Re-ident nfc-mfclassic.c using "indent -br -ce --line-length120 -nut -i2 -ppi 2 " command line.
This commit is contained in:
Romuald Conty
parent
8bac5355dd
commit
3c1a61349f
1 changed files with 285 additions and 310 deletions
|
|
@ -23,7 +23,7 @@
|
|||
*/
|
||||
|
||||
#ifdef HAVE_CONFIG_H
|
||||
#include "config.h"
|
||||
# include "config.h"
|
||||
#endif // HAVE_CONFIG_H
|
||||
|
||||
#include <stdio.h>
|
||||
|
|
@ -40,7 +40,7 @@
|
|||
#include "mifaretag.h"
|
||||
#include "nfc-utils.h"
|
||||
|
||||
static nfc_device_t* pnd;
|
||||
static nfc_device_t *pnd;
|
||||
static nfc_target_info_t nti;
|
||||
static mifare_param mp;
|
||||
static mifare_tag mtKeys;
|
||||
|
|
@ -49,37 +49,48 @@ static bool bUseKeyA;
|
|||
static bool bUseKeyFile;
|
||||
static uint8_t uiBlocks;
|
||||
static byte_t keys[] = {
|
||||
0xff,0xff,0xff,0xff,0xff,0xff,
|
||||
0xd3,0xf7,0xd3,0xf7,0xd3,0xf7,
|
||||
0xa0,0xa1,0xa2,0xa3,0xa4,0xa5,
|
||||
0xb0,0xb1,0xb2,0xb3,0xb4,0xb5,
|
||||
0x4d,0x3a,0x99,0xc3,0x51,0xdd,
|
||||
0x1a,0x98,0x2c,0x7e,0x45,0x9a,
|
||||
0xaa,0xbb,0xcc,0xdd,0xee,0xff,
|
||||
0x00,0x00,0x00,0x00,0x00,0x00
|
||||
0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||
0xd3, 0xf7, 0xd3, 0xf7, 0xd3, 0xf7,
|
||||
0xa0, 0xa1, 0xa2, 0xa3, 0xa4, 0xa5,
|
||||
0xb0, 0xb1, 0xb2, 0xb3, 0xb4, 0xb5,
|
||||
0x4d, 0x3a, 0x99, 0xc3, 0x51, 0xdd,
|
||||
0x1a, 0x98, 0x2c, 0x7e, 0x45, 0x9a,
|
||||
0xaa, 0xbb, 0xcc, 0xdd, 0xee, 0xff,
|
||||
0x00, 0x00, 0x00, 0x00, 0x00, 0x00
|
||||
};
|
||||
static size_t num_keys = sizeof(keys) / 6;
|
||||
|
||||
static void print_success_or_failure(bool bFailure, uint32_t* uiBlockCounter)
|
||||
static size_t num_keys = sizeof (keys) / 6;
|
||||
|
||||
static void
|
||||
print_success_or_failure (bool bFailure, uint32_t * uiBlockCounter)
|
||||
{
|
||||
printf("%c",(bFailure)?'x':'.');
|
||||
printf ("%c", (bFailure) ? 'x' : '.');
|
||||
if (uiBlockCounter)
|
||||
*uiBlockCounter += (bFailure)?0:4;
|
||||
*uiBlockCounter += (bFailure) ? 0 : 4;
|
||||
}
|
||||
|
||||
static bool is_first_block(uint32_t uiBlock)
|
||||
static bool
|
||||
is_first_block (uint32_t uiBlock)
|
||||
{
|
||||
// Test if we are in the small or big sectors
|
||||
if (uiBlock < 128) return ((uiBlock)%4 == 0); else return ((uiBlock)%16 == 0);
|
||||
if (uiBlock < 128)
|
||||
return ((uiBlock) % 4 == 0);
|
||||
else
|
||||
return ((uiBlock) % 16 == 0);
|
||||
}
|
||||
|
||||
static bool is_trailer_block(uint32_t uiBlock)
|
||||
static bool
|
||||
is_trailer_block (uint32_t uiBlock)
|
||||
{
|
||||
// Test if we are in the small or big sectors
|
||||
if (uiBlock < 128) return ((uiBlock+1)%4 == 0); else return ((uiBlock+1)%16 == 0);
|
||||
if (uiBlock < 128)
|
||||
return ((uiBlock + 1) % 4 == 0);
|
||||
else
|
||||
return ((uiBlock + 1) % 16 == 0);
|
||||
}
|
||||
|
||||
static uint32_t get_trailer_block(uint32_t uiFirstBlock)
|
||||
static uint32_t
|
||||
get_trailer_block (uint32_t uiFirstBlock)
|
||||
{
|
||||
// Test if we are in the small or big sectors
|
||||
uint32_t trailer_block = 0;
|
||||
|
|
@ -91,452 +102,416 @@ static uint32_t get_trailer_block(uint32_t uiFirstBlock)
|
|||
return trailer_block;
|
||||
}
|
||||
|
||||
static bool authenticate(uint32_t uiBlock)
|
||||
static bool
|
||||
authenticate (uint32_t uiBlock)
|
||||
{
|
||||
mifare_cmd mc;
|
||||
uint32_t uiTrailerBlock;
|
||||
size_t key_index;
|
||||
|
||||
|
||||
// Key file authentication.
|
||||
if (bUseKeyFile)
|
||||
{
|
||||
if (bUseKeyFile) {
|
||||
// Set the authentication information (uid)
|
||||
memcpy(mp.mpa.abtUid,nti.nai.abtUid,4);
|
||||
memcpy (mp.mpa.abtUid, nti.nai.abtUid, 4);
|
||||
|
||||
// Locate the trailer (with the keys) used for this sector
|
||||
uiTrailerBlock = get_trailer_block(uiBlock);
|
||||
|
||||
uiTrailerBlock = get_trailer_block (uiBlock);
|
||||
|
||||
// Determin if we should use the a or the b key
|
||||
if (bUseKeyA)
|
||||
{
|
||||
if (bUseKeyA) {
|
||||
mc = MC_AUTH_A;
|
||||
memcpy(mp.mpa.abtKey,mtKeys.amb[uiTrailerBlock].mbt.abtKeyA,6);
|
||||
memcpy (mp.mpa.abtKey, mtKeys.amb[uiTrailerBlock].mbt.abtKeyA, 6);
|
||||
} else {
|
||||
mc = MC_AUTH_B;
|
||||
memcpy(mp.mpa.abtKey,mtKeys.amb[uiTrailerBlock].mbt.abtKeyB,6);
|
||||
memcpy (mp.mpa.abtKey, mtKeys.amb[uiTrailerBlock].mbt.abtKeyB, 6);
|
||||
}
|
||||
|
||||
// Try to authenticate for the current sector
|
||||
if (nfc_initiator_mifare_cmd(pnd,mc,uiBlock,&mp))
|
||||
return true;
|
||||
if (nfc_initiator_mifare_cmd (pnd, mc, uiBlock, &mp))
|
||||
return true;
|
||||
}
|
||||
|
||||
// Auto authentication.
|
||||
else
|
||||
{
|
||||
else {
|
||||
// Determin if we should use the a or the b key
|
||||
mc = (bUseKeyA) ? MC_AUTH_A : MC_AUTH_B;
|
||||
|
||||
|
||||
// Set the authentication information (uid)
|
||||
memcpy(mp.mpa.abtUid,nti.nai.abtUid,4);
|
||||
|
||||
for (key_index = 0; key_index < num_keys; key_index++)
|
||||
{
|
||||
memcpy(mp.mpa.abtKey, keys + (key_index*6), 6);
|
||||
if (nfc_initiator_mifare_cmd(pnd, mc, uiBlock, &mp))
|
||||
{
|
||||
memcpy (mp.mpa.abtUid, nti.nai.abtUid, 4);
|
||||
|
||||
for (key_index = 0; key_index < num_keys; key_index++) {
|
||||
memcpy (mp.mpa.abtKey, keys + (key_index * 6), 6);
|
||||
if (nfc_initiator_mifare_cmd (pnd, mc, uiBlock, &mp)) {
|
||||
/**
|
||||
* @note: what about the other key?
|
||||
*/
|
||||
if (bUseKeyA)
|
||||
memcpy(mtKeys.amb[uiBlock].mbt.abtKeyA,&mp.mpa.abtKey,6);
|
||||
memcpy (mtKeys.amb[uiBlock].mbt.abtKeyA, &mp.mpa.abtKey, 6);
|
||||
else
|
||||
memcpy(mtKeys.amb[uiBlock].mbt.abtKeyB,&mp.mpa.abtKey,6);
|
||||
|
||||
memcpy (mtKeys.amb[uiBlock].mbt.abtKeyB, &mp.mpa.abtKey, 6);
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
nfc_initiator_select_tag(pnd, NM_ISO14443A_106, mp.mpa.abtUid, 4, NULL);
|
||||
|
||||
nfc_initiator_select_tag (pnd, NM_ISO14443A_106, mp.mpa.abtUid, 4, NULL);
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
static bool read_card(void)
|
||||
static bool
|
||||
read_card (void)
|
||||
{
|
||||
int32_t iBlock;
|
||||
bool bFailure = false;
|
||||
uint32_t uiReadBlocks = 0;
|
||||
|
||||
printf("Reading out %d blocks |",uiBlocks+1);
|
||||
printf ("Reading out %d blocks |", uiBlocks + 1);
|
||||
|
||||
// Read the card from end to begin
|
||||
for (iBlock=uiBlocks; iBlock>=0; iBlock--)
|
||||
{
|
||||
for (iBlock = uiBlocks; iBlock >= 0; iBlock--) {
|
||||
// Authenticate everytime we reach a trailer block
|
||||
if (is_trailer_block(iBlock))
|
||||
{
|
||||
if (is_trailer_block (iBlock)) {
|
||||
// Skip this the first time, bFailure it means nothing (yet)
|
||||
if (iBlock != uiBlocks)
|
||||
print_success_or_failure(bFailure, &uiReadBlocks);
|
||||
print_success_or_failure (bFailure, &uiReadBlocks);
|
||||
|
||||
// Show if the readout went well
|
||||
if (bFailure)
|
||||
{
|
||||
if (bFailure) {
|
||||
// When a failure occured we need to redo the anti-collision
|
||||
if (!nfc_initiator_select_tag(pnd,NM_ISO14443A_106,NULL,0,&nti))
|
||||
{
|
||||
printf("!\nError: tag was removed\n");
|
||||
if (!nfc_initiator_select_tag (pnd, NM_ISO14443A_106, NULL, 0, &nti)) {
|
||||
printf ("!\nError: tag was removed\n");
|
||||
return false;
|
||||
}
|
||||
bFailure = false;
|
||||
}
|
||||
|
||||
fflush(stdout);
|
||||
|
||||
fflush (stdout);
|
||||
|
||||
// Try to authenticate for the current sector
|
||||
if (!authenticate(iBlock))
|
||||
{
|
||||
printf("!\nError: authentication failed for block %02x\n",iBlock);
|
||||
if (!authenticate (iBlock)) {
|
||||
printf ("!\nError: authentication failed for block %02x\n", iBlock);
|
||||
return false;
|
||||
}
|
||||
|
||||
// Try to read out the trailer
|
||||
if (nfc_initiator_mifare_cmd(pnd,MC_READ,iBlock,&mp))
|
||||
{
|
||||
if (nfc_initiator_mifare_cmd (pnd, MC_READ, iBlock, &mp)) {
|
||||
// Copy the keys over from our key dump and store the retrieved access bits
|
||||
memcpy(mtDump.amb[iBlock].mbt.abtKeyA,mtKeys.amb[iBlock].mbt.abtKeyA,6);
|
||||
memcpy(mtDump.amb[iBlock].mbt.abtAccessBits,mp.mpd.abtData+6,4);
|
||||
memcpy(mtDump.amb[iBlock].mbt.abtKeyB,mtKeys.amb[iBlock].mbt.abtKeyB,6);
|
||||
memcpy (mtDump.amb[iBlock].mbt.abtKeyA, mtKeys.amb[iBlock].mbt.abtKeyA, 6);
|
||||
memcpy (mtDump.amb[iBlock].mbt.abtAccessBits, mp.mpd.abtData + 6, 4);
|
||||
memcpy (mtDump.amb[iBlock].mbt.abtKeyB, mtKeys.amb[iBlock].mbt.abtKeyB, 6);
|
||||
}
|
||||
} else {
|
||||
// Make sure a earlier readout did not fail
|
||||
if (!bFailure)
|
||||
{
|
||||
if (!bFailure) {
|
||||
// Try to read out the data block
|
||||
if (nfc_initiator_mifare_cmd(pnd,MC_READ,iBlock,&mp))
|
||||
{
|
||||
memcpy(mtDump.amb[iBlock].mbd.abtData,mp.mpd.abtData,16);
|
||||
if (nfc_initiator_mifare_cmd (pnd, MC_READ, iBlock, &mp)) {
|
||||
memcpy (mtDump.amb[iBlock].mbd.abtData, mp.mpd.abtData, 16);
|
||||
} else {
|
||||
bFailure = true;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
print_success_or_failure(bFailure, &uiReadBlocks);
|
||||
printf("|\n");
|
||||
printf("Done, %d of %d blocks read.\n", uiReadBlocks, uiBlocks+1);
|
||||
fflush(stdout);
|
||||
print_success_or_failure (bFailure, &uiReadBlocks);
|
||||
printf ("|\n");
|
||||
printf ("Done, %d of %d blocks read.\n", uiReadBlocks, uiBlocks + 1);
|
||||
fflush (stdout);
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
static bool write_card(void)
|
||||
static bool
|
||||
write_card (void)
|
||||
{
|
||||
uint32_t uiBlock;
|
||||
bool bFailure = false;
|
||||
uint32_t uiWriteBlocks = 0;
|
||||
|
||||
printf("Writing %d blocks |",uiBlocks+1);
|
||||
printf ("Writing %d blocks |", uiBlocks + 1);
|
||||
|
||||
// Write the card from begin to end;
|
||||
for (uiBlock=0; uiBlock<=uiBlocks; uiBlock++)
|
||||
{
|
||||
for (uiBlock = 0; uiBlock <= uiBlocks; uiBlock++) {
|
||||
// Authenticate everytime we reach the first sector of a new block
|
||||
if (is_first_block(uiBlock))
|
||||
{
|
||||
if (is_first_block (uiBlock)) {
|
||||
// Skip this the first time, bFailure it means nothing (yet)
|
||||
if (uiBlock != 0)
|
||||
print_success_or_failure(bFailure, &uiWriteBlocks);
|
||||
print_success_or_failure (bFailure, &uiWriteBlocks);
|
||||
|
||||
// Show if the readout went well
|
||||
if (bFailure)
|
||||
{
|
||||
if (bFailure) {
|
||||
// When a failure occured we need to redo the anti-collision
|
||||
if (!nfc_initiator_select_tag(pnd,NM_ISO14443A_106,NULL,0,&nti))
|
||||
{
|
||||
printf("!\nError: tag was removed\n");
|
||||
if (!nfc_initiator_select_tag (pnd, NM_ISO14443A_106, NULL, 0, &nti)) {
|
||||
printf ("!\nError: tag was removed\n");
|
||||
return false;
|
||||
}
|
||||
bFailure = false;
|
||||
}
|
||||
|
||||
fflush(stdout);
|
||||
fflush (stdout);
|
||||
|
||||
// Try to authenticate for the current sector
|
||||
if (!authenticate(uiBlock))
|
||||
{
|
||||
printf("!\nError: authentication failed for block %02x\n",uiBlock);
|
||||
if (!authenticate (uiBlock)) {
|
||||
printf ("!\nError: authentication failed for block %02x\n", uiBlock);
|
||||
return false;
|
||||
}
|
||||
}
|
||||
|
||||
if (is_trailer_block(uiBlock))
|
||||
{
|
||||
if (is_trailer_block (uiBlock)) {
|
||||
// Copy the keys over from our key dump and store the retrieved access bits
|
||||
memcpy(mp.mpd.abtData,mtDump.amb[uiBlock].mbt.abtKeyA,6);
|
||||
memcpy(mp.mpd.abtData+6,mtDump.amb[uiBlock].mbt.abtAccessBits,4);
|
||||
memcpy(mp.mpd.abtData+10,mtDump.amb[uiBlock].mbt.abtKeyB,6);
|
||||
memcpy (mp.mpd.abtData, mtDump.amb[uiBlock].mbt.abtKeyA, 6);
|
||||
memcpy (mp.mpd.abtData + 6, mtDump.amb[uiBlock].mbt.abtAccessBits, 4);
|
||||
memcpy (mp.mpd.abtData + 10, mtDump.amb[uiBlock].mbt.abtKeyB, 6);
|
||||
|
||||
// Try to write the trailer
|
||||
if (nfc_initiator_mifare_cmd(pnd,MC_WRITE,uiBlock,&mp) == false) {
|
||||
printf("failed to write trailer block %d \n", uiBlock);
|
||||
if (nfc_initiator_mifare_cmd (pnd, MC_WRITE, uiBlock, &mp) == false) {
|
||||
printf ("failed to write trailer block %d \n", uiBlock);
|
||||
bFailure = true;
|
||||
}
|
||||
} else {
|
||||
|
||||
// The first block 0x00 is read only, skip this
|
||||
if (uiBlock == 0) continue;
|
||||
if (uiBlock == 0)
|
||||
continue;
|
||||
|
||||
// Make sure a earlier write did not fail
|
||||
if (!bFailure)
|
||||
{
|
||||
if (!bFailure) {
|
||||
// Try to write the data block
|
||||
memcpy(mp.mpd.abtData,mtDump.amb[uiBlock].mbd.abtData,16);
|
||||
if (!nfc_initiator_mifare_cmd(pnd,MC_WRITE,uiBlock,&mp)) bFailure = true;
|
||||
memcpy (mp.mpd.abtData, mtDump.amb[uiBlock].mbd.abtData, 16);
|
||||
if (!nfc_initiator_mifare_cmd (pnd, MC_WRITE, uiBlock, &mp))
|
||||
bFailure = true;
|
||||
}
|
||||
}
|
||||
}
|
||||
print_success_or_failure(bFailure, &uiWriteBlocks);
|
||||
printf("|\n");
|
||||
printf("Done, %d of %d blocks written.\n", uiWriteBlocks, uiBlocks+1);
|
||||
fflush(stdout);
|
||||
print_success_or_failure (bFailure, &uiWriteBlocks);
|
||||
printf ("|\n");
|
||||
printf ("Done, %d of %d blocks written.\n", uiWriteBlocks, uiBlocks + 1);
|
||||
fflush (stdout);
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
static void mifare_classic_extract_payload(const char* abDump, char* pbPayload)
|
||||
static void
|
||||
mifare_classic_extract_payload (const char *abDump, char *pbPayload)
|
||||
{
|
||||
uint8_t uiSectorIndex;
|
||||
uint8_t uiBlockIndex;
|
||||
size_t szDumpOffset;
|
||||
size_t szPayloadIndex = 0;
|
||||
|
||||
for(uiSectorIndex=1; uiSectorIndex<16; uiSectorIndex++) {
|
||||
for(uiBlockIndex=0; uiBlockIndex<3; uiBlockIndex++) {
|
||||
szDumpOffset = uiSectorIndex*16*4 + uiBlockIndex*16;
|
||||
for (uiSectorIndex = 1; uiSectorIndex < 16; uiSectorIndex++) {
|
||||
for (uiBlockIndex = 0; uiBlockIndex < 3; uiBlockIndex++) {
|
||||
szDumpOffset = uiSectorIndex * 16 * 4 + uiBlockIndex * 16;
|
||||
// for(uint8_t uiByteIndex=0; uiByteIndex<16; uiByteIndex++) printf("%02x ", abDump[szPayloadIndex+uiByteIndex]);
|
||||
memcpy(pbPayload+szPayloadIndex, abDump+szDumpOffset, 16);
|
||||
memcpy (pbPayload + szPayloadIndex, abDump + szDumpOffset, 16);
|
||||
szPayloadIndex += 16;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
typedef enum {
|
||||
typedef enum
|
||||
{
|
||||
ACTION_READ,
|
||||
ACTION_WRITE,
|
||||
ACTION_EXTRACT,
|
||||
ACTION_USAGE
|
||||
} action_t;
|
||||
|
||||
static void print_usage(const char* pcProgramName)
|
||||
static void
|
||||
print_usage (const char *pcProgramName)
|
||||
{
|
||||
printf("Usage: ");
|
||||
printf("%s r|w a|b <dump.mfd> [<keys.mfd>]\n", pcProgramName);
|
||||
printf(" r|w - Perform read from (r) or write to (w) card\n");
|
||||
printf(" a|b - Use A or B keys for action\n");
|
||||
printf(" <dump.mfd> - MiFare Dump (MFD) used to write (card to MFD) or (MFD to card)\n");
|
||||
printf(" <keys.mfd> - MiFare Dump (MFD) that contain the keys (optional)\n");
|
||||
printf("Or: ");
|
||||
printf("%s x <dump.mfd> <payload.bin>\n", pcProgramName);
|
||||
printf(" x - Extract payload (data blocks) from MFD\n");
|
||||
printf(" <dump.mfd> - MiFare Dump (MFD) that contains wanted payload\n");
|
||||
printf(" <payload.bin> - Binary file where payload will be extracted\n");
|
||||
printf ("Usage: ");
|
||||
printf ("%s r|w a|b <dump.mfd> [<keys.mfd>]\n", pcProgramName);
|
||||
printf (" r|w - Perform read from (r) or write to (w) card\n");
|
||||
printf (" a|b - Use A or B keys for action\n");
|
||||
printf (" <dump.mfd> - MiFare Dump (MFD) used to write (card to MFD) or (MFD to card)\n");
|
||||
printf (" <keys.mfd> - MiFare Dump (MFD) that contain the keys (optional)\n");
|
||||
printf ("Or: ");
|
||||
printf ("%s x <dump.mfd> <payload.bin>\n", pcProgramName);
|
||||
printf (" x - Extract payload (data blocks) from MFD\n");
|
||||
printf (" <dump.mfd> - MiFare Dump (MFD) that contains wanted payload\n");
|
||||
printf (" <payload.bin> - Binary file where payload will be extracted\n");
|
||||
}
|
||||
|
||||
int main(int argc, const char* argv[])
|
||||
int
|
||||
main (int argc, const char *argv[])
|
||||
{
|
||||
bool b4K;
|
||||
action_t atAction = ACTION_USAGE;
|
||||
byte_t* pbtUID;
|
||||
FILE* pfKeys = NULL;
|
||||
FILE* pfDump = NULL;
|
||||
const char* command = argv[1];
|
||||
byte_t *pbtUID;
|
||||
FILE *pfKeys = NULL;
|
||||
FILE *pfDump = NULL;
|
||||
const char *command = argv[1];
|
||||
|
||||
if(argc < 2)
|
||||
{
|
||||
print_usage(argv[0]);
|
||||
exit(EXIT_FAILURE);
|
||||
if (argc < 2) {
|
||||
print_usage (argv[0]);
|
||||
exit (EXIT_FAILURE);
|
||||
}
|
||||
|
||||
if(strcmp(command, "r") == 0)
|
||||
{
|
||||
if (strcmp (command, "r") == 0) {
|
||||
atAction = ACTION_READ;
|
||||
bUseKeyA = tolower((int)((unsigned char)*(argv[2]))) == 'a';
|
||||
bUseKeyA = tolower ((int) ((unsigned char) *(argv[2]))) == 'a';
|
||||
bUseKeyFile = (argc > 4);
|
||||
} else if(strcmp(command, "w") == 0)
|
||||
{
|
||||
} else if (strcmp (command, "w") == 0) {
|
||||
atAction = ACTION_WRITE;
|
||||
bUseKeyA = tolower((int)((unsigned char)*(argv[2]))) == 'a';
|
||||
bUseKeyA = tolower ((int) ((unsigned char) *(argv[2]))) == 'a';
|
||||
bUseKeyFile = (argc > 4);
|
||||
} else if(strcmp(command, "x") == 0)
|
||||
{
|
||||
} else if (strcmp (command, "x") == 0) {
|
||||
atAction = ACTION_EXTRACT;
|
||||
}
|
||||
|
||||
switch(atAction) {
|
||||
case ACTION_USAGE:
|
||||
print_usage(argv[0]);
|
||||
exit(EXIT_FAILURE);
|
||||
break;
|
||||
case ACTION_READ:
|
||||
case ACTION_WRITE:
|
||||
if (argc < 4)
|
||||
{
|
||||
print_usage(argv[0]);
|
||||
exit(EXIT_FAILURE);
|
||||
switch (atAction) {
|
||||
case ACTION_USAGE:
|
||||
print_usage (argv[0]);
|
||||
exit (EXIT_FAILURE);
|
||||
break;
|
||||
case ACTION_READ:
|
||||
case ACTION_WRITE:
|
||||
if (argc < 4) {
|
||||
print_usage (argv[0]);
|
||||
exit (EXIT_FAILURE);
|
||||
}
|
||||
|
||||
if (bUseKeyFile) {
|
||||
pfKeys = fopen (argv[4], "rb");
|
||||
if (pfKeys == NULL) {
|
||||
printf ("Could not open keys file: %s\n", argv[4]);
|
||||
exit (EXIT_FAILURE);
|
||||
}
|
||||
if (fread (&mtKeys, 1, sizeof (mtKeys), pfKeys) != sizeof (mtKeys)) {
|
||||
printf ("Could not read keys file: %s\n", argv[4]);
|
||||
fclose (pfKeys);
|
||||
exit (EXIT_FAILURE);
|
||||
}
|
||||
fclose (pfKeys);
|
||||
}
|
||||
|
||||
if (atAction == ACTION_READ) {
|
||||
memset (&mtDump, 0x00, sizeof (mtDump));
|
||||
} else {
|
||||
pfDump = fopen (argv[3], "rb");
|
||||
|
||||
if (pfDump == NULL) {
|
||||
printf ("Could not open dump file: %s\n", argv[3]);
|
||||
exit (EXIT_FAILURE);
|
||||
}
|
||||
|
||||
if (bUseKeyFile)
|
||||
{
|
||||
pfKeys = fopen(argv[4],"rb");
|
||||
if (pfKeys == NULL)
|
||||
{
|
||||
printf("Could not open keys file: %s\n",argv[4]);
|
||||
exit(EXIT_FAILURE);
|
||||
}
|
||||
if (fread(&mtKeys,1,sizeof(mtKeys),pfKeys) != sizeof(mtKeys))
|
||||
{
|
||||
printf("Could not read keys file: %s\n",argv[4]);
|
||||
fclose(pfKeys);
|
||||
exit(EXIT_FAILURE);
|
||||
}
|
||||
fclose(pfKeys);
|
||||
if (fread (&mtDump, 1, sizeof (mtDump), pfDump) != sizeof (mtDump)) {
|
||||
printf ("Could not read dump file: %s\n", argv[3]);
|
||||
fclose (pfDump);
|
||||
exit (EXIT_FAILURE);
|
||||
}
|
||||
|
||||
if(atAction == ACTION_READ) {
|
||||
memset(&mtDump,0x00,sizeof(mtDump));
|
||||
} else {
|
||||
pfDump = fopen(argv[3],"rb");
|
||||
|
||||
if (pfDump == NULL)
|
||||
{
|
||||
printf("Could not open dump file: %s\n",argv[3]);
|
||||
exit(EXIT_FAILURE);
|
||||
}
|
||||
|
||||
if (fread(&mtDump,1,sizeof(mtDump),pfDump) != sizeof(mtDump))
|
||||
{
|
||||
printf("Could not read dump file: %s\n",argv[3]);
|
||||
fclose(pfDump);
|
||||
exit(EXIT_FAILURE);
|
||||
}
|
||||
fclose(pfDump);
|
||||
}
|
||||
// printf("Successfully opened required files\n");
|
||||
|
||||
// Try to open the NFC reader
|
||||
pnd = nfc_connect(NULL);
|
||||
if (pnd == NULL)
|
||||
{
|
||||
printf("Error connecting NFC reader\n");
|
||||
exit(EXIT_FAILURE);
|
||||
}
|
||||
|
||||
nfc_initiator_init(pnd);
|
||||
|
||||
// Drop the field for a while
|
||||
nfc_configure(pnd,NDO_ACTIVATE_FIELD,false);
|
||||
|
||||
// Let the reader only try once to find a tag
|
||||
nfc_configure(pnd,NDO_INFINITE_SELECT,false);
|
||||
nfc_configure(pnd,NDO_HANDLE_CRC,true);
|
||||
nfc_configure(pnd,NDO_HANDLE_PARITY,true);
|
||||
|
||||
// Enable field so more power consuming cards can power themselves up
|
||||
nfc_configure(pnd,NDO_ACTIVATE_FIELD,true);
|
||||
|
||||
printf("Connected to NFC reader: %s\n",pnd->acName);
|
||||
|
||||
// Try to find a MIFARE Classic tag
|
||||
if (!nfc_initiator_select_tag(pnd,NM_ISO14443A_106,NULL,0,&nti))
|
||||
{
|
||||
printf("Error: no tag was found\n");
|
||||
nfc_disconnect(pnd);
|
||||
exit(EXIT_FAILURE);
|
||||
}
|
||||
|
||||
// Test if we are dealing with a MIFARE compatible tag
|
||||
if ((nti.nai.btSak & 0x08) == 0)
|
||||
{
|
||||
printf("Error: tag is not a MIFARE Classic card\n");
|
||||
nfc_disconnect(pnd);
|
||||
exit(EXIT_FAILURE);
|
||||
}
|
||||
|
||||
if (bUseKeyFile)
|
||||
{
|
||||
// Get the info from the key dump
|
||||
b4K = (mtKeys.amb[0].mbm.abtATQA[1] == 0x02);
|
||||
pbtUID = mtKeys.amb[0].mbm.abtUID;
|
||||
|
||||
// Compare if key dump UID is the same as the current tag UID
|
||||
if (memcmp(nti.nai.abtUid,pbtUID,4) != 0)
|
||||
{
|
||||
printf("Expected MIFARE Classic %cK card with UID: %02x%02x%02x%02x\n",b4K?'4':'1', pbtUID[3], pbtUID[2], pbtUID[1], pbtUID[0]);
|
||||
}
|
||||
}
|
||||
|
||||
// Get the info from the current tag
|
||||
pbtUID = nti.nai.abtUid;
|
||||
b4K = (nti.nai.abtAtqa[1] == 0x02);
|
||||
printf("Found MIFARE Classic %cK card with UID: %02x%02x%02x%02x\n",b4K?'4':'1', pbtUID[3], pbtUID[2], pbtUID[1], pbtUID[0]);
|
||||
|
||||
uiBlocks = (b4K)?0xff:0x3f;
|
||||
|
||||
if (atAction == ACTION_READ)
|
||||
{
|
||||
if (read_card())
|
||||
{
|
||||
printf("Writing data to file: %s ... ",argv[3]);
|
||||
fflush(stdout);
|
||||
pfDump = fopen(argv[3],"wb");
|
||||
if (fwrite(&mtDump,1,sizeof(mtDump),pfDump) != sizeof(mtDump))
|
||||
{
|
||||
printf("\nCould not write to file: %s\n",argv[3]);
|
||||
exit(EXIT_FAILURE);
|
||||
}
|
||||
printf("Done.\n");
|
||||
fclose(pfDump);
|
||||
}
|
||||
} else {
|
||||
write_card();
|
||||
}
|
||||
|
||||
nfc_disconnect(pnd);
|
||||
break;
|
||||
fclose (pfDump);
|
||||
}
|
||||
// printf("Successfully opened required files\n");
|
||||
|
||||
case ACTION_EXTRACT: {
|
||||
const char* pcDump = argv[2];
|
||||
const char* pcPayload = argv[3];
|
||||
// Try to open the NFC reader
|
||||
pnd = nfc_connect (NULL);
|
||||
if (pnd == NULL) {
|
||||
printf ("Error connecting NFC reader\n");
|
||||
exit (EXIT_FAILURE);
|
||||
}
|
||||
|
||||
nfc_initiator_init (pnd);
|
||||
|
||||
// Drop the field for a while
|
||||
nfc_configure (pnd, NDO_ACTIVATE_FIELD, false);
|
||||
|
||||
// Let the reader only try once to find a tag
|
||||
nfc_configure (pnd, NDO_INFINITE_SELECT, false);
|
||||
nfc_configure (pnd, NDO_HANDLE_CRC, true);
|
||||
nfc_configure (pnd, NDO_HANDLE_PARITY, true);
|
||||
|
||||
// Enable field so more power consuming cards can power themselves up
|
||||
nfc_configure (pnd, NDO_ACTIVATE_FIELD, true);
|
||||
|
||||
printf ("Connected to NFC reader: %s\n", pnd->acName);
|
||||
|
||||
// Try to find a MIFARE Classic tag
|
||||
if (!nfc_initiator_select_tag (pnd, NM_ISO14443A_106, NULL, 0, &nti)) {
|
||||
printf ("Error: no tag was found\n");
|
||||
nfc_disconnect (pnd);
|
||||
exit (EXIT_FAILURE);
|
||||
}
|
||||
// Test if we are dealing with a MIFARE compatible tag
|
||||
if ((nti.nai.btSak & 0x08) == 0) {
|
||||
printf ("Error: tag is not a MIFARE Classic card\n");
|
||||
nfc_disconnect (pnd);
|
||||
exit (EXIT_FAILURE);
|
||||
}
|
||||
|
||||
if (bUseKeyFile) {
|
||||
// Get the info from the key dump
|
||||
b4K = (mtKeys.amb[0].mbm.abtATQA[1] == 0x02);
|
||||
pbtUID = mtKeys.amb[0].mbm.abtUID;
|
||||
|
||||
// Compare if key dump UID is the same as the current tag UID
|
||||
if (memcmp (nti.nai.abtUid, pbtUID, 4) != 0) {
|
||||
printf ("Expected MIFARE Classic %cK card with UID: %02x%02x%02x%02x\n", b4K ? '4' : '1', pbtUID[3], pbtUID[2],
|
||||
pbtUID[1], pbtUID[0]);
|
||||
}
|
||||
}
|
||||
// Get the info from the current tag
|
||||
pbtUID = nti.nai.abtUid;
|
||||
b4K = (nti.nai.abtAtqa[1] == 0x02);
|
||||
printf ("Found MIFARE Classic %cK card with UID: %02x%02x%02x%02x\n", b4K ? '4' : '1', pbtUID[3], pbtUID[2],
|
||||
pbtUID[1], pbtUID[0]);
|
||||
|
||||
uiBlocks = (b4K) ? 0xff : 0x3f;
|
||||
|
||||
if (atAction == ACTION_READ) {
|
||||
if (read_card ()) {
|
||||
printf ("Writing data to file: %s ... ", argv[3]);
|
||||
fflush (stdout);
|
||||
pfDump = fopen (argv[3], "wb");
|
||||
if (fwrite (&mtDump, 1, sizeof (mtDump), pfDump) != sizeof (mtDump)) {
|
||||
printf ("\nCould not write to file: %s\n", argv[3]);
|
||||
exit (EXIT_FAILURE);
|
||||
}
|
||||
printf ("Done.\n");
|
||||
fclose (pfDump);
|
||||
}
|
||||
} else {
|
||||
write_card ();
|
||||
}
|
||||
|
||||
nfc_disconnect (pnd);
|
||||
break;
|
||||
|
||||
case ACTION_EXTRACT:{
|
||||
const char *pcDump = argv[2];
|
||||
const char *pcPayload = argv[3];
|
||||
|
||||
FILE *pfDump = NULL;
|
||||
FILE *pfPayload = NULL;
|
||||
|
||||
FILE* pfDump = NULL;
|
||||
FILE* pfPayload = NULL;
|
||||
|
||||
char abDump[4096];
|
||||
char abPayload[4096];
|
||||
|
||||
pfDump = fopen(pcDump,"rb");
|
||||
|
||||
if (pfDump == NULL)
|
||||
{
|
||||
printf("Could not open dump file: %s\n",pcDump);
|
||||
exit(EXIT_FAILURE);
|
||||
}
|
||||
|
||||
if (fread(abDump,1,sizeof(abDump),pfDump) != sizeof(abDump))
|
||||
{
|
||||
printf("Could not read dump file: %s\n",pcDump);
|
||||
fclose(pfDump);
|
||||
exit(EXIT_FAILURE);
|
||||
}
|
||||
fclose(pfDump);
|
||||
pfDump = fopen (pcDump, "rb");
|
||||
|
||||
mifare_classic_extract_payload(abDump, abPayload);
|
||||
|
||||
printf("Writing data to file: %s\n",pcPayload);
|
||||
pfPayload = fopen(pcPayload,"wb");
|
||||
if (fwrite(abPayload,1,sizeof(abPayload),pfPayload) != sizeof(abPayload))
|
||||
{
|
||||
printf("Could not write to file: %s\n",pcPayload);
|
||||
exit(EXIT_FAILURE);
|
||||
if (pfDump == NULL) {
|
||||
printf ("Could not open dump file: %s\n", pcDump);
|
||||
exit (EXIT_FAILURE);
|
||||
}
|
||||
fclose(pfPayload);
|
||||
printf("Done, all bytes have been extracted!\n");
|
||||
|
||||
if (fread (abDump, 1, sizeof (abDump), pfDump) != sizeof (abDump)) {
|
||||
printf ("Could not read dump file: %s\n", pcDump);
|
||||
fclose (pfDump);
|
||||
exit (EXIT_FAILURE);
|
||||
}
|
||||
fclose (pfDump);
|
||||
|
||||
mifare_classic_extract_payload (abDump, abPayload);
|
||||
|
||||
printf ("Writing data to file: %s\n", pcPayload);
|
||||
pfPayload = fopen (pcPayload, "wb");
|
||||
if (fwrite (abPayload, 1, sizeof (abPayload), pfPayload) != sizeof (abPayload)) {
|
||||
printf ("Could not write to file: %s\n", pcPayload);
|
||||
exit (EXIT_FAILURE);
|
||||
}
|
||||
fclose (pfPayload);
|
||||
printf ("Done, all bytes have been extracted!\n");
|
||||
}
|
||||
};
|
||||
|
||||
exit(EXIT_SUCCESS);
|
||||
exit (EXIT_SUCCESS);
|
||||
}
|
||||
|
||||
|
|
|
|||
Loading…
Reference in a new issue