DeforaNetworks/nfcutils
DeforaNetworks/nfcutils
3
0
Fork 0
Code Releases Activity

indent using "indent -br -ce --line-length120 -nut -i2 src/lsnfc.c".

Browse Source
This commit is contained in:
Romuald Conty 2010-03-18 11:08:53 +00:00
parent 50e79d3760
commit 82076d5a80
1 changed files with 133 additions and 106 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

239
src/lsnfc.c
View File

@ -25,21 +25,23 @@
#include <nfc/nfc.h> #include <nfc/nfc.h>
static nfc_device_t* pnd; static nfc_device_t *pnd;
static byte_t abtFelica[5] = { 0x00, 0xff, 0xff, 0x00, 0x00 }; static byte_t abtFelica[5] = { 0x00, 0xff, 0xff, 0x00, 0x00 };
#define ERR(x, ...) printf("ERROR: " x "\n", ## __VA_ARGS__ ) #define ERR(x, ...) printf("ERROR: " x "\n", ## __VA_ARGS__ )
#define MAX_DEVICE_COUNT 16 #define MAX_DEVICE_COUNT 16
void print_hex(byte_t* pbtData, size_t szDate) void
print_hex (byte_t * pbtData, size_t szDate)
{ {
for(size_t i=0; i<szDate; i++) { for (size_t i = 0; i < szDate; i++) {
printf("%02x",pbtData[i]); printf ("%02x", pbtData[i]);
} }
} }
int main(int argc, const char* argv[]) int
main (int argc, const char *argv[])
{ {
nfc_target_info_t nti; nfc_target_info_t nti;
uint8_t tag_count = 0; uint8_t tag_count = 0;
@ -48,48 +50,44 @@ int main(int argc, const char* argv[])
size_t szFound; size_t szFound;
// Try to open the NFC device // Try to open the NFC device
if (!(pnddDevices = malloc (MAX_DEVICE_COUNT * sizeof (*pnddDevices)))) if (!(pnddDevices = malloc (MAX_DEVICE_COUNT * sizeof (*pnddDevices)))) {
{
fprintf (stderr, "malloc() failed\n"); fprintf (stderr, "malloc() failed\n");
return EXIT_FAILURE; return EXIT_FAILURE;
} }
nfc_list_devices (pnddDevices, MAX_DEVICE_COUNT, &szFound); nfc_list_devices (pnddDevices, MAX_DEVICE_COUNT, &szFound);
if (szFound == 0) if (szFound == 0) {
{ ERR ("%s", "No device found.");
ERR("%s", "No device found.");
} }
for (size_t i = 0; i < szFound; i++) for (size_t i = 0; i < szFound; i++) {
{ pnd = nfc_connect (&(pnddDevices[i]));
pnd = nfc_connect(&(pnddDevices[i]));
if (pnd == NULL) { if (pnd == NULL) {
ERR("%s", "Unable to connect to NFC device."); ERR ("%s", "Unable to connect to NFC device.");
return EXIT_FAILURE; return EXIT_FAILURE;
} }
nfc_initiator_init(pnd); nfc_initiator_init (pnd);
// Drop the field for a while // Drop the field for a while
nfc_configure(pnd,NDO_ACTIVATE_FIELD,false); nfc_configure (pnd, NDO_ACTIVATE_FIELD, false);
// Let the reader only try once to find a tag // Let the reader only try once to find a tag
nfc_configure(pnd,NDO_INFINITE_SELECT,false); nfc_configure (pnd, NDO_INFINITE_SELECT, false);
// Configure the CRC and Parity settings // Configure the CRC and Parity settings
nfc_configure(pnd,NDO_HANDLE_CRC,true); nfc_configure (pnd, NDO_HANDLE_CRC, true);
nfc_configure(pnd,NDO_HANDLE_PARITY,true); nfc_configure (pnd, NDO_HANDLE_PARITY, true);
// Enable field so more power consuming cards can power themselves up // Enable field so more power consuming cards can power themselves up
nfc_configure(pnd,NDO_ACTIVATE_FIELD,true); nfc_configure (pnd, NDO_ACTIVATE_FIELD, true);
bool no_more_tag = false; bool no_more_tag = false;
printf("device = %s\n",pnd->acName); printf ("device = %s\n", pnd->acName);
do { do {
if (nfc_initiator_select_tag(pnd,NM_ISO14443A_106,NULL,0,&nti)) if (nfc_initiator_select_tag (pnd, NM_ISO14443A_106, NULL, 0, &nti)) {
{ printf (" ISO14443A: ");
printf(" ISO14443A: ");
/* /*
Theses values comes from http://www.libnfc.org/documentation/hardware/tags/iso14443 Theses values comes from http://www.libnfc.org/documentation/hardware/tags/iso14443
@ -111,83 +109,112 @@ Gemplus MPCOS 00 02 98
Innovision R&T Jewel 0C 00 Innovision R&T Jewel 0C 00
*/ */
if ((nti.nai.abtAtqa[0] == 0x00) && (nti.nai.abtAtqa[1] == 0x04) && (nti.nai.btSak == 0x09)) { if ((nti.nai.abtAtqa[0] == 0x00) && (nti.nai.abtAtqa[1] == 0x04) && (nti.nai.btSak == 0x09)) {
printf("NXP MIFARE Mini (UID="); print_hex(nti.nai.abtUid,nti.nai.szUidLen); printf(")\n"); printf ("NXP MIFARE Mini (UID=");
} else if ((nti.nai.abtAtqa[0] == 0x00) && (nti.nai.abtAtqa[1] == 0x04) && (nti.nai.btSak == 0x08)) { print_hex (nti.nai.abtUid, nti.nai.szUidLen);
printf("NXP MIFARE Classic 1K (UID="); print_hex(nti.nai.abtUid,nti.nai.szUidLen); printf(")\n"); printf (")\n");
} else if ((nti.nai.abtAtqa[0] == 0x00) && (nti.nai.abtAtqa[1] == 0x02) && (nti.nai.btSak == 0x18)) { } else if ((nti.nai.abtAtqa[0] == 0x00) && (nti.nai.abtAtqa[1] == 0x04) && (nti.nai.btSak == 0x08)) {
printf("NXP MIFARE Classic 4K (UID="); print_hex(nti.nai.abtUid,nti.nai.szUidLen); printf(")\n"); printf ("NXP MIFARE Classic 1K (UID=");
} else if ((nti.nai.abtAtqa[0] == 0x00) && (nti.nai.abtAtqa[1] == 0x02) && (nti.nai.btSak == 0x38)) { print_hex (nti.nai.abtUid, nti.nai.szUidLen);
printf("Nokia MIFARE Classic 4K - emulated - (UID="); print_hex(nti.nai.abtUid,nti.nai.szUidLen); printf(")\n"); printf (")\n");
} else if ((nti.nai.abtAtqa[0] == 0x00) && (nti.nai.abtAtqa[1] == 0x44) && (nti.nai.btSak == 0x00)) { } else if ((nti.nai.abtAtqa[0] == 0x00) && (nti.nai.abtAtqa[1] == 0x02) && (nti.nai.btSak == 0x18)) {
printf("NXP MIFARE Ultralight (UID="); print_hex(nti.nai.abtUid,nti.nai.szUidLen); printf(")\n"); printf ("NXP MIFARE Classic 4K (UID=");
} else if ((nti.nai.abtAtqa[0] == 0x03) && (nti.nai.abtAtqa[1] == 0x44) && (nti.nai.btSak == 0x20)) { print_hex (nti.nai.abtUid, nti.nai.szUidLen);
printf("NXP MIFARE DESFire (UID="); print_hex(nti.nai.abtUid,nti.nai.szUidLen); printf(")\n"); printf (")\n");
} else if ((nti.nai.abtAtqa[0] == 0x03) && (nti.nai.abtAtqa[1] == 0x04) && (nti.nai.btSak == 0x28)) { } else if ((nti.nai.abtAtqa[0] == 0x00) && (nti.nai.abtAtqa[1] == 0x02) && (nti.nai.btSak == 0x38)) {
printf("NXP JCOP31 (UID="); print_hex(nti.nai.abtUid,nti.nai.szUidLen); printf(")\n"); printf ("Nokia MIFARE Classic 4K - emulated - (UID=");
} else if ((nti.nai.abtAtqa[0] == 0x00) && (nti.nai.abtAtqa[1] == 0x48) && (nti.nai.btSak == 0x20)) { print_hex (nti.nai.abtUid, nti.nai.szUidLen);
/* @todo handle ATS to be able to know which one is it. */ printf (")\n");
printf("NXP JCOP31 or JCOP41 (UID="); print_hex(nti.nai.abtUid,nti.nai.szUidLen); printf(")\n"); } else if ((nti.nai.abtAtqa[0] == 0x00) && (nti.nai.abtAtqa[1] == 0x44) && (nti.nai.btSak == 0x00)) {
} else if ((nti.nai.abtAtqa[0] == 0x00) && (nti.nai.abtAtqa[1] == 0x04) && (nti.nai.btSak == 0x28)) { printf ("NXP MIFARE Ultralight (UID=");
printf("NXP JCOP41 (UID="); print_hex(nti.nai.abtUid,nti.nai.szUidLen); printf(")\n"); print_hex (nti.nai.abtUid, nti.nai.szUidLen);
} else if ((nti.nai.abtAtqa[0] == 0x00) && (nti.nai.abtAtqa[1] == 0x04) && (nti.nai.btSak == 0x88)) { printf (")\n");
printf("Infineon MIFARE Classic 1K (UID="); print_hex(nti.nai.abtUid,nti.nai.szUidLen); printf(")\n"); } else if ((nti.nai.abtAtqa[0] == 0x03) && (nti.nai.abtAtqa[1] == 0x44) && (nti.nai.btSak == 0x20)) {
} else if ((nti.nai.abtAtqa[0] == 0x00) && (nti.nai.abtAtqa[1] == 0x02) && (nti.nai.btSak == 0x98)) { printf ("NXP MIFARE DESFire (UID=");
printf("Gemplus MPCOS (UID="); print_hex(nti.nai.abtUid,nti.nai.szUidLen); printf(")\n"); print_hex (nti.nai.abtUid, nti.nai.szUidLen);
} else if ((nti.nai.abtAtqa[0] == 0x0C) && (nti.nai.abtAtqa[1] == 0x00)) { printf (")\n");
/* @note I'm not sure that Jewel can be detected using this modultation and I haven't Jewel tags to test. */ } else if ((nti.nai.abtAtqa[0] == 0x03) && (nti.nai.abtAtqa[1] == 0x04) && (nti.nai.btSak == 0x28)) {
printf("Innovision R&T Jewel (UID="); print_hex(nti.nai.abtUid,nti.nai.szUidLen); printf(")\n"); printf ("NXP JCOP31 (UID=");
} else { print_hex (nti.nai.abtUid, nti.nai.szUidLen);
printf("Unknown ISO14443A tag type: "); printf (")\n");
printf("ATQA (SENS_RES): "); print_hex(nti.nai.abtAtqa,2); } else if ((nti.nai.abtAtqa[0] == 0x00) && (nti.nai.abtAtqa[1] == 0x48) && (nti.nai.btSak == 0x20)) {
printf(", UID (NFCID%c): ",(nti.nai.abtUid[0]==0x08?'3':'1')); print_hex(nti.nai.abtUid,nti.nai.szUidLen); /* @todo handle ATS to be able to know which one is it. */
printf(", SAK (SEL_RES): "); print_hex(&nti.nai.btSak,1); printf ("NXP JCOP31 or JCOP41 (UID=");
if (nti.nai.szAtsLen) print_hex (nti.nai.abtUid, nti.nai.szUidLen);
{ printf (")\n");
printf(", ATS (ATR): "); } else if ((nti.nai.abtAtqa[0] == 0x00) && (nti.nai.abtAtqa[1] == 0x04) && (nti.nai.btSak == 0x28)) {
print_hex(nti.nai.abtAts,nti.nai.szAtsLen); printf ("NXP JCOP41 (UID=");
print_hex (nti.nai.abtUid, nti.nai.szUidLen);
printf (")\n");
} else if ((nti.nai.abtAtqa[0] == 0x00) && (nti.nai.abtAtqa[1] == 0x04) && (nti.nai.btSak == 0x88)) {
printf ("Infineon MIFARE Classic 1K (UID=");
print_hex (nti.nai.abtUid, nti.nai.szUidLen);
printf (")\n");
} else if ((nti.nai.abtAtqa[0] == 0x00) && (nti.nai.abtAtqa[1] == 0x02) && (nti.nai.btSak == 0x98)) {
printf ("Gemplus MPCOS (UID=");
print_hex (nti.nai.abtUid, nti.nai.szUidLen);
printf (")\n");
} else if ((nti.nai.abtAtqa[0] == 0x0C) && (nti.nai.abtAtqa[1] == 0x00)) {
/* @note I'm not sure that Jewel can be detected using this modultation and I haven't Jewel tags to test. */
printf ("Innovision R&T Jewel (UID=");
print_hex (nti.nai.abtUid, nti.nai.szUidLen);
printf (")\n");
} else {
printf ("Unknown ISO14443A tag type: ");
printf ("ATQA (SENS_RES): ");
print_hex (nti.nai.abtAtqa, 2);
printf (", UID (NFCID%c): ", (nti.nai.abtUid[0] == 0x08 ? '3' : '1'));
print_hex (nti.nai.abtUid, nti.nai.szUidLen);
printf (", SAK (SEL_RES): ");
print_hex (&nti.nai.btSak, 1);
if (nti.nai.szAtsLen) {
printf (", ATS (ATR): ");
print_hex (nti.nai.abtAts, nti.nai.szAtsLen);
}
printf ("\n");
} }
printf("\n"); nfc_initiator_deselect_tag (pnd);
tag_count++;
} else if (nfc_initiator_select_tag (pnd, NM_FELICA_212, abtFelica, 5, &nti)
|| nfc_initiator_select_tag (pnd, NM_FELICA_424, abtFelica, 5, &nti)) {
printf (" Felica: ");
printf ("ID (NFCID2): ");
print_hex (nti.nfi.abtId, 8);
printf (", Parameter (PAD): ");
print_hex (nti.nfi.abtPad, 8);
printf ("\n");
nfc_initiator_deselect_tag (pnd);
tag_count++;
} else if (nfc_initiator_select_tag (pnd, NM_ISO14443B_106, (byte_t *) "\x00", 1, &nti)) {
printf (" ISO14443B: ");
printf ("ATQB: ");
print_hex (nti.nbi.abtAtqb, 12);
printf (", ID: ");
print_hex (nti.nbi.abtId, 4);
printf (", CID: %02x\n", nti.nbi.btCid);
if (nti.nbi.szInfLen > 0) {
printf (", INF: ");
print_hex (nti.nbi.abtInf, nti.nbi.szInfLen);
}
printf (", PARAMS: %02x %02x %02x %02x\n", nti.nbi.btParam1, nti.nbi.btParam2, nti.nbi.btParam3,
nti.nbi.btParam4);
printf ("\n");
nfc_initiator_deselect_tag (pnd);
tag_count++;
} else if (nfc_initiator_select_tag (pnd, NM_JEWEL_106, NULL, 0, &nti)) {
printf (" Jewel: No test results yet");
nfc_initiator_deselect_tag (pnd);
tag_count++;
} else {
no_more_tag = true;
} }
nfc_initiator_deselect_tag(pnd); } while (no_more_tag != true);
tag_count++; printf ("%d tag(s) have been found.\n", tag_count);
} else if (nfc_initiator_select_tag(pnd,NM_FELICA_212,abtFelica,5,&nti) || nfc_initiator_select_tag(pnd,NM_FELICA_424,abtFelica,5,&nti))
{
printf(" Felica: ");
printf("ID (NFCID2): "); print_hex(nti.nfi.abtId,8);
printf(", Parameter (PAD): "); print_hex(nti.nfi.abtPad,8);
printf("\n");
nfc_initiator_deselect_tag(pnd);
tag_count++;
} else if (nfc_initiator_select_tag(pnd,NM_ISO14443B_106,(byte_t*)"\x00",1,&nti))
{
printf(" ISO14443B: ");
printf("ATQB: "); print_hex(nti.nbi.abtAtqb,12);
printf(", ID: "); print_hex(nti.nbi.abtId,4);
printf(", CID: %02x\n",nti.nbi.btCid);
if (nti.nbi.szInfLen>0)
{
printf(", INF: "); print_hex(nti.nbi.abtInf,nti.nbi.szInfLen);
}
printf(", PARAMS: %02x %02x %02x %02x\n",nti.nbi.btParam1,nti.nbi.btParam2,nti.nbi.btParam3,nti.nbi.btParam4);
printf("\n");
nfc_initiator_deselect_tag(pnd);
tag_count++;
} else if (nfc_initiator_select_tag(pnd,NM_JEWEL_106,NULL,0,&nti))
{
printf(" Jewel: No test results yet");
nfc_initiator_deselect_tag(pnd);
tag_count++;
} else {
no_more_tag = true;
}
} while (no_more_tag != true);
printf("%d tag(s) have been found.\n", tag_count);
// Disable field // Disable field
nfc_configure(pnd,NDO_ACTIVATE_FIELD,false); nfc_configure (pnd, NDO_ACTIVATE_FIELD, false);
nfc_disconnect(pnd); nfc_disconnect (pnd);
} }
return EXIT_SUCCESS; return EXIT_SUCCESS;
} }