+ qsort(state_s, i, sizeof(*state_s), compar_state);
+ *(state_s + i) = -1;
+
+ //Create the intersection:
+ if (par_info == 0 )
+ if ( last_keylist != NULL)
+ {
+ int64_t *p1, *p2, *p3;
+ p1 = p3 = last_keylist;
+ p2 = state_s;
+ while ( *p1 != -1 && *p2 != -1 ) {
+ if (compar_state(p1, p2) == 0) {
+ printf("p1:%"llx" p2:%"llx" p3:%"llx" key:%012"llx"\n",(uint64_t)(p1-last_keylist),(uint64_t)(p2-state_s),(uint64_t)(p3-last_keylist),*p1);
+ *p3++ = *p1++;
+ p2++;
+ }
+ else {
+ while (compar_state(p1, p2) == -1) ++p1;
+ while (compar_state(p1, p2) == 1) ++p2;
+ }
+ }
+ key_count = p3 - last_keylist;;
+ }
+ else
+ key_count = 0;
+ else
+ {
+ last_keylist = state_s;
+ key_count = i;
+ }
+
+ printf("key_count:%d\n", key_count);
+
+ // The list may still contain several key candidates. Test each of them with mfCheckKeys
+ for (i = 0; i < key_count; i++) {
+ uint8_t keyBlock[6];
+ uint64_t key64;
+ key64 = *(last_keylist + i);
+ num_to_bytes(key64, 6, keyBlock);
+ key64 = 0;
+ if (!mfCheckKeys(0, 0, false, 1, keyBlock, &key64)) {
+ *key = key64;
+ free(last_keylist);
+ last_keylist = NULL;
+ if (par_info ==0)
+ free(state);
+ return 0;
+ }
+ }
+
+
+ free(last_keylist);
+ last_keylist = state_s;
+
+ return 1;
+}
+
+// 32 bit recover key from 2 nonces
+uint64_t mfkey32(uint32_t uid, uint32_t nt, uint32_t nr0_enc, uint32_t ar0_enc, uint32_t nr1_enc, uint32_t ar1_enc) {
+ struct Crypto1State *s,*t;
+ uint64_t key=0; // recovered key
+ /*uint32_t uid; // serial number
+ uint32_t nt; // tag challenge
+ uint32_t nr0_enc; // first encrypted reader challenge
+ uint32_t ar0_enc; // first encrypted reader response
+ uint32_t nr1_enc; // second encrypted reader challenge
+ uint32_t ar1_enc; // second encrypted reader response
+ */
+ uint8_t found=0;
+ //uint32_t ks2; // keystream used to encrypt reader response
+
+ // Generate lfsr succesors of the tag challenge
+ prng_successor(nt, 64);
+ prng_successor(nt, 96);
+
+ // Extract the keystream from the messages
+ //ks2 = ar0_enc ^ prng_successor(nt, 64);
+
+ s = lfsr_recovery32(ar0_enc ^ prng_successor(nt, 64), 0);
+
+ for(t = s; t->odd | t->even; ++t) {
+ lfsr_rollback_word(t, 0, 0);
+ lfsr_rollback_word(t, nr0_enc, 1);
+ lfsr_rollback_word(t, uid ^ nt, 0);
+ crypto1_get_lfsr(t, &key);
+ crypto1_word(t, uid ^ nt, 0);
+ crypto1_word(t, nr1_enc, 1);
+ if (ar1_enc == (crypto1_word(t, 0, 0) ^ prng_successor(nt, 64))) {
+ //printf("\nFound Key: [%012"llx"]\n\n",key);
+ found = 1;
+ break;
+ }
+ }
+ free(s);
+
+ if (found) return key;
+ return 0;