Docs: update gitignore

.gitignore

@@ -1 +1,4 @@
 simplelink/ble_sdk_2_02_02_25/examples/
+simplelink/ble_sdk_2_02_02_25/src/common/cc26xx/ccs/
+simplelink/ble_sdk_2_02_02_25/src/components/npi/src/
+.vscode

simplelink/ble_sdk_2_02_02_25/src/boards/BOOSTXL_CC2650MA/BOOSTXL_CC2650MA.h

@@ -50,7 +50,7 @@ extern "C" {
  *  ==========================================================================*/
 #include <ti/drivers/PIN.h>
 #include <driverlib/ioc.h>
-// #include "application_config/application_config.h"
+#include "application_config/application_config.h"
 
 /** ============================================================================
  *  Externs
@@ -166,14 +166,6 @@ extern const PIN_Config BoardGpioInitTable[];
 #define Board_SPI0_MOSI                Board_BP_SPI_MOSI
 #define Board_SPI0_CLK                 Board_BP_SPI_CLK
 #define Board_SPI0_CS                  Board_BP_SPI_CS_Wireless
-
-#define Board_SPI1_MISO                PIN_UNASSIGNED
-#define Board_SPI1_MOSI                PIN_UNASSIGNED
-#define Board_SPI1_CLK                 PIN_UNASSIGNED
-#define Board_SPI1_CS                  PIN_UNASSIGNED
-
-#define Board_I2C0_SCL0                PIN_UNASSIGNED 
-#define Board_I2C0_SDA0                PIN_UNASSIGNED
 #else
 #define Board_SPI0_MISO                E_SPI0_MISO
 #define Board_SPI0_MOSI                E_SPI0_MOSI

simplelink/ble_sdk_2_02_02_25/src/examples/simple_peripheral/cc26xx/app/HAL/ADGS1412x9.h

@@ -0,0 +1,65 @@
+#ifndef ADGS1412X2_H
+#define ADGS1412X2_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+
+#define SIZE_OF_DAISY_CHAIN_COMMAND 2
+
+
+struct switch_series_data_t {
+    uint8_t device8_switch;
+    uint8_t device7_switch;
+    uint8_t device6_switch;
+    uint8_t device5_switch;
+    uint8_t device4_switch;
+    uint8_t device3_switch;
+    uint8_t device2_switch;
+    uint8_t device1_switch;
+}__attribute__((packed));
+
+
+enum ADGS1412_SWITCH_ENABLE_e {
+    ALL_OPEN    = 0x00,     // 0b00000000
+    SINGLE_S1   = 0x01,     // 0b00000001
+    SINGLE_S2   = 0x02,     // 0b00000010
+    S1_S2_ON    = 0x03,     // 0b00000011
+    SINGLE_S3   = 0x04,     // 0b00000100
+    S3_S1_ON    = 0x05,     // 0b00000101
+    S3_S2_ON    = 0x06,     // 0b00000110
+    S3_S2_S1_ON = 0x07,     // 0b00000111
+    SINGLE_S4   = 0x08,     // 0b00001000
+    S4_S1_ON    = 0x09,     // 0b00001001
+    S4_S2_ON    = 0x0A,     // 0b00001010
+    S4_S2_S1_ON = 0x0B,     // 0b00001011
+    S4_S3_ON    = 0x0C,     // 0b00001100
+    S4_S3_S1_ON = 0x0D,     // 0b00001101
+    S4_S3_S2_ON = 0x0E,     // 0b00001110
+    ALL_ON      = 0x0F,     // 0b00001111
+};
+
+
+enum ADGS1412_module_e {
+    ADGS1412_MODULE_U14 = 0,
+    ADGS1412_MODULE_U13,
+    ADGS1412_MODULE_U18,
+    ADGS1412_MODULE_U20, 
+    ADGS1412_MODULE_U26, 
+    ADGS1412_MODULE_U29, 
+    ADGS1412_MODULE_U22, 
+    ADGS1412_MODULE_U24, 
+
+    ADGS1412_MODULE_MAX, 
+};
+
+
+static struct switch_series_data_t switch_series_data_g = {0};
+
+int switch_ctrl(uint8_t switch_module_number, uint8_t enable_type);
+
+#ifdef __cplusplus
+}
+#endif
+#endif  

simplelink/ble_sdk_2_02_02_25/src/examples/simple_peripheral/cc26xx/app/HAL/ADGS1412x9_c.h

@@ -0,0 +1,107 @@
+#include "application_config/application_config.h"
+#include "HAL/cc2650_driver/spi_ctrl.h"
+#include "HAL/ADGS1412x9.h"
+
+
+static const uint8_t SPI_DAISY_CHAIN_COMMAND[2] = {0x25, 0x00};
+
+static int __switch_transfer(struct switch_series_data_t *sd) 
+{
+    spi1_close();
+    spi1_open(SPI_CLK_4M, POL0, PHA0);
+
+    pin_set(E_PIN_SWCSBB, 0);
+    spi1_write(NULL, (uint8_t *)(sd), 8);
+    pin_set(E_PIN_SWCSBB, 1);
+
+    return 0;
+}
+
+
+static int __switch_daisy_chain_mode() {
+    spi1_close();
+    spi1_open(SPI_CLK_4M, POL0, PHA0);
+
+    pin_set(E_PIN_SWCSBB, 0);
+    spi1_write(NULL, SPI_DAISY_CHAIN_COMMAND, 2);
+    pin_set(E_PIN_SWCSBB, 1);
+
+    return 0;
+}
+
+
+static int __set_switch_param(enum ADGS1412_module_e switch_module, enum ADGS1412_SWITCH_ENABLE_e enable_type, struct switch_series_data_t *switch_data) 
+{
+    struct switch_series_data_t *sd = switch_data;
+    enum ADGS1412_module_e sw_module =  switch_module;
+    enum ADGS1412_SWITCH_ENABLE_e en_type =  enable_type;
+
+    switch(sw_module) {
+        case ADGS1412_MODULE_U14:
+            sd->device8_switch = (uint8_t)en_type;
+            break;
+        
+        case ADGS1412_MODULE_U13:
+            sd->device7_switch = (uint8_t)en_type;
+            break;
+
+        case ADGS1412_MODULE_U18:
+            sd->device6_switch = (uint8_t)en_type;
+            break;
+        
+        case ADGS1412_MODULE_U20:
+            sd->device5_switch = (uint8_t)en_type;
+            break;
+
+        case ADGS1412_MODULE_U26:
+            sd->device4_switch = (uint8_t)en_type;
+            break;
+        
+        case ADGS1412_MODULE_U29:
+            sd->device3_switch = (uint8_t)en_type;
+            break;
+
+        case ADGS1412_MODULE_U22:
+            sd->device2_switch = (uint8_t)en_type;
+            break;
+        
+        case ADGS1412_MODULE_U24:
+            sd->device1_switch = (uint8_t)en_type;
+            break;    
+        case ADGS1412_MODULE_MAX:
+            *sd = (struct switch_series_data_t) {.device8_switch = (uint8_t)en_type,
+                                          .device7_switch = (uint8_t)en_type,
+                                          .device6_switch = (uint8_t)en_type,
+                                          .device5_switch = (uint8_t)en_type,
+                                          .device4_switch = (uint8_t)en_type,
+                                          .device3_switch = (uint8_t)en_type,
+                                          .device2_switch = (uint8_t)en_type,
+                                          .device1_switch = (uint8_t)en_type,
+                                          };
+            break;
+    }
+    return 0;
+}
+
+int switch_ctrl(uint8_t switch_module_number, uint8_t enable_type) 
+{
+
+    struct switch_series_data_t *sd = &switch_series_data_g;
+    enum ADGS1412_module_e sw_module = (enum ADGS1412_module_e) switch_module_number;
+    enum ADGS1412_SWITCH_ENABLE_e en_type = (enum ADGS1412_SWITCH_ENABLE_e) enable_type; 
+    
+    if(sw_module > ADGS1412_MODULE_MAX)
+        return -1;
+
+    if(en_type > ALL_ON)
+        return -2;
+
+    if (sw_module == ADGS1412_MODULE_U24 && en_type == S1_S2_ON)
+        return -3;
+
+    __switch_daisy_chain_mode();
+    __set_switch_param(sw_module, en_type, sd);
+    __switch_transfer(sd);
+    
+    return 0;
+}

simplelink/ble_sdk_2_02_02_25/src/examples/simple_peripheral/cc26xx/app/HAL/APA102_2020_256_8x4.h

@@ -0,0 +1,63 @@
+#ifndef APA102_2020_256_8X4_H
+#define APA102_2020_256_8X4_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif   
+
+#define LED_TANDEM_N  4
+
+enum led_series_nb_e {
+    LED_NB_1 = 0,
+    LED_NB_2,
+    LED_NB_3,
+    LED_NB_4,
+
+    LED_NB_MAX = LED_TANDEM_N,
+};
+
+enum led_bright_e {
+    LED_BR_LV0  = 0x00,
+    LED_BR_LV1  = 0x01,
+    LED_BR_LV8  = 0x08,
+
+    LED_BR_MAX  = 0x1F,
+};
+
+enum led_color_e {
+    LED_CLR_BLACK = 0,
+    LED_CLR_WHITE,
+    LED_CLR_RED,
+    LED_CLR_ORANGE,
+    LED_CLR_YELLOW,
+    LED_CLR_GREEN,
+    LED_CLR_CYAN,
+    LED_CLR_BLUE,
+    LED_CLR_PURPLE,
+    LED_CLR_MAGENTA,
+    LED_CLR_YELLOWGREEN,
+    LED_CLR_EMERALD,
+
+    LED_CLR_MAX,
+};
+
+struct led_color_t {
+    uint8_t b;
+    uint8_t g;
+    uint8_t r;    
+};
+
+struct led_frame_t {
+    uint8_t bright: 5,
+            rsvd: 3;
+    struct led_color_t color;
+};
+
+int led_color_set(enum led_series_nb_e led_nb, enum led_bright_e bright, enum led_color_e color);
+int led_color_code_set(enum led_series_nb_e led_nb, enum led_bright_e bright, struct led_color_t *color);
+int led_rainbow(enum led_bright_e bright);
+
+#ifdef __cplusplus
+}
+#endif
+#endif

simplelink/ble_sdk_2_02_02_25/src/examples/simple_peripheral/cc26xx/app/HAL/APA102_2020_256_8x4_c.h

@@ -0,0 +1,204 @@
+/*
+ *  APA-102-2020-256-8A-20190612: Series data structure
+ *    +-------------------+------------------------- ... -+-----------------+
+ *    |  start_frame(4B)  |  led_frame(4B) *LED_TANDEM_N  |  end_frame(4B)  |
+ *    +-------------------+------------------------- ... -+-----------------+
+ *                       /                \
+ *                     /   led_frame(4B)   \
+ *                   /                      \
+ *       0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
+ *      +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ *      | 111 | bright  |      blue     |     green     |      red      |
+ *      +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ */
+
+#include "application_config/application_config.h"
+#include "HAL/cc2650_driver/spi_ctrl.h"
+#include "HAL/APA102_2020_256_8x4.h"
+
+#define LED_FRME_FILL_RSVD(_f)      (_f)->rsvd = 0x07 // 0x11100000 || bright
+#define LED_SERIES_D_START          0x00000000
+#define LED_SERIES_D_END            0xFFFFFFFF
+
+struct led_series_data_t {
+    uint32_t f_start;
+    struct led_frame_t f_led[LED_TANDEM_N];
+    uint32_t f_end;
+};
+
+static struct led_series_data_t led_series_data_g = {0};
+
+const struct led_color_t led_color_list_g[LED_CLR_MAX] = {
+//  {blue, green, red}
+    {0x00, 0x00, 0x00},     // LED_CLR_BLACK
+    {0xFF, 0xFF, 0xCA},     // LED_CLR_WHITE
+    {0x00, 0x00, 0xFF},     // LED_CLR_RED
+    {0x09, 0x58, 0xFF},     // LED_CLR_ORANGE
+    {0x00, 0xE1, 0xE1},     // LED_CLR_YELLOW
+    {0x00, 0xFA, 0x00},     // LED_CLR_GREEN
+    {0x40, 0x40, 0x00},     // LED_CLR_CYAN
+    {0xAA, 0x00, 0x00},     // LED_CLR_BLUE
+    {0x6F, 0x00, 0x3A},     // LED_CLR_PURPLE
+    {0xFF, 0x00, 0xFF},     // LED_CLR_MAGENTA
+    {0x00, 0xA6, 0x64},     // LED_CLR_YELLOWGREEN
+    {0x78, 0xC8, 0x50},     // LED_CLR_EMERALD
+};
+
+static int __led_single_set(struct led_series_data_t *led_s_d, struct led_frame_t *led_f, enum led_series_nb_e led_nb)
+{
+    struct led_series_data_t *sd = led_s_d;
+    struct led_frame_t *f = led_f;
+    enum led_series_nb_e nb = led_nb;
+    
+    memcpy(&sd->f_led[nb], f, sizeof(struct led_frame_t));
+
+    return 0;
+}
+
+static int __led_multiple_set(struct led_series_data_t *led_s_d, struct led_frame_t *led_f)
+{
+    struct led_series_data_t *sd = led_s_d;
+    struct led_frame_t *f = led_f;
+    int i;
+    
+    /*
+     * use __led_single_set() to finish all led;
+     */
+    for (i = LED_NB_1; i < LED_NB_MAX; i++) {
+        __led_single_set(sd, f, (enum led_series_nb_e)i);
+    }
+    
+    return 0;
+}
+
+static int __led_complete(struct led_series_data_t *led_s_d)
+{
+    struct led_series_data_t *sd = led_s_d;
+    struct led_frame_t *f = sd->f_led;
+    int i;
+
+    for (i = LED_NB_1; i < LED_NB_MAX; i++) {
+        LED_FRME_FILL_RSVD(f);
+        f++;
+    }
+
+    sd->f_start = LED_SERIES_D_START;
+    sd->f_end   = LED_SERIES_D_END;
+    
+    return 0;
+}
+
+static int __led_color_set(enum led_series_nb_e led_nb, struct led_frame_t *led_f)
+{
+    enum led_series_nb_e nb = led_nb;
+    struct led_frame_t *f = led_f;
+    struct led_series_data_t *sd = &led_series_data_g;
+
+    if (f == NULL)
+        return -1;
+
+    /*
+     * nb -  < LED_NB_MAX: fill one led_frame
+     *      == LED_NB_MAX: fill multiple led_frame
+     *
+     * complete: then, fill (start_frame, end_frame and the rsvd of every led_frame)
+     *
+     * finally, write cmd to hw by spi
+     */
+    if (nb < LED_NB_MAX) {
+        __led_single_set(sd, f, nb);
+    } else if (nb == LED_NB_MAX) {
+        __led_multiple_set(sd, f);
+    } else {
+        return -2;
+    }
+
+    __led_complete(sd);
+    
+    spi0_write(NULL, (void *)(sd), sizeof(struct led_series_data_t));
+
+    return 0;
+}
+
+int led_color_set(enum led_series_nb_e led_nb, enum led_bright_e bright, enum led_color_e color)
+{
+    enum led_series_nb_e nb = led_nb;
+    enum led_bright_e b = bright;
+    enum led_color_e c = color;
+    struct led_frame_t led_f;
+    
+    if (nb > LED_NB_MAX)
+        return -1;
+
+    if (c >= LED_CLR_MAX)
+        return -2;
+    
+    if (b > LED_BR_MAX)
+        return -3;
+    
+    led_f.bright = b;
+    led_f.color = led_color_list_g[c];
+    __led_color_set(nb, &led_f);
+
+    return 0;
+}
+
+int led_color_code_set(enum led_series_nb_e led_nb, enum led_bright_e bright, struct led_color_t *color)
+{
+    enum led_series_nb_e nb = led_nb;
+    enum led_bright_e b = bright;
+    struct led_color_t *c = color;
+    struct led_frame_t led_f;
+    
+    // valid the input values
+    if (nb > LED_NB_MAX)
+        return -1;
+
+    if (b > LED_BR_MAX)
+        return -2;
+    
+    led_f.bright = b;
+    memcpy(&led_f.color, c, sizeof(struct led_color_t));
+
+    __led_color_set(nb, &led_f);
+
+    return 0;
+}
+
+int led_rainbow(enum led_bright_e bright)
+{
+    enum led_bright_e b = bright;
+    int i;
+    
+    if (b > LED_BR_MAX)
+        return -1;
+    
+    for(i=0; i<LED_NB_MAX; i++) {
+        led_color_set((enum led_series_nb_e)i, b, (enum led_color_e)i);
+    }
+    
+    return 0;
+}
+
+/*
+ * example -
+ *    customize color:
+ *        struct led_color_t led_c; 
+ *        uint8_t bri;
+ *                       // { ins,  ins,      num,    r,    g,    b,  bri};
+ *        uint8_t ins[20] = {0x30, 0x00, LED_NB_4, 0xFF, 0x00, 0x44,  0x3};  
+ *        led_c.r = ins[3];
+ *        led_c.g = ins[4];
+ *        led_c.b = ins[5];
+ *        bri = ins[6];   
+ *        led_color_code_set(LED_NB_4, bri, &led_c);
+ *
+ *    single led:
+ *        led_color_set(LED_NB_1, LED_BR_LV1, LED_CLR_WHITE);
+ * 
+ *    multiple led:
+ *        led_color_set(LED_NB_MAX, LED_BR_LV1, LED_CLR_BLUE);
+ * 
+ *    rainbow led:
+ *        led_rainbow(LED_BR_LV1);
+ */

simplelink/ble_sdk_2_02_02_25/src/examples/simple_peripheral/cc26xx/app/HAL/MAX5136x2.h

@@ -0,0 +1,61 @@
+#ifndef MAX5136X2_H
+#define MAX5136X2_H
+
+#ifdef  __cplusplus
+extern "C" {
+#endif
+
+#define REVERT_2_BYTE(_b)     ((_b) >> 8 | (((_b) & 0xFF) << 8))
+
+#define MAX5136_NUM_MAX 2
+#define SIZEOFDAC_SPI MAX5136_NUM_MAX*3
+
+#define CTRL_B_LDAC                 0x01
+#define CTRL_B_CLR                  0x02
+#define CTRL_B_POW_CTRL             0x03
+#define CTRL_B_LINEARITY            0x05
+#define CTRL_B_WRT(_d0, _d1)        (0x10 | ((_d1) << 1) | (_d0))
+#define CTRL_B_WRT_THR(_d0, _d1)    (0x30 | ((_d1) << 1) | (_d0))
+
+#define DATA_B_LDAC(_d0, _d1)           ((_d1) << 9 | (_d0) << 8)
+#define DATA_B_POW_CT(_d0, _d1, _rd)    ((_d1) << 9 | (_d0) << 8 | (_rd) << 7)
+#define DATA_B_LINE(_en)                ((_en) << 9)
+    
+#define DAC0_EN      1
+#define DAC0_DIS     0
+#define DAC1_EN      1
+#define DAC1_DIS     0
+
+
+
+
+
+enum MAX5136_num_e {
+    DAC_NB_0 = 0x00,
+    DAC_NB_1,
+    DAC_NB_MAX = 0x02,
+};
+
+
+
+
+struct dac_series_control_t 
+{
+    uint8_t dac0_enable;
+    uint8_t dac1_enable;
+    uint16_t volts;
+}__attribute__((packed));
+
+
+struct dac_series_control_t dac_series_control_g[MAX5136_NUM_MAX] = {0};
+
+
+
+//int dac_write_through_mode(uint8_t dac0_enable, uint8_t dac1_enable, uint16_t volts, struct dac_series_data_t *sd_dac);
+// int dac_series_control_clear();
+int dac_enable_all_output(struct dac_series_control_t *seriesPtr);
+int dac_enable_single_output(uint8_t dac0_enable, uint8_t dac1_enable, uint16_t volts, enum MAX5136_num_e dac_num);
+#ifdef __cplusplus
+}
+#endif
+#endif

simplelink/ble_sdk_2_02_02_25/src/examples/simple_peripheral/cc26xx/app/HAL/MAX5136x2_c.h

@@ -0,0 +1,120 @@
+/*
+ * MAX5136
+ *  CLR: Software clear.
+ *       0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 
+ *      +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ *      |0 0 0 0 0 0 1 0|x x x x x x x x|x x x x x x x x|
+ *      +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ * 
+ *  Write-through: Write to selected input and DAC registers, DAC outputs updated(writethrough).
+ *       0 1 2 3  4  5  6  7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 
+ *      +-+-+-+-+--+--+--+--+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ *      |0 0 1 1 D3 D2 D1 D0|         DAC data              |
+ *      +-+-+-+-+--+--+--+--+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ */
+#include "application_config/application_config.h"
+#include "HAL/cc2650_driver/spi_ctrl.h"
+#include "HAL/MAX5136x2.h"
+
+struct dac_series_data_t {
+    uint8_t control_bits;
+    uint16_t data_bits;
+}__attribute__((packed));
+
+
+static struct dac_series_data_t dac_series_data_g[MAX5136_NUM_MAX] = {0};
+
+
+static int __dac_transfer(struct dac_series_data_t *sd) 
+{
+    spi1_close();
+    spi1_open(SPI_CLK_4M, POL1, PHA0);
+
+    pin_set(E_PIN_DACCS, 0); 
+    spi1_write(NULL, (uint8_t *)(sd), SIZEOFDAC_SPI);
+    pin_set(E_PIN_DACCS, 1);
+    return 0; 
+}
+
+
+static int __dac_write_through_mode(uint8_t dac0_enable, uint8_t dac1_enable, uint16_t volts, struct dac_series_data_t *sd_dac)
+{
+    uint8_t d0 = dac0_enable;
+    uint8_t d1 = dac1_enable;
+    uint16_t v = volts;
+
+    struct dac_series_data_t *sd = sd_dac;
+
+    sd->control_bits = CTRL_B_WRT_THR(d0, d1);
+    sd->data_bits = REVERT_2_BYTE(v);
+    
+    
+    return 0;
+}
+
+
+static int dac_series_control_clear() {
+    for(int i = DAC_NB_0; i < DAC_NB_MAX; i++) {
+        dac_series_control_g[i].dac0_enable = 0;
+        dac_series_control_g[i].dac1_enable = 0;
+        dac_series_control_g[i].volts = 0;
+    }
+
+    return 0;
+}
+
+
+int dac_enable_all_output(struct dac_series_control_t *seriesPtr) 
+{
+    struct dac_series_data_t *sd = dac_series_data_g;
+
+    for(int i = DAC_NB_0; i < DAC_NB_MAX; i++) {
+        if (seriesPtr[i].dac0_enable || seriesPtr[i].dac1_enable) {
+            uint8_t dac0_en = seriesPtr[i].dac0_enable;
+            uint8_t dac1_en = seriesPtr[i].dac1_enable;
+            uint16_t v = seriesPtr[i].volts;
+            __dac_write_through_mode(dac0_en, dac1_en, v, (sd + i));
+        }
+    }
+
+    __dac_transfer(sd);
+
+    dac_series_control_clear();
+    return 0;
+}
+
+
+int dac_enable_single_output(uint8_t dac0_enable, uint8_t dac1_enable, uint16_t volts, enum MAX5136_num_e dac_num) {
+    uint8_t dac0_en = dac0_enable;
+    uint8_t dac1_en = dac1_enable;
+    uint16_t v = volts;
+    enum MAX5136_num_e dac_n = dac_num; 
+    struct dac_series_data_t *sd = dac_series_data_g;
+
+    if(dac_n >= DAC_NB_MAX)
+        return -1;
+
+    for(int i = DAC_NB_0; i < DAC_NB_MAX; i++) {
+        if(i == dac_n) 
+            __dac_write_through_mode(dac0_en, dac1_en, v, (sd+i));
+    }
+
+    return 0;
+}
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+

simplelink/ble_sdk_2_02_02_25/src/examples/simple_peripheral/cc26xx/app/HAL/MCP23008x2.h

@@ -0,0 +1,75 @@
+#ifndef MCP23008X2_H
+#define MCP23008X2_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+//i2c addr
+/************************************************************************************************
+ * .h
+ ************************************************************************************************/
+
+#define GET_INPUT_SW_SEN()      ((chip_MCP23008_rd_reg_stat(MCP23008_PB, MCP23008_REG_GPIO) & 0x40) >> 6)
+
+#define PUSH_KEY (GET_INPUT_SW_SEN() == 0)
+
+#define SET_VLOGIC_EN_GPIO(_v)      (chip_MCP23008_set(MCP23008_PB, MCP23008_REG_GPIO, MCP23008_P4, _v))
+#define SET_VLOGIC_EN_IODIR(_v)     (chip_MCP23008_set(MCP23008_PB, MCP23008_REG_IODIR, MCP23008_P4, _v))  
+#define SET_SW_EN_GPIO(_v)          (chip_MCP23008_set(MCP23008_PB, MCP23008_REG_GPIO, MCP23008_P5, _v))
+
+enum mcp23008_module_e {
+    MCP23008_PA = 0,
+    MCP23008_PB,
+
+    MCP23008_MODULE_MAX,
+};
+
+enum mcp23008_reg_name_e {
+    MCP23008_REG_IODIR = 0x00,      /*IODIR – I/O DIRECTION REGISTER (ADDR 0x00)*/
+    MCP23008_REG_IPOL,              /*IPOL – INPUT POLARITY PORT REGISTER (ADDR 0x01)*/
+    MCP23008_REG_GPINTEN,           /*GPINTEN – INTERRUPT-ON-CHANGE PINS (ADDR 0x02)*/
+    MCP23008_REG_DEFVAL,            /*DEFVAL – DEFAULT VALUE REGISTER (ADDR 0x03)*/
+    MCP23008_REG_INTCON,            /*INTCON – INTERRUPT-ON-CHANGE CONTROL REGISTER (ADDR 0x04)*/
+    MCP23008_REG_IOCON,             /*IOCON – I/O EXPANDER CONFIGURATION REGISTER (ADDR 0x05)*/
+    MCP23008_REG_GPPU,              /*GPPU – GPIO PULL-UP RESISTOR REGISTER (ADDR 0x06)*/
+    MCP23008_REG_INTF,              /*INTF – INTERRUPT FLAG REGISTER (ADDR 0x07)*/
+    MCP23008_REG_INTCAP,            /*INTCAP – INTERRUPT CAPTURED VALUE FOR PORT REGISTER (ADDR 0x08)*/
+    MCP23008_REG_GPIO,              /*GPIO – GENERAL PURPOSE I/O PORT REGISTER (ADDR 0x09)*/
+    MCP23008_REG_OLAT,              /*OLAT – OUTPUT LATCH REGISTER 0 (ADDR 0x0A)*/
+    
+    MCP23008_REG_MAX,
+};
+
+enum mcp23008_gpio_e {
+    MCP23008_P0 = 0,
+    MCP23008_P1,
+    MCP23008_P2,
+    MCP23008_P3,
+    MCP23008_P4,
+    MCP23008_P5,
+    MCP23008_P6,
+    MCP23008_P7,
+    
+    MCP23008_PIN_ALL,
+};
+
+struct mcp23008_reg_name_t {
+    uint8_t iodir;
+    uint8_t gpio;
+};
+
+struct mcp23008_set_para_t {
+    enum mcp23008_module_e chip_module;
+    enum mcp23008_reg_name_e reg_addr; 
+    uint8_t val;
+};
+
+int chip_MCP23008_set(enum mcp23008_module_e i2c_module, enum mcp23008_reg_name_e reg_address, enum mcp23008_gpio_e wt_bit, uint8_t value);
+uint8_t chip_MCP23008_rd_reg_stat(enum mcp23008_module_e i2c_module, enum mcp23008_reg_name_e reg_address);
+
+
+#ifdef __cplusplus
+}
+#endif
+#endif  

