Sfoglia il codice sorgente

Minor cleanup

Will integrate arha's code more fully once tested; leaving both methods in for the time being
Zachary Weiss 3 anni fa
parent
commit
c64394247c
4 ha cambiato i file con 130 aggiunte e 201 eliminazioni
  1. 1 2
      assets/SamyExampleImage.mag
  2. 1 1
      assets/SamyExpiredCard.mag
  3. 113 187
      helpers/mag_helpers.c
  4. 15 11
      helpers/mag_helpers.h

+ 1 - 2
assets/samy.mag → assets/SamyExampleImage.mag

@@ -1,8 +1,7 @@
 Filetype: Flipper Mag device
 Filetype: Flipper Mag device
 Version: 1
 Version: 1
 # Mag device track data
 # Mag device track data
-# Track 1: %B123456781234567^LASTNAME/FIRST^YYMMSSSDDDDDDDDDDDDDDDDDDDDDDDDD?
+# Data matching image example in Samy's repo, for ease of comparison
 Track 1: %B426684131234567^LASTNAME/FIRST^YYMMSSSDDDDDDDDDDDDDDDDDDDDDDDDD?
 Track 1: %B426684131234567^LASTNAME/FIRST^YYMMSSSDDDDDDDDDDDDDDDDDDDDDDDDD?
-# Track 2: ;123456781234567=YYMMSSSDDDDDDDDDDDDDD?
 Track 2: ;426684131234567=230188855555555555555?
 Track 2: ;426684131234567=230188855555555555555?
 Track 3: 
 Track 3: 

+ 1 - 1
assets/samy-javier-branch.mag → assets/SamyExpiredCard.mag

@@ -1,7 +1,7 @@
 Filetype: Flipper Mag device
 Filetype: Flipper Mag device
 Version: 1
 Version: 1
 # Mag device track data
 # Mag device track data
-# found in samy magspoof branch f150bb783237051fba7e4e6ed96a722e542a9663, using as test data, card is long expired
+# Found in samyk's MagSpoof branch f150bb783237051fba7e4e6ed96a722e542a9663; using as test data, card is long expired
 Track 1: %B493173000682759^URISTA HDZ-IVAN JAVIER    ^150220100234000000?
 Track 1: %B493173000682759^URISTA HDZ-IVAN JAVIER    ^150220100234000000?
 Track 2: ;493173000682759=15022100000234?
 Track 2: ;493173000682759=15022100000234?
 Track 3: 
 Track 3: 

+ 113 - 187
helpers/mag_helpers.c

@@ -18,34 +18,31 @@ const int sublen[] = {32, 48, 48};
 uint8_t bit_dir = 0;
 uint8_t bit_dir = 0;
 uint8_t last_value = 2;
 uint8_t last_value = 2;
 
 
