+//-----------------------------------------------------------------------------
+// Copyright (C) 2010 iZsh <izsh at fail0verflow.com>
+//
+// This code is licensed to you under the terms of the GNU GPL, version 2 or,
+// at your option, any later version. See the LICENSE.txt file for the text of
+// the license.
+//-----------------------------------------------------------------------------
+// Main command parser entry point
+//-----------------------------------------------------------------------------
+
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <string.h>
+#include "sleep.h"
#include "cmdparser.h"
#include "data.h"
#include "usb_cmd.h"
unsigned int current_command = CMD_UNKNOWN;
unsigned int received_command = CMD_UNKNOWN;
+UsbCommand current_response;
+UsbCommand current_response_user;
static int CmdHelp(const char *Cmd);
static int CmdQuit(const char *Cmd);
return 0;
}
-void WaitForResponse(uint32_t response_type)
+UsbCommand * WaitForResponseTimeout(uint32_t response_type, uint32_t ms_timeout) {
+ UsbCommand * ret = NULL;
+ int i=0;
+
+ for(i=0; received_command != response_type && i < ms_timeout / 10; i++) {
+ msleep(10); // XXX ugh
+ }
+
+ // There was an evil BUG
+ memcpy(¤t_response_user, ¤t_response, sizeof(UsbCommand));
+ ret = ¤t_response_user;
+
+ if(received_command != response_type)
+ ret = NULL;
+
+ received_command = CMD_UNKNOWN;
+
+ return ret;
+}
+
+UsbCommand * WaitForResponse(uint32_t response_type)
{
- while (received_command != response_type) {
-#ifdef WIN32
- UsbCommand c;
- if (ReceiveCommandPoll(&c))
- UsbCommandReceived(&c);
- Sleep(0);
-#else
- usleep(10000); // XXX ugh
-#endif
- }
- received_command = CMD_UNKNOWN;
+ return WaitForResponseTimeout(response_type, -1);
}
//-----------------------------------------------------------------------------
}
memcpy(s, UC->d.asBytes, UC->arg[0]);
s[UC->arg[0]] = '\0';
- PrintAndLog("#db# %s", s);
+ PrintAndLog("#db# %s ", s);
return;
}
case CMD_DEBUG_PRINT_INTEGERS:
- PrintAndLog("#db# %08x, %08x, %08x\r\n", UC->arg[0], UC->arg[1], UC->arg[2]);
+ PrintAndLog("#db# %08x, %08x, %08x \r\n", UC->arg[0], UC->arg[1], UC->arg[2]);
return;
case CMD_MEASURED_ANTENNA_TUNING: {
return;
default:
unexpected_response:
- PrintAndLog("unrecognized command %08x\n", UC->cmd);
- break;
+
+ if(UC->cmd != CMD_ACK)
+ PrintAndLog("unrecognized command %08x \n", UC->cmd);
+ else
+ memcpy(¤t_response, UC, sizeof(UsbCommand));
+ received_command = UC->cmd;
}
}