fix: 修正cpg10_electrodes指令

This commit is contained in:
Roy_01
2024-07-09 11:58:49 +08:00
parent b072f22ede
commit 3fd1dfd904
+32 -21
View File
@@ -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);