-void bitbang_raw(bool value, MagSetting* setting)
-{
+void bitbang_raw(bool value, MagSetting* setting) {
     switch(setting->tx) {
     switch(setting->tx) {
-        case MagTxStateRFID:
-            furi_hal_gpio_write(RFID_PIN_OUT, value);
-            break;
-        case MagTxStateGPIOA6A7:
-            furi_hal_gpio_write(GPIO_PIN_A, value);
-            furi_hal_gpio_write(GPIO_PIN_B, !value);
-            break;
-        case MagTxCC1101_434:
-        case MagTxCC1101_868:
-            if (last_value == 2 || value != (bool)last_value)
-            {
-                furi_hal_gpio_write(&gpio_cc1101_g0, true);
-                furi_delay_us(64);
-                furi_hal_gpio_write(&gpio_cc1101_g0, false);
-            }
-            break;
-        default:
-            break;
+    case MagTxStateRFID:
+        furi_hal_gpio_write(RFID_PIN_OUT, value);
+        break;
+    case MagTxStateGPIOA6A7:
+        furi_hal_gpio_write(GPIO_PIN_A, value);
+        furi_hal_gpio_write(GPIO_PIN_B, !value);
+        break;
+    case MagTxCC1101_434:
+    case MagTxCC1101_868:
+        if(last_value == 2 || value != (bool)last_value) {
+            furi_hal_gpio_write(&gpio_cc1101_g0, true);
+            furi_delay_us(64);
+            furi_hal_gpio_write(&gpio_cc1101_g0, false);
+        }
+        break;
+    default:
+        break;
     }
     }
 
 
     last_value = value;
     last_value = value;
 }
 }
 
 
 void play_bit_rf(bool bit, MagSetting* setting) {
 void play_bit_rf(bool bit, MagSetting* setting) {
-
     bit_dir ^= 1;
     bit_dir ^= 1;
     furi_hal_gpio_write(&gpio_cc1101_g0, true);
     furi_hal_gpio_write(&gpio_cc1101_g0, true);
     furi_delay_us(64);
     furi_delay_us(64);
@@ -134,11 +131,10 @@ void tx_init_rfid() {
 
 
     furi_hal_gpio_init(RFID_PIN_OUT, GpioModeOutputPushPull, GpioPullNo, GpioSpeedLow);
     furi_hal_gpio_init(RFID_PIN_OUT, GpioModeOutputPushPull, GpioPullNo, GpioSpeedLow);
 
 
-    // confirm this delay is needed / sufficient? legacy from hackathon...
     furi_delay_ms(300);
     furi_delay_ms(300);
 }
 }
 
 
-void tx_reset_rfid() {
+void tx_deinit_rfid() {
     // reset RFID system
     // reset RFID system
     furi_hal_gpio_write(RFID_PIN_OUT, 0);
     furi_hal_gpio_write(RFID_PIN_OUT, 0);
 
 
@@ -155,10 +151,11 @@ void tx_init_gpio() {
 
 
     furi_hal_gpio_write(GPIO_PIN_ENABLE, 1);
     furi_hal_gpio_write(GPIO_PIN_ENABLE, 1);
 
 
+    // had some issues with ~300; bumped higher temporarily
     furi_delay_ms(500);
     furi_delay_ms(500);
 }
 }
 
 
-void tx_reset_gpio() {
+void tx_deinit_gpio() {
     furi_hal_gpio_write(GPIO_PIN_A, 0);
     furi_hal_gpio_write(GPIO_PIN_A, 0);
     furi_hal_gpio_write(GPIO_PIN_B, 0);
     furi_hal_gpio_write(GPIO_PIN_B, 0);
     furi_hal_gpio_write(GPIO_PIN_ENABLE, 0);
     furi_hal_gpio_write(GPIO_PIN_ENABLE, 0);
@@ -168,8 +165,7 @@ void tx_reset_gpio() {
     furi_hal_power_disable_otg();
     furi_hal_power_disable_otg();
 }
 }
 
 
-void tx_init_rf(int hz)
-{
+void tx_init_rf(int hz) {
     // presets and frequency will need some experimenting
     // presets and frequency will need some experimenting
     furi_hal_subghz_reset();
     furi_hal_subghz_reset();
     furi_hal_subghz_load_preset(FuriHalSubGhzPresetOok650Async);
     furi_hal_subghz_load_preset(FuriHalSubGhzPresetOok650Async);
@@ -183,8 +179,7 @@ void tx_init_rf(int hz)
     furi_hal_gpio_write(&gpio_cc1101_g0, false);
     furi_hal_gpio_write(&gpio_cc1101_g0, false);
 }
 }
 
 
-void tx_deinit_rf()
-{
+void tx_deinit_rf() {
     furi_hal_gpio_write(&gpio_cc1101_g0, false);
     furi_hal_gpio_write(&gpio_cc1101_g0, false);
     furi_hal_subghz_reset();
     furi_hal_subghz_reset();
     furi_hal_subghz_idle();
     furi_hal_subghz_idle();
@@ -212,14 +207,14 @@ bool tx_init(MagSetting* setting) {
     return true;
     return true;
 }
 }
 
 
-bool tx_reset(MagSetting* setting) {
+bool tx_deinit(MagSetting* setting) {
     // Reset configured TX method
     // Reset configured TX method
     switch(setting->tx) {
     switch(setting->tx) {
     case MagTxStateRFID:
     case MagTxStateRFID:
-        tx_reset_rfid();
+        tx_deinit_rfid();
         break;
         break;
     case MagTxStateGPIOA6A7:
     case MagTxStateGPIOA6A7:
-        tx_reset_gpio();
+        tx_deinit_gpio();
         break;
         break;
     case MagTxCC1101_434:
     case MagTxCC1101_434:
     case MagTxCC1101_868:
     case MagTxCC1101_868:
@@ -232,15 +227,12 @@ bool tx_reset(MagSetting* setting) {
     return true;
     return true;
 }
 }
 
 
+// due for deprecation
 void track_to_bits(uint8_t* bit_array, const char* track_data, uint8_t track_index) {
 void track_to_bits(uint8_t* bit_array, const char* track_data, uint8_t track_index) {
     // convert individual track to bits
     // convert individual track to bits
 
 
     int tmp, crc, lrc = 0;
     int tmp, crc, lrc = 0;
     int i = 0;
     int i = 0;
-    // Please forgive the mess. This was a bug battlezone. Will clean up over the weekend
-    // So many stupid things done here, many learnings lol
-    //FURI_LOG_D(TAG, "%d", strlen(track_data));
-    //FURI_LOG_D(TAG, "%d", strlen(track_data) * bitlen[track_index]);
 
 
     // convert track data to bits
     // convert track data to bits
     for(uint8_t j = 0; track_data[j] != '\0'; j++) {
     for(uint8_t j = 0; track_data[j] != '\0'; j++) {
@@ -251,13 +243,10 @@ void track_to_bits(uint8_t* bit_array, const char* track_data, uint8_t track_ind
             crc ^= tmp & 1;
             crc ^= tmp & 1;
             lrc ^= (tmp & 1) << k;
             lrc ^= (tmp & 1) << k;
             bit_array[i] = tmp & 1;
             bit_array[i] = tmp & 1;
-            //FURI_LOG_D(
-            //    TAG, "i, j, k: %d %d %d  char %s bit %d", i, j, k, &track_data[j], bit_array[i]);
             i++;
             i++;
             tmp >>= 1;
             tmp >>= 1;
         }
         }
         bit_array[i] = crc;
         bit_array[i] = crc;
-        //FURI_LOG_D(TAG, "i, j: %d %d  char %s bit %d", i, j, &track_data[j], bit_array[i]);
         i++;
         i++;
     }
     }
 
 
@@ -268,17 +257,14 @@ void track_to_bits(uint8_t* bit_array, const char* track_data, uint8_t track_ind
     for(uint8_t j = 0; j < bitlen[track_index] - 1; j++) {
     for(uint8_t j = 0; j < bitlen[track_index] - 1; j++) {
         crc ^= tmp & 1;
         crc ^= tmp & 1;
         bit_array[i] = tmp & 1;
         bit_array[i] = tmp & 1;
-        //FURI_LOG_D(TAG, "i, j: %d %d   bit %d", i, j, bit_array[i]);
         i++;
         i++;
         tmp >>= 1;
         tmp >>= 1;
     }
     }
     bit_array[i] = crc;
     bit_array[i] = crc;
-    //FURI_LOG_D(TAG, "i: %d   bit %d", i, bit_array[i]);
     i++;
     i++;
 
 
     // My makeshift end sentinel. All other values 0/1
     // My makeshift end sentinel. All other values 0/1
     bit_array[i] = 2;
     bit_array[i] = 2;
-    //FURI_LOG_D(TAG, "i: %d   bit %d", i, bit_array[i]);
     i++;
     i++;
 
 
     // Log the output (messy but works)
     // Log the output (messy but works)
@@ -297,13 +283,13 @@ void track_to_bits(uint8_t* bit_array, const char* track_data, uint8_t track_ind
 void mag_spoof_bitwise(Mag* mag) {
 void mag_spoof_bitwise(Mag* mag) {
     MagSetting* setting = mag->setting;
     MagSetting* setting = mag->setting;
 
 
-
     FuriString* ft1 = mag->mag_dev->dev_data.track[0].str;
     FuriString* ft1 = mag->mag_dev->dev_data.track[0].str;
     FuriString* ft2 = mag->mag_dev->dev_data.track[1].str;
     FuriString* ft2 = mag->mag_dev->dev_data.track[1].str;
 
 
-    char* data1; char* data2;
-    data1 = malloc(furi_string_size(ft1)+1);
-    data2 = malloc(furi_string_size(ft2)+1);
+    char* data1;
+    char* data2;
+    data1 = malloc(furi_string_size(ft1) + 1);
+    data2 = malloc(furi_string_size(ft2) + 1);
     strncpy(data1, furi_string_get_cstr(ft1), furi_string_size(ft1));
     strncpy(data1, furi_string_get_cstr(ft1), furi_string_size(ft1));
     strncpy(data2, furi_string_get_cstr(ft2), furi_string_size(ft2));
     strncpy(data2, furi_string_get_cstr(ft2), furi_string_size(ft2));
 
 
@@ -312,31 +298,32 @@ void mag_spoof_bitwise(Mag* mag) {
         debug_msr_string(data2, BITS_TRACK2, OFFSET_TRACK2);
         debug_msr_string(data2, BITS_TRACK2, OFFSET_TRACK2);
     }
     }
 
 
-
-    uint8_t bits_t1_raw[64] = {0x00};              // 68 chars max track 1 + 1 char crc * 7 approx =~ 483 bits
-    uint8_t bits_t1_manchester[128] = {0x00};      // twice the above
-    uint16_t bits_t1_count = msr_encode(data1, (uint8_t*) bits_t1_manchester, (uint8_t*) bits_t1_raw, BITS_TRACK1, OFFSET_TRACK1);
-    uint8_t bits_t2_raw[64] = {0x00};              // 68 chars max track 1 + 1 char crc * 7 approx =~ 483 bits
-    uint8_t bits_t2_manchester[128] = {0x00};      // twice the above
-    uint16_t bits_t2_count = msr_encode(data2, (uint8_t*) bits_t2_manchester, (uint8_t*) bits_t2_raw, BITS_TRACK2, OFFSET_TRACK2);
+    uint8_t bits_t1_raw[64] = {0x00}; // 68 chars max track 1 + 1 char crc * 7 approx =~ 483 bits
+    uint8_t bits_t1_manchester[128] = {0x00}; // twice the above
+    uint16_t bits_t1_count = msr_encode(
+        data1, (uint8_t*)bits_t1_manchester, (uint8_t*)bits_t1_raw, BITS_TRACK1, OFFSET_TRACK1);
+    uint8_t bits_t2_raw[64] = {0x00}; // 68 chars max track 1 + 1 char crc * 7 approx =~ 483 bits
+    uint8_t bits_t2_manchester[128] = {0x00}; // twice the above
+    uint16_t bits_t2_count = msr_encode(
+        data2, (uint8_t*)bits_t2_manchester, (uint8_t*)bits_t2_raw, BITS_TRACK2, OFFSET_TRACK2);
 
 
     if(furi_log_get_level() >= FuriLogLevelDebug) {
     if(furi_log_get_level() >= FuriLogLevelDebug) {
         printf("Manchester bitcount: T1: %d, T2: %d\r\n", bits_t1_count, bits_t2_count);
         printf("Manchester bitcount: T1: %d, T2: %d\r\n", bits_t1_count, bits_t2_count);
 
 
         printf("T1 raw: ");
         printf("T1 raw: ");
-        for (int i = 0; i < bits_t1_count / 16; i++) printf("%02x ", bits_t1_raw[i]);
+        for(int i = 0; i < bits_t1_count / 16; i++) printf("%02x ", bits_t1_raw[i]);
         printf("\r\n");
         printf("\r\n");
 
 
         printf("T1 manchester: ");
         printf("T1 manchester: ");
-        for (int i = 0; i < bits_t1_count / 8; i++) printf("%02x ", bits_t1_manchester[i]);
+        for(int i = 0; i < bits_t1_count / 8; i++) printf("%02x ", bits_t1_manchester[i]);
         printf("\r\n");
         printf("\r\n");
 
 
         printf("T2 raw: ");
         printf("T2 raw: ");
-        for (int i = 0; i < bits_t2_count / 16; i++) printf("%02x ", bits_t2_raw[i]);
+        for(int i = 0; i < bits_t2_count / 16; i++) printf("%02x ", bits_t2_raw[i]);
         printf("\r\n");
         printf("\r\n");
 
 
         printf("T2 manchester: ");
         printf("T2 manchester: ");
-        for (int i = 0; i < bits_t2_count / 8; i++) printf("%02x ", bits_t2_manchester[i]);
+        for(int i = 0; i < bits_t2_count / 8; i++) printf("%02x ", bits_t2_manchester[i]);
         printf("\r\n");
         printf("\r\n");
 
 
         printf("Bitwise emulation done\r\n\r\n");
         printf("Bitwise emulation done\r\n\r\n");
@@ -347,21 +334,18 @@ void mag_spoof_bitwise(Mag* mag) {
     FURI_CRITICAL_ENTER();
     FURI_CRITICAL_ENTER();
     bool bit = false;
     bool bit = false;
 
 
-
     if((setting->track == MagTrackStateAll))
     if((setting->track == MagTrackStateAll))
-    for(uint16_t i = 0; i < ZERO_PREFIX; i++)
-    {
-        bit ^= 0xFF;
-        bitbang_raw(bit, setting);
-        furi_delay_us(setting->us_clock*2);
-    }
+        for(uint16_t i = 0; i < ZERO_PREFIX; i++) {
+            bit ^= 0xFF;
+            bitbang_raw(bit, setting);
+            furi_delay_us(setting->us_clock * 2);
+        }
 
 
     if((setting->track == MagTrackStateAll) || (setting->track == MagTrackStateOne))
     if((setting->track == MagTrackStateAll) || (setting->track == MagTrackStateOne))
-    for(uint16_t i = 0; i < bits_t1_count; i++)
-    {
-        uint8_t byte = i / 8;
-        uint8_t bitmask = 1 << (7-(i % 8));
-        /* this comment is mostly for zw's convenience:
+        for(uint16_t i = 0; i < bits_t1_count; i++) {
+            uint8_t byte = i / 8;
+            uint8_t bitmask = 1 << (7 - (i % 8));
+            /* this comment is mostly for zw's convenience:
          *
          *
          * bits are stored in their arrays like on a card (LSB first). This is not how usually bits are stored in a
          * bits are stored in their arrays like on a card (LSB first). This is not how usually bits are stored in a
          * byte, with the MSB first. the var bitmask creates the pattern to iterate through each bit, LSB first, like so
          * byte, with the MSB first. the var bitmask creates the pattern to iterate through each bit, LSB first, like so
@@ -381,52 +365,49 @@ void mag_spoof_bitwise(Mag* mag) {
          * order. THus, the reason for the bitmask above
          * order. THus, the reason for the bitmask above
          */
          */
 
 
-        bit = !!(bits_t1_manchester[byte] & bitmask);
+            bit = !!(bits_t1_manchester[byte] & bitmask);
 
 
-        // TODO: reimplement timing delays. Replace fixed furi_hal_cortex_delay_us to wait instead to a specific value
-        // for DWT->CYCCNT. Note timer is aliased to 64us as per
-        // #define FURI_HAL_CORTEX_INSTRUCTIONS_PER_MICROSECOND (SystemCoreClock / 1000000) | furi_hal_cortex.c
+            // TODO: reimplement timing delays. Replace fixed furi_hal_cortex_delay_us to wait instead to a specific value
+            // for DWT->CYCCNT. Note timer is aliased to 64us as per
+            // #define FURI_HAL_CORTEX_INSTRUCTIONS_PER_MICROSECOND (SystemCoreClock / 1000000) | furi_hal_cortex.c
 
 
-        bitbang_raw(bit, setting);
-        furi_delay_us(setting->us_clock);
-        // if (i % 2 == 1) furi_delay_us(setting->us_interpacket);
-    }
+            bitbang_raw(bit, setting);
+            furi_delay_us(setting->us_clock);
+            // if (i % 2 == 1) furi_delay_us(setting->us_interpacket);
+        }
 
 
     if((setting->track == MagTrackStateAll))
     if((setting->track == MagTrackStateAll))
-    for(uint16_t i = 0; i < ZERO_BETWEEN; i++)
-    {
-        bit ^= 0xFF;
-        bitbang_raw(bit, setting);
-        furi_delay_us(setting->us_clock*2);
-    }
+        for(uint16_t i = 0; i < ZERO_BETWEEN; i++) {
+            bit ^= 0xFF;
+            bitbang_raw(bit, setting);
+            furi_delay_us(setting->us_clock * 2);
+        }
 
 
     if((setting->track == MagTrackStateAll) || (setting->track == MagTrackStateTwo))
     if((setting->track == MagTrackStateAll) || (setting->track == MagTrackStateTwo))
-    for(uint16_t i = 0; i < bits_t2_count; i++)
-    {
-        uint16_t j = bits_t2_count - i - 1;
-        uint8_t byte = j / 8;
-        uint8_t bitmask = 1 << (7-(j % 8));
-        bool bit = !!(bits_t2_manchester[byte] & bitmask);
-        bitbang_raw(bit, setting);
-        furi_delay_us(setting->us_clock);
-        // if (i % 2 == 1) furi_delay_us(setting->us_interpacket);
-    }
+        for(uint16_t i = 0; i < bits_t2_count; i++) {
+            uint16_t j = bits_t2_count - i - 1;
+            uint8_t byte = j / 8;
+            uint8_t bitmask = 1 << (7 - (j % 8));
+            bool bit = !!(bits_t2_manchester[byte] & bitmask);
+            bitbang_raw(bit, setting);
+            furi_delay_us(setting->us_clock);
+            // if (i % 2 == 1) furi_delay_us(setting->us_interpacket);
+        }
 
 
     if((setting->track == MagTrackStateAll))
     if((setting->track == MagTrackStateAll))
-    for(uint16_t i = 0; i < ZERO_SUFFIX; i++)
-    {
-        bit ^= 0xFF;
-        bitbang_raw(bit, setting);
-        furi_delay_us(setting->us_clock*2);
-    }
+        for(uint16_t i = 0; i < ZERO_SUFFIX; i++) {
+            bit ^= 0xFF;
+            bitbang_raw(bit, setting);
+            furi_delay_us(setting->us_clock * 2);
+        }
 
 
     FURI_CRITICAL_EXIT();
     FURI_CRITICAL_EXIT();
     free(data1);
     free(data1);
     free(data2);
     free(data2);
     tx_reset(setting);
     tx_reset(setting);
-
 }
 }
 
 
+// due for deprecation
 void mag_spoof(Mag* mag) {
 void mag_spoof(Mag* mag) {
     MagSetting* setting = mag->setting;
     MagSetting* setting = mag->setting;
 
 
@@ -490,76 +471,33 @@ void mag_spoof(Mag* mag) {
     }*/
     }*/
 }
 }
 
 
-//// @antirez's code from protoview for bitmapping. May want to refactor to use this...
-
-/* Set the 'bitpos' bit to value 'val', in the specified bitmap
- * 'b' of len 'blen'.
- * Out of range bits will silently be discarded. */
-void set_bit(uint8_t* b, uint32_t blen, uint32_t bitpos, bool val) {
-    uint32_t byte = bitpos / 8;
-    uint32_t bit = bitpos & 7;
-    if(byte >= blen) return;
-    if(val)
-        b[byte] |= 1 << bit;
-    else
-        b[byte] &= ~(1 << bit);
-}
-
-/* Get the bit 'bitpos' of the bitmap 'b' of 'blen' bytes.
- * Out of range bits return false (not bit set). */
-bool get_bit(uint8_t* b, uint32_t blen, uint32_t bitpos) {
-    uint32_t byte = bitpos / 8;
-    uint32_t bit = bitpos & 7;
-    if(byte >= blen) return 0;
-    return (b[byte] & (1 << bit)) != 0;
-}
-
-/*uint32_t convert_signal_to_bits(uint8_t *b, uint32_t blen, RawSamplesBuffer *s, uint32_t idx, uint32_t count, uint32_t rate) {
-    if (rate == 0) return 0; // We can't perform the conversion.
-    uint32_t bitpos = 0;
-    for (uint32_t j = 0; j < count; j++) {
-        uint32_t dur;
-        bool level;
-        raw_samples_get(s, j+idx, &level, &dur);
-
-        uint32_t numbits = dur / rate; // full bits that surely fit. 
-        uint32_t rest = dur % rate;    // How much we are left with. 
-        if (rest > rate/2) numbits++;  // There is another one.
-        while(numbits--) set_bit(b,blen,bitpos++,s[j].level);
-    }
-    return bitpos;
-}*/
-
-
-
-
-uint16_t add_bit(bool value, uint8_t* out, uint16_t count)
-{
+uint16_t add_bit(bool value, uint8_t* out, uint16_t count) {
     uint8_t bit = count % 8;
     uint8_t bit = count % 8;
     uint8_t byte = count / 8;
     uint8_t byte = count / 8;
-    if (value)
-    {
+    if(value) {
         out[byte] |= 0x01;
         out[byte] |= 0x01;
     }
     }
-    if (bit < 7) out[byte] <<= 1;
-    return count+1;
+    if(bit < 7) out[byte] <<= 1;
+    return count + 1;
 }
 }
 
 
-uint16_t add_bit_manchester(bool value, uint8_t* out, uint16_t count)
-{
+uint16_t add_bit_manchester(bool value, uint8_t* out, uint16_t count) {
     static bool toggle = 0;
     static bool toggle = 0;
     toggle ^= 0x01;
     toggle ^= 0x01;
     count = add_bit(toggle, out, count);
     count = add_bit(toggle, out, count);
-    if (value) toggle ^= 0x01;
+    if(value) toggle ^= 0x01;
     count = add_bit(toggle, out, count);
     count = add_bit(toggle, out, count);
     return count;
     return count;
 }
 }
 
 
-
-uint16_t msr_encode(char* data, uint8_t* out_manchester, uint8_t* out_raw, uint8_t track_bits, uint8_t track_ascii_offset)
-{
+uint16_t msr_encode(
+    char* data,
+    uint8_t* out_manchester,
+    uint8_t* out_raw,
+    uint8_t track_bits,
+    uint8_t track_ascii_offset) {
     /*
     /*
-     * track_bits - the number of raw (data) bits on the track. on ISO cards, that's 7 for track 5, or 4 for 2/3 - this is samy's bitlen
+     * track_bits - the number of raw (data) bits on the track. on ISO cards, that's 7 for track 1, or 5 for 2/3 - this is samy's bitlen
      *            - this count includes the parity bit
      *            - this count includes the parity bit
      * track_ascii_offset - how much the ascii values are offset. track 1 makes space (ascii 32) become data 0x00,
      * track_ascii_offset - how much the ascii values are offset. track 1 makes space (ascii 32) become data 0x00,
      *                    - tracks 2/3 make ascii "0" become data 0x00 - this is samy's sublen
      *                    - tracks 2/3 make ascii "0" become data 0x00 - this is samy's sublen
@@ -570,20 +508,16 @@ uint16_t msr_encode(char* data, uint8_t* out_manchester, uint8_t* out_raw, uint8
     uint16_t output_count = 0;
     uint16_t output_count = 0;
     int tmp, crc, lrc = 0;
     int tmp, crc, lrc = 0;
 
 
-    for (int i = 0; i < PREFIX_NUM_ZEROES; i++)
-    {
+    for(int i = 0; i < PREFIX_NUM_ZEROES; i++) {
         output_count = add_bit_manchester(0, out_manchester, output_count);
         output_count = add_bit_manchester(0, out_manchester, output_count);
         raw_bits_count = add_bit(0, out_raw, raw_bits_count);
         raw_bits_count = add_bit(0, out_raw, raw_bits_count);
     }
     }
 
 
-
-    for (int i = 0; *(data+i) != 0; i++)
-    {
+    for(int i = 0; *(data + i) != 0; i++) {
         crc = 1;
         crc = 1;
-        tmp = *(data+i) - track_ascii_offset;
+        tmp = *(data + i) - track_ascii_offset;
 
 
-        for (int j = 0; j < track_bits-1; j++)
-        {
+        for(int j = 0; j < track_bits - 1; j++) {
             crc ^= tmp & 1;
             crc ^= tmp & 1;
             lrc ^= (tmp & 1) << j;
             lrc ^= (tmp & 1) << j;
             raw_bits_count = add_bit(tmp & 0x01, out_raw, raw_bits_count);
             raw_bits_count = add_bit(tmp & 0x01, out_raw, raw_bits_count);
@@ -594,12 +528,10 @@ uint16_t msr_encode(char* data, uint8_t* out_manchester, uint8_t* out_raw, uint8
         output_count = add_bit_manchester(crc, out_manchester, output_count);
         output_count = add_bit_manchester(crc, out_manchester, output_count);
     }
     }
 
 
-
     // LRC byte
     // LRC byte
     tmp = lrc;
     tmp = lrc;
     crc = 1;
     crc = 1;
-    for (int j = 0; j < track_bits-1; j++)
-    {
+    for(int j = 0; j < track_bits - 1; j++) {
         crc ^= tmp & 0x01;
         crc ^= tmp & 0x01;
         raw_bits_count = add_bit(tmp & 0x01, out_raw, raw_bits_count);
         raw_bits_count = add_bit(tmp & 0x01, out_raw, raw_bits_count);
         output_count = add_bit_manchester(tmp & 0x01, out_manchester, output_count);
         output_count = add_bit_manchester(tmp & 0x01, out_manchester, output_count);
@@ -611,50 +543,44 @@ uint16_t msr_encode(char* data, uint8_t* out_manchester, uint8_t* out_raw, uint8
     return output_count;
     return output_count;
 }
 }
 
 
-void debug_msr_string(char* data,  uint8_t track_bits, uint8_t track_ascii_offset)
-{
-    uint8_t bits_raw[64] = {0};           // 68 chars max track 1 + 1 char crc * 7 approx =~ 483 bits
-    uint8_t bits_manchester[128] = {0};    // twice the above
+void debug_msr_string(char* data, uint8_t track_bits, uint8_t track_ascii_offset) {
+    uint8_t bits_raw[64] = {0}; // 68 chars max track 1 + 1 char crc * 7 approx =~ 483 bits
+    uint8_t bits_manchester[128] = {0}; // twice the above
     int numbits = 0;
     int numbits = 0;
 
 
     printf("Encoding [%s] with %d bits\r\n", data, track_bits);
     printf("Encoding [%s] with %d bits\r\n", data, track_bits);
-    numbits = msr_encode(data, (uint8_t*)bits_manchester, (uint8_t*)bits_raw, track_bits, track_ascii_offset);
+    numbits = msr_encode(
+        data, (uint8_t*)bits_manchester, (uint8_t*)bits_raw, track_bits, track_ascii_offset);
     printf("Got %d bits\r\n", numbits);
     printf("Got %d bits\r\n", numbits);
     printf("Raw byte stream:     ");
     printf("Raw byte stream:     ");
-    for(int i = 0; i < numbits / 8 / 2; i++)
-    {
+    for(int i = 0; i < numbits / 8 / 2; i++) {
         printf("%02x", bits_raw[i]);
         printf("%02x", bits_raw[i]);
-        if (i%4==3) printf(" ");
+        if(i % 4 == 3) printf(" ");
     }
     }
 
 
     printf("\r\n");
     printf("\r\n");
 
 
     printf("Bits                 ");
     printf("Bits                 ");
     int space_counter = 0;
     int space_counter = 0;
-    for(int i = 0; i < numbits / 2; i++)
-    {
-        if (i < PREFIX_NUM_ZEROES)
-        {
+    for(int i = 0; i < numbits / 2; i++) {
+        if(i < PREFIX_NUM_ZEROES) {
             printf("X");
             printf("X");
             continue;
             continue;
-        }
-        else if (i == PREFIX_NUM_ZEROES)
-        {
-            printf (" ");
+        } else if(i == PREFIX_NUM_ZEROES) {
+            printf(" ");
             space_counter = 0;
             space_counter = 0;
         }
         }
-        printf("%01x", (bits_raw[i/8] & (1 << (7-(i%8)))) != 0);
-        if ((space_counter) % track_bits == track_bits-1) printf(" ");
+        printf("%01x", (bits_raw[i / 8] & (1 << (7 - (i % 8)))) != 0);
+        if((space_counter) % track_bits == track_bits - 1) printf(" ");
         space_counter++;
         space_counter++;
     }
     }
 
 
     printf("\r\n");
     printf("\r\n");
 
 
     printf("Manchester encoded, byte stream: ");
     printf("Manchester encoded, byte stream: ");
-    for(int i = 0; i < numbits / 8; i++)
-    {
+    for(int i = 0; i < numbits / 8; i++) {
         printf("%02x", bits_manchester[i]);
         printf("%02x", bits_manchester[i]);
-        if (i%4==3) printf(" ");
+        if(i % 4 == 3) printf(" ");
     }
     }
     printf("\r\n\r\n");
     printf("\r\n\r\n");
 }
 }

+ 15 - 11
helpers/mag_helpers.h

@@ -7,15 +7,10 @@ void play_bit_gpio(uint8_t send_bit, MagSetting* setting);
 bool play_bit(uint8_t send_bit, MagSetting* setting);
 bool play_bit(uint8_t send_bit, MagSetting* setting);
 void tx_init_rfid();
 void tx_init_rfid();
 void tx_init_gpio();
 void tx_init_gpio();
-void tx_reset_rfid();
-void tx_reset_gpio();
+void tx_deinit_rfid();
+void tx_deinit_gpio();
 bool tx_init(MagSetting* setting);
 bool tx_init(MagSetting* setting);
-bool tx_reset(MagSetting* setting);
-void track_to_bits(uint8_t* bit_array, const char* track_data, uint8_t track_index);
-void mag_spoof(Mag* mag);
-void set_bit(uint8_t* b, uint32_t blen, uint32_t bitpos, bool val);
-bool get_bit(uint8_t* b, uint32_t blen, uint32_t bitpos);
-
+bool tx_deinit(MagSetting* setting);
 
 
 #define PREFIX_NUM_ZEROES 25
 #define PREFIX_NUM_ZEROES 25
 #define BITS_TRACK1 7
 #define BITS_TRACK1 7
@@ -24,8 +19,17 @@ bool get_bit(uint8_t* b, uint32_t blen, uint32_t bitpos);
 #define OFFSET_TRACK2 48
 #define OFFSET_TRACK2 48
 uint16_t add_bit(bool value, uint8_t* out, uint16_t count);
 uint16_t add_bit(bool value, uint8_t* out, uint16_t count);
 uint16_t add_bit_manchester(bool value, uint8_t* out, uint16_t count);
 uint16_t add_bit_manchester(bool value, uint8_t* out, uint16_t count);
-uint16_t msr_encode(char* data, uint8_t* out_manchester, uint8_t* out_raw, uint8_t track_bits, uint8_t track_ascii_offset);
-void debug_msr_string(char* data,  uint8_t track_bits, uint8_t track_ascii_offset);
+uint16_t msr_encode(
+    char* data,
+    uint8_t* out_manchester,
+    uint8_t* out_raw,
+    uint8_t track_bits,
+    uint8_t track_ascii_offset);
+void debug_msr_string(char* data, uint8_t track_bits, uint8_t track_ascii_offset);
 void mag_spoof_bitwise(Mag* mag);
 void mag_spoof_bitwise(Mag* mag);
 void tx_deinit_rf();
 void tx_deinit_rf();
-void tx_init_rf(int hz);
+void tx_init_rf(int hz);
+
+// due for deprecation
+void track_to_bits(uint8_t* bit_array, const char* track_data, uint8_t track_index);
+void mag_spoof(Mag* mag);