]> git.zerfleddert.de Git - proxmark3-svn/blame - client/cmdlfhid.c
Revert "Comms refactor (prerequisite of libproxmark work) (#371)"
[proxmark3-svn] / client / cmdlfhid.c
CommitLineData
a553f267 1//-----------------------------------------------------------------------------
2// Copyright (C) 2010 iZsh <izsh at fail0verflow.com>
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//-----------------------------------------------------------------------------
b9957414 8// Low frequency HID commands (known)
a553f267 9//-----------------------------------------------------------------------------
10
7fe9b0b7 11#include <stdio.h>
54a942b0 12#include <string.h>
2b4898ec 13#include "cmdlfhid.h"
902cb3c0 14#include "proxmark3.h"
7fe9b0b7 15#include "ui.h"
16#include "graph.h"
17#include "cmdparser.h"
6cd2eef4 18#include "cmddata.h" //for g_debugMode, demodbuff cmds
19#include "lfdemod.h" // for HIDdemodFSK
7fe9b0b7 20
21static int CmdHelp(const char *Cmd);
6cd2eef4 22
23//by marshmellow (based on existing demod + holiman's refactor)
24//HID Prox demod - FSK RF/50 with preamble of 00011101 (then manchester encoded)
25//print full HID Prox ID and some bit format details if found
26int CmdFSKdemodHID(const char *Cmd)
7fe9b0b7 27{
6cd2eef4 28 //raw fsk demod no manchester decoding no start bit finding just get binary from wave
29 uint32_t hi2=0, hi=0, lo=0;
30
31 uint8_t BitStream[MAX_GRAPH_TRACE_LEN]={0};
32 size_t BitLen = getFromGraphBuf(BitStream);
33 if (BitLen==0) return 0;
34 //get binary from fsk wave
1c70664a 35 int waveIdx = 0;
36 int idx = HIDdemodFSK(BitStream,&BitLen,&hi2,&hi,&lo, &waveIdx);
6cd2eef4 37 if (idx<0){
38 if (g_debugMode){
39 if (idx==-1){
40 PrintAndLog("DEBUG: Just Noise Detected");
41 } else if (idx == -2) {
42 PrintAndLog("DEBUG: Error demoding fsk");
43 } else if (idx == -3) {
44 PrintAndLog("DEBUG: Preamble not found");
45 } else if (idx == -4) {
46 PrintAndLog("DEBUG: Error in Manchester data, SIZE: %d", BitLen);
47 } else {
48 PrintAndLog("DEBUG: Error demoding fsk %d", idx);
49 }
50 }
7fe9b0b7 51 return 0;
52 }
6cd2eef4 53 if (hi2==0 && hi==0 && lo==0) {
54 if (g_debugMode) PrintAndLog("DEBUG: Error - no values found");
55 return 0;
56 }
57 if (hi2 != 0){ //extra large HID tags
58 PrintAndLog("HID Prox TAG ID: %x%08x%08x (%d)",
59 (unsigned int) hi2, (unsigned int) hi, (unsigned int) lo, (unsigned int) (lo>>1) & 0xFFFF);
60 }
61 else { //standard HID tags <38 bits
62 uint8_t fmtLen = 0;
63 uint32_t fc = 0;
64 uint32_t cardnum = 0;
65 if (((hi>>5)&1)==1){//if bit 38 is set then < 37 bit format is used
66 uint32_t lo2=0;
67 lo2=(((hi & 31) << 12) | (lo>>20)); //get bits 21-37 to check for format len bit
68 uint8_t idx3 = 1;
69 while(lo2>1){ //find last bit set to 1 (format len bit)
70 lo2=lo2>>1;
71 idx3++;
72 }
73 fmtLen =idx3+19;
74 fc =0;
75 cardnum=0;
76 if(fmtLen==26){
77 cardnum = (lo>>1)&0xFFFF;
78 fc = (lo>>17)&0xFF;
79 }
80 if(fmtLen==34){
81 cardnum = (lo>>1)&0xFFFF;
82 fc= ((hi&1)<<15)|(lo>>17);
83 }
84 if(fmtLen==35){
85 cardnum = (lo>>1)&0xFFFFF;
86 fc = ((hi&1)<<11)|(lo>>21);
87 }
88 }
89 else { //if bit 38 is not set then 37 bit format is used
90 fmtLen = 37;
91 fc = 0;
92 cardnum = 0;
93 if(fmtLen == 37){
94 cardnum = (lo>>1)&0x7FFFF;
95 fc = ((hi&0xF)<<12)|(lo>>20);
96 }
7fe9b0b7 97 }
6cd2eef4 98 PrintAndLog("HID Prox TAG ID: %x%08x (%d) - Format Len: %dbit - FC: %d - Card: %d",
99 (unsigned int) hi, (unsigned int) lo, (unsigned int) (lo>>1) & 0xFFFF,
100 (unsigned int) fmtLen, (unsigned int) fc, (unsigned int) cardnum);
7fe9b0b7 101 }
6cd2eef4 102 setDemodBuf(BitStream,BitLen,idx);
1c70664a 103 setClockGrid(50, waveIdx + (idx*50));
6cd2eef4 104 if (g_debugMode){
105 PrintAndLog("DEBUG: idx: %d, Len: %d, Printing Demod Buffer:", idx, BitLen);
106 printDemodBuff();
107 }
108 return 1;
7fe9b0b7 109}
6cd2eef4 110
111int CmdHIDReadFSK(const char *Cmd)
7fe9b0b7 112{
083ca3de 113 int findone=0;
3fe4ff4f 114 if(Cmd[0]=='1') findone=1;
7fe9b0b7 115 UsbCommand c={CMD_HID_DEMOD_FSK};
083ca3de 116 c.arg[0]=findone;
7fe9b0b7 117 SendCommand(&c);
118 return 0;
119}
120
121int CmdHIDSim(const char *Cmd)
38b20f75 122{
8cf533fd 123 uint32_t hi = 0, lo = 0;
124 int n = 0, i = 0;
38b20f75 125
8cf533fd 126 while (sscanf(&Cmd[i++], "%1x", &n ) == 1) {
127 hi = (hi << 4) | (lo >> 28);
128 lo = (lo << 4) | (n & 0xf);
129 }
38b20f75 130
8cf533fd 131 PrintAndLog("Emulating tag with ID %x%08x", hi, lo);
132 PrintAndLog("Press pm3-button to abort simulation");
38b20f75 133
8cf533fd 134 UsbCommand c = {CMD_HID_SIM_TAG, {hi, lo, 0}};
135 SendCommand(&c);
136 return 0;
38b20f75 137}
138
139int CmdHIDClone(const char *Cmd)
7fe9b0b7 140{
54a942b0 141 unsigned int hi2 = 0, hi = 0, lo = 0;
035303ac 142 int n = 0, i = 0;
54a942b0 143 UsbCommand c;
7fe9b0b7 144
54a942b0 145 if (strchr(Cmd,'l') != 0) {
38b20f75 146 while (sscanf(&Cmd[i++], "%1x", &n ) == 1) {
54a942b0 147 hi2 = (hi2 << 4) | (hi >> 28);
148 hi = (hi << 4) | (lo >> 28);
149 lo = (lo << 4) | (n & 0xf);
150 }
38b20f75 151
54a942b0 152 PrintAndLog("Cloning tag with long ID %x%08x%08x", hi2, hi, lo);
38b20f75 153
54a942b0 154 c.d.asBytes[0] = 1;
38b20f75 155 }
156 else {
157 while (sscanf(&Cmd[i++], "%1x", &n ) == 1) {
54a942b0 158 hi = (hi << 4) | (lo >> 28);
159 lo = (lo << 4) | (n & 0xf);
160 }
38b20f75 161
54a942b0 162 PrintAndLog("Cloning tag with ID %x%08x", hi, lo);
38b20f75 163
54a942b0 164 hi2 = 0;
165 c.d.asBytes[0] = 0;
7fe9b0b7 166 }
38b20f75 167
168 c.cmd = CMD_HID_CLONE_TAG;
d16d20b1 169 c.arg[0] = hi2;
170 c.arg[1] = hi;
171 c.arg[2] = lo;
ec09b62d 172
ec09b62d 173 SendCommand(&c);
174 return 0;
175}
176
7fe9b0b7 177static command_t CommandTable[] =
178{
179 {"help", CmdHelp, 1, "This help"},
6cd2eef4 180 {"demod", CmdFSKdemodHID, 1, "Demodulate HID Prox from GraphBuffer"},
181 {"read", CmdHIDReadFSK, 0, "['1'] Realtime HID FSK Read from antenna (option '1' for one tag only)"},
083ca3de 182 {"sim", CmdHIDSim, 0, "<ID> -- HID tag simulator"},
183 {"clone", CmdHIDClone, 0, "<ID> ['l'] -- Clone HID to T55x7 (tag must be in antenna)(option 'l' for 84bit ID)"},
7fe9b0b7 184 {NULL, NULL, 0, NULL}
185};
186
187int CmdLFHID(const char *Cmd)
188{
189 CmdsParse(CommandTable, Cmd);
190 return 0;
191}
192
193int CmdHelp(const char *Cmd)
194{
195 CmdsHelp(CommandTable);
196 return 0;
197}
Impressum, Datenschutz