Add support for MFP 2k

2026-05-12 11:20:09 -07:00 · 2017-01-27 02:57:03 -06:00
parent 6100b28875
commit bfc405e718
2 changed files with 154 additions and 0 deletions
@@ -0,0 +1,153 @@
+diff --git a/src/mfoc.c b/src/mfoc.c
+index 469b138..ba11ce9 100644
+--- a/src/mfoc.c
+++ b/src/mfoc.c
+@@ -56,6 +56,13 @@
+ #include "slre.h"
+ #include "slre.c"
+ 
+#define MAX_FRAME_LEN 264
+
+static const nfc_modulation nm = {
+.nmt = NMT_ISO14443A,
+.nbr = NBR_106,
+};
+
+ nfc_context *context;
+ 
+ uint64_t knownKey = 0;
+@@ -99,13 +106,8 @@ int32_t dist_nt(uint32_t nt1, uint32_t nt2) {
+         return(-99999);
+ }
+ 
+-
+ int main(int argc, char *const argv[])
+ {
+-  const nfc_modulation nm = {
+-    .nmt = NMT_ISO14443A,
+-    .nbr = NBR_106,
+-  };
+ 
+   int ch, i, k, n, j, m;
+   int key, block;
+@@ -321,9 +323,15 @@ int main(int argc, char *const argv[])
+     case 0x01:
+     case 0x08:
+     case 0x88:
+-      printf("Found Mifare Classic 1k tag\n");
+-      t.num_sectors = NR_TRAILERS_1k;
+-      t.num_blocks = NR_BLOCKS_1k;
+      if (get_rats_is_2k(t, r)) {
+          printf("Found Mifare Plus 2k tag\n");
+          t.num_sectors = NR_TRAILERS_2k;
+          t.num_blocks = NR_BLOCKS_2k;
+      } else {
+        printf("Found Mifare Classic 1k tag\n");
+        t.num_sectors = NR_TRAILERS_1k;
+        t.num_blocks = NR_BLOCKS_1k;
+      }
+       break;
+     case 0x09:
+       printf("Found Mifare Classic Mini tag\n");
+@@ -858,11 +866,6 @@ void mf_configure(nfc_device *pdi)
+ 
+ void mf_select_tag(nfc_device *pdi, nfc_target *pnt)
+ {
+-  // Poll for a ISO14443A (MIFARE) tag
+-  const nfc_modulation nm = {
+-    .nmt = NMT_ISO14443A,
+-    .nbr = NBR_106,
+-  };
+   if (nfc_initiator_select_passive_target(pdi, nm, NULL, 0, pnt) < 0) {
+     ERR("Unable to connect to the MIFARE Classic tag");
+     nfc_close(pdi);
+@@ -905,10 +908,6 @@ int find_exploit_sector(mftag t)
+ 
+ void mf_anticollision(mftag t, mfreader r)
+ {
+-  const nfc_modulation nm = {
+-    .nmt = NMT_ISO14443A,
+-    .nbr = NBR_106,
+-  };
+   if (nfc_initiator_select_passive_target(r.pdi, nm, NULL, 0, &t.nt) < 0) {
+     nfc_perror(r.pdi, "nfc_initiator_select_passive_target");
+     ERR("Tag has been removed");
+@@ -916,6 +915,48 @@ void mf_anticollision(mftag t, mfreader r)
+   }
+ }
+ 
+
+bool
+get_rats_is_2k(mftag t, mfreader r)
+{
+  int res;
+  uint8_t abtRx[MAX_FRAME_LEN];
+  int szRxBits;
+  uint8_t  abtRats[2] = { 0xe0, 0x50};
+  // Use raw send/receive methods
+  if (nfc_device_set_property_bool(r.pdi, NP_EASY_FRAMING, false) < 0) {
+    nfc_perror(r.pdi, "nfc_configure");
+    return false;
+  }
+  res = nfc_initiator_transceive_bytes(r.pdi, abtRats, sizeof(abtRats), abtRx, sizeof(abtRx), 0);
+  if (res > 0) {
+    // ISO14443-4 card, turn RF field off/on to access ISO14443-3 again
+    if (nfc_device_set_property_bool(r.pdi, NP_ACTIVATE_FIELD, false) < 0) {
+      nfc_perror(r.pdi, "nfc_configure");
+      return false;
+    }
+    if (nfc_device_set_property_bool(r.pdi, NP_ACTIVATE_FIELD, true) < 0) {
+      nfc_perror(r.pdi, "nfc_configure");
+      return false;
+    }
+  }
+  // Reselect tag
+  if (nfc_initiator_select_passive_target(r.pdi, nm, NULL, 0, &t.nt) <= 0) {
+    printf("Error: tag disappeared\n");
+    nfc_close(r.pdi);
+    nfc_exit(context);
+    exit(EXIT_FAILURE);
+  }
+  if (res >= 10) {
+    printf("ATS %02X%02X%02X%02X%02X|%02X%02X%02X%02X\n", res, abtRx[0], abtRx[1], abtRx[2], abtRx[3], abtRx[4], abtRx[5], abtRx[6], abtRx[7], abtRx[8]);
+    return ((abtRx[5] == 0xc1) && (abtRx[6] == 0x05)
+            && (abtRx[7] == 0x2f) && (abtRx[8] == 0x2f)
+            && ((t.nt.nti.nai.abtAtqa[1] & 0x02) == 0x00));
+  } else {
+    return false;
+  }
+}
+
+ int mf_enhanced_auth(int e_sector, int a_sector, mftag t, mfreader r, denonce *d, pKeys *pk, char mode, bool dumpKeysA)
+ {
+   struct Crypto1State *pcs;
+diff --git a/src/mfoc.h b/src/mfoc.h
+index 532e834..9ea7547 100644
+--- a/src/mfoc.h
+++ b/src/mfoc.h
+@@ -8,6 +8,8 @@
+ #define NR_TRAILERS_MINI (5)
+ // Mifare Classic 4k 32x64b + 8*256b = 40
+ #define NR_TRAILERS_4k  (40)
+// Mifare Classic 2k 32x64b
+#define NR_TRAILERS_2k  (32)
+ 
+ // Number of blocks
+ // Mifare Classic 1k
+@@ -16,6 +18,8 @@
+ #define NR_BLOCKS_MINI 0x13
+ // Mifare Classic 4k
+ #define NR_BLOCKS_4k 0xff
+// Mifare Classic 2k
+#define NR_BLOCKS_2k 0x7f
+ 
+ #define MAX_FRAME_LEN 264
+ 
+@@ -85,6 +89,7 @@ void mf_select_tag(nfc_device *pdi, nfc_target *pnt);
+ int trailer_block(uint32_t block);
+ int find_exploit_sector(mftag t);
+ void mf_anticollision(mftag t, mfreader r);
+bool get_rats_is_2k(mftag t, mfreader r);
+ int mf_enhanced_auth(int e_sector, int a_sector, mftag t, mfreader r, denonce *d, pKeys *pk, char mode, bool dumpKeysA);
+ uint32_t median(denonce d);
+ int compar_int(const void *a, const void *b);
@@ -15,6 +15,7 @@ git clean -dfx
 patch -p1 < ../mfoc_test_prng.diff
 patch -p1 < ../mfoc_fix_4k_and_mini.diff
 patch -p1 < ../mfoc_support_tnp.diff
+patch -p1 < ../mfoc_support_2k.diff
 autoreconf -vfi
 ./configure
 make