1 //-----------------------------------------------------------------------------
3 // This code is licensed to you under the terms of the GNU GPL, version 2 or,
4 // at your option, any later version. See the LICENSE.txt file for the text of
6 //-----------------------------------------------------------------------------
7 // Low frequency Presco tag commands
8 //-----------------------------------------------------------------------------
10 #include "cmdlfvisa2000.h"
12 #define BL0CK1 0x56495332
14 static int CmdHelp(const char *Cmd
);
16 int usage_lf_visa2k_clone(void){
17 PrintAndLog("clone a Visa2000 tag to a T55x7 tag.");
18 PrintAndLog("Usage: lf visa2k clone [h] <card ID> <Q5>");
19 PrintAndLog("Options:");
20 PrintAndLog(" h : This help");
21 PrintAndLog(" <card ID> : Visa2k card ID");
22 PrintAndLog(" <Q5> : specify write to Q5 (t5555 instead of t55x7)");
24 PrintAndLog("Sample: lf visa2k clone 112233");
28 int usage_lf_visa2k_sim(void) {
29 PrintAndLog("Enables simulation of visa2k card with specified card number.");
30 PrintAndLog("Simulation runs until the button is pressed or another USB command is issued.");
32 PrintAndLog("Usage: lf visa2k sim [h] <card ID>");
33 PrintAndLog("Options:");
34 PrintAndLog(" h : This help");
35 PrintAndLog(" <card ID> : Visa2k card ID");
37 PrintAndLog("Sample: lf visa2k sim 112233");
41 static uint8_t visa_chksum( uint32_t id
) {
43 for (uint8_t i
= 0; i
< 32; i
+= 4)
44 sum
^= (id
>> i
) & 0xF;
48 //see ASKDemod for what args are accepted
49 int CmdVisa2kDemod(const char *Cmd
) {
53 if (!ASKDemod_ext("64 0 0", FALSE
, FALSE
, 1, &st
)) {
54 if (g_debugMode
) PrintAndLog("DEBUG: Error - Visa2k: ASK/Manchester Demod failed");
57 size_t size
= DemodBufferLen
;
58 int ans
= Visa2kDemod_AM(DemodBuffer
, &size
);
62 PrintAndLog("DEBUG: Error - Visa2k: too few bits found");
64 PrintAndLog("DEBUG: Error - Visa2k: preamble not found");
66 PrintAndLog("DEBUG: Error - Visa2k: Size not correct: %d", size
);
68 PrintAndLog("DEBUG: Error - Visa2k: ans: %d", ans
);
72 setDemodBuf(DemodBuffer
, 96, ans
);
75 uint32_t raw1
= bytebits_to_byte(DemodBuffer
, 32);
76 uint32_t raw2
= bytebits_to_byte(DemodBuffer
+32, 32);
77 uint32_t raw3
= bytebits_to_byte(DemodBuffer
+64, 32);
80 uint8_t calc
= visa_chksum(raw2
);
81 uint8_t chk
= raw3
& 0xF;
84 printf("DEBUG: error: Visa2000 checksum failed %x - %x\n", chk
, calc
);
87 PrintAndLog("Visa2000 Tag Found: Card ID %u, Raw: %08X%08X%08X", raw2
, raw1
,raw2
, raw3
);
92 int CmdVisa2kRead(const char *Cmd
) {
94 getSamples("20000",TRUE
);
95 return CmdVisa2kDemod(Cmd
);
98 int CmdVisa2kClone(const char *Cmd
) {
101 uint32_t blocks
[4] = {T55x7_MODULATION_MANCHESTER
| T55x7_BITRATE_RF_64
| T55x7_ST_TERMINATOR
|3<<T55x7_MAXBLOCK_SHIFT
, BL0CK1
, 0};
103 char cmdp
= param_getchar(Cmd
, 0);
104 if (strlen(Cmd
) == 0 || cmdp
== 'h' || cmdp
== 'H') return usage_lf_visa2k_clone();
106 id
= param_get32ex(Cmd
, 0, 0, 10);
109 if (param_getchar(Cmd
, 1) == 'Q' || param_getchar(Cmd
, 1) == 'q') {
110 //t5555 (Q5) BITRATE = (RF-2)/2 (iceman)
111 blocks
[0] = T5555_MODULATION_MANCHESTER
| 64<<T5555_BITRATE_SHIFT
| T5555_ST_TERMINATOR
| 3<<T5555_MAXBLOCK_SHIFT
;
116 blocks
[3] = visa_chksum( id
);
118 PrintAndLog("Preparing to clone Visa2000 to T55x7 with CardId: %u", id
);
119 PrintAndLog("Blk | Data ");
120 PrintAndLog("----+------------");
121 PrintAndLog(" 00 | 0x%08x", blocks
[0]);
122 PrintAndLog(" 01 | 0x%08x", blocks
[1]);
123 PrintAndLog(" 02 | 0x%08x", blocks
[2]);
124 PrintAndLog(" 02 | 0x%08x", blocks
[3]);
127 UsbCommand c
= {CMD_T55XX_WRITE_BLOCK
, {0,0,0}};
129 for (int i
= 3; i
>= 0; --i
) {
130 c
.arg
[0] = blocks
[i
];
132 clearCommandBuffer();
134 if (!WaitForResponseTimeout(CMD_ACK
, &resp
, 1000)){
135 PrintAndLog("Error occurred, device did not respond during write operation.");
142 int CmdVisa2kSim(const char *Cmd
) {
145 char cmdp
= param_getchar(Cmd
, 0);
146 if (strlen(Cmd
) == 0 || cmdp
== 'h' || cmdp
== 'H') return usage_lf_visa2k_sim();
148 id
= param_get32ex(Cmd
, 0, 0, 10);
150 uint8_t clk
= 64, encoding
= 1, separator
= 1, invert
= 0;
153 arg1
= clk
<< 8 | encoding
;
154 arg2
= invert
<< 8 | separator
;
156 PrintAndLog("Simulating Visa2000 - CardId: %u", id
);
158 UsbCommand c
= {CMD_ASK_SIM_TAG
, {arg1
, arg2
, size
}};
160 uint32_t blocks
[3] = { BL0CK1
, id
, visa_chksum(id
) };
162 for(int i
=0; i
<3; ++i
)
163 num_to_bytebits(blocks
[i
], 32, c
.d
.asBytes
+ i
*32);
165 clearCommandBuffer();
170 static command_t CommandTable
[] = {
171 {"help", CmdHelp
, 1, "This help"},
172 {"read", CmdVisa2kRead
, 0, "Attempt to read and extract tag data"},
173 {"clone", CmdVisa2kClone
, 0, "clone Visa2000 tag"},
174 {"sim", CmdVisa2kSim
, 0, "simulate Visa2000 tag"},
175 {NULL
, NULL
, 0, NULL
}
178 int CmdLFVisa2k(const char *Cmd
) {
179 clearCommandBuffer();
180 CmdsParse(CommandTable
, Cmd
);
184 int CmdHelp(const char *Cmd
) {
185 CmdsHelp(CommandTable
);