Modify(#2 ): remove Display code

Revert(#2 ): Elite BAT1.0 renascent
[clean]
2023-04-18 16:08:40 +08:00 · 2023-04-18 15:35:23 +08:00 · 2023-03-16 16:02:26 +08:00 · 2023-03-16 15:41:54 +08:00 · 2023-03-16 15:39:41 +08:00 · 2023-03-16 15:31:56 +08:00
21 changed files with 1029 additions and 11244 deletions
@@ -50,7 +50,7 @@ extern "C" {
 *  ==========================================================================*/
 #include <ti/drivers/PIN.h>
 #include <driverlib/ioc.h>
-#include "boards_config/elite_pin_conf.h"
+// #include "application_config/application_config.h"

 /** ============================================================================
 *  Externs
@@ -146,12 +146,6 @@ extern const PIN_Config BoardGpioInitTable[];
 #define Board_UART_TX                  Board_BP_UART_Rx          /* RXD */
 #define Board_UART_RX                  Board_BP_UART_Tx          /* TXD */

-// /* SPI Board */
-// #define Board_SPI0_MISO                Board_BP_SPI_MISO
-// #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
-
 /* Power Management Board */
 #define Board_SRDY                     Board_BP_Pin_J2_19
 #define Board_MRDY                     Board_BP_Pin_J1_2
@@ -166,6 +160,35 @@ extern const PIN_Config BoardGpioInitTable[];
 #define Board_PWMPIN6                  PIN_UNASSIGNED
 #define Board_PWMPIN7                  PIN_UNASSIGNED

+/* SPI & I2C Board */
+#ifndef DEF_ELITE_MODEL
+#define Board_SPI0_MISO                Board_BP_SPI_MISO
+#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
+#define Board_SPI0_CLK                 E_SPI0_CLK
+#define Board_SPI0_CS                  E_SPI0_CS
+
+#define Board_SPI1_MISO                E_SPI1_MISO
+#define Board_SPI1_MOSI                E_SPI1_MOSI
+#define Board_SPI1_CLK                 E_SPI1_CLK
+#define Board_SPI1_CS                  E_SPI1_CS
+
+#define Board_I2C0_SCL0                E_I2C0_SCL0 
+#define Board_I2C0_SDA0                E_I2C0_SDA0
+#endif
+
 /** ============================================================================
 *  Instance identifiers
 *  ==========================================================================*/
@@ -1,10 +0,0 @@
-#define DEF_ELITE_EDC_2_0
-
-#if defined (DEF_ELITE_EDC_1_5_RE)
-  #include "boards_config/pin_config_edc15re.h"
-#elif defined (DEF_ELITE_EDC_1_5)
-  #include "boards_config/pin_config_edc15.h"
-#elif defined (DEF_ELITE_EDC_2_0)
-  #include "boards_config/pin_config_edc20.h"
-
-#endif
@@ -1,45 +0,0 @@
-#define D0                              DIO3
-#define D1                              DIO4
-#define D2                              DIO5
-#define D3                              DIO6
-#define D4                              DIO7
-#define D5                              DIO8
-#define D6                              DIO9
-#define D7                              DIO10
-#define LOAD0                           DIO13
-#define LOAD1                           DIO12
-#define LOAD2                           DIO11
-#define SHUT_DOWN                       DIO14
-
-/* SPI Board */
-#define Board_SPI0_MISO                 PIN_UNASSIGNED
-#define Board_SPI0_MOSI                 D1
-#define Board_SPI0_CLK                  D0
-#define Board_SPI0_CS                   PIN_UNASSIGNED
-
-#define Board_SPI1_MISO                 DIO1
-#define Board_SPI1_MOSI                 D3
-#define Board_SPI1_CLK                  D2
-#define Board_SPI1_CS                   PIN_UNASSIGNED
-
-#define CS_ADC                          LOAD0, D6
-#define CS_DAC                          LOAD0, D7
-#define MOSI                            LOAD0, D3
-#define SCLK                            LOAD0, D2
-#define LED_MOSI_A                      LOAD0, D1
-#define LED_SCLK_A                      LOAD0, D0
-#define CS_MEM                          LOAD0, D5
-
-#define MEM_HOLD                        LOAD0, D4
-#define HIGH_Z                          LOAD2, D5
-
-#define I_MID_ON                    LOAD2, D0
-#define I_SMALL_ON                  LOAD2, D4
-#define I_LARGE_ON                  LOAD2, D1
-#define V_SMALL_ON                  LOAD2, D2
-#define V_MID_ON                    LOAD2, D3
-#define VOUT_SMALL_ON               LOAD2, D7
-#define OFF                   LOAD2, D6
-
-#define P_10V_enable                      LOAD1, D5
-#define P_5V_enable                       LOAD1, D6
@@ -1,46 +0,0 @@
-#define D0                              DIO3
-#define D1                              DIO4
-#define D2                              DIO5
-#define D3                              DIO6
-#define D4                              DIO7
-#define D5                              DIO8
-#define D6                              DIO9
-#define D7                              DIO10
-#define LOAD0                           DIO13
-#define LOAD1                           DIO12
-#define LOAD2                           DIO11
-
-#define SHUT_DOWN                       DIO14 //switch_on
-
-/* SPI Board */
-#define Board_SPI0_MISO                 PIN_UNASSIGNED
-#define Board_SPI0_MOSI                 D1
-#define Board_SPI0_CLK                  D0
-#define Board_SPI0_CS                   PIN_UNASSIGNED
-
-#define Board_SPI1_MISO                 DIO1
-#define Board_SPI1_MOSI                 D3
-#define Board_SPI1_CLK                  D2
-#define Board_SPI1_CS                   PIN_UNASSIGNED
-
-#define LED_SCLK_A                      LOAD0, D0
-#define LED_MOSI_A                      LOAD0, D1
-#define SCLK                            LOAD0, D2
-#define MOSI                            LOAD0, D3
-#define HIGH_Z                          LOAD0, D4
-#define CS_MEM                          LOAD0, D5
-#define CS_ADC                          LOAD0, D6
-#define CS_DAC                          LOAD0, D7
-
-#define MEM_HOLD                        LOAD1, D0
-#define P_10V_enable                    LOAD1, D5
-#define P_5V_enable                     LOAD1, D6
-
-#define I_MID_ON                        LOAD2, D0
-#define I_LARGE_ON                      LOAD2, D1
-#define V_SMALL_ON                      LOAD2, D2
-#define V_MID_ON                        LOAD2, D3
-#define I_SMALL_ON                      LOAD2, D4
-#define OFF                             LOAD2, D6 //6994
-#define VOUT_SMALL_ON                   LOAD2, D7
-
@@ -1,85 +0,0 @@
-/* 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 Board */
-#define Board_SPI0_MISO         PIN_UNASSIGNED
-#define Board_SPI0_MOSI         E_PIN_LED_SPI_SDI
-#define Board_SPI0_CLK          E_PIN_LED_SPI_CLK
-#define Board_SPI0_CS           PIN_UNASSIGNED
-
-#define Board_SPI1_MISO         E_PIN_MISO
-#define Board_SPI1_MOSI         E_PIN_MOSI
-#define Board_SPI1_CLK          E_PIN_SCLK0
-#define Board_SPI1_CS           PIN_UNASSIGNED
-
-/* I2C */
-#define Board_I2C0_SCL0         E_PIN_I2C_SCK 
-#define Board_I2C0_SDA0         E_PIN_I2C_SDA
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-#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 ADC_CS                          DIO11
-//#define DAC_CS                          DIO10
-
-#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
-
@@ -1,29 +0,0 @@
-#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
-
-
-bool 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);
-
-bool 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
@@ -1,112 +0,0 @@
-#include "driver/spi_ctrl.h"
-static SPI_Handle spiHandle0 = NULL;
-static SPI_Params spiParams0;
-
-/* system use SPI parameters */
-static SPI_Handle spiHandle1 = NULL;
-static SPI_Params spiParams1;
-
-
-bool spi0_open(uint32_t bitRate, uint8_t polarity, uint8_t phase)
-{
-    uint8_t pol = polarity;
-    uint8_t pha = phase;
-    SPI_FrameFormat frameFormat;
-
-    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 */
-    SPI_Params_init(&spiParams0);
-    spiParams0.bitRate = bitRate;
-    spiParams0.mode = SPI_MASTER;
-    spiParams0.dataSize = 8;
-    spiParams0.frameFormat = frameFormat;
-
-    /* Attempt to open SPI. */
-    spiHandle0 = SPI_open(Board_SPI0, &spiParams0);
-
-    return spiHandle0 != NULL;
-}
-
-/* Close the RTOS SPI driver */
-void spi0_close(void)
-{
-    if (spiHandle0 != NULL)
-    {
-        // Close the RTOS driver
-        SPI_close(spiHandle0);
-        spiHandle0 = NULL;
-    }
-}
-
-int spi0_write(uint8_t *rxBuf, uint8_t *txBuf, uint8_t len)
-{
-    SPI_Transaction spi0Transaction;
-
-    spi0Transaction.count  = len;
-    spi0Transaction.txBuf  = txBuf;
-    spi0Transaction.arg    = NULL;
-    spi0Transaction.rxBuf  = NULL;
-
-    return SPI_transfer(spiHandle0, &spi0Transaction) ? 0 : -1;
-}
-
-/* Open the RTOS SPI driver */
-bool spi1_open(uint32_t bitRate, uint8_t polarity, uint8_t phase)
-{
-    uint32_t rate = bitRate;
-    uint8_t pol = polarity;
-    uint8_t pha = phase;
-    SPI_FrameFormat frameFormat;
-
-    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 */
-    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);
-
-    return spiHandle1 != NULL;
-}
-
-/* Close the RTOS SPI driver */
-void spi1_close(void)
-{
-    if (spiHandle1 != NULL)
-    {
-        // Close the RTOS driver
-        SPI_close(spiHandle1);
-        spiHandle1 = NULL;
-    }
-}
-
-int spi1_write(uint8_t *rxBuf, uint8_t *txBuf, uint8_t len)
-{
-    SPI_Transaction spi1Transaction;
-
-    spi1Transaction.count  = len;
-    spi1Transaction.txBuf  = txBuf;
-    spi1Transaction.arg    = NULL;
-    spi1Transaction.rxBuf  = rxBuf;
-
-    return SPI_transfer(spiHandle1, &spi1Transaction) ? 0 : -1;
-}
@@ -1,65 +0,0 @@
-#ifndef ADGS1412_H
-#define ADGS1412_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  
@@ -1,107 +0,0 @@
-#include "hardware/ADGS1412.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);
-    #define WRITE_TO_SWITCH(_d, _l) spi1_write(NULL, (uint8_t *)(_d), (_l))
-    WRITE_TO_SWITCH(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;
-}
@@ -1,65 +0,0 @@
-#ifndef DAC_MAX5136_H
-#define DAC_MAX5136_H
-
-
-#define REVERT_2_BYTE(_b)     ((_b) >> 8 | (((_b) & 0xFF) << 8))
-#ifdef  __cplusplus
-extern "C" {
-#endif
-
-
-#define MAX5136_NUM_MAX 2
-#define SIZEOFDAC_SPI MAX5136_NUM_MAX*3
-// #include "driver/spi_ctrl.h"
-
-
-
-#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  //DAC_MAX5136_H
@@ -1,110 +0,0 @@
-#include "hardware/DAC_MAX5136.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); 
-
-    #define WRITE_TO_DAC(_d, _l) spi1_write(NULL, (uint8_t *)(_d), (_l))
-    WRITE_TO_DAC(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;
-}
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
@@ -1,109 +0,0 @@
-#ifndef MCP23008_H
-#define MCP23008_H
-
-#ifdef __cplusplus
-extern "C" {
-#endif
-
-//i2c addr
-/************************************************************************************************
- * .h
- ************************************************************************************************/
-/*
- * Register addresses
- * +---------+-------------------+
- * | Address |     Access to:    |
- * +---------+-------------------+
- * |  00h    |        IODIR      |
- * |  01h    |        IPOL       |
- * |  02h    |        GPINTEN    |
- * |  03h    |        DEFVAL     |
- * |  04h    |        INTCON     |
- * |  05h    |        IOCON      |
- * |  06h    |        GPPU       |
- * |  07h    |        INTF       |
- * |  08h    | INTCAP(Read-only) |
- * |  09h    |        GPIO       |
- * |  0Ah    |        OLAT       |
- * +---------+-------------------+
- */
-
-#define MCP23008_WT_BIT     0
-#define MCP23008_RD_BIT     1
-
-
-
-#define GET_INPUT_SW_SEN()      ((chip_MCP23008_rd_reg_stat(MCP23008_MODULE_U503, MCP23008_REG_GPIO) & 0x40) >> 6)
-
-#define PUSH_KEY (GET_INPUT_SW_SEN() == 0)
-
-#define SET_VLOGIC_EN_GPIO(_v)      (chip_MCP23008_set(MCP23008_MODULE_U503, MCP23008_REG_GPIO, MCP23008_P4, _v))
-#define SET_VLOGIC_EN_IODIR(_v)     (chip_MCP23008_set(MCP23008_MODULE_U503, MCP23008_REG_IODIR, MCP23008_P4, _v))  
-#define SET_SW_EN_GPIO(_v)          (chip_MCP23008_set(MCP23008_MODULE_U503, MCP23008_REG_GPIO, MCP23008_P5, _v))
-
-
-
-enum mcp23008_module_e {
-    MCP23008_MODULE_U503 = 0,
-    MCP23008_MODULE_U505,
-
-    MCP23008_MODULE_MAX,
-};
-
-enum mcp23008_reg_name_e {
-    MCP23008_REG_IODIR = 0x00,
-    MCP23008_REG_IPOL,
-    MCP23008_REG_GPINTEN,
-    MCP23008_REG_DEFVAL,
-    MCP23008_REG_INTCON,
-    MCP23008_REG_IOCON,
-    MCP23008_REG_GPPU,
-    MCP23008_REG_INTF,
-    MCP23008_REG_INTCAP,
-    MCP23008_REG_GPIO,
-    MCP23008_REG_OLAT,
-    
-    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;
-};
-
-static struct mcp23008_reg_name_t mcp23008_reg_name_g[MCP23008_MODULE_MAX] = {0};
-
-static uint8_t module_addr_g[MCP23008_MODULE_MAX] = {
-    0x46,   // MCP23008_MODULE_U503
-    0x4C,   // MCP23008_MODULE_U505
-};
-
-
-
-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  
@@ -1,149 +0,0 @@
-#include "hardware/MCP23008.h"
-
-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;
-
-    send->i2c_txlen = 2;
-    send->i2c_rxlen = 0;
-    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);
-
-    return i2c0_write(send);
-}
-
-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;
-}
@@ -1,271 +0,0 @@
-/* .h */
-
-/*
- *  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      |
- *      +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- */
-
-#ifdef DEF_LED_TANDEN_N
-#define LED_TANDEM_N  DEF_LED_TANDEN_N
-#else
-#define LED_TANDEM_N  12
-#endif
-
-enum led_series_nb_e {
-    LED_NB_1 = 0,
-    LED_NB_2,
-    LED_NB_3,
-    LED_NB_4,
-    LED_NB_5,
-    LED_NB_6,
-    LED_NB_7,
-    LED_NB_8,
-    LED_NB_9,
-    LED_NB_10,
-    LED_NB_11,
-    LED_NB_12,
-    
-    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);
-
-
-
-
-/* .c */
-#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);
-    
-#define WRITE_TO_HW(_d, _l) spi0_write(NULL, (void *)(_d), (_l))
-    WRITE_TO_HW(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);
- */
@@ -1,15 +0,0 @@
-
-#ifndef VERSION_DATE
-#define VERSION_DATE
-
-#define VERSION_DATE_YEAR      22
-#define VERSION_DATE_MONTH     6
-#define VERSION_DATE_DAY       9
-#define VERSION_DATE_HOUR      10
-#define VERSION_DATE_MINUTE    32
-
-// 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
@@ -1,975 +0,0 @@
-/*
- *  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) {
-                LEDPowerON();
-            }
-            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;
-        }
-        }
-}
@@ -1,313 +0,0 @@
-
-#include "hardware/DAC_MAX5136.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_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 + 1;  //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 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;
-        
-        
-        default:
-            break;
-        
-    }
-
-    return;
-}
@@ -50,15 +50,9 @@

 #include <xdc/runtime/Error.h>

-
 #include <ti/drivers/Power.h>
 #include <ti/drivers/power/PowerCC26XX.h>
 #include <ti/sysbios/BIOS.h>
-#include <ti/drivers/SPI.h>
-#include <ti/drivers/spi/SPICC26XXDMA.h>
-#include <ti/drivers/dma/UDMACC26XX.h>
-#include <ti/drivers/I2C.h>
-#include <ti/drivers/i2c/I2CCC26XX.h>

 #include "icall.h"
 #include "hal_assert.h"
@@ -138,7 +132,7 @@ PIN_Handle radCtrlHandle;

 extern void AssertHandler(uint8 assertCause, uint8 assertSubcause);

-//extern Display_Handle dispHandle;
+// extern Display_Handle dispHandle;

 /*******************************************************************************
 * @fn          Main
@@ -253,48 +247,49 @@ int main()
 */
 void AssertHandler(uint8 assertCause, uint8 assertSubcause)
 {
+/*
  // Open the display if the app has not already done so
-//  if ( !dispHandle )
-//  {
-//    dispHandle = Display_open(Display_Type_LCD, NULL);
-//  }
+  if ( !dispHandle )
+  {
+    dispHandle = Display_open(Display_Type_LCD, NULL);
+  }

-
-//  Display_print0(dispHandle, 0, 0, ">>>STACK ASSERT");
+  Display_print0(dispHandle, 0, 0, ">>>STACK ASSERT");

  // check the assert cause
-//  switch (assertCause)
-//  {
-//    case HAL_ASSERT_CAUSE_OUT_OF_MEMORY:
-//      Display_print0(dispHandle, 0, 0, "***ERROR***");
-//      Display_print0(dispHandle, 2, 0, ">> OUT OF MEMORY!");
-//      break;
-//
-//    case HAL_ASSERT_CAUSE_INTERNAL_ERROR:
-//      // check the subcause
-//      if (assertSubcause == HAL_ASSERT_SUBCAUSE_FW_INERNAL_ERROR)
-//      {
-//        Display_print0(dispHandle, 0, 0, "***ERROR***");
-//        Display_print0(dispHandle, 2, 0, ">> INTERNAL FW ERROR!");
-//      }
-//      else
-//      {
-//        Display_print0(dispHandle, 0, 0, "***ERROR***");
-//        Display_print0(dispHandle, 2, 0, ">> INTERNAL ERROR!");
-//      }
-//      break;
-//
-//    case HAL_ASSERT_CAUSE_ICALL_ABORT:
-//      Display_print0(dispHandle, 0, 0, "***ERROR***");
-//      Display_print0(dispHandle, 2, 0, ">> ICALL ABORT!");
-//      HAL_ASSERT_SPINLOCK;
-//      break;
-//
-//    default:
-//      Display_print0(dispHandle, 0, 0, "***ERROR***");
-//      Display_print0(dispHandle, 2, 0, ">> DEFAULT SPINLOCK!");
-//      HAL_ASSERT_SPINLOCK;
-//  }
+  switch (assertCause)
+  {
+    case HAL_ASSERT_CAUSE_OUT_OF_MEMORY:
+      Display_print0(dispHandle, 0, 0, "***ERROR***");
+      Display_print0(dispHandle, 2, 0, ">> OUT OF MEMORY!");
+      break;
+
+    case HAL_ASSERT_CAUSE_INTERNAL_ERROR:
+      // check the subcause
+      if (assertSubcause == HAL_ASSERT_SUBCAUSE_FW_INERNAL_ERROR)
+      {
+        Display_print0(dispHandle, 0, 0, "***ERROR***");
+        Display_print0(dispHandle, 2, 0, ">> INTERNAL FW ERROR!");
+      }
+      else
+      {
+        Display_print0(dispHandle, 0, 0, "***ERROR***");
+        Display_print0(dispHandle, 2, 0, ">> INTERNAL ERROR!");
+      }
+      break;
+
+    case HAL_ASSERT_CAUSE_ICALL_ABORT:
+      Display_print0(dispHandle, 0, 0, "***ERROR***");
+      Display_print0(dispHandle, 2, 0, ">> ICALL ABORT!");
+      HAL_ASSERT_SPINLOCK;
+      break;
+
+    default:
+      Display_print0(dispHandle, 0, 0, "***ERROR***");
+      Display_print0(dispHandle, 2, 0, ">> DEFAULT SPINLOCK!");
+      HAL_ASSERT_SPINLOCK;
+  }
+*/

  return;
 }
