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 | } |