]>
Commit | Line | Data |
---|---|---|
e04475c4 | 1 | //----------------------------------------------------------------------------- |
2 | // Authored by Iceman | |
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 COTAG commands | |
9 | //----------------------------------------------------------------------------- | |
7cb8516c | 10 | #include <stdio.h> |
11 | #include <string.h> | |
12 | #include <stdint.h> | |
13 | #include "proxmark3.h" | |
14 | #include "ui.h" | |
15 | #include "cmddata.h" | |
16 | #include "data.h" | |
17 | #include "cmdlfcotag.h" | |
18 | #include "lfdemod.h" | |
19 | #include "usb_cmd.h" | |
20 | #include "cmdmain.h" | |
e04475c4 | 21 | |
22 | static int CmdHelp(const char *Cmd); | |
23 | ||
24 | int usage_lf_cotag_read(void){ | |
25 | PrintAndLog("Usage: lf COTAG read [h] <signaldata>"); | |
26 | PrintAndLog("Options:"); | |
27 | PrintAndLog(" h : This help"); | |
28 | PrintAndLog(" <0|1|2> : 0 - HIGH/LOW signal; maxlength bigbuff"); | |
29 | PrintAndLog(" : 1 - translation of HI/LO into bytes with manchester 0,1"); | |
30 | PrintAndLog(" : 2 - raw signal; maxlength bigbuff"); | |
31 | PrintAndLog(""); | |
32 | PrintAndLog("Sample:"); | |
33 | PrintAndLog(" lf cotag read 0"); | |
34 | PrintAndLog(" lf cotag read 1"); | |
35 | return 0; | |
36 | } | |
37 | ||
38 | // COTAG demod should be able to use GraphBuffer, | |
39 | // when data load samples | |
40 | int CmdCOTAGDemod(const char *Cmd) { | |
41 | ||
42 | uint8_t bits[COTAG_BITS] = {0}; | |
43 | size_t bitlen = COTAG_BITS; | |
44 | memcpy(bits, DemodBuffer, COTAG_BITS); | |
45 | ||
669959bc | 46 | uint8_t alignPos = 0; |
47 | int err = manrawdecode(bits, &bitlen, 1, &alignPos); | |
e04475c4 | 48 | if (err){ |
49 | if (g_debugMode) PrintAndLog("DEBUG: Error - COTAG too many errors: %d", err); | |
50 | return -1; | |
51 | } | |
52 | ||
53 | setDemodBuf(bits, bitlen, 0); | |
54 | ||
55 | //got a good demod | |
56 | uint16_t cn = bytebits_to_byteLSBF(bits+1, 16); | |
57 | uint32_t fc = bytebits_to_byteLSBF(bits+1+16, 8); | |
58 | ||
59 | uint32_t raw1 = bytebits_to_byteLSBF(bits, 32); | |
60 | uint32_t raw2 = bytebits_to_byteLSBF(bits+32, 32); | |
61 | uint32_t raw3 = bytebits_to_byteLSBF(bits+64, 32); | |
62 | uint32_t raw4 = bytebits_to_byteLSBF(bits+96, 32); | |
63 | ||
64 | /* | |
65 | fc 161: 1010 0001 -> LSB 1000 0101 | |
66 | cn 33593 1000 0011 0011 1001 -> LSB 1001 1100 1100 0001 | |
67 | cccc cccc cccc cccc ffffffff | |
68 | 0 1001 1100 1100 0001 1000 0101 0000 0000 100001010000000001111011100000011010000010000000000000000000000000000000000000000000000000000000100111001100000110000101000 | |
69 | 1001 1100 1100 0001 10000101 | |
70 | */ | |
71 | PrintAndLog("COTAG Found: FC %u, CN: %u Raw: %08X%08X%08X%08X", fc, cn, raw1 ,raw2, raw3, raw4); | |
72 | return 1; | |
73 | } | |
74 | ||
75 | // When reading a COTAG. | |
76 | // 0 = HIGH/LOW signal - maxlength bigbuff | |
77 | // 1 = translation for HI/LO into bytes with manchester 0,1 - length 300 | |
78 | // 2 = raw signal - maxlength bigbuff | |
79 | int CmdCOTAGRead(const char *Cmd) { | |
80 | ||
81 | if (Cmd[0] == 'h' || Cmd[0] == 'H') return usage_lf_cotag_read(); | |
82 | ||
83 | uint32_t rawsignal = 1; | |
84 | sscanf(Cmd, "%u", &rawsignal); | |
85 | ||
86 | UsbCommand c = {CMD_COTAG, {rawsignal, 0, 0}}; | |
87 | clearCommandBuffer(); | |
88 | SendCommand(&c); | |
89 | if ( !WaitForResponseTimeout(CMD_ACK, NULL, 7000) ) { | |
90 | PrintAndLog("command execution time out"); | |
91 | return -1; | |
92 | } | |
93 | ||
94 | switch ( rawsignal ){ | |
95 | case 0: | |
96 | case 2: { | |
97 | CmdPlot(""); | |
98 | CmdGrid("384"); | |
b9957414 | 99 | getSamples(0, true); break; |
e04475c4 | 100 | } |
101 | case 1: { | |
102 | GetFromBigBuf(DemodBuffer, COTAG_BITS, 0); | |
103 | DemodBufferLen = COTAG_BITS; | |
104 | UsbCommand response; | |
105 | if ( !WaitForResponseTimeout(CMD_ACK, &response, 1000) ) { | |
106 | PrintAndLog("timeout while waiting for reply."); | |
107 | return -1; | |
108 | } | |
109 | return CmdCOTAGDemod(""); | |
110 | } | |
111 | } | |
112 | return 0; | |
113 | } | |
114 | ||
115 | static command_t CommandTable[] = { | |
116 | {"help", CmdHelp, 1, "This help"}, | |
117 | {"demod", CmdCOTAGDemod, 1, "Tries to decode a COTAG signal"}, | |
118 | {"read", CmdCOTAGRead, 0, "Attempt to read and extract tag data"}, | |
119 | {NULL, NULL, 0, NULL} | |
120 | }; | |
121 | ||
122 | int CmdLFCOTAG(const char *Cmd) { | |
123 | clearCommandBuffer(); | |
124 | CmdsParse(CommandTable, Cmd); | |
125 | return 0; | |
126 | } | |
127 | ||
128 | int CmdHelp(const char *Cmd) { | |
129 | CmdsHelp(CommandTable); | |
130 | return 0; | |
131 | } |