]>
Commit | Line | Data |
---|---|---|
dbf6e824 CY |
1 | //----------------------------------------------------------------------------- |
2 | // Authored by Craig Young <cyoung@tripwire.com> based on cmdlfhid.c structure | |
3 | // | |
4 | // cmdlfhid.c is Copyright (C) 2010 iZsh <izsh at fail0verflow.com> | |
5 | // | |
6 | // This code is licensed to you under the terms of the GNU GPL, version 2 or, | |
7 | // at your option, any later version. See the LICENSE.txt file for the text of | |
8 | // the license. | |
9 | //----------------------------------------------------------------------------- | |
10 | // Low frequency AWID26 commands | |
11 | //----------------------------------------------------------------------------- | |
12 | ||
acf0582d | 13 | #include <string.h> |
dbf6e824 CY |
14 | #include <stdio.h> // sscanf |
15 | #include "proxmark3.h" // Definitions, USB controls, etc | |
16 | #include "ui.h" // PrintAndLog | |
17 | #include "cmdparser.h" // CmdsParse, CmdsHelp | |
18 | #include "cmdlfawid.h" // AWID function declarations | |
19 | #include "lfdemod.h" // parityTest | |
709665b5 | 20 | #include "util.h" // weigandparity |
21 | #include "protocols.h" // for T55xx config register definitions | |
976627d5 | 22 | #include "cmdmain.h" |
dbf6e824 | 23 | |
709665b5 | 24 | static int CmdHelp(const char *Cmd); |
bcffcca2 CY |
25 | |
26 | int usage_lf_awid_fskdemod(void) { | |
37824afe MHS |
27 | PrintAndLog("Enables AWID26 compatible reader mode printing details of scanned AWID26 tags."); |
28 | PrintAndLog("By default, values are printed and logged until the button is pressed or another USB command is issued."); | |
29 | PrintAndLog("If the ['1'] option is provided, reader mode is exited after reading a single AWID26 card."); | |
30 | PrintAndLog(""); | |
31 | PrintAndLog("Usage: lf awid fskdemod ['1']"); | |
709665b5 | 32 | PrintAndLog("Options : "); |
37824afe MHS |
33 | PrintAndLog(" 1 : (optional) stop after reading a single card"); |
34 | PrintAndLog(""); | |
709665b5 | 35 | PrintAndLog("Samples : lf awid fskdemod"); |
36 | PrintAndLog(" : lf awid fskdemod 1"); | |
37824afe | 37 | return 0; |
bcffcca2 CY |
38 | } |
39 | ||
40 | int usage_lf_awid_sim(void) { | |
37824afe MHS |
41 | PrintAndLog("Enables simulation of AWID26 card with specified facility-code and card number."); |
42 | PrintAndLog("Simulation runs until the button is pressed or another USB command is issued."); | |
43 | PrintAndLog("Per AWID26 format, the facility-code is 8-bit and the card number is 16-bit. Larger values are truncated."); | |
44 | PrintAndLog(""); | |
45 | PrintAndLog("Usage: lf awid sim <Facility-Code> <Card-Number>"); | |
709665b5 | 46 | PrintAndLog("Options : "); |
37824afe MHS |
47 | PrintAndLog(" <Facility-Code> : 8-bit value representing the AWID facility code"); |
48 | PrintAndLog(" <Card Number> : 16-bit value representing the AWID card number"); | |
49 | PrintAndLog(""); | |
709665b5 | 50 | PrintAndLog("Sample : lf awid sim 224 1337"); |
37824afe | 51 | return 0; |
bcffcca2 CY |
52 | } |
53 | ||
54 | int usage_lf_awid_clone(void) { | |
37824afe MHS |
55 | PrintAndLog("Enables cloning of AWID26 card with specified facility-code and card number onto T55x7."); |
56 | PrintAndLog("The T55x7 must be on the antenna when issuing this command. T55x7 blocks are calculated and printed in the process."); | |
57 | PrintAndLog("Per AWID26 format, the facility-code is 8-bit and the card number is 16-bit. Larger values are truncated."); | |
58 | PrintAndLog(""); | |
59 | PrintAndLog("Usage: lf awid clone <Facility-Code> <Card-Number>"); | |
709665b5 | 60 | PrintAndLog("Options : "); |
37824afe MHS |
61 | PrintAndLog(" <Facility-Code> : 8-bit value representing the AWID facility code"); |
62 | PrintAndLog(" <Card Number> : 16-bit value representing the AWID card number"); | |
709665b5 | 63 | PrintAndLog(" Q5 : optional - clone to Q5 (T5555) instead of T55x7 chip"); |
37824afe | 64 | PrintAndLog(""); |
709665b5 | 65 | PrintAndLog("Sample : lf awid clone 224 1337"); |
37824afe | 66 | return 0; |
bcffcca2 CY |
67 | } |
68 | ||
709665b5 | 69 | int CmdAWIDDemodFSK(const char *Cmd) { |
37824afe | 70 | int findone=0; |
709665b5 | 71 | if (Cmd[0] == 'h' || Cmd[0] == 'H') return usage_lf_awid_fskdemod(); |
72 | if (Cmd[0] == '1') findone = 1; | |
73 | ||
74 | UsbCommand c = {CMD_AWID_DEMOD_FSK, {findone, 0, 0}}; | |
75 | clearCommandBuffer(); | |
37824afe MHS |
76 | SendCommand(&c); |
77 | return 0; | |
dbf6e824 CY |
78 | } |
79 | ||
709665b5 | 80 | //refactored by marshmellow |
81 | int getAWIDBits(uint32_t fc, uint32_t cn, uint8_t *AWIDBits) { | |
82 | uint8_t pre[66]; | |
83 | memset(pre, 0, sizeof(pre)); | |
84 | AWIDBits[7]=1; | |
85 | num_to_bytebits(26, 8, pre); | |
86 | ||
87 | uint8_t wiegand[24]; | |
88 | num_to_bytebits(fc, 8, wiegand); | |
89 | num_to_bytebits(cn, 16, wiegand+8); | |
90 | ||
91 | wiegand_add_parity(pre+8, wiegand, 24); | |
92 | ||
93 | size_t bitLen = addParity(pre, AWIDBits+8, 66, 4, 1); | |
94 | if (bitLen != 88) return 0; | |
95 | //for (uint8_t i = 0; i<3; i++){ | |
96 | // PrintAndLog("DEBUG: %08X", bytebits_to_byte(AWIDBits+(32*i),32)); | |
97 | //} | |
37824afe | 98 | return 1; |
dbf6e824 CY |
99 | } |
100 | ||
709665b5 | 101 | int CmdAWIDSim(const char *Cmd) { |
102 | uint32_t fcode = 0, cnum = 0, fc=0, cn=0; | |
103 | uint8_t BitStream[96]; | |
104 | uint8_t *bs = BitStream; | |
105 | size_t size = sizeof(BitStream); | |
106 | memset(bs, 0, size); | |
107 | ||
37824afe MHS |
108 | uint64_t arg1 = (10<<8) + 8; // fcHigh = 10, fcLow = 8 |
109 | uint64_t arg2 = 50; // clk RF/50 invert=0 | |
709665b5 | 110 | |
111 | if (sscanf(Cmd, "%u %u", &fc, &cn ) != 2) return usage_lf_awid_sim(); | |
112 | ||
113 | fcode = (fc & 0x000000FF); | |
114 | cnum = (cn & 0x0000FFFF); | |
115 | ||
116 | if (fc != fcode) PrintAndLog("Facility-Code (%u) truncated to 8-bits: %u",fc,fcode); | |
117 | if (cn != cnum) PrintAndLog("Card number (%u) truncated to 16-bits: %u",cn,cnum); | |
37824afe | 118 | |
37824afe MHS |
119 | PrintAndLog("Emulating AWID26 -- FC: %u; CN: %u\n",fcode,cnum); |
120 | PrintAndLog("Press pm3-button to abort simulation or run another command"); | |
709665b5 | 121 | |
122 | if (!getAWIDBits(fc, cn, bs)) { | |
123 | PrintAndLog("Error with tag bitstream generation."); | |
124 | return 1; | |
125 | } | |
37824afe | 126 | // AWID uses: fcHigh: 10, fcLow: 8, clk: 50, invert: 0 |
709665b5 | 127 | UsbCommand c = {CMD_FSK_SIM_TAG, {arg1, arg2, size}}; |
128 | memcpy(c.d.asBytes, bs, size); | |
129 | clearCommandBuffer(); | |
37824afe MHS |
130 | SendCommand(&c); |
131 | return 0; | |
dbf6e824 CY |
132 | } |
133 | ||
709665b5 | 134 | int CmdAWIDClone(const char *Cmd) { |
135 | uint32_t blocks[4] = {T55x7_MODULATION_FSK2a | T55x7_BITRATE_RF_50 | 3<<T55x7_MAXBLOCK_SHIFT, 0, 0, 0}; | |
136 | uint32_t fc=0,cn=0; | |
137 | uint8_t BitStream[96]; | |
138 | uint8_t *bs=BitStream; | |
139 | memset(bs,0,sizeof(BitStream)); | |
37824afe | 140 | |
709665b5 | 141 | if (sscanf(Cmd, "%u %u", &fc, &cn ) != 2) return usage_lf_awid_clone(); |
142 | ||
143 | if (param_getchar(Cmd, 3) == 'Q' || param_getchar(Cmd, 3) == 'q') | |
6f1a5978 | 144 | blocks[0] = T5555_MODULATION_FSK2 | T5555_INVERT_OUTPUT | ((50-2)>>1)<<T5555_BITRATE_SHIFT | 3<<T5555_MAXBLOCK_SHIFT; |
37824afe MHS |
145 | |
146 | if ((fc & 0xFF) != fc) { | |
147 | fc &= 0xFF; | |
148 | PrintAndLog("Facility-Code Truncated to 8-bits (AWID26): %u", fc); | |
149 | } | |
150 | if ((cn & 0xFFFF) != cn) { | |
151 | cn &= 0xFFFF; | |
152 | PrintAndLog("Card Number Truncated to 16-bits (AWID26): %u", cn); | |
153 | } | |
976627d5 | 154 | |
709665b5 | 155 | if ( !getAWIDBits(fc, cn, bs)) { |
156 | PrintAndLog("Error with tag bitstream generation."); | |
157 | return 1; | |
158 | } | |
159 | ||
160 | blocks[1] = bytebits_to_byte(bs,32); | |
161 | blocks[2] = bytebits_to_byte(bs+32,32); | |
162 | blocks[3] = bytebits_to_byte(bs+64,32); | |
163 | ||
164 | PrintAndLog("Preparing to clone AWID26 to T55x7 with FC: %u, CN: %u", | |
165 | fc, cn); | |
166 | PrintAndLog("Blk | Data "); | |
167 | PrintAndLog("----+------------"); | |
168 | PrintAndLog(" 00 | 0x%08x", blocks[0]); | |
169 | PrintAndLog(" 01 | 0x%08x", blocks[1]); | |
170 | PrintAndLog(" 02 | 0x%08x", blocks[2]); | |
171 | PrintAndLog(" 03 | 0x%08x", blocks[3]); | |
172 | ||
173 | UsbCommand resp; | |
174 | UsbCommand c = {CMD_T55XX_WRITE_BLOCK, {0,0,0}}; | |
175 | ||
176 | for (uint8_t i=0; i<4; i++) { | |
177 | c.cmd = CMD_T55XX_WRITE_BLOCK; | |
178 | c.arg[0] = blocks[i]; | |
179 | c.arg[1] = i; | |
180 | c.arg[2] = 0; | |
181 | clearCommandBuffer(); | |
182 | SendCommand(&c); | |
183 | if (!WaitForResponseTimeout(CMD_ACK, &resp, 1000)){ | |
184 | PrintAndLog("Error occurred, device did not respond during write operation."); | |
185 | return -1; | |
37824afe | 186 | } |
709665b5 | 187 | |
37824afe MHS |
188 | } |
189 | return 0; | |
dbf6e824 CY |
190 | } |
191 | ||
709665b5 | 192 | static command_t CommandTable[] = { |
193 | {"help", CmdHelp, 1, "This help"}, | |
37824afe MHS |
194 | {"fskdemod", CmdAWIDDemodFSK, 0, "['1'] Realtime AWID FSK demodulator (option '1' for one tag only)"}, |
195 | {"sim", CmdAWIDSim, 0, "<Facility-Code> <Card Number> -- AWID tag simulator"}, | |
709665b5 | 196 | {"clone", CmdAWIDClone, 0, "<Facility-Code> <Card Number> <Q5> -- Clone AWID to T55x7 (tag must be in range of antenna)"}, |
37824afe | 197 | {NULL, NULL, 0, NULL} |
dbf6e824 CY |
198 | }; |
199 | ||
709665b5 | 200 | int CmdLFAWID(const char *Cmd) { |
37824afe MHS |
201 | CmdsParse(CommandTable, Cmd); |
202 | return 0; | |
dbf6e824 CY |
203 | } |
204 | ||
709665b5 | 205 | int CmdHelp(const char *Cmd) { |
37824afe MHS |
206 | CmdsHelp(CommandTable); |
207 | return 0; | |
dbf6e824 | 208 | } |