diff --git a/cpg10_dev_mode.c b/cpg10_dev_mode.c index 8e4616c..93d5d0e 100644 --- a/cpg10_dev_mode.c +++ b/cpg10_dev_mode.c @@ -1,4 +1,5 @@ #include "cpg10_dev_mode.h" +#include "tw1508.h" #include "nrf_gpio.h" #include "nrf_log.h" @@ -161,14 +162,14 @@ void dev_mode_gpio_function(uint8_t *ins) } } -#define ELECTRODES_A1HB1L 0 -#define ELECTRODES_A1LB1H 1 -#define ELECTRODES_A2HB2L 2 -#define ELECTRODES_A2LB2H 3 -#define ELECTRODES_A3HB3L 4 -#define ELECTRODES_A3LB3H 5 -#define ELECTRODES_A4HB4L 6 -#define ELECTRODES_A4LB4H 7 +#define ELECTRODES_A1HB1L 1 +#define ELECTRODES_A1LB1H 2 +#define ELECTRODES_A2HB2L 3 +#define ELECTRODES_A2LB2H 4 +#define ELECTRODES_A3HB3L 5 +#define ELECTRODES_A3LB3H 6 +#define ELECTRODES_A4HB4L 7 +#define ELECTRODES_A4LB4H 8 static void cpg10_electrodes(uint32_t electrodes_mode) { switch (electrodes_mode) @@ -233,18 +234,29 @@ static void cpg10_electrodes(uint32_t electrodes_mode) /* dev_mode_set_cpg10_electrodes - (1)0x3000FF90nn - -func: dev_mode_set_cpg10_electrodes - -nn: electrodes mode 01h-09h - 01h: ELECTRODES_A1HB1L - 02h: ELECTRODES_A1HB1L - 03h: ELECTRODES_A1LB1H - 04h: ELECTRODES_A2HB2L - 05h: ELECTRODES_A2LB2H - 06h: ELECTRODES_A3HB3L - 07h: ELECTRODES_A3LB3H - 08h: ELECTRODES_A4HB4L - 09h: ELECTRODES_A4LB4H + (1)0x3000FF9001 + -func: ELECTRODES_A1HB1L + + (2)0x3000FF9002 + -func: ELECTRODES_A1LB1H + + (3)0x3000FF9003 + -func: ELECTRODES_A2HB2L + + (4)0x3000FF9004 + -func: ELECTRODES_A2LB2H + + (5)0x3000FF9005 + -func: ELECTRODES_A3HB3L + + (6)0x3000FF9006 + -func: ELECTRODES_A3LB3H + + (7)0x3000FF9007 + -func: ELECTRODES_A4HB4L + + (8)0x3000FF9008 + -func: ELECTRODES_A4LB4H */ void dev_mode_set_cpg10_electrodes(uint8_t *ins) { @@ -255,7 +267,6 @@ void dev_mode_set_cpg10_electrodes(uint8_t *ins) uint16_t magic : 16; uint8_t dev_opcode; uint8_t electrodes_opcode; - uint8_t param[]; } *p_ins = (void *)ins; cpg10_electrodes(p_ins->electrodes_opcode);