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 // Main command parser entry point
9 //-----------------------------------------------------------------------------
16 #include "cmdparser.h"
17 #include "proxmark3.h"
28 unsigned int current_command
= CMD_UNKNOWN
;
29 unsigned int received_command
= CMD_UNKNOWN
;
30 UsbCommand current_response
;
31 UsbCommand current_response_user
;
33 static int CmdHelp(const char *Cmd
);
34 static int CmdQuit(const char *Cmd
);
36 static command_t CommandTable
[] =
38 {"help", CmdHelp
, 1, "This help. Use '<command> help' for details of the following commands:\n"},
39 {"data", CmdData
, 1, "{ Plot window / data buffer manipulation... }"},
40 {"exit", CmdQuit
, 1, "Exit program"},
41 {"hf", CmdHF
, 1, "{ HF commands... }"},
42 {"hw", CmdHW
, 1, "{ Hardware commands... }"},
43 {"lf", CmdLF
, 1, "{ LF commands... }"},
44 {"quit", CmdQuit
, 1, "Quit program"},
48 int CmdHelp(const char *Cmd
)
50 CmdsHelp(CommandTable
);
54 int CmdQuit(const char *Cmd
)
60 bool WaitForResponseTimeout(uint32_t cmd
, UsbCommand
* response
, size_t ms_timeout
) {
62 // Wait until the command is received
63 for(size_t i
=0; received_command
!= cmd
&& i
< ms_timeout
/10; i
++) {
64 msleep(10); // XXX ugh
65 if (i
== 200) { // Two seconds elapsed
66 PrintAndLog("Waiting for a response from the proxmark...");
67 PrintAndLog("Don't forget to cancel its operation first by pressing on the button");
71 // Check if timeout occured
72 if(received_command
!= cmd
) return false;
74 // Copy the received response (if supplied)
76 memcpy(response
, ¤t_response
, sizeof(UsbCommand
));
79 // Reset the received command
80 received_command
= CMD_UNKNOWN
;
85 bool WaitForResponse(uint32_t cmd
, UsbCommand
* response
) {
86 return WaitForResponseTimeout(cmd
,response
,-1);
89 //-----------------------------------------------------------------------------
90 // Entry point into our code: called whenever the user types a command and
91 // then presses Enter, which the full command line that they typed.
92 //-----------------------------------------------------------------------------
93 void CommandReceived(char *Cmd
) {
94 CmdsParse(CommandTable
, Cmd
);
97 //-----------------------------------------------------------------------------
98 // Entry point into our code: called whenever we received a packet over USB
99 // that we weren't necessarily expecting, for example a debug print.
100 //-----------------------------------------------------------------------------
101 void UsbCommandReceived(UsbCommand
*UC
)
104 // printf("UsbCommand length[len=%d]\n",sizeof(UsbCommand));
105 // printf(" cmd[len=%d]: %x\n",sizeof(UC->cmd),UC->cmd);
106 // printf(" arg0[len=%d]: %x\n",sizeof(UC->arg[0]),UC->arg[0]);
107 // printf(" arg1[len=%d]: %x\n",sizeof(UC->arg[1]),UC->arg[1]);
108 // printf(" arg2[len=%d]: %x\n",sizeof(UC->arg[2]),UC->arg[2]);
109 // printf(" data[len=%d]: %02x%02x%02x...\n",sizeof(UC->d.asBytes),UC->d.asBytes[0],UC->d.asBytes[1],UC->d.asBytes[2]);
111 // printf("%s(%x) current cmd = %x\n", __FUNCTION__, c->cmd, current_command);
112 // If we recognize a response, return to avoid further processing
114 // First check if we are handling a debug message
115 case CMD_DEBUG_PRINT_STRING
: {
116 char s
[USB_CMD_DATA_SIZE
+1];
117 size_t len
= MIN(UC
->arg
[0],USB_CMD_DATA_SIZE
);
118 memcpy(s
,UC
->d
.asBytes
,len
);
120 PrintAndLog("#db# %s ", s
);
124 case CMD_DEBUG_PRINT_INTEGERS
: {
125 PrintAndLog("#db# %08x, %08x, %08x \r\n", UC
->arg
[0], UC
->arg
[1], UC
->arg
[2]);
129 case CMD_MEASURED_ANTENNA_TUNING
: {
131 int vLf125
, vLf134
, vHf
;
132 vLf125
= UC
->arg
[0] & 0xffff;
133 vLf134
= UC
->arg
[0] >> 16;
134 vHf
= UC
->arg
[1] & 0xffff;;
135 peakf
= UC
->arg
[2] & 0xffff;
136 peakv
= UC
->arg
[2] >> 16;
138 PrintAndLog("# LF antenna: %5.2f V @ 125.00 kHz", vLf125
/1000.0);
139 PrintAndLog("# LF antenna: %5.2f V @ 134.00 kHz", vLf134
/1000.0);
140 PrintAndLog("# LF optimal: %5.2f V @%9.2f kHz", peakv
/1000.0, 12000.0/(peakf
+1));
141 PrintAndLog("# HF antenna: %5.2f V @ 13.56 MHz", vHf
/1000.0);
143 PrintAndLog("# Your LF antenna is unusable.");
144 else if (peakv
<10000)
145 PrintAndLog("# Your LF antenna is marginal.");
147 PrintAndLog("# Your HF antenna is unusable.");
149 PrintAndLog("# Your HF antenna is marginal.");
152 case CMD_DOWNLOADED_RAW_ADC_SAMPLES_125K
: {
153 // printf("received samples: ");
154 // print_hex(UC->d.asBytes,512);
155 sample_buf_len
+= UC
->arg
[1];
156 // printf("samples: %zd offset: %d\n",sample_buf_len,UC->arg[0]);
157 memcpy(sample_buf
+(UC
->arg
[0]),UC
->d
.asBytes
,UC
->arg
[1]);
162 // PrintAndLog("Receive ACK\n");
166 // Maybe it's a response
167 switch(current_command
) {
168 case CMD_DOWNLOAD_RAW_ADC_SAMPLES_125K
: {
169 if (UC
->cmd
!= CMD_DOWNLOADED_RAW_ADC_SAMPLES_125K
) {
170 PrintAndLog("unrecognized command %08x\n", UC
->cmd
);
174 PrintAndLog("received samples %d\n",UC
->arg
[0]);
175 memcpy(sample_buf
+UC
->arg
[0],UC
->d
.asBytes
,48);
176 sample_buf_len
+= 48;
177 // for(i=0; i<48; i++) sample_buf[i] = UC->d.asBytes[i];
178 received_command
= UC
->cmd
;
184 // // Store the last received command
185 // memcpy(¤t_response, UC, sizeof(UsbCommand));
186 // received_command = UC->cmd;
189 // Store the last received command
190 memcpy(¤t_response
, UC
, sizeof(UsbCommand
));
191 received_command
= UC
->cmd
;
193 // Maybe it's a response:
194 switch(current_command) {
195 case CMD_DOWNLOAD_RAW_ADC_SAMPLES_125K:
196 if (UC->cmd != CMD_DOWNLOADED_RAW_ADC_SAMPLES_125K) goto unexpected_response;
198 for(i=0; i<48; i++) sample_buf[i] = UC->d.asBytes[i];
199 received_command = UC->cmd;
201 case CMD_ACQUIRE_RAW_ADC_SAMPLES_125K:
202 case CMD_DOWNLOADED_SIM_SAMPLES_125K:
203 if (UC->cmd != CMD_ACK) goto unexpected_response;
205 received_command = UC->cmd;
210 if(UC->cmd != CMD_ACK)
211 PrintAndLog("unrecognized command %08x \n", UC->cmd);
213 memcpy(¤t_response, UC, sizeof(UsbCommand));
214 received_command = UC->cmd;