simplelink/ble_sdk_2_02_02_25/src/examples/simple_peripheral/cc26xx/app/HAL/MCP23008x2_c.h

@@ -0,0 +1,205 @@
+/*
+ *  MCP23008: Series data structure
+ *  I2C
+ *   -Write:
+ *    +---------------------+------------------------+-------------+
+ *    |  Device Opcode(1B)  |  Register Address(1B)  |  Value(1B)  |
+ *    +---------------------+------------------------+-------------+
+ *      /                \
+ *     / Device Opcode(1B)\
+ *    /                    \
+ *     0 1 2 3 4  5  6   7  
+ *    +-+-+-+-+--+--+--+---+
+ *    | 0100  |A2 A1 A0 R/W|
+ *    +-+-+-+-+--+--+--+---+
+ *    ps.CC2650 I2C parameter:I2C_addr、tx、txlen、rxlen,
+ *       I2C_addr = 0b 0 1 0 0 A2 A1 A0
+ *       tx = Register Address + Value
+ *       txlen=2
+ *       rxlen=1
+ * 
+ * 
+ *   -Read:
+ *    +---------------------+------------------------+
+ *    |  Device Opcode(1B)  |  Register Address(1B)  |
+ *    +---------------------+------------------------+
+ *      /                \
+ *     / Device Opcode(1B)\
+ *    /                    \
+ *     0 1 2 3 4  5  6   7  
+ *    +-+-+-+-+--+--+--+---+
+ *    | 0100  |A2 A1 A0 R/W|
+ *    +-+-+-+-+--+--+--+---+
+ *    ps.CC2650 I2C parameter:I2C_addr、tx、txlen、rxlen,
+ *       I2C_addr = 0b 0 1 0 0 A2 A1 A0
+ *       tx = Register Address
+ *       txlen=1
+ *       rxlen=1
+ *        
+ */
+
+#include "HAL/cc2650_driver/i2c_ctrl.h"
+#include "HAL/MCP23008x2.h"
+
+#define MCP23008_WT_BIT     0
+#define MCP23008_RD_BIT     1
+
+static uint8_t module_addr_g[MCP23008_MODULE_MAX] = {
+    0x4C,   // MCP23008_PA
+    0x46,   // MCP23008_PB
+};
+
+static struct mcp23008_reg_name_t mcp23008_reg_name_g[MCP23008_MODULE_MAX] = {0};
+
+static uint8_t __mcp23008_reg_value_get(struct mcp23008_set_para_t *mcp23008_ctrl_para)
+{
+    struct mcp23008_set_para_t *para = mcp23008_ctrl_para;
+    struct mcp23008_reg_name_t *p;
+    uint8_t ret;
+
+    p = mcp23008_reg_name_g + para->chip_module;
+
+    switch(para->reg_addr) {
+        case MCP23008_REG_GPIO:
+            ret = p->gpio;
+            break;
+
+        case MCP23008_REG_IODIR:
+            ret = p->iodir;
+            break;
+
+        default:
+            ret = 0;
+            break;
+    }
+
+    return ret;
+}
+
+
+static void __mcp23008_reg_value_set(struct mcp23008_set_para_t *mcp23008_ctrl_para)
+{
+    struct mcp23008_set_para_t *para = mcp23008_ctrl_para;
+    struct mcp23008_reg_name_t *p;
+
+    p = mcp23008_reg_name_g + para->chip_module;
+
+    switch(para->reg_addr) {
+        case MCP23008_REG_GPIO:
+            p->gpio = para->val;
+            break;
+
+        case MCP23008_REG_IODIR:
+            p->iodir = para->val;
+            break;
+
+        default:
+            break;
+    }
+        
+    return;
+}
+
+
+static int __chip_MCP23008_i2c_write(struct mcp23008_set_para_t *mcp23008_ctrl_para)
+{
+    struct mcp23008_set_para_t *para = mcp23008_ctrl_para;
+    struct i2c_para_t i2c_send;
+    struct i2c_para_t *send = &i2c_send;
+    int ret;
+
+    send->i2c_txlen = 2;
+    send->i2c_rxlen = 1;
+    send->i2c_addr = module_addr_g[para->chip_module] | MCP23008_WT_BIT;
+    memcpy(send->i2c_tx, &para->reg_addr, 1);
+    memcpy(&send->i2c_tx[1], &para->val, 1);
+
+    ret = i2c0_write(send);
+
+    return ret;
+}
+
+static uint8_t __chip_MCP23008_i2c_read(struct mcp23008_set_para_t *mcp23008_ctrl_para)
+{
+    struct mcp23008_set_para_t *para = mcp23008_ctrl_para;
+    struct i2c_para_t i2c_read;
+    struct i2c_para_t *read = &i2c_read;
+
+    read->i2c_txlen = 1;
+    read->i2c_rxlen = 1;
+    read->i2c_addr = module_addr_g[para->chip_module] | MCP23008_RD_BIT;
+    memcpy(read->i2c_tx, &para->reg_addr, 1);
+    
+    if (i2c0_write(read) == 0) {
+        para->val = read->i2c_rx[0];
+       return 0;
+    }
+        
+    return 1;
+}
+
+
+int chip_MCP23008_set(enum mcp23008_module_e i2c_module, enum mcp23008_reg_name_e reg_address, enum mcp23008_gpio_e wt_bit, uint8_t value)
+{
+    struct mcp23008_set_para_t mcp23008_ctrl_para;
+    struct mcp23008_set_para_t *para = &mcp23008_ctrl_para;
+    enum mcp23008_module_e modul = i2c_module;
+    enum mcp23008_reg_name_e reg = reg_address;              // for current version, it selects IODIR or GPIO
+    enum mcp23008_gpio_e wt_b = wt_bit;                      //  
+    uint8_t v = value;
+    uint8_t set_val = 0;
+    
+    if (modul >= MCP23008_MODULE_MAX)
+        return -1;
+    
+    if (reg >= MCP23008_REG_MAX)
+        return -2;
+    
+    if (wt_b > MCP23008_PIN_ALL)
+        return -3;
+        
+    if (wt_b < MCP23008_PIN_ALL && v > 1)
+        return -4;
+
+    para->chip_module = modul;
+    para->reg_addr = reg;
+    para->val = v;
+    
+    if (wt_b < MCP23008_PIN_ALL) {
+        set_val = __mcp23008_reg_value_get(para);
+        set_val &= ~(1 << wt_b);
+        set_val |= v << wt_b;
+        para->val = set_val;
+    }
+
+    if (__chip_MCP23008_i2c_write(para) == 0) {
+        __mcp23008_reg_value_set(para);
+        return 0;
+    }
+    
+    return -1;
+}
+
+
+uint8_t chip_MCP23008_rd_reg_stat(enum mcp23008_module_e i2c_module, enum mcp23008_reg_name_e reg_address)
+{
+    struct mcp23008_set_para_t mcp23008_ctrl_para;
+    struct mcp23008_set_para_t *para = &mcp23008_ctrl_para;
+    enum mcp23008_module_e modul = i2c_module;
+    enum mcp23008_reg_name_e reg = reg_address;
+
+    if (modul >= MCP23008_MODULE_MAX)
+        return 0;
+    
+    if (reg >= MCP23008_REG_MAX)
+        return 0;
+
+    para->chip_module = modul;
+    para->reg_addr = reg;
+
+    __chip_MCP23008_i2c_read(para);
+
+    return para->val;
+}
+
+

simplelink/ble_sdk_2_02_02_25/src/examples/simple_peripheral/cc26xx/app/HAL/cc2650_driver/i2c_ctrl.h

@@ -0,0 +1,25 @@
+#ifndef I2C_CTRL_H
+#define I2C_CTRL_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#define I2C_100K    0
+#define I2C_400K    1
+
+struct i2c_para_t {
+    uint8_t i2c_addr;
+    uint8_t i2c_txlen;
+    uint8_t i2c_rxlen;
+    uint8_t i2c_tx[256];
+    uint8_t i2c_rx[256];
+};
+
+int i2c0_open(uint8_t bitRate);
+int i2c0_write(struct i2c_para_t *i2c_para);
+
+#ifdef __cplusplus
+}
+#endif
+#endif

simplelink/ble_sdk_2_02_02_25/src/examples/simple_peripheral/cc26xx/app/HAL/cc2650_driver/i2c_ctrl_c.h

@@ -0,0 +1,53 @@
+#include <Board.h>
+#include <ti/drivers/I2C.h>
+#include "HAL/cc2650_driver/i2c_ctrl.h"
+
+/* system use I2C parameters */
+static I2C_Handle I2Chandle0 = NULL;
+static I2C_Params I2CParams0;
+
+/* Open the I2C driver */
+int i2c0_open(uint8_t speed)
+{
+    //ret=0 -> success
+    //   =1 -> already exists
+    //   =2 -> open fail
+    uint8_t s = speed;
+    I2C_BitRate rate; 
+
+    if (I2Chandle0 != NULL)
+        return 1;
+
+    if (s == I2C_100K)
+        rate = I2C_100kHz;
+    else
+        rate = I2C_400kHz;
+
+    /*  Configure I2C */
+    Board_initI2C();
+    I2C_Params_init(&I2CParams0);
+    I2CParams0.bitRate = rate;
+
+    /* Attempt to open I2C. */
+    I2Chandle0 = I2C_open(Board_I2C0, &I2CParams0);
+
+    if (I2Chandle0 == NULL)
+        return 2;
+
+    return 0;
+}
+
+int i2c0_write(struct i2c_para_t *i2c_para)
+{
+    struct i2c_para_t *p = i2c_para;
+
+    I2C_Transaction I2C0Transaction;
+    
+    I2C0Transaction.writeCount   = p->i2c_txlen;
+    I2C0Transaction.writeBuf     = p->i2c_tx;
+    I2C0Transaction.readCount    = p->i2c_rxlen;
+    I2C0Transaction.readBuf      = p->i2c_rx;
+    I2C0Transaction.slaveAddress = p->i2c_addr>>1;
+
+    return I2C_transfer(I2Chandle0, &I2C0Transaction) ? 0 : -1;
+}

simplelink/ble_sdk_2_02_02_25/src/examples/simple_peripheral/cc26xx/app/HAL/cc2650_driver/spi_ctrl.h

@@ -0,0 +1,27 @@
+#ifndef SPI_CTRL_H
+#define SPI_CTRL_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif        
+
+#define POL0    0
+#define POL1    1
+#define PHA0    0
+#define PHA1    1
+
+#define SPI_CLK_10M     10000000
+#define SPI_CLK_4M      4000000
+
+int spi0_open(uint32_t bitRate, uint8_t polarity, uint8_t phase);
+void spi0_close(void);
+int spi0_write(uint8_t *rxBuf, uint8_t *txBuf, uint8_t len);
+
+int spi1_open(uint32_t bitRate, uint8_t polarity, uint8_t phase);
+void spi1_close(void);
+int spi1_write(uint8_t *rxBuf, uint8_t *txBuf, uint8_t len);
+
+#ifdef __cplusplus
+}
+#endif
+#endif

simplelink/ble_sdk_2_02_02_25/src/examples/simple_peripheral/cc26xx/app/HAL/cc2650_driver/spi_ctrl_c.h

