cvs.zerfleddert.de Git - proxmark3-svn/blobdiff

#include <stdio.h>\r

#include <string.h>\r

#include <inttypes.h>\r

#include <stdio.h>\r

#include <string.h>\r

#include <inttypes.h>\r

-//#include <time.h> //not used - marshmellow\r

#include "proxmark3.h"\r

#include "ui.h"\r

#include "graph.h"\r

#include "proxmark3.h"\r

#include "ui.h"\r

#include "graph.h"\r

#include "util.h"\r

#include "data.h"\r

#include "lfdemod.h"\r

#include "util.h"\r

#include "data.h"\r

#include "lfdemod.h"\r

-//#include "../common/crc.h" //not used - marshmellow\r

-//#include "../common/iso14443crc.h" //not used - marshmellow\r

#include "cmdhf14a.h" //for getTagInfo\r

\r

#define T55x7_CONFIGURATION_BLOCK 0x00\r

#include "cmdhf14a.h" //for getTagInfo\r

\r

#define T55x7_CONFIGURATION_BLOCK 0x00\r

#define REGULAR_READ_MODE_BLOCK 0xFF\r

\r

// Default configuration\r

#define REGULAR_READ_MODE_BLOCK 0xFF\r

\r

// Default configuration\r

-t55xx_conf_block_t config = { .modulation = DEMOD_ASK, .inverted = FALSE, .offset = 0x00, .block0 = 0x00, .Q5 = FALSE };\r

+t55xx_conf_block_t config = { .modulation = DEMOD_ASK, .inverted = false, .offset = 0x00, .block0 = 0x00, .Q5 = false };\r

\r

t55xx_conf_block_t Get_t55xx_Config(){\r

return config;\r

\r

t55xx_conf_block_t Get_t55xx_Config(){\r

return config;\r

PrintAndLog(" i [1] Invert data signal, defaults to normal");\r

PrintAndLog(" o [offset] Set offset, where data should start decode in bitstream");\r

PrintAndLog(" Q5 Set as Q5(T5555) chip instead of T55x7");\r

PrintAndLog(" i [1] Invert data signal, defaults to normal");\r

PrintAndLog(" o [offset] Set offset, where data should start decode in bitstream");\r

PrintAndLog(" Q5 Set as Q5(T5555) chip instead of T55x7");\r

+ PrintAndLog(" ST Set Sequence Terminator on");\r

PrintAndLog("");\r

PrintAndLog("Examples:");\r

PrintAndLog(" lf t55xx config d FSK - FSK demodulation");\r

PrintAndLog("");\r

PrintAndLog("Examples:");\r

PrintAndLog(" lf t55xx config d FSK - FSK demodulation");\r

return 0;\r

}\r

int usage_t55xx_write(){\r

return 0;\r

}\r

int usage_t55xx_write(){\r

- PrintAndLog("Usage: lf t55xx wr [b <block>] [d <data>] [p <password>] [1]");\r

+ PrintAndLog("Usage: lf t55xx write [b <block>] [d <data>] [p <password>] [1]");\r

PrintAndLog("Options:");\r

PrintAndLog(" b <block> - block number to write. Between 0-7");\r

PrintAndLog(" d <data> - 4 bytes of data to write (8 hex characters)");\r

PrintAndLog("Options:");\r

PrintAndLog(" b <block> - block number to write. Between 0-7");\r

PrintAndLog(" d <data> - 4 bytes of data to write (8 hex characters)");\r

PrintAndLog(" 1 - OPTIONAL write Page 1 instead of Page 0");\r

PrintAndLog("");\r

PrintAndLog("Examples:");\r

PrintAndLog(" 1 - OPTIONAL write Page 1 instead of Page 0");\r

PrintAndLog("");\r

PrintAndLog("Examples:");\r

- PrintAndLog(" lf t55xx wr b 3 d 11223344 - write 11223344 to block 3");\r

- PrintAndLog(" lf t55xx wr b 3 d 11223344 p feedbeef - write 11223344 to block 3 password feedbeef");\r

+ PrintAndLog(" lf t55xx write b 3 d 11223344 - write 11223344 to block 3");\r

+ PrintAndLog(" lf t55xx write b 3 d 11223344 p feedbeef - write 11223344 to block 3 password feedbeef");\r

PrintAndLog("");\r

return 0;\r

}\r

PrintAndLog("");\r

return 0;\r

}\r

