]> git.zerfleddert.de Git - proxmark3-svn/blob - client/cmdlfti.c
Bugfixes for LF FDX
[proxmark3-svn] / client / cmdlfti.c
1 //-----------------------------------------------------------------------------
2 // Copyright (C) 2010 iZsh <izsh at fail0verflow.com>
3 //
4 // This code is licensed to you under the terms of the GNU GPL, version 2 or,
5 // at your option, any later version. See the LICENSE.txt file for the text of
6 // the license.
7 //-----------------------------------------------------------------------------
8 // Low frequency TI commands
9 //-----------------------------------------------------------------------------
10
11 #include "cmdlfti.h"
12
13 #include <stdio.h>
14 #include <stdlib.h>
15 #include <inttypes.h>
16 #include "crc16.h"
17 #include "comms.h"
18 #include "ui.h"
19 #include "graph.h"
20 #include "cmdparser.h"
21 #include "util.h"
22
23 static int CmdHelp(const char *Cmd);
24
25 int CmdTIDemod(const char *Cmd)
26 {
27 /* MATLAB as follows:
28 f_s = 2000000; % sampling frequency
29 f_l = 123200; % low FSK tone
30 f_h = 134200; % high FSK tone
31
32 T_l = 119e-6; % low bit duration
33 T_h = 130e-6; % high bit duration
34
35 l = 2*pi*ones(1, floor(f_s*T_l))*(f_l/f_s);
36 h = 2*pi*ones(1, floor(f_s*T_h))*(f_h/f_s);
37
38 l = sign(sin(cumsum(l)));
39 h = sign(sin(cumsum(h)));
40 */
41
42 // 2M*16/134.2k = 238
43 static const int LowTone[] = {
44 1, 1, 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1, -1,
45 1, 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1, -1,
46 1, 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1, -1,
47 1, 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1, -1,
48 1, 1, 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1, -1,
49 1, 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1, -1,
50 1, 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1, -1,
51 1, 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1, -1,
52 1, 1, 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1, -1,
53 1, 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1, -1,
54 1, 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1, -1,
55 1, 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1, -1,
56 1, 1, 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1, -1,
57 1, 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1, -1,
58 1, 1, 1, 1, 1, 1, 1, 1, -1, -1
59 };
60 // 2M*16/123.2k = 260
61 static const int HighTone[] = {
62 1, 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1,
63 1, 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1,
64 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1, -1,
65 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1, -1,
66 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1, -1,
67 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1,
68 1, 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1,
69 1, 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1,
70 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1, -1,
71 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1, -1,
72 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1,
73 1, 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1,
74 1, 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1,
75 1, 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1,
76 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1, -1,
77 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1, -1,
78 1, 1, 1, 1, 1, 1, 1, -1, -1, -1, -1, -1, -1, -1,
79 1, 1, 1, 1, 1, 1, 1, 1
80 };
81 int lowLen = sizeof(LowTone)/sizeof(int);
82 int highLen = sizeof(HighTone)/sizeof(int);
83 int convLen = (highLen>lowLen)?highLen:lowLen;
84 uint16_t crc;
85 int i, j, TagType;
86 int lowSum = 0, highSum = 0;;
87 int lowTot = 0, highTot = 0;
88
89 for (i = 0; i < GraphTraceLen - convLen; i++) {
90 lowSum = 0;
91 highSum = 0;;
92
93 for (j = 0; j < lowLen; j++) {
94 lowSum += LowTone[j]*GraphBuffer[i+j];
95 }
96 for (j = 0; j < highLen; j++) {
97 highSum += HighTone[j]*GraphBuffer[i+j];
98 }
99 lowSum = abs((100*lowSum) / lowLen);
100 highSum = abs((100*highSum) / highLen);
101 lowSum = (lowSum<0)?-lowSum:lowSum;
102 highSum = (highSum<0)?-highSum:highSum;
103
104 GraphBuffer[i] = (highSum << 16) | lowSum;
105 }
106
107 for (i = 0; i < GraphTraceLen - convLen - 16; i++) {
108 lowTot = 0;
109 highTot = 0;
110 // 16 and 15 are f_s divided by f_l and f_h, rounded
111 for (j = 0; j < 16; j++) {
112 lowTot += (GraphBuffer[i+j] & 0xffff);
113 }
114 for (j = 0; j < 15; j++) {
115 highTot += (GraphBuffer[i+j] >> 16);
116 }
117 GraphBuffer[i] = lowTot - highTot;
118 }
119
120 GraphTraceLen -= (convLen + 16);
121
122 RepaintGraphWindow();
123
124 // TI tag data format is 16 prebits, 8 start bits, 64 data bits,
125 // 16 crc CCITT bits, 8 stop bits, 15 end bits
126
127 // the 16 prebits are always low
128 // the 8 start and stop bits of a tag must match
129 // the start/stop prebits of a ro tag are 01111110
130 // the start/stop prebits of a rw tag are 11111110
131 // the 15 end bits of a ro tag are all low
132 // the 15 end bits of a rw tag match bits 15-1 of the data bits
133
134 // Okay, so now we have unsliced soft decisions;
135 // find bit-sync, and then get some bits.
136 // look for 17 low bits followed by 6 highs (common pattern for ro and rw tags)
137 int max = 0, maxPos = 0;
138 for (i = 0; i < 6000; i++) {
139 int j;
140 int dec = 0;
141 // searching 17 consecutive lows
142 for (j = 0; j < 17*lowLen; j++) {
143 dec -= GraphBuffer[i+j];
144 }
145 // searching 7 consecutive highs
146 for (; j < 17*lowLen + 6*highLen; j++) {
147 dec += GraphBuffer[i+j];
148 }
149 if (dec > max) {
150 max = dec;
151 maxPos = i;
152 }
153 }
154
155 // place a marker in the buffer to visually aid location
156 // of the start of sync
157 GraphBuffer[maxPos] = 800;
158 GraphBuffer[maxPos+1] = -800;
159
160 // advance pointer to start of actual data stream (after 16 pre and 8 start bits)
161 maxPos += 17*lowLen;
162 maxPos += 6*highLen;
163
164 // place a marker in the buffer to visually aid location
165 // of the end of sync
166 GraphBuffer[maxPos] = 800;
167 GraphBuffer[maxPos+1] = -800;
168
169 PrintAndLog("actual data bits start at sample %d", maxPos);
170
171 PrintAndLog("length %d/%d", highLen, lowLen);
172
173 uint8_t bits[1+64+16+8+16];
174 bits[sizeof(bits)-1] = '\0';
175
176 uint32_t shift3 = 0x7e000000, shift2 = 0, shift1 = 0, shift0 = 0;
177
178 for (i = 0; i < arraylen(bits)-1; i++) {
179 int high = 0;
180 int low = 0;
181 int j;
182 for (j = 0; j < lowLen; j++) {
183 low -= GraphBuffer[maxPos+j];
184 }
185 for (j = 0; j < highLen; j++) {
186 high += GraphBuffer[maxPos+j];
187 }
188
189 if (high > low) {
190 bits[i] = '1';
191 maxPos += highLen;
192 // bitstream arrives lsb first so shift right
193 shift3 |= (1<<31);
194 } else {
195 bits[i] = '.';
196 maxPos += lowLen;
197 }
198
199 // 128 bit right shift register
200 shift0 = (shift0>>1) | (shift1 << 31);
201 shift1 = (shift1>>1) | (shift2 << 31);
202 shift2 = (shift2>>1) | (shift3 << 31);
203 shift3 >>= 1;
204
205 // place a marker in the buffer between bits to visually aid location
206 GraphBuffer[maxPos] = 800;
207 GraphBuffer[maxPos+1] = -800;
208 }
209 PrintAndLog("Info: raw tag bits = %s", bits);
210
211 TagType = (shift3>>8)&0xff;
212 if ( TagType != ((shift0>>16)&0xff) ) {
213 PrintAndLog("Error: start and stop bits do not match!");
214 return 0;
215 }
216 else if (TagType == 0x7e) {
217 PrintAndLog("Info: Readonly TI tag detected.");
218 return 0;
219 }
220 else if (TagType == 0xfe) {
221 PrintAndLog("Info: Rewriteable TI tag detected.");
222
223 // put 64 bit data into shift1 and shift0
224 shift0 = (shift0>>24) | (shift1 << 8);
225 shift1 = (shift1>>24) | (shift2 << 8);
226
227 // align 16 bit crc into lower half of shift2
228 shift2 = ((shift2>>24) | (shift3 << 8)) & 0x0ffff;
229
230 // align 16 bit "end bits" or "ident" into lower half of shift3
231 shift3 >>= 16;
232
233 // only 15 bits compare, last bit of ident is not valid
234 if ( (shift3^shift0)&0x7fff ) {
235 PrintAndLog("Error: Ident mismatch!");
236 }
237 // WARNING the order of the bytes in which we calc crc below needs checking
238 // i'm 99% sure the crc algorithm is correct, but it may need to eat the
239 // bytes in reverse or something
240 // calculate CRC
241 crc=0;
242 crc = update_crc16(crc, (shift0)&0xff);
243 crc = update_crc16(crc, (shift0>>8)&0xff);
244 crc = update_crc16(crc, (shift0>>16)&0xff);
245 crc = update_crc16(crc, (shift0>>24)&0xff);
246 crc = update_crc16(crc, (shift1)&0xff);
247 crc = update_crc16(crc, (shift1>>8)&0xff);
248 crc = update_crc16(crc, (shift1>>16)&0xff);
249 crc = update_crc16(crc, (shift1>>24)&0xff);
250 PrintAndLog("Info: Tag data = %08X%08X", shift1, shift0);
251 if (crc != (shift2&0xffff)) {
252 PrintAndLog("Error: CRC mismatch, calculated %04X, got ^04X", crc, shift2&0xffff);
253 } else {
254 PrintAndLog("Info: CRC %04X is good", crc);
255 }
256 }
257 else {
258 PrintAndLog("Unknown tag type.");
259 return 0;
260 }
261 return 0;
262 }
263
264 // read a TI tag and return its ID
265 int CmdTIRead(const char *Cmd)
266 {
267 UsbCommand c = {CMD_READ_TI_TYPE};
268 SendCommand(&c);
269 return 0;
270 }
271
272 // write new data to a r/w TI tag
273 int CmdTIWrite(const char *Cmd)
274 {
275 UsbCommand c = {CMD_WRITE_TI_TYPE};
276 int res = 0;
277
278 res = sscanf(Cmd, "%012" SCNx64 " %012" SCNx64 " %012" SCNx64 "", &c.arg[0], &c.arg[1], &c.arg[2]);
279
280 if (res == 2) c.arg[2]=0;
281 if (res < 2)
282 PrintAndLog("Please specify the data as two hex strings, optionally the CRC as a third");
283 else
284 SendCommand(&c);
285 return 0;
286 }
287
288 static command_t CommandTable[] =
289 {
290 {"help", CmdHelp, 1, "This help"},
291 {"demod", CmdTIDemod, 1, "Demodulate raw bits for TI-type LF tag"},
292 {"read", CmdTIRead, 0, "Read and decode a TI 134 kHz tag"},
293 {"write", CmdTIWrite, 0, "Write new data to a r/w TI 134 kHz tag"},
294 {NULL, NULL, 0, NULL}
295 };
296
297 int CmdLFTI(const char *Cmd)
298 {
299 CmdsParse(CommandTable, Cmd);
300 return 0;
301 }
302
303 int CmdHelp(const char *Cmd)
304 {
305 CmdsHelp(CommandTable);
306 return 0;
307 }
Impressum, Datenschutz