@@ -0,0 +1,162 @@
+#include <Board.h>
+#include <ti/drivers/SPI.h>
+#include "HAL/cc2650_driver/spi_ctrl.h"
+/*
+SPI bit rate in Hz.
+
+Maximum bit rates supported by hardware:
+
++---------------+-----------------+------------------+
+| Device Family	| Slave Max (MHz) | Master Max (MHz) |
++---------------+-----------------+------------------+
+|   MSP432P4    |     16 MHz      |	     24 MHz      |
+|   MSP432E4    |     10 MHz      |      60 MHz      |
+| CC13XX/CC26XX	|      4 MHz      |      12 MHz      |
+|    CC32XX     |     20 MHz      |      20 MHz      |
++---------------+-----------------+------------------+
+Please note that depending on the specific use case, the driver may not support the hardware's maximum bit rate.
+*/
+
+/* system use SPI parameters */
+static SPI_Handle spiHandle0 = NULL;
+static SPI_Params spiParams0;
+
+static SPI_Handle spiHandle1 = NULL;
+static SPI_Params spiParams1;
+
+/* Open the RTOS SPI driver */
+int spi0_open(uint32_t bitRate, uint8_t polarity, uint8_t phase)
+{
+    //ret=0 -> success
+    //   =1 -> already exists
+    //   =2 -> open fail
+    uint32_t rate = bitRate;
+    uint8_t pol = polarity;
+    uint8_t pha = phase;
+    SPI_FrameFormat frameFormat;
+
+    if (spiHandle0 != NULL)
+        return 1;
+
+    if (pol == 0 && pha == 0)
+        frameFormat = SPI_POL0_PHA0;
+    else if (pol == 0 && pha == 1)
+        frameFormat = SPI_POL0_PHA1;
+    else if (pol == 1 && pha == 0)
+        frameFormat = SPI_POL1_PHA0;
+    else if (pol == 1 && pha == 1)
+        frameFormat = SPI_POL1_PHA1;
+
+    /*  Configure SPI as master */
+    Board_initSPI();
+    SPI_Params_init(&spiParams0);
+    spiParams0.bitRate = rate;
+    spiParams0.mode = SPI_MASTER;
+    spiParams0.dataSize = 8;
+    spiParams0.frameFormat = frameFormat;
+
+    /* Attempt to open SPI. */
+    spiHandle0 = SPI_open(Board_SPI0, &spiParams0);
+
+    if (spiHandle0 == NULL)
+        return 2;
+
+    return 0;
+}
+
+/* Close the RTOS SPI driver */
+void spi0_close(void)
+{
+    if (spiHandle0 != NULL)
+    {
+        SPI_close(spiHandle0);
+        spiHandle0 = NULL;
+    }
+
+    return;
+}
+
+int spi0_write(uint8_t *rxBuf, uint8_t *txBuf, uint8_t len)
+{
+    //ret=0 -> success
+    //   =1 -> fail
+
+    SPI_Transaction spi0Transaction;
+    spi0Transaction.count  = len;
+    spi0Transaction.txBuf  = txBuf;
+    spi0Transaction.arg    = NULL;
+    spi0Transaction.rxBuf  = NULL;
+
+    if (SPI_transfer(spiHandle0, &spi0Transaction) == FALSE) //TRUE->sucess, FALSE->fail
+        return 1;
+
+    return 0;
+}
+
+/* Open the RTOS SPI driver */
+int spi1_open(uint32_t bitRate, uint8_t polarity, uint8_t phase)
+{
+    //ret=0 -> success
+    //   =1 -> already exists
+    //   =2 -> open fail
+    uint32_t rate = bitRate;
+    uint8_t pol = polarity;
+    uint8_t pha = phase;
+    SPI_FrameFormat frameFormat;
+
+    if (spiHandle1 != NULL)
+        return 1;
+
+    if (pol == 0 && pha == 0)
+        frameFormat = SPI_POL0_PHA0;
+    else if (pol == 0 && pha == 1)
+        frameFormat = SPI_POL0_PHA1;
+    else if (pol == 1 && pha == 0)
+        frameFormat = SPI_POL1_PHA0;
+    else if (pol == 1 && pha == 1)
+        frameFormat = SPI_POL1_PHA1;
+    
+    /*  Configure SPI as master */
+    Board_initSPI();
+    SPI_Params_init(&spiParams1);
+    spiParams1.bitRate = rate;
+    spiParams1.mode = SPI_MASTER;
+    spiParams1.dataSize = 8;
+    spiParams1.frameFormat = frameFormat;
+
+    /* Attempt to open SPI. */
+    spiHandle1 = SPI_open(Board_SPI1, &spiParams1);
+
+    if (spiHandle1 == NULL)
+        return 2;
+
+    return spiHandle1 != NULL;
+}
+
+/* Close the RTOS SPI driver */
+void spi1_close(void)
+{
+    if (spiHandle1 != NULL)
+    {
+        SPI_close(spiHandle1);
+        spiHandle1 = NULL;
+    }
+
+    return;
+}
+
+int spi1_write(uint8_t *rxBuf, uint8_t *txBuf, uint8_t len)
+{
+    //ret=0 -> success
+    //   =1 -> fail
+
+    SPI_Transaction spi1Transaction;
+    spi1Transaction.count  = len;
+    spi1Transaction.txBuf  = txBuf;
+    spi1Transaction.arg    = NULL;
+    spi1Transaction.rxBuf  = rxBuf;
+    if (SPI_transfer(spiHandle1, &spi1Transaction) == FALSE) //TRUE->sucess, FALSE->fail
+        return 1;
+
+    return 0;
+}

simplelink/ble_sdk_2_02_02_25/src/examples/simple_peripheral/cc26xx/app/application/BAT_10_app.h

@@ -0,0 +1,6 @@
+
+
+
+
+
+

simplelink/ble_sdk_2_02_02_25/src/examples/simple_peripheral/cc26xx/app/application_config/BAT_10_conf.h

@@ -0,0 +1,92 @@
+#ifndef BAT_10_CONF_H
+#define BAT_10_CONF_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+/* --------------------
+ * define device name 
+ * ------------------*/
+#define DEVICE_NAME "Elite-BAT"
+#define MAJOR_PRODUCT_NUMBER    0
+#define MINOR_PRODUCT_NUMBER    3
+#define MAJOR_VERSION_NUMBER    1
+#define MINOR_VERSION_NUMBER    1
+
+
+/* ---------------------------
+ * define device buffer size
+ * -------------------------*/
+#define CUSTOM_GATT_LENGTH
+#define BLE_CIS_BUFF_SIZE   20
+#define BLE_INS_BUFF_SIZE   20
+#define BLE_DAT_BUFF_SIZE   40
+
+/* -------------------
+ * define device pin
+ * -----------------*/
+// Elite Pin Board
+#define E_PIN_LED_SPI_CLK   DIO5
+#define E_PIN_LED_SPI_SDI   DIO6
+#define E_PIN_ADCA0         DIO0
+#define E_PIN_ADCA1         DIO1
+#define E_PIN_ADCA2         DIO7
+#define E_PIN_SWCSBB        DIO2
+#define E_PIN_MEMCS         DIO3
+#define E_PIN_DIO4          DIO4
+#define E_PIN_I2C_SCK       DIO8
+#define E_PIN_I2C_SDA       DIO9
+#define E_PIN_DACCS         DIO10
+#define E_PIN_ADCCS         DIO11
+#define E_PIN_SCLK0         DIO12
+#define E_PIN_MOSI          DIO13
+#define E_PIN_MISO          DIO14
+
+// SPI & I2C Board
+#define E_SPI0_MISO         PIN_UNASSIGNED
+#define E_SPI0_MOSI         E_PIN_LED_SPI_SDI
+#define E_SPI0_CLK          E_PIN_LED_SPI_CLK
+#define E_SPI0_CS           PIN_UNASSIGNED
+
+#define E_SPI1_MISO         E_PIN_MISO
+#define E_SPI1_MOSI         E_PIN_MOSI
+#define E_SPI1_CLK          E_PIN_SCLK0
+#define E_SPI1_CS           PIN_UNASSIGNED
+
+#define E_I2C0_SCL0         E_PIN_I2C_SCK
+#define E_I2C0_SDA0         E_PIN_I2C_SDA
+
+// no use
+#define D0                  PIN_UNASSIGNED
+#define D1                  PIN_UNASSIGNED
+#define D2                  PIN_UNASSIGNED
+#define D3                  PIN_UNASSIGNED
+#define D4                  PIN_UNASSIGNED
+#define D5                  PIN_UNASSIGNED
+#define D6                  PIN_UNASSIGNED
+#define D7                  PIN_UNASSIGNED
+#define LOAD0               PIN_UNASSIGNED
+#define LOAD1               PIN_UNASSIGNED
+#define LOAD2               PIN_UNASSIGNED
+
+#define SHUT_DOWN           PIN_UNASSIGNED //switch_on
+#define HIGH_Z              LOAD0, PIN_UNASSIGNED
+#define CS_MEM              LOAD0, PIN_UNASSIGNED
+#define CS_ADC              LOAD0, PIN_UNASSIGNED
+#define CS_DAC              LOAD0, PIN_UNASSIGNED
+#define MEM_HOLD            LOAD1, PIN_UNASSIGNED
+#define P_10V_enable        LOAD1, PIN_UNASSIGNED
+#define P_5V_enable         LOAD1, PIN_UNASSIGNED
+#define I_MID_ON            LOAD2, PIN_UNASSIGNED
+#define I_LARGE_ON          LOAD2, PIN_UNASSIGNED
+#define V_SMALL_ON          LOAD2, PIN_UNASSIGNED
+#define V_MID_ON            LOAD2, PIN_UNASSIGNED
+#define I_SMALL_ON          LOAD2, PIN_UNASSIGNED
+#define OFF                 LOAD2, PIN_UNASSIGNED //6994
+#define VOUT_SMALL_ON       LOAD2, PIN_UNASSIGNED
+
+#ifdef __cplusplus
+}
+#endif
+#endif

simplelink/ble_sdk_2_02_02_25/src/examples/simple_peripheral/cc26xx/app/application_config/application_config.h

@@ -0,0 +1,159 @@
+
+#ifndef APPLICATION_CONFIG_H
+#define APPLICATION_CONFIG_H
+
+#ifdef  __cplusplus
+extern "C" {
+#endif
+
+// !!! define DEF_ELITE_MODEL first please !!!
+
+/*
+ *
+ * product number: MAJOR_PRODUCT_NUMBER, MINOR_PRODUCT_NUMBER, MAJOR_VERSION_NUMBER, MINOR_VERSION_NUMBER
+ * MAJOR_PRODUCT_NUMBER -> 0:Elite, 1:other serial
+ * Elite:
+ *      MINOR_PRODUCT_NUMBER -> 1:legacy, 2:EDC, 3:BAT, 4:EIS, 5:TRIG, 6:MEGAFLY
+ *
+ * |------------------+------------------------+----------------------+-------------------------+----------------+----------------------+----------------------+----------+
+ * |     hardware     |       model name       |   hw upper board     |    hw lower board       | product number |      device name     | data server lib name |    UI    |
+ * |------------------+------------------------+----------------------+-------------------------+----------------+----------------------+----------------------+----------+
+ * | Elite EDC1.4     | DEF_ELITE_EDC_14       | Elite1.4-re Jun.2019 | Elite1.4-re Jun. 2019   |   0, 2, 1, 5   | "Elite-EDC"          | Elite_EDC_1.4        | null     |
+ * | Elite EDC1.5     | DEF_ELITE_EDC_15       | Elite1.5 Dec. 2019   | Elite1.5 Dec. 2019      |   0, 2, 1, 6   | "Elite-EDC"          | Elite_EDC_1.5        | EliteEDC |
+ * | Elite EDC1.5re   | DEF_ELITE_EDC_15RE     | Elite1.5 Dec. 2019   | Elite1.5-re Jan. 2021   |   0, 2, 1, 7   | "Elite-EDC"          | Elite_EDC_1.5re      | EliteEDC |
+ * | Elite EDC1.5r2   | DEF_ELITE_EDC_15R2     | Elite1.5 Dec. 2019   | Elite1.5-r2 May. 2022   |   0, 2, 1, 8   | "Elite-EDC"          | Elite_EDC_1.5r2      | EliteEDC |
+ * | Elite BAT0.1     | DEF_ELITE_BAT_01       |             Elite2.0 Feb. 2022                 |   0, 3, 1, 0   | "Elite-BAT"          | Elite_BAT_0.1        | EliteEDC |
+ * | Elite BAT1.0     | DEF_ELITE_BAT_10       | BAT SMC V1.0 Aug.2022| BAT PWR V1.0 Aug. 2022  |   0, 3, 1, 1   | "Elite-BAT"          | Elite_BAT_1.0        | EliteEDC |
+ * | Elite EIS1.0     | DEF_ELITE_EIS_10       | Elite1.5 Dec. 2019   | Elite EIS1.0 Aug. 2020  |   0, 4, 1, 0   | "Elite-EIS"          | Elite_EIS_1.0        | EliteEIS |
+ * | Elite EIS1.1     | DEF_ELITE_EIS_11       | Elite1.5 Dec. 2019   | Elite EIS1.1 Feb. 2022  |   0, 4, 1, 1   | "Elite-EIS"          | Elite_EIS_1.1        | EliteEIS |
+ * | Elite EISmini1.0 | DEF_ELITE_EIS_MINI_10  |             EIS MINI May. 2022                 |   0, 4, 1, 2   | "Elite-EIS-MINI"     | Elite_EIS_MINI_1.0   | EliteEIS |
+ * | Elite TRIG0.1    | DEF_ELITE_TRIG_01      |            Elite TRIG01 Jan. 2021              |   0, 5, 1, 0   | "Elite-TRIG"         | Elite_TRIG_0.1       | EliteTrigger     |
+ * | Elite MEGAFLY0.1 | DEF_ELITE_MEGAFLY_01   | Elite1.5 Dec. 2019   | Elite Megafly Sep. 2020 |   0, 6, 1, 0   | "Elite-MEGAFLY"      | Elite_MEGAFLY_0.1    | null     |
+ * |-----------------+------------------------+----------------------+-------------------------+----------------+----------------------+----------------------+----------+
+ * ps.
+ *    model name is FW engineer defined
+ *    device name is used for controller
+ */
+
+
+#define DEF_ELITE_EDC_14        0
+#define DEF_ELITE_EDC_15        1
+#define DEF_ELITE_EDC_15RE      2
+#define DEF_ELITE_EDC_15R2      3
+#define DEF_ELITE_BAT_01        4
+#define DEF_ELITE_BAT_10        5
+#define DEF_ELITE_EIS_10        6
+#define DEF_ELITE_EIS_11        7
+#define DEF_ELITE_EIS_MINI_10   8
+#define DEF_ELITE_TRIG_01       9
+#define DEF_ELITE_MEGAFLY_01    10
+#define DEF_ELITE_MAX           11
+
+#define DEF_ELITE_MODEL    DEF_ELITE_BAT_10
+#ifndef DEF_ELITE_MODEL
+#error "DEF_ELITE_MODEL not defined"
+#endif
+
+// model information
+#if (DEF_ELITE_MODEL == DEF_ELITE_EDC_14)
+    #error "code no support"
+#elif (DEF_ELITE_MODEL == DEF_ELITE_EDC_15)
+    #error "code no support"
+#elif (DEF_ELITE_MODEL == DEF_ELITE_EDC_15RE)
+    #error "code no support"
+#elif (DEF_ELITE_MODEL == DEF_ELITE_EDC_15R2)
+    #error "code no support"
+#elif (DEF_ELITE_MODEL == DEF_ELITE_BAT_01)
+    #error "code no support"
+#elif (DEF_ELITE_MODEL == DEF_ELITE_BAT_10)
+    #include "BAT_10_conf.h"
+#elif (DEF_ELITE_MODEL == DEF_ELITE_EIS_10)
+    #error "code no support"
+#elif (DEF_ELITE_MODEL == DEF_ELITE_EIS_11)
+    #error "code no support"
+#elif (DEF_ELITE_MODEL == DEF_ELITE_EIS_MINI_10)
+    #error "code no support"
+#elif (DEF_ELITE_MODEL == DEF_ELITE_TRIG_01)
+    #error "code no support"
+#elif (DEF_ELITE_MODEL == DEF_ELITE_MEGAFLY_01)
+    #error "code no support"
+#else
+    #error "no this model"
+#endif
+
+
+// model information
+// #if (DEF_ELITE_MODEL == DEF_ELITE_EDC_14)
+//     #define DEVICE_NAME             "Elite-EDC"
+//     #define MAJOR_PRODUCT_NUMBER    0
+//     #define MINOR_PRODUCT_NUMBER    2
+//     #define MAJOR_VERSION_NUMBER    1
+//     #define MINOR_VERSION_NUMBER    5
+// #elif (DEF_ELITE_MODEL == DEF_ELITE_EDC_15)
+//     #define DEVICE_NAME             "Elite-EDC"
+//     #define MAJOR_PRODUCT_NUMBER    0
+//     #define MINOR_PRODUCT_NUMBER    2
+//     #define MAJOR_VERSION_NUMBER    1
+//     #define MINOR_VERSION_NUMBER    6
+// #elif (DEF_ELITE_MODEL == DEF_ELITE_EDC_15RE)
+//     #define DEVICE_NAME             "Elite-EDC"
+//     #define MAJOR_PRODUCT_NUMBER    0
+//     #define MINOR_PRODUCT_NUMBER    2
+//     #define MAJOR_VERSION_NUMBER    1
+//     #define MINOR_VERSION_NUMBER    7
+// #elif (DEF_ELITE_MODEL == DEF_ELITE_EDC_15R2)
+//     #define DEVICE_NAME             "Elite-EDC"
+//     #define MAJOR_PRODUCT_NUMBER    0
+//     #define MINOR_PRODUCT_NUMBER    2
+//     #define MAJOR_VERSION_NUMBER    1
+//     #define MINOR_VERSION_NUMBER    8
+// #elif (DEF_ELITE_MODEL == DEF_ELITE_BAT_01)
+//     #define DEVICE_NAME             "Elite-BAT"
+//     #define MAJOR_PRODUCT_NUMBER    0
+//     #define MINOR_PRODUCT_NUMBER    3
+//     #define MAJOR_VERSION_NUMBER    1
+//     #define MINOR_VERSION_NUMBER    0
+// #elif (DEF_ELITE_MODEL == DEF_ELITE_BAT_10)
+//     #define DEVICE_NAME             "Elite-BAT"
+//     #define MAJOR_PRODUCT_NUMBER    0
+//     #define MINOR_PRODUCT_NUMBER    3
+//     #define MAJOR_VERSION_NUMBER    1
+//     #define MINOR_VERSION_NUMBER    1
+// #elif (DEF_ELITE_MODEL == DEF_ELITE_EIS_10)
+//     #define DEVICE_NAME             "Elite-EIS"
+//     #define MAJOR_PRODUCT_NUMBER    0
+//     #define MINOR_PRODUCT_NUMBER    4
+//     #define MAJOR_VERSION_NUMBER    1
+//     #define MINOR_VERSION_NUMBER    0
+// #elif (DEF_ELITE_MODEL == DEF_ELITE_EIS_11)
+//     #define DEVICE_NAME             "Elite-EIS"
+//     #define MAJOR_PRODUCT_NUMBER    0
+//     #define MINOR_PRODUCT_NUMBER    4
+//     #define MAJOR_VERSION_NUMBER    1
+//     #define MINOR_VERSION_NUMBER    1
+// #elif (DEF_ELITE_MODEL == DEF_ELITE_EIS_MINI_10)
+//     #define DEVICE_NAME             "Elite-EIS"
+//     #define MAJOR_PRODUCT_NUMBER    0
+//     #define MINOR_PRODUCT_NUMBER    4
+//     #define MAJOR_VERSION_NUMBER    1
+//     #define MINOR_VERSION_NUMBER    2
+// #elif (DEF_ELITE_MODEL == DEF_ELITE_TRIG_01)
+//     #define DEVICE_NAME             "Elite-TRIG"
+//     #define MAJOR_PRODUCT_NUMBER    0
+//     #define MINOR_PRODUCT_NUMBER    5
+//     #define MAJOR_VERSION_NUMBER    1
+//     #define MINOR_VERSION_NUMBER    0
+// #elif (DEF_ELITE_MODEL == DEF_ELITE_MEGAFLY_01)
+//     #define DEVICE_NAME             "Elite-MEGAFLY"
+//     #define MAJOR_PRODUCT_NUMBER    0
+//     #define MINOR_PRODUCT_NUMBER    6
+//     #define MAJOR_VERSION_NUMBER    1
+//     #define MINOR_VERSION_NUMBER    0
+// #else
+//     #error "no this model"
+// #endif
+
+#ifdef  __cplusplus
+}
+#endif
+#endif

simplelink/ble_sdk_2_02_02_25/src/examples/simple_peripheral/cc26xx/app/headstage/Elite_version.h

