add: USB Speed Test to hw status

[proxmark3-svn] / client / cmdhw.c

diff --git a/client/cmdhw.c b/client/cmdhw.c
index 23b6ce21b5af5cb1ffb87347b0c6320df8908a78..44f878afe63dd6fde6ad06e10ec766fffa346703 100644 (file)
--- a/client/cmdhw.c
+++ b/client/cmdhw.c
@@ -18,6 +18,7 @@
 #include "cmdhw.h"
 #include "cmdmain.h"
 #include "cmddata.h"
+#include "data.h"
 
 /* low-level hardware control */
 
@@ -428,11 +429,20 @@ int CmdVersion(const char *Cmd)
 
 int CmdStatus(const char *Cmd)
 {
-       UsbCommand c = {CMD_STATUS};
+       uint8_t speed_test_buffer[USB_CMD_DATA_SIZE];
+       sample_buf = speed_test_buffer;
+       #define USB_SPEED_TEST_SIZE (1000*USB_CMD_DATA_SIZE)
+
+       clearCommandBuffer();
+       UsbCommand c = {CMD_STATUS, {USB_SPEED_TEST_SIZE}};
        SendCommand(&c);
+       if (!WaitForResponseTimeout(CMD_ACK,&c,1500)) {
+               PrintAndLog("Status command failed. USB Speed Test timed out");
+       }
        return 0;
 }
 
+
 int CmdPing(const char *Cmd)
 {
        clearCommandBuffer();