github/proxmark3
1
0
Fork 0
mirror of https://github.com/Proxmark/proxmark3.git synced 2025-08-22 22:23:38 -07:00
Code Issues Projects Releases Packages Wiki Activity Actions

FIX: a shot at fixing the "_" underscore problem in fileutils.c. This one uses _ifdefine. I hope it works. Linux people can let me know if it works.

Browse source 
FIX: changed the DetectASKClock in lfdemod.c to correct detect all clocks in the array.
CHG: I like code with more spaces inside of it and tried change some stuff according to our codestyle in HACKING.txt
ADD: some zero checks and overflows, god knows where it was.

The T55XX commands will be rewritten to use Marshmellows lfdemod.c instead.
CHG: Made the graph window smaller.
CHG: lf read  now does a "data samples" also.  (less writing commands)
CHG: data samples now defaults to samples size of 20000
This commit is contained in:
iceman1001 2015-01-04 22:49:54 +01:00
commit 8d0a3e87d7
12 changed files with 1280 additions and 1275 deletions
Download patch file Download diff file Expand all files Collapse all files

6
armsrc/desfire_crypto.c
View file

@ -321,7 +321,7 @@ void* mifare_cryto_postprocess_data (desfiretag_t tag, void *data, ssize_t *nbyt
*nbytes = -1; *nbytes = -1;
res = NULL; res = NULL;
#ifdef WITH_DEBUG #ifdef WITH_DEBUG
printf ("No room for MAC!"); Dbprintf ("No room for MAC!");
#endif #endif
break; break;
} }
@ -336,7 +336,7 @@ void* mifare_cryto_postprocess_data (desfiretag_t tag, void *data, ssize_t *nbyt
if (0 != memcmp ((uint8_t *)data + *nbytes - 1, (uint8_t *)edata + edl - 8, 4)) { if (0 != memcmp ((uint8_t *)data + *nbytes - 1, (uint8_t *)edata + edl - 8, 4)) {
#ifdef WITH_DEBUG #ifdef WITH_DEBUG
printf ("MACing not verified"); Dbprintf ("MACing not verified");
hexdump ((uint8_t *)data + *nbytes - 1, key_macing_length (key), "Expect ", 0); hexdump ((uint8_t *)data + *nbytes - 1, key_macing_length (key), "Expect ", 0);
hexdump ((uint8_t *)edata + edl - 8, key_macing_length (key), "Actual ", 0); hexdump ((uint8_t *)edata + edl - 8, key_macing_length (key), "Actual ", 0);
#endif #endif
@ -366,7 +366,7 @@ void* mifare_cryto_postprocess_data (desfiretag_t tag, void *data, ssize_t *nbyt
((uint8_t *)data)[*nbytes - 9] = first_cmac_byte; ((uint8_t *)data)[*nbytes - 9] = first_cmac_byte;
if (0 != memcmp (DESFIRE (tag)->cmac, (uint8_t *)data + *nbytes - 9, 8)) { if (0 != memcmp (DESFIRE (tag)->cmac, (uint8_t *)data + *nbytes - 9, 8)) {
#ifdef WITH_DEBUG #ifdef WITH_DEBUG
printf ("CMAC NOT verified :-("); Dbprintf ("CMAC NOT verified :-(");
hexdump ((uint8_t *)data + *nbytes - 9, 8, "Expect ", 0); hexdump ((uint8_t *)data + *nbytes - 9, 8, "Expect ", 0);
hexdump (DESFIRE (tag)->cmac, 8, "Actual ", 0); hexdump (DESFIRE (tag)->cmac, 8, "Actual ", 0);
#endif #endif

317
armsrc/lfops.c
View file

@ -64,9 +64,9 @@ void SnoopLFRawAdcSamples(int divisor, int trigger_threshold)
// split into two routines so we can avoid timing issues after sending commands // // split into two routines so we can avoid timing issues after sending commands //
void DoAcquisition125k_internal(int trigger_threshold, bool silent) void DoAcquisition125k_internal(int trigger_threshold, bool silent)
{ {
uint8_t *dest = get_bigbufptr_recvrespbuf(); uint8_t *dest = (uint8_t *)BigBuf;
uint16_t i = 0; uint16_t i = 0;
memset(dest, 0x00, FREE_BUFFER_SIZE); memset(dest, 0x00, BIGBUF_SIZE);
for(;;) { for(;;) {
if (AT91C_BASE_SSC->SSC_SR & AT91C_SSC_TXRDY) { if (AT91C_BASE_SSC->SSC_SR & AT91C_SSC_TXRDY) {
@ -80,7 +80,7 @@ void DoAcquisition125k_internal(int trigger_threshold, bool silent)
continue; continue;
else else
trigger_threshold = -1; trigger_threshold = -1;
if (++i >= FREE_BUFFER_SIZE) break; if (++i >= BIGBUF_SIZE) break;
} }
} }
if (!silent){ if (!silent){
@ -161,8 +161,6 @@ void ReadTItag(void)
signed char *dest = (signed char *)BigBuf; signed char *dest = (signed char *)BigBuf;
int n = sizeof(BigBuf); int n = sizeof(BigBuf);
// int *dest = GraphBuffer;
// int n = GraphTraceLen;
// 128 bit shift register [shift3:shift2:shift1:shift0] // 128 bit shift register [shift3:shift2:shift1:shift0]
uint32_t shift3 = 0, shift2 = 0, shift1 = 0, shift0 = 0; uint32_t shift3 = 0, shift2 = 0, shift1 = 0, shift0 = 0;
@ -569,8 +567,6 @@ void SimulateTagLowFrequency( uint16_t period, uint32_t gap, uint8_t ledcontrol)
void SimulateTagLowFrequencyA(int len, int gap) void SimulateTagLowFrequencyA(int len, int gap)
{ {
//Dbprintf("LEN %d || Gap %d",len, gap);
uint8_t *buf = (uint8_t *)BigBuf; uint8_t *buf = (uint8_t *)BigBuf;
FpgaDownloadAndGo(FPGA_BITSTREAM_LF); FpgaDownloadAndGo(FPGA_BITSTREAM_LF);
@ -624,7 +620,7 @@ static void fc(int c, uint16_t *n) {
int idx; int idx;
// for when we want an fc8 pattern every 4 logical bits // for when we want an fc8 pattern every 4 logical bits
if(c==0) { if(c == 0) {
dest[((*n)++)]=1; dest[((*n)++)]=1;
dest[((*n)++)]=1; dest[((*n)++)]=1;
dest[((*n)++)]=0; dest[((*n)++)]=0;
@ -635,7 +631,7 @@ static void fc(int c, uint16_t *n) {
dest[((*n)++)]=0; dest[((*n)++)]=0;
} }
// an fc/8 encoded bit is a bit pattern of 11000000 x6 = 48 samples // an fc/8 encoded bit is a bit pattern of 11000000 x6 = 48 samples
if(c==8) { if(c == 8) {
for (idx=0; idx<6; idx++) { for (idx=0; idx<6; idx++) {
dest[((*n)++)]=1; dest[((*n)++)]=1;
dest[((*n)++)]=1; dest[((*n)++)]=1;
@ -649,8 +645,8 @@ static void fc(int c, uint16_t *n) {
} }
// an fc/10 encoded bit is a bit pattern of 1110000000 x5 = 50 samples // an fc/10 encoded bit is a bit pattern of 1110000000 x5 = 50 samples
if(c==10) { if(c == 10) {
for (idx=0; idx<5; idx++) { for (idx = 0; idx < 5; idx++) {
dest[((*n)++)]=1; dest[((*n)++)]=1;
dest[((*n)++)]=1; dest[((*n)++)]=1;
dest[((*n)++)]=1; dest[((*n)++)]=1;
@ -669,7 +665,7 @@ static void fc(int c, uint16_t *n) {
// simulate a HID tag until the button is pressed // simulate a HID tag until the button is pressed
void CmdHIDsimTAG(int hi, int lo, uint8_t ledcontrol) void CmdHIDsimTAG(int hi, int lo, uint8_t ledcontrol)
{ {
uint16_t n=0, i=0; uint16_t n = 0, i = 0;
/* /*
HID tag bitstream format HID tag bitstream format
The tag contains a 44bit unique code. This is sent out MSB first in sets of 4 bits The tag contains a 44bit unique code. This is sent out MSB first in sets of 4 bits
@ -680,11 +676,11 @@ void CmdHIDsimTAG(int hi, int lo, uint8_t ledcontrol)
nor 1 bits, they are special patterns (a = set of 12 fc8 and b = set of 10 fc10) nor 1 bits, they are special patterns (a = set of 12 fc8 and b = set of 10 fc10)
*/ */
if (hi>0xFFF) { if (hi > 0xFFF) {
DbpString("Tags can only have 44 bits."); DbpString("Tags can only have 44 bits.");
return; return;
} }
fc(0,&n); fc(0, &n);
// special start of frame marker containing invalid bit sequences // special start of frame marker containing invalid bit sequences
fc(8, &n); fc(8, &n); // invalid fc(8, &n); fc(8, &n); // invalid
fc(8, &n); fc(10, &n); // logical 0 fc(8, &n); fc(10, &n); // logical 0
@ -693,9 +689,9 @@ void CmdHIDsimTAG(int hi, int lo, uint8_t ledcontrol)
WDT_HIT(); WDT_HIT();
// manchester encode bits 43 to 32 // manchester encode bits 43 to 32
for (i=11; i>=0; i--) { for (i = 11; i >= 0; i--) {
if ((i%4)==3) fc(0,&n); if ((i % 4) == 3) fc(0, &n);
if ((hi>>i)&1) { if ((hi >> i) & 1) {
fc(10, &n); fc(8, &n); // low-high transition fc(10, &n); fc(8, &n); // low-high transition
} else { } else {
fc(8, &n); fc(10, &n); // high-low transition fc(8, &n); fc(10, &n); // high-low transition
@ -704,9 +700,9 @@ void CmdHIDsimTAG(int hi, int lo, uint8_t ledcontrol)
WDT_HIT(); WDT_HIT();
// manchester encode bits 31 to 0 // manchester encode bits 31 to 0
for (i=31; i>=0; i--) { for (i = 31; i >= 0; i--) {
if ((i%4)==3) fc(0,&n); if ((i % 4 ) == 3) fc(0, &n);
if ((lo>>i)&1) { if ((lo >> i ) & 1) {
fc(10, &n); fc(8, &n); // low-high transition fc(10, &n); fc(8, &n); // low-high transition
} else { } else {
fc(8, &n); fc(10, &n); // high-low transition fc(8, &n); fc(10, &n); // high-low transition
@ -725,10 +721,8 @@ void CmdHIDsimTAG(int hi, int lo, uint8_t ledcontrol)
// loop to get raw HID waveform then FSK demodulate the TAG ID from it // loop to get raw HID waveform then FSK demodulate the TAG ID from it
void CmdHIDdemodFSK(int findone, int *high, int *low, int ledcontrol) void CmdHIDdemodFSK(int findone, int *high, int *low, int ledcontrol)
{ {
uint8_t *dest = get_bigbufptr_recvrespbuf(); uint8_t *dest = (uint8_t *)BigBuf;
uint32_t hi2 = 0, hi = 0, lo = 0;
size_t size=0; //, found=0;
uint32_t hi2=0, hi=0, lo=0;
// Configure to go in 125Khz listen mode // Configure to go in 125Khz listen mode
LFSetupFPGAForADC(0, true); LFSetupFPGAForADC(0, true);
@ -739,77 +733,84 @@ void CmdHIDdemodFSK(int findone, int *high, int *low, int ledcontrol)
if (ledcontrol) LED_A_ON(); if (ledcontrol) LED_A_ON();
DoAcquisition125k_internal(-1,true); DoAcquisition125k_internal(-1,true);
size = sizeof(BigBuf);
if (size < 2000) continue;
// FSK demodulator
int bitLen = HIDdemodFSK(dest,size,&hi2,&hi,&lo); // FSK demodulator
int bitLen = HIDdemodFSK(dest,BIGBUF_SIZE,&hi2,&hi,&lo);
WDT_HIT(); WDT_HIT();
if (bitLen>0 && lo>0){ if (bitLen > 0 && lo > 0){
// final loop, go over previously decoded manchester data and decode into usable tag ID // final loop, go over previously decoded manchester data and decode into usable tag ID
// 111000 bit pattern represent start of frame, 01 pattern represents a 1 and 10 represents a 0 // 111000 bit pattern represent start of frame, 01 pattern represents a 1 and 10 represents a 0
if (hi2 != 0){ //extra large HID tags
Dbprintf("TAG ID: %x%08x%08x (%d)", if (hi2 != 0){
(unsigned int) hi2, (unsigned int) hi, (unsigned int) lo, (unsigned int) (lo>>1) & 0xFFFF); //extra large HID tags
}else { //standard HID tags <38 bits Dbprintf("TAG ID: %x%08x%08x (%d)",
//Dbprintf("TAG ID: %x%08x (%d)",(unsigned int) hi, (unsigned int) lo, (unsigned int) (lo>>1) & 0xFFFF); //old print cmd (unsigned int) hi2,
uint8_t bitlen = 0; (unsigned int) hi,
uint32_t fc = 0; (unsigned int) lo,
uint32_t cardnum = 0; (unsigned int) (lo >> 1) & 0xFFFF);
if (((hi>>5)&1)==1){//if bit 38 is set then < 37 bit format is used
uint32_t lo2=0; } else {
lo2=(((hi & 31) << 12) | (lo>>20)); //get bits 21-37 to check for format len bit //standard HID tags <38 bits
uint8_t idx3 = 1; uint8_t bitlen = 0;
while(lo2>1){ //find last bit set to 1 (format len bit) uint32_t fc = 0;
lo2=lo2>>1; uint32_t cardnum = 0;
idx3++;
} if ((( hi >> 5 ) & 1) ==1){//if bit 38 is set then < 37 bit format is used
bitlen =idx3+19; uint32_t lo2 = 0;
fc =0; lo2 = (((hi & 31) << 12) | (lo >> 20)); //get bits 21-37 to check for format len bit
cardnum=0; uint8_t idx3 = 1;
if(bitlen==26){ while(lo2 > 1){ //find last bit set to 1 (format len bit)
cardnum = (lo>>1)&0xFFFF; lo2 = lo2 >> 1;
fc = (lo>>17)&0xFF; idx3++;
} }
if(bitlen==37){ bitlen =idx3 + 19;
cardnum = (lo>>1)&0x7FFFF; fc = 0;
fc = ((hi&0xF)<<12)|(lo>>20); cardnum = 0;
} if(bitlen == 26){
if(bitlen==34){ cardnum = (lo >> 1) & 0xFFFF;
cardnum = (lo>>1)&0xFFFF; fc = (lo >> 17) & 0xFF;
fc= ((hi&1)<<15)|(lo>>17); }
} if(bitlen == 37){
if(bitlen==35){ cardnum = (lo >> 1) & 0x7FFFF;
cardnum = (lo>>1)&0xFFFFF; fc = ((hi & 0xF) << 12)|( lo >> 20);
fc = ((hi&1)<<11)|(lo>>21); }
} if(bitlen == 34){
} cardnum = (lo >> 1) & 0xFFFF;
else { //if bit 38 is not set then 37 bit format is used fc = ((hi & 1) << 15) | (lo >> 17);
bitlen= 37; }
fc =0; if(bitlen == 35){
cardnum=0; cardnum = (lo >> 1 ) & 0xFFFFF;
if(bitlen==37){ fc = ((hi & 1) << 11 ) | ( lo >> 21);
cardnum = (lo>>1)&0x7FFFF; }
fc = ((hi&0xF)<<12)|(lo>>20);
}
}
//Dbprintf("TAG ID: %x%08x (%d)",
// (unsigned int) hi, (unsigned int) lo, (unsigned int) (lo>>1) & 0xFFFF);
Dbprintf("TAG ID: %x%08x (%d) - Format Len: %dbit - FC: %d - Card: %d",
(unsigned int) hi, (unsigned int) lo, (unsigned int) (lo>>1) & 0xFFFF,
(unsigned int) bitlen, (unsigned int) fc, (unsigned int) cardnum);
}
if (findone){
if (ledcontrol) LED_A_OFF();
return;
} }
// reset else { //if bit 38 is not set then 37 bit format is used
hi2 = hi = lo = 0; bitlen = 37;
fc = 0;
cardnum = 0;
if(bitlen == 37){
cardnum = ( lo >> 1) & 0x7FFFF;
fc = ((hi & 0xF) << 12 ) |(lo >> 20);
}
}
Dbprintf("TAG ID: %x%08x (%d) - Format Len: %dbit - FC: %d - Card: %d",
(unsigned int) hi,
(unsigned int) lo,
(unsigned int) (lo >> 1) & 0xFFFF,
(unsigned int) bitlen,
(unsigned int) fc,
(unsigned int) cardnum);
}
if (findone){
if (ledcontrol) LED_A_OFF();
return;
}
// reset
hi2 = hi = lo = 0;
} }
WDT_HIT(); WDT_HIT();
//SpinDelay(50);
} }
DbpString("Stopped"); DbpString("Stopped");
if (ledcontrol) LED_A_OFF(); if (ledcontrol) LED_A_OFF();
@ -818,13 +819,12 @@ void CmdHIDdemodFSK(int findone, int *high, int *low, int ledcontrol)
void CmdEM410xdemod(int findone, int *high, int *low, int ledcontrol) void CmdEM410xdemod(int findone, int *high, int *low, int ledcontrol)
{ {
uint8_t *dest = (uint8_t *)BigBuf; uint8_t *dest = (uint8_t *)BigBuf;
uint32_t bitLen = 0;
size_t size=0; //, found=0; int clk = 0, invert = 0, errCnt = 0;
uint32_t bitLen=0; uint64_t lo = 0;
int clk=0, invert=0, errCnt=0;
uint64_t lo=0;
// Configure to go in 125Khz listen mode // Configure to go in 125Khz listen mode
LFSetupFPGAForADC(95, true); LFSetupFPGAForADC(0, true);
while(!BUTTON_PRESS()) { while(!BUTTON_PRESS()) {
@ -832,37 +832,33 @@ void CmdEM410xdemod(int findone, int *high, int *low, int ledcontrol)
if (ledcontrol) LED_A_ON(); if (ledcontrol) LED_A_ON();
DoAcquisition125k_internal(-1,true); DoAcquisition125k_internal(-1,true);
size = sizeof(BigBuf);
if (size < 2000) continue;
// FSK demodulator // FSK demodulator
//int askmandemod(uint8_t *BinStream,uint32_t *BitLen,int *clk, int *invert); bitLen = BIGBUF_SIZE;
bitLen=size; errCnt = askmandemod(dest,&bitLen,&clk,&invert);
//Dbprintf("DEBUG: Buffer got"); if ( errCnt < 0 ) continue;
errCnt = askmandemod(dest,&bitLen,&clk,&invert); //HIDdemodFSK(dest,size,&hi2,&hi,&lo);
//Dbprintf("DEBUG: ASK Got");
WDT_HIT();
if (errCnt>=0){
lo = Em410xDecode(dest,bitLen);
//Dbprintf("DEBUG: EM GOT");
//printEM410x(lo);
if (lo>0){
Dbprintf("EM TAG ID: %02x%08x - (%05d_%03d_%08d)",(uint32_t)(lo>>32),(uint32_t)lo,(uint32_t)(lo&0xFFFF),(uint32_t)((lo>>16LL) & 0xFF),(uint32_t)(lo & 0xFFFFFF));
}
if (findone){
if (ledcontrol) LED_A_OFF();
return;
}
} else {
//Dbprintf("DEBUG: No Tag");
}
WDT_HIT(); WDT_HIT();
lo = 0;
clk=0; lo = Em410xDecode(dest,bitLen);
invert=0;
errCnt=0; if ( lo <= 0) continue;
size=0;
//SpinDelay(50); Dbprintf("EM TAG ID: %02x%08x - (%05d_%03d_%08d)",
(uint32_t)(lo >> 32),
(uint32_t)lo,
(uint32_t)(lo & 0xFFFF),
(uint32_t)((lo >> 16LL) & 0xFF),
(uint32_t)(lo & 0xFFFFFF)
);
if (findone){
if (ledcontrol) LED_A_OFF();
return;
}
WDT_HIT();
lo = clk = invert = errCnt = 0;
} }
DbpString("Stopped"); DbpString("Stopped");
if (ledcontrol) LED_A_OFF(); if (ledcontrol) LED_A_OFF();
@ -871,30 +867,27 @@ void CmdEM410xdemod(int findone, int *high, int *low, int ledcontrol)
void CmdIOdemodFSK(int findone, int *high, int *low, int ledcontrol) void CmdIOdemodFSK(int findone, int *high, int *low, int ledcontrol)
{ {
uint8_t *dest = (uint8_t *)BigBuf; uint8_t *dest = (uint8_t *)BigBuf;
size_t size=0; int idx = 0;
int idx=0; uint32_t code = 0, code2 = 0;
uint32_t code=0, code2=0; uint8_t version = 0;
uint8_t version=0; uint8_t facilitycode = 0;
uint8_t facilitycode=0; uint16_t number = 0;
uint16_t number=0;
// Configure to go in 125Khz listen mode
LFSetupFPGAForADC(0, true); LFSetupFPGAForADC(0, true);
while(!BUTTON_PRESS()) { while(!BUTTON_PRESS()) {
WDT_HIT(); WDT_HIT();
if (ledcontrol) LED_A_ON(); if (ledcontrol) LED_A_ON();
DoAcquisition125k_internal(-1,true); DoAcquisition125k_internal(-1, true);
size = sizeof(BigBuf);
//make sure buffer has data idx = IOdemodFSK(dest, BIGBUF_SIZE);
if (size < 2000) continue;
//fskdemod and get start index if ( idx < 0 )
WDT_HIT(); continue;
idx = IOdemodFSK(dest,size);
if (idx>0){ WDT_HIT();
//valid tag found
//Index map //Index map
//0 10 20 30 40 50 60 //0 10 20 30 40 50 60
@ -905,34 +898,34 @@ void CmdIOdemodFSK(int findone, int *high, int *low, int ledcontrol)
// //
//XSF(version)facility:codeone+codetwo //XSF(version)facility:codeone+codetwo
//Handle the data //Handle the data
if(findone){ //only print binary if we are doing one
Dbprintf("%d%d%d%d%d%d%d%d %d",dest[idx], dest[idx+1], dest[idx+2],dest[idx+3],dest[idx+4],dest[idx+5],dest[idx+6],dest[idx+7],dest[idx+8]);
Dbprintf("%d%d%d%d%d%d%d%d %d",dest[idx+9], dest[idx+10],dest[idx+11],dest[idx+12],dest[idx+13],dest[idx+14],dest[idx+15],dest[idx+16],dest[idx+17]);
Dbprintf("%d%d%d%d%d%d%d%d %d",dest[idx+18],dest[idx+19],dest[idx+20],dest[idx+21],dest[idx+22],dest[idx+23],dest[idx+24],dest[idx+25],dest[idx+26]);
Dbprintf("%d%d%d%d%d%d%d%d %d",dest[idx+27],dest[idx+28],dest[idx+29],dest[idx+30],dest[idx+31],dest[idx+32],dest[idx+33],dest[idx+34],dest[idx+35]);
Dbprintf("%d%d%d%d%d%d%d%d %d",dest[idx+36],dest[idx+37],dest[idx+38],dest[idx+39],dest[idx+40],dest[idx+41],dest[idx+42],dest[idx+43],dest[idx+44]);
Dbprintf("%d%d%d%d%d%d%d%d %d",dest[idx+45],dest[idx+46],dest[idx+47],dest[idx+48],dest[idx+49],dest[idx+50],dest[idx+51],dest[idx+52],dest[idx+53]);
Dbprintf("%d%d%d%d%d%d%d%d %d%d",dest[idx+54],dest[idx+55],dest[idx+56],dest[idx+57],dest[idx+58],dest[idx+59],dest[idx+60],dest[idx+61],dest[idx+62],dest[idx+63]);
}
code = bytebits_to_byte(dest+idx,32);
code2 = bytebits_to_byte(dest+idx+32,32);
version = bytebits_to_byte(dest+idx+27,8); //14,4
facilitycode = bytebits_to_byte(dest+idx+18,8) ;
number = (bytebits_to_byte(dest+idx+36,8)<<8)|(bytebits_to_byte(dest+idx+45,8)); //36,9
Dbprintf("XSF(%02d)%02x:%05d (%08x%08x)",version,facilitycode,number,code,code2); if(findone){ //only print binary if we are doing one
// if we're only looking for one tag Dbprintf("%d%d%d%d%d%d%d%d %d",dest[idx], dest[idx+1], dest[idx+2],dest[idx+3],dest[idx+4],dest[idx+5],dest[idx+6],dest[idx+7],dest[idx+8]);
if (findone){ Dbprintf("%d%d%d%d%d%d%d%d %d",dest[idx+9], dest[idx+10],dest[idx+11],dest[idx+12],dest[idx+13],dest[idx+14],dest[idx+15],dest[idx+16],dest[idx+17]);
if (ledcontrol) LED_A_OFF(); Dbprintf("%d%d%d%d%d%d%d%d %d",dest[idx+18],dest[idx+19],dest[idx+20],dest[idx+21],dest[idx+22],dest[idx+23],dest[idx+24],dest[idx+25],dest[idx+26]);
return; Dbprintf("%d%d%d%d%d%d%d%d %d",dest[idx+27],dest[idx+28],dest[idx+29],dest[idx+30],dest[idx+31],dest[idx+32],dest[idx+33],dest[idx+34],dest[idx+35]);
} Dbprintf("%d%d%d%d%d%d%d%d %d",dest[idx+36],dest[idx+37],dest[idx+38],dest[idx+39],dest[idx+40],dest[idx+41],dest[idx+42],dest[idx+43],dest[idx+44]);
code=code2=0; Dbprintf("%d%d%d%d%d%d%d%d %d",dest[idx+45],dest[idx+46],dest[idx+47],dest[idx+48],dest[idx+49],dest[idx+50],dest[idx+51],dest[idx+52],dest[idx+53]);
version=facilitycode=0; Dbprintf("%d%d%d%d%d%d%d%d %d%d",dest[idx+54],dest[idx+55],dest[idx+56],dest[idx+57],dest[idx+58],dest[idx+59],dest[idx+60],dest[idx+61],dest[idx+62],dest[idx+63]);
number=0;
idx=0;
} }
WDT_HIT();
code = bytebits_to_byte(dest+idx,32);
code2 = bytebits_to_byte(dest+idx+32,32);
version = bytebits_to_byte(dest+idx+27,8); //14,4
facilitycode = bytebits_to_byte(dest+idx+18,8) ;
number = (bytebits_to_byte(dest+idx+36,8)<<8)|(bytebits_to_byte(dest+idx+45,8)); //36,9
Dbprintf("XSF(%02d)%02x:%05d (%08x%08x)", version, facilitycode, number, code, code2);
if (findone){
if (ledcontrol) LED_A_OFF();
return;
}
code = code2 = 0;
version = facilitycode = 0;
number = 0;
idx = 0;
} }
DbpString("Stopped"); DbpString("Stopped");
if (ledcontrol) LED_A_OFF(); if (ledcontrol) LED_A_OFF();
} }

889
client/cmddata.c
View file

File diff suppressed because it is too large Load diff

58
client/cmdlf.c
View file

@ -375,6 +375,8 @@ int CmdLFRead(const char *Cmd)
// load samples // load samples
CmdSamples(""); CmdSamples("");
// show plot
ShowGraphWindow();
return 0; return 0;
} }
@ -460,36 +462,38 @@ int CmdLFSimManchester(const char *Cmd)
int CmdLFSnoop(const char *Cmd) int CmdLFSnoop(const char *Cmd)
{ {
UsbCommand c = {CMD_LF_SNOOP_RAW_ADC_SAMPLES}; UsbCommand c = {CMD_LF_SNOOP_RAW_ADC_SAMPLES};
// 'h' means higher-low-frequency, 134 kHz
c.arg[0] = 0;
c.arg[1] = -1;
if (*Cmd == 0) {
// empty
} else if (*Cmd == 'l') {
sscanf(Cmd, "l %"lli, &c.arg[1]);
} else if(*Cmd == 'h') {
c.arg[0] = 1;
sscanf(Cmd, "h %"lli, &c.arg[1]);
} else if (sscanf(Cmd, "%"lli" %"lli, &c.arg[0], &c.arg[1]) < 1) {
PrintAndLog("use 'snoop' or 'snoop {l,h} [trigger threshold]', or 'snoop <divisor> [trigger threshold]'");
return 0;
}
SendCommand(&c);
WaitForResponse(CMD_ACK,NULL);
size_t BUFF_SIZE = 8000;
uint8_t data[BUFF_SIZE];
GetFromBigBuf(data,BUFF_SIZE,3560); //3560 -- should be offset.. // 'h' means higher-low-frequency, 134 kHz
WaitForResponseTimeout(CMD_ACK,NULL, 1500); c.arg[0] = 0;
c.arg[1] = -1;
if (*Cmd == 'l') {
sscanf(Cmd, "l %"lli, &c.arg[1]);
} else if (*Cmd == 'h') {
c.arg[0] = 1;
sscanf(Cmd, "h %"lli, &c.arg[1]);
} else if (sscanf(Cmd, "%"lli" %"lli, &c.arg[0], &c.arg[1]) < 1) {
PrintAndLog("use 'snoop' or 'snoop {l,h} [trigger threshold]', or 'snoop <divisor> [trigger threshold]'");
return 0;
}
SendCommand(&c);
WaitForResponse(CMD_ACK,NULL);
size_t BUFF_SIZE = 8000;
uint8_t data[BUFF_SIZE];
GetFromBigBuf(data,BUFF_SIZE,0); //3560 -- should be offset..
WaitForResponseTimeout(CMD_ACK,NULL, 1500);
for (int j = 0; j < BUFF_SIZE; j++) { for (int j = 0; j < BUFF_SIZE; j++) {
GraphBuffer[j] = ((int)data[j]); GraphBuffer[j] = ((int)data[j]);
} }
GraphTraceLen = BUFF_SIZE; GraphTraceLen = BUFF_SIZE;
return 0; return 0;
} }
int CmdVchDemod(const char *Cmd) int CmdVchDemod(const char *Cmd)
@ -575,8 +579,8 @@ int CmdLFfind(const char *Cmd)
char cmdp = param_getchar(Cmd, 0); char cmdp = param_getchar(Cmd, 0);
if (strlen(Cmd) > 1 || cmdp == 'h' || cmdp == 'H') { if (strlen(Cmd) > 1 || cmdp == 'h' || cmdp == 'H') {
PrintAndLog("Usage: lf search [use data from Graphbuffer]"); PrintAndLog("Usage: lf search <0|1>");
PrintAndLog(" [use data from Graphbuffer], if not set, try reading data from tag."); PrintAndLog(" <use data from Graphbuffer>, if not set, try reading data from tag.");
PrintAndLog(""); PrintAndLog("");
PrintAndLog(" sample: lf search"); PrintAndLog(" sample: lf search");
PrintAndLog(" : lf search 1"); PrintAndLog(" : lf search 1");
@ -585,7 +589,7 @@ int CmdLFfind(const char *Cmd)
if (!offline || (cmdp != '1') ){ if (!offline || (cmdp != '1') ){
ans = CmdLFRead(""); ans = CmdLFRead("");
} else if (GraphTraceLen<1000) { } else if (GraphTraceLen < 1000) {
PrintAndLog("Data in Graphbuffer was too small."); PrintAndLog("Data in Graphbuffer was too small.");
return 0; return 0;
} }

64
client/cmdlfem4x.c
View file

@ -28,20 +28,16 @@ char *global_em410xId;
static int CmdHelp(const char *Cmd); static int CmdHelp(const char *Cmd);
int CmdEMdemodASK(const char *Cmd) int CmdEMdemodASK(const char *Cmd)
{ {
int findone=0; char cmdp = param_getchar(Cmd, 0);
UsbCommand c={CMD_EM410X_DEMOD}; int findone = (cmdp == '1') ? 1 : 0;
if(Cmd[0]=='1') findone=1; UsbCommand c = { CMD_EM410X_DEMOD };
c.arg[0]=findone; c.arg[0] = findone;
SendCommand(&c); SendCommand(&c);
return 0; return 0;
} }
/* Read the ID of an EM410x tag. /* Read the ID of an EM410x tag.
* Format: * Format:
* 1111 1111 1 <-- standard non-repeatable header * 1111 1111 1 <-- standard non-repeatable header
@ -54,29 +50,25 @@ int CmdEM410xRead(const char *Cmd)
{ {
int i, j, clock, header, rows, bit, hithigh, hitlow, first, bit2idx, high, low; int i, j, clock, header, rows, bit, hithigh, hitlow, first, bit2idx, high, low;
int parity[4]; int parity[4];
char id[11]; char id[11] = {0x00};
char id2[11]; char id2[11] = {0x00};
int retested = 0; int retested = 0;
uint8_t BitStream[MAX_GRAPH_TRACE_LEN]; uint8_t BitStream[MAX_GRAPH_TRACE_LEN];
high = low = 0; high = low = 0;
/* Detect high and lows and clock */ // get clock
for (i = 0; i < GraphTraceLen; i++) clock = GetClock(Cmd, 0);
{
if (GraphBuffer[i] > high) // Detect high and lows and clock
high = GraphBuffer[i]; DetectHighLowInGraph( &high, &low, TRUE);
else if (GraphBuffer[i] < low)
low = GraphBuffer[i];
}
/* get clock */ PrintAndLog("NUMNUM");
clock = GetClock(Cmd, high, 0);
// parity for our 4 columns
/* parity for our 4 columns */
parity[0] = parity[1] = parity[2] = parity[3] = 0; parity[0] = parity[1] = parity[2] = parity[3] = 0;
header = rows = 0; header = rows = 0;
/* manchester demodulate */ // manchester demodulate
bit = bit2idx = 0; bit = bit2idx = 0;
for (i = 0; i < (int)(GraphTraceLen / clock); i++) for (i = 0; i < (int)(GraphTraceLen / clock); i++)
{ {
@ -87,9 +79,9 @@ int CmdEM410xRead(const char *Cmd)
/* Find out if we hit both high and low peaks */ /* Find out if we hit both high and low peaks */
for (j = 0; j < clock; j++) for (j = 0; j < clock; j++)
{ {
if (GraphBuffer[(i * clock) + j] == high) if (GraphBuffer[(i * clock) + j] >= high)
hithigh = 1; hithigh = 1;
else if (GraphBuffer[(i * clock) + j] == low) else if (GraphBuffer[(i * clock) + j] <= low)
hitlow = 1; hitlow = 1;
/* it doesn't count if it's the first part of our read /* it doesn't count if it's the first part of our read
@ -109,7 +101,7 @@ int CmdEM410xRead(const char *Cmd)
BitStream[bit2idx++] = bit; BitStream[bit2idx++] = bit;
} }
retest: retest:
/* We go till 5 before the graph ends because we'll get that far below */ /* We go till 5 before the graph ends because we'll get that far below */
for (i = 0; i < bit2idx - 5; i++) for (i = 0; i < bit2idx - 5; i++)
@ -189,13 +181,14 @@ retest:
} }
/* if we've already retested after flipping bits, return */ /* if we've already retested after flipping bits, return */
if (retested++){ if (retested++){
return 0; PrintAndLog("Failed to decode");
return 0;
} }
/* if this didn't work, try flipping bits */ /* if this didn't work, try flipping bits */
for (i = 0; i < bit2idx; i++) for (i = 0; i < bit2idx; i++)
BitStream[i] ^= 1; BitStream[i] ^= 1;
goto retest; goto retest;
} }
@ -290,7 +283,8 @@ int CmdEM410xSim(const char *Cmd)
*/ */
int CmdEM410xWatch(const char *Cmd) int CmdEM410xWatch(const char *Cmd)
{ {
int read_h = (*Cmd == 'h'); char cmdp = param_getchar(Cmd, 0);
int read_h = (cmdp == 'h');
do do
{ {
if (ukbhit()) { if (ukbhit()) {
@ -551,7 +545,7 @@ int CmdReadWord(const char *Cmd)
uint8_t data[LF_TRACE_BUFF_SIZE] = {0x00}; uint8_t data[LF_TRACE_BUFF_SIZE] = {0x00};
GetFromBigBuf(data,LF_TRACE_BUFF_SIZE,3560); //3560 -- should be offset.. GetFromBigBuf(data,LF_TRACE_BUFF_SIZE,0); //3560 -- should be offset..
WaitForResponseTimeout(CMD_ACK,NULL, 1500); WaitForResponseTimeout(CMD_ACK,NULL, 1500);
for (int j = 0; j < LF_TRACE_BUFF_SIZE; j++) { for (int j = 0; j < LF_TRACE_BUFF_SIZE; j++) {
@ -591,7 +585,7 @@ int CmdReadWordPWD(const char *Cmd)
uint8_t data[LF_TRACE_BUFF_SIZE] = {0x00}; uint8_t data[LF_TRACE_BUFF_SIZE] = {0x00};
GetFromBigBuf(data,LF_TRACE_BUFF_SIZE,3560); //3560 -- should be offset.. GetFromBigBuf(data,LF_TRACE_BUFF_SIZE,0); //3560 -- should be offset..
WaitForResponseTimeout(CMD_ACK,NULL, 1500); WaitForResponseTimeout(CMD_ACK,NULL, 1500);
for (int j = 0; j < LF_TRACE_BUFF_SIZE; j++) { for (int j = 0; j < LF_TRACE_BUFF_SIZE; j++) {

53
client/cmdlft55xx.c
View file

@ -22,7 +22,7 @@
#include "data.h" #include "data.h"
#define LF_TRACE_BUFF_SIZE 12000 // 32 x 32 x 10 (32 bit times numofblock (7), times clock skip..) #define LF_TRACE_BUFF_SIZE 20000 // 32 x 32 x 10 (32 bit times numofblock (7), times clock skip..)
#define LF_BITSSTREAM_LEN 1000 // more then 1000 bits shouldn't happend.. 8block * 4 bytes * 8bits = #define LF_BITSSTREAM_LEN 1000 // more then 1000 bits shouldn't happend.. 8block * 4 bytes * 8bits =
static int CmdHelp(const char *Cmd); static int CmdHelp(const char *Cmd);
@ -48,7 +48,7 @@ int CmdReadBlk(const char *Cmd)
uint8_t data[LF_TRACE_BUFF_SIZE] = {0x00}; uint8_t data[LF_TRACE_BUFF_SIZE] = {0x00};
GetFromBigBuf(data,LF_TRACE_BUFF_SIZE,3560); //3560 -- should be offset.. GetFromBigBuf(data,LF_TRACE_BUFF_SIZE,0); //3560 -- should be offset..
WaitForResponseTimeout(CMD_ACK,NULL, 1500); WaitForResponseTimeout(CMD_ACK,NULL, 1500);
for (int j = 0; j < LF_TRACE_BUFF_SIZE; j++) { for (int j = 0; j < LF_TRACE_BUFF_SIZE; j++) {
@ -85,7 +85,7 @@ int CmdReadBlkPWD(const char *Cmd)
uint8_t data[LF_TRACE_BUFF_SIZE] = {0x00}; uint8_t data[LF_TRACE_BUFF_SIZE] = {0x00};
GetFromBigBuf(data,LF_TRACE_BUFF_SIZE,3560); //3560 -- should be offset.. GetFromBigBuf(data,LF_TRACE_BUFF_SIZE,0); //3560 -- should be offset..
WaitForResponseTimeout(CMD_ACK,NULL, 1500); WaitForResponseTimeout(CMD_ACK,NULL, 1500);
for (int j = 0; j < LF_TRACE_BUFF_SIZE; j++) { for (int j = 0; j < LF_TRACE_BUFF_SIZE; j++) {
@ -166,7 +166,7 @@ int CmdReadTrace(const char *Cmd)
uint8_t data[LF_TRACE_BUFF_SIZE] = {0x00}; uint8_t data[LF_TRACE_BUFF_SIZE] = {0x00};
GetFromBigBuf(data,LF_TRACE_BUFF_SIZE,3560); //3560 -- should be offset.. GetFromBigBuf(data,LF_TRACE_BUFF_SIZE,0); //3560 -- should be offset..
WaitForResponseTimeout(CMD_ACK,NULL, 1500); WaitForResponseTimeout(CMD_ACK,NULL, 1500);
for (int j = 0; j < LF_TRACE_BUFF_SIZE; j++) { for (int j = 0; j < LF_TRACE_BUFF_SIZE; j++) {
@ -249,32 +249,31 @@ int CmdInfo(const char *Cmd){
return 0; return 0;
} }
if ( strlen(Cmd)==0){ if ( strlen(Cmd) == 0 ){
CmdReadBlk("0"); CmdReadBlk("0");
} }
uint8_t bits[LF_BITSSTREAM_LEN] = {0x00}; uint8_t bits[LF_BITSSTREAM_LEN] = {0x00};
uint8_t * bitstream = bits;
manchester_decode(GraphBuffer, LF_TRACE_BUFF_SIZE, bits, LF_BITSSTREAM_LEN);
manchester_decode(GraphBuffer, LF_TRACE_BUFF_SIZE, bitstream, LF_BITSSTREAM_LEN);
uint8_t si = 5; uint8_t si = 5;
uint32_t bl0 = PackBits(si, 32, bitstream); uint32_t bl0 = PackBits(si, 32, bits);
uint32_t safer = PackBits(si, 4, bitstream); si += 4; uint32_t safer = PackBits(si, 4, bits); si += 4;
uint32_t resv = PackBits(si, 7, bitstream); si += 7; uint32_t resv = PackBits(si, 7, bits); si += 7;
uint32_t dbr = PackBits(si, 3, bitstream); si += 3; uint32_t dbr = PackBits(si, 3, bits); si += 3;
uint32_t extend = PackBits(si, 1, bitstream); si += 1; uint32_t extend = PackBits(si, 1, bits); si += 1;
uint32_t datamodulation = PackBits(si, 5, bitstream); si += 5; uint32_t datamodulation = PackBits(si, 5, bits); si += 5;
uint32_t pskcf = PackBits(si, 2, bitstream); si += 2; uint32_t pskcf = PackBits(si, 2, bits); si += 2;
uint32_t aor = PackBits(si, 1, bitstream); si += 1; uint32_t aor = PackBits(si, 1, bits); si += 1;
uint32_t otp = PackBits(si, 1, bitstream); si += 1; uint32_t otp = PackBits(si, 1, bits); si += 1;
uint32_t maxblk = PackBits(si, 3, bitstream); si += 3; uint32_t maxblk = PackBits(si, 3, bits); si += 3;
uint32_t pwd = PackBits(si, 1, bitstream); si += 1; uint32_t pwd = PackBits(si, 1, bits); si += 1;
uint32_t sst = PackBits(si, 1, bitstream); si += 1; uint32_t sst = PackBits(si, 1, bits); si += 1;
uint32_t fw = PackBits(si, 1, bitstream); si += 1; uint32_t fw = PackBits(si, 1, bits); si += 1;
uint32_t inv = PackBits(si, 1, bitstream); si += 1; uint32_t inv = PackBits(si, 1, bits); si += 1;
uint32_t por = PackBits(si, 1, bitstream); si += 1; uint32_t por = PackBits(si, 1, bits); si += 1;
PrintAndLog(""); PrintAndLog("");
PrintAndLog("-- T55xx Configuration --------------------------------------"); PrintAndLog("-- T55xx Configuration --------------------------------------");
@ -295,7 +294,7 @@ int CmdInfo(const char *Cmd){
PrintAndLog(" POR-Delay : %s", (por) ? "Yes":"No"); PrintAndLog(" POR-Delay : %s", (por) ? "Yes":"No");
PrintAndLog("-------------------------------------------------------------"); PrintAndLog("-------------------------------------------------------------");
PrintAndLog(" Raw Data - Page 0"); PrintAndLog(" Raw Data - Page 0");
PrintAndLog(" Block 0 : 0x%08X %s", bl0, sprint_bin(bitstream+5,32) ); PrintAndLog(" Block 0 : 0x%08X %s", bl0, sprint_bin(bits+5,32) );
PrintAndLog("-------------------------------------------------------------"); PrintAndLog("-------------------------------------------------------------");
return 0; return 0;
@ -357,8 +356,10 @@ int ManchesterDemod(int blockNum){
uint8_t bits[LF_BITSSTREAM_LEN] = {0x00}; uint8_t bits[LF_BITSSTREAM_LEN] = {0x00};
uint8_t * bitstream = bits; uint8_t * bitstream = bits;
manchester_decode(GraphBuffer, LF_TRACE_BUFF_SIZE, bitstream, LF_BITSSTREAM_LEN); //manchester_decode(GraphBuffer, LF_TRACE_BUFF_SIZE, bitstream, LF_BITSSTREAM_LEN);
blockData = PackBits(offset, sizebyte, bitstream); manchester_decode(GraphBuffer, LF_TRACE_BUFF_SIZE, bits, LF_BITSSTREAM_LEN);
//blockData = PackBits(offset, sizebyte, bitstream);
blockData = PackBits(offset, sizebyte, bits);
if ( blockNum < 0) if ( blockNum < 0)
PrintAndLog(" Decoded : 0x%08X %s", blockData, sprint_bin(bitstream+offset,sizebyte) ); PrintAndLog(" Decoded : 0x%08X %s", blockData, sprint_bin(bitstream+offset,sizebyte) );

204
client/graph.c
View file

@ -49,151 +49,69 @@ int ClearGraph(int redraw)
return gtl; return gtl;
} }
/* void SetGraphBuf(uint8_t *buff, int size)
* Detect clock rate
*/
//decommissioned - has difficulty detecting rf/32
/*
int DetectClockOld(int peak)
{ {
int i; if ( buff == NULL ) return;
int clock = 0xFFFF;
int lastpeak = 0;
// Detect peak if we don't have one
if (!peak)
for (i = 0; i < GraphTraceLen; ++i)
if (GraphBuffer[i] > peak)
peak = GraphBuffer[i];
// peak=(int)(peak*.75);
for (i = 1; i < GraphTraceLen; ++i)
{
// If this is the beginning of a peak
if (GraphBuffer[i - 1] != GraphBuffer[i] && GraphBuffer[i] >= peak)
{
// Find lowest difference between peaks
if (lastpeak && i - lastpeak < clock)
clock = i - lastpeak;
lastpeak = i;
}
}
return clock; uint16_t i = 0;
if ( size > MAX_GRAPH_TRACE_LEN )
size = MAX_GRAPH_TRACE_LEN;
ClearGraph(0);
for (; i < size; ++i){
GraphBuffer[i] = buff[i];
}
GraphTraceLen = size;
RepaintGraphWindow();
return;
} }
*/
/*
NOW IN LFDEMOD.C
// by marshmellow // Copies grahpbuff to buff.
// not perfect especially with lower clocks or VERY good antennas (heavy wave clipping) // while triming values to the range -127 -- 127.
// maybe somehow adjust peak trimming value based on samples to fix? int GetFromGraphBuf(uint8_t *buff)
int DetectASKClock(int peak)
{
int i=0;
int low=0;
int clk[]={16,32,40,50,64,100,128,256};
int loopCnt = 256;
if (GraphTraceLen<loopCnt) loopCnt = GraphTraceLen;
if (!peak){
for (i=0;i<loopCnt;++i){
if(GraphBuffer[i]>peak){
peak = GraphBuffer[i];
}
if(GraphBuffer[i]<low){
low = GraphBuffer[i];
}
}
peak=(int)(peak*.75);
low= (int)(low*.75);
}
int ii;
int clkCnt;
int tol = 0;
int bestErr=1000;
int errCnt[]={0,0,0,0,0,0,0,0};
for(clkCnt=0; clkCnt<6;++clkCnt){
if (clk[clkCnt]==32){
tol=1;
}else{
tol=0;
}
bestErr=1000;
for (ii=0; ii<loopCnt; ++ii){
if ((GraphBuffer[ii]>=peak) || (GraphBuffer[ii]<=low)){
errCnt[clkCnt]=0;
for (i=0; i<((int)(GraphTraceLen/clk[clkCnt])-1); ++i){
if (GraphBuffer[ii+(i*clk[clkCnt])]>=peak || GraphBuffer[ii+(i*clk[clkCnt])]<=low){
}else if(GraphBuffer[ii+(i*clk[clkCnt])-tol]>=peak || GraphBuffer[ii+(i*clk[clkCnt])-tol]<=low){
}else if(GraphBuffer[ii+(i*clk[clkCnt])+tol]>=peak || GraphBuffer[ii+(i*clk[clkCnt])+tol]<=low){
}else{ //error no peak detected
errCnt[clkCnt]++;
}
}
if(errCnt[clkCnt]==0) return clk[clkCnt];
if(errCnt[clkCnt]<bestErr) bestErr=errCnt[clkCnt];
}
}
}
int iii=0;
int best=0;
for (iii=0; iii<6;++iii){
if (errCnt[iii]<errCnt[best]){
best = iii;
}
}
// PrintAndLog("DEBUG: clkCnt: %d, ii: %d, i: %d peak: %d, low: %d, errcnt: %d, errCnt64: %d",clkCnt,ii,i,peak,low,errCnt[best],errCnt[4]);
return clk[best];
}
*/
void setGraphBuf(uint8_t *buff,int size)
{ {
int i=0; if ( buff == NULL ) return -1;
ClearGraph(0); uint32_t i = 0;
for (; i < size; ++i){
GraphBuffer[i]=buff[i]; for (; i < GraphTraceLen; ++i){
}
GraphTraceLen=size; // trim upper and lower values.
RepaintGraphWindow(); if (GraphBuffer[i] > 127)
return; GraphBuffer[i] = 127;
} else if (GraphBuffer[i] < -127)
int getFromGraphBuf(uint8_t *buff) GraphBuffer[i] = -127;
{
uint32_t i; buff[i] = (uint8_t)(GraphBuffer[i] + 128);
for (i=0;i<GraphTraceLen;++i){ }
if (GraphBuffer[i]>127) GraphBuffer[i]=127; //trim return i;
if (GraphBuffer[i]<-127) GraphBuffer[i]=-127; //trim
buff[i]=(uint8_t)(GraphBuffer[i]+128);
}
return i;
} }
/* Get or auto-detect clock rate */ /* Get or auto-detect clock rate */
int GetClock(const char *str, int peak, int verbose) int GetClock(const char *str, int verbose)
{ {
int clock; int clock;
sscanf(str, "%i", &clock); sscanf(str, "%i", &clock);
if (!strcmp(str, "")) if (!strcmp(str, ""))
clock = 0; clock = 0;
/* Auto-detect clock */ /* Auto-detect clock */
if (!clock) if (!clock) {
{
uint8_t grph[MAX_GRAPH_TRACE_LEN]={0};
int size = getFromGraphBuf(grph);
clock = DetectASKClock(grph,size,0);
//clock2 = DetectClock2(peak);
/* Only print this message if we're not looping something */
if (!verbose)
PrintAndLog("Auto-detected clock rate: %d", clock);
}
return clock; uint8_t grph[MAX_GRAPH_TRACE_LEN] = {0x00};
int size = GetFromGraphBuf(grph);
if ( size < 0 ) {
PrintAndLog("Failed to copy from graphbuffer");
return -1;
}
clock = DetectASKClock(grph, size, 0);
/* Only print this message if we're not looping something */
if (verbose)
PrintAndLog("Auto-detected clock rate: %d", clock);
}
return clock;
} }
// A simple test to see if there is any data inside Graphbuffer.
/* A simple test to see if there is any data inside Graphbuffer.
*/
bool HasGraphData(){ bool HasGraphData(){
if ( GraphTraceLen <= 0) { if ( GraphTraceLen <= 0) {
@ -201,4 +119,26 @@ bool HasGraphData(){
return false; return false;
} }
return true; return true;
}
// Detect high and lows in Grapbuffer.
// Only loops the first 256 values.
void DetectHighLowInGraph(int *high, int *low, bool addFuzz) {
uint8_t loopMax = 255;
if ( loopMax > GraphTraceLen)
loopMax = GraphTraceLen;
for (uint8_t i = 0; i < loopMax; ++i) {
if (GraphBuffer[i] > *high)
*high = GraphBuffer[i];
else if (GraphBuffer[i] < *low)
*low = GraphBuffer[i];
}
//12% fuzz in case highs and lows aren't clipped
if (addFuzz) {
*high = (int)(*high * .88);
*low = (int)(*low * .88);
}
} }

8
client/graph.h
View file

@ -13,11 +13,11 @@
void AppendGraph(int redraw, int clock, int bit); void AppendGraph(int redraw, int clock, int bit);
int ClearGraph(int redraw); int ClearGraph(int redraw);
//int DetectClock(int peak); int GetFromGraphBuf(uint8_t *buff);
int getFromGraphBuf(uint8_t *buff); int GetClock(const char *str, int verbose);
int GetClock(const char *str, int peak, int verbose); void SetGraphBuf(uint8_t *buff,int size);
void setGraphBuf(uint8_t *buff,int size);
bool HasGraphData(); bool HasGraphData();
void DetectHighLowInGraph(int *high, int *low, bool addFuzz);
#define MAX_GRAPH_TRACE_LEN (1024*128) #define MAX_GRAPH_TRACE_LEN (1024*128)
extern int GraphBuffer[MAX_GRAPH_TRACE_LEN]; extern int GraphBuffer[MAX_GRAPH_TRACE_LEN];

6
client/loclass/fileutils.c
View file

@ -49,8 +49,14 @@
* @return * @return
*/ */
int fileExists(const char *filename) { int fileExists(const char *filename) {
#ifdef _WIN32
struct _stat fileStat; struct _stat fileStat;
int result = _stat(filename, &fileStat); int result = _stat(filename, &fileStat);
#else
struct stat fileStat;
int result = stat(filename, &fileStat);
#endif
return result == 0; return result == 0;
} }

2
client/proxguiqt.cpp
View file

@ -280,7 +280,7 @@ void ProxWidget::paintEvent(QPaintEvent *event)
ProxWidget::ProxWidget(QWidget *parent) : QWidget(parent), GraphStart(0), GraphPixelsPerPoint(1) ProxWidget::ProxWidget(QWidget *parent) : QWidget(parent), GraphStart(0), GraphPixelsPerPoint(1)
{ {
resize(600, 500); resize(600, 300);
QPalette palette(QColor(0,0,0,0)); QPalette palette(QColor(0,0,0,0));
palette.setColor(QPalette::WindowText, QColor(255,255,255)); palette.setColor(QPalette::WindowText, QColor(255,255,255));

67
client/ui.c
View file

@ -20,13 +20,14 @@
#include "ui.h" #include "ui.h"
#include "cmdmain.h" #include "cmdmain.h"
#include "cmddata.h" #include "cmddata.h"
#include "graph.h"
//#include <liquid/liquid.h> //#include <liquid/liquid.h>
#define M_PI 3.14159265358979323846264338327 #define M_PI 3.14159265358979323846264338327
double CursorScaleFactor; double CursorScaleFactor;
int PlotGridX, PlotGridY, PlotGridXdefault= 64, PlotGridYdefault= 64; int PlotGridX, PlotGridY, PlotGridXdefault= 64, PlotGridYdefault= 64;
int offline; int offline;
int flushAfterWrite = 0; //buzzy int flushAfterWrite = 0;
extern pthread_mutex_t print_lock; extern pthread_mutex_t print_lock;
static char *logfilename = "proxmark3.log"; static char *logfilename = "proxmark3.log";
@ -37,13 +38,13 @@ void PrintAndLog(char *fmt, ...)
int saved_point; int saved_point;
va_list argptr, argptr2; va_list argptr, argptr2;
static FILE *logfile = NULL; static FILE *logfile = NULL;
static int logging=1; static int logging = 1;
// lock this section to avoid interlacing prints from different threats // lock this section to avoid interlacing prints from different threats
pthread_mutex_lock(&print_lock); pthread_mutex_lock(&print_lock);
if (logging && !logfile) { if (logging && !logfile) {
logfile=fopen(logfilename, "a"); logfile = fopen(logfilename, "a");
if (!logfile) { if (!logfile) {
fprintf(stderr, "Can't open logfile, logging disabled!\n"); fprintf(stderr, "Can't open logfile, logging disabled!\n");
logging=0; logging=0;
@ -82,8 +83,7 @@ void PrintAndLog(char *fmt, ...)
} }
va_end(argptr2); va_end(argptr2);
if (flushAfterWrite == 1) //buzzy if (flushAfterWrite == 1) {
{
fflush(NULL); fflush(NULL);
} }
//release lock //release lock
@ -98,74 +98,35 @@ void SetLogFilename(char *fn)
int manchester_decode( int * data, const size_t len, uint8_t * dataout, size_t dataoutlen){ int manchester_decode( int * data, const size_t len, uint8_t * dataout, size_t dataoutlen){
int bitlength = 0; int bitlength = 0;
int i, clock, high, low, startindex; int clock, high, low, startindex;
low = startindex = 0; low = startindex = 0;
high = 1; high = 1;
uint8_t * bitStream = (uint8_t* ) malloc(sizeof(uint8_t) * dataoutlen); uint8_t * bitStream = (uint8_t* ) malloc(sizeof(uint8_t) * dataoutlen);
memset(bitStream, 0x00, dataoutlen); memset(bitStream, 0x00, dataoutlen);
/* Detect high and lows */ /* Detect high and lows */
for (i = 0; i < len; i++) { DetectHighLowInGraph(&high, &low, TRUE);
if (data[i] > high)
high = data[i];
else if (data[i] < low)
low = data[i];
}
/* get clock */ /* get clock */
clock = GetT55x7Clock( data, len, high ); clock = GetClock("", 0);
startindex = DetectFirstTransition(data, len, high); startindex = DetectFirstTransition(data, len, high);
//PrintAndLog(" Clock : %d", clock);
if (high != 1) if (high != 1)
// decode "raw"
bitlength = ManchesterConvertFrom255(data, len, bitStream, dataoutlen, high, low, clock, startindex); bitlength = ManchesterConvertFrom255(data, len, bitStream, dataoutlen, high, low, clock, startindex);
else else
bitlength= ManchesterConvertFrom1(data, len, bitStream, dataoutlen, clock, startindex); // decode manchester
bitlength = ManchesterConvertFrom1(data, len, bitStream, dataoutlen, clock, startindex);
memcpy(dataout, bitStream, bitlength); memcpy(dataout, bitStream, bitlength);
free(bitStream); free(bitStream);
return bitlength; return bitlength;
} }
int GetT55x7Clock( const int * data, const size_t len, int peak ){
int i,lastpeak,clock;
clock = 0xFFFF;
lastpeak = 0;
/* Detect peak if we don't have one */
if (!peak) {
for (i = 0; i < len; ++i) {
if (data[i] > peak) {
peak = data[i];
}
}
}
for (i = 1; i < len; ++i) {
/* if this is the beginning of a peak */
if ( data[i-1] != data[i] && data[i] == peak) {
/* find lowest difference between peaks */
if (lastpeak && i - lastpeak < clock)
clock = i - lastpeak;
lastpeak = i;
}
}
// When detected clock is 31 or 33 then then return
int clockmod = clock%8;
if ( clockmod == 0) return clock;
if ( clockmod == 7 ) clock += 1;
else if ( clockmod == 1 ) clock -= 1;
return clock;
}
int DetectFirstTransition(const int * data, const size_t len, int threshold){ int DetectFirstTransition(const int * data, const size_t len, int threshold){
int i =0; int i = 0;
/* now look for the first threshold */ /* now look for the first threshold */
for (; i < len; ++i) { for (; i < len; ++i) {
if (data[i] == threshold) { if (data[i] == threshold) {

881
common/lfdemod.c
View file

File diff suppressed because it is too large Load diff