@@ -0,0 +1,15 @@
+
+#ifndef VERSION_DATE
+#define VERSION_DATE
+
+#define VERSION_DATE_YEAR      23
+#define VERSION_DATE_MONTH     3
+#define VERSION_DATE_DAY       16
+#define VERSION_DATE_HOUR      13
+#define VERSION_DATE_MINUTE    40
+
+// this is NOT the version hash !!
+// it's the last version hash
+#define VERSION_HASH           8808490caa465cc94d14896de28763a5e5c4672b
+#define VERSION_GIT_BRANCH     Elite_OBJ_0.2mv
+#endif

simplelink/ble_sdk_2_02_02_25/src/examples/simple_peripheral/cc26xx/app/headstage/ins_decode_edc15re.h

@@ -0,0 +1,975 @@
+/*
+ *  Real instruction(RIS)
+ *     0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
+ *    +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ *    | 0011  |Mem  id|  Payload len  |         Payload  ...
+ *    +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ *      ... ...                                                       |
+ *    +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ *  Bytestream:
+ *      34 0C 01 61 A8 75 30 03 E8 12 43 21 03 E8
+ *      34 03 E1 01 03
+ *
+ *
+ *  Virtual instruction(VIS)
+ *     0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5
+ *    +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ *    | 1100  |Mem  id|   operation   |
+ *    +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ *  Bytestream:
+ *      C4 C0
+ *      C4 60
+ *
+ *
+ *  Control instruction(CIS)
+ *     0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5
+ *    +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ *    | 0111  |Mem  id|   operation   |
+ *    +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ *  Bytestream:
+ *      74 40
+ *      74 10
+ */
+
+ /*
+  *  RIS Payload
+  *    +----------------------------------+-------------------------------+
+  *    |              mode(1B)            | ... ...                       |
+  *    +----------------------------------+-------------------------------+
+  *    | CURVE_IV                  = 0x01 | ... ...                       |
+  *    | CURVE_IV_CY               = 0x02 | ... ...                       |
+  *    | CURVE_VO                  = 0x03 | ... ...                       |
+  *    | CURVE_RT                  = 0x04 | ... ...                       |
+  *    | CURVE_VT                  = 0x05 | ... ...                       |
+  *    | CURVE_IT                  = 0x06 | ... ...                       |
+  *    | CURVE_CC                  = 0x07 | ... ...                       |
+  *    | CURVE_OCP                 = 0x08 | ... ...                       |
+  *    | CURVE_CV                  = 0x09 | ... ...                       |
+  *    | CURVE_LSV                 = 0x0A | ... ...                       |
+  *    | CURVE_CA                  = 0x0B | ... ...                       |
+  *    | CURVE_PULSE               = 0x0C | ... ...                       |
+  *    | CURVE_UNI_PULSE           = 0x0D | ... ...                       |
+  *    | CURVE_DPV                 = 0x0E | ... ...                       |
+  *    | CURVE_DPV_SMPRATE         = 0x0F | ... ...                       |
+  *    | CURVE_DPV_ADVANCE         = 0x10 | ... ...                       |
+  *    | CURVE_DPV_ADVANCE_SMPRATE = 0x11 | ... ...                       |
+  *    | CURVE_CALI_ADC            = 0xF1 | ... ...                       |
+  *    | MODE_DEV_TOOL             = 0xFF | ... ...                       |
+  *    | SET_SAMPLE_RATE           = 0xE0 | ... ...                       |
+  *    | SET_ADC_DAC_GAIN          = 0xE1 | ... ...                       |
+  *    | SET_PARA                  = 0xE2 | ... ...                       |
+  *    +----------------------------------+----------------------------------
+  */
+
+static uint32_t OldStep2NewStepTime(uint32_t StepTime){
+    uint8_t StepTimeLevel = 0;
+    StepTimeLevel = StepTime / 0x12;
+
+    switch (StepTimeLevel) {
+        case 0: {  //0.5 sec
+            return STEPTIME_HALF_SEC;
+        }
+        case 1: {  //1 sec
+            return STEPTIME_ONE_SEC;
+        }
+        case 2: {  //2 sec
+            return STEPTIME_TWO_SEC;
+        }
+        default: {  //1 sec
+            return STEPTIME_ONE_SEC;
+        }
+    }
+}
+
+#define STEP_TO_VSETRATE(step)   step2VsetRate(step)
+
+static void step2VsetRate(uint32_t step){
+    /*step = 100 mv, index = 0, n = 2
+             10  mv, index = 1, n = 10
+             1   mv, index = 2, n = 100
+             0.1 mv, index = 3, n = 1000
+             0.01mv, index = 4, n = 10000  */
+
+    if(step >= 10000){
+        instru.VsetRateIndex = 0;
+    }else if (step >= 1000){
+        instru.VsetRateIndex = 1;
+    }else if (step >= 100){
+        instru.VsetRateIndex = 2;
+    }else if (step >= 10){
+        instru.VsetRateIndex = 3;
+    }else if (step >= 1){
+        instru.VsetRateIndex = 4;
+    }
+}
+
+#include "headstage/mode_dev_tool.h"
+static void ins_decode_ris(uint8_t *ins_buf)
+{
+    uint8_t *p = ins_buf;
+    uint8_t mode = p[2];
+
+    switch (mode) {
+        case CURVE_IV: {
+            instru.eliteFxn      = CURVE_IV;
+            instru.Ve1           = ((uint16_t)(p[3]) << 8) | (uint16_t)(p[4]);
+            instru.Ve2           = ((uint16_t)(p[5]) << 8) | (uint16_t)(p[6]);
+            instru.Vinit         = (int32_t)instru.Ve1;
+            instru.Vmax          = (int32_t)VMAX(instru.Ve1,instru.Ve2);
+            instru.Vmin          = (int32_t)VMIN(instru.Ve1,instru.Ve2);
+            instru.directionInit = VDIRECTION(instru.Ve1,instru.Ve2);
+            instru.steptime      = (uint32_t)(p[9]);
+            instru.steptime      = OldStep2NewStepTime(instru.steptime); //5000;10000;20000;
+            instru.step          = ((uint32_t)(p[7]) << 8) | (uint32_t)(p[8]);//1~1000 = 0.1mv ~ 100mv
+            instru.step          = instru.step * 100000 / instru.steptime;
+            STEP_TO_VSETRATE(instru.step);
+            instru.VsetRate      = VsetRateTable[instru.VsetRateIndex];//N
+            instru.cycleNumber   = 1;
+            instru.hign_z_en     = ~(p[11] & 0x0F);
+            instru.notifyRate    = ((uint32_t)p[12] << 8) | (uint32_t)p[13];
+            instru.notifyRate    = 10000 / instru.notifyRate * 10;
+
+            if ((instru.Ve1 < DAC_VOUT_GAIN_LARGE_BOUNDARY_USERCODE && instru.Ve1 > DAC_VOUT_GAIN_LARGE_BOUNDARY1_USERCODE)
+            && (instru.Ve2 < DAC_VOUT_GAIN_LARGE_BOUNDARY_USERCODE && instru.Ve2 > DAC_VOUT_GAIN_LARGE_BOUNDARY1_USERCODE)) {
+                instru.VoutGainLv = VOUT_GAIN_15K;
+            } else {
+                instru.VoutGainLv = VOUT_GAIN_240K;
+            }
+
+            ModeLED(WORKING);
+
+            break;
+        }
+
+        case CURVE_IV_CY: {
+            instru.eliteFxn      = CURVE_IV_CY;
+            instru.Ve1           = ((uint16_t)(p[3]) << 8) | (uint16_t)(p[4]);
+            instru.Ve2           = ((uint16_t)(p[5]) << 8) | (uint16_t)(p[6]);
+            instru.Vinit         = (int32_t)instru.Ve1;
+            instru.Vmax          = (int32_t)VMAX(instru.Ve1,instru.Ve2);
+            instru.Vmin          = (int32_t)VMIN(instru.Ve1,instru.Ve2);
+            instru.directionInit = VDIRECTION(instru.Ve1,instru.Ve2);
+            instru.steptime      = (uint32_t)(p[9]);
+            instru.steptime      = OldStep2NewStepTime(instru.steptime); //5000;10000;20000;
+            instru.step          = ((uint32_t)(p[7]) << 8) | (uint32_t)(p[8]);//1~1000 = 0.1mv ~ 100mv
+            instru.step          = instru.step * 100000 / instru.steptime;
+            STEP_TO_VSETRATE(instru.step);
+            instru.VsetRate      = VsetRateTable[instru.VsetRateIndex];//N
+            instru.cycleNumber   = ((uint16_t)(p[10]) << 8) | (uint16_t)(p[11]);
+            instru.hign_z_en     = ~(p[13] & 0x0F);
+            instru.notifyRate    = ((uint32_t)p[14] << 8) | (uint32_t)p[15];
+            instru.notifyRate    = 10000 / instru.notifyRate * 10;
+
+            if ((instru.Ve1 < DAC_VOUT_GAIN_LARGE_BOUNDARY_USERCODE && instru.Ve1 > DAC_VOUT_GAIN_LARGE_BOUNDARY1_USERCODE)
+            && (instru.Ve2 < DAC_VOUT_GAIN_LARGE_BOUNDARY_USERCODE && instru.Ve2 > DAC_VOUT_GAIN_LARGE_BOUNDARY1_USERCODE)) {
+                instru.VoutGainLv = VOUT_GAIN_15K;
+            } else {
+                instru.VoutGainLv = VOUT_GAIN_240K;
+            }
+
+            ModeLED(WORKING);
+
+            break;
+        }
+
+        case CURVE_VO: {
+            instru.eliteFxn      = CURVE_VO;
+            instru.Ve1           = ((uint16_t)p[3] << 8) | (uint16_t)p[4];
+            instru.Vinit         = (int32_t)instru.Ve1;
+            instru.hign_z_en     = ~(p[6] & 0x0F);
+
+            if (instru.Ve1 < DAC_VOUT_GAIN_LARGE_BOUNDARY_USERCODE && instru.Ve1 > DAC_VOUT_GAIN_LARGE_BOUNDARY1_USERCODE) {
+                instru.VoutGainLv = VOUT_GAIN_15K;
+            } else {
+                instru.VoutGainLv = VOUT_GAIN_240K;
+            }
+
+            instru.notifyRate    = ((uint32_t)p[7] << 8) | (uint32_t)p[8];
+            instru.notifyRate    = 10000 / instru.notifyRate * 10;
+
+            ModeLED(WORKING);
+
+            break;
+        }
+
+        case CURVE_RT: {
+            instru.eliteFxn      = CURVE_RT;
+            instru.notifyRate    = ((uint32_t)p[7] << 8) | (uint32_t)p[8];
+            instru.notifyRate    = 10000 / instru.notifyRate * 10;
+            instru.VsetRate      = 2;
+            instru.Ve1           = ((uint16_t)p[3] << 8) | (uint16_t)p[4];
+            instru.Vinit         = (int32_t)instru.Ve1;
+            instru.hign_z_en     = ~(p[6] & 0x0F);
+
+            if (instru.Ve1 < DAC_VOUT_GAIN_LARGE_BOUNDARY_USERCODE && instru.Ve1 > DAC_VOUT_GAIN_LARGE_BOUNDARY1_USERCODE) {
+                instru.VoutGainLv = VOUT_GAIN_15K;
+            } else {
+                instru.VoutGainLv = VOUT_GAIN_240K;
+            }
+
+            ModeLED(WORKING);
+
+            break;
+        }
+
+        case CURVE_VT: {
+            instru.eliteFxn      = CURVE_VT;
+            instru.notifyRate    = ((uint32_t)p[5] << 8) | (uint32_t)p[6];
+            instru.notifyRate    = 10000 / instru.notifyRate * 10;
+            instru.hign_z_en     = ~(p[4] & 0x0F);
+
+            ModeLED(WORKING);
+
+            break;
+        }
+
+        case CURVE_IT: {
+            instru.eliteFxn      = CURVE_IT;
+            instru.notifyRate    = ((uint32_t)p[7] << 8) | (uint32_t)p[8];
+            instru.notifyRate    = 10000 / instru.notifyRate * 10;
+            instru.Ve1           = ((uint16_t)p[3] << 8) | (uint16_t)p[4];
+            instru.Vinit         = (int32_t)instru.Ve1;
+            instru.hign_z_en     = ~(p[6] & 0x0F);
+
+            if (instru.Ve1 < DAC_VOUT_GAIN_LARGE_BOUNDARY_USERCODE && instru.Ve1 > DAC_VOUT_GAIN_LARGE_BOUNDARY1_USERCODE) {
+                instru.VoutGainLv = VOUT_GAIN_15K;
+            } else {
+                instru.VoutGainLv = VOUT_GAIN_240K;
+            }
+
+            ModeLED(WORKING);
+
+            break;
+        }
+
+        case CURVE_CC: {
+            instru.eliteFxn        = CURVE_CC;
+            instru.notifyRate      = ((uint32_t)p[14] << 8) | (uint32_t)p[15];
+            instru.notifyRate      = 10000 / instru.notifyRate * 10;
+            instru.charge          = p[3]; //0:discharge 1:charge
+            instru.constantCurrent = (uint32_t)(p[4])  << 24 | (uint32_t)(p[5]) << 16 | (uint32_t)(p[6]) << 8 | (uint32_t)(p[7]);
+            instru.Vmax            = (uint32_t)(p[8])  << 8  | (uint32_t)(p[9]);
+            instru.Vmin            = (uint32_t)(p[10]) << 8  | (uint32_t)(p[11]);
+            instru.hign_z_en       = ~(p[13] & 0x0F);
+
+            instru.VoutGainLv   = VOUT_GAIN_240K;
+
+            ModeLED(WORKING);
+            /*******************************************************
+            controller instruction
+            p[3]   -> Charge, 0:discharge 1:charge
+            p[6:9] -> ConstantCurrent, 0 ~ 15000uA : 0 ~ 1500000
+            ********************************************************/
+
+            break;
+        }
+
+        case CURVE_CV: {
+            if (p[3] == PARA_1) {
+                instru.Vinit       = ((int32_t)(p[4]) << 8) | (int32_t)(p[5]);
+                instru.Ve1         = ((uint16_t)(p[6]) << 8) | (uint16_t)(p[7]);
+                instru.Ve2         = ((uint16_t)(p[8]) << 8) | (uint16_t)(p[9]);
+                instru.Vmax        = (int32_t)VMAX(instru.Ve1,instru.Ve2);
+                instru.Vmin        = (int32_t)VMIN(instru.Ve1,instru.Ve2);
+                if (instru.Vinit > instru.Ve1 || instru.Vinit == instru.Vmax) {
+                    instru.directionInit = 0;//0:reverse   1:forward
+                } else if (instru.Vinit <= instru.Ve1 || instru.Vinit == instru.Vmin) {
+                    instru.directionInit = 1;
+                }
+
+                //controller UI 0.01~1000mv send to Elite 1~100000
+                instru.step        = (uint32_t)(p[10]) << 24 | (uint32_t)(p[11]) << 16 | (uint32_t)(p[12]) << 8 | (uint32_t)(p[13]);
+                STEP_TO_VSETRATE(instru.step);
+                instru.VsetRate    = VsetRateTable[instru.VsetRateIndex];//N
+
+                instru.Currentmax  = (int32_t)(p[14]) << 24 | (int32_t)(p[15]) << 16 | (int32_t)(p[16]) << 8 | (int32_t)(p[17]);
+
+            } else if (p[3] == PARA_2) {
+                instru.eliteFxn    = CURVE_CV;
+                instru.cycleNumber = ((uint16_t)(p[4]) << 8) | (uint16_t)(p[5]);
+                instru.notifyRate  = (uint32_t)(p[8]) << 8 | (uint32_t)(p[9]);
+                instru.notifyRate  = 10000 / instru.notifyRate * 10;
+                instru.hign_z_en   = ~(p[7] & 0x0F);
+
+                instru.VoutGainLv = VOUT_GAIN_240K;
+                ModeLED(WORKING);
+            }
+
+            break;
+        }
+
+        case CURVE_LSV: {
+            if (p[3] == PARA_1) {
+                instru.Ve1           = ((uint16_t)(p[4]) << 8) | (uint16_t)(p[5]);
+                instru.Ve2           = ((uint16_t)(p[6]) << 8) | (uint16_t)(p[7]);
+                instru.Vinit         = (int32_t)instru.Ve1;
+                instru.Vmax          = (int32_t)VMAX(instru.Ve1,instru.Ve2);
+                instru.Vmin          = (int32_t)VMIN(instru.Ve1,instru.Ve2);
+                instru.directionInit = VDIRECTION(instru.Ve1,instru.Ve2);
+                instru.Currentmax    = (int32_t)(p[12]) << 24 | (int32_t)(p[13]) << 16 | (int32_t)(p[14]) << 8 | (int32_t)(p[15]);
+
+                //controller UI 0.01~1000mv send to Elite 1~100000
+                instru.step          = (uint32_t)(p[8]) << 24 | (uint32_t)(p[9]) << 16 | (uint32_t)(p[10]) << 8 | (uint32_t)(p[11]);
+                STEP_TO_VSETRATE(instru.step);
+                instru.VsetRate      = VsetRateTable[instru.VsetRateIndex];//N
+                instru.cycleNumber   = 1;//p[16.17];
+
+            } else if (p[3] == PARA_2) {
+                instru.eliteFxn      = CURVE_LSV;
+                instru.notifyRate    = (uint32_t)(p[6]) << 8 | (uint32_t)(p[7]);
+                instru.notifyRate    = 10000 / instru.notifyRate * 10;
+                instru.hign_z_en     = ~(p[5] & 0x0F);
+
+                instru.VoutGainLv = VOUT_GAIN_240K;
+
+                ModeLED(WORKING);
+            }
+
+            break;
+        }
+
+        case CURVE_CA: {
+            instru.eliteFxn    = CURVE_CA;
+            instru.Vinit       = ((int32_t)(p[3]) << 8) | (int32_t)(p[4]);
+            instru.notifyRate  = (uint32_t)(p[7]) << 8 | (uint32_t)(p[8]);
+            instru.notifyRate  = 10000 / instru.notifyRate * 10;
+            instru.VsetRate    = VsetRateTable[0];
+            instru.hign_z_en   = ~(p[6] & 0x0F);
+
+            instru.VoutGainLv = VOUT_GAIN_240K;
+
+            ModeLED(WORKING);
+            break;
+        }
+
+        case CURVE_OCP: {
+            instru.eliteFxn      = CURVE_OCP;
+            instru.notifyRate    = ((uint32_t)p[5] << 8) | (uint32_t)p[6];
+            instru.notifyRate    = 10000 / instru.notifyRate * 10;
+            instru.hign_z_en     = 0;
+
+            ModeLED(WORKING);
+
+            break;
+        }
+
+        case SET_SAMPLE_RATE: {
+            instru.notifyRate  = (uint32_t)(p[3]) << 8 | (uint32_t)(p[4]);
+            instru.notifyRate  = 10000 / instru.notifyRate * 10;
+
+            break;
+        }
+
+        case SET_ADC_DAC_GAIN: {
+            switch (p[3]) {
+                case RIS_ADC_IIN: {
+                    instru.IinADCGainLv = p[4];
+                    if (instru.IinADCGainLv != I_GAIN_AUTO) {
+                        instru.IinADCAutoGainEn = 0;
+                    } else {
+                        instru.IinADCAutoGainEn = 1;
+                        instru.IinADCGainLv = I_GAIN_100R;
+                        IinADCGainCtrl(instru.IinADCGainLv);
+                    }
+                    break;
+                }
+                case RIS_ADC_VIN: {
+                    instru.VinADCGainLv = p[4];
+                    if (instru.VinADCGainLv != VIN_GAIN_AUTO) {
+                        instru.VinADCAutoGainEn = 0;
+                    } else {
+                        instru.VinADCAutoGainEn = 1;
+                        instru.VinADCGainLv = VIN_GAIN_1K;
+                        VinADCGainCtrl(instru.VinADCGainLv);
+                    }
+                    break;
+                }
+                case RIS_DAC_VOUT: {
+                    // instru.VoutGainLv = p[4];
+                    // if (instru.VoutGainLv == VOUT_GAIN_AUTO) {
+                    //     instru.VoutGainLv = VOUT_GAIN_15K;
+                    // }
+                    instru.VoutGainLv = p[4];
+                    VoutGainControl(instru.VoutGainLv);
+                    break;
+                }
+                case RIS_HIGH_Z: {
+                    switch (p[4]) {
+                        case 0x00:
+                            PIN15_setOutputValue(HIGH_Z, 0);   // 0 => open high_z mode
+                            break;
+
+                        case 0x01:
+                            PIN15_setOutputValue(HIGH_Z, 1);   // 1 => close high_z mode
+                            break;
+
+                        default:
+                        break;
+
+                    }
+                    break;
+                }
+                default:
+                break;
+            }
+            break;
+        }
+
+        case CURVE_CALI_ADC: {
+            switch (p[3]) {
+                case RIS_ADC_IIN: {             // 0x00
+                    instru.eliteFxn      = CURVE_CALI_ADC;
+                    instru.AdcChannel    = RIS_ADC_IIN;
+                    instru.notifyRate    = 1000;
+                    ModeLED(WORKING);
+                    break;
+                }
+                case RIS_ADC_VIN: {             // 0x01
+                    instru.eliteFxn      = CURVE_CALI_ADC;
+                    instru.AdcChannel    = RIS_ADC_VIN;
+                    instru.notifyRate    = 1000;
+                    ModeLED(WORKING);
+                    break;
+                }
+                case RIS_DAC_VOUT: {             // 0x02
+                    instru.eliteFxn      = CURVE_CALI_ADC;
+                    instru.AdcChannel    = RIS_DAC_VOUT;
+                    instru.notifyRate    = 1000;
+                    instru.VoltConstant  = ( ((uint16_t)(p[4])) << 8) | (uint16_t)(p[5]);      // output voltage
+                    DAC_outputV(instru.VoltConstant); //UserCode -> DAC code -> DAC out
+                    ModeLED(WORKING);
+                    break;
+                }
+                default:
+                break;
+
+            }
+            break;
+        }
+
+        case CURVE_PULSE: {
+            instru.VoutGainLv = VOUT_GAIN_240K;
+            instru.notifyRate    = 100;
+            if (p[3] == PARA_1) {
+                instru.sti_t1    = (int32_t)(p[4]) << 24 | (int32_t)(p[5]) << 16 | (int32_t)(p[6]) << 8 | (int32_t)(p[7]);
+                instru.sti_t2    = (int32_t)(p[8]) << 24 | (int32_t)(p[9]) << 16 | (int32_t)(p[10]) << 8 | (int32_t)(p[11]);
+                instru.sti_t3    = (int32_t)(p[12]) << 24 | (int32_t)(p[13]) << 16 | (int32_t)(p[14]) << 8 | (int32_t)(p[15]);
+                instru.sti_t4    = (int32_t)(p[16]) << 24 | (int32_t)(p[17]) << 16 | (int32_t)(p[18]) << 8 | (int32_t)(p[19]);
+            } else if (p[3] == PARA_2) {
+                instru.sti_t5    = (int32_t)(p[4]) << 24 | (int32_t)(p[5]) << 16 | (int32_t)(p[6]) << 8 | (int32_t)(p[7]);
+                instru.sti_v1    = 25000; //8~11
+                instru.sti_v2    = 50000; //12~15  //41406.43161.
+                instru.sti_v3    = 25000; //16~19
+            } else if (p[3] == PARA_3) {
+                instru.sti_v4    = 25000; //4~7
+                instru.sti_v5    = 25000; //8~11
+                instru.sti_cy    = (uint16_t)(p[12]); //12
+                instru.sti_loop  = (uint16_t)(p[13]); //13
+            } else if (p[3] == PARA_4) {
+                instru.sti_t6    = (int32_t)(p[4]) << 24 | (int32_t)(p[5]) << 16 | (int32_t)(p[6]) << 8 | (int32_t)(p[7]); //4~7
+                instru.sti_t7    = (int32_t)(p[8]) << 24 | (int32_t)(p[9]) << 16 | (int32_t)(p[10]) << 8 | (int32_t)(p[11]); //8~11
+                instru.sti_v6    = 25000; //12~15
+                instru.sti_v7    = 25000; //16~19
+                instru.sti_t1    = VALUE_ZERO_TO_ONE(instru.sti_t1);
+                instru.sti_t2    = VALUE_ZERO_TO_ONE(instru.sti_t2);
+                instru.sti_t3    = VALUE_ZERO_TO_ONE(instru.sti_t3);
+                instru.sti_t4    = VALUE_ZERO_TO_ONE(instru.sti_t4);
+                instru.sti_t5    = VALUE_ZERO_TO_ONE(instru.sti_t5);
+                instru.sti_t6    = VALUE_ZERO_TO_ONE(instru.sti_t6);
+                instru.sti_t7    = VALUE_ZERO_TO_ONE(instru.sti_t7);
+                megaStiEnable         = true;
+            } else if (p[3] == PARA_17) {
+                instru.eliteFxn  = CURVE_PULSE;
+                ModeLED(WORKING);
+            }
+            break;
+        }
+
+        case CURVE_UNI_PULSE: {
+            if (p[3] == PARA_1) {
+                uint8_t seg_index             = p[12];
+                instru.v_initial[seg_index]   = (int32_t)p[4] << 8 | (int32_t)p[5];
+                instru.v0                     = instru.v_initial[0];
+                instru.t_pulse[seg_index]     = (uint32_t)p[6] << 24 | (uint32_t)p[7] << 16 | (uint32_t)p[8] << 8 | (uint32_t)p[9];
+                instru.t_pulse_min[seg_index] = (uint32_t)p[10];
+                instru.t_pulse_max[seg_index] = (uint32_t)p[11];
+                instru.v_slope[seg_index]     = 0;
+                instru.v_step[seg_index]      = 0;
+
+            } else if (p[3] == PARA_2) {
+                uint8_t seg_index             = p[12];
+                instru.v_initial[seg_index]   = (int32_t)p[4] << 8 | (int32_t)p[5];
+                instru.t_pulse[seg_index]     = (uint32_t)p[6] << 24 | (uint32_t)p[7] << 16 | (uint32_t)p[8] << 8 | (uint32_t)p[9];
+                instru.t_pulse_min[seg_index] = (uint32_t)p[10];
+                instru.t_pulse_max[seg_index] = (uint32_t)p[11];
+                instru.v_slope[seg_index]     = 0;
+                instru.v_step[seg_index]      = 0;
+
+            } else if (p[3] == PARA_3) {
+                uint8_t seg_index             = p[12];
+                instru.v_initial[seg_index]   = (int32_t)p[4] << 8 | (int32_t)p[5];
+                instru.t_pulse[seg_index]     = (uint32_t)p[6] << 24 | (uint32_t)p[7] << 16 | (uint32_t)p[8] << 8 | (uint32_t)p[9];
+                instru.t_pulse_min[seg_index] = (uint32_t)p[10];
+                instru.t_pulse_max[seg_index] = (uint32_t)p[11];
+                instru.v_slope[seg_index]     = 0;
+                instru.v_step[seg_index]      = 0;
+
+            } else if (p[3] == PARA_4) {
+                uint8_t seg_index             = p[12];
+                instru.v_initial[seg_index]   = (int32_t)p[4] << 8 | (int32_t)p[5];
+                instru.t_pulse[seg_index]     = (uint32_t)p[6] << 24 | (uint32_t)p[7] << 16 | (uint32_t)p[8] << 8 | (uint32_t)p[9];
+                instru.t_pulse_min[seg_index] = (uint32_t)p[10];
+                instru.t_pulse_max[seg_index] = (uint32_t)p[11];
+                instru.v_slope[seg_index]     = 0;
+                instru.v_step[seg_index]      = 0;
+
+            } else if (p[3] == PARA_FINAL) {
+                instru.eliteFxn       = CURVE_UNI_PULSE;
+
+                instru.VoutGainLv = VOUT_GAIN_240K;
+
+                ModeLED(WORKING);
+
+            }
+
+            break;
+        }
+        
+        case CURVE_DPV: {
+
+            /*
+            * DPV mode --auto
+            * +----------+------------+-------------+-----------------+---------------+---------------+
+            * |    UI    |  E Initial |   E Final   | Pulse Amplitude |   Pulse Width |   Increment   |
+            * |   json   | DPV_e_init | DPV_e_final |     DPV_amp     | DPV_pul_width | DPV_increment |
+            * +----------+------------+-------------+-----------------+---------------+---------------+
+            * |    UI    |   Step Time   |   Sample rate   | (audio)  |        (audio)         |
+            * |   json   | DPV_step_time | DPV_notify_rate | DPV_mode | DPV_engineering_enable |
+            * +----------+---------------+-----------------+----------+------------------------+
+            * hide parameter
+            * +----------+-------------------------------------+
+            * |    UI    |   Current Recording Period(Slots)   |
+            * |   json   | DPV_curr_rec_max | DPV_curr_rec_min |
+            * +----------+------------------+------------------+
+            *
+            */
+            //--mode
+            static uint8_t dpv_option;
+
+            //--Auto
+            static int32_t dpv_e_init;
+            static int32_t dpv_e_final;
+            static int32_t dpv_amp;
+            static uint32_t dpv_pul_width;
+            static int32_t dpv_increment;
+            static uint32_t dpv_step_time;
+            static uint32_t dpv_notify_rate;
+            static uint32_t dpv_curr_rec_percent_min[4];
+            static uint32_t dpv_curr_rec_percent_max[4];
+
+            //--engineering
+            static uint8_t dpv_engi_advanced_en;
+
+            if (p[3] == PARA_1) {
+                dpv_option = p[4];
+                dpv_engi_advanced_en = p[5];
+
+            } else if (p[3] == PARA_2) {
+                dpv_e_init = (int32_t)p[4] << 8 | (int32_t)p[5];
+                dpv_e_final = (int32_t)p[6] << 8 | (int32_t)p[7];
+                dpv_amp = (int32_t)p[8] << 8 | (int32_t)p[9];
+                dpv_pul_width = (uint32_t)p[10] << 24 | (uint32_t)p[11] << 16 | (uint32_t)p[12] << 8 | (uint32_t)p[13];
+                dpv_increment = (int32_t)p[14] << 8 | (int32_t)p[15];
+
+            } else if (p[3] == PARA_3) {
+                dpv_step_time = (uint32_t)p[4] << 24 | (uint32_t)p[5] << 16 | (uint32_t)p[6] << 8 | (uint32_t)p[7];
+                dpv_notify_rate = (uint32_t)p[8] << 8 | (uint32_t)p[9];
+                dpv_curr_rec_percent_min[0] = (uint32_t)p[10];
+                dpv_curr_rec_percent_max[0] = (uint32_t)p[11];
+                dpv_curr_rec_percent_min[1] = (uint32_t)p[10];
+                dpv_curr_rec_percent_max[1] = (uint32_t)p[11];
+
+            } else if (p[3] == PARA_FINAL) {
+                dpv_e_init = UC_TO_5NV(dpv_e_init);
+                dpv_e_final = UC_TO_5NV(dpv_e_final);
+                dpv_amp = UC_TO_5NV(dpv_amp);
+                dpv_pul_width = dpv_pul_width * 10;
+                dpv_increment = UC_TO_5NV(dpv_increment);
+                dpv_increment = abs(dpv_increment);
+                dpv_step_time = dpv_step_time * 10;
+                dpv_notify_rate = 10000 / dpv_notify_rate * 10;
+
+                instru.v0 = dpv_e_init;
+                instru.v_stop = dpv_e_final;
+                instru.t_pulse[0] = dpv_step_time - dpv_pul_width;
+                instru.t_pulse[1] = dpv_pul_width;
+                instru.v_initial[0] = dpv_e_init;
+                instru.v_initial[1] = dpv_e_init + dpv_amp;
+                instru.v_step[0] = dpv_increment;
+                instru.v_step[1] = dpv_increment;
+                instru.notifyRate = dpv_notify_rate;
+                instru.v_slope[0] = 0; // 1234 = slop 1.234, same as scanrate
+                instru.v_slope[1] = 0; // 1234 = slop 1.234
+                instru.t_pulse_min[0] = dpv_curr_rec_percent_min[0];
+                instru.t_pulse_max[0] = dpv_curr_rec_percent_max[0];
+                instru.t_pulse_min[1] = dpv_curr_rec_percent_min[1];
+                instru.t_pulse_max[1] = dpv_curr_rec_percent_max[1];
+
+                if (instru.v0 > instru.v_stop) {
+                    instru.directionInit = 0;//0:reverse   1:forward
+                    instru.v_step[0] = (-1) * instru.v_step[0];
+                    instru.v_step[1] = (-1) * instru.v_step[1];
+                } else if (instru.v0 < instru.v_stop) {
+                    instru.directionInit = 1;
+                }
+
+                if (dpv_option == 0) {
+                    instru.eliteFxn = CURVE_DPV;
+                } else if (dpv_option == 2) {
+                    instru.eliteFxn = CURVE_DPV_SMPRATE;
+                }
+                instru.VoutGainLv = VOUT_GAIN_240K;
+                ModeLED(WORKING);
+            }
+
+            break;
+        }
+
+        case CURVE_DPV_ADVANCE: {
+
+            /*
+            * DPV mode --advanced
+            * +----------+------------+---------+---------+-------------+-----------------+---------------+---------------+
+            * |    UI    |  E Initial |   E 1   |   E 2   |   E Final   | Pulse Amplitude |   Pulse Width |   Increment   |
+            * |   json   | DPV_e_init | DPV_e_1 | DPV_e_2 | DPV_e_final |     DPV_amp     | DPV_pul_width | DPV_increment |
+            * +----------+------------+---------+---------+-------------+-----------------+---------------+---------------+
+            * |    UI    |   Step Time   |   Sample rate   |   Current Recording Period(Slots)   |
+            * |   json   | DPV_step_time | DPV_notify_rate | DPV_curr_rec_max | DPV_curr_rec_min |
+            * +----------+---------------+-----------------+------------------+------------------+
+            * |    UI    | (audio)  |        (audio)         |
+            * |   json   | DPV_mode | DPV_engineering_enable |
+            * +----------+----------+------------------------+
+            *
+            */
+            //--mode
+            static uint8_t dpv_option;
+
+            //--advanced
+            static int32_t dpv_e_init;
+            static int32_t dpv_e_final;
+            static int32_t dpv_amp;
+            static uint32_t dpv_pul_width;
+            static int32_t dpv_increment;
+            static uint32_t dpv_step_time;
+            static uint32_t dpv_notify_rate;
+            static uint32_t dpv_curr_rec_percent_min[4];
+            static uint32_t dpv_curr_rec_percent_max[4];
+            static int32_t dpv_e_1;
+            static int32_t dpv_e_2;
+            static uint8_t dpv_invert_option;
+            static uint16_t dpv_cycle;
+
+            //--engineering
+            static uint8_t dpv_engi_advanced_en;
+
+            if (p[3] == PARA_1) {
+                dpv_option = p[4];
+                dpv_engi_advanced_en = p[5];
+
+            } else if (p[3] == PARA_2) {
+                dpv_e_init = (int32_t)p[4] << 8 | (int32_t)p[5];
+                dpv_e_final = (int32_t)p[6] << 8 | (int32_t)p[7];
+                dpv_amp = (int32_t)p[8] << 8 | (int32_t)p[9];
+                dpv_pul_width = (uint32_t)p[10] << 24 | (uint32_t)p[11] << 16 | (uint32_t)p[12] << 8 | (uint32_t)p[13];
+                dpv_increment = (int32_t)p[14] << 8 | (int32_t)p[15];
+
+            } else if (p[3] == PARA_3) {
+                dpv_step_time = (uint32_t)p[4] << 24 | (uint32_t)p[5] << 16 | (uint32_t)p[6] << 8 | (uint32_t)p[7];
+                dpv_notify_rate = (uint32_t)p[8] << 8 | (uint32_t)p[9];
+                dpv_curr_rec_percent_min[0] = (uint32_t)p[10];
+                dpv_curr_rec_percent_max[0] = (uint32_t)p[11];
+                dpv_curr_rec_percent_min[1] = (uint32_t)p[10];
+                dpv_curr_rec_percent_max[1] = (uint32_t)p[11];
+
+            } else if (p[3] == PARA_4) {
+                dpv_e_1 = (int32_t)p[4] << 8 | (int32_t)p[5];
+                dpv_e_2 = (int32_t)p[6] << 8 | (int32_t)p[7];
+                dpv_invert_option = p[8];
+                dpv_cycle = (uint16_t)p[9] << 8 | (uint16_t)p[10];
+
+            } else if (p[3] == PARA_FINAL) {
+                dpv_e_init = UC_TO_5NV(dpv_e_init);
+                dpv_e_final = UC_TO_5NV(dpv_e_final);
+                dpv_amp = UC_TO_5NV(dpv_amp);
+                dpv_pul_width = dpv_pul_width * 10;
+                dpv_increment = UC_TO_5NV(dpv_increment);
+                dpv_increment = abs(dpv_increment);
+                dpv_step_time = dpv_step_time * 10;
+                dpv_notify_rate = 10000 / dpv_notify_rate * 10;
+                dpv_e_1 = UC_TO_5NV(dpv_e_1);
+                dpv_e_2 = UC_TO_5NV(dpv_e_2);
+
+                instru.v0 = dpv_e_init;
+                instru.v_stop = dpv_e_final;
+                instru.t_pulse[0] = dpv_step_time - dpv_pul_width;
+                instru.t_pulse[1] = dpv_pul_width;
+                instru.v_initial[0] = dpv_e_init;
+                instru.v_initial[1] = dpv_e_init + dpv_amp;
+                instru.v_step[0] = abs(dpv_increment);
+                instru.v_step[1] = abs(dpv_increment);
+                instru.notifyRate = dpv_notify_rate;
+                instru.v_slope[0] = 0; // 1234 = slop 1.234, same as scanrate
+                instru.v_slope[1] = 0; // 1234 = slop 1.234
+                instru.t_pulse_min[0] = dpv_curr_rec_percent_min[0];
+                instru.t_pulse_max[0] = dpv_curr_rec_percent_max[0];
+                instru.t_pulse_min[1] = dpv_curr_rec_percent_min[1];
+                instru.t_pulse_max[1] = dpv_curr_rec_percent_max[1];
+                instru.v_1 = dpv_e_1;
+                instru.v_2 = dpv_e_2;
+                instru.cycleNumber = dpv_cycle;
+                if (dpv_invert_option == 1) {
+                    instru.v_invert_option = true;
+                } else {
+                    instru.v_invert_option = false;
+                }
+
+
+                if (instru.v0 > dpv_e_1) {
+                    instru.directionInit = 0;//0:reverse   1:forward
+                    instru.v_step[0] = (-1) * instru.v_step[0];
+                    instru.v_step[1] = (-1) * instru.v_step[1];
+
+                } else if (instru.v0 < dpv_e_1) {
+                    instru.directionInit = 1;
+
+                }
+
+                if (dpv_e_1 > dpv_e_2) {
+                    instru.v_up = dpv_e_1;
+                    instru.v_low = dpv_e_2;
+                    instru.v_stop_direction = 1;//0:reverse   1:forward
+
+                } else if (dpv_e_1 < dpv_e_2) {
+                    instru.v_up = dpv_e_2;
+                    instru.v_low = dpv_e_1;
+                    instru.v_stop_direction = 0;//0:reverse   1:forward
+                }
+
+                if (dpv_option == 1) {
+                    instru.eliteFxn = CURVE_DPV_ADVANCE;
+                } else if (dpv_option == 2) {
+                    instru.eliteFxn = CURVE_DPV_ADVANCE_SMPRATE;
+                }
+                instru.VoutGainLv = VOUT_GAIN_240K;
+                ModeLED(WORKING);
+            }
+
+            break;
+        }
+
+        case SET_PARA: {
+            int32_t value;
+
+            if (instru.eliteFxn == CURVE_VO) {
+                switch (p[3]) {
+                    case DAC_VOLT:
+                        value = (p[4] << 8) | p[5]; // usercode
+
+                        if (value < DAC_VOUT_GAIN_LARGE_BOUNDARY_USERCODE && value > DAC_VOUT_GAIN_LARGE_BOUNDARY1_USERCODE) {
+                            instru.VoutGainLv = VOUT_GAIN_15K;
+                        } else {
+                            instru.VoutGainLv = VOUT_GAIN_240K;
+                        }
+                        VoutGainControl(instru.VoutGainLv);
+
+                        value = (value - 25000) * 4 * 10000; //[5nV]
+                        set_para(instru.eliteFxn, DAC_VOLT, value);
+                        break;
+
+                        default:
+                        break;
+                }
+
+            } else if (instru.eliteFxn == CURVE_IT) {
+                switch (p[3]) {
+                    case DAC_VOLT:
+                    value = (p[4] << 8) | p[5]; // usercode
+
+                    if (value < DAC_VOUT_GAIN_LARGE_BOUNDARY_USERCODE && value > DAC_VOUT_GAIN_LARGE_BOUNDARY1_USERCODE) {
+                        instru.VoutGainLv = VOUT_GAIN_15K;
+                    } else {
+                        instru.VoutGainLv = VOUT_GAIN_240K;
+                    }
+                    VoutGainControl(instru.VoutGainLv);
+
+                    value = (value - 25000) * 4 * 10000; //[5nV]
+                    set_para(instru.eliteFxn, DAC_VOLT, value);
+                    break;
+
+                    default:
+                    break;
+                }
+
+            } else if (instru.eliteFxn == CURVE_RT) {
+                switch (p[3]) {
+                    case DAC_VOLT:
+                    value = (p[4] << 8) | p[5]; // usercode
+
+                    if (value < DAC_VOUT_GAIN_LARGE_BOUNDARY_USERCODE && value > DAC_VOUT_GAIN_LARGE_BOUNDARY1_USERCODE) {
+                        instru.VoutGainLv = VOUT_GAIN_15K;
+                    } else {
+                        instru.VoutGainLv = VOUT_GAIN_240K;
+                    }
+                    VoutGainControl(instru.VoutGainLv);
+
+                    value = (value - 25000) * 4 * 10000; //[5nV]
+                    set_para(instru.eliteFxn, DAC_VOLT, value);
+                    break;
+
+                    default:
+                    break;
+                }
+
+            }
+
+            break;
+        }
+
+        case MODE_DEV_TOOL: { // 0x3000FF
+            mode_dev_tool(p);
+
+            break;
+        }
+
+        default: {
+        /** **/
+        break;
+        }
+    }
+
+}
+
+static void ins_decode_vis(uint8_t *ins_buf)
+{
+    uint8_t *p = ins_buf;
+    uint8_t oper = p[1];  // this is don't care in RIS
+        switch (oper) {
+        // reset all variables ( Ins = 0xC0F0)
+        case VIS_RST: {
+            instru.eliteFxn = VIS_RST;
+            reset();
+            break;
+        }
+
+        case VIS_ASK: {
+            not_buf[0] = BLE_DAT_BUFF_SIZE - 1;  //data len
+            for (int i = 0; i < BLE_DAT_BUFF_SIZE; i++) {
+                not_buf[i] = i;
+            }
+            SimpleProfile_SetParameter(BLE_CIS_BUFF_CHAR, BLE_DAT_BUFF_SIZE, not_buf);
+            break;
+        }
+
+        case VIS_STI: {
+            for(int i = 0; i < 12; i++) {
+                FlushNotify();
+            }
+            PeriodicEvent = true;
+            InitPeriodicEvent = true;      // need to create a WorkModeData?
+            mode_init         = true;
+            InitGPT();
+            break;
+        }
+
+        case VIS_FUH: {
+            led_color_set(LED_NB_MAX, LED_BR_LV1, LED_CLR_RED);
+            break;
+        }
+
+        case VIS_INT: {
+            Eliteinterrupt();
+            for (int i = 0; i < 12; i++) {
+                FlushNotify();
+            }
+            break;
+        }
+
+        case VIS_DEVICE_SHINY: {
+            led_color_set(LED_NB_MAX, LED_BR_LV1, LED_CLR_MAGENTA);
+            break;
+        }
+
+        case VIS_SHINY_DIS: {
+            if (PeriodicEvent) {
+                WORKLED();
+            } else if (!PeriodicEvent) {
+                checkFlafLED();
+            }
+            break;
+        }
+
+        case VIS_CC_ZERO: {
+            instru.eliteFxn      = CURVE_OCP;
+            instru.notifyRate    = 500;
+
+            if (instru.notifyRate > 1000) {
+            // slow notify rate, < 10sps, auto gain changer only use ADC gain level = 1.2.3.4
+                instru.gain_switch_on = 0b11110000;
+
+            } else {
+            // fast notify rate, >= 10sps, auto gain changer only use ADC gain level = 1.2.3
+                instru.gain_switch_on = 0b01110000;
+            }
+
+            ModeLED(PRE_WORK);
+            break;
+        }
+
+        default: {
+            break;
+        }
+        }
+}
+
+static void ins_decode_cis(uint8_t *ins_buf)
+{
+    uint8_t *p = ins_buf;
+    uint8_t oper = p[1];  // this is don't care in RIS
+
+        switch (oper) {
+        case CIS_VERSION: {
+            initCISBuf();
+            cis_buf[0] = 6; //data len
+            cis_buf[1] = CIS_VERSION;
+            cis_buf[2] = VERSION_DATE_YEAR;
+            cis_buf[3] = VERSION_DATE_MONTH;
+            cis_buf[4] = VERSION_DATE_DAY;
+            cis_buf[5] = VERSION_DATE_HOUR;
+            cis_buf[6] = VERSION_DATE_MINUTE;
+            SimpleProfile_SetParameter(BLE_CIS_BUFF_CHAR, BLE_CIS_BUFF_SIZE, cis_buf);
+            break;
+        }
+
+        case CIS_VOLT: {
+            // uint32_t bat = headstage_battery_volt();
+            // initCISBuf();
+            // cis_buf[0] = 5; //data len
+            // cis_buf[1] = CIS_VOLT;
+            // memcpy(&cis_buf[2], (uint8_t *)&bat, sizeof(bat));
+            // SimpleProfile_SetParameter(BLE_CIS_BUFF_CHAR, BLE_CIS_BUFF_SIZE, cis_buf);
+            break;
+        }
+
+
+
+        case CIS_TEMPERATURE: { //0x7080
+            int32_t t = headstage_temperature();
+            initCISBuf();
+            cis_buf[0] = 5; //data len
+            cis_buf[1] = CIS_TEMPERATURE;
+            memcpy(&cis_buf[2], (uint8_t *)&t, sizeof(t));
+            SimpleProfile_SetParameter(BLE_CIS_BUFF_CHAR, BLE_CIS_BUFF_SIZE, cis_buf);
+            break;
+        }
+        }
+}

