diff --git a/armsrc/appmain.c b/armsrc/appmain.c index 7b56690c7..3a86b0eaa 100644 --- a/armsrc/appmain.c +++ b/armsrc/appmain.c @@ -1143,7 +1143,7 @@ static bool QCTestPM5(uint8_t *failed_item, uint32_t timeout_ms) { // 蜂鸣器 (PB13 使能, PC9 = TMR8_CH4 调制) 由通用 buzzer 模块驱动 BuzzerSetup(); - LEDsoff(); // 在开始测试之前线关闭所有LED + LEDsoff(); // 在开始测试之前先关闭所有LED *failed_item = 2; // 在开始测试之前,如果按钮是按下的,则认为失败,有可能按钮不良卡住了 @@ -1224,6 +1224,59 @@ out: return result; } +static int8_t QCTestPM5IO(uint16_t index, uint8_t status) { + // !!! No one is allowed to modify the definition and order of this list except DXL. + // Otherwise, the PM5 factory tester will fail to check. + struct qc_io_map { + crm_periph_clock_type gpio_clk; + gpio_type *gpio_group; + uint16_t gpio_pin; + } const qc_io_map[] = { + {.gpio_clk = CRM_GPIOA_PERIPH_CLOCK, .gpio_group = GPIOA, .gpio_pin = GPIO_PINS_14}, // SIGIN1-5x2P-SWD-CLK + {.gpio_clk = CRM_GPIOA_PERIPH_CLOCK, .gpio_group = GPIOA, .gpio_pin = GPIO_PINS_13}, // SIGIN2-5x2P-SWD-DIO + {.gpio_clk = CRM_GPIOA_PERIPH_CLOCK, .gpio_group = GPIOA, .gpio_pin = GPIO_PINS_3}, // SIGIN3-5x2P-UART_RX + {.gpio_clk = CRM_GPIOA_PERIPH_CLOCK, .gpio_group = GPIOA, .gpio_pin = GPIO_PINS_2}, // SIGIN4-5x2P-UART_TX + {.gpio_clk = CRM_GPIOA_PERIPH_CLOCK, .gpio_group = GPIOA, .gpio_pin = GPIO_PINS_7}, // SIGIN5-CEP-USB_RXP(MOSI) + {.gpio_clk = CRM_GPIOA_PERIPH_CLOCK, .gpio_group = GPIOA, .gpio_pin = GPIO_PINS_6}, // SIGIN6-CEP-USB_RXN(MISO) + {.gpio_clk = CRM_GPIOA_PERIPH_CLOCK, .gpio_group = GPIOA, .gpio_pin = GPIO_PINS_9}, // SIGIN7-CEP-USB_SBU(UART-1-line) + {.gpio_clk = CRM_GPIOA_PERIPH_CLOCK, .gpio_group = GPIOA, .gpio_pin = GPIO_PINS_11}, // SIGIN8-CEP-USB_DN + {.gpio_clk = CRM_GPIOA_PERIPH_CLOCK, .gpio_group = GPIOA, .gpio_pin = GPIO_PINS_4}, // SIGIN9-CEP-USB_TXP(CSN) + {.gpio_clk = CRM_GPIOA_PERIPH_CLOCK, .gpio_group = GPIOA, .gpio_pin = GPIO_PINS_12}, // SIGIN10-CEP-USB_DP + {.gpio_clk = CRM_GPIOA_PERIPH_CLOCK, .gpio_group = GPIOA, .gpio_pin = GPIO_PINS_5}, // SIGIN11-CEP-USB_TXN(CLK) + }; + if (index >= ARRAYLEN(qc_io_map)) { + return PM3_EINVARG; + } + // For RXP/RXN/TXP/TXN + gpio_inter_usb_spi_role_setup(); + Gpio_Inter_USB_SPI_Role_High(); + // Enable the clock for the GPIO port and configure the pin as output + crm_periph_clock_enable(qc_io_map[index].gpio_clk, TRUE); + // Configure the GPIO pin as output or input based on the status parameter + gpio_init_type gpio_init_struct; + gpio_default_para_init(&gpio_init_struct); + gpio_init_struct.gpio_pins = qc_io_map[index].gpio_pin; + gpio_init_struct.gpio_mode = GPIO_MODE_OUTPUT; + // Set the GPIO pin state or RESET to default based on the status parameter( -> Preset <- ) + if (status == 0) { + gpio_bits_reset(qc_io_map[index].gpio_group, qc_io_map[index].gpio_pin); + } else if (status == 1) { + gpio_bits_set(qc_io_map[index].gpio_group, qc_io_map[index].gpio_pin); + } else { + // Reset to Default state or MUX + if (index == 0 || index == 1) { + // SIGIN1-SWD-CLK or SIGIN2-SWD-DIO + gpio_init_struct.gpio_mode = GPIO_MODE_MUX; + gpio_init_struct.gpio_pull = index == 0 ? GPIO_PULL_DOWN : GPIO_PULL_UP; + gpio_pin_mux_config(qc_io_map[index].gpio_group, qc_io_map[index].gpio_pin, GPIO_MUX_0); + } else { + gpio_init_struct.gpio_mode = GPIO_MODE_INPUT; + } + } + gpio_init(qc_io_map[index].gpio_group, &gpio_init_struct); + return PM3_SUCCESS; +} + #endif // static, not on the stack: this is 512 bytes and PacketReceived is already deep @@ -3876,6 +3929,23 @@ static void PacketReceived(PacketCommandNG *packet) { reply_ng(CMD_PM5_QC_TEST_HW, QCTestPM5(&failed_item, timeout_ms) ? PM3_SUCCESS : PM3_EFAILED, &failed_item, 1); break; } + case CMD_PM5_QC_TEST_IO: { + struct p { + uint32_t pwd; // 0xDEADBEEF + uint16_t index; // index of the IO to test + uint8_t status; // 0 = low, 1 = high, 2 = float or RESET TO DEFAULT + } PACKED; + struct p *payload = (struct p *)packet->data.asBytes; + // !!! IMPORTANT !!! + // This password must not be written in the client software. + // Users should never use this command without knowing its purpose, otherwise it may damage the device. + if (payload->pwd != 0xDEADBEEF) { + reply_ng(CMD_PM5_QC_TEST_IO, PM3_EFAILED, NULL, 0); + break; + } + reply_ng(CMD_PM5_QC_TEST_IO, QCTestPM5IO(payload->index, payload->status), NULL, 0); + break; + } case CMD_PM5_RGB_SET: { // Set the antenna RGB LED colour (used by `hf/lf tune --rgb`). struct p { diff --git a/client/src/cmdhw.c b/client/src/cmdhw.c index a222d1c8a..062cbd815 100644 --- a/client/src/cmdhw.c +++ b/client/src/cmdhw.c @@ -2267,19 +2267,95 @@ static int CmdPM5QCTest(const char *Cmd) { CLIParserContext *ctx; CLIParserInit(&ctx, "hw qc_pm5", "QC Test for the PM5", - "hw qc_pm5 -> run QC test with default 20 second timeout\n" - "hw qc_pm5 -t 3 -> run QC test with a 3 second timeout"); + "hw qc_pm5 -> run hardware QC test with default 20 second timeout\n" + "hw qc_pm5 -t 3 -> run hardware QC test with a 3 second timeout\n" + "hw qc_pm5 --iolow --pwd -> drive PM5 test IO low\n" + "hw qc_pm5 --iohigh --pwd -> drive PM5 test IO high\n" + "hw qc_pm5 --ioreset --pwd -> reset PM5 test IO to default"); void *argtable[] = { arg_param_begin, arg_u64_0("t", "timeout", "", "test sequence timeout in seconds (default 20)"), + arg_u64_0(NULL, "iolow", "", "drive PM5 test IO low"), + arg_u64_0(NULL, "iohigh", "", "drive PM5 test IO high"), + arg_u64_0(NULL, "ioreset", "", "reset PM5 test IO to default"), + arg_str0(NULL, "pwd", "", "QC test password in hex (required for IO tests)"), arg_param_end }; CLIExecWithReturn(ctx, Cmd, argtable, true); + uint32_t timeout_ms = arg_get_u32_def(ctx, 1, 20); timeout_ms *= 1000; + + bool io_low = arg_get_u64_count(ctx, 2) > 0; + bool io_high = arg_get_u64_count(ctx, 3) > 0; + bool io_reset = arg_get_u64_count(ctx, 4) > 0; + int io_count = (io_low ? 1 : 0) + (io_high ? 1 : 0) + (io_reset ? 1 : 0); + + uint16_t io_index = 0; + uint8_t io_status = 0; + if (io_low) { + io_index = (uint16_t)arg_get_u32(ctx, 2); + io_status = 0; + } else if (io_high) { + io_index = (uint16_t)arg_get_u32(ctx, 3); + io_status = 1; + } else if (io_reset) { + io_index = (uint16_t)arg_get_u32(ctx, 4); + io_status = 2; + } + + uint8_t pwd[4]; + int dlen = 0; + int res = CLIParamHexToBuf(arg_get_str(ctx, 5), pwd, sizeof(pwd), &dlen); CLIParserFree(ctx); + if (io_count > 1) { + PrintAndLogEx(ERR, "only one of --iolow, --iohigh, --ioreset may be specified"); + return PM3_EINVARG; + } + + if (io_count == 1) { + if (res || dlen != sizeof(pwd)) { + PrintAndLogEx(ERR, "invalid password format, must be hex(8 chars)"); + return PM3_EINVARG; + } + + PrintAndLogEx(WARNING, _RED_("!!! WARNING: PM5 IO QC test drives the test IO pins directly !!!")); + PrintAndLogEx(WARNING, _RED_("!!! This can damage the device if used incorrectly !!!")); + PrintAndLogEx(WARNING, _RED_("!!! Only proceed if you know exactly what you are doing !!!")); + PrintAndLogEx(INFO, "PM5 IO QC test password: 0x%02X%02X%02X%02X", pwd[0], pwd[1], pwd[2], pwd[3]); + + struct { + uint32_t pwd; // QC password, verified by the device + uint16_t index; // index of the IO to test + uint8_t status; // 0 = low, 1 = high, 2 = float or RESET TO DEFAULT + } PACKED payload = { + .pwd = BYTES2UINT32_BE(pwd), + .index = io_index, + .status = io_status, + }; + + PrintAndLogEx(INFO, "Performing PM5 IO QC test (index %u, status %u)...", io_index, io_status); + + clearCommandBuffer(); + SendCommandNG(CMD_PM5_QC_TEST_IO, (uint8_t *)&payload, sizeof(payload)); + + PacketResponseNG resp; + if (WaitForResponseTimeout(CMD_PM5_QC_TEST_IO, &resp, 1000) == false) { + SendCommandNG(CMD_BREAK_LOOP, NULL, 0); + PrintAndLogEx(WARNING, "command execution time out"); + return PM3_ETIMEOUT; + } + + if (resp.status != PM3_SUCCESS) { + PrintAndLogEx(ERR, "failed to perform IO QC test on PM5 (wrong password?)"); + return resp.status; + } + PrintAndLogEx(INFO, "PM5 IO QC test successful."); + return PM3_SUCCESS; + } + if (timeout_ms == 0) { PrintAndLogEx(ERR, "timeout must be greater than zero"); return PM3_EINVARG; @@ -2594,7 +2670,7 @@ static command_t CommandTable[] = { {"fpga", CmdFPGA, IfPm3Present, "Fpga commands"}, {"fpgaoff", CmdFPGAOff, IfPm3Present, "Turn off FPGA on device"}, {"ant_pm5", CmdPM5Ant, IfPm5StdAnt, "Control the antennal of pm5"}, - {"qc_pm5", CmdPM5QCTest, IfPm5, "Perform QC test for the PM5"}, + {"qc_pm5", CmdPM5QCTest, IfPm5, "Perform QC test (hardware or IO) for the PM5"}, {"factorydata", CmdDeviceFactoryData, IfI2cEeprom, "Get/Set the factory data for Device"}, {"lcd", CmdLCD, IfPm3Lcd, "Send command/data to LCD"}, {"lcdreset", CmdLCDReset, IfPm3Lcd, "Hardware reset LCD"}, diff --git a/include/pm3_cmd.h b/include/pm3_cmd.h index fdbd2c07b..e1029c8cc 100644 --- a/include/pm3_cmd.h +++ b/include/pm3_cmd.h @@ -874,6 +874,7 @@ typedef struct { #define CMD_EEPROM_FACTORY_INFO_READ 0x0172 #define CMD_EEPROM_FACTORY_INFO_WRITE 0x0173 // PM5, QC test for the hardware +#define CMD_PM5_QC_TEST_IO 0x0176 #define CMD_PM5_QC_TEST_HW 0x0177 // PM5, set the antenna RGB LED colour (payload: r,g,b). Used by `hf/lf tune --rgb`. #define CMD_PM5_RGB_SET 0x0178