@@ -9,7 +9,7 @@
 Target Device: CC2650, CC2640

 ******************************************************************************
-
+ 
 Copyright (c) 2010-2018, Texas Instruments Incorporated
 All rights reserved.

@@ -135,6 +135,7 @@ static simpleProfileCBs_t *simpleProfile_AppCBs = NULL;
 // Simple Profile Service attribute
 static CONST gattAttrType_t simpleProfileService = { ATT_BT_UUID_SIZE, simpleProfileServUUID };

+
 // Simple Profile Characteristic 1 Properties
 // static uint8 simpleProfileChar1Props = GATT_PROP_READ | GATT_PROP_WRITE;
 /*user insert*/
@@ -143,12 +144,13 @@ static uint8 simpleProfileChar1Props = GATT_PROP_READ;
 // Characteristic 1 Value
 // static uint8 simpleProfileChar1 = 0;
 /*user insert*/
-#define SIMPLEPROFILE_CHAR1_LEN 20
 static uint8 simpleProfileChar1[SIMPLEPROFILE_CHAR1_LEN] = {0};

+
 // Simple Profile Characteristic 1 User Description
 static uint8 simpleProfileChar1UserDesp[17] = "Characteristic 1";

+
 // Simple Profile Characteristic 2 Properties
 static uint8 simpleProfileChar2Props = GATT_PROP_READ;