simplelink/ble_sdk_2_02_02_25/src/examples/simple_peripheral/cc26xx/app/headstage/mode_dev_tool.h

@@ -0,0 +1,396 @@
+#include "HAL/cc2650_driver/i2c_ctrl.h"
+#include "HAL/MAX5136x2.h"
+/*
+ *  MODE_DEV_TOOL 0xFF
+ *      DEV_TOOL_VERSION [34 LL FF 01]
+ * 
+ *      DEV_TOOL_BAT     [34 LL FF 02]
+ * 
+ *      DEV_TOOL_TEMP    [34 LL FF 03]
+ * 
+ *      DEV_TOOL_LED     [34 LL FF 04]
+ *          DEV_LED_LIMIT_COLOR [00 NN]
+ *          DEV_LED_DARK_COLOR  [01 RR GG BB]
+ *          DEV_LED_LIGHT_COLOR [02 RR GG BB]
+ *          DEV_LED_RAINBOW     [03]
+ * 
+ *      DEV_TOOL_SPI     [34 LL FF 20 pp RR WW ss ss ss ...]
+ *          DT_CHIP_ADC     pp = [00]
+ *          DT_CHIP_DAC     pp = [01]
+ *          DT_CHIP_MEM     pp = [02]
+ *          DT_CHIP_SWITCH  pp = [03]
+ * 
+ *      DEV_TOOL_I2C     [34 LL FF 28 qq RR WW ss ss ss ...]
+ * 
+ *      DEV_TOOL_GPIO_EDC20_ADC_CH [34 LL FF 31 cc]
+ *         cc = 07 => all open
+ *         cc = 04 => open A2
+ *         cc = 02 => open A1
+ *         cc = 01 => open A0                 
+ *
+ */
+
+
+
+enum dev_tool_para_e {
+    DEV_TOOL_VERSION        = 0x01,
+    DEV_TOOL_BAT            = 0x02,
+    DEV_TOOL_TEMP           = 0x03,
+    DEV_TOOL_LED            = 0x04,
+    DEV_TOOL_SPI            = 0x20,
+    DEV_TOOL_I2C            = 0x28,
+    DEV_TOOL_GPIO_EDC20_ADC_CH = 0x31,
+    DEV_TOOL_MCP23008_PB = 0x32,
+    DEV_TOOL_MCP23008_PA = 0x33,
+    DEV_TOOL_MCP23008_RD = 0x34,
+    DEV_TOOL_OUT0_WRITE_THROUGH = 0x50,
+    DEV_TOOL_SWITCH_SELECT = 0x60,
+};
+
+enum dev_tool_chip_e {
+    DT_CHIP_ADC             = 0,
+    DT_CHIP_DAC,
+    DT_CHIP_MEM,
+    DT_CHIP_SWITCH,
+    DT_OPEN_SPI1            = 0x11,
+
+    DT_CHIP_MAX,
+};
+
+enum dev_led_item_e {
+  DEV_LED_LIMIT_COLOR       = 0,
+  DEV_LED_DARK_COLOR,
+  DEV_LED_LIGHT_COLOR,
+  DEV_LED_RAINBOW,
+
+  DEV_LED_MAX,
+};
+
+static void dev_tool_version()
+{
+    initCISBuf();
+    cis_buf[0] = 6; //data len
+    cis_buf[1] = DEV_TOOL_VERSION;
+    cis_buf[2] = VERSION_DATE_YEAR;
+    cis_buf[3] = VERSION_DATE_MONTH;
+    cis_buf[4] = VERSION_DATE_DAY;
+    cis_buf[5] = VERSION_DATE_HOUR;
+    cis_buf[6] = VERSION_DATE_MINUTE;
+    SimpleProfile_SetParameter(BLE_CIS_BUFF_CHAR, BLE_CIS_BUFF_SIZE, cis_buf);
+}
+
+static void dev_tool_battery()
+{
+    uint32_t bat;
+    bat = headstage_battery_volt();
+
+    initCISBuf();
+    cis_buf[0] = 5;  //data len
+    cis_buf[1] = DEV_TOOL_BAT;
+    memcpy(&cis_buf[2], (uint8_t *)&bat, sizeof(bat));
+
+    SimpleProfile_SetParameter(BLE_CIS_BUFF_CHAR, BLE_CIS_BUFF_SIZE, cis_buf);
+}
+
+static void dev_tool_temp()
+{
+    int32_t t;
+            
+    t = headstage_temperature();
+
+    initCISBuf();
+    cis_buf[0] = 5; //data len
+    cis_buf[1] = DEV_TOOL_TEMP;
+    memcpy(&cis_buf[2], (uint8_t *)&t, sizeof(t));
+    SimpleProfile_SetParameter(BLE_CIS_BUFF_CHAR, BLE_CIS_BUFF_SIZE, cis_buf);
+}
+
+static int dev_tool_led(uint8_t *ins_buf)
+{
+    uint8_t *p = ins_buf;
+    struct led_color_t led_c;
+    uint8_t led_item = p[4];
+    uint8_t c_num = p[5];
+
+    led_c.r = p[5];
+    led_c.g = p[6];
+    led_c.b = p[7];
+
+    if (led_item >= DEV_LED_MAX)
+        return -1;
+
+    if (led_item == DEV_LED_RAINBOW)
+        return led_rainbow(LED_BR_LV1);
+
+    if (led_item == DEV_LED_LIMIT_COLOR)
+        return led_color_set(LED_NB_MAX, LED_BR_LV1, (enum led_color_e)c_num);
+
+    if (led_item == DEV_LED_DARK_COLOR)
+        return led_color_code_set(LED_NB_MAX, LED_BR_LV1, &led_c);
+
+    if (led_item == DEV_LED_LIGHT_COLOR)
+        return led_color_code_set(LED_NB_MAX, LED_BR_LV8, &led_c);
+
+    return 0;
+}
+
+static void dev_tool_spi(uint8_t *ins_buf)
+{
+    uint8_t *p = ins_buf;
+    uint8_t chip_sel = p[4];
+    
+    //ADC、DAC、MEM、SWITCH
+    uint8_t rxlen = p[5];
+    uint8_t txlen = p[6];
+    uint8_t tx[250] = {0};
+    uint8_t rx[250] = {0};
+
+    //set spi config
+    uint8_t pol = p[5] >> 4;
+    uint8_t pha = p[5] & 0X0F;
+
+    if (chip_sel >= DT_CHIP_MAX)
+        return;
+    
+    switch (chip_sel) {
+        case DT_CHIP_ADC:
+            pin_set(E_PIN_ADCCS, 0);
+            memcpy(tx, &p[7], txlen);
+            spi1_write(rx, tx, txlen);
+            pin_set(E_PIN_ADCCS, 1);
+            break;
+
+        case DT_CHIP_DAC:
+            pin_set(E_PIN_DACCS, 0);
+            memcpy(tx, &p[7], txlen);
+            spi1_write(rx, tx, txlen);
+            pin_set(E_PIN_DACCS, 1);
+            break;
+
+        case DT_CHIP_MEM:
+            pin_set(E_PIN_MEMCS, 0);
+            memcpy(tx, &p[7], txlen);
+            spi1_write(rx, tx, txlen);
+            pin_set(E_PIN_MEMCS, 1);
+            break;
+
+        case DT_CHIP_SWITCH:
+            pin_set(E_PIN_SWCSBB, 0);
+            memcpy(tx, &p[7], txlen);
+            spi1_write(rx, tx, txlen);
+            pin_set(E_PIN_SWCSBB, 1);
+            break;
+
+        case DT_OPEN_SPI1:
+            spi1_close();
+            spi1_open(SPI_CLK_4M, pol, pha);
+            break;
+
+    }
+
+    initCISBuf();
+    cis_buf[0] = rxlen + 1;  //data len
+    cis_buf[1] = DEV_TOOL_SPI;
+    memcpy(&cis_buf[2], rx, rxlen);
+    SimpleProfile_SetParameter(BLE_CIS_BUFF_CHAR, BLE_CIS_BUFF_SIZE, cis_buf);
+
+}
+
+static void dev_tool_i2c(uint8_t *ins_buf)
+{
+    uint8_t *p = ins_buf;
+    struct i2c_para_t i2c_send;
+    struct i2c_para_t *send = &i2c_send;
+
+    send->i2c_addr = p[4];
+    send->i2c_rxlen = p[5];
+    send->i2c_txlen = p[6];
+    memcpy(send->i2c_tx, &p[7], send->i2c_txlen);
+    
+    i2c0_write(send);
+
+    initCISBuf();
+    cis_buf[0] = send->i2c_rxlen + 2;  //data len
+    cis_buf[1] = DEV_TOOL_I2C;
+    memcpy(&cis_buf[2], send->i2c_rx, send->i2c_rxlen);
+    SimpleProfile_SetParameter(BLE_CIS_BUFF_CHAR, BLE_CIS_BUFF_SIZE, cis_buf);
+}
+
+static void dev_tool_gpio_edc20_adc_ch(uint8_t *ins_buf)
+{
+    uint8_t *p = ins_buf;
+    uint8_t adc_selector = p[4];
+    
+    adc_sel_set(adc_selector);
+
+}
+
+static void dev_tool_dac_write(uint8_t *ins_buf)
+{
+    
+    
+    uint8_t *p = ins_buf;
+    dac_series_control_g[DAC_NB_0].dac0_enable = (p[4] & 0xf0) >> 4;
+    dac_series_control_g[DAC_NB_0].dac1_enable = (p[4] & 0x0f);
+    dac_series_control_g[DAC_NB_0].volts = (uint16_t) p[5] << 8 | (uint16_t) p[6]; 
+
+    dac_series_control_g[DAC_NB_1].dac0_enable = (p[7] & 0xf0) >> 4;
+    dac_series_control_g[DAC_NB_1].dac1_enable = (p[7] & 0x0f);
+    dac_series_control_g[DAC_NB_1].volts = (uint16_t) p[8] << 8 | (uint16_t) p[9]; 
+
+    dac_enable_all_output(dac_series_control_g);
+}
+
+
+static void dev_tool_dac_write_single(uint8_t *ins_buf) {
+    uint8_t *p = ins_buf;
+    uint8_t dac0_enable = (p[4] & 0xf0) >> 4;
+    uint8_t dac1_enable = (p[4] & 0x0f);
+    uint16_t volts = (uint16_t) p[5] << 8 | (uint16_t) p[6];
+    enum MAX5136_num_e dac_num = (enum MAX5136_num_e) p[7];
+
+    dac_enable_single_output(dac0_enable, dac1_enable, volts, dac_num);
+}
+
+static void dev_tool_switch_select(uint8_t *ins_buf)
+{
+    uint8_t *p = ins_buf;
+    
+    uint8_t switch_module_number = p[4];
+    uint8_t enable_type = p[5];
+
+    switch_ctrl(switch_module_number, enable_type);
+}
+
+static void dev_tool_mcp23008_pb(uint8_t *ins_buf)    //3000FF32
+{                                                                
+    uint8_t *p = ins_buf;
+    
+    enum mcp23008_gpio_e pin_n = (enum mcp23008_gpio_e)p[4];       // 0x00~0x07: PBx
+    uint8_t register_n = p[5];  // 0x00:IODIR     0x09:GPIO
+    uint8_t _v = p[6];          // 0:low 1:hogh  0:output 1:input
+    uint8_t re_val = 0;
+
+    if (register_n == 9) { // gpio:high/low
+        chip_MCP23008_set(MCP23008_MODULE_U503, MCP23008_REG_GPIO, pin_n, _v);
+        re_val = chip_MCP23008_rd_reg_stat(MCP23008_MODULE_U503, MCP23008_REG_GPIO);
+    } else if (register_n == 0) { // iodir:input-1/output-0
+        chip_MCP23008_set(MCP23008_MODULE_U503, MCP23008_REG_IODIR, pin_n, _v);
+        re_val = chip_MCP23008_rd_reg_stat(MCP23008_MODULE_U503, MCP23008_REG_IODIR);
+    }
+
+    initCISBuf();
+    cis_buf[0] = 2;  //data len
+    cis_buf[1] = DEV_TOOL_MCP23008_PB;
+    memcpy(&cis_buf[2], &re_val, 1);
+    SimpleProfile_SetParameter(BLE_CIS_BUFF_CHAR, BLE_CIS_BUFF_SIZE, cis_buf);
+}
+
+static void dev_tool_mcp23008_pa(uint8_t *ins_buf)    //3000FF33
+{                                                                
+    uint8_t *p = ins_buf;
+    
+    enum mcp23008_gpio_e pin_n = (enum mcp23008_gpio_e)p[4];       // 0x00~0x07: PAx
+    uint8_t register_n = p[5];  // 0x00:IODIR     0x09:GPIO
+    uint8_t _v = p[6];          // 0:low 1:hogh  0:output 1:input
+    uint8_t re_val = 0;
+
+    if (register_n == 9) { // gpio:high/low
+        chip_MCP23008_set(MCP23008_MODULE_U505, MCP23008_REG_GPIO, pin_n, _v);
+        re_val = chip_MCP23008_rd_reg_stat(MCP23008_MODULE_U505, MCP23008_REG_GPIO);
+    } else if (register_n == 0) { // iodir:input-1/output-0
+        chip_MCP23008_set(MCP23008_MODULE_U505, MCP23008_REG_IODIR, pin_n, _v);
+        re_val = chip_MCP23008_rd_reg_stat(MCP23008_MODULE_U505, MCP23008_REG_IODIR);
+    }
+
+    initCISBuf();
+    cis_buf[0] = 2;  //data len
+    cis_buf[1] = DEV_TOOL_MCP23008_PA;
+    memcpy(&cis_buf[2], &re_val, 1);
+    SimpleProfile_SetParameter(BLE_CIS_BUFF_CHAR, BLE_CIS_BUFF_SIZE, cis_buf);
+}
+
+static void dev_tool_mcp23008_rd(uint8_t *ins_buf)    //3000FF34
+{                                                                
+    uint8_t *p = ins_buf;
+    
+    uint8_t register_n = p[4];  // 0x00:IODIR     0x09:GPIO
+    uint8_t re_val = 0;
+
+    initCISBuf();
+    cis_buf[0] = 5;  //data len
+    cis_buf[1] = DEV_TOOL_MCP23008_RD;
+
+    if (register_n == 9) { // gpio:high/low
+        re_val = chip_MCP23008_rd_reg_stat(MCP23008_MODULE_U505, MCP23008_REG_GPIO);
+        memcpy(&cis_buf[2], &re_val, 1);
+        re_val = chip_MCP23008_rd_reg_stat(MCP23008_MODULE_U503, MCP23008_REG_GPIO);
+        memcpy(&cis_buf[3], &re_val, 1);
+
+    } else if (register_n == 0) { // iodir:input-1/output-0
+        re_val = chip_MCP23008_rd_reg_stat(MCP23008_MODULE_U505, MCP23008_REG_IODIR);
+        memcpy(&cis_buf[2], &re_val, 1);
+        re_val = chip_MCP23008_rd_reg_stat(MCP23008_MODULE_U503, MCP23008_REG_IODIR);
+        memcpy(&cis_buf[3], &re_val, 1);
+    }
+
+    SimpleProfile_SetParameter(BLE_CIS_BUFF_CHAR, BLE_CIS_BUFF_SIZE, cis_buf);
+}
+
+static void mode_dev_tool(uint8_t *ins_buf)
+{
+    uint8_t *p = ins_buf;
+    uint8_t dev_item = p[3];
+
+    switch (dev_item) {
+        case DEV_TOOL_VERSION:
+            dev_tool_version();
+            break;
+
+        case DEV_TOOL_BAT:
+            dev_tool_battery();
+            break;
+
+        case DEV_TOOL_TEMP:
+            dev_tool_temp();
+            break;
+
+        case DEV_TOOL_LED:
+            dev_tool_led(p);
+            break;
+
+        case DEV_TOOL_SPI:
+            dev_tool_spi(p);
+            break;
+
+        case DEV_TOOL_I2C:
+            dev_tool_i2c(p);
+            break;
+
+        case DEV_TOOL_GPIO_EDC20_ADC_CH:
+            dev_tool_gpio_edc20_adc_ch(p);
+            break;
+            
+        case DEV_TOOL_OUT0_WRITE_THROUGH: 
+            dev_tool_dac_write(p);
+            break;
+
+        case DEV_TOOL_SWITCH_SELECT:
+            dev_tool_switch_select(p);
+            break;
+        case DEV_TOOL_MCP23008_PB:
+            dev_tool_mcp23008_pb(p);
+            break;        
+        case DEV_TOOL_MCP23008_PA:
+            dev_tool_mcp23008_pa(p);
+            break;
+        case DEV_TOOL_MCP23008_RD:
+            dev_tool_mcp23008_rd(p);
+            break;  
+        default:
+            break;
+        
+    }
+
+    return;
+}

