syntax suger

chg:  added clearCommandBuffer(); before calls to sendcommand.
This commit is contained in:
iceman1001 2016-08-09 09:12:16 +02:00
commit 3d4207f3b6

View file

@ -310,7 +310,7 @@ static void lookupChipID(uint32_t iChipID, uint32_t mem_used)
int CmdDetectReader(const char *Cmd) int CmdDetectReader(const char *Cmd)
{ {
UsbCommand c={CMD_LISTEN_READER_FIELD}; UsbCommand c = {CMD_LISTEN_READER_FIELD};
// 'l' means LF - 125/134 kHz // 'l' means LF - 125/134 kHz
if(*Cmd == 'l') { if(*Cmd == 'l') {
c.arg[0] = 1; c.arg[0] = 1;
@ -320,6 +320,7 @@ int CmdDetectReader(const char *Cmd)
PrintAndLog("use 'detectreader' or 'detectreader l' or 'detectreader h'"); PrintAndLog("use 'detectreader' or 'detectreader l' or 'detectreader h'");
return 0; return 0;
} }
clearCommandBuffer();
SendCommand(&c); SendCommand(&c);
return 0; return 0;
} }
@ -328,6 +329,7 @@ int CmdDetectReader(const char *Cmd)
int CmdFPGAOff(const char *Cmd) int CmdFPGAOff(const char *Cmd)
{ {
UsbCommand c = {CMD_FPGA_MAJOR_MODE_OFF}; UsbCommand c = {CMD_FPGA_MAJOR_MODE_OFF};
clearCommandBuffer();
SendCommand(&c); SendCommand(&c);
return 0; return 0;
} }
@ -336,10 +338,11 @@ int CmdLCD(const char *Cmd)
{ {
int i, j; int i, j;
UsbCommand c={CMD_LCD}; UsbCommand c = {CMD_LCD};
sscanf(Cmd, "%x %d", &i, &j); sscanf(Cmd, "%x %d", &i, &j);
while (j--) { while (j--) {
c.arg[0] = i & 0x1ff; c.arg[0] = i & 0x1ff;
clearCommandBuffer();
SendCommand(&c); SendCommand(&c);
} }
return 0; return 0;
@ -348,6 +351,7 @@ int CmdLCD(const char *Cmd)
int CmdLCDReset(const char *Cmd) int CmdLCDReset(const char *Cmd)
{ {
UsbCommand c = {CMD_LCD_RESET, {strtol(Cmd, NULL, 0), 0, 0}}; UsbCommand c = {CMD_LCD_RESET, {strtol(Cmd, NULL, 0), 0, 0}};
clearCommandBuffer();
SendCommand(&c); SendCommand(&c);
return 0; return 0;
} }
@ -355,6 +359,7 @@ int CmdLCDReset(const char *Cmd)
int CmdReadmem(const char *Cmd) int CmdReadmem(const char *Cmd)
{ {
UsbCommand c = {CMD_READ_MEM, {strtol(Cmd, NULL, 0), 0, 0}}; UsbCommand c = {CMD_READ_MEM, {strtol(Cmd, NULL, 0), 0, 0}};
clearCommandBuffer();
SendCommand(&c); SendCommand(&c);
return 0; return 0;
} }
@ -362,6 +367,7 @@ int CmdReadmem(const char *Cmd)
int CmdReset(const char *Cmd) int CmdReset(const char *Cmd)
{ {
UsbCommand c = {CMD_HARDWARE_RESET}; UsbCommand c = {CMD_HARDWARE_RESET};
clearCommandBuffer();
SendCommand(&c); SendCommand(&c);
return 0; return 0;
} }
@ -373,27 +379,26 @@ int CmdReset(const char *Cmd)
int CmdSetDivisor(const char *Cmd) int CmdSetDivisor(const char *Cmd)
{ {
UsbCommand c = {CMD_SET_LF_DIVISOR, {strtol(Cmd, NULL, 0), 0, 0}}; UsbCommand c = {CMD_SET_LF_DIVISOR, {strtol(Cmd, NULL, 0), 0, 0}};
if (c.arg[0] < 19 || c.arg[0] > 255) { if (c.arg[0] < 19 || c.arg[0] > 255) {
PrintAndLog("divisor must be between 19 and 255"); PrintAndLog("divisor must be between 19 and 255");
} else { return 1;
}
clearCommandBuffer();
SendCommand(&c); SendCommand(&c);
PrintAndLog("Divisor set, expected freq=%dHz", 12000000 / (c.arg[0]+1)); PrintAndLog("Divisor set, expected freq=%dHz", 12000000 / (c.arg[0]+1));
}
return 0; return 0;
} }
int CmdSetMux(const char *Cmd) int CmdSetMux(const char *Cmd)
{ {
UsbCommand c={CMD_SET_ADC_MUX}; UsbCommand c = {CMD_SET_ADC_MUX};
if (strcmp(Cmd, "lopkd") == 0) { if (strcmp(Cmd, "lopkd") == 0) c.arg[0] = 0;
c.arg[0] = 0; else if (strcmp(Cmd, "loraw") == 0) c.arg[0] = 1;
} else if (strcmp(Cmd, "loraw") == 0) { else if (strcmp(Cmd, "hipkd") == 0) c.arg[0] = 2;
c.arg[0] = 1; else if (strcmp(Cmd, "hiraw") == 0) c.arg[0] = 3;
} else if (strcmp(Cmd, "hipkd") == 0) { clearCommandBuffer();
c.arg[0] = 2;
} else if (strcmp(Cmd, "hiraw") == 0) {
c.arg[0] = 3;
}
SendCommand(&c); SendCommand(&c);
return 0; return 0;
} }
@ -405,14 +410,13 @@ int CmdTune(const char *Cmd)
int CmdVersion(const char *Cmd) int CmdVersion(const char *Cmd)
{ {
clearCommandBuffer(); clearCommandBuffer();
UsbCommand c = {CMD_VERSION}; UsbCommand c = {CMD_VERSION};
static UsbCommand resp = {0, {0, 0, 0}}; static UsbCommand resp = {0, {0, 0, 0}};
if (resp.arg[0] == 0 && resp.arg[1] == 0) { // no cached information available if (resp.arg[0] == 0 && resp.arg[1] == 0) { // no cached information available
SendCommand(&c); SendCommand(&c);
if (WaitForResponseTimeout(CMD_ACK,&resp,1000)) { if (WaitForResponseTimeout(CMD_ACK, &resp, 1000)) {
PrintAndLog("Prox/RFID mark3 RFID instrument"); PrintAndLog("Prox/RFID mark3 RFID instrument");
PrintAndLog((char*)resp.d.asBytes); PrintAndLog((char*)resp.d.asBytes);
lookupChipID(resp.arg[0], resp.arg[1]); lookupChipID(resp.arg[0], resp.arg[1]);
@ -431,13 +435,11 @@ int CmdStatus(const char *Cmd)
{ {
uint8_t speed_test_buffer[USB_CMD_DATA_SIZE]; uint8_t speed_test_buffer[USB_CMD_DATA_SIZE];
sample_buf = speed_test_buffer; sample_buf = speed_test_buffer;
clearCommandBuffer(); clearCommandBuffer();
UsbCommand c = {CMD_STATUS}; UsbCommand c = {CMD_STATUS};
SendCommand(&c); SendCommand(&c);
if (!WaitForResponseTimeout(CMD_ACK,&c,1900)) { if (!WaitForResponseTimeout(CMD_ACK, &c, 1900))
PrintAndLog("Status command failed. USB Speed Test timed out"); PrintAndLog("Status command failed. USB Speed Test timed out");
}
return 0; return 0;
} }
@ -448,7 +450,7 @@ int CmdPing(const char *Cmd)
UsbCommand resp; UsbCommand resp;
UsbCommand c = {CMD_PING}; UsbCommand c = {CMD_PING};
SendCommand(&c); SendCommand(&c);
if (WaitForResponseTimeout(CMD_ACK,&resp,1000)) if (WaitForResponseTimeout(CMD_ACK, &resp, 1000))
PrintAndLog("Ping successfull"); PrintAndLog("Ping successfull");
else else
PrintAndLog("Ping failed"); PrintAndLog("Ping failed");