53 #endif // HAVE_CONFIG_H
64 #if defined(WIN32) && defined(__GNUC__)
72 print_usage(
char *progname)
74 fprintf(stderr,
"usage: %s -o FILE\n", progname);
75 fprintf(stderr,
"\nOptions:\n");
76 fprintf(stderr,
" -o Extract NDEF message if available in FILE\n");
79 static void stop_select(
int sig)
91 build_felica_frame(
const nfc_felica_info nfi,
const uint8_t command,
const uint8_t *payload,
const size_t payload_len, uint8_t *frame,
size_t *frame_len)
93 frame[0] = 1 + 1 + 8 + payload_len;
94 *frame_len = frame[0];
96 memcpy(frame + 2, nfi.abtId, 8);
97 memcpy(frame + 10, payload, payload_len);
102 nfc_forum_tag_type3_check(
nfc_device *dev,
const nfc_target nt,
const uint16_t block,
const uint8_t block_count, uint8_t *data,
size_t *data_len)
104 uint8_t payload[1024] = {
111 size_t payload_len = 1 + 2 + 1;
112 for (uint8_t b = 0; b < block_count; b++) {
114 payload[payload_len++] = 0x80;
115 payload[payload_len++] = block + b;
117 payload[payload_len++] = 0x00;
118 payload[payload_len++] = (block + b) >> 8;
119 payload[payload_len++] = (block + b) & 0xff;
124 size_t frame_len =
sizeof(frame);
125 build_felica_frame(nt.nti.nfi, CHECK, payload, payload_len, frame, &frame_len);
132 const int res_overhead = 1 + 1 + 8 + 2;
133 if (res < res_overhead) {
137 uint8_t felica_res_len = rx[0];
138 if (res != felica_res_len) {
142 if ((CHECK + 1) != rx[1]) {
146 if (0 != memcmp(&rx[2], nt.nti.nfi.abtId, 8)) {
150 const uint8_t status_flag1 = rx[10];
151 const uint8_t status_flag2 = rx[11];
152 if ((status_flag1) || (status_flag2)) {
154 fprintf(stderr,
"Status bytes: %02x, %02x\n", status_flag1, status_flag2);
158 *data_len = res - res_overhead + 1;
159 memcpy(data, &rx[res_overhead + 1], *data_len);
164 main(
int argc,
char *argv[])
170 char *ndef_output = NULL;
171 while ((ch = getopt(argc, argv,
"ho:")) != -1) {
174 print_usage(argv[0]);
178 ndef_output = optarg;
182 fprintf(stderr,
"Option -%c requires an argument.\n", optopt);
184 print_usage(argv[0]);
189 if (ndef_output == NULL) {
190 print_usage(argv[0]);
193 FILE *message_stream = NULL;
194 FILE *ndef_stream = NULL;
196 if ((strlen(ndef_output) == 1) && (ndef_output[0] ==
'-')) {
197 message_stream = stderr;
198 ndef_stream = stdout;
200 message_stream = stdout;
201 ndef_stream = fopen(ndef_output,
"wb");
203 fprintf(stderr,
"Could not open file %s.\n", ndef_output);
209 if (context == NULL) {
210 ERR(
"Unable to init libnfc (malloc)\n");
217 ERR(
"Unable to open NFC device");
230 signal(SIGINT, stop_select);
241 fprintf(message_stream,
"Place your NFC Forum Tag Type 3 in the field...\n");
244 const uint8_t *pbtSensfReq = (uint8_t *)
"\x00\xff\xff\x01\x00";
246 nfc_perror(pnd,
"nfc_initiator_select_passive_target");
254 const uint8_t abtNfcForumSysCode[] = { 0x12, 0xfc };
255 if (0 != memcmp(nt.nti.nfi.abtSysCode, abtNfcForumSysCode, 2)) {
257 const uint8_t *pbtSensfReqNfcForum = (uint8_t *)
"\x00\x12\xfc\x01\x00";
259 nfc_perror(pnd,
"nfc_initiator_select_passive_target");
266 if (0 != memcmp(nt.nti.nfi.abtSysCode, abtNfcForumSysCode, 2)) {
267 fprintf(stderr,
"Tag is not NFC Forum Tag Type 3 compliant.\n");
278 nfc_perror(pnd,
"nfc_device_set_property_bool");
286 size_t data_len =
sizeof(data);
288 if (nfc_forum_tag_type3_check(pnd, nt, 0, 1, data, &data_len) <= 0) {
296 const int ndef_major_version = (data[0] & 0xf0) >> 4;
297 const int ndef_minor_version = (data[0] & 0x0f);
298 fprintf(message_stream,
"NDEF Mapping version: %d.%d\n", ndef_major_version, ndef_minor_version);
300 const int available_block_count = (data[3] << 8) + data[4];
301 fprintf(message_stream,
"NFC Forum Tag Type 3 capacity: %d bytes\n", available_block_count * 16);
303 uint32_t ndef_data_len = (data[11] << 16) + (data[12] << 8) + data[13];
304 fprintf(message_stream,
"NDEF data length: %d bytes\n", ndef_data_len);
306 uint16_t ndef_calculated_checksum = 0;
307 for (
size_t n = 0; n < 14; n++)
308 ndef_calculated_checksum += data[n];
310 const uint16_t ndef_checksum = (data[14] << 8) + data[15];
311 if (ndef_calculated_checksum != ndef_checksum) {
312 fprintf(stderr,
"NDEF CRC does not match with calculated one\n");
319 if (!ndef_data_len) {
320 fprintf(stderr,
"Empty NFC Forum Tag Type 3\n");
327 const uint8_t block_max_per_check = data[1];
328 const uint16_t block_count_to_check = (ndef_data_len / 16) + 1;
331 for (uint16_t b = 0; b < (block_count_to_check / block_max_per_check); b += block_max_per_check) {
332 size_t size =
sizeof(data) - data_len;
333 if (!nfc_forum_tag_type3_check(pnd, nt, 1 + b, MIN(block_max_per_check, (block_count_to_check - (b * block_max_per_check))), data + data_len, &size)) {
342 if (fwrite(data, 1, data_len, ndef_stream) != data_len) {
343 fprintf(stderr,
"Could not write to file.\n");