int try_format_sector (MifareTag tag, MifareClassicSectorNumber sector)
{
display_progress ();
size_t i;
for (i = 0; i < (sizeof (default_keys) / sizeof (MifareClassicKey)); i++)
{
MifareClassicBlockNumber block = mifare_classic_sector_last_block (sector);
if ((0 == mifare_classic_connect (tag)) && (0 == mifare_classic_authenticate (tag, block, default_keys[i], MFC_KEY_A)))
{
if (0 == mifare_classic_format_sector (tag, sector))
{
mifare_classic_disconnect (tag);
return 1;
}
else if (EIO == errno)
{
err (EXIT_FAILURE, "sector %d", sector);
}
mifare_classic_disconnect (tag);
}
if ((0 == mifare_classic_connect (tag)) && (0 == mifare_classic_authenticate (tag, block, default_keys[i], MFC_KEY_B)))
{
if (0 == mifare_classic_format_sector (tag, sector))
{
mifare_classic_disconnect (tag);
return 1;
}
else if (EIO == errno)
{
err (EXIT_FAILURE, "sector %d", sector);
}
mifare_classic_disconnect (tag);
}
}
sprintf(message_erreur,"No known authentication key for sector %d !", sector);
return 0;
}
int
search_sector_key (MifareTag tag, MifareClassicSectorNumber sector, MifareClassicKey *key, MifareClassicKeyType *key_type)
{
MifareClassicBlockNumber block = mifare_classic_sector_last_block (sector);
/*
* FIXME: We should not assume that if we have full access to trailer block
* we also have a full access to data blocks.
*/
mifare_classic_disconnect (tag);
for (size_t i = 0; i < (sizeof (default_keys) / sizeof (MifareClassicKey)); i++) {
if ((0 == mifare_classic_connect (tag)) && (0 == mifare_classic_authenticate (tag, block, default_keys[i], MFC_KEY_A))) {
if ((1 == mifare_classic_get_trailer_block_permission (tag, block, MCAB_WRITE_KEYA, MFC_KEY_A)) &&
(1 == mifare_classic_get_trailer_block_permission (tag, block, MCAB_WRITE_ACCESS_BITS, MFC_KEY_A)) &&
(1 == mifare_classic_get_trailer_block_permission (tag, block, MCAB_WRITE_KEYB, MFC_KEY_A))) {
memcpy (key, &default_keys[i], sizeof (MifareClassicKey));
*key_type = MFC_KEY_A;
return 1;
}
}
mifare_classic_disconnect (tag);
if ((0 == mifare_classic_connect (tag)) && (0 == mifare_classic_authenticate (tag, block, default_keys[i], MFC_KEY_B))) {
if ((1 == mifare_classic_get_trailer_block_permission (tag, block, MCAB_WRITE_KEYA, MFC_KEY_B)) &&
(1 == mifare_classic_get_trailer_block_permission (tag, block, MCAB_WRITE_ACCESS_BITS, MFC_KEY_B)) &&
(1 == mifare_classic_get_trailer_block_permission (tag, block, MCAB_WRITE_KEYB, MFC_KEY_B))) {
memcpy (key, &default_keys[i], sizeof (MifareClassicKey));
*key_type = MFC_KEY_B;
return 1;
}
}
mifare_classic_disconnect (tag);
}
warnx ("No known authentication key for sector 0x%02x\n", sector);
return 0;
}
void
cut_setup (void)
{
int res;
nfc_connstring devices[8];
size_t device_count;
nfc_init (&context);
cut_assert_not_null (context, cut_message ("Unable to init libnfc (malloc)"));
device_count = nfc_list_devices (context, devices, 8);
if (device_count <= 0)
cut_omit ("No device found");
for (size_t i = 0; i < device_count; i++) {
device = nfc_open (context, devices[i]);
if (!device)
cut_omit ("nfc_open() failed.");
tags = freefare_get_tags (device);
cut_assert_not_null (tags, cut_message ("freefare_get_tags() failed"));
tag = NULL;
for (int i=0; tags[i]; i++) {
if ((freefare_get_tag_type(tags[i]) == MIFARE_CLASSIC_1K) ||
(freefare_get_tag_type(tags[i]) == MIFARE_CLASSIC_4K)) {
tag = tags[i];
res = mifare_classic_connect (tag);
cut_assert_equal_int (0, res, cut_message ("mifare_classic_connect() failed"));
return;
}
}
nfc_close (device);
device = NULL;
freefare_free_tags (tags);
tags = NULL;
}
cut_omit ("No MIFARE Classic tag on NFC device");
}
int main(int argc, const char *argv[])
{
nfc_device *pnd;
//nfc_target nt;
MifareTag *tags = NULL;
int i,j,k;
int nbrsect=0;
MifareClassicBlock data;
// Allocate only a pointer to nfc_context
nfc_context *context;
// Initialize libnfc and set the nfc_context
nfc_init(&context);
if (context == NULL) {
printf("Unable to init libnfc\n");
exit(EXIT_FAILURE);
}
// Open, using the first available NFC device which can be in order of selection:
// - default device specified using environment variable or
// - first specified device in libnfc.conf (/etc/nfc) or
// - first specified device in device-configuration directory (/etc/nfc/devices.d) or
// - first auto-detected (if feature is not disabled in libnfc.conf) device
pnd = nfc_open(context, NULL);
if (pnd == NULL) {
printf("ERROR: %s\n", "Unable to open NFC device.");
exit(EXIT_FAILURE);
}
printf("NFC reader: %s opened\n", nfc_device_get_name(pnd));
tags = freefare_get_tags(pnd);
if (!tags) {
printf("no Mifare classic\n");
} else {
for (i = 0; tags[i]; i++) {
switch(freefare_get_tag_type(tags[i])) {
case CLASSIC_1K:
printf("%u : Mifare 1k (S50) : %s\n", i, freefare_get_tag_uid(tags[i]));
nbrsect=16;
break;
case CLASSIC_4K:
printf("%u : Mifare 4k (S70) : %s\n", i, freefare_get_tag_uid(tags[i]));
nbrsect=40;
break;
default:
printf("%u : other ISO14443A tag : %s\n", i, freefare_get_tag_uid(tags[i]));
}
}
}
if (!tags[0]) {
printf("no tag found !\n");
nfc_close(pnd);
nfc_exit(context);
exit(EXIT_FAILURE);
}
printf ("Found %s\n", freefare_get_tag_friendly_name (tags[0]));
/*
MifareClassicBlockNumber dablock = 1;
if(mifare_classic_connect(tags[0]) == OPERATION_OK) {
printf("Connected !\n");
if(mifare_classic_authenticate(tags[0], dablock, keys[0], MFC_KEY_A) == OPERATION_OK) {
printf("Authenticated !\n");
if(mifare_classic_get_data_block_permission (tags[0], dablock, MCAB_R|MCAB_W, MFC_KEY_A))
printf("i can READ block %d with key A\n", dablock);
if(mifare_classic_get_trailer_block_permission (tags[0], ((dablock)/4)*4+3, MCAB_READ_KEYB, MFC_KEY_B))
printf("i can READ KEY A in trailer\n");
}
}
*/
for(i=0; i<nbrsect; i++) {
for(j=0; j < sizeof(keys)/sizeof(keys[0]); j++) {
if((mifare_classic_connect(tags[0]) == OPERATION_OK) &&
(mifare_classic_authenticate(
tags[0],
mifare_classic_sector_last_block(i),
keys[j],
MFC_KEY_A) == OPERATION_OK)) {
printf("sector %02d auth with A[%d]\n", i, j);
for(k=mifare_classic_sector_first_block(i);
k<=mifare_classic_sector_last_block(i); k++) {
if(mifare_classic_read(tags[0], k, &data) == OPERATION_OK) {
print_hex(data,16);
} else {
printf("read error\n");
}
}
mifare_classic_disconnect(tags[0]);
break;
}
mifare_classic_disconnect(tags[0]);
}
printf("\n");
}
printf("\n");
freefare_free_tags(tags);
// Close NFC device
nfc_close(pnd);
// Release the context
nfc_exit(context);
exit(EXIT_SUCCESS);
}
int main(int argc, char **argv) {
int res;
nfc_connstring devices[8];
size_t device_count;
nfc_context *nfcctx;
char *uid = NULL;
init_crypto_state();
nfc_init(&nfcctx);
device_count = nfc_list_devices(nfcctx,devices,8);
if (device_count <= 0) {
std::cerr << "No device found" << std::endl;
}
device = nfc_open(nfcctx, devices[0]);
tags = freefare_get_tags(device);
if (tags[0] == NULL) {
std::cerr << "No tag on device" << std::endl;
exit(1);
}
for (int i = 0; tags[i]; i++) {
if (freefare_get_tag_type(tags[i]) == CLASSIC_1K) {
tag = tags[i];
res = mifare_classic_connect(tag);
if (res != 0) {
std::cout << "Error connecting to MiFare Classic" << std::endl;
exit(1);
}
std::cout << "Connected to MiFare Classic" << std::endl;
uid = freefare_get_tag_uid(tag);
break;
}
}
std::cout << "UID: " << uid << std::endl;
MifareClassicKey *keyA = (MifareClassicKey *)get_random_bytes(6);
std::cout << "Key A: ";
print_hex(*keyA,6);
char *b64KeyA = getBase64String((char *)keyA,6);
std::cout << b64KeyA << std::endl;
std::cout << "Key B: ";
MifareClassicKey *keyB = (MifareClassicKey *)get_random_bytes(6);
print_hex(*keyB,6);
char *b64KeyB = getBase64String((char *)keyB,6);
bool addedToServer = addCard(uid,b64KeyA,b64KeyB);
if (!addedToServer) {
printf("Not added to server\n");
}
// Authenticate with default key to make changes
MifareClassicBlockNumber lastTrailer = mifare_classic_sector_last_block(15);
res = mifare_classic_authenticate(tag,lastTrailer,defaultKey,MFC_KEY_A);
if (res != 0) {
printf("Could not authenticate with default key.. card already formatted?\n");
return -1;
}
MifareClassicBlockNumber firstBlock = mifare_classic_sector_first_block(15);
res = mifare_classic_init_value(tag,firstBlock,SECTOR_15_BLOCK_0_INIT,firstBlock);
if (res != 0) {
printf("Could not init value block %d\n",firstBlock);
}
MifareClassicBlock trailerBlock;
mifare_classic_trailer_block(&trailerBlock,*keyA,0x03,0x00,0x00,0x04,0x00, *keyB);
print_hex(trailerBlock, sizeof(MifareClassicBlock));
res = mifare_classic_write(tag,lastTrailer,trailerBlock);
if (res != 0) {
printf("Could not write sector 15 trailer. STOP\n");
return -1;
}
MifareClassicBlock normalTrailerBlock;
mifare_classic_trailer_block(&normalTrailerBlock,*keyA,0x00,0x00,0x00,0x04,0x00,*keyB);
printf("Writing normal trailer block ");
print_hex(&normalTrailerBlock[0], sizeof(MifareClassicBlock));
MifareClassicSectorNumber sector;
for(sector=0; sector<15;sector++) {
MifareClassicBlockNumber trailerBlockNumber = mifare_classic_sector_last_block(sector);
res = mifare_classic_authenticate(tag,trailerBlockNumber,defaultKey,MFC_KEY_A);
if (res != 0) {
printf("Could not authenticate with default key.. card already formatted?\n");
return -1;
}
res = mifare_classic_write(tag,trailerBlockNumber,normalTrailerBlock);
if (res != 0) {
printf("Could not write trailer block for sector %d\n",sector);
return -1;
} else {
printf("Wrote trailer block for sector %d\n",sector);
}
}
free(keyA);
free(keyB);
free(b64KeyA);
free(b64KeyB);
free(uid);
freefare_free_tags(tags);
nfc_close(device);
}
int
mifare_classic_read_ndef(MifareTag tag, char * buffer, char *max_size)
{
int error = EXIT_SUCCESS;
Mad mad;
// NFCForum card has a MAD, load it.
if (0 == mifare_classic_connect (tag)) {
} else {
return -2;
}
if ((mad = mad_read (tag))) {
// Dump the NFCForum application using MAD information
ssize_t len;
if ((len = mifare_application_read (tag, mad, mad_nfcforum_aid, buffer, max_size, mifare_classic_nfcforum_public_key_a, MFC_KEY_A)) != -1) {
uint8_t tlv_type;
uint16_t tlv_data_len;
uint8_t * tlv_data;
uint8_t * pbuffer = buffer;
uint8_t found = false;
while (!found)
{
tlv_data = tlv_decode (pbuffer, &tlv_type, &tlv_data_len);
switch (tlv_type) {
case 0x00:
printf ("NFC Forum application contains a \"NULL TLV\", Skipping...\n"); // According to [ANNFC1K4K], we skip this Tag to read further TLV blocks.
pbuffer += tlv_record_length(pbuffer, NULL, NULL);
if (pbuffer >= buffer + sizeof(buffer)) {
error= -3;
found = true;
}
break;
case 0x03:
printf ("NFC Forum application contains a \"NDEF Message TLV\".\n");
found = true;
error = tlv_data_len;
memcpy(buffer,tlv_data,tlv_data_len);
break;
case 0xFD:
printf ("NFC Forum application contains a \"Proprietary TLV\", Skipping...\n"); // According to [ANNFC1K4K], we can skip this TLV to read further TLV blocks.
pbuffer += tlv_record_length(pbuffer, NULL, NULL);
if (pbuffer >= buffer + sizeof(buffer)) {
error= -4;
found = true;
}
break;
case 0xFE:
printf ("NFC Forum application contains a \"Terminator TLV\", no available data.\n");
error= -5;
found = true;
break;
default:
printf ("NFC Forum application contains an invalid TLV.\n");
error= -6;
found = true;
}
}
} else {
printf ("No NFC Forum application.\n");
error= -7;
}
} else {
printf ("No MAD detected.\n");
}
vPortFree (mad);
return error;
}
int main(int argc, const char *argv[])
{
nfc_device *pnd;
// nfc_target nt;
// static mifare_param mp;
int i, j;
MifareTag *tags = NULL;
int error = 0;
MifareClassicBlock dablock;
// MifareClassicBlock mydata = {0x00,0x00,0x00,0x42, 0xff,0xff,0xff,0xbd, 0x00,0x00,0x00,0x42, 0,0xff,0x00,0xff};
MifareClassicBlock my_trailer_block;
MifareClassicKey my_key_A = { 0xff,0xff,0xff,0xff,0xff,0xff };
MifareClassicKey my_key_B = { 0xff,0xff,0xff,0xff,0xff,0xff };
// Allocate only a pointer to nfc_context
nfc_context *context;
// Initialize libnfc and set the nfc_context
nfc_init(&context);
if (context == NULL) {
printf("Unable to init libnfc (malloc)\n");
exit(EXIT_FAILURE);
}
// Display libnfc version
const char *acLibnfcVersion = nfc_version();
(void)argc;
printf("%s uses libnfc %s\n", argv[0], acLibnfcVersion);
// Open, using the first available NFC device which can be in order of selection:
// - default device specified using environment variable or
// - first specified device in libnfc.conf (/etc/nfc) or
// - first specified device in device-configuration directory (/etc/nfc/devices.d) or
// - first auto-detected (if feature is not disabled in libnfc.conf) device
pnd = nfc_open(context, NULL);
if (pnd == NULL) {
printf("ERROR: %s\n", "Unable to open NFC device.");
exit(EXIT_FAILURE);
}
// Set opened NFC device to initiator mode
if (nfc_initiator_init(pnd) < 0) {
nfc_perror(pnd, "nfc_initiator_init");
exit(EXIT_FAILURE);
}
printf("NFC reader: %s opened\n", nfc_device_get_name(pnd));
// Poll for a ISO14443A (MIFARE) tag
/*
const nfc_modulation nmMifare = {
.nmt = NMT_ISO14443A,
.nbr = NBR_106,
};
if (nfc_initiator_select_passive_target(pnd, nmMifare, NULL, 0, &nt) > 0) {
printf("The following (NFC) ISO14443A tag was found:\n");
printf(" ATQA (SENS_RES): ");
print_hex(nt.nti.nai.abtAtqa, 2);
printf(" UID (NFCID%c): ", (nt.nti.nai.abtUid[0] == 0x08 ? '3' : '1'));
print_hex(nt.nti.nai.abtUid, nt.nti.nai.szUidLen);
printf(" SAK (SEL_RES): ");
print_hex(&nt.nti.nai.btSak, 1);
if (nt.nti.nai.szAtsLen) {
printf(" ATS (ATR): ");
print_hex(nt.nti.nai.abtAts, nt.nti.nai.szAtsLen);
}
}
*/
tags = freefare_get_tags(pnd);
if (!tags) {
printf("no Mifare classic\n");
} else {
for (i = 0; (!error) && tags[i]; i++) {
if (freefare_get_tag_type(tags[i]) == CLASSIC_1K)
printf("%u : Mifare 1k (S50)\n",i);
if (freefare_get_tag_type(tags[i]) == CLASSIC_4K)
printf("%u : Mifare 4k (S70)\n",i);
}
if(mifare_classic_connect(tags[0])==0) {
printf("connected\n");
if(mifare_classic_authenticate(tags[0], 1,keys[0],MFC_KEY_B) == OPERATION_OK) {
printf("Authenticated !\n");
if(mifare_classic_read (tags[0], 1, &dablock) == OPERATION_OK) {
printf("Block readed\n");
for(j=0; j<16; j++) {
printf("%02X ", dablock[j]);
}
printf("\n");
} else {
printf("Auth error : %s\n", freefare_strerror(tags[0]));
}
if(mifare_classic_get_data_block_permission (tags[0], 1, MCAB_R, MFC_KEY_A))
printf("i can READ this block with B\n");
if(mifare_classic_get_data_block_permission (tags[0], 1, MCAB_W, MFC_KEY_A))
printf("i can WRITE this block with B\n");
if(mifare_classic_get_data_block_permission (tags[0], 1, MCAB_I, MFC_KEY_A))
printf("i can INC this block with B\n");
if(mifare_classic_get_data_block_permission (tags[0], 1, MCAB_D, MFC_KEY_A))
printf("i can DEC this block with B\n");
printf("---\n");
/* trailer = ((block) / 4) * 4 + 3; */
if(mifare_classic_get_trailer_block_permission (tags[0], 3, MCAB_READ_KEYA, MFC_KEY_A))
printf("i can READ KEY A in trailer\n");
if(mifare_classic_get_trailer_block_permission (tags[0], 3, MCAB_WRITE_KEYA, MFC_KEY_A))
printf("i can WRITE KEY A in trailer\n");
if(mifare_classic_get_trailer_block_permission (tags[0], 3, MCAB_READ_ACCESS_BITS, MFC_KEY_A))
printf("i can READ ACCESS BITS in trailer\n");
if(mifare_classic_get_trailer_block_permission (tags[0], 3, MCAB_WRITE_ACCESS_BITS, MFC_KEY_A))
printf("i can WRITE ACCESS BITS in trailer\n");
if(mifare_classic_get_trailer_block_permission (tags[0], 3, MCAB_READ_KEYB, MFC_KEY_A))
printf("i can READ KEYB in trailer\n");
if(mifare_classic_get_trailer_block_permission (tags[0], 3, MCAB_WRITE_KEYB, MFC_KEY_A))
printf("i can WRITE KEYB in trailer\n");
/*
if(mifare_classic_write (tags[0], 1, mydata) == 0) {
printf("write ok\n");
}
*/
if(mifare_classic_init_value (tags[0], 1, 0x42, 00) == 0) {
printf("init value bloc ok\n");
}
/* compose trailer block */
/* ab0 ab1 ab2 abt gpb */
/* abt = C_100 = 4 = 100 = c3c2c1 != datasheet c1c2c3*/
//mifare_classic_trailer_block (&my_trailer_block, my_key_A, C_000, C_011, C_000, C_100, 0x69, my_key_B);
mifare_classic_trailer_block (&my_trailer_block, my_key_A, C_000, C_000, C_000, C_100, 0x69, my_key_B);
for(j=0; j<16; j++) {
printf("%02X ", my_trailer_block[j]);
}
printf("\n");
if(mifare_classic_write (tags[0], 3, my_trailer_block) == 0) {
printf("trailer write ok\n");
}
/*
if(mifare_classic_decrement(tags[0], 1, 1) == OPERATION_OK) {
printf("decrement ok\n");
} else {
printf("Decrement error : %s\n", freefare_strerror(tags[0]));
}
if(mifare_classic_transfer (tags[0], 1) == OPERATION_OK) {
printf("transfer ok\n");
} else {
printf("Transfert error : %s\n", freefare_strerror(tags[0]));
}
if(mifare_classic_read(tags[0], 1, &dablock) == OPERATION_OK) {
printf("Block readed\n");
for(j=0; j<16; j++) {
printf("%02X ", dablock[j]);
}
printf("\n");
} else {
printf("Read error : %s\n", freefare_strerror(tags[0]));
}
*/
} else {
printf("Erreur : %s\n", freefare_strerror(tags[0]));
}
mifare_classic_disconnect(tags[0]);
}
}
/*
for(i=0; i<1; i++) {
for(j=0; j<8; j++) {
memcpy(mp.mpa.abtKey, &keys[j*6], 6);
res = nfc_initiator_mifare_cmd(pnd, MC_AUTH_B, 0, &mp);
if(res) {
printf("sector %u / key %u : yes\n", i, j);
continue;
} else {
printf("sector %u / key %u : no\n", i, j);
}
}
}
*/
/*
// mifare parameters
memcpy(mp.mpa.abtAuthUid,nt.nti.nai.abtUid,4);
memcpy(mp.mpa.abtKey, &keys[0*6], 6);
// block
res = nfc_initiator_mifare_cmd(pnd, MC_AUTH_A, 0, &mp);
if(res) {
printf("Auth success\n");
} else {
printf("Auth failed\n");
}
for(i=0; i<4; i++) {
res = nfc_initiator_mifare_cmd(pnd, MC_READ, i, &mp);
if(res) {
print_hex(mp.mpd.abtData,16);
} else {
printf("Read failed\n");
}
}
*/
// Close NFC device
nfc_close(pnd);
// Release the context
nfc_exit(context);
exit(EXIT_SUCCESS);
}
