]> git.zerfleddert.de Git - proxmark3-svn/blob - client/cmdlfnoralsy.c
CHG: missing file extension.
[proxmark3-svn] / client / cmdlfnoralsy.c
1 //-----------------------------------------------------------------------------
2 //
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
5 // the license.
6 //-----------------------------------------------------------------------------
7 // Low frequency Presco tag commands
8 //-----------------------------------------------------------------------------
9
10 #include "cmdlfnoralsy.h"
11
12 static int CmdHelp(const char *Cmd);
13
14 int usage_lf_noralsy_clone(void){
15 PrintAndLog("clone a Noralsy tag to a T55x7 tag.");
16 PrintAndLog("Usage: lf noralsy clone [h] <card ID> <Q5>");
17 PrintAndLog("Options:");
18 PrintAndLog(" h : This help");
19 PrintAndLog(" <card ID> : Noralsy card ID");
20 PrintAndLog(" <Q5> : specify write to Q5 (t5555 instead of t55x7)");
21 PrintAndLog("");
22 PrintAndLog("Sample: lf noralsy clone 112233");
23 return 0;
24 }
25
26 int usage_lf_noralsy_sim(void) {
27 PrintAndLog("Enables simulation of Noralsy card with specified card number.");
28 PrintAndLog("Simulation runs until the button is pressed or another USB command is issued.");
29 PrintAndLog("");
30 PrintAndLog("Usage: lf noralsy sim [h] <card ID>");
31 PrintAndLog("Options:");
32 PrintAndLog(" h : This help");
33 PrintAndLog(" <card ID> : Noralsy card ID");
34 PrintAndLog("");
35 PrintAndLog("Sample: lf noralsy sim 112233");
36 return 0;
37 }
38
39 static uint8_t noralsy_chksum( uint8_t* bits, uint8_t len) {
40 uint8_t sum = 0;
41 for (uint8_t i = 0; i < len; i += 4)
42 sum ^= bytebits_to_byte(bits+i, 4);
43 return sum & 0x0F ;
44 }
45 int getnoralsyBits(uint32_t id, uint8_t *bits) {
46 //preamp
47 num_to_bytebits(0xBB0214FF, 32, bits); // --> Have seen 0xBB0214FF / 0xBB0314FF UNKNOWN
48
49 //convert ID into BCD-format
50 id = DEC2BCD(id);
51
52 uint16_t sub1 = (id & 0xFFF0000) >> 16;
53 uint8_t sub2 = (id & 0x000FF00) >> 8;
54 uint8_t sub3 = (id & 0x00000FF);
55
56 num_to_bytebits(sub1, 12, bits+32);
57 num_to_bytebits(0x980, 12, bits+44); // --> UNKNOWN part
58 num_to_bytebits(sub2, 8, bits+56);
59 num_to_bytebits(sub3, 8, bits+64);
60
61 //chksum byte
62 uint8_t chksum = noralsy_chksum(bits+32, 40);
63 num_to_bytebits(chksum, 4, bits+72);
64 chksum = noralsy_chksum(bits, 76);
65 num_to_bytebits(chksum, 4, bits+76);
66 return 1;
67 }
68
69 //see ASKDemod for what args are accepted
70 int CmdNoralsyDemod(const char *Cmd) {
71
72 //ASK / Manchester
73 bool st = true;
74 if (!ASKDemod_ext("32 0 0", FALSE, FALSE, 1, &st)) {
75 if (g_debugMode) PrintAndLog("DEBUG: Error - Noralsy: ASK/Manchester Demod failed");
76 return 0;
77 }
78 size_t size = DemodBufferLen;
79 int ans = NoralsyDemod_AM(DemodBuffer, &size);
80 if (ans < 0){
81 if (g_debugMode){
82 if (ans == -1)
83 PrintAndLog("DEBUG: Error - Noralsy: too few bits found");
84 else if (ans == -2)
85 PrintAndLog("DEBUG: Error - Noralsy: preamble not found");
86 else if (ans == -3)
87 PrintAndLog("DEBUG: Error - Noralsy: Size not correct: %d", size);
88 else
89 PrintAndLog("DEBUG: Error - Noralsy: ans: %d", ans);
90 }
91 return 0;
92 }
93 setDemodBuf(DemodBuffer, 96, ans);
94
95 //got a good demod
96 uint32_t raw1 = bytebits_to_byte(DemodBuffer, 32);
97 uint32_t raw2 = bytebits_to_byte(DemodBuffer+32, 32);
98 uint32_t raw3 = bytebits_to_byte(DemodBuffer+64, 32);
99
100 uint32_t cardid = ((raw2 & 0xFFF00000) >> 20) << 16;
101 cardid |= (raw2 & 0xFF) << 8;
102 cardid |= ((raw3 & 0xFF000000) >> 24);
103 cardid = BCD2DEC(cardid);
104
105 // calc checksums
106 uint8_t calc1 = noralsy_chksum(DemodBuffer+32, 40);
107 uint8_t calc2 = noralsy_chksum(DemodBuffer, 76);
108 uint8_t chk1 = 0, chk2 = 0;
109 chk1 = bytebits_to_byte(DemodBuffer+72, 4);
110 chk2 = bytebits_to_byte(DemodBuffer+76, 4);
111 // test checksums
112 if ( chk1 != calc1 ) {
113 printf("checksum 1 failed %x - %x\n", chk1, calc1);
114 return 0;
115 }
116 if ( chk2 != calc2 ) {
117 printf("checksum 2 failed %x - %x\n", chk2, calc2);
118 return 0;
119 }
120
121 PrintAndLog("Noralsy Tag Found: Card ID %u, Raw: %08X%08X%08X", cardid, raw1 ,raw2, raw3);
122 return 1;
123 }
124
125 int CmdNoralsyRead(const char *Cmd) {
126 CmdLFRead("s");
127 getSamples("20000",TRUE);
128 return CmdNoralsyDemod(Cmd);
129 }
130
131 int CmdNoralsyClone(const char *Cmd) {
132
133 uint32_t id = 0;
134 uint32_t blocks[4] = {T55x7_MODULATION_MANCHESTER | T55x7_BITRATE_RF_32 | T55x7_ST_TERMINATOR |3<<T55x7_MAXBLOCK_SHIFT, 0, 0};
135
136 uint8_t bits[96];
137 uint8_t *bs = bits;
138 memset(bs, 0, sizeof(bits));
139
140 char cmdp = param_getchar(Cmd, 0);
141 if (strlen(Cmd) == 0 || cmdp == 'h' || cmdp == 'H') return usage_lf_noralsy_clone();
142
143 id = param_get32ex(Cmd, 0, 0, 10);
144
145 //Q5
146 if (param_getchar(Cmd, 1) == 'Q' || param_getchar(Cmd, 1) == 'q') {
147 //t5555 (Q5) BITRATE = (RF-2)/2 (iceman)
148 blocks[0] = T5555_MODULATION_MANCHESTER | 32<<T5555_BITRATE_SHIFT | T5555_ST_TERMINATOR | 3<<T5555_MAXBLOCK_SHIFT;
149 }
150
151 if ( !getnoralsyBits(id, bs)) {
152 PrintAndLog("Error with tag bitstream generation.");
153 return 1;
154 }
155
156 //
157 blocks[1] = bytebits_to_byte(bs,32);
158 blocks[2] = bytebits_to_byte(bs+32,32);
159 blocks[3] = bytebits_to_byte(bs+64,32);
160
161 PrintAndLog("Preparing to clone Noralsy to T55x7 with CardId: %u", id);
162 PrintAndLog("Blk | Data ");
163 PrintAndLog("----+------------");
164 PrintAndLog(" 00 | 0x%08x", blocks[0]);
165 PrintAndLog(" 01 | 0x%08x", blocks[1]);
166 PrintAndLog(" 02 | 0x%08x", blocks[2]);
167 PrintAndLog(" 03 | 0x%08x", blocks[3]);
168
169 UsbCommand resp;
170 UsbCommand c = {CMD_T55XX_WRITE_BLOCK, {0,0,0}};
171
172 for (int i = 3; i >= 0; --i) {
173 c.arg[0] = blocks[i];
174 c.arg[1] = i;
175 clearCommandBuffer();
176 SendCommand(&c);
177 if (!WaitForResponseTimeout(CMD_ACK, &resp, 1000)){
178 PrintAndLog("Error occurred, device did not respond during write operation.");
179 return -1;
180 }
181 }
182 return 0;
183 }
184
185 int CmdNoralsySim(const char *Cmd) {
186
187 uint8_t bits[96];
188 uint8_t *bs = bits;
189 memset(bs, 0, sizeof(bits));
190
191 uint32_t id = 0;
192 char cmdp = param_getchar(Cmd, 0);
193 if (strlen(Cmd) == 0 || cmdp == 'h' || cmdp == 'H') return usage_lf_noralsy_sim();
194
195 id = param_get32ex(Cmd, 0, 0, 10);
196
197 uint8_t clk = 32, encoding = 1, separator = 1, invert = 0;
198 uint16_t arg1, arg2;
199 size_t size = 96;
200 arg1 = clk << 8 | encoding;
201 arg2 = invert << 8 | separator;
202
203 if ( !getnoralsyBits(id, bs)) {
204 PrintAndLog("Error with tag bitstream generation.");
205 return 1;
206 }
207
208 PrintAndLog("Simulating Noralsy - CardId: %u", id);
209
210 UsbCommand c = {CMD_ASK_SIM_TAG, {arg1, arg2, size}};
211 memcpy(c.d.asBytes, bs, size);
212 clearCommandBuffer();
213 SendCommand(&c);
214 return 0;
215 }
216
217 static command_t CommandTable[] = {
218 {"help", CmdHelp, 1, "This help"},
219 {"read", CmdNoralsyRead, 0, "Attempt to read and extract tag data"},
220 {"clone", CmdNoralsyClone,0, "clone Noralsy tag"},
221 {"sim", CmdNoralsySim, 0, "simulate Noralsy tag"},
222 {NULL, NULL, 0, NULL}
223 };
224
225 int CmdLFNoralsy(const char *Cmd) {
226 clearCommandBuffer();
227 CmdsParse(CommandTable, Cmd);
228 return 0;
229 }
230
231 int CmdHelp(const char *Cmd) {
232 CmdsHelp(CommandTable);
233 return 0;
234 }
Impressum, Datenschutz