simplelink/ble_sdk_2_02_02_25/src/examples/simple_peripheral/cc26xx/app/simple_peripheral.c

@@ -9,7 +9,7 @@
  Target Device: CC2650, CC2640
 
  ******************************************************************************
- 
+
  Copyright (c) 2013-2018, Texas Instruments Incorporated
  All rights reserved.
 
@@ -105,11 +105,11 @@
 #ifndef FEATURE_OAD
 // Minimum connection interval (units of 1.25ms, 80=100ms) if automatic
 // parameter update request is enabled
-#define DEFAULT_DESIRED_MIN_CONN_INTERVAL     80
+#define DEFAULT_DESIRED_MIN_CONN_INTERVAL     6	//ori:80
 
 // Maximum connection interval (units of 1.25ms, 800=1000ms) if automatic
 // parameter update request is enabled
-#define DEFAULT_DESIRED_MAX_CONN_INTERVAL     800
+#define DEFAULT_DESIRED_MAX_CONN_INTERVAL     6 //ori:800
 #else //!FEATURE_OAD
 // Minimum connection interval (units of 1.25ms, 8=10ms) if automatic
 // parameter update request is enabled
@@ -147,7 +147,7 @@
 
 
 #ifndef SBP_TASK_STACK_SIZE
-#define SBP_TASK_STACK_SIZE                   644
+#define SBP_TASK_STACK_SIZE                   844 //ori:644
 #endif
 
 // Internal Events for RTOS application