@@ -157,9 +159,11 @@ static uint8 simpleProfileChar2Props = GATT_PROP_READ;
 /*user insert*/
 static uint8 simpleProfileChar2[SIMPLEPROFILE_CHAR2_LEN] = {0};

+
 // Simple Profile Characteristic 2 User Description
 static uint8 simpleProfileChar2UserDesp[17] = "Characteristic 2";

+
 // Simple Profile Characteristic 3 Properties
 static uint8 simpleProfileChar3Props = GATT_PROP_WRITE;

@@ -168,9 +172,11 @@ static uint8 simpleProfileChar3Props = GATT_PROP_WRITE;
 /*user insert*/
 static uint8 simpleProfileChar3[SIMPLEPROFILE_CHAR3_LEN] = {0};

+
 // Simple Profile Characteristic 3 User Description
 static uint8 simpleProfileChar3UserDesp[17] = "Characteristic 3";

+
 // Simple Profile Characteristic 4 Properties
 static uint8 simpleProfileChar4Props = GATT_PROP_NOTIFY;

@@ -179,6 +185,7 @@ static uint8 simpleProfileChar4Props = GATT_PROP_NOTIFY;
 /*user insert*/
 static uint8 simpleProfileChar4[SIMPLEPROFILE_CHAR4_LEN] = {0};