uint8_t bitRate = 0;\r

uint8_t rates[9] = {8,16,32,40,50,64,100,128,0};\r

uint8_t cmdp = 0;\r

uint8_t bitRate = 0;\r

uint8_t rates[9] = {8,16,32,40,50,64,100,128,0};\r

uint8_t cmdp = 0;\r

- bool errors = FALSE;\r

+ bool errors = false;\r

while(param_getchar(Cmd, cmdp) != 0x00 && !errors)\r

{\r

tmp = param_getchar(Cmd, cmdp);\r

while(param_getchar(Cmd, cmdp) != 0x00 && !errors)\r

{\r

tmp = param_getchar(Cmd, cmdp);\r

break;\r

}\r

break;\r

}\r

- if (i==9) errors = TRUE;\r

+ if (i==9) errors = true;\r

}\r

cmdp+=2;\r

break;\r

}\r

cmdp+=2;\r

break;\r

config.inverted=0;\r

} else {\r

PrintAndLog("Unknown modulation '%s'", modulation);\r

config.inverted=0;\r

} else {\r

PrintAndLog("Unknown modulation '%s'", modulation);\r

- errors = TRUE;\r

+ errors = true;\r

}\r

break;\r

case 'i':\r

}\r

break;\r

case 'i':\r

break;\r

case 'Q':\r

case 'q': \r

break;\r

case 'Q':\r

case 'q': \r

- config.Q5 = TRUE;\r

+ config.Q5 = true;\r

+ cmdp++;\r

+ break;\r

+ case 'S':\r

+ case 's': \r

+ config.ST = true;\r

cmdp++;\r

break;\r

default:\r

PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd, cmdp));\r

cmdp++;\r

break;\r

default:\r

PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd, cmdp));\r

- errors = TRUE;\r

+ errors = true;\r

break;\r

}\r

break;\r

}\r

char buf[30] = {0x00};\r

char *cmdStr = buf;\r

int ans = 0;\r

char buf[30] = {0x00};\r

char *cmdStr = buf;\r

int ans = 0;\r

+ bool ST = config.ST;\r

uint8_t bitRate[8] = {8,16,32,40,50,64,100,128};\r

DemodBufferLen = 0x00;\r

\r

