]>
Commit | Line | Data |
---|---|---|
dc3e2acf OM |
1 | //----------------------------------------------------------------------------- |
2 | // Copyright (C) 2018 Merlok | |
4b5d696c | 3 | // Copyright (C) 2018 drHatson |
dc3e2acf OM |
4 | // |
5 | // This code is licensed to you under the terms of the GNU GPL, version 2 or, | |
6 | // at your option, any later version. See the LICENSE.txt file for the text of | |
7 | // the license. | |
8 | //----------------------------------------------------------------------------- | |
9 | // High frequency MIFARE Plus commands | |
10 | //----------------------------------------------------------------------------- | |
11 | ||
12 | #include "cmdhfmfp.h" | |
13 | ||
14 | #include <inttypes.h> | |
15 | #include <string.h> | |
16 | #include <stdio.h> | |
17 | #include <stdlib.h> | |
18 | #include <ctype.h> | |
19 | #include "comms.h" | |
20 | #include "cmdmain.h" | |
21 | #include "util.h" | |
22 | #include "ui.h" | |
23 | #include "cmdhf14a.h" | |
24 | #include "mifare.h" | |
fdd9395d OM |
25 | #include "mifare/mifare4.h" |
26 | #include "mifare/mad.h" | |
27 | #include "mifare/ndef.h" | |
ae3340a0 | 28 | #include "cliparser/cliparser.h" |
700d8687 | 29 | #include "crypto/libpcrypto.h" |
fdd9395d | 30 | #include "emv/dump.h" |
ae3340a0 OM |
31 | |
32 | static const uint8_t DefaultKey[16] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; | |
33 | ||
dc3e2acf OM |
34 | static int CmdHelp(const char *Cmd); |
35 | ||
36 | int CmdHFMFPInfo(const char *cmd) { | |
37 | ||
38 | if (cmd && strlen(cmd) > 0) | |
39 | PrintAndLog("WARNING: command don't have any parameters.\n"); | |
40 | ||
41 | // info about 14a part | |
42 | CmdHF14AInfo(""); | |
43 | ||
44 | // Mifare Plus info | |
45 | UsbCommand c = {CMD_READER_ISO_14443a, {ISO14A_CONNECT | ISO14A_NO_DISCONNECT, 0, 0}}; | |
46 | SendCommand(&c); | |
47 | ||
48 | UsbCommand resp; | |
49 | WaitForResponse(CMD_ACK,&resp); | |
50 | ||
51 | iso14a_card_select_t card; | |
52 | memcpy(&card, (iso14a_card_select_t *)resp.d.asBytes, sizeof(iso14a_card_select_t)); | |
53 | ||
54 | uint64_t select_status = resp.arg[0]; // 0: couldn't read, 1: OK, with ATS, 2: OK, no ATS, 3: proprietary Anticollision | |
55 | ||
56 | if (select_status == 1 || select_status == 2) { | |
57 | PrintAndLog("----------------------------------------------"); | |
58 | PrintAndLog("Mifare Plus info:"); | |
59 | ||
60 | // MIFARE Type Identification Procedure | |
61 | // https://www.nxp.com/docs/en/application-note/AN10833.pdf | |
62 | uint16_t ATQA = card.atqa[0] + (card.atqa[1] << 8); | |
63 | if (ATQA == 0x0004) PrintAndLog("ATQA: Mifare Plus 2k 4bUID"); | |
64 | if (ATQA == 0x0002) PrintAndLog("ATQA: Mifare Plus 4k 4bUID"); | |
65 | if (ATQA == 0x0044) PrintAndLog("ATQA: Mifare Plus 2k 7bUID"); | |
66 | if (ATQA == 0x0042) PrintAndLog("ATQA: Mifare Plus 4k 7bUID"); | |
67 | ||
68 | uint8_t SLmode = 0xff; | |
69 | if (card.sak == 0x08) { | |
70 | PrintAndLog("SAK: Mifare Plus 2k 7bUID"); | |
71 | if (select_status == 2) SLmode = 1; | |
72 | } | |
73 | if (card.sak == 0x18) { | |
74 | PrintAndLog("SAK: Mifare Plus 4k 7bUID"); | |
75 | if (select_status == 2) SLmode = 1; | |
76 | } | |
77 | if (card.sak == 0x10) { | |
78 | PrintAndLog("SAK: Mifare Plus 2k"); | |
79 | if (select_status == 2) SLmode = 2; | |
80 | } | |
81 | if (card.sak == 0x11) { | |
82 | PrintAndLog("SAK: Mifare Plus 4k"); | |
83 | if (select_status == 2) SLmode = 2; | |
84 | } | |
85 | if (card.sak == 0x20) { | |
86 | PrintAndLog("SAK: Mifare Plus SL0/SL3 or Mifare desfire"); | |
87 | if (card.ats_len > 0) { | |
88 | SLmode = 3; | |
89 | ||
90 | // check SL0 | |
91 | uint8_t data[250] = {0}; | |
92 | int datalen = 0; | |
93 | // https://github.com/Proxmark/proxmark3/blob/master/client/scripts/mifarePlus.lua#L161 | |
94 | uint8_t cmd[3 + 16] = {0xa8, 0x90, 0x90, 0x00}; | |
95 | int res = ExchangeRAW14a(cmd, sizeof(cmd), false, false, data, sizeof(data), &datalen); | |
96 | if (!res && datalen > 1 && data[0] == 0x09) { | |
97 | SLmode = 0; | |
98 | } | |
99 | } | |
100 | } | |
101 | ||
102 | if (SLmode != 0xff) | |
103 | PrintAndLog("Mifare Plus SL mode: SL%d", SLmode); | |
104 | else | |
105 | PrintAndLog("Mifare Plus SL mode: unknown("); | |
106 | } else { | |
107 | PrintAndLog("Mifare Plus info not available."); | |
108 | } | |
109 | ||
110 | DropField(); | |
111 | ||
112 | return 0; | |
113 | } | |
114 | ||
ae3340a0 OM |
115 | int CmdHFMFPWritePerso(const char *cmd) { |
116 | uint8_t keyNum[64] = {0}; | |
117 | int keyNumLen = 0; | |
118 | uint8_t key[64] = {0}; | |
119 | int keyLen = 0; | |
120 | ||
121 | CLIParserInit("hf mfp wrp", | |
122 | "Executes Write Perso command. Can be used in SL0 mode only.", | |
123 | "Usage:\n\thf mfp wrp 4000 000102030405060708090a0b0c0d0e0f -> write key (00..0f) to key number 4000 \n" | |
124 | "\thf mfp wrp 4000 -> write default key(0xff..0xff) to key number 4000"); | |
125 | ||
126 | void* argtable[] = { | |
127 | arg_param_begin, | |
128 | arg_lit0("vV", "verbose", "show internal data."), | |
129 | arg_str1(NULL, NULL, "<HEX key number (2b)>", NULL), | |
130 | arg_strx0(NULL, NULL, "<HEX key (16b)>", NULL), | |
131 | arg_param_end | |
132 | }; | |
133 | CLIExecWithReturn(cmd, argtable, true); | |
134 | ||
135 | bool verbose = arg_get_lit(1); | |
136 | CLIGetHexWithReturn(2, keyNum, &keyNumLen); | |
137 | CLIGetHexWithReturn(3, key, &keyLen); | |
138 | CLIParserFree(); | |
139 | ||
fdd9395d | 140 | mfpSetVerboseMode(verbose); |
ae3340a0 OM |
141 | |
142 | if (!keyLen) { | |
143 | memmove(key, DefaultKey, 16); | |
144 | keyLen = 16; | |
145 | } | |
146 | ||
147 | if (keyNumLen != 2) { | |
148 | PrintAndLog("Key number length must be 2 bytes instead of: %d", keyNumLen); | |
149 | return 1; | |
150 | } | |
151 | if (keyLen != 16) { | |
152 | PrintAndLog("Key length must be 16 bytes instead of: %d", keyLen); | |
153 | return 1; | |
154 | } | |
155 | ||
156 | uint8_t data[250] = {0}; | |
157 | int datalen = 0; | |
158 | ||
159 | int res = MFPWritePerso(keyNum, key, true, false, data, sizeof(data), &datalen); | |
160 | if (res) { | |
161 | PrintAndLog("Exchange error: %d", res); | |
162 | return res; | |
163 | } | |
164 | ||
165 | if (datalen != 3) { | |
166 | PrintAndLog("Command must return 3 bytes instead of: %d", datalen); | |
167 | return 1; | |
168 | } | |
169 | ||
170 | if (data[0] != 0x90) { | |
fdd9395d | 171 | PrintAndLog("Command error: %02x %s", data[0], mfpGetErrorDescription(data[0])); |
ae3340a0 OM |
172 | return 1; |
173 | } | |
174 | PrintAndLog("Write OK."); | |
175 | ||
176 | return 0; | |
177 | } | |
178 | ||
179 | uint16_t CardAddresses[] = {0x9000, 0x9001, 0x9002, 0x9003, 0x9004, 0xA000, 0xA001, 0xA080, 0xA081, 0xC000, 0xC001}; | |
180 | ||
181 | int CmdHFMFPInitPerso(const char *cmd) { | |
182 | int res; | |
183 | uint8_t key[256] = {0}; | |
184 | int keyLen = 0; | |
185 | uint8_t keyNum[2] = {0}; | |
186 | uint8_t data[250] = {0}; | |
187 | int datalen = 0; | |
188 | ||
189 | CLIParserInit("hf mfp initp", | |
190 | "Executes Write Perso command for all card's keys. Can be used in SL0 mode only.", | |
191 | "Usage:\n\thf mfp initp 000102030405060708090a0b0c0d0e0f -> fill all the keys with key (00..0f)\n" | |
192 | "\thf mfp initp -vv -> fill all the keys with default key(0xff..0xff) and show all the data exchange"); | |
193 | ||
194 | void* argtable[] = { | |
195 | arg_param_begin, | |
196 | arg_litn("vV", "verbose", 0, 2, "show internal data."), | |
197 | arg_strx0(NULL, NULL, "<HEX key (16b)>", NULL), | |
198 | arg_param_end | |
199 | }; | |
200 | CLIExecWithReturn(cmd, argtable, true); | |
201 | ||
202 | bool verbose = arg_get_lit(1); | |
203 | bool verbose2 = arg_get_lit(1) > 1; | |
204 | CLIGetHexWithReturn(2, key, &keyLen); | |
205 | CLIParserFree(); | |
206 | ||
207 | if (keyLen && keyLen != 16) { | |
208 | PrintAndLog("Key length must be 16 bytes instead of: %d", keyLen); | |
209 | return 1; | |
210 | } | |
211 | ||
212 | if (!keyLen) | |
213 | memmove(key, DefaultKey, 16); | |
214 | ||
fdd9395d | 215 | mfpSetVerboseMode(verbose2); |
ae3340a0 OM |
216 | for (uint16_t sn = 0x4000; sn < 0x4050; sn++) { |
217 | keyNum[0] = sn >> 8; | |
218 | keyNum[1] = sn & 0xff; | |
219 | res = MFPWritePerso(keyNum, key, (sn == 0x4000), true, data, sizeof(data), &datalen); | |
220 | if (!res && (datalen == 3) && data[0] == 0x09) { | |
221 | PrintAndLog("2k card detected."); | |
222 | break; | |
223 | } | |
224 | if (res || (datalen != 3) || data[0] != 0x90) { | |
225 | PrintAndLog("Write error on address %04x", sn); | |
226 | break; | |
227 | } | |
228 | } | |
229 | ||
fdd9395d | 230 | mfpSetVerboseMode(verbose); |
ae3340a0 OM |
231 | for (int i = 0; i < sizeof(CardAddresses) / 2; i++) { |
232 | keyNum[0] = CardAddresses[i] >> 8; | |
233 | keyNum[1] = CardAddresses[i] & 0xff; | |
234 | res = MFPWritePerso(keyNum, key, false, true, data, sizeof(data), &datalen); | |
235 | if (!res && (datalen == 3) && data[0] == 0x09) { | |
236 | PrintAndLog("Skipped[%04x]...", CardAddresses[i]); | |
237 | } else { | |
238 | if (res || (datalen != 3) || data[0] != 0x90) { | |
239 | PrintAndLog("Write error on address %04x", CardAddresses[i]); | |
240 | break; | |
241 | } | |
242 | } | |
243 | } | |
244 | ||
245 | DropField(); | |
246 | ||
247 | if (res) | |
248 | return res; | |
249 | ||
250 | PrintAndLog("Done."); | |
251 | ||
252 | return 0; | |
253 | } | |
254 | ||
255 | int CmdHFMFPCommitPerso(const char *cmd) { | |
256 | CLIParserInit("hf mfp commitp", | |
257 | "Executes Commit Perso command. Can be used in SL0 mode only.", | |
258 | "Usage:\n\thf mfp commitp -> \n"); | |
259 | ||
260 | void* argtable[] = { | |
261 | arg_param_begin, | |
262 | arg_lit0("vV", "verbose", "show internal data."), | |
263 | arg_int0(NULL, NULL, "SL mode", NULL), | |
264 | arg_param_end | |
265 | }; | |
266 | CLIExecWithReturn(cmd, argtable, true); | |
267 | ||
268 | bool verbose = arg_get_lit(1); | |
269 | CLIParserFree(); | |
270 | ||
fdd9395d | 271 | mfpSetVerboseMode(verbose); |
ae3340a0 OM |
272 | |
273 | uint8_t data[250] = {0}; | |
274 | int datalen = 0; | |
275 | ||
276 | int res = MFPCommitPerso(true, false, data, sizeof(data), &datalen); | |
277 | if (res) { | |
278 | PrintAndLog("Exchange error: %d", res); | |
279 | return res; | |
280 | } | |
281 | ||
282 | if (datalen != 3) { | |
283 | PrintAndLog("Command must return 3 bytes instead of: %d", datalen); | |
284 | return 1; | |
285 | } | |
286 | ||
287 | if (data[0] != 0x90) { | |
fdd9395d | 288 | PrintAndLog("Command error: %02x %s", data[0], mfpGetErrorDescription(data[0])); |
ae3340a0 OM |
289 | return 1; |
290 | } | |
291 | PrintAndLog("Switch level OK."); | |
292 | ||
293 | return 0; | |
294 | } | |
295 | ||
296 | int CmdHFMFPAuth(const char *cmd) { | |
297 | uint8_t keyn[250] = {0}; | |
298 | int keynlen = 0; | |
299 | uint8_t key[250] = {0}; | |
300 | int keylen = 0; | |
301 | ||
302 | CLIParserInit("hf mfp auth", | |
c8a0f550 | 303 | "Executes AES authentication command for Mifare Plus card", |
ae3340a0 OM |
304 | "Usage:\n\thf mfp auth 4000 000102030405060708090a0b0c0d0e0f -> executes authentication\n" |
305 | "\thf mfp auth 9003 FFFFFFFFFFFFFFFFFFFFFFFFFFFFFFFF -v -> executes authentication and shows all the system data\n"); | |
306 | ||
307 | void* argtable[] = { | |
308 | arg_param_begin, | |
309 | arg_lit0("vV", "verbose", "show internal data."), | |
310 | arg_str1(NULL, NULL, "<Key Num (HEX 2 bytes)>", NULL), | |
311 | arg_str1(NULL, NULL, "<Key Value (HEX 16 bytes)>", NULL), | |
312 | arg_param_end | |
313 | }; | |
314 | CLIExecWithReturn(cmd, argtable, true); | |
315 | ||
316 | bool verbose = arg_get_lit(1); | |
317 | CLIGetHexWithReturn(2, keyn, &keynlen); | |
318 | CLIGetHexWithReturn(3, key, &keylen); | |
319 | CLIParserFree(); | |
320 | ||
321 | if (keynlen != 2) { | |
322 | PrintAndLog("ERROR: <Key Num> must be 2 bytes long instead of: %d", keynlen); | |
323 | return 1; | |
324 | } | |
325 | ||
326 | if (keylen != 16) { | |
327 | PrintAndLog("ERROR: <Key Value> must be 16 bytes long instead of: %d", keylen); | |
328 | return 1; | |
329 | } | |
330 | ||
331 | return MifareAuth4(NULL, keyn, key, true, false, verbose); | |
332 | } | |
333 | ||
334 | int CmdHFMFPRdbl(const char *cmd) { | |
c8a0f550 OM |
335 | uint8_t keyn[2] = {0}; |
336 | uint8_t key[250] = {0}; | |
337 | int keylen = 0; | |
338 | ||
339 | CLIParserInit("hf mfp rdbl", | |
4b5d696c | 340 | "Reads several blocks from Mifare Plus card.", |
c8a0f550 OM |
341 | "Usage:\n\thf mfp rdbl 0 000102030405060708090a0b0c0d0e0f -> executes authentication and read block 0 data\n" |
342 | "\thf mfp rdbl 1 -v -> executes authentication and shows sector 1 data with default key 0xFF..0xFF and some additional data\n"); | |
343 | ||
344 | void* argtable[] = { | |
345 | arg_param_begin, | |
346 | arg_lit0("vV", "verbose", "show internal data."), | |
347 | arg_int0("nN", "count", "blocks count (by default 1).", NULL), | |
348 | arg_lit0("bB", "keyb", "use key B (by default keyA)."), | |
4b5d696c | 349 | arg_lit0("pP", "plain", "plain communication mode between reader and card."), |
c8a0f550 OM |
350 | arg_int1(NULL, NULL, "<Block Num (0..255)>", NULL), |
351 | arg_str0(NULL, NULL, "<Key Value (HEX 16 bytes)>", NULL), | |
352 | arg_param_end | |
353 | }; | |
354 | CLIExecWithReturn(cmd, argtable, false); | |
355 | ||
356 | bool verbose = arg_get_lit(1); | |
357 | int blocksCount = arg_get_int_def(2, 1); | |
358 | bool keyB = arg_get_lit(3); | |
4b5d696c | 359 | int plain = arg_get_lit(4); |
c8a0f550 OM |
360 | uint32_t blockn = arg_get_int(5); |
361 | CLIGetHexWithReturn(6, key, &keylen); | |
362 | CLIParserFree(); | |
363 | ||
fdd9395d | 364 | mfpSetVerboseMode(verbose); |
c8a0f550 OM |
365 | |
366 | if (!keylen) { | |
367 | memmove(key, DefaultKey, 16); | |
368 | keylen = 16; | |
369 | } | |
370 | ||
371 | if (blockn > 255) { | |
372 | PrintAndLog("ERROR: <Block Num> must be in range [0..255] instead of: %d", blockn); | |
373 | return 1; | |
374 | } | |
375 | ||
376 | if (keylen != 16) { | |
377 | PrintAndLog("ERROR: <Key Value> must be 16 bytes long instead of: %d", keylen); | |
378 | return 1; | |
379 | } | |
380 | ||
381 | // 3 blocks - wo iso14443-4 chaining | |
382 | if (blocksCount > 3) { | |
383 | PrintAndLog("ERROR: blocks count must be less than 3 instead of: %d", blocksCount); | |
384 | return 1; | |
385 | } | |
386 | ||
4b5d696c | 387 | if (blocksCount > 1 && mfIsSectorTrailer(blockn)) { |
388 | PrintAndLog("WARNING: trailer!"); | |
389 | } | |
390 | ||
c8a0f550 OM |
391 | uint8_t sectorNum = mfSectorNum(blockn & 0xff); |
392 | uint16_t uKeyNum = 0x4000 + sectorNum * 2 + (keyB ? 1 : 0); | |
393 | keyn[0] = uKeyNum >> 8; | |
394 | keyn[1] = uKeyNum & 0xff; | |
395 | if (verbose) | |
396 | PrintAndLog("--block:%d sector[%d]:%02x key:%04x", blockn, mfNumBlocksPerSector(sectorNum), sectorNum, uKeyNum); | |
397 | ||
398 | mf4Session session; | |
399 | int res = MifareAuth4(&session, keyn, key, true, true, verbose); | |
400 | if (res) { | |
401 | PrintAndLog("Authentication error: %d", res); | |
402 | return res; | |
403 | } | |
404 | ||
405 | uint8_t data[250] = {0}; | |
406 | int datalen = 0; | |
407 | uint8_t mac[8] = {0}; | |
408 | res = MFPReadBlock(&session, plain, blockn & 0xff, blocksCount, false, false, data, sizeof(data), &datalen, mac); | |
409 | if (res) { | |
410 | PrintAndLog("Read error: %d", res); | |
411 | return res; | |
412 | } | |
413 | ||
414 | if (datalen && data[0] != 0x90) { | |
fdd9395d | 415 | PrintAndLog("Card read error: %02x %s", data[0], mfpGetErrorDescription(data[0])); |
c8a0f550 OM |
416 | return 6; |
417 | } | |
418 | ||
419 | if (datalen != 1 + blocksCount * 16 + 8 + 2) { | |
420 | PrintAndLog("Error return length:%d", datalen); | |
421 | return 5; | |
422 | } | |
423 | ||
424 | int indx = blockn; | |
425 | for(int i = 0; i < blocksCount; i++) { | |
426 | PrintAndLog("data[%03d]: %s", indx, sprint_hex(&data[1 + i * 16], 16)); | |
427 | indx++; | |
4b5d696c | 428 | if (mfIsSectorTrailer(indx) && i != blocksCount - 1){ |
c8a0f550 OM |
429 | PrintAndLog("data[%03d]: ------------------- trailer -------------------", indx); |
430 | indx++; | |
431 | } | |
432 | } | |
433 | ||
4b5d696c | 434 | if (memcmp(&data[blocksCount * 16 + 1], mac, 8)) { |
c8a0f550 OM |
435 | PrintAndLog("WARNING: mac not equal..."); |
436 | PrintAndLog("MAC card: %s", sprint_hex(&data[blocksCount * 16 + 1], 8)); | |
437 | PrintAndLog("MAC reader: %s", sprint_hex(mac, 8)); | |
438 | } else { | |
439 | if(verbose) | |
440 | PrintAndLog("MAC: %s", sprint_hex(&data[blocksCount * 16 + 1], 8)); | |
441 | } | |
ae3340a0 OM |
442 | |
443 | return 0; | |
444 | } | |
445 | ||
446 | int CmdHFMFPRdsc(const char *cmd) { | |
c8a0f550 OM |
447 | uint8_t keyn[2] = {0}; |
448 | uint8_t key[250] = {0}; | |
449 | int keylen = 0; | |
450 | ||
451 | CLIParserInit("hf mfp rdsc", | |
4b5d696c | 452 | "Reads one sector from Mifare Plus card.", |
c8a0f550 OM |
453 | "Usage:\n\thf mfp rdsc 0 000102030405060708090a0b0c0d0e0f -> executes authentication and read sector 0 data\n" |
454 | "\thf mfp rdsc 1 -v -> executes authentication and shows sector 1 data with default key 0xFF..0xFF and some additional data\n"); | |
455 | ||
456 | void* argtable[] = { | |
457 | arg_param_begin, | |
458 | arg_lit0("vV", "verbose", "show internal data."), | |
459 | arg_lit0("bB", "keyb", "use key B (by default keyA)."), | |
4b5d696c | 460 | arg_lit0("pP", "plain", "plain communication mode between reader and card."), |
c8a0f550 OM |
461 | arg_int1(NULL, NULL, "<Sector Num (0..255)>", NULL), |
462 | arg_str0(NULL, NULL, "<Key Value (HEX 16 bytes)>", NULL), | |
463 | arg_param_end | |
464 | }; | |
465 | CLIExecWithReturn(cmd, argtable, false); | |
466 | ||
467 | bool verbose = arg_get_lit(1); | |
468 | bool keyB = arg_get_lit(2); | |
4b5d696c | 469 | bool plain = arg_get_lit(3); |
c8a0f550 OM |
470 | uint32_t sectorNum = arg_get_int(4); |
471 | CLIGetHexWithReturn(5, key, &keylen); | |
472 | CLIParserFree(); | |
473 | ||
fdd9395d | 474 | mfpSetVerboseMode(verbose); |
c8a0f550 OM |
475 | |
476 | if (!keylen) { | |
477 | memmove(key, DefaultKey, 16); | |
478 | keylen = 16; | |
479 | } | |
480 | ||
481 | if (sectorNum > 39) { | |
482 | PrintAndLog("ERROR: <Sector Num> must be in range [0..39] instead of: %d", sectorNum); | |
483 | return 1; | |
484 | } | |
485 | ||
486 | if (keylen != 16) { | |
487 | PrintAndLog("ERROR: <Key Value> must be 16 bytes long instead of: %d", keylen); | |
488 | return 1; | |
489 | } | |
490 | ||
491 | uint16_t uKeyNum = 0x4000 + sectorNum * 2 + (keyB ? 1 : 0); | |
492 | keyn[0] = uKeyNum >> 8; | |
493 | keyn[1] = uKeyNum & 0xff; | |
494 | if (verbose) | |
495 | PrintAndLog("--sector[%d]:%02x key:%04x", mfNumBlocksPerSector(sectorNum), sectorNum, uKeyNum); | |
496 | ||
497 | mf4Session session; | |
498 | int res = MifareAuth4(&session, keyn, key, true, true, verbose); | |
499 | if (res) { | |
500 | PrintAndLog("Authentication error: %d", res); | |
501 | return res; | |
502 | } | |
503 | ||
504 | uint8_t data[250] = {0}; | |
505 | int datalen = 0; | |
506 | uint8_t mac[8] = {0}; | |
507 | for(int n = mfFirstBlockOfSector(sectorNum); n < mfFirstBlockOfSector(sectorNum) + mfNumBlocksPerSector(sectorNum); n++) { | |
508 | res = MFPReadBlock(&session, plain, n & 0xff, 1, false, true, data, sizeof(data), &datalen, mac); | |
509 | if (res) { | |
510 | PrintAndLog("Read error: %d", res); | |
511 | DropField(); | |
512 | return res; | |
513 | } | |
514 | ||
515 | if (datalen && data[0] != 0x90) { | |
fdd9395d | 516 | PrintAndLog("Card read error: %02x %s", data[0], mfpGetErrorDescription(data[0])); |
c8a0f550 OM |
517 | DropField(); |
518 | return 6; | |
519 | } | |
520 | if (datalen != 1 + 16 + 8 + 2) { | |
521 | PrintAndLog("Error return length:%d", datalen); | |
522 | DropField(); | |
523 | return 5; | |
524 | } | |
525 | ||
526 | PrintAndLog("data[%03d]: %s", n, sprint_hex(&data[1], 16)); | |
527 | ||
4b5d696c | 528 | if (memcmp(&data[1 + 16], mac, 8)) { |
c8a0f550 OM |
529 | PrintAndLog("WARNING: mac on block %d not equal...", n); |
530 | PrintAndLog("MAC card: %s", sprint_hex(&data[1 + 16], 8)); | |
531 | PrintAndLog("MAC reader: %s", sprint_hex(mac, 8)); | |
532 | } else { | |
533 | if(verbose) | |
534 | PrintAndLog("MAC: %s", sprint_hex(&data[1 + 16], 8)); | |
535 | } | |
536 | } | |
537 | DropField(); | |
ae3340a0 OM |
538 | |
539 | return 0; | |
540 | } | |
541 | ||
542 | int CmdHFMFPWrbl(const char *cmd) { | |
c8a0f550 OM |
543 | uint8_t keyn[2] = {0}; |
544 | uint8_t key[250] = {0}; | |
545 | int keylen = 0; | |
546 | uint8_t datain[250] = {0}; | |
547 | int datainlen = 0; | |
548 | ||
549 | CLIParserInit("hf mfp wrbl", | |
550 | "Writes one block to Mifare Plus card.", | |
551 | "Usage:\n\thf mfp wrbl 1 ff0000000000000000000000000000ff 000102030405060708090a0b0c0d0e0f -> writes block 1 data\n" | |
552 | "\thf mfp wrbl 2 ff0000000000000000000000000000ff -v -> writes block 2 data with default key 0xFF..0xFF and some additional data\n"); | |
553 | ||
554 | void* argtable[] = { | |
555 | arg_param_begin, | |
556 | arg_lit0("vV", "verbose", "show internal data."), | |
557 | arg_lit0("bB", "keyb", "use key B (by default keyA)."), | |
558 | arg_int1(NULL, NULL, "<Block Num (0..255)>", NULL), | |
559 | arg_str1(NULL, NULL, "<Data (HEX 16 bytes)>", NULL), | |
560 | arg_str0(NULL, NULL, "<Key (HEX 16 bytes)>", NULL), | |
561 | arg_param_end | |
562 | }; | |
563 | CLIExecWithReturn(cmd, argtable, false); | |
564 | ||
565 | bool verbose = arg_get_lit(1); | |
566 | bool keyB = arg_get_lit(2); | |
567 | uint32_t blockNum = arg_get_int(3); | |
568 | CLIGetHexWithReturn(4, datain, &datainlen); | |
569 | CLIGetHexWithReturn(5, key, &keylen); | |
570 | CLIParserFree(); | |
571 | ||
fdd9395d | 572 | mfpSetVerboseMode(verbose); |
c8a0f550 OM |
573 | |
574 | if (!keylen) { | |
575 | memmove(key, DefaultKey, 16); | |
576 | keylen = 16; | |
577 | } | |
578 | ||
579 | if (blockNum > 39) { | |
580 | PrintAndLog("ERROR: <Block Num> must be in range [0..255] instead of: %d", blockNum); | |
581 | return 1; | |
582 | } | |
583 | ||
584 | if (keylen != 16) { | |
585 | PrintAndLog("ERROR: <Key> must be 16 bytes long instead of: %d", keylen); | |
586 | return 1; | |
587 | } | |
588 | ||
589 | if (datainlen != 16) { | |
590 | PrintAndLog("ERROR: <Data> must be 16 bytes long instead of: %d", datainlen); | |
591 | return 1; | |
592 | } | |
ae3340a0 | 593 | |
c8a0f550 OM |
594 | uint8_t sectorNum = mfSectorNum(blockNum & 0xff); |
595 | uint16_t uKeyNum = 0x4000 + sectorNum * 2 + (keyB ? 1 : 0); | |
596 | keyn[0] = uKeyNum >> 8; | |
597 | keyn[1] = uKeyNum & 0xff; | |
598 | if (verbose) | |
599 | PrintAndLog("--block:%d sector[%d]:%02x key:%04x", blockNum & 0xff, mfNumBlocksPerSector(sectorNum), sectorNum, uKeyNum); | |
600 | ||
601 | mf4Session session; | |
602 | int res = MifareAuth4(&session, keyn, key, true, true, verbose); | |
603 | if (res) { | |
604 | PrintAndLog("Authentication error: %d", res); | |
605 | return res; | |
606 | } | |
607 | ||
608 | uint8_t data[250] = {0}; | |
609 | int datalen = 0; | |
610 | uint8_t mac[8] = {0}; | |
611 | res = MFPWriteBlock(&session, blockNum & 0xff, datain, false, false, data, sizeof(data), &datalen, mac); | |
612 | if (res) { | |
613 | PrintAndLog("Write error: %d", res); | |
614 | DropField(); | |
615 | return res; | |
616 | } | |
617 | ||
618 | if (datalen != 3 && (datalen != 3 + 8)) { | |
619 | PrintAndLog("Error return length:%d", datalen); | |
620 | DropField(); | |
621 | return 5; | |
622 | } | |
623 | ||
624 | if (datalen && data[0] != 0x90) { | |
fdd9395d | 625 | PrintAndLog("Card write error: %02x %s", data[0], mfpGetErrorDescription(data[0])); |
c8a0f550 OM |
626 | DropField(); |
627 | return 6; | |
628 | } | |
629 | ||
4b5d696c | 630 | if (memcmp(&data[1], mac, 8)) { |
c8a0f550 OM |
631 | PrintAndLog("WARNING: mac not equal..."); |
632 | PrintAndLog("MAC card: %s", sprint_hex(&data[1], 8)); | |
633 | PrintAndLog("MAC reader: %s", sprint_hex(mac, 8)); | |
634 | } else { | |
635 | if(verbose) | |
636 | PrintAndLog("MAC: %s", sprint_hex(&data[1], 8)); | |
637 | } | |
638 | ||
639 | DropField(); | |
4b5d696c | 640 | PrintAndLog("Write OK."); |
ae3340a0 OM |
641 | return 0; |
642 | } | |
643 | ||
fdd9395d OM |
644 | int CmdHFMFPMAD(const char *cmd) { |
645 | ||
646 | CLIParserInit("hf mfp mad", | |
647 | "Checks and prints Mifare Application Directory (MAD)", | |
648 | "Usage:\n\thf mfp mad -> shows MAD if exists\n" | |
649 | "\thf mfp mad -a 03e1 -k d3f7d3f7d3f7d3f7d3f7d3f7d3f7d3f7 -> shows NDEF data if exists\n"); | |
650 | ||
651 | void *argtable[] = { | |
652 | arg_param_begin, | |
653 | arg_lit0("vV", "verbose", "show technical data"), | |
654 | arg_str0("aA", "aid", "print all sectors with aid", NULL), | |
655 | arg_str0("kK", "key", "key for printing sectors", NULL), | |
656 | arg_lit0("bB", "keyb", "use key B for access printing sectors (by default: key A)"), | |
657 | arg_param_end | |
658 | }; | |
659 | CLIExecWithReturn(cmd, argtable, true); | |
660 | ||
661 | bool verbose = arg_get_lit(1); | |
662 | uint8_t aid[2] = {0}; | |
663 | int aidlen; | |
664 | CLIGetHexWithReturn(2, aid, &aidlen); | |
665 | uint8_t key[16] = {0}; | |
666 | int keylen; | |
667 | CLIGetHexWithReturn(3, key, &keylen); | |
668 | bool keyB = arg_get_lit(4); | |
669 | ||
670 | CLIParserFree(); | |
671 | ||
672 | if (aidlen != 2 && keylen > 0) { | |
673 | PrintAndLogEx(WARNING, "do not need a key without aid."); | |
674 | } | |
675 | ||
676 | uint8_t sector0[16 * 4] = {0}; | |
677 | uint8_t sector10[16 * 4] = {0}; | |
678 | ||
679 | if (mfpReadSector(MF_MAD1_SECTOR, MF_KEY_A, (uint8_t *)g_mifarep_mad_key, sector0, verbose)) { | |
680 | PrintAndLogEx(NORMAL, ""); | |
681 | PrintAndLogEx(ERR, "read sector 0 error. card don't have MAD or don't have MAD on default keys."); | |
682 | return 2; | |
683 | } | |
684 | ||
685 | if (verbose) { | |
686 | for (int i = 0; i < 4; i ++) | |
687 | PrintAndLogEx(NORMAL, "[%d] %s", i, sprint_hex(§or0[i * 16], 16)); | |
688 | } | |
689 | ||
690 | bool haveMAD2 = false; | |
691 | MAD1DecodeAndPrint(sector0, verbose, &haveMAD2); | |
692 | ||
693 | if (haveMAD2) { | |
694 | if (mfpReadSector(MF_MAD2_SECTOR, MF_KEY_A, (uint8_t *)g_mifarep_mad_key, sector10, verbose)) { | |
695 | PrintAndLogEx(NORMAL, ""); | |
696 | PrintAndLogEx(ERR, "read sector 0x10 error. card don't have MAD or don't have MAD on default keys."); | |
697 | return 2; | |
698 | } | |
699 | ||
700 | MAD2DecodeAndPrint(sector10, verbose); | |
701 | } | |
702 | ||
703 | if (aidlen == 2) { | |
704 | uint16_t aaid = (aid[0] << 8) + aid[1]; | |
705 | PrintAndLogEx(NORMAL, "\n-------------- AID 0x%04x ---------------", aaid); | |
706 | ||
707 | uint16_t mad[7 + 8 + 8 + 8 + 8] = {0}; | |
708 | size_t madlen = 0; | |
709 | if (MADDecode(sector0, sector10, mad, &madlen)) { | |
710 | PrintAndLogEx(ERR, "can't decode mad."); | |
711 | return 10; | |
712 | } | |
713 | ||
714 | uint8_t akey[16] = {0}; | |
715 | memcpy(akey, g_mifarep_ndef_key, 16); | |
716 | if (keylen == 16) { | |
717 | memcpy(akey, key, 16); | |
718 | } | |
719 | ||
720 | for (int i = 0; i < madlen; i++) { | |
721 | if (aaid == mad[i]) { | |
722 | uint8_t vsector[16 * 4] = {0}; | |
723 | if (mfpReadSector(i + 1, keyB ? MF_KEY_B : MF_KEY_A, akey, vsector, false)) { | |
724 | PrintAndLogEx(NORMAL, ""); | |
725 | PrintAndLogEx(ERR, "read sector %d error.", i + 1); | |
726 | return 2; | |
727 | } | |
728 | ||
729 | for (int j = 0; j < (verbose ? 4 : 3); j ++) | |
730 | PrintAndLogEx(NORMAL, " [%03d] %s", (i + 1) * 4 + j, sprint_hex(&vsector[j * 16], 16)); | |
731 | } | |
732 | } | |
733 | } | |
734 | ||
735 | return 0; | |
736 | } | |
737 | ||
738 | int CmdHFMFPNDEF(const char *cmd) { | |
739 | ||
740 | CLIParserInit("hf mfp ndef", | |
741 | "Prints NFC Data Exchange Format (NDEF)", | |
742 | "Usage:\n\thf mfp ndef -> shows NDEF data\n" | |
743 | "\thf mfp ndef -a 03e1 -k d3f7d3f7d3f7d3f7d3f7d3f7d3f7d3f7 -> shows NDEF data with custom AID and key\n"); | |
744 | ||
745 | void *argtable[] = { | |
746 | arg_param_begin, | |
747 | arg_litn("vV", "verbose", 0, 2, "show technical data"), | |
748 | arg_str0("aA", "aid", "replace default aid for NDEF", NULL), | |
749 | arg_str0("kK", "key", "replace default key for NDEF", NULL), | |
750 | arg_lit0("bB", "keyb", "use key B for access sectors (by default: key A)"), | |
751 | arg_param_end | |
752 | }; | |
753 | CLIExecWithReturn(cmd, argtable, true); | |
754 | ||
755 | bool verbose = arg_get_lit(1); | |
756 | bool verbose2 = arg_get_lit(1) > 1; | |
757 | uint8_t aid[2] = {0}; | |
758 | int aidlen; | |
759 | CLIGetHexWithReturn(2, aid, &aidlen); | |
760 | uint8_t key[16] = {0}; | |
761 | int keylen; | |
762 | CLIGetHexWithReturn(3, key, &keylen); | |
763 | bool keyB = arg_get_lit(4); | |
764 | ||
765 | CLIParserFree(); | |
766 | ||
767 | uint16_t ndefAID = 0x03e1; | |
768 | if (aidlen == 2) | |
769 | ndefAID = (aid[0] << 8) + aid[1]; | |
770 | ||
771 | uint8_t ndefkey[16] = {0}; | |
772 | memcpy(ndefkey, g_mifarep_ndef_key, 16); | |
773 | if (keylen == 16) { | |
774 | memcpy(ndefkey, key, 16); | |
775 | } | |
776 | ||
777 | uint8_t sector0[16 * 4] = {0}; | |
778 | uint8_t sector10[16 * 4] = {0}; | |
779 | uint8_t data[4096] = {0}; | |
780 | int datalen = 0; | |
781 | ||
782 | PrintAndLogEx(NORMAL, ""); | |
783 | ||
784 | if (mfpReadSector(MF_MAD1_SECTOR, MF_KEY_A, (uint8_t *)g_mifarep_mad_key, sector0, verbose)) { | |
785 | PrintAndLogEx(ERR, "read sector 0 error. card don't have MAD or don't have MAD on default keys."); | |
786 | return 2; | |
787 | } | |
788 | ||
789 | bool haveMAD2 = false; | |
790 | int res = MADCheck(sector0, NULL, verbose, &haveMAD2); | |
791 | if (res) { | |
792 | PrintAndLogEx(ERR, "MAD error %d.", res); | |
793 | return res; | |
794 | } | |
795 | ||
796 | if (haveMAD2) { | |
797 | if (mfpReadSector(MF_MAD2_SECTOR, MF_KEY_A, (uint8_t *)g_mifarep_mad_key, sector10, verbose)) { | |
798 | PrintAndLogEx(ERR, "read sector 0x10 error. card don't have MAD or don't have MAD on default keys."); | |
799 | return 2; | |
800 | } | |
801 | } | |
802 | ||
803 | uint16_t mad[7 + 8 + 8 + 8 + 8] = {0}; | |
804 | size_t madlen = 0; | |
805 | if (MADDecode(sector0, (haveMAD2 ? sector10 : NULL), mad, &madlen)) { | |
806 | PrintAndLogEx(ERR, "can't decode mad."); | |
807 | return 10; | |
808 | } | |
809 | ||
810 | printf("data reading:"); | |
811 | for (int i = 0; i < madlen; i++) { | |
812 | if (ndefAID == mad[i]) { | |
813 | uint8_t vsector[16 * 4] = {0}; | |
814 | if (mfpReadSector(i + 1, keyB ? MF_KEY_B : MF_KEY_A, ndefkey, vsector, false)) { | |
815 | PrintAndLogEx(ERR, "read sector %d error.", i + 1); | |
816 | return 2; | |
817 | } | |
818 | ||
819 | memcpy(&data[datalen], vsector, 16 * 3); | |
820 | datalen += 16 * 3; | |
821 | ||
822 | printf("."); | |
823 | } | |
824 | } | |
825 | printf(" OK\n"); | |
826 | ||
827 | if (!datalen) { | |
828 | PrintAndLogEx(ERR, "no NDEF data."); | |
829 | return 11; | |
830 | } | |
831 | ||
832 | if (verbose2) { | |
833 | PrintAndLogEx(NORMAL, "NDEF data:"); | |
834 | dump_buffer(data, datalen, stdout, 1); | |
835 | } | |
836 | ||
837 | NDEFDecodeAndPrint(data, datalen, verbose); | |
838 | ||
839 | return 0; | |
840 | } | |
841 | ||
dc3e2acf OM |
842 | static command_t CommandTable[] = |
843 | { | |
844 | {"help", CmdHelp, 1, "This help"}, | |
845 | {"info", CmdHFMFPInfo, 0, "Info about Mifare Plus tag"}, | |
ae3340a0 OM |
846 | {"wrp", CmdHFMFPWritePerso, 0, "Write Perso command"}, |
847 | {"initp", CmdHFMFPInitPerso, 0, "Fills all the card's keys"}, | |
848 | {"commitp", CmdHFMFPCommitPerso, 0, "Move card to SL1 or SL3 mode"}, | |
c8a0f550 OM |
849 | {"auth", CmdHFMFPAuth, 0, "Authentication"}, |
850 | {"rdbl", CmdHFMFPRdbl, 0, "Read blocks"}, | |
851 | {"rdsc", CmdHFMFPRdsc, 0, "Read sectors"}, | |
4b5d696c | 852 | {"wrbl", CmdHFMFPWrbl, 0, "Write blocks"}, |
fdd9395d OM |
853 | {"mad", CmdHFMFPMAD, 0, "Checks and prints MAD"}, |
854 | {"ndef", CmdHFMFPNDEF, 0, "Prints NDEF records from card"}, | |
dc3e2acf OM |
855 | {NULL, NULL, 0, NULL} |
856 | }; | |
857 | ||
858 | int CmdHFMFP(const char *Cmd) { | |
859 | (void)WaitForResponseTimeout(CMD_ACK,NULL,100); | |
860 | CmdsParse(CommandTable, Cmd); | |
861 | return 0; | |
862 | } | |
863 | ||
864 | int CmdHelp(const char *Cmd) { | |
865 | CmdsHelp(CommandTable); | |
866 | return 0; | |
867 | } |