+
 // Simple Profile Characteristic 4 Configuration Each client has its own
 // instantiation of the Client Characteristic Configuration. Reads of the
 // Client Characteristic Configuration only shows the configuration for
@@ -188,6 +195,7 @@ static gattCharCfg_t *simpleProfileChar4Config;
 // Simple Profile Characteristic 4 User Description
 static uint8 simpleProfileChar4UserDesp[17] = "Characteristic 4";

+
 // Simple Profile Characteristic 5 Properties
 static uint8 simpleProfileChar5Props = GATT_PROP_READ;

@@ -222,17 +230,17 @@ static gattAttribute_t simpleProfileAttrTbl[SERVAPP_NUM_ATTR_SUPPORTED] =
      // Characteristic Value 1
      {
        { ATT_BT_UUID_SIZE, simpleProfilechar1UUID },
-      	GATT_PERMIT_READ,
-      	0,
-      	simpleProfileChar1
+        GATT_PERMIT_READ,
+        0,
+        simpleProfileChar1
      },

      // Characteristic 1 User Description
      {
        { ATT_BT_UUID_SIZE, charUserDescUUID },
-    	GATT_PERMIT_READ,
-    	0,
-    	simpleProfileChar1UserDesp
+        GATT_PERMIT_READ,
+        0,
+        simpleProfileChar1UserDesp
      },

    // Characteristic 2 Declaration
@@ -246,114 +254,112 @@ static gattAttribute_t simpleProfileAttrTbl[SERVAPP_NUM_ATTR_SUPPORTED] =
      // Characteristic Value 2
      {
        { ATT_BT_UUID_SIZE, simpleProfilechar2UUID },
-	    GATT_PERMIT_READ,
-	    0,
-	    simpleProfileChar2
-	  },
-	  
-	  // Characteristic 2 User Description
-	  {
-	    { ATT_BT_UUID_SIZE, charUserDescUUID }, 
-	    GATT_PERMIT_READ, 
-	    0, 
-	    simpleProfileChar2UserDesp
-	  },
-
+        GATT_PERMIT_READ,
+        0,
+        simpleProfileChar2
+      },

+      // Characteristic 2 User Description
+      {
+        { ATT_BT_UUID_SIZE, charUserDescUUID },
+        GATT_PERMIT_READ,
+        0,
+        simpleProfileChar2UserDesp
+      },

    // Characteristic 3 Declaration
    {
-      { ATT_BT_UUID_SIZE, characterUUID }, 
-      GATT_PERMIT_READ, 
-      0, 
+      { ATT_BT_UUID_SIZE, characterUUID },
+      GATT_PERMIT_READ,
+      0,
      &simpleProfileChar3Props
    },

-    // Characteristic Value 3
-    {
-      { ATT_BT_UUID_SIZE, simpleProfilechar3UUID }, 
-      GATT_PERMIT_WRITE, 
-      0, 
-      simpleProfileChar3
-    },
+      // Characteristic Value 3
+      {
+        { ATT_BT_UUID_SIZE, simpleProfilechar3UUID },
+        GATT_PERMIT_WRITE,
+        0,
+        simpleProfileChar3
+      },

-    // Characteristic 3 User Description
-    {
-      { ATT_BT_UUID_SIZE, charUserDescUUID }, 
-      GATT_PERMIT_READ, 
-      0, 
-      simpleProfileChar3UserDesp
-    },
+      // Characteristic 3 User Description
+      {
+        { ATT_BT_UUID_SIZE, charUserDescUUID },
+        GATT_PERMIT_READ,
+        0,
+        simpleProfileChar3UserDesp
+      },

    // Characteristic 4 Declaration
    {
-      { ATT_BT_UUID_SIZE, characterUUID }, 
-      GATT_PERMIT_READ, 
+      { ATT_BT_UUID_SIZE, characterUUID },
+      GATT_PERMIT_READ,
      0,
      &simpleProfileChar4Props
    },

