]>
cvs.zerfleddert.de Git - proxmark3-svn/blob - client/cmdlfhid.c
66dfae8bee324065bb3175a9ee0ede220b50b8bc
1 //-----------------------------------------------------------------------------
2 // Copyright (C) 2010 iZsh <izsh at fail0verflow.com>
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
7 //-----------------------------------------------------------------------------
8 // Low frequency HID commands (known)
11 // RF interface, programming a T55x7 clone, 26-bit HID H10301 encoding:
12 // http://www.proxmark.org/files/Documents/125%20kHz%20-%20HID/HID_format_example.pdf
14 // "Understanding Card Data Formats"
15 // https://www.hidglobal.com/sites/default/files/hid-understanding_card_data_formats-wp-en.pdf
17 // "What Format Do You Need?"
18 // https://www.hidglobal.com/sites/default/files/resource_files/hid-prox-br-en.pdf
19 //-----------------------------------------------------------------------------
28 #include "cmdparser.h"
29 #include "cmddata.h" //for g_debugMode, demodbuff cmds
30 #include "lfdemod.h" // for HIDdemodFSK
31 #include "hidcardformats.h"
32 #include "hidcardformatutils.h"
33 #include "util.h" // for param_get8,32,64
37 * Converts a hex string to component "hi2", "hi" and "lo" 32-bit integers, one nibble
40 * Returns the number of nibbles (4 bits) entered.
42 int hexstring_to_int96(/* out */ uint32_t* hi2
,/* out */ uint32_t* hi
, /* out */ uint32_t* lo
, const char* str
) {
43 // TODO: Replace this with param_gethex when it supports arbitrary length
47 while (sscanf(&str
[i
++], "%1x", &n
) == 1) {
48 *hi2
= (*hi2
<< 4) | (*hi
>> 28);
49 *hi
= (*hi
<< 4) | (*lo
>> 28);
50 *lo
= (*lo
<< 4) | (n
& 0xf);
56 //by marshmellow (based on existing demod + holiman's refactor)
57 //HID Prox demod - FSK RF/50 with preamble of 00011101 (then manchester encoded)
58 //print full HID Prox ID and some bit format details if found
59 int CmdFSKdemodHID(const char *Cmd
)
61 //raw fsk demod no manchester decoding no start bit finding just get binary from wave
62 uint32_t hi2
=0, hi
=0, lo
=0;
64 uint8_t BitStream
[MAX_GRAPH_TRACE_LEN
]={0};
65 size_t BitLen
= getFromGraphBuf(BitStream
);
66 if (BitLen
==0) return 0;
67 //get binary from fsk wave
69 int idx
= HIDdemodFSK(BitStream
,&BitLen
,&hi2
,&hi
,&lo
, &waveIdx
);
73 PrintAndLog("DEBUG: Just Noise Detected");
74 } else if (idx
== -2) {
75 PrintAndLog("DEBUG: Error demoding fsk");
76 } else if (idx
== -3) {
77 PrintAndLog("DEBUG: Preamble not found");
78 } else if (idx
== -4) {
79 PrintAndLog("DEBUG: Error in Manchester data, SIZE: %d", BitLen
);
81 PrintAndLog("DEBUG: Error demoding fsk %d", idx
);
86 if (hi2
==0 && hi
==0 && lo
==0) {
87 if (g_debugMode
) PrintAndLog("DEBUG: Error - no values found");
92 PrintAndLog("HID Prox TAG ID: %x%08x%08x",
93 (unsigned int) hi2
, (unsigned int) hi
, (unsigned int) lo
96 PrintAndLog("HID Prox TAG ID: %x%08x",
97 (unsigned int) hi
, (unsigned int) lo
100 hidproxmessage_t packed
= initialize_proxmessage_object(hi2
, hi
, lo
);
101 bool ret
= HIDTryUnpack(&packed
, false);
104 PrintAndLog("Invalid or unsupported tag length.");
106 setDemodBuf(BitStream
,BitLen
,idx
);
107 setClockGrid(50, waveIdx
+ (idx
*50));
109 PrintAndLog("DEBUG: idx: %d, Len: %d, Printing Demod Buffer:", idx
, BitLen
);
115 int CmdHIDReadFSK(const char *Cmd
)
118 if(Cmd
[0]=='1') findone
=1;
119 UsbCommand c
={CMD_HID_DEMOD_FSK
};
125 int CmdHIDSim(const char *Cmd
)
127 uint32_t hi2
= 0, hi
= 0, lo
= 0;
128 hexstring_to_int96(&hi2
, &hi
, &lo
, Cmd
);
129 if (hi
>= 0x40 || hi2
!= 0) {
130 PrintAndLog("This looks like a long tag ID. Use 'lf simfsk' for long tags. Aborting!");
134 PrintAndLog("Emulating tag with ID %x%08x", hi
, lo
);
135 PrintAndLog("Press pm3-button to abort simulation");
137 UsbCommand c
= {CMD_HID_SIM_TAG
, {hi
, lo
, 0}};
142 int CmdHIDClone(const char *Cmd
)
144 unsigned int hi2
= 0, hi
= 0, lo
= 0;
146 hexstring_to_int96(&hi2
, &hi
, &lo
, Cmd
);
148 if (hi
>= 0x40 || hi2
!= 0) {
149 PrintAndLog("Cloning tag with long ID %x%08x%08x", hi2
, hi
, lo
);
152 PrintAndLog("Cloning tag with ID %x%08x", hi
, lo
);
156 c
.cmd
= CMD_HID_CLONE_TAG
;
157 c
.arg
[0] = (hi2
& 0x000FFFFF);
165 int CmdHIDDecode(const char *Cmd
){
167 PrintAndLog("Usage: lf hid decode <id> {p}");
168 PrintAndLog(" (optional) p: Ignore invalid parity");
169 PrintAndLog(" sample: lf hid decode 2006f623ae");
173 uint32_t top
= 0, mid
= 0, bot
= 0;
174 bool ignoreParity
= false;
175 hexstring_to_int96(&top
, &mid
, &bot
, Cmd
);
176 hidproxmessage_t packed
= initialize_proxmessage_object(top
, mid
, bot
);
178 char opt
= param_getchar(Cmd
, 1);
179 if (opt
== 'p') ignoreParity
= true;
181 HIDTryUnpack(&packed
, ignoreParity
);
184 int CmdHIDEncode(const char *Cmd
) {
185 if (strlen(Cmd
) == 0) {
186 PrintAndLog("Usage: lf hid encode <format> <facility code (decimal)> <card number (decimal)> [issue level (decimal)]");
187 PrintAndLog(" sample: lf hid encode H10301 123 4567");
191 int formatIndex
= -1;
192 if (!strcmp(Cmd
, "help") || !strcmp(Cmd
, "h") || !strcmp(Cmd
, "list") || !strcmp(Cmd
, "?")){
197 memset(format
, 0, sizeof(format
));
198 param_getstr(Cmd
, 0, format
, sizeof(format
));
199 formatIndex
= HIDFindCardFormat(format
);
200 if (formatIndex
== -1) {
207 memset(&card
, 0, sizeof(hidproxcard_t
));
208 card
.FacilityCode
= param_get32ex(Cmd
, 1, 0, 10);
209 card
.CardNumber
= param_get64ex(Cmd
, 2, 0, 10);
210 card
.IssueLevel
= param_get32ex(Cmd
, 3, 0, 10);
211 card
.ParitySupported
= true; // Try to encode parity if supported.
213 hidproxmessage_t packed
;
214 memset(&packed
, 0, sizeof(hidproxmessage_t
));
215 if (HIDPack(formatIndex
, &card
, &packed
)){
216 if (packed
.top
!= 0) {
217 PrintAndLog("HID Prox TAG ID: %x%08x%08x",
218 (unsigned int)packed
.top
, (unsigned int)packed
.mid
, (unsigned int)packed
.bot
);
220 PrintAndLog("HID Prox TAG ID: %x%08x",
221 (unsigned int)packed
.mid
, (unsigned int)packed
.bot
);
224 PrintAndLog("The provided data could not be encoded with the selected format.");
229 int CmdHIDWrite(const char *Cmd
) {
230 if (strlen(Cmd
) == 0) {
231 PrintAndLog("Usage: lf hid write <format> <facility code (decimal)> <card number (decimal)> [issue level (decimal)]");
232 PrintAndLog(" sample: lf hid write H10301 123 4567");
236 int formatIndex
= -1;
237 if (!strcmp(Cmd
, "help") || !strcmp(Cmd
, "h") || !strcmp(Cmd
, "list") || !strcmp(Cmd
, "?")){
242 memset(format
, 0, sizeof(format
));
243 param_getstr(Cmd
, 0, format
, sizeof(format
));
244 formatIndex
= HIDFindCardFormat(format
);
245 if (formatIndex
== -1) {
252 memset(&card
, 0, sizeof(hidproxcard_t
));
253 card
.FacilityCode
= param_get32ex(Cmd
, 1, 0, 10);
254 card
.CardNumber
= param_get64ex(Cmd
, 2, 0, 10);
255 card
.IssueLevel
= param_get32ex(Cmd
, 3, 0, 10);
256 card
.ParitySupported
= true; // Try to encode parity if supported.
258 hidproxmessage_t packed
;
259 memset(&packed
, 0, sizeof(hidproxmessage_t
));
260 if (HIDPack(formatIndex
, &card
, &packed
)){
262 if (packed
.top
!= 0) {
263 PrintAndLog("HID Prox TAG ID: %x%08x%08x",
264 (unsigned int)packed
.top
, (unsigned int)packed
.mid
, (unsigned int)packed
.bot
);
267 PrintAndLog("HID Prox TAG ID: %x%08x",
268 (unsigned int)packed
.mid
, (unsigned int)packed
.bot
);
272 c
.cmd
= CMD_HID_CLONE_TAG
;
273 c
.arg
[0] = (packed
.top
& 0x000FFFFF);
274 c
.arg
[1] = packed
.mid
;
275 c
.arg
[2] = packed
.bot
;
279 PrintAndLog("The provided data could not be encoded with the selected format.");
284 static int CmdHelp(const char *Cmd
); // define this now so the below won't error out.
285 static command_t CommandTable
[] =
287 {"help", CmdHelp
, 1, "This help"},
288 {"demod", CmdFSKdemodHID
, 1, "Demodulate HID Prox from GraphBuffer"},
289 {"read", CmdHIDReadFSK
, 0, "['1'] Realtime HID FSK Read from antenna (option '1' for one tag only)"},
290 {"sim", CmdHIDSim
, 0, "<ID> -- HID tag simulator"},
291 {"clone", CmdHIDClone
, 0, "<ID> -- Clone HID to T55x7 (tag must be in antenna)"},
292 {"decode", CmdHIDDecode
, 1, "<ID> -- Try to decode an HID tag and show its contents"},
293 {"encode", CmdHIDEncode
, 1, "<format> <fc> <num> -- Encode an HID ID with the specified format, facility code and card number"},
294 {"write", CmdHIDWrite
, 0, "<format> <fc> <num> -- Encode and write to a T55x7 tag (tag must be in antenna)"},
295 {NULL
, NULL
, 0, NULL
}
298 int CmdLFHID(const char *Cmd
)
300 CmdsParse(CommandTable
, Cmd
);
304 int CmdHelp(const char *Cmd
)
306 CmdsHelp(CommandTable
);