diff options
Diffstat (limited to 'openpicc/application/iso14443a_pretender.c')
| -rw-r--r-- | openpicc/application/iso14443a_pretender.c | 61 |
1 files changed, 53 insertions, 8 deletions
diff --git a/openpicc/application/iso14443a_pretender.c b/openpicc/application/iso14443a_pretender.c index 6f62330..c2e37d5 100644 --- a/openpicc/application/iso14443a_pretender.c +++ b/openpicc/application/iso14443a_pretender.c @@ -26,6 +26,7 @@ #include <board.h> #include <task.h> #include <errno.h> +#include <string.h> #include <stdlib.h> #include "openpicc.h" @@ -36,6 +37,7 @@ #include "iso14443a_manchester.h" #include "usb_print.h" #include "cmd.h" +extern volatile int fdt_offset; #include "led.h" static const iso14443_frame ATQA_FRAME = { @@ -47,6 +49,24 @@ static const iso14443_frame ATQA_FRAME = { {} }; +static const iso14443_frame LONG_FRAME = { + TYPE_A, + {{STANDARD_FRAME, PARITY, ISO14443A_LAST_BIT_NONE}}, + 40, + 0, 0, + { 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, + 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, + 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, + 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, }, + {} +}; + +#define FRAME_SIZE(bytes) (2* (1+(9*bytes)+1) ) +#define SIZED_BUFFER(bytes) struct { int len; u_int8_t data[FRAME_SIZE(bytes)]; } + +static SIZED_BUFFER(2) ATQA_BUFFER; +static SIZED_BUFFER(40) LONG_BUFFER; + static ssc_dma_tx_buffer_t tx_buffer; static void fast_receive_callback(ssc_dma_rx_buffer_t *buffer, u_int8_t in_irq) @@ -60,10 +80,11 @@ static void fast_receive_callback(ssc_dma_rx_buffer_t *buffer, u_int8_t in_irq) switch(buffer->len_transfers) { case 3: case 4: /* REQA (7 bits) */ + case 7: case 8: case 9: tx_frame = &ATQA_FRAME; fdt = 1172; break; - case 6: case 7: /* ANTICOL (2 bytes) */ + //case 6: case 7: /* ANTICOL (2 bytes) */ case 22: /* SELECT (9 bytes) */ break; @@ -74,15 +95,26 @@ static void fast_receive_callback(ssc_dma_rx_buffer_t *buffer, u_int8_t in_irq) } /* Add some extra room to the fdt for testing */ - fdt += 3*128; + //fdt += 3*128; + fdt += fdt_offset; + int ret = 0; if(tx_frame != NULL) { + tx_buffer.source = (void*)tx_frame; - tx_buffer.len = sizeof(tx_buffer.data); - ret = manchester_encode(tx_buffer.data, - tx_buffer.len, - tx_frame); + if(tx_frame == &ATQA_FRAME) { + memcpy(tx_buffer.data, ATQA_BUFFER.data, ATQA_BUFFER.len); + ret = tx_buffer.len = ATQA_BUFFER.len; + } else if(tx_frame == &LONG_FRAME) { + memcpy(tx_buffer.data, LONG_BUFFER.data, LONG_BUFFER.len); + ret = tx_buffer.len = LONG_BUFFER.len; + } else { + tx_buffer.len = sizeof(tx_buffer.data); + ret = manchester_encode(tx_buffer.data, + tx_buffer.len, + tx_frame); + } if(ret >= 0) { tx_buffer.state = FULL; tx_buffer.len = ret; @@ -129,6 +161,18 @@ void iso14443a_pretender (void *pvParameters) vTaskDelay(1*portTICK_RATE_MS); } + ATQA_BUFFER.len = manchester_encode(ATQA_BUFFER.data, sizeof(ATQA_BUFFER.data), &ATQA_FRAME); + LONG_BUFFER.len = manchester_encode(LONG_BUFFER.data, sizeof(LONG_BUFFER.data), &LONG_FRAME); + if(ATQA_BUFFER.len < 0 || LONG_BUFFER.len < 0) { + usb_print_string("Buffer prefilling failed\n\r"); + while(1) { + for(i=1000; i<=3000; i++) { + vLedSetBrightness(LED_GREEN, abs(1000-(i%2000))); + vTaskDelay(1*portTICK_RATE_MS); + } + } + } + do { res = iso14443_layer2a_init(1); if(res < 0) { @@ -206,7 +250,8 @@ void iso14443a_pretender (void *pvParameters) current_detected = 0; last_switched = xTaskGetTickCount(); } - + +#if 0 if(last_detected & (DETECTED_14443A_3 | DETECTED_14443A_4 | DETECTED_MIFARE)) { if(last_detected & DETECTED_MIFARE) { vLedSetGreen(0); @@ -222,6 +267,6 @@ void iso14443a_pretender (void *pvParameters) vLedSetGreen(0); vLedSetRed(0); } - +#endif } } |