fix: 修正cpg10_electrodes指令
This commit is contained in:
+32
-21
@@ -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);
|
||||
|
||||
Reference in New Issue
Block a user