-    // Characteristic Value 4
-    {
-      { ATT_BT_UUID_SIZE, simpleProfilechar4UUID }, 
-      0, 
-      0, 
-      simpleProfileChar4
-    },
+      // Characteristic Value 4
+      {
+        { ATT_BT_UUID_SIZE, simpleProfilechar4UUID },
+        0,
+        0,
+        simpleProfileChar4
+      },

-    // Characteristic 4 configuration
-    {
-      { ATT_BT_UUID_SIZE, clientCharCfgUUID }, 
-      GATT_PERMIT_READ | GATT_PERMIT_WRITE, 
-      0, 
-      (uint8 *)&simpleProfileChar4Config
-    },
+      // Characteristic 4 configuration
+      {
+        { ATT_BT_UUID_SIZE, clientCharCfgUUID },
+        GATT_PERMIT_READ | GATT_PERMIT_WRITE,
+        0,
+        (uint8 *)&simpleProfileChar4Config
+      },

-    // Characteristic 4 User Description
-    {
-      { ATT_BT_UUID_SIZE, charUserDescUUID }, 
-      GATT_PERMIT_READ, 
-      0, 
-      simpleProfileChar4UserDesp
-    },
+      // Characteristic 4 User Description
+      {
+        { ATT_BT_UUID_SIZE, charUserDescUUID },
+        GATT_PERMIT_READ,
+        0,
+        simpleProfileChar4UserDesp
+      },

    // Characteristic 5 Declaration
    {
-      { ATT_BT_UUID_SIZE, characterUUID }, 
-      GATT_PERMIT_READ, 
-      0, 
+      { ATT_BT_UUID_SIZE, characterUUID },
+      GATT_PERMIT_READ,
+      0,
      &simpleProfileChar5Props
    },

-    // Characteristic Value 5
-    {
-      { ATT_BT_UUID_SIZE, simpleProfilechar5UUID }, 
-      GATT_PERMIT_AUTHEN_READ, 
-      0, 
-      simpleProfileChar5
-    },
+      // Characteristic Value 5
+      {
+        { ATT_BT_UUID_SIZE, simpleProfilechar5UUID },
+        GATT_PERMIT_AUTHEN_READ,
+        0,
+        simpleProfileChar5
+      },

-    // Characteristic 5 User Description
-    {
-      { ATT_BT_UUID_SIZE, charUserDescUUID }, 
-      GATT_PERMIT_READ, 
-      0, 
-      simpleProfileChar5UserDesp
-    },
+      // Characteristic 5 User Description
+      {
+        { ATT_BT_UUID_SIZE, charUserDescUUID },
+        GATT_PERMIT_READ,
+        0,
+        simpleProfileChar5UserDesp
+      },
 };

 /*********************************************************************
 * LOCAL FUNCTIONS
 */
 static bStatus_t simpleProfile_ReadAttrCB(uint16_t connHandle,
-										  gattAttribute_t *pAttr,
-										  uint8_t *pValue, uint16_t *pLen,
-										  uint16_t offset, uint16_t maxLen,
-										  uint8_t method);
+                                          gattAttribute_t *pAttr,
+                                          uint8_t *pValue, uint16_t *pLen,
+                                          uint16_t offset, uint16_t maxLen,
+                                          uint8_t method);
 static bStatus_t simpleProfile_WriteAttrCB(uint16_t connHandle,
-										   gattAttribute_t *pAttr,
-										   uint8_t *pValue, uint16_t len,
-										   uint16_t offset, uint8_t method);
+                                           gattAttribute_t *pAttr,
+                                           uint8_t *pValue, uint16_t len,
+                                           uint16_t offset, uint8_t method);

 /*********************************************************************
 * PROFILE CALLBACKS
@@ -395,7 +401,7 @@ bStatus_t SimpleProfile_AddService( uint32 services )

  // Allocate Client Characteristic Configuration table
  simpleProfileChar4Config = (gattCharCfg_t *)ICall_malloc( sizeof(gattCharCfg_t) *
-  														    linkDBNumConns );
+                                                            linkDBNumConns );
  if ( simpleProfileChar4Config == NULL )
  {
    return ( bleMemAllocError );
@@ -408,9 +414,9 @@ bStatus_t SimpleProfile_AddService( uint32 services )
  {
    // Register GATT attribute list and CBs with GATT Server App
    status = GATTServApp_RegisterService( simpleProfileAttrTbl,
-    									  GATT_NUM_ATTRS( simpleProfileAttrTbl ),
-    									  GATT_MAX_ENCRYPT_KEY_SIZE,
-    									  &simpleProfileCBs );
+                                          GATT_NUM_ATTRS( simpleProfileAttrTbl ),
+                                          GATT_MAX_ENCRYPT_KEY_SIZE,
+                                          &simpleProfileCBs );
  }
  else
  {
@@ -468,7 +474,7 @@ bStatus_t SimpleProfile_SetParameter( uint8 param, uint8 len, void *value )
      {
        memcpy(simpleProfileChar1, value, len);
        // simpleProfileChar1 = *((uint8*)value);
-      } 
+      }
      else
      {
        ret = bleInvalidRange;
@@ -482,7 +488,7 @@ bStatus_t SimpleProfile_SetParameter( uint8 param, uint8 len, void *value )
        // simpleProfileChar2 = *((uint8*)value);
      }
      else
-	  {
+      {
        ret = bleInvalidRange;
      }
      break;
@@ -491,7 +497,8 @@ bStatus_t SimpleProfile_SetParameter( uint8 param, uint8 len, void *value )
      if (len <= SIMPLEPROFILE_CHAR3_LEN) 
      {
        memcpy(simpleProfileChar3, value, len);
-      } 
+        // simpleProfileChar3 = *((uint8*)value);
+      }
      else
      {
        ret = bleInvalidRange;
@@ -502,9 +509,12 @@ bStatus_t SimpleProfile_SetParameter( uint8 param, uint8 len, void *value )
      if (len <= SIMPLEPROFILE_CHAR4_LEN)
      {
        memcpy(simpleProfileChar4, value, len);
+        // simpleProfileChar4 = *((uint8*)value);

        // See if Notification has been enabled
-        GATTServApp_ProcessCharCfg(simpleProfileChar4Config, simpleProfileChar4, FALSE, simpleProfileAttrTbl, GATT_NUM_ATTRS(simpleProfileAttrTbl), INVALID_TASK_ID, simpleProfile_ReadAttrCB);
+        GATTServApp_ProcessCharCfg( simpleProfileChar4Config, simpleProfileChar4, FALSE,
+                                    simpleProfileAttrTbl, GATT_NUM_ATTRS( simpleProfileAttrTbl ),
+                                    INVALID_TASK_ID, simpleProfile_ReadAttrCB );
      }
      else
      {
@@ -513,8 +523,9 @@ bStatus_t SimpleProfile_SetParameter( uint8 param, uint8 len, void *value )
      break;

    case SIMPLEPROFILE_CHAR5:
-      if (len == SIMPLEPROFILE_CHAR5_LEN) {
-        VOID memcpy(simpleProfileChar5, value, SIMPLEPROFILE_CHAR5_LEN);
+      if ( len == SIMPLEPROFILE_CHAR5_LEN )
+      {
+        VOID memcpy( simpleProfileChar5, value, SIMPLEPROFILE_CHAR5_LEN );
      }
      else
      {
@@ -543,37 +554,41 @@ bStatus_t SimpleProfile_SetParameter( uint8 param, uint8 len, void *value )
 *
 * @return  bStatus_t
 */