@@ -155,6 +155,7 @@
 #define SBP_CHAR_CHANGE_EVT                   0x0002
 #define SBP_PERIODIC_EVT                      0x0004
 #define SBP_CONN_EVT_END_EVT                  0x0008
+#define SBP_KEY_CHANGE_EVT                    0x0010
 
 /*********************************************************************
  * TYPEDEFS
@@ -181,7 +182,7 @@ typedef struct
 static ICall_EntityID selfEntity;
 
 // Semaphore globally used to post events to the application thread
-static ICall_Semaphore sem;
+static ICall_Semaphore semaphore;
 
 // Clock instances for internal periodic events.
 static Clock_Struct periodicClock;
@@ -207,6 +208,7 @@ Char sbpTaskStack[SBP_TASK_STACK_SIZE];
 //static gaprole_States_t gapProfileState = GAPROLE_INIT;
 
 // GAP - SCAN RSP data (max size = 31 bytes)
+/*
 static uint8_t scanRspData[] =
 {
   // complete name
@@ -245,6 +247,7 @@ static uint8_t scanRspData[] =
   GAP_ADTYPE_POWER_LEVEL,
   0       // 0dBm
 };
+*/
 
 // GAP - Advertisement data (max size = 31 bytes, though this is
 // best kept short to conserve power while advertisting)
@@ -276,7 +279,7 @@ static uint8_t advertData[] =
 };
 
 // GAP GATT Attributes
-static uint8_t attDeviceName[GAP_DEVICE_NAME_LEN] = "Simple BLE Peripheral";
+// static uint8_t attDeviceName[GAP_DEVICE_NAME_LEN] = "Simple BLE Peripheral";
 
 // Globals used for ATT Response retransmission
 static gattMsgEvent_t *pAttRsp = NULL;
@@ -293,9 +296,9 @@ static uint8_t SimpleBLEPeripheral_processStackMsg(ICall_Hdr *pMsg);
 static uint8_t SimpleBLEPeripheral_processGATTMsg(gattMsgEvent_t *pMsg);
 static void SimpleBLEPeripheral_processAppMsg(sbpEvt_t *pMsg);
 static void SimpleBLEPeripheral_processStateChangeEvt(gaprole_States_t newState);
-static void SimpleBLEPeripheral_processCharValueChangeEvt(uint8_t paramID);
+// static void SimpleBLEPeripheral_processCharValueChangeEvt(uint8_t paramID);
 static void SimpleBLEPeripheral_performPeriodicTask(void);
-static void SimpleBLEPeripheral_clockHandler(UArg arg);
+// static void SimpleBLEPeripheral_clockHandler(UArg arg);
 
 static void SimpleBLEPeripheral_sendAttRsp(void);
 static void SimpleBLEPeripheral_freeAttRsp(uint8_t status);
@@ -393,7 +396,7 @@ static void SimpleBLEPeripheral_init(void)
   // ******************************************************************
   // Register the current thread as an ICall dispatcher application
   // so that the application can send and receive messages.
-  ICall_registerApp(&selfEntity, &sem);
+  ICall_registerApp(&selfEntity, &semaphore);
 
 #ifdef USE_RCOSC
   RCOSC_enableCalibration();
@@ -421,8 +424,8 @@ static void SimpleBLEPeripheral_init(void)
   appMsgQueue = Util_constructQueue(&appMsg);
 
   // Create one-shot clocks for internal periodic events.
-  Util_constructClock(&periodicClock, SimpleBLEPeripheral_clockHandler,
-                      SBP_PERIODIC_EVT_PERIOD, 0, false, SBP_PERIODIC_EVT);
+  // Util_constructClock(&periodicClock, SimpleBLEPeripheral_clockHandler,
+  //                     SBP_PERIODIC_EVT_PERIOD, 0, false, SBP_PERIODIC_EVT);
 
   // dispHandle = Display_open(Display_Type_LCD, NULL);
 
@@ -451,8 +454,8 @@ static void SimpleBLEPeripheral_init(void)
     GAPRole_SetParameter(GAPROLE_ADVERT_OFF_TIME, sizeof(uint16_t),
                          &advertOffTime);
 
-    GAPRole_SetParameter(GAPROLE_SCAN_RSP_DATA, sizeof(scanRspData),
-                         scanRspData);
+    // GAPRole_SetParameter(GAPROLE_SCAN_RSP_DATA, sizeof(scanRspData),
+    //                      scanRspData);
     GAPRole_SetParameter(GAPROLE_ADVERT_DATA, sizeof(advertData), advertData);
 
     GAPRole_SetParameter(GAPROLE_PARAM_UPDATE_ENABLE, sizeof(uint8_t),
@@ -468,7 +471,7 @@ static void SimpleBLEPeripheral_init(void)
   }
 
   // Set the GAP Characteristics
-  GGS_SetParameter(GGS_DEVICE_NAME_ATT, GAP_DEVICE_NAME_LEN, attDeviceName);
+  // GGS_SetParameter(GGS_DEVICE_NAME_ATT, GAP_DEVICE_NAME_LEN, attDeviceName);
 
   // Set advertising interval
   {
@@ -521,18 +524,18 @@ static void SimpleBLEPeripheral_init(void)
   {
     uint8_t charValue1 = 1;
     uint8_t charValue2 = 2;
-    uint8_t charValue3 = 3;
-    uint8_t charValue4 = 4;
+    uint8_t charValue3[SIMPLEPROFILE_CHAR3_LEN] = {0};
+    uint8_t charValue4[SIMPLEPROFILE_CHAR4_LEN] = {0};
     uint8_t charValue5[SIMPLEPROFILE_CHAR5_LEN] = { 1, 2, 3, 4, 5 };
 
     SimpleProfile_SetParameter(SIMPLEPROFILE_CHAR1, sizeof(uint8_t),
                                &charValue1);
     SimpleProfile_SetParameter(SIMPLEPROFILE_CHAR2, sizeof(uint8_t),
                                &charValue2);
-    SimpleProfile_SetParameter(SIMPLEPROFILE_CHAR3, sizeof(uint8_t),
-                               &charValue3);
-    SimpleProfile_SetParameter(SIMPLEPROFILE_CHAR4, sizeof(uint8_t),
-                               &charValue4);
+    SimpleProfile_SetParameter(SIMPLEPROFILE_CHAR3, SIMPLEPROFILE_CHAR3_LEN,
+                               charValue3);
+    SimpleProfile_SetParameter(SIMPLEPROFILE_CHAR4, SIMPLEPROFILE_CHAR4_LEN,
+                               charValue4);
     SimpleProfile_SetParameter(SIMPLEPROFILE_CHAR5, SIMPLEPROFILE_CHAR5_LEN,
                                charValue5);
   }
@@ -554,6 +557,7 @@ static void SimpleBLEPeripheral_init(void)
   GATT_RegisterForMsgs(selfEntity);
 
   HCI_LE_ReadMaxDataLenCmd();
+
 /*
 #if defined FEATURE_OAD
 #if defined (HAL_IMAGE_A)
@@ -567,6 +571,204 @@ static void SimpleBLEPeripheral_init(void)
 */
 }
 
