X-Git-Url: http://cvs.zerfleddert.de/cgi-bin/gitweb.cgi/proxmark3-svn/blobdiff_plain/7838f4beba79370f94c7a3de2cf34278f5d481c8..59152dcb05df24432f711e7032b9c9cf6050ec47:/client/cmdhw.c diff --git a/client/cmdhw.c b/client/cmdhw.c index 5f25241c..24b4bada 100644 --- 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 */ @@ -25,7 +26,8 @@ static int CmdHelp(const char *Cmd); static void lookupChipID(uint32_t iChipID, uint32_t mem_used) { - char asBuff[100]; + char asBuff[120]; + memset(asBuff, 0, sizeof(asBuff)); uint32_t mem_avail = 0; switch(iChipID) @@ -135,12 +137,17 @@ static void lookupChipID(uint32_t iChipID, uint32_t mem_used) mem_avail = 2048; break; } - PrintAndLog("Nonvolatile Program Memory Size: %dK bytes. Used: %d bytes (%2.0f\%). Free: %d bytes (%2.0f\%).", + + uint32_t mem_left = 0; + if ( mem_avail > 0 ) + mem_left = (mem_avail * 1024) - mem_used; + + PrintAndLog("Nonvolatile Program Memory Size: %uK bytes. Used: %u bytes (%2.0f\%). Free: %u bytes (%2.0f\%).", mem_avail, mem_used, - mem_avail == 0 ? 0 : (float)mem_used/(mem_avail*1024)*100, - mem_avail*1024 - mem_used, - mem_avail == 0 ? 0 : (float)(mem_avail*1024-mem_used)/(mem_avail*1024)*100 + mem_avail == 0 ? 0.0f : (float)mem_used/(mem_avail*1024)*100, + mem_left, + mem_avail == 0 ? 0.0f : (float)mem_left/(mem_avail*1024)*100 ); switch((iChipID&0xF000)>>12) { @@ -309,60 +316,66 @@ static void lookupChipID(uint32_t iChipID, uint32_t mem_used) int CmdDetectReader(const char *Cmd) { - UsbCommand c={CMD_LISTEN_READER_FIELD}; - // 'l' means LF - 125/134 kHz - if(*Cmd == 'l') { - c.arg[0] = 1; - } else if (*Cmd == 'h') { - c.arg[0] = 2; - } else if (*Cmd != '\0') { - PrintAndLog("use 'detectreader' or 'detectreader l' or 'detectreader h'"); - return 0; - } - SendCommand(&c); - return 0; + UsbCommand c = {CMD_LISTEN_READER_FIELD}; + // 'l' means LF - 125/134 kHz + if(*Cmd == 'l') { + c.arg[0] = 1; + } else if (*Cmd == 'h') { + c.arg[0] = 2; + } else if (*Cmd != '\0') { + PrintAndLog("use 'detectreader' or 'detectreader l' or 'detectreader h'"); + return 0; + } + clearCommandBuffer(); + SendCommand(&c); + return 0; } // ## FPGA Control int CmdFPGAOff(const char *Cmd) { - UsbCommand c = {CMD_FPGA_MAJOR_MODE_OFF}; - SendCommand(&c); - return 0; + UsbCommand c = {CMD_FPGA_MAJOR_MODE_OFF}; + clearCommandBuffer(); + SendCommand(&c); + return 0; } int CmdLCD(const char *Cmd) { - int i, j; + int i, j; - UsbCommand c={CMD_LCD}; - sscanf(Cmd, "%x %d", &i, &j); - while (j--) { - c.arg[0] = i & 0x1ff; - SendCommand(&c); - } - return 0; + UsbCommand c = {CMD_LCD}; + sscanf(Cmd, "%x %d", &i, &j); + while (j--) { + c.arg[0] = i & 0x1ff; + clearCommandBuffer(); + SendCommand(&c); + } + return 0; } int CmdLCDReset(const char *Cmd) { - UsbCommand c = {CMD_LCD_RESET, {strtol(Cmd, NULL, 0), 0, 0}}; - SendCommand(&c); - return 0; + UsbCommand c = {CMD_LCD_RESET, {strtol(Cmd, NULL, 0), 0, 0}}; + clearCommandBuffer(); + SendCommand(&c); + return 0; } int CmdReadmem(const char *Cmd) { - UsbCommand c = {CMD_READ_MEM, {strtol(Cmd, NULL, 0), 0, 0}}; - SendCommand(&c); - return 0; + UsbCommand c = {CMD_READ_MEM, {strtol(Cmd, NULL, 0), 0, 0}}; + clearCommandBuffer(); + SendCommand(&c); + return 0; } int CmdReset(const char *Cmd) { - UsbCommand c = {CMD_HARDWARE_RESET}; - SendCommand(&c); - return 0; + UsbCommand c = {CMD_HARDWARE_RESET}; + clearCommandBuffer(); + SendCommand(&c); + return 0; } /* @@ -371,30 +384,29 @@ int CmdReset(const char *Cmd) */ int CmdSetDivisor(const char *Cmd) { - UsbCommand c = {CMD_SET_LF_DIVISOR, {strtol(Cmd, NULL, 0), 0, 0}}; - if (c.arg[0] < 19 || c.arg[0] > 255) { - PrintAndLog("divisor must be between 19 and 255"); - } else { - SendCommand(&c); - PrintAndLog("Divisor set, expected freq=%dHz", 12000000 / (c.arg[0]+1)); - } - return 0; + UsbCommand c = {CMD_SET_LF_DIVISOR, {strtol(Cmd, NULL, 0), 0, 0}}; + + if (c.arg[0] < 19 || c.arg[0] > 255) { + PrintAndLog("divisor must be between 19 and 255"); + return 1; + } + + clearCommandBuffer(); + SendCommand(&c); + PrintAndLog("Divisor set, expected freq=%dHz", 12000000 / (c.arg[0]+1)); + return 0; } int CmdSetMux(const char *Cmd) { - UsbCommand c={CMD_SET_ADC_MUX}; - if (strcmp(Cmd, "lopkd") == 0) { - c.arg[0] = 0; - } else if (strcmp(Cmd, "loraw") == 0) { - c.arg[0] = 1; - } else if (strcmp(Cmd, "hipkd") == 0) { - c.arg[0] = 2; - } else if (strcmp(Cmd, "hiraw") == 0) { - c.arg[0] = 3; - } - SendCommand(&c); - return 0; + UsbCommand c = {CMD_SET_ADC_MUX}; + if (strcmp(Cmd, "lopkd") == 0) c.arg[0] = 0; + else if (strcmp(Cmd, "loraw") == 0) c.arg[0] = 1; + else if (strcmp(Cmd, "hipkd") == 0) c.arg[0] = 2; + else if (strcmp(Cmd, "hiraw") == 0) c.arg[0] = 3; + clearCommandBuffer(); + SendCommand(&c); + return 0; } int CmdTune(const char *Cmd) @@ -404,18 +416,17 @@ int CmdTune(const char *Cmd) int CmdVersion(const char *Cmd) { - clearCommandBuffer(); - UsbCommand c = {CMD_VERSION}; + UsbCommand c = {CMD_VERSION}; static UsbCommand resp = {0, {0, 0, 0}}; if (resp.arg[0] == 0 && resp.arg[1] == 0) { // no cached information available - SendCommand(&c); - if (WaitForResponseTimeout(CMD_ACK,&resp,1000)) { - PrintAndLog("Prox/RFID mark3 RFID instrument"); - PrintAndLog((char*)resp.d.asBytes); - lookupChipID(resp.arg[0], resp.arg[1]); - } + SendCommand(&c); + if (WaitForResponseTimeout(CMD_ACK, &resp, 1000)) { + PrintAndLog("Prox/RFID mark3 RFID instrument"); + PrintAndLog((char*)resp.d.asBytes); + lookupChipID(resp.arg[0], resp.arg[1]); + } } else { PrintAndLog("[[[ Cached information ]]]\n"); PrintAndLog("Prox/RFID mark3 RFID instrument"); @@ -428,8 +439,13 @@ int CmdVersion(const char *Cmd) int CmdStatus(const char *Cmd) { + uint8_t speed_test_buffer[USB_CMD_DATA_SIZE]; + sample_buf = speed_test_buffer; + clearCommandBuffer(); UsbCommand c = {CMD_STATUS}; SendCommand(&c); + if (!WaitForResponseTimeout(CMD_ACK, &c, 1900)) + PrintAndLog("Status command failed. USB Speed Test timed out"); return 0; } @@ -439,40 +455,39 @@ int CmdPing(const char *Cmd) UsbCommand resp; UsbCommand c = {CMD_PING}; SendCommand(&c); - if (WaitForResponseTimeout(CMD_ACK,&resp,1000)) { + if (WaitForResponseTimeout(CMD_ACK, &resp, 1000)) PrintAndLog("Ping successfull"); - }else{ - PrintAndLog("Ping failed"); - } - return 0; + else + PrintAndLog("Ping failed"); + return 0; } static command_t CommandTable[] = { - {"help", CmdHelp, 1, "This help"}, - {"detectreader", CmdDetectReader,0, "['l'|'h'] -- Detect external reader field (option 'l' or 'h' to limit to LF or HF)"}, - {"fpgaoff", CmdFPGAOff, 0, "Set FPGA off"}, - {"lcd", CmdLCD, 0, " -- Send command/data to LCD"}, - {"lcdreset", CmdLCDReset, 0, "Hardware reset LCD"}, - {"readmem", CmdReadmem, 0, "[address] -- Read memory at decimal address from flash"}, - {"reset", CmdReset, 0, "Reset the Proxmark3"}, - {"setlfdivisor", CmdSetDivisor, 0, "<19 - 255> -- Drive LF antenna at 12Mhz/(divisor+1)"}, - {"setmux", CmdSetMux, 0, " -- Set the ADC mux to a specific value"}, - {"tune", CmdTune, 0, "Measure antenna tuning"}, - {"version", CmdVersion, 0, "Show version information about the connected Proxmark"}, + {"help", CmdHelp, 1, "This help"}, + {"detectreader", CmdDetectReader,0, "['l'|'h'] -- Detect external reader field (option 'l' or 'h' to limit to LF or HF)"}, + {"fpgaoff", CmdFPGAOff, 0, "Set FPGA off"}, + {"lcd", CmdLCD, 0, " -- Send command/data to LCD"}, + {"lcdreset", CmdLCDReset, 0, "Hardware reset LCD"}, + {"readmem", CmdReadmem, 0, "[address] -- Read memory at decimal address from flash"}, + {"reset", CmdReset, 0, "Reset the Proxmark3"}, + {"setlfdivisor", CmdSetDivisor, 0, "<19 - 255> -- Drive LF antenna at 12Mhz/(divisor+1)"}, + {"setmux", CmdSetMux, 0, " -- Set the ADC mux to a specific value"}, + {"tune", CmdTune, 0, "Measure antenna tuning"}, + {"version", CmdVersion, 0, "Show version information about the connected Proxmark"}, {"status", CmdStatus, 0, "Show runtime status information about the connected Proxmark"}, {"ping", CmdPing, 0, "Test if the pm3 is responsive"}, - {NULL, NULL, 0, NULL} + {NULL, NULL, 0, NULL} }; -int CmdHW(const char *Cmd) -{ - CmdsParse(CommandTable, Cmd); - return 0; +int CmdHW(const char *Cmd) { + clearCommandBuffer(); + CmdsParse(CommandTable, Cmd); + return 0; } int CmdHelp(const char *Cmd) { - CmdsHelp(CommandTable); - return 0; + CmdsHelp(CommandTable); + return 0; }