]> cvs.zerfleddert.de Git - proxmark3-svn/blob - client/cmdhf14b.c
flasher updated again, should work more solid now
[proxmark3-svn] / client / cmdhf14b.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 // High frequency ISO14443B commands
9 //-----------------------------------------------------------------------------
10
11 #include <stdio.h>
12 #include <stdlib.h>
13 #include <stdbool.h>
14 #include <string.h>
15 #include <stdint.h>
16 #include "iso14443crc.h"
17 //#include "proxusb.h"
18 #include "proxmark3.h"
19 #include "data.h"
20 #include "graph.h"
21 #include "ui.h"
22 #include "cmdparser.h"
23 #include "cmdhf14b.h"
24
25 static int CmdHelp(const char *Cmd);
26
27 int CmdHF14BDemod(const char *Cmd)
28 {
29 int i, j, iold;
30 int isum, qsum;
31 int outOfWeakAt;
32 bool negateI, negateQ;
33
34 uint8_t data[256];
35 int dataLen = 0;
36
37 // As received, the samples are pairs, correlations against I and Q
38 // square waves. So estimate angle of initial carrier (or just
39 // quadrant, actually), and then do the demod.
40
41 // First, estimate where the tag starts modulating.
42 for (i = 0; i < GraphTraceLen; i += 2) {
43 if (abs(GraphBuffer[i]) + abs(GraphBuffer[i + 1]) > 40) {
44 break;
45 }
46 }
47 if (i >= GraphTraceLen) {
48 PrintAndLog("too weak to sync");
49 return 0;
50 }
51 PrintAndLog("out of weak at %d", i);
52 outOfWeakAt = i;
53
54 // Now, estimate the phase in the initial modulation of the tag
55 isum = 0;
56 qsum = 0;
57 for (; i < (outOfWeakAt + 16); i += 2) {
58 isum += GraphBuffer[i + 0];
59 qsum += GraphBuffer[i + 1];
60 }
61 negateI = (isum < 0);
62 negateQ = (qsum < 0);
63
64 // Turn the correlation pairs into soft decisions on the bit.
65 j = 0;
66 for (i = 0; i < GraphTraceLen / 2; i++) {
67 int si = GraphBuffer[j];
68 int sq = GraphBuffer[j + 1];
69 if (negateI) si = -si;
70 if (negateQ) sq = -sq;
71 GraphBuffer[i] = si + sq;
72 j += 2;
73 }
74 GraphTraceLen = i;
75
76 i = outOfWeakAt / 2;
77 while (GraphBuffer[i] > 0 && i < GraphTraceLen)
78 i++;
79 if (i >= GraphTraceLen) goto demodError;
80
81 iold = i;
82 while (GraphBuffer[i] < 0 && i < GraphTraceLen)
83 i++;
84 if (i >= GraphTraceLen) goto demodError;
85 if ((i - iold) > 23) goto demodError;
86
87 PrintAndLog("make it to demod loop");
88
89 for (;;) {
90 iold = i;
91 while (GraphBuffer[i] >= 0 && i < GraphTraceLen)
92 i++;
93 if (i >= GraphTraceLen) goto demodError;
94 if ((i - iold) > 6) goto demodError;
95
96 uint16_t shiftReg = 0;
97 if (i + 20 >= GraphTraceLen) goto demodError;
98
99 for (j = 0; j < 10; j++) {
100 int soft = GraphBuffer[i] + GraphBuffer[i + 1];
101
102 if (abs(soft) < (abs(isum) + abs(qsum)) / 20) {
103 PrintAndLog("weak bit");
104 }
105
106 shiftReg >>= 1;
107 if(GraphBuffer[i] + GraphBuffer[i+1] >= 0) {
108 shiftReg |= 0x200;
109 }
110
111 i+= 2;
112 }
113
114 if ((shiftReg & 0x200) && !(shiftReg & 0x001))
115 {
116 // valid data byte, start and stop bits okay
117 PrintAndLog(" %02x", (shiftReg >> 1) & 0xff);
118 data[dataLen++] = (shiftReg >> 1) & 0xff;
119 if (dataLen >= sizeof(data)) {
120 return 0;
121 }
122 } else if (shiftReg == 0x000) {
123 // this is EOF
124 break;
125 } else {
126 goto demodError;
127 }
128 }
129
130 uint8_t first, second;
131 ComputeCrc14443(CRC_14443_B, data, dataLen-2, &first, &second);
132 PrintAndLog("CRC: %02x %02x (%s)\n", first, second,
133 (first == data[dataLen-2] && second == data[dataLen-1]) ?
134 "ok" : "****FAIL****");
135
136 RepaintGraphWindow();
137 return 0;
138
139 demodError:
140 PrintAndLog("demod error");
141 RepaintGraphWindow();
142 return 0;
143 }
144
145 int CmdHF14BList(const char *Cmd)
146 {
147 uint8_t got[960];
148 GetFromBigBuf(got,sizeof(got),0);
149
150 PrintAndLog("recorded activity:");
151 PrintAndLog(" time :rssi: who bytes");
152 PrintAndLog("---------+----+----+-----------");
153
154 int i = 0;
155 int prev = -1;
156
157 for(;;) {
158 if(i >= 900) {
159 break;
160 }
161
162 bool isResponse;
163 int timestamp = *((uint32_t *)(got+i));
164 if(timestamp & 0x80000000) {
165 timestamp &= 0x7fffffff;
166 isResponse = 1;
167 } else {
168 isResponse = 0;
169 }
170 int metric = *((uint32_t *)(got+i+4));
171
172 int len = got[i+8];
173
174 if(len > 100) {
175 break;
176 }
177 if(i + len >= 900) {
178 break;
179 }
180
181 uint8_t *frame = (got+i+9);
182
183 char line[1000] = "";
184 int j;
185 for(j = 0; j < len; j++) {
186 sprintf(line+(j*3), "%02x ", frame[j]);
187 }
188
189 char *crc;
190 if(len > 2) {
191 uint8_t b1, b2;
192 ComputeCrc14443(CRC_14443_B, frame, len-2, &b1, &b2);
193 if(b1 != frame[len-2] || b2 != frame[len-1]) {
194 crc = "**FAIL CRC**";
195 } else {
196 crc = "";
197 }
198 } else {
199 crc = "(SHORT)";
200 }
201
202 char metricString[100];
203 if(isResponse) {
204 sprintf(metricString, "%3d", metric);
205 } else {
206 strcpy(metricString, " ");
207 }
208
209 PrintAndLog(" +%7d: %s: %s %s %s",
210 (prev < 0 ? 0 : timestamp - prev),
211 metricString,
212 (isResponse ? "TAG" : " "), line, crc);
213
214 prev = timestamp;
215 i += (len + 9);
216 }
217 return 0;
218 }
219
220 int CmdHF14BRead(const char *Cmd)
221 {
222 UsbCommand c = {CMD_ACQUIRE_RAW_ADC_SAMPLES_ISO_14443, {strtol(Cmd, NULL, 0), 0, 0}};
223 SendCommand(&c);
224 return 0;
225 }
226
227 int CmdHF14Sim(const char *Cmd)
228 {
229 UsbCommand c={CMD_SIMULATE_TAG_ISO_14443};
230 SendCommand(&c);
231 return 0;
232 }
233
234 int CmdHFSimlisten(const char *Cmd)
235 {
236 UsbCommand c = {CMD_SIMULATE_TAG_HF_LISTEN};
237 SendCommand(&c);
238 return 0;
239 }
240
241 int CmdHF14BSnoop(const char *Cmd)
242 {
243 UsbCommand c = {CMD_SNOOP_ISO_14443};
244 SendCommand(&c);
245 return 0;
246 }
247
248 /* New command to read the contents of a SRI512 tag
249 * SRI512 tags are ISO14443-B modulated memory tags,
250 * this command just dumps the contents of the memory
251 */
252 int CmdSri512Read(const char *Cmd)
253 {
254 UsbCommand c = {CMD_READ_SRI512_TAG, {strtol(Cmd, NULL, 0), 0, 0}};
255 SendCommand(&c);
256 return 0;
257 }
258
259 /* New command to read the contents of a SRIX4K tag
260 * SRIX4K tags are ISO14443-B modulated memory tags,
261 * this command just dumps the contents of the memory/
262 */
263 int CmdSrix4kRead(const char *Cmd)
264 {
265 UsbCommand c = {CMD_READ_SRIX4K_TAG, {strtol(Cmd, NULL, 0), 0, 0}};
266 SendCommand(&c);
267 return 0;
268 }
269
270 static command_t CommandTable[] =
271 {
272 {"help", CmdHelp, 1, "This help"},
273 {"demod", CmdHF14BDemod, 1, "Demodulate ISO14443 Type B from tag"},
274 {"list", CmdHF14BList, 0, "List ISO 14443 history"},
275 {"read", CmdHF14BRead, 0, "Read HF tag (ISO 14443)"},
276 {"sim", CmdHF14Sim, 0, "Fake ISO 14443 tag"},
277 {"simlisten", CmdHFSimlisten, 0, "Get HF samples as fake tag"},
278 {"snoop", CmdHF14BSnoop, 0, "Eavesdrop ISO 14443"},
279 {"sri512read", CmdSri512Read, 0, "<int> -- Read contents of a SRI512 tag"},
280 {"srix4kread", CmdSrix4kRead, 0, "<int> -- Read contents of a SRIX4K tag"},
281 {NULL, NULL, 0, NULL}
282 };
283
284 int CmdHF14B(const char *Cmd)
285 {
286 CmdsParse(CommandTable, Cmd);
287 return 0;
288 }
289
290 int CmdHelp(const char *Cmd)
291 {
292 CmdsHelp(CommandTable);
293 return 0;
294 }
Impressum, Datenschutz