diff --git a/client/Makefile b/client/Makefile index 13bb06ff7..cc3feb156 100644 --- a/client/Makefile +++ b/client/Makefile @@ -769,6 +769,7 @@ SRCS = mifare/aiddesfire.c \ cmdhfvas.c \ cmdhfxerox.c \ cmdhw.c \ + cmdfpga.c \ cmdlf.c \ cmdlfawid.c \ cmdlfcotag.c \ diff --git a/client/src/cmdfpga.c b/client/src/cmdfpga.c new file mode 100644 index 000000000..dd2dba0da --- /dev/null +++ b/client/src/cmdfpga.c @@ -0,0 +1,192 @@ +#include "fileutils.h" +#include "cmdparser.h" // command_t +#include "cliparser.h" +#include "comms.h" +#include "cmdfpga.h" +#include "ui.h" + +static int CmdHelp(const char *Cmd); + +static int CmdConfigFpga(const char *Cmd) { + CLIParserContext *ctx; + CLIParserInit(&ctx, "hw fpga config ", + "Read the bin file and write it to the fpga [sram|flash]", + "hw fpga config -s -f myfile -> config fpga sram by bin file\n" + "hw fpga config -f myfile -> config fpga flash by bin file\n" + ); + + void *argtable[] = { + arg_param_begin, + arg_lit0("s", "sram", "config to sram, or config to flash"), + arg_str0("f", "file", "", "save to file, not suffix include"), + arg_param_end + }; + CLIExecWithReturn(ctx, Cmd, argtable, false); + + // config to sram or flash by -s option + bool sram_mode = arg_get_lit(ctx, 1); + + // check for -file option first to determine the output mode + int fnlen = 0; + char filename[FILE_PATH_SIZE] = {0}; + CLIParamStrToBuf(arg_get_str(ctx, 2), (uint8_t *)filename, FILE_PATH_SIZE, &fnlen); + + CLIParserFree(ctx); + + // Check if file name is provided + if (fnlen == 0) { + PrintAndLogEx(WARNING, "No file specified"); + return PM3_EINVARG; + } + + // Load the file content into data buffer + uint8_t *data = NULL; + size_t datalen = 0; + int res = loadFile_safe(filename, ".bin", (void **)&data, &datalen); + if (res != PM3_SUCCESS) { + free(data); + return PM3_EFILE; + } + + // TODO DXL Maybe length check for device model is required. + // coming soon + + // TODO DXL check response result is required + + struct { + uint8_t sram_mode; + uint32_t file_length; + } PACKED params; + params.sram_mode = sram_mode; + params.file_length = datalen; + + PacketResponseNG resp; + PrintAndLogEx(INFO, "Starting FPGA configuration in " _YELLOW_("%s"), sram_mode ? "SRAM" : "Flash"); + + // Start fpga config by mode + SendCommandNG(CMD_FPGA_BITSTREAM_CONFIG_START, (uint8_t *)¶ms, sizeof(params)); + // Wait for response before sending data + if (WaitForResponseTimeout(CMD_FPGA_BITSTREAM_CONFIG_START, &resp, 15000) == false) { + PrintAndLogEx(WARNING, "start config for fpga timeout while waiting for reply"); + free(data); + return PM3_ETIMEOUT; + } + if (resp.status != PM3_SUCCESS) { + PrintAndLogEx(ERR, "Failed to start FPGA configuration: %d", resp.status); + free(data); + return resp.status; + } + + // Start to send data in chunks + size_t offset = 0; + while (offset < datalen) { + size_t chunk_size = (datalen - offset) > PM3_CMD_DATA_SIZE ? PM3_CMD_DATA_SIZE : (datalen - offset); + SendCommandNG(CMD_FPGA_BITSTREAM_CONFIG_WRITE, data + offset, chunk_size); + // Wait for response before sending next chunk + if (WaitForResponseTimeout(CMD_FPGA_BITSTREAM_CONFIG_WRITE, &resp, 5000) == false) { + PrintAndLogEx(WARNING, "transfer data for fpga timeout while waiting for reply"); + free(data); + return PM3_ETIMEOUT; + } + if (resp.status != PM3_SUCCESS) { + PrintAndLogEx(ERR, "Failed to transfer FPGA configuration data: %d", resp.status); + free(data); + return resp.status; + } + offset += chunk_size; + // Print progress + PrintAndLogEx(INFO, "Sent "_YELLOW_("%zu")" bytes, progress: "_YELLOW_("%.2f%%"), chunk_size, (offset / (float)datalen) * 100); + } + + PrintAndLogEx(SUCCESS, "FPGA configuration transfer complete!"); + + // Stop fpga config + SendCommandNG(CMD_FPGA_BITSTREAM_CONFIG_FINISH, NULL, 0); + if (WaitForResponseTimeout(CMD_FPGA_BITSTREAM_CONFIG_FINISH, &resp, 5000) == false) { + PrintAndLogEx(WARNING, "stop config for fpga timeout while waiting for reply"); + free(data); + return PM3_ETIMEOUT; + } + if (resp.status != PM3_SUCCESS) { + PrintAndLogEx(ERR, "Failed to finish FPGA configuration: %d", resp.status); + free(data); + return resp.status; + } + + PrintAndLogEx(SUCCESS, "FPGA configuration successfully!"); + free(data); + return PM3_SUCCESS; +} + +static int CmdFpgaSetPowerPWM(const char *Cmd) { + CLIParserContext *ctx; + CLIParserInit(&ctx, "hw fpga pwrpwm ", + "Set the proportion of low levels of PWM output from FPGA for controlling driver voltage.", + "hw fpga pwrpwm -c 1000 -> Set pwm low-level count to 1000 for HF driver power.\n" + "hw fpga pwrpwm -c 1000 -l -> Set pwm low-level count to 1000 for LF driver power.\n"); + + void *argtable[] = { + arg_param_begin, + arg_lit0("l", "lf", "Set the driver voltage for LF. When not specified as LF, default setting for HF."), + arg_int0("c", "count", "", "PWM output low level counting used to control the voltage of the driver. " + "The larger the value, the higher the voltage; " + "the smaller the value, the lower the voltage."), + arg_param_end + }; + CLIExecWithReturn(ctx, Cmd, argtable, false); + + // Is setting for lf? + bool is_lf = arg_get_lit(ctx, 1); + // the count of low levels of pwm output + int count = arg_get_int_def(ctx, 2, 1000); + + CLIParserFree(ctx); + + // TODO DXL check response result is required + + if (count < 0 || count > 4095) { + PrintAndLogEx(ERR, "Invalid count value: %d. It should be between 0 and 4095.", count); + return PM3_EINVARG; + } + + struct { + uint8_t is_lf; + uint16_t count; + } PACKED params = { + .is_lf = is_lf, + .count = count, + }; + + // Start fpga config by mode + PacketResponseNG resp; + SendCommandNG(CMD_FPGA_CMD_SET_PWR_PWM_LOW_COUNT, (uint8_t *)¶ms, sizeof(params)); + PrintAndLogEx(INFO, "PWM value: " _YELLOW_("%d") ", for %s", count, is_lf ? "LF driver" : "HF driver"); + + // Wait for response before sending data + if (WaitForResponseTimeout(CMD_FPGA_CMD_SET_PWR_PWM_LOW_COUNT, &resp, 15000) == false) { + PrintAndLogEx(WARNING, "set power pwm for fpga timeout while waiting for reply"); + return PM3_ETIMEOUT; + } + + PrintAndLogEx(SUCCESS, "Set PWM to FPGA for driver power control complete!"); + return PM3_SUCCESS; +} + +static command_t CommandTable[] = { + {"help", CmdHelp, AlwaysAvailable, "This help"}, + {"-------------", CmdHelp, AlwaysAvailable, "----------------------- " _CYAN_("Operation") " -----------------------"}, + {"config", CmdConfigFpga, IfPm3Present, "Configure FPGA for sram or flash"}, + {"pwrpwm", CmdFpgaSetPowerPWM, IfPm3Present, "Adjust the input voltage of the driver through FPGA."}, + {NULL, NULL, NULL, NULL} +}; + +static int CmdHelp(const char *Cmd) { + (void)Cmd; // Cmd is not used so far + CmdsHelp(CommandTable); + return PM3_SUCCESS; +} + +int CmdFPGA(const char *Cmd) { + clearCommandBuffer(); + return CmdsParse(CommandTable, Cmd); +} \ No newline at end of file diff --git a/client/src/cmdfpga.h b/client/src/cmdfpga.h new file mode 100644 index 000000000..ecb51099f --- /dev/null +++ b/client/src/cmdfpga.h @@ -0,0 +1,6 @@ +#ifndef CMD_FPGA_H +#define CMD_FPGA_H + +int CmdFPGA(const char *Cmd); + +#endif // CMD_FPGA_H \ No newline at end of file