lf simpsk - now uses cliparser. And simulation can be broken by enter or button press

client/src/cmdlf.c

@@ -203,19 +203,7 @@ static int usage_lf_simask(void) {
     PrintAndLogEx(NORMAL, "       d <hexdata>    Data to sim as hex - omit to sim from DemodBuffer");
     return PM3_SUCCESS;
 }
-static int usage_lf_simpsk(void) {
+
-    PrintAndLogEx(NORMAL, "Usage: lf simpsk [1|2|3] [c <clock>] [i] [r <carrier>] [d <raw hex to sim>]");
-    PrintAndLogEx(NORMAL, "Options:");
-    PrintAndLogEx(NORMAL, "       h              This help");
-    PrintAndLogEx(NORMAL, "       c <clock>      Manually set clock - can autodetect if using DemodBuffer");
-    PrintAndLogEx(NORMAL, "       i              invert data");
-    PrintAndLogEx(NORMAL, "       1              set PSK1 (default)");
-    PrintAndLogEx(NORMAL, "       2              set PSK2");
-    PrintAndLogEx(NORMAL, "       3              set PSK3");
-    PrintAndLogEx(NORMAL, "       r <carrier>    2|4|8 are valid carriers: default = 2");
-    PrintAndLogEx(NORMAL, "       d <hexdata>    Data to sim as hex - omit to sim from DemodBuffer");
-    return PM3_SUCCESS;
-}
 
 static int CmdLFTune(const char *Cmd) {
 
@@ -865,8 +853,6 @@ int CmdLFSim(const char *Cmd) {
 
     PrintAndLogEx(DEBUG, "DEBUG: Uploading %zu bytes", GraphTraceLen);
 
-    PacketResponseNG resp;
-
     struct pupload {
         uint8_t flag;
         uint16_t offset;
@@ -881,6 +867,8 @@ int CmdLFSim(const char *Cmd) {
     // fast push mode
     conn.block_after_ACK = true;
 
+    PacketResponseNG resp;
+
     //can send only 512 bits at a time (1 byte sent per bit...)
     for (uint16_t i = 0; i < GraphTraceLen; i += PM3_CMD_DATA_SIZE - 3) {
 
@@ -903,8 +891,6 @@ int CmdLFSim(const char *Cmd) {
 
     // Disable fast mode before last command
     conn.block_after_ACK = false;
-    PrintAndLogEx(NORMAL, "");
-    PrintAndLogEx(INFO, "Simulating");
 
     struct p {
         uint16_t len;
@@ -916,11 +902,24 @@ int CmdLFSim(const char *Cmd) {
     clearCommandBuffer();
     SendCommandNG(CMD_LF_SIMULATE, (uint8_t *)&payload, sizeof(payload));
 
-    WaitForResponse(CMD_LF_SIMULATE, &resp);
+    PrintAndLogEx(NORMAL, "");
+    PrintAndLogEx(INFO, "Press " _GREEN_("<Enter>") " or pm3-button to exit");
 
+    for (;;) {
+        if (kbd_enter_pressed()) {
+            SendCommandNG(CMD_BREAK_LOOP, NULL, 0);
+            PrintAndLogEx(DEBUG, "User aborted");
+            break;
+        }
+
+        if (WaitForResponseTimeout(CMD_LF_SIMULATE, &resp, 1000)) {
+            if (resp.status == PM3_EOPABORTED) {
+                PrintAndLogEx(DEBUG, "Button pressed, user aborted");
+                break;
+            }
+        }
+    }
     PrintAndLogEx(INFO, "Done");
-    if (resp.status != PM3_EOPABORTED)
-        return resp.status;
     return PM3_SUCCESS;
 }
 
@@ -1012,19 +1011,31 @@ int CmdLFfskSim(const char *Cmd) {
     payload->clock = clk;
     memcpy(payload->data, DemodBuffer, size);
 
-    PrintAndLogEx(INFO, "Simulating");
-
     clearCommandBuffer();
     SendCommandNG(CMD_LF_FSK_SIMULATE, (uint8_t *)payload,  sizeof(lf_fsksim_t) + size);
     free(payload);
 
     setClockGrid(clk, 0);
-    PacketResponseNG resp;
-    WaitForResponse(CMD_LF_FSK_SIMULATE, &resp);
 
+    PrintAndLogEx(NORMAL, "");
+    PrintAndLogEx(INFO, "Press " _GREEN_("<Enter>") " or pm3-button to exit");
+
+    for (;;) {
+        if (kbd_enter_pressed()) {
+            SendCommandNG(CMD_BREAK_LOOP, NULL, 0);
+            PrintAndLogEx(DEBUG, "User aborted");
+            break;
+        }
+
+        PacketResponseNG resp;
+        if (WaitForResponseTimeout(CMD_LF_FSK_SIMULATE, &resp, 1000)) {
+            if (resp.status == PM3_EOPABORTED) {
+                PrintAndLogEx(DEBUG, "Button pressed, user aborted");
+                break;
+            }
+        }
+    }
     PrintAndLogEx(INFO, "Done");
-    if (resp.status != PM3_EOPABORTED)
-        return resp.status;
     return PM3_SUCCESS;
 }
 
@@ -1114,113 +1125,140 @@ int CmdLFaskSim(const char *Cmd) {
     payload->clock = clk;
     memcpy(payload->data, DemodBuffer, size);
 
-    PrintAndLogEx(INFO, "Simulating");
-
     clearCommandBuffer();
     SendCommandNG(CMD_LF_ASK_SIMULATE, (uint8_t *)payload,  sizeof(lf_asksim_t) + size);
     free(payload);
 
-    PacketResponseNG resp;
+    PrintAndLogEx(NORMAL, "");
-    WaitForResponse(CMD_LF_ASK_SIMULATE, &resp);
+    PrintAndLogEx(INFO, "Press " _GREEN_("<Enter>") " or pm3-button to exit");
 
+    for (;;) {
+        if (kbd_enter_pressed()) {
+            SendCommandNG(CMD_BREAK_LOOP, NULL, 0);
+            PrintAndLogEx(DEBUG, "User aborted");
+            break;
+        }
+
+        PacketResponseNG resp;
+        if (WaitForResponseTimeout(CMD_LF_ASK_SIMULATE, &resp, 1000)) {
+            if (resp.status == PM3_EOPABORTED) {
+                PrintAndLogEx(DEBUG, "Button pressed, user aborted");
+                break;
+            }
+        }
+    }
     PrintAndLogEx(INFO, "Done");
-    if (resp.status != PM3_EOPABORTED)
-        return resp.status;
     return PM3_SUCCESS;
 }
 
 // sim psk data given carrier, clock, invert
 // - allow pull data from DemodBuffer or parameters
 int CmdLFpskSim(const char *Cmd) {
-    //might be able to autodetect FC and clock from Graphbuffer if using demod buffer
+ 
-    //will need carrier, Clock, and bitstream
+    CLIParserContext *ctx;
-    uint8_t carrier = 0, clk = 0;
+    CLIParserInit(&ctx, "lf simpsk",
-    uint8_t invert = 0;
+                  "Simulate LF PSK tag from demodbuffer or input",
-    bool errors = false;
+                  "lf simpsk -1 --clk 32 --rc 2 -d a0000000bd989a11   --> simulate a indala tag manually\n"
-    char hexData[64] = {0x00}; // store entered hex data
+                 );
-    uint8_t data[255] = {0x00};
-    int dataLen = 0;
-    uint8_t cmdp = 0;
-    uint8_t pskType = 1;
 
-    while (param_getchar(Cmd, cmdp) != 0x00 && !errors) {
+    void *argtable[] = {
-        switch (tolower(param_getchar(Cmd, cmdp))) {
+        arg_param_begin,
-            case 'h':
+        arg_lit0("1", "psk1", "set PSK1 (default)"),
-                return usage_lf_simpsk();
+        arg_lit0("2", "psk2", "set PSK2"),
-            case 'i':
+        arg_lit0("3", "psk3", "set PSK3"),        
-                invert = 1;
+        arg_lit0("i", "inv", "invert data"),
-                cmdp++;
+        arg_u64_0("c", "clk", "<dec>", "manually set clock - can autodetect if using DemodBuffer (default 32)"),
-                break;
+        arg_u64_0(NULL, "rc", "<dec>", "2|4|8 are valid carriers (default 2)"),
-            case 'c':
+        arg_str0("d", "data", "<hex>", "data to sim - omit to use DemodBuffer"),
-                errors |= param_getdec(Cmd, cmdp + 1, &clk);
+        arg_lit0("v", "verbose", "verbose output"),
-                cmdp += 2;
+        arg_param_end
-                break;
+    };
-            case 'r':
+    CLIExecWithReturn(ctx, Cmd, argtable, true);
-                errors |= param_getdec(Cmd, cmdp + 1, &carrier);
+    bool use_psk1 = arg_get_lit(ctx, 1);
-                cmdp += 2;
+    bool use_psk2 = arg_get_lit(ctx, 2);
-                break;
+    bool use_psk3 = arg_get_lit(ctx, 3);
-            case '1':
+    bool invert = arg_get_lit(ctx, 4);
-                pskType = 1;
+    uint8_t clk = arg_get_u32_def(ctx, 5, 0);
-                cmdp++;
+    uint8_t carrier = arg_get_u32_def(ctx, 6, 2);
-                break;
+    int raw_len = 64;
-            case '2':
+    char raw[64] = {0};
-                pskType = 2;
+    CLIGetStrWithReturn(ctx, 7, (uint8_t*)raw, &raw_len);
-                cmdp++;
+    bool verbose = arg_get_lit(ctx, 8);
-                break;
+    CLIParserFree(ctx);
-            case '3':
-                pskType = 3;
-                cmdp++;
-                break;
-            case 'd':
-                dataLen = param_getstr(Cmd, cmdp + 1, hexData, sizeof(hexData));
-                if (dataLen == 0)
-                    errors = true;
-                else
-                    dataLen = hextobinarray((char *)data, hexData);
 
-                if (dataLen == 0) errors = true;
+    if ((use_psk1 + use_psk2 + use_psk3) > 1) {
-                if (errors) PrintAndLogEx(ERR, "Error getting hex data");
+        PrintAndLogEx(ERR, "only one PSK mode can be set");
-                cmdp += 2;
+        return PM3_EINVARG;
-                break;
-            default:
-                PrintAndLogEx(WARNING, "Unknown parameter '%c'", param_getchar(Cmd, cmdp));
-                errors = true;
-                break;
-        }
     }
+    
+    if (carrier != 2 && carrier != 4 && carrier != 8) {
+        PrintAndLogEx(ERR, "Wrong carrier given, expected <2|4|8>");
+        return PM3_EINVARG;
+    }
+
+    uint8_t psk_type = 1;
+    if (use_psk2)
+        psk_type = 2;
+    if (use_psk3)
+        psk_type = 3;
+
+
+    uint8_t bs[256] = {0x00};
+    int bs_len = hextobinarray((char *)bs, raw);
+    if (bs_len == 0) {
+        PrintAndLogEx(ERR, "Failed to convert to binary string array");
+        return PM3_EINVARG;
+    }
+
     // No args
-    if (cmdp == 0 && DemodBufferLen == 0)
+    //if (DemodBufferLen == 0)
-        errors = true;
+    //    errors = true;
 
-    //Validations
-    if (errors) return usage_lf_simpsk();
 
-    if (dataLen == 0) { //using DemodBuffer
+    if (bs_len == 0) { 
+        // Using data from DemodBuffer
+        // might be able to autodetect FC and clock from Graphbuffer if using demod buffer
+        // will need carrier, clock, and bitstream
         PrintAndLogEx(INFO, "Getting Clocks");
 
-        if (clk == 0) clk = GetPskClock("", false);
+        int res = 0;
-        PrintAndLogEx(INFO, "clk: %d", clk);
+        if (clk == 0) {
+            res = GetPskClock("", verbose);
+            if ( res < 1) {
+                clk = 32;
+            } else {
+                clk = (uint8_t)res;
+            }
+        }
 
-        if (!carrier) carrier = GetPskCarrier(false);
+        if (carrier == 0) {
-        PrintAndLogEx(INFO, "carrier: %d", carrier);
+             res = GetPskCarrier(verbose);
+             if (res < 1 ) {
+                 carrier = 2;
+             } else {
+                 carrier = (uint8_t)res;
+             }
+        }
+        PrintAndLogEx(INFO, "Using clk: %u,  carrier: %u", clk, carrier);
 
     } else {
-        setDemodBuff(data, dataLen, 0);
+        setDemodBuff(bs, bs_len, 0);
     }
 
-    if (clk == 0) clk = 32;
+    if (clk == 0) {
-
+        PrintAndLogEx(INFO, "Autodetection of clock failed, falling back to FC/32");
-    if (carrier != 2 && carrier != 4 && carrier != 8)
+        clk = 32;
-        carrier = 2;
-
-    if (pskType != 1) {
-        if (pskType == 2) {
-            //need to convert psk2 to psk1 data before sim
-            psk2TOpsk1(DemodBuffer, DemodBufferLen);
-        } else {
-            PrintAndLogEx(WARNING, "Sorry, PSK3 not yet available");
-        }
     }
+
+
+    if (psk_type == 2) {
+        //need to convert psk2 to psk1 data before sim
+        psk2TOpsk1(DemodBuffer, DemodBufferLen);
+    } else if (psk_type == 3) {
+        PrintAndLogEx(WARNING, "PSK3 not yet available. Falling back to PSK1");
+        psk_type = 1;
+    }
+
     size_t size = DemodBufferLen;
     if (size > (PM3_CMD_DATA_SIZE - sizeof(lf_psksim_t))) {
         PrintAndLogEx(WARNING, "DemodBuffer too long for current implementation - length: %zu - max: %zu", size, PM3_CMD_DATA_SIZE - sizeof(lf_psksim_t));
@@ -1232,19 +1270,29 @@ int CmdLFpskSim(const char *Cmd) {
     payload->invert = invert;
     payload->clock = clk;
     memcpy(payload->data, DemodBuffer, size);
-
-    PrintAndLogEx(INFO, "Simulating");
-
     clearCommandBuffer();
     SendCommandNG(CMD_LF_PSK_SIMULATE, (uint8_t *)payload,  sizeof(lf_psksim_t) + size);
     free(payload);
 
-    PacketResponseNG resp;
+    PrintAndLogEx(NORMAL, "");
-    WaitForResponse(CMD_LF_PSK_SIMULATE, &resp);
+    PrintAndLogEx(INFO, "Press " _GREEN_("<Enter>") " or pm3-button to exit");
 
+    for (;;) {
+        if (kbd_enter_pressed()) {
+            SendCommandNG(CMD_BREAK_LOOP, NULL, 0);
+            PrintAndLogEx(DEBUG, "User aborted");
+            break;
+        }
+
+        PacketResponseNG resp;
+        if (WaitForResponseTimeout(CMD_LF_PSK_SIMULATE, &resp, 1000)) {
+            if (resp.status == PM3_EOPABORTED) {
+                PrintAndLogEx(DEBUG, "Button pressed, user aborted");
+                break;
+            }
+        }
+    }
     PrintAndLogEx(INFO, "Done");
-    if (resp.status != PM3_EOPABORTED)
-        return resp.status;
     return PM3_SUCCESS;
 }