-bStatus_t SimpleProfile_GetParameter(uint8 param, void *value) {
-    bStatus_t ret = SUCCESS;
-    switch (param) {
+bStatus_t SimpleProfile_GetParameter( uint8 param, void *value )
+{
+  bStatus_t ret = SUCCESS;
+  switch ( param )
+  {
    case SIMPLEPROFILE_CHAR1:
-        memcpy(value, simpleProfileChar1, SIMPLEPROFILE_CHAR1_LEN);
-        //      *((uint8*)value) = simpleProfileChar1;
-        break;
+      memcpy(value, simpleProfileChar1, SIMPLEPROFILE_CHAR1_LEN);
+      // *((uint8*)value) = simpleProfileChar1;
+      break;

    case SIMPLEPROFILE_CHAR2:
-        memcpy(value, simpleProfileChar2, SIMPLEPROFILE_CHAR2_LEN);
-        //      *((uint8*)value) = simpleProfileChar2;
-        break;
+      memcpy(value, simpleProfileChar2, SIMPLEPROFILE_CHAR2_LEN);
+      // *((uint8*)value) = simpleProfileChar2;
+      break;

    case SIMPLEPROFILE_CHAR3:
-        memcpy(value, simpleProfileChar3, SIMPLEPROFILE_CHAR3_LEN);
-        break;
+      memcpy(value, simpleProfileChar3, SIMPLEPROFILE_CHAR3_LEN);
+      // *((uint8*)value) = simpleProfileChar3;
+      break;

    case SIMPLEPROFILE_CHAR4:
-        memcpy(value, simpleProfileChar4, SIMPLEPROFILE_CHAR4_LEN);
-        break;
+      memcpy(value, simpleProfileChar4, SIMPLEPROFILE_CHAR4_LEN);
+      // *((uint8*)value) = simpleProfileChar4;
+      break;

    case SIMPLEPROFILE_CHAR5:
-        VOID memcpy(value, simpleProfileChar5, SIMPLEPROFILE_CHAR5_LEN);
-        break;
+      VOID memcpy( value, simpleProfileChar5, SIMPLEPROFILE_CHAR5_LEN );
+      break;

    default:
-        ret = INVALIDPARAMETER;
-        break;
-    }
+      ret = INVALIDPARAMETER;
+      break;
+  }

-    return (ret);
+  return ( ret );
 }

 /*********************************************************************
@@ -591,62 +606,65 @@ bStatus_t SimpleProfile_GetParameter(uint8 param, void *value) {
 *
 * @return      SUCCESS, blePending or Failure
 */
-static bStatus_t simpleProfile_ReadAttrCB(uint16_t connHandle, gattAttribute_t *pAttr, uint8_t *pValue, uint16_t *pLen, uint16_t offset, uint16_t maxLen, uint8_t method) {
-    bStatus_t status = SUCCESS;
+static bStatus_t simpleProfile_ReadAttrCB(uint16_t connHandle,
+                                          gattAttribute_t *pAttr,
+                                          uint8_t *pValue, uint16_t *pLen,
+                                          uint16_t offset, uint16_t maxLen,
+                                          uint8_t method)
+{
+  bStatus_t status = SUCCESS;

-    // Make sure it's not a blob operation (no attributes in the profile are long)
-    if (offset > 0) {
-        return (ATT_ERR_ATTR_NOT_LONG);
+  // Make sure it's not a blob operation (no attributes in the profile are long)
+  if ( offset > 0 )
+  {
+    return ( ATT_ERR_ATTR_NOT_LONG );
+  }
+
+  if ( pAttr->type.len == ATT_BT_UUID_SIZE )
+  {
+    // 16-bit UUID
+    uint16 uuid = BUILD_UINT16( pAttr->type.uuid[0], pAttr->type.uuid[1]);
+    switch ( uuid )
+    {
+      // No need for "GATT_SERVICE_UUID" or "GATT_CLIENT_CHAR_CFG_UUID" cases;
+      // gattserverapp handles those reads
+
+      // characteristics 1 and 2 have read permissions
+      // characteritisc 3 does not have read permissions; therefore it is not
+      //   included here
+      // characteristic 4 does not have read permissions, but because it
+      //   can be sent as a notification, it is included here
+      case SIMPLEPROFILE_CHAR1_UUID:
+        *pLen = SIMPLEPROFILE_CHAR1_LEN;
+        VOID memcpy( pValue, pAttr->pValue, SIMPLEPROFILE_CHAR1_LEN );
+      case SIMPLEPROFILE_CHAR2_UUID:
+              *pLen = SIMPLEPROFILE_CHAR2_LEN;
+        VOID memcpy( pValue, pAttr->pValue, SIMPLEPROFILE_CHAR2_LEN );
+      case SIMPLEPROFILE_CHAR4_UUID:
+        *pLen = SIMPLEPROFILE_CHAR4_LEN;
+        VOID memcpy( pValue, pAttr->pValue, SIMPLEPROFILE_CHAR4_LEN );
+        break;
+
+      case SIMPLEPROFILE_CHAR5_UUID:
+        *pLen = SIMPLEPROFILE_CHAR5_LEN;
+        VOID memcpy( pValue, pAttr->pValue, SIMPLEPROFILE_CHAR5_LEN );
+        break;
+
+      default:
+        // Should never get here! (characteristics 3 and 4 do not have read permissions)
+        *pLen = 0;
+        status = ATT_ERR_ATTR_NOT_FOUND;
+        break;
    }
+  }
+  else
+  {
+    // 128-bit UUID
+    *pLen = 0;
+    status = ATT_ERR_INVALID_HANDLE;
+  }

-    if (pAttr->type.len == ATT_BT_UUID_SIZE) {
-        // 16-bit UUID
-        uint16 uuid = BUILD_UINT16(pAttr->type.uuid[0], pAttr->type.uuid[1]);
-        switch (uuid) {
-        // No need for "GATT_SERVICE_UUID" or "GATT_CLIENT_CHAR_CFG_UUID" cases;
-        // gattserverapp handles those reads
-
-        // characteristics 1 and 2 have read permissions
-        // characteritisc 3 does not have read permissions; therefore it is not
-        //   included here
-        // characteristic 4 does not have read permissions, but because it
-        //   can be sent as a notification, it is included here
-        case SIMPLEPROFILE_CHAR1_UUID:
-            *pLen = SIMPLEPROFILE_CHAR1_LEN;
-            VOID memcpy(pValue, pAttr->pValue, SIMPLEPROFILE_CHAR1_LEN);
-            break;
-
-        case SIMPLEPROFILE_CHAR2_UUID:
-            //        *pLen = 1;
-            //        pValue[0] = *pAttr->pValue;
-
-            *pLen = SIMPLEPROFILE_CHAR2_LEN;
-            VOID memcpy(pValue, pAttr->pValue, SIMPLEPROFILE_CHAR2_LEN);
-            break;
-
-        case SIMPLEPROFILE_CHAR4_UUID:
-            *pLen = SIMPLEPROFILE_CHAR4_LEN;
-            VOID memcpy(pValue, pAttr->pValue, SIMPLEPROFILE_CHAR4_LEN);
-            break;
-            //      case SIMPLEPROFILE_CHAR5_UUID:
-
-            //        *pLen = SIMPLEPROFILE_CHAR5_LEN;
-            //        VOID memcpy( pValue, pAttr->pValue, SIMPLEPROFILE_CHAR5_LEN );
-            //        break;
-
-        default:
-            // Should never get here! (characteristics 3 and 4 do not have read permissions)
-            *pLen  = 0;
-            status = ATT_ERR_ATTR_NOT_FOUND;
-            break;
-        }
-    } else {
-        // 128-bit UUID
-        *pLen  = 0;
-        status = ATT_ERR_INVALID_HANDLE;
-    }
-
-    return (status);
+  return ( status );
 }

 /*********************************************************************
@@ -663,83 +681,83 @@ static bStatus_t simpleProfile_ReadAttrCB(uint16_t connHandle, gattAttribute_t *
 *
 * @return  SUCCESS, blePending or Failure
 */
-static bStatus_t simpleProfile_WriteAttrCB(uint16_t connHandle, gattAttribute_t *pAttr, uint8_t *pValue, uint16_t len, uint16_t offset, uint8_t method) {
-    bStatus_t status    = SUCCESS;
-    uint8     notifyApp = 0xFF;
+static bStatus_t simpleProfile_WriteAttrCB(uint16_t connHandle,
+                                           gattAttribute_t *pAttr,
+                                           uint8_t *pValue, uint16_t len,
+                                           uint16_t offset, uint8_t method)
+{
+  bStatus_t status = SUCCESS;
+  uint8 notifyApp = 0xFF;

-    if (pAttr->type.len == ATT_BT_UUID_SIZE) {
-        // 16-bit UUID
-        uint16 uuid = BUILD_UINT16(pAttr->type.uuid[0], pAttr->type.uuid[1]);
-        switch (uuid) {
-            // Validate the value
-            // Make sure it's not a blob oper
-            /*
-            if ( offset == 0 )
-            {
-              if ( len != 1 )
-              {
-                status = ATT_ERR_INVALID_VALUE_SIZE;
-              }
-            }
-            else
-            {
-              status = ATT_ERR_ATTR_NOT_LONG;
-            }
+  if ( pAttr->type.len == ATT_BT_UUID_SIZE )
+  {
+    // 16-bit UUID
+    uint16 uuid = BUILD_UINT16( pAttr->type.uuid[0], pAttr->type.uuid[1]);
+    switch ( uuid )
+    {
+      case SIMPLEPROFILE_CHAR1_UUID:
+      case SIMPLEPROFILE_CHAR3_UUID:

-            //Write the value
-            if ( status == SUCCESS )
-            {
-              uint8 *pCurValue = (uint8 *)pAttr->pValue;
-              *pCurValue = pValue[0];
-
-              if( pAttr->pValue == &simpleProfileChar1 )
-              {
-                notifyApp = SIMPLEPROFILE_CHAR1;
-              }
-            }
-
-            break;
-            */
-        case SIMPLEPROFILE_CHAR3_UUID:
-            if (offset == 0) {
-                if (len > SIMPLEPROFILE_CHAR3_LEN) {
-                    status = ATT_ERR_INVALID_VALUE_SIZE;
-                }
-            } else {
-                status = ATT_ERR_ATTR_NOT_LONG;
-            }
-
-            // Write the value
-            if (status == SUCCESS) {
-                // Copy pValue into the variable we point to from the attribute table.
-                memcpy(pAttr->pValue + offset, pValue, len);
-                memset(pAttr->pValue + len, 0, SIMPLEPROFILE_CHAR3_LEN - len);
-
-                if (pAttr->pValue == simpleProfileChar3) {
-                    notifyApp = SIMPLEPROFILE_CHAR3;
-                }
-            }
-
-            break;
-        case GATT_CLIENT_CHAR_CFG_UUID:
-            status = GATTServApp_ProcessCCCWriteReq(connHandle, pAttr, pValue, len, offset, GATT_CLIENT_CFG_NOTIFY);
-            break;
-        default:
-            // Should never get here! (characteristics 2 and 4 do not have write permissions)
-            status = ATT_ERR_ATTR_NOT_FOUND;
-            break;
+        //Validate the value
+        // Make sure it's not a blob oper
+        if ( offset == 0 )
+        {
+          if ( len > SIMPLEPROFILE_CHAR3_LEN )
+          {
+            status = ATT_ERR_INVALID_VALUE_SIZE;
+          }
+        }
+        else
+        {
+          status = ATT_ERR_ATTR_NOT_LONG;
        }
-    } else {
-        // 128-bit UUID
-        status = ATT_ERR_INVALID_HANDLE;
-    }

-    // If a characteristic value changed then callback function to notify application of change
-    if ((notifyApp != 0xFF) && simpleProfile_AppCBs && simpleProfile_AppCBs->pfnSimpleProfileChange) {
-        simpleProfile_AppCBs->pfnSimpleProfileChange(notifyApp);
-    }
+        //Write the value
+        if ( status == SUCCESS )
+        {
+          uint8 *pCurValue = (uint8 *)pAttr->pValue;
+          *pCurValue = pValue[0];

-    return (status);
+          // Copy pValue into the variable we point to from the attribute table.
+          memcpy(pAttr->pValue + offset, pValue, len);
+          memset(pAttr->pValue + len, 0, SIMPLEPROFILE_CHAR3_LEN - len);
+
+          if( pAttr->pValue == simpleProfileChar1 )
+          {
+            notifyApp = SIMPLEPROFILE_CHAR1;
+          }
+          else
+          {
+            notifyApp = SIMPLEPROFILE_CHAR3;
+          }
+        }
+
+        break;
+
+      case GATT_CLIENT_CHAR_CFG_UUID:
+        status = GATTServApp_ProcessCCCWriteReq( connHandle, pAttr, pValue, len,
+                                                 offset, GATT_CLIENT_CFG_NOTIFY );
+        break;
+
+      default:
+        // Should never get here! (characteristics 2 and 4 do not have write permissions)
+        status = ATT_ERR_ATTR_NOT_FOUND;
+        break;
+    }
+  }
+  else
+  {
+    // 128-bit UUID
+    status = ATT_ERR_INVALID_HANDLE;
+  }
+
+  // If a characteristic value changed then callback function to notify application of change
+  if ( (notifyApp != 0xFF ) && simpleProfile_AppCBs && simpleProfile_AppCBs->pfnSimpleProfileChange )
+  {
+    simpleProfile_AppCBs->pfnSimpleProfileChange( notifyApp );
+  }
+
+  return ( status );
 }

 /*********************************************************************
@@ -56,7 +56,7 @@ extern "C"
 /*********************************************************************
 * INCLUDES
 */
-
+// #include "application_config/application_config.h"
 /*********************************************************************
 * CONSTANTS
 */
@@ -81,12 +81,24 @@ extern "C"
 // Simple Keys Profile Services bit fields
 #define SIMPLEPROFILE_SERVICE               0x00000001

+#ifndef CUSTOM_GATT_LENGTH
 // Length of Characteristic 5 in bytes
 #define SIMPLEPROFILE_CHAR5_LEN           5
-/*user insert*/
-#define SIMPLEPROFILE_CHAR4_LEN           40
+#define SIMPLEPROFILE_CHAR4_LEN           20
 #define SIMPLEPROFILE_CHAR3_LEN           20
 #define SIMPLEPROFILE_CHAR2_LEN           20
+#define SIMPLEPROFILE_CHAR1_LEN           20
+#else
+/*user insert*/
+#define SIMPLEPROFILE_CHAR5_LEN           5
+#define SIMPLEPROFILE_CHAR4_LEN           BLE_DAT_BUFF_SIZE
+#define SIMPLEPROFILE_CHAR3_LEN           BLE_INS_BUFF_SIZE
+#define SIMPLEPROFILE_CHAR2_LEN           BLE_CIS_BUFF_SIZE
+#define SIMPLEPROFILE_CHAR1_LEN           20
+#define BLE_CIS_BUFF_CHAR                 SIMPLEPROFILE_CHAR2
+#define BLE_INS_BUFF_CHAR                 SIMPLEPROFILE_CHAR3
+#define BLE_DAT_BUFF_CHAR                 SIMPLEPROFILE_CHAR4
+#endif
 /*********************************************************************
 * TYPEDEFS
 */
Author	SHA1	Message	Date
Roy	986350ef5e	Modify(#2 ): remove Display code	2023-04-18 16:08:40 +08:00
Roy	d2e37ce574	Revert(#2 ): Elite BAT1.0 renascent	2023-04-18 15:35:23 +08:00
ROY	cdf50c6c48	[clean]	2023-03-16 16:02:26 +08:00
ROY	47f4fd49e5	[clean]	2023-03-16 15:41:54 +08:00
ROY	9e623f46da	[clean]	2023-03-16 15:39:41 +08:00
ROY	42d803e739	[clean]	2023-03-16 15:31:56 +08:00
ROY	e4bef28ead	[clean]	2023-03-16 15:17:18 +08:00
ROY	ae61ec610f	[clean]	2023-03-16 15:09:45 +08:00
ROY	f3a8943c1e	[clean]	2023-03-16 15:02:55 +08:00
ROY	3990c4db8f	[clean]	2023-03-16 14:57:37 +08:00
ROY	ead65c3c94	[clean]	2023-03-16 14:51:06 +08:00
ROY	b41e757e44	[clean]	2023-03-16 14:44:57 +08:00
ROY	bfcf716b94	[clean]	2023-03-16 14:35:27 +08:00
ROY	ba1aeb4670	[clean]	2023-03-16 14:29:54 +08:00
ROY	6541fd1386	[update] update timer	2023-03-16 13:40:35 +08:00
ROY	b95ebc697e	[update] update gpio	2023-03-16 12:43:01 +08:00
ROY	dbb85e508a	[update] update gpio	2023-03-15 18:03:03 +08:00
ROY	39dd62b0a0	[update] update gpio code	2023-03-15 16:45:21 +08:00
ROY	2a24c65ad6	[update] update i2c code	2023-03-15 16:39:02 +08:00
ROY	2908c595d1	[update] update main.c code	2023-03-15 10:51:35 +08:00
ROY	f9aa353292	[update] edit code	2023-03-15 10:48:08 +08:00
ROY	df0f87c281	[update] fix MCP23008	2023-03-15 10:46:11 +08:00
ROY	82ca5435f5	[update] update spi0/1_write	2023-03-15 09:44:29 +08:00
ROY	18c25c1e62	[update] update ADGS1412 library	2023-03-08 18:04:18 +08:00
ROY	ce47324003	[update] define header file	2023-03-08 16:56:02 +08:00
ROY	390822f893	[update] update MAX5136 library	2023-03-08 15:07:15 +08:00
ROY	fa06908a08	[update] update APA102 library	2023-03-08 14:57:20 +08:00
ROY	bb425dd5bd	[update] update MCP23008 library	2023-03-08 14:54:31 +08:00
ROY	607702ae23	[update] update MCP23008 library	2023-03-08 11:11:19 +08:00
ROY	09c3a67657	[update] update i2c function	2023-03-06 14:34:04 +08:00
ROY	05e8dc5982	[update] update led function	2023-03-03 15:01:06 +08:00
ROY	62d28c4054	[update] update spi function	2023-03-03 14:46:23 +08:00
ROY	84339ea967	[update] clean up pin define and gatt function	2023-03-03 11:07:28 +08:00
ROY	b5da45124d	[update] clean up pin define and gatt function	2023-03-03 11:07:09 +08:00
ROY	8d9e4eab63	[update] update gatt file	2023-03-02 14:52:21 +08:00
ROY	41d20603d1	[update] update gatt file	2023-03-02 13:35:36 +08:00
ROY	10a9a617ab	[update] update device name	2023-02-14 14:21:18 +08:00
ROY	7fb3bd976f	[update] fix led status	2023-02-14 14:17:25 +08:00
ROY	d2a3a9a712	[update] spi 10M & update boot process	2023-01-30 17:33:03 +08:00
ROY	ee75ad8341	[update] note spi	2023-01-30 17:31:21 +08:00
ROY	552569d985	[update] note mcp23008 reg_name	2023-01-17 10:16:04 +08:00