+#include "application/BAT_10_app.h"
+#include "application_config/application_config.h"
+#include "HAL/cc2650_driver/spi_ctrl.h"
+#include "HAL/cc2650_driver/i2c_ctrl.h"
+#include "HAL/APA102_2020_256_8x4.h"
+#include "HAL/MCP23008x2.h"
+#include "HAL/MAX5136x2.h"
+#include "unfinished_code.h"
+
+#include "devinfoservice.h"
+#include "gapgattserver.h"
+#include "gattservapp.h"
+
+struct date_t {
+    uint8_t year;
+    uint8_t month;
+    uint8_t day;
+};
+
+struct device_info_t {
+    struct date_t date;
+};
+
+struct device_info_t device_info;
+
+void get_date(struct date_t *date)
+{
+    const char *months[12] = {"Jan", "Feb", "Mar", "Apr", "May", "Jun",
+                              "Jul", "Aug", "Sep", "Oct", "Nov", "Dec"};
+    struct date_t *d = date;
+    char year_s[5] = {0};
+    char month_s[4] = {0};
+    char day_s[3] = {0};
+    int i;
+    char date_now[] = __DATE__;
+
+    memcpy(year_s, date_now + 9, 2);
+    memcpy(month_s, date_now, 3);
+    memcpy(day_s, date_now + 4, 2);
+
+    d->year = atoi(year_s);
+    d->day = atoi(day_s);
+    for (i=0; i<12; i++) {
+        if (!strcmp(month_s, months[i])) {
+            d->month = i + 1;
+            break;
+        }
+    }
+
+    return;
+}
+
+static void headstage_init_device_info() {
+    uint8_t  scan_rsp_data[64] = {9};
+    uint8_t *p = scan_rsp_data;
+    struct device_info_t *dev = &device_info;
+    int i;
+
+    get_date(&device_info.date);
+
+    *p++ = sizeof(DEVICE_NAME);                                  // 10
+    *p++ = GAP_ADTYPE_LOCAL_NAME_COMPLETE;                       // 09
+    for (i=0; i<sizeof(DEVICE_NAME)-1; i++) {
+        *p++ = DEVICE_NAME[i];
+    }                                                            // 69 108 105 116 101 45 69 73 83
+    *p++ = 16;                                                   // 16
+    *p++ = GAP_ADTYPE_MANUFACTURER_SPECIFIC;                     // 255
+    *p++ = 'B';                                                  // 66
+    *p++ = 'P';                                                  // 80
+    *p++ = 'H';                                                  // 72
+    *p++ = 'S';                                                  // 83
+    *p++ = MAJOR_PRODUCT_NUMBER;                                 // 0
+    *p++ = MINOR_PRODUCT_NUMBER;                                 // 4
+    *p++ = MAJOR_VERSION_NUMBER;                                 // 1
+    *p++ = MINOR_VERSION_NUMBER;                                 // 0
+    *p++ = dev->date.year;                                       // 22
+    *p++ = dev->date.month;                                      // 07
+    *p++ = 'B';                                                  // 66
+    *p++ = 'A';                                                  // 65
+    *p++ = 'T';                                                  // 84
+    *p++ = (uint8_t)(NotifyVoltBat);                                    // 44
+    *p++ = (uint8_t)(NotifyVoltBat >> 8);                                // 33
+
+    GGS_SetParameter(GGS_DEVICE_NAME_ATT, sizeof(DEVICE_NAME), DEVICE_NAME);
+
+    GAPRole_SetParameter(GAPROLE_SCAN_RSP_DATA, p - scan_rsp_data, scan_rsp_data);
+}
+
+// #include "EliteGPTimer.h"
+
+
+#include <Board.h>
+#include <ti/drivers/timer/GPTimerCC26XX.h>
+#include <ti/sysbios/BIOS.h>
+#include <xdc/runtime/Types.h>
+
+
+static GPTimerCC26XX_Handle gptimer_handle;
+void elite_gptimer_task(void);
+static void elite_gptimer_callback(GPTimerCC26XX_Handle handle, GPTimerCC26XX_IntMask interruptMask);
+
+#define elite_gptimer_start() GPTimerCC26XX_start(gptimer_handle)
+#define elite_gptimer_stop() GPTimerCC26XX_stop(gptimer_handle)
+#define elite_gptimer_close() GPTimerCC26XX_close(gptimer_handle)
+#define CLOCK_FREQ 4769  // clock freq = 0.1 ms(4800), Measured(4769)
+
+static void elite_gptimer_callback(GPTimerCC26XX_Handle handle, GPTimerCC26XX_IntMask interruptMask) {
+    elite_gptimer_task();
+
+    return;
+}
+
+#define elite_gptimer_open()                                                                          \
+    do {                                                                                              \
+        GPTimerCC26XX_Params params;                                                                  \
+        GPTimerCC26XX_Params_init(&params);                                                           \
+        params.width          = GPT_CONFIG_16BIT;                                                     \
+        params.mode           = GPT_MODE_PERIODIC_UP;                                               \
+        params.debugStallMode = GPTimerCC26XX_DEBUG_STALL_OFF;                                        \
+        gptimer_handle        = GPTimerCC26XX_open(Board_GPTIMER0A, &params);                         \
+        Types_FreqHz  freq;                                                                           \
+        BIOS_getCpuFreq(&freq);                                                                       \
+        GPTimerCC26XX_Value loadVal = freq.lo / 1000 - 1; /*47999*/                                   \
+        GPTimerCC26XX_setLoadValue(gptimer_handle, loadVal);                                          \
+        GPTimerCC26XX_setLoadValue(gptimer_handle, CLOCK_FREQ); /* 0.1 ms*/                           \
+        GPTimerCC26XX_registerInterrupt(gptimer_handle, elite_gptimer_callback, GPT_INT_TIMEOUT);     \
+    } while (0)
+
+
+#define TIMER_SEC(_v)   (_v * 10000)
+#define TIMER_mSEC(_v)   (_v * 10)
+
+static void key_manage(uint32_t delta_time)
+{
+    uint32_t t = delta_time;
+    static uint32_t keyTimer = 0;
+    static bool byPass1sec = false;
+    if (!PUSH_KEY) {
+        if (keyTimer > 0) {
+            checkFlafLED();
+            byPass1sec = false;
+        }
+        keyTimer = 0;
+        return;
+    }
+    keyTimer = keyTimer + t;
+    if (keyTimer >= TIMER_SEC(3)){
+        chip_MCP23008_set(MCP23008_PB, MCP23008_REG_GPIO, MCP23008_P0, 0); //close 15V
+        chip_MCP23008_set(MCP23008_PB, MCP23008_REG_GPIO, MCP23008_P1, 1);
+        SET_VLOGIC_EN_GPIO(0);
+        chip_MCP23008_set(MCP23008_PB, MCP23008_REG_GPIO, MCP23008_P7, 1); //SET_SHUTDOWN_GPIO
+    } else if (keyTimer >= TIMER_SEC(1) && !byPass1sec) {
+        led_color_set(LED_NB_MAX, LED_BR_LV1, LED_CLR_ORANGE);
+        byPass1sec = true;
+    }
+    return;
+}
+
+void elite_gptimer_task(void)
+{
+    events |= SBP_PERIODIC_EVT;
+    Semaphore_post(semaphore);
+    GPT.cnt_gpt++;
+}
+
+static bool power_on(uint32_t delta_time)
+{   
+    uint32_t t = delta_time;
+    bool elite_on = false;
+    static uint32_t keyTimer = 0;
+
+    keyTimer = keyTimer + t;
+
+    if (keyTimer >= TIMER_SEC(1)) {
+
+        chip_MCP23008_set(MCP23008_PB, MCP23008_REG_GPIO, MCP23008_PIN_ALL, 0x22);
+        chip_MCP23008_set(MCP23008_PB, MCP23008_REG_IODIR, MCP23008_PIN_ALL, 0x58);
+        chip_MCP23008_set(MCP23008_PA, MCP23008_REG_GPIO, MCP23008_PIN_ALL, 0x74);
+        chip_MCP23008_set(MCP23008_PA, MCP23008_REG_IODIR, MCP23008_PIN_ALL, 0x00);
+
+        SET_VLOGIC_EN_GPIO(1);
+        SET_VLOGIC_EN_IODIR(P_OUTPUT);
+        ModeLED(BT_WAIT);
+        
+        SET_SW_EN_GPIO(0);
+        chip_MCP23008_set(MCP23008_PB, MCP23008_REG_GPIO, MCP23008_P0, 1);
+        chip_MCP23008_set(MCP23008_PB, MCP23008_REG_GPIO, MCP23008_P1, 0);
+        //chip_MCP23008_set(MCP23008_PA, MCP23008_REG_GPIO, MCP23008_P2, 0);   // bat0.1 need
+
+        chip_MCP23008_set(MCP23008_PA, MCP23008_REG_GPIO, MCP23008_P2, 0);
+        
+        keyTimer = 0;
+        elite_on = true;
+    }
+
+    return elite_on;
+}
+
 /*********************************************************************
  * @fn      SimpleBLEPeripheral_taskFxn
  *
@@ -578,101 +780,183 @@ static void SimpleBLEPeripheral_init(void)
  */
 static void SimpleBLEPeripheral_taskFxn(UArg a0, UArg a1)
 {
-  // Initialize application
-  SimpleBLEPeripheral_init();
+    batteryADC_flag = false;
 
-  // Application main loop
-  for (;;)
-  {
-    // Waits for a signal to the semaphore associated with the calling thread.
-    // Note that the semaphore associated with a thread is signaled when a
-    // message is queued to the message receive queue of the thread or when
-    // ICall_signal() function is called onto the semaphore.
-    ICall_Errno errno = ICall_wait(ICALL_TIMEOUT_FOREVER);
+    // Initialize application
+    SimpleBLEPeripheral_init();
 
-    if (errno == ICALL_ERRNO_SUCCESS)
-    {
-      ICall_EntityID dest;
-      ICall_ServiceEnum src;
-      ICall_HciExtEvt *pMsg = NULL;
+    gpio_create();
 
-      if (ICall_fetchServiceMsg(&src, &dest,
-                                (void **)&pMsg) == ICALL_ERRNO_SUCCESS)
-      {
-        uint8 safeToDealloc = TRUE;
+    spi0_open(SPI_CLK_10M, POL0, PHA1); //10M   // SPI0  = LED
+    spi1_open(SPI_CLK_10M, POL0, PHA1); //10M   // SPI1  = ADC. DAC
 
-        if ((src == ICALL_SERVICE_CLASS_BLE) && (dest == selfEntity))
-        {
-          ICall_Stack_Event *pEvt = (ICall_Stack_Event *)pMsg;
+    i2c0_open(I2C_400K);
 
-          // Check for BLE stack events first
-          if (pEvt->signature == 0xffff)
-          {
-            if (pEvt->event_flag & SBP_CONN_EVT_END_EVT)
-            {
-              // Try to retransmit pending ATT Response (if any)
-              SimpleBLEPeripheral_sendAttRsp();
+    elite_gptimer_open();
+    elite_gptimer_start();
+
+    InitEliteInstruction();
+
+
+
+    // headstage_battery_volt();
+    headstage_init_device_info();
+
+    bool elite_on;
+    uint32_t check_key_time = 0;
+
+    InitGPT();
+
+    // power on elite
+    while(1) {
+        if (events & SBP_PERIODIC_EVT) {
+            events &= ~SBP_PERIODIC_EVT;
+
+            GPT.cnt_gpt_delta = GPT.cnt_gpt - GPT.cnt_gpt0;
+            GPT.cnt_gpt0 = GPT.cnt_gpt;
+            elite_on = power_on(GPT.cnt_gpt_delta);
+        }
+
+        if (elite_on)
+            break;
+    }
+
+    // Application main loop
+    for (;;) {
+        // Waits for a signal to the semaphore associated with the calling thread.
+        // Note that the semaphore associated with a thread is signaled when a
+        // message is queued to the message receive queue of the thread or when
+        // ICall_signal() function is called onto the semaphore.
+
+
+        ICall_Errno errno = ICall_wait(ICALL_TIMEOUT_FOREVER); // let errno wait for infinite time, if periodicClock time up then execute below code
+        if (errno == ICALL_ERRNO_SUCCESS) {
+            ICall_EntityID dest;
+            ICall_ServiceEnum src;
+            ICall_HciExtEvt *pMsg = NULL;
+
+            if (ICall_fetchServiceMsg(&src, &dest,
+                                      (void **)&pMsg) == ICALL_ERRNO_SUCCESS) {
+                uint8 safeToDealloc = TRUE;
+
+                if ((src == ICALL_SERVICE_CLASS_BLE) && (dest == selfEntity)) {
+                    ICall_Stack_Event *pEvt = (ICall_Stack_Event *)pMsg;
+
+                    // Check for BLE stack events first
+                    if (pEvt->signature == 0xffff) {
+                        if (pEvt->event_flag & SBP_CONN_EVT_END_EVT) {
+                          // Try to retransmit pending ATT Response (if any)
+                          SimpleBLEPeripheral_sendAttRsp();
+                        }
+                    } else {
+                        // Process inter-task message
+                        safeToDealloc = SimpleBLEPeripheral_processStackMsg((ICall_Hdr *)pMsg);
+                    }
+                }
+
+                if (pMsg && safeToDealloc) {
+                    ICall_freeMsg(pMsg);
+                }
+            }
+
+            // If RTOS queue is not empty, process app message.
+            while (!Queue_empty(appMsgQueue)) {
+                sbpEvt_t *pMsg = (sbpEvt_t *)Util_dequeueMsg(appMsgQueue);
+                if (pMsg) {
+                      // Process message.
+                      SimpleBLEPeripheral_processAppMsg(pMsg);
+
+                      // Free the space from the message.
+                      ICall_free(pMsg);
+                }
             }
-          }
-          else
-          {
-            // Process inter-task message
-            safeToDealloc = SimpleBLEPeripheral_processStackMsg((ICall_Hdr *)pMsg);
-          }
         }
 
-        if (pMsg && safeToDealloc)
-        {
-          ICall_freeMsg(pMsg);
-        }
-      }
+       if (events & SBP_PERIODIC_EVT) {
+            events &= ~SBP_PERIODIC_EVT;
+            GPT.cnt_gpt_delta = GPT.cnt_gpt - GPT.cnt_gpt0;
+            GPT.cnt_gpt0 = GPT.cnt_gpt;
+            
+            check_key_time = check_key_time + GPT.cnt_gpt_delta;
+            if (check_key_time >= TIMER_mSEC(20)) {
+                key_manage(TIMER_mSEC(20));
+                check_key_time = 0;
+            }
+            
 
-      // If RTOS queue is not empty, process app message.
-      while (!Queue_empty(appMsgQueue))
-      {
-        sbpEvt_t *pMsg = (sbpEvt_t *)Util_dequeueMsg(appMsgQueue);
-        if (pMsg)
-        {
-          // Process message.
-          SimpleBLEPeripheral_processAppMsg(pMsg);
 
-          // Free the space from the message.
-          ICall_free(pMsg);
-        }
-      }
-    }
+            //led_manage(GPT.cnt_gpt_delta);
 
-    if (events & SBP_PERIODIC_EVT)
-    {
-      events &= ~SBP_PERIODIC_EVT;
+        //    GPT.cnt_adc_rate = GPT.cnt_adc_rate + GPT.cnt_gpt_delta;
+        //    if(GPT.cnt_adc_rate >= 10000){
+        //        GPT.cnt_adc_rate = 0; //To get right data, ADC must be delay 1.5ms
 
-      Util_startClock(&periodicClock);
+        //    }
 
-      // Perform periodic application task
-      SimpleBLEPeripheral_performPeriodicTask();
-    }
+       }
+
+//        if(events & SBP_PERIODIC_EVT){
+//            events &= ~SBP_PERIODIC_EVT;
+//            if (!PeriodicEvent) {                // if there is no periodic event
+//                key = PIN_getInputValue(SHUT_DOWN);
+//                if (EliteOn) {
+//                    if (counter6994 < CLOCK_ONE_SECOND*5) {  // counter6994 enable a IC after 35 counts
+//                        counter6994++;
+//                    } else if (counter6994 == CLOCK_ONE_SECOND*5) {
+//                        PIN15_setOutputValue(OFF, 0);  // OFF = 1 => turn off 6994
+//                        counter6994++;
+//                    } else if (counter6994 > CLOCK_ONE_SECOND*5) {
+//                        counter6994 = 0;
+//                    }
+//                    EliteKeyPress(key);
+//
+//                    GPT.cnt_gpt_delta = GPT.cnt_gpt - GPT.cnt_gpt0;
+//                    GPT.cnt_gpt0 = GPT.cnt_gpt;
+//
+//                    GPT.BatteryADCCounter = GPT.BatteryADCCounter + GPT.cnt_gpt_delta;
+//                    GPT.BatteryCheckCounter = GPT.BatteryCheckCounter + GPT.cnt_gpt_delta;
+//
+//                    if(key != 0){  //detect Elite battery power when no periodic event
+//                        measureBat();
+//                    }
+//                    if(Free_Work_Mode){
+//                        wm_deinit();
+//                        InitEliteInstruction();
+//                        Free_Work_Mode = false;
+//                    }
+//                } else {
+//                    EliteOn = TurnOnElite(key);
+//                }
+//            }
+//            else {                               // if there is periodic event
+//                if(InitPeriodicEvent){
+//                    wm_init();
+//                    InitPeriodicEvent = false;
+//                }
+//
+//                // Perform periodic application task
+//                SimpleBLEPeripheral_performPeriodicTask();
+//                key = PIN_getInputValue(SHUT_DOWN);
+//                EliteKeyPress(key);  // onPress=> key = 0; 1.lighten LED 2.long press shut down 2650
+//            }
+//        }
 
 #ifdef FEATURE_OAD
-    while (!Queue_empty(hOadQ))
-    {
-      oadTargetWrite_t *oadWriteEvt = Queue_get(hOadQ);
+        while (!Queue_empty(hOadQ)) {
+            oadTargetWrite_t *oadWriteEvt = Queue_get(hOadQ);
 
-      // Identify new image.
-      if (oadWriteEvt->event == OAD_WRITE_IDENTIFY_REQ)
-      {
-        OAD_imgIdentifyWrite(oadWriteEvt->connHandle, oadWriteEvt->pData);
-      }
-      // Write a next block request.
-      else if (oadWriteEvt->event == OAD_WRITE_BLOCK_REQ)
-      {
-        OAD_imgBlockWrite(oadWriteEvt->connHandle, oadWriteEvt->pData);
-      }
+            // Identify new image.
+            if (oadWriteEvt->event == OAD_WRITE_IDENTIFY_REQ) {
+                OAD_imgIdentifyWrite(oadWriteEvt->connHandle, oadWriteEvt->pData);
+            } else if (oadWriteEvt->event == OAD_WRITE_BLOCK_REQ) { // Write a next block request.
+                OAD_imgBlockWrite(oadWriteEvt->connHandle, oadWriteEvt->pData);
+            }
 
-      // Free buffer.
-      ICall_free(oadWriteEvt);
-    }
+            // Free buffer.
+            ICall_free(oadWriteEvt);
+        }
 #endif //FEATURE_OAD
-  }
+    }
 }
 
 /*********************************************************************
@@ -709,7 +993,7 @@ static uint8_t SimpleBLEPeripheral_processStackMsg(ICall_Hdr *pMsg)
               AssertHandler(HAL_ASSERT_CAUSE_HARDWARE_ERROR,0);
             }
             break;
-      
+
           default:
             break;
         }
@@ -863,7 +1147,8 @@ static void SimpleBLEPeripheral_processAppMsg(sbpEvt_t *pMsg) {
         break;
 
     case SBP_CHAR_CHANGE_EVT:
-      SimpleBLEPeripheral_processCharValueChangeEvt(pMsg->hdr.state);
+    	// SimpleBLEPeripheral_processCharValueChangeEvt(pMsg->hdr.state);
+        ZM_instruction_update_handle(pMsg->hdr.state);
       break;
 
     default:
@@ -926,14 +1211,10 @@ static void SimpleBLEPeripheral_processStateChangeEvt(gaprole_States_t newState)
 
         DevInfo_SetParameter(DEVINFO_SYSTEM_ID, DEVINFO_SYSTEM_ID_LEN, systemId);
 
-        // Display device address
-        // Display_print0(dispHandle, 1, 0, Util_convertBdAddr2Str(ownAddress));
-        // Display_print0(dispHandle, 2, 0, "Initialized");
       }
       break;
 
     case GAPROLE_ADVERTISING:
-      // Display_print0(dispHandle, 2, 0, "Advertising");
       break;
 
 #ifdef PLUS_BROADCASTER
@@ -944,7 +1225,7 @@ static void SimpleBLEPeripheral_processStateChangeEvt(gaprole_States_t newState)
      */
     case GAPROLE_ADVERTISING_NONCONN:
       {
-        uint8_t advertEnabled = FALSE;
+        uint8_t advertEnabled = true;  // do some change to experiment
 
         // Disable non-connectable advertising.
         GAPRole_SetParameter(GAPROLE_ADV_NONCONN_ENABLED, sizeof(uint8_t),
@@ -969,7 +1250,7 @@ static void SimpleBLEPeripheral_processStateChangeEvt(gaprole_States_t newState)
         linkDBInfo_t linkInfo;
         uint8_t numActive = 0;
 
-        Util_startClock(&periodicClock);
+		// Util_startClock(&periodicClock);
 
         numActive = linkDB_NumActive();
 
@@ -977,8 +1258,6 @@ static void SimpleBLEPeripheral_processStateChangeEvt(gaprole_States_t newState)
         // connection
         if ( linkDB_GetInfo( numActive - 1, &linkInfo ) == SUCCESS )
         {
-          // Display_print1(dispHandle, 2, 0, "Num Conns: %d", (uint16_t)numActive);
-          // Display_print0(dispHandle, 3, 0, Util_convertBdAddr2Str(linkInfo.addr));
         }
         else
         {
@@ -986,8 +1265,6 @@ static void SimpleBLEPeripheral_processStateChangeEvt(gaprole_States_t newState)
 
           GAPRole_GetParameter(GAPROLE_CONN_BD_ADDR, peerAddress);
 
-          // Display_print0(dispHandle, 2, 0, "Connected");
-          // Display_print0(dispHandle, 3, 0, Util_convertBdAddr2Str(peerAddress));
         }
 
         #ifdef PLUS_BROADCASTER
@@ -1015,26 +1292,16 @@ static void SimpleBLEPeripheral_processStateChangeEvt(gaprole_States_t newState)
       break;
 
     case GAPROLE_CONNECTED_ADV:
-      // Display_print0(dispHandle, 2, 0, "Connected Advertising");
       break;
 
     case GAPROLE_WAITING:
-      Util_stopClock(&periodicClock);
       SimpleBLEPeripheral_freeAttRsp(bleNotConnected);
-
-      // Display_print0(dispHandle, 2, 0, "Disconnected");
-
-      // Clear remaining lines
-      // Display_clearLines(dispHandle, 3, 5);
+      ModeLED(BT_WAIT);
       break;
 
     case GAPROLE_WAITING_AFTER_TIMEOUT:
       SimpleBLEPeripheral_freeAttRsp(bleNotConnected);
-
-      // Display_print0(dispHandle, 2, 0, "Timed Out");
-
-      // Clear remaining lines
-      // Display_clearLines(dispHandle, 3, 5);
+      ModeLED(BT_WAIT);
 
       #ifdef PLUS_BROADCASTER
         // Reset flag for next connection.
@@ -1043,11 +1310,9 @@ static void SimpleBLEPeripheral_processStateChangeEvt(gaprole_States_t newState)
       break;
 
     case GAPROLE_ERROR:
-      // Display_print0(dispHandle, 2, 0, "Error");
       break;
 
     default:
-      // Display_clearLine(dispHandle, 2);
       break;
   }
 
@@ -1082,6 +1347,7 @@ static void SimpleBLEPeripheral_charValueChangeCB(uint8_t paramID)
  *
  * @return  None.
  */
+/*
 static void SimpleBLEPeripheral_processCharValueChangeEvt(uint8_t paramID)
 {
 #ifndef FEATURE_OAD_ONCHIP
@@ -1092,13 +1358,13 @@ static void SimpleBLEPeripheral_processCharValueChangeEvt(uint8_t paramID)
     case SIMPLEPROFILE_CHAR1:
       SimpleProfile_GetParameter(SIMPLEPROFILE_CHAR1, &newValue);
 
-      // Display_print1(dispHandle, 4, 0, "Char 1: %d", (uint16_t)newValue);
+      Display_print1(dispHandle, 4, 0, "Char 1: %d", (uint16_t)newValue);
       break;
 
     case SIMPLEPROFILE_CHAR3:
       SimpleProfile_GetParameter(SIMPLEPROFILE_CHAR3, &newValue);
 
-      // Display_print1(dispHandle, 4, 0, "Char 3: %d", (uint16_t)newValue);
+      Display_print1(dispHandle, 4, 0, "Char 3: %d", (uint16_t)newValue);
       break;
 
     default:
@@ -1107,6 +1373,7 @@ static void SimpleBLEPeripheral_processCharValueChangeEvt(uint8_t paramID)
   }
 #endif //!FEATURE_OAD_ONCHIP
 }
+*/
 
 /*********************************************************************
  * @fn      SimpleBLEPeripheral_performPeriodicTask
@@ -1123,6 +1390,9 @@ static void SimpleBLEPeripheral_processCharValueChangeEvt(uint8_t paramID)
  */
 static void SimpleBLEPeripheral_performPeriodicTask(void)
 {
+  elite_task();
+
+/*
 #ifndef FEATURE_OAD_ONCHIP
   uint8_t valueToCopy;
 
@@ -1137,6 +1407,7 @@ static void SimpleBLEPeripheral_performPeriodicTask(void)
                                &valueToCopy);
   }
 #endif //!FEATURE_OAD_ONCHIP
+*/
 }
 
 
@@ -1171,7 +1442,7 @@ void SimpleBLEPeripheral_processOadWriteCB(uint8_t event, uint16_t connHandle,
     Queue_put(hOadQ, (Queue_Elem *)oadWriteEvt);
 
     // Post the application's semaphore.
-    Semaphore_post(sem);
+    Semaphore_post(semaphore);
   }
   else
   {
@@ -1189,14 +1460,16 @@ void SimpleBLEPeripheral_processOadWriteCB(uint8_t event, uint16_t connHandle,
  *
  * @return  None.
  */
+/*
 static void SimpleBLEPeripheral_clockHandler(UArg arg)
 {
   // Store the event.
   events |= arg;
 
   // Wake up the application.
-  Semaphore_post(sem);
+  Semaphore_post(semaphore);
 }
+*/
 
 /*********************************************************************
  * @fn      SimpleBLEPeripheral_enqueueMsg
@@ -1219,9 +1492,17 @@ static void SimpleBLEPeripheral_enqueueMsg(uint8_t event, uint8_t state)
     pMsg->hdr.state = state;
 
     // Enqueue the message.
-    Util_enqueueMsg(appMsgQueue, sem, (uint8*)pMsg);
+    Util_enqueueMsg(appMsgQueue, semaphore, (uint8*)pMsg);
   }
 }
 
 /*********************************************************************
 *********************************************************************/
+
+#include "application/BAT_10_app_c.h"
+#include "HAL/cc2650_driver/spi_ctrl_c.h"
+#include "HAL/cc2650_driver/i2c_ctrl_c.h"
+#include "HAL/APA102_2020_256_8x4_c.h"
+#include "HAL/MCP23008x2_c.h"
+#include "HAL/MAX5136x2_c.h"
+#include "HAL/ADGS1412x9_c.h"

simplelink/ble_sdk_2_02_02_25/src/profiles/simple_profile/simple_gatt_profile.h

@@ -56,7 +56,7 @@ extern "C"
 /*********************************************************************
  * INCLUDES
  */
-// #include "application_config/application_config.h"
+#include "application_config/application_config.h"
 /*********************************************************************
  * CONSTANTS
  */