switch( config.modulation ){\r

case DEMOD_FSK:\r

snprintf(cmdStr, sizeof(buf),"%d %d", bitRate[config.bitrate], config.inverted );\r

uint8_t bitRate[8] = {8,16,32,40,50,64,100,128};\r

DemodBufferLen = 0x00;\r

\r

switch( config.modulation ){\r

case DEMOD_FSK:\r

snprintf(cmdStr, sizeof(buf),"%d %d", bitRate[config.bitrate], config.inverted );\r

- ans = FSKrawDemod(cmdStr, FALSE);\r

+ ans = FSKrawDemod(cmdStr, false);\r

break;\r

case DEMOD_FSK1:\r

case DEMOD_FSK1a:\r

snprintf(cmdStr, sizeof(buf),"%d %d 8 5", bitRate[config.bitrate], config.inverted );\r

break;\r

case DEMOD_FSK1:\r

case DEMOD_FSK1a:\r

snprintf(cmdStr, sizeof(buf),"%d %d 8 5", bitRate[config.bitrate], config.inverted );\r

- ans = FSKrawDemod(cmdStr, FALSE);\r

+ ans = FSKrawDemod(cmdStr, false);\r

break;\r

case DEMOD_FSK2:\r

case DEMOD_FSK2a:\r

snprintf(cmdStr, sizeof(buf),"%d %d 10 8", bitRate[config.bitrate], config.inverted );\r

break;\r

case DEMOD_FSK2:\r

case DEMOD_FSK2a:\r

snprintf(cmdStr, sizeof(buf),"%d %d 10 8", bitRate[config.bitrate], config.inverted );\r

- ans = FSKrawDemod(cmdStr, FALSE);\r

+ ans = FSKrawDemod(cmdStr, false);\r

break;\r

case DEMOD_ASK:\r

snprintf(cmdStr, sizeof(buf),"%d %d 1", bitRate[config.bitrate], config.inverted );\r

break;\r

case DEMOD_ASK:\r

snprintf(cmdStr, sizeof(buf),"%d %d 1", bitRate[config.bitrate], config.inverted );\r

- ans = ASKDemod(cmdStr, FALSE, FALSE, 1);\r

+ ans = ASKDemod_ext(cmdStr, false, false, 1, &ST);\r

break;\r

case DEMOD_PSK1:\r

// skip first 160 samples to allow antenna to settle in (psk gets inverted occasionally otherwise)\r

save_restoreGB(1);\r

CmdLtrim("160");\r

snprintf(cmdStr, sizeof(buf),"%d %d 6", bitRate[config.bitrate], config.inverted );\r

break;\r

case DEMOD_PSK1:\r

// skip first 160 samples to allow antenna to settle in (psk gets inverted occasionally otherwise)\r

save_restoreGB(1);\r

CmdLtrim("160");\r

snprintf(cmdStr, sizeof(buf),"%d %d 6", bitRate[config.bitrate], config.inverted );\r

- ans = PSKDemod(cmdStr, FALSE);\r

+ ans = PSKDemod(cmdStr, false);\r

//undo trim samples\r

save_restoreGB(0);\r

break;\r

//undo trim samples\r

save_restoreGB(0);\r

break;\r

save_restoreGB(1);\r

CmdLtrim("160");\r

snprintf(cmdStr, sizeof(buf),"%d 0 6", bitRate[config.bitrate] );\r

save_restoreGB(1);\r

CmdLtrim("160");\r

snprintf(cmdStr, sizeof(buf),"%d 0 6", bitRate[config.bitrate] );\r

- ans = PSKDemod(cmdStr, FALSE);\r

+ ans = PSKDemod(cmdStr, false);\r

psk1TOpsk2(DemodBuffer, DemodBufferLen);\r

//undo trim samples\r

save_restoreGB(0);\r

break;\r

case DEMOD_NRZ:\r

snprintf(cmdStr, sizeof(buf),"%d %d 1", bitRate[config.bitrate], config.inverted );\r

psk1TOpsk2(DemodBuffer, DemodBufferLen);\r

//undo trim samples\r

save_restoreGB(0);\r

break;\r

case DEMOD_NRZ:\r

snprintf(cmdStr, sizeof(buf),"%d %d 1", bitRate[config.bitrate], config.inverted );\r

- ans = NRZrawDemod(cmdStr, FALSE);\r

+ ans = NRZrawDemod(cmdStr, false);\r

break;\r

case DEMOD_BI:\r

case DEMOD_BIa:\r

snprintf(cmdStr, sizeof(buf),"0 %d %d 1", bitRate[config.bitrate], config.inverted );\r

break;\r

case DEMOD_BI:\r

case DEMOD_BIa:\r

snprintf(cmdStr, sizeof(buf),"0 %d %d 1", bitRate[config.bitrate], config.inverted );\r

- ans = ASKbiphaseDemod(cmdStr, FALSE);\r

+ ans = ASKbiphaseDemod(cmdStr, false);\r

break;\r

default:\r

break;\r

default:\r

- return FALSE;\r

+ return false;\r

}\r

return (bool) ans;\r

}\r

return (bool) ans;\r

}\r

DemodBufferLen = 0x00;\r

\r

// According to datasheet. Always: RF/64, not inverted, Manchester\r

DemodBufferLen = 0x00;\r

\r

// According to datasheet. Always: RF/64, not inverted, Manchester\r

- return (bool) ASKDemod("64 0 1", FALSE, FALSE, 1);\r

+ return (bool) ASKDemod("64 0 1", false, false, 1);\r

}\r

\r

int CmdT55xxDetect(const char *Cmd){\r

}\r

\r

int CmdT55xxDetect(const char *Cmd){\r

- bool errors = FALSE;\r

- bool useGB = FALSE;\r

- bool usepwd = FALSE;\r

+ bool errors = false;\r

+ bool useGB = false;\r

+ bool usepwd = false;\r

uint32_t password = 0;\r

uint8_t cmdp = 0;\r

\r

uint32_t password = 0;\r

uint8_t cmdp = 0;\r

\r

case 'p':\r

case 'P':\r

password = param_get32ex(Cmd, cmdp+1, 0, 16);\r

case 'p':\r

case 'P':\r

password = param_get32ex(Cmd, cmdp+1, 0, 16);\r

- usepwd = TRUE;\r

+ usepwd = true;\r

cmdp += 2;\r

break;\r

case '1':\r

// use Graphbuffer data\r

cmdp += 2;\r

break;\r

case '1':\r

// use Graphbuffer data\r

- useGB = TRUE;\r

+ useGB = true;\r

cmdp++;\r

break;\r

default:\r

cmdp++;\r

break;\r

default:\r

t55xx_conf_block_t tests[15];\r

int bitRate=0;\r

uint8_t fc1 = 0, fc2 = 0, clk=0;\r

t55xx_conf_block_t tests[15];\r

int bitRate=0;\r

uint8_t fc1 = 0, fc2 = 0, clk=0;\r

-\r

- if (GetFskClock("", FALSE, FALSE)){ \r

- fskClocks(&fc1, &fc2, &clk, FALSE);\r

- if ( FSKrawDemod("0 0", FALSE) && test(DEMOD_FSK, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {\r

+ if (GetFskClock("", false, false)){ \r

+ fskClocks(&fc1, &fc2, &clk, false);\r

+ if ( FSKrawDemod("0 0", false) && test(DEMOD_FSK, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {\r

tests[hits].modulation = DEMOD_FSK;\r

if (fc1==8 && fc2 == 5)\r

tests[hits].modulation = DEMOD_FSK1a;\r

else if (fc1==10 && fc2 == 8)\r

tests[hits].modulation = DEMOD_FSK2;\r

tests[hits].bitrate = bitRate;\r

tests[hits].modulation = DEMOD_FSK;\r

if (fc1==8 && fc2 == 5)\r

tests[hits].modulation = DEMOD_FSK1a;\r

else if (fc1==10 && fc2 == 8)\r

tests[hits].modulation = DEMOD_FSK2;\r

tests[hits].bitrate = bitRate;\r

- tests[hits].inverted = FALSE;\r

+ tests[hits].inverted = false;\r

tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);\r

+ tests[hits].ST = false;\r

++hits;\r

}\r

++hits;\r

}\r

- if ( FSKrawDemod("0 1", FALSE) && test(DEMOD_FSK, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {\r

+ if ( FSKrawDemod("0 1", false) && test(DEMOD_FSK, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {\r

tests[hits].modulation = DEMOD_FSK;\r

if (fc1 == 8 && fc2 == 5)\r

tests[hits].modulation = DEMOD_FSK1;\r

else if (fc1 == 10 && fc2 == 8)\r

tests[hits].modulation = DEMOD_FSK2a;\r

tests[hits].bitrate = bitRate;\r

tests[hits].modulation = DEMOD_FSK;\r

if (fc1 == 8 && fc2 == 5)\r

tests[hits].modulation = DEMOD_FSK1;\r

else if (fc1 == 10 && fc2 == 8)\r

tests[hits].modulation = DEMOD_FSK2a;\r

tests[hits].bitrate = bitRate;\r

- tests[hits].inverted = TRUE;\r

+ tests[hits].inverted = true;\r

tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);\r

+ tests[hits].ST = false;\r

++hits;\r

}\r

} else {\r

++hits;\r

}\r

} else {\r

- clk = GetAskClock("", FALSE, FALSE);\r

+ clk = GetAskClock("", false, false);\r

if (clk>0) {\r

- if ( ASKDemod("0 0 1", FALSE, FALSE, 1) && test(DEMOD_ASK, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {\r

+ tests[hits].ST = true;\r

+ if ( ASKDemod_ext("0 0 1", false, false, 1, &tests[hits].ST) && test(DEMOD_ASK, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {\r

tests[hits].modulation = DEMOD_ASK;\r

tests[hits].bitrate = bitRate;\r

tests[hits].modulation = DEMOD_ASK;\r

tests[hits].bitrate = bitRate;\r

- tests[hits].inverted = FALSE;\r

+ tests[hits].inverted = false;\r

tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);\r

++hits;\r

}\r

tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);\r

++hits;\r

}\r

- if ( ASKDemod("0 1 1", FALSE, FALSE, 1) && test(DEMOD_ASK, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {\r

+ tests[hits].ST = true;\r

+ if ( ASKDemod_ext("0 1 1", false, false, 1, &tests[hits].ST) && test(DEMOD_ASK, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {\r

tests[hits].modulation = DEMOD_ASK;\r

tests[hits].bitrate = bitRate;\r

tests[hits].modulation = DEMOD_ASK;\r

tests[hits].bitrate = bitRate;\r

- tests[hits].inverted = TRUE;\r

+ tests[hits].inverted = true;\r

tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);\r

++hits;\r

}\r

tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);\r

++hits;\r

}\r

- if ( ASKbiphaseDemod("0 0 0 2", FALSE) && test(DEMOD_BI, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5) ) {\r

+ if ( ASKbiphaseDemod("0 0 0 2", false) && test(DEMOD_BI, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5) ) {\r

tests[hits].modulation = DEMOD_BI;\r

tests[hits].bitrate = bitRate;\r

tests[hits].modulation = DEMOD_BI;\r

tests[hits].bitrate = bitRate;\r

- tests[hits].inverted = FALSE;\r

+ tests[hits].inverted = false;\r

tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);\r

+ tests[hits].ST = false;\r

++hits;\r

}\r

++hits;\r

}\r

- if ( ASKbiphaseDemod("0 0 1 2", FALSE) && test(DEMOD_BIa, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5) ) {\r

+ if ( ASKbiphaseDemod("0 0 1 2", false) && test(DEMOD_BIa, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5) ) {\r

tests[hits].modulation = DEMOD_BIa;\r

tests[hits].bitrate = bitRate;\r

tests[hits].modulation = DEMOD_BIa;\r

tests[hits].bitrate = bitRate;\r

- tests[hits].inverted = TRUE;\r

+ tests[hits].inverted = true;\r

tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);\r

+ tests[hits].ST = false;\r

++hits;\r

}\r

//undo trim from ask\r

//save_restoreGB(0);\r

++hits;\r

}\r

//undo trim from ask\r

//save_restoreGB(0);\r

- clk = GetNrzClock("", FALSE, FALSE);\r

+ clk = GetNrzClock("", false, false);\r

if (clk>0) {\r

- if ( NRZrawDemod("0 0 1", FALSE) && test(DEMOD_NRZ, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {\r

+ if ( NRZrawDemod("0 0 1", false) && test(DEMOD_NRZ, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {\r

tests[hits].modulation = DEMOD_NRZ;\r

tests[hits].bitrate = bitRate;\r

tests[hits].modulation = DEMOD_NRZ;\r

tests[hits].bitrate = bitRate;\r

- tests[hits].inverted = FALSE;\r

+ tests[hits].inverted = false;\r

tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);\r

+ tests[hits].ST = false;\r

++hits;\r

}\r

\r

++hits;\r

}\r

\r

- if ( NRZrawDemod("0 1 1", FALSE) && test(DEMOD_NRZ, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {\r

+ if ( NRZrawDemod("0 1 1", false) && test(DEMOD_NRZ, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {\r

tests[hits].modulation = DEMOD_NRZ;\r

tests[hits].bitrate = bitRate;\r

tests[hits].modulation = DEMOD_NRZ;\r

tests[hits].bitrate = bitRate;\r

- tests[hits].inverted = TRUE;\r

+ tests[hits].inverted = true;\r

tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);\r

+ tests[hits].ST = false;\r

++hits;\r

}\r

++hits;\r

}\r

// skip first 160 samples to allow antenna to settle in (psk gets inverted occasionally otherwise)\r

save_restoreGB(1);\r

CmdLtrim("160");\r

// skip first 160 samples to allow antenna to settle in (psk gets inverted occasionally otherwise)\r

save_restoreGB(1);\r

CmdLtrim("160");\r

- clk = GetPskClock("", FALSE, FALSE);\r

+ clk = GetPskClock("", false, false);\r

if (clk>0) {\r

- if ( PSKDemod("0 0 6", FALSE) && test(DEMOD_PSK1, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {\r

+ if ( PSKDemod("0 0 6", false) && test(DEMOD_PSK1, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {\r

tests[hits].modulation = DEMOD_PSK1;\r

tests[hits].bitrate = bitRate;\r

tests[hits].modulation = DEMOD_PSK1;\r

tests[hits].bitrate = bitRate;\r

- tests[hits].inverted = FALSE;\r

+ tests[hits].inverted = false;\r

tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);\r

+ tests[hits].ST = false;\r

++hits;\r

}\r

++hits;\r

}\r

- if ( PSKDemod("0 1 6", FALSE) && test(DEMOD_PSK1, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {\r

+ if ( PSKDemod("0 1 6", false) && test(DEMOD_PSK1, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {\r

tests[hits].modulation = DEMOD_PSK1;\r

tests[hits].bitrate = bitRate;\r

tests[hits].modulation = DEMOD_PSK1;\r

tests[hits].bitrate = bitRate;\r

- tests[hits].inverted = TRUE;\r

+ tests[hits].inverted = true;\r

tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);\r

+ tests[hits].ST = false;\r

++hits;\r

}\r

// PSK2 - needs a call to psk1TOpsk2.\r

++hits;\r

}\r

// PSK2 - needs a call to psk1TOpsk2.\r

- if ( PSKDemod("0 0 6", FALSE)) {\r

+ if ( PSKDemod("0 0 6", false)) {\r

psk1TOpsk2(DemodBuffer, DemodBufferLen);\r

if (test(DEMOD_PSK2, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)){\r

tests[hits].modulation = DEMOD_PSK2;\r

tests[hits].bitrate = bitRate;\r

psk1TOpsk2(DemodBuffer, DemodBufferLen);\r

if (test(DEMOD_PSK2, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)){\r

tests[hits].modulation = DEMOD_PSK2;\r

tests[hits].bitrate = bitRate;\r

- tests[hits].inverted = FALSE;\r

+ tests[hits].inverted = false;\r

tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);\r

+ tests[hits].ST = false;\r

++hits;\r

}\r

} // inverse waves does not affect this demod\r

// PSK3 - needs a call to psk1TOpsk2.\r

++hits;\r

}\r

} // inverse waves does not affect this demod\r

// PSK3 - needs a call to psk1TOpsk2.\r

- if ( PSKDemod("0 0 6", FALSE)) {\r

+ if ( PSKDemod("0 0 6", false)) {\r

psk1TOpsk2(DemodBuffer, DemodBufferLen);\r

if (test(DEMOD_PSK3, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)){\r

tests[hits].modulation = DEMOD_PSK3;\r

tests[hits].bitrate = bitRate;\r

psk1TOpsk2(DemodBuffer, DemodBufferLen);\r

if (test(DEMOD_PSK3, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)){\r

tests[hits].modulation = DEMOD_PSK3;\r

tests[hits].bitrate = bitRate;\r

- tests[hits].inverted = FALSE;\r

+ tests[hits].inverted = false;\r

tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);\r

+ tests[hits].ST = false;\r

++hits;\r

}\r

} // inverse waves does not affect this demod\r

++hits;\r

}\r

} // inverse waves does not affect this demod\r

config.offset = tests[0].offset;\r

config.block0 = tests[0].block0;\r

config.Q5 = tests[0].Q5;\r

config.offset = tests[0].offset;\r

config.block0 = tests[0].block0;\r

config.Q5 = tests[0].Q5;\r

+ config.ST = tests[0].ST;\r

printConfiguration( config );\r

- return TRUE;\r

+ return true;\r

}\r

\r

if ( hits > 1) {\r

}\r

\r

if ( hits > 1) {\r

printConfiguration( tests[i] );\r

}\r

printConfiguration( tests[i] );\r

}\r

- return FALSE;\r

+ return false;\r

}\r

\r

bool testModulation(uint8_t mode, uint8_t modread){\r

switch( mode ){\r

case DEMOD_FSK:\r

}\r

\r

bool testModulation(uint8_t mode, uint8_t modread){\r

switch( mode ){\r

case DEMOD_FSK:\r

- if (modread >= DEMOD_FSK1 && modread <= DEMOD_FSK2a) return TRUE;\r

+ if (modread >= DEMOD_FSK1 && modread <= DEMOD_FSK2a) return true;\r

break;\r

case DEMOD_ASK:\r

break;\r

case DEMOD_ASK:\r

- if (modread == DEMOD_ASK) return TRUE;\r

+ if (modread == DEMOD_ASK) return true;\r

break;\r

case DEMOD_PSK1:\r

break;\r

case DEMOD_PSK1:\r

- if (modread == DEMOD_PSK1) return TRUE;\r

+ if (modread == DEMOD_PSK1) return true;\r

break;\r

case DEMOD_PSK2:\r

break;\r

case DEMOD_PSK2:\r

- if (modread == DEMOD_PSK2) return TRUE;\r

+ if (modread == DEMOD_PSK2) return true;\r

break;\r

case DEMOD_PSK3:\r

break;\r

case DEMOD_PSK3:\r

- if (modread == DEMOD_PSK3) return TRUE;\r

+ if (modread == DEMOD_PSK3) return true;\r

break;\r

case DEMOD_NRZ:\r

break;\r

case DEMOD_NRZ:\r

- if (modread == DEMOD_NRZ) return TRUE;\r

+ if (modread == DEMOD_NRZ) return true;\r

break;\r

case DEMOD_BI:\r

break;\r

case DEMOD_BI:\r

- if (modread == DEMOD_BI) return TRUE;\r

+ if (modread == DEMOD_BI) return true;\r

break;\r

case DEMOD_BIa:\r

break;\r

case DEMOD_BIa:\r

- if (modread == DEMOD_BIa) return TRUE;\r

+ if (modread == DEMOD_BIa) return true;\r

break; \r

default:\r

break; \r

default:\r

- return FALSE;\r

+ return false;\r

}\r

- return FALSE;\r

+ return false;\r

}\r

\r

bool testQ5Modulation(uint8_t mode, uint8_t modread){\r

switch( mode ){\r

case DEMOD_FSK:\r

}\r

\r

bool testQ5Modulation(uint8_t mode, uint8_t modread){\r

switch( mode ){\r

case DEMOD_FSK:\r

- if (modread >= 4 && modread <= 5) return TRUE;\r

+ if (modread >= 4 && modread <= 5) return true;\r

break;\r

case DEMOD_ASK:\r

break;\r

case DEMOD_ASK:\r

- if (modread == 0) return TRUE;\r

+ if (modread == 0) return true;\r

break;\r

case DEMOD_PSK1:\r

break;\r

case DEMOD_PSK1:\r

- if (modread == 1) return TRUE;\r

+ if (modread == 1) return true;\r

break;\r

case DEMOD_PSK2:\r

break;\r

case DEMOD_PSK2:\r

- if (modread == 2) return TRUE;\r

+ if (modread == 2) return true;\r

break;\r

case DEMOD_PSK3:\r

break;\r

case DEMOD_PSK3:\r

- if (modread == 3) return TRUE;\r

+ if (modread == 3) return true;\r

break;\r

case DEMOD_NRZ:\r

break;\r

case DEMOD_NRZ:\r

- if (modread == 7) return TRUE;\r

+ if (modread == 7) return true;\r

break;\r

case DEMOD_BI:\r

break;\r

case DEMOD_BI:\r

- if (modread == 6) return TRUE;\r

+ if (modread == 6) return true;\r

break;\r

default:\r

break;\r

default:\r

- return FALSE;\r

+ return false;\r

}\r

- return FALSE;\r

+ return false;\r

}\r

\r

int convertQ5bitRate(uint8_t bitRateRead) {\r

}\r

\r

int convertQ5bitRate(uint8_t bitRateRead) {\r

\r

bool testQ5(uint8_t mode, uint8_t *offset, int *fndBitRate, uint8_t clk){\r

\r

bool testQ5(uint8_t mode, uint8_t *offset, int *fndBitRate, uint8_t clk){\r

\r

- if ( DemodBufferLen < 64 ) return FALSE;\r

+ if ( DemodBufferLen < 64 ) return false;\r

uint8_t si = 0;\r

for (uint8_t idx = 28; idx < 64; idx++){\r

si = idx;\r

uint8_t si = 0;\r

for (uint8_t idx = 28; idx < 64; idx++){\r

si = idx;\r

if (*fndBitRate < 0) continue;\r

*offset = idx;\r

\r

if (*fndBitRate < 0) continue;\r

*offset = idx;\r

\r

- return TRUE;\r

+ return true;\r

}\r

- return FALSE;\r

+ return false;\r

}\r

\r

bool testBitRate(uint8_t readRate, uint8_t clk){\r

}\r

\r

bool testBitRate(uint8_t readRate, uint8_t clk){\r

\r

bool test(uint8_t mode, uint8_t *offset, int *fndBitRate, uint8_t clk, bool *Q5){\r

\r

bool test(uint8_t mode, uint8_t *offset, int *fndBitRate, uint8_t clk, bool *Q5){\r

\r

- if ( DemodBufferLen < 64 ) return FALSE;\r

+ if ( DemodBufferLen < 64 ) return false;\r

uint8_t si = 0;\r

for (uint8_t idx = 28; idx < 64; idx++){\r

si = idx;\r

uint8_t si = 0;\r

for (uint8_t idx = 28; idx < 64; idx++){\r

si = idx;\r

uint8_t extend = PackBits(si, 1, DemodBuffer); si += 1; //bit 15 extended mode\r

uint8_t modread = PackBits(si, 5, DemodBuffer); si += 5+2+1; \r

//uint8_t pskcr = PackBits(si, 2, DemodBuffer); si += 2+1; //could check psk cr\r

uint8_t extend = PackBits(si, 1, DemodBuffer); si += 1; //bit 15 extended mode\r

uint8_t modread = PackBits(si, 5, DemodBuffer); si += 5+2+1; \r

//uint8_t pskcr = PackBits(si, 2, DemodBuffer); si += 2+1; //could check psk cr\r

- uint8_t nml01 = PackBits(si, 1, DemodBuffer); si += 1+5; //bit 24, 30, 31 could be tested for 0 if not extended mode\r

- uint8_t nml02 = PackBits(si, 2, DemodBuffer); si += 2;\r

+ //uint8_t nml01 = PackBits(si, 1, DemodBuffer); si += 1+5; //bit 24, 30, 31 could be tested for 0 if not extended mode\r

+ //uint8_t nml02 = PackBits(si, 2, DemodBuffer); si += 2;\r

\r

//if extended mode\r

\r

//if extended mode\r

- bool extMode =( (safer == 0x6 || safer == 0x9) && extend) ? TRUE : FALSE;\r

+ bool extMode =( (safer == 0x6 || safer == 0x9) && extend) ? true : false;\r

\r

if (!extMode){\r

\r

if (!extMode){\r

- if (nml01 || nml02 || xtRate) continue;\r

+ if (xtRate) continue; //nml01 || nml02 || caused issues on noralys tags\r

}\r

//test modulation\r

if (!testModulation(mode, modread)) continue;\r

if (!testBitRate(bitRate, clk)) continue;\r

*fndBitRate = bitRate;\r

*offset = idx;\r

}\r

//test modulation\r

if (!testModulation(mode, modread)) continue;\r

if (!testBitRate(bitRate, clk)) continue;\r

*fndBitRate = bitRate;\r

*offset = idx;\r

- *Q5 = FALSE;\r

- return TRUE;\r

+ *Q5 = false;\r

+ return true;\r

}\r

if (testQ5(mode, offset, fndBitRate, clk)) {\r

}\r

if (testQ5(mode, offset, fndBitRate, clk)) {\r

- *Q5 = TRUE;\r

- return TRUE;\r

+ *Q5 = true;\r

+ return true;\r

}\r

- return FALSE;\r

+ return false;\r

}\r

\r

void printT55xxBlock(const char *blockNum){\r

}\r

\r

void printT55xxBlock(const char *blockNum){\r

PrintAndLog("Bit Rate : %s", GetBitRateStr(b.bitrate) );\r

PrintAndLog("Inverted : %s", (b.inverted) ? "Yes" : "No" );\r

PrintAndLog("Offset : %d", b.offset);\r

PrintAndLog("Bit Rate : %s", GetBitRateStr(b.bitrate) );\r

PrintAndLog("Inverted : %s", (b.inverted) ? "Yes" : "No" );\r

PrintAndLog("Offset : %d", b.offset);\r

+ PrintAndLog("Seq. Term. : %s", (b.ST) ? "Yes" : "No" );\r

PrintAndLog("Block0 : 0x%08X", b.block0);\r

PrintAndLog("");\r

return 0;\r

PrintAndLog("Block0 : 0x%08X", b.block0);\r

PrintAndLog("");\r

return 0;\r

\r

PrintAndLog("Testing %08X", testpwd);\r

\r

PrintAndLog("Testing %08X", testpwd);\r

\r

- if ( !AquireData(T55x7_PAGE0, T55x7_CONFIGURATION_BLOCK, TRUE, testpwd)) {\r

+ if ( !AquireData(T55x7_PAGE0, T55x7_CONFIGURATION_BLOCK, true, testpwd)) {\r

PrintAndLog("Aquireing data from device failed. Quitting");\r

free(keyBlock);\r

return 0;\r

PrintAndLog("Aquireing data from device failed. Quitting");\r

free(keyBlock);\r

return 0;\r

}\r

\r

return 0;\r

}\r

\r

- if (!AquireData(T55x7_PAGE0, T55x7_CONFIGURATION_BLOCK, TRUE, i)) {\r

+ if (!AquireData(T55x7_PAGE0, T55x7_CONFIGURATION_BLOCK, true, i)) {\r

PrintAndLog("Aquireing data from device failed. Quitting");\r

free(keyBlock);\r

return 0;\r

PrintAndLog("Aquireing data from device failed. Quitting");\r

free(keyBlock);\r

return 0;\r