fix bug

[CC] notify rate 10

simplelink/ble_sdk_2_02_02_25/examples/cc2650em/simple_peripheral/ccs/config/src/makefile.libs

@@ -16,7 +16,7 @@
 # sources were generated) is:
 #    C:\ti\simplelink\ble_sdk_2_02_02_25\examples\cc2650em\simple_peripheral\ccs\config\src
 #
-GEN_SRC_DIR ?= ../../config/src
+GEN_SRC_DIR ?= ../../../../../ti/simplelink/ble_sdk_2_02_02_25/examples/cc2650em/simple_peripheral/ccs/config/src
 
 ifeq (,$(wildcard $(GEN_SRC_DIR)))
 $(error "ERROR: GEN_SRC_DIR must be set to the directory containing the generated sources")

simplelink/ble_sdk_2_02_02_25/examples/cc2650em/simple_peripheral/ccs/config/src/sysbios/makefile

@@ -1,12 +1,12 @@
 
-XOPTS = -I"C:/ti/xdctools_3_32_02_25_core/packages/" -Dxdc_target_types__=C:/ti/tirtos_cc13xx_cc26xx_2_21_01_08/products/bios_6_46_01_38/packages/ti/targets/arm/elf/std.h -Dxdc_target_name__=M3
+XOPTS = -I"C:/ti/xdctools_3_32_00_06_core/packages/" -Dxdc_target_types__=C:/ti/tirtos_cc13xx_cc26xx_2_21_01_08/products/bios_6_46_01_38/packages/ti/targets/arm/elf/std.h -Dxdc_target_name__=M3
 
 vpath % C:/ti/tirtos_cc13xx_cc26xx_2_21_01_08/products/bios_6_46_01_38/packages/ti/sysbios/
-vpath %.c C:/ti/xdctools_3_32_02_25_core/packages/
+vpath %.c C:/ti/xdctools_3_32_00_06_core/packages/
 
 CCOPTS    = --endian=little -mv7M3 --abi=eabi -q -ms --opt_for_speed=0  --program_level_compile -o3 -g --optimize_with_debug  -Dti_sysbios_knl_Task_minimizeLatency__D=FALSE -Dti_sysbios_family_arm_cc26xx_Boot_driverlibVersion=2 -Dti_sysbios_knl_Clock_stopCheckNext__D=TRUE -Dti_sysbios_family_arm_m3_Hwi_enableException__D=TRUE -Dti_sysbios_family_arm_m3_Hwi_disablePriority__D=32U -Dti_sysbios_family_arm_m3_Hwi_numSparseInterrupts__D=0U
 
-XDC_ROOT  = C:/ti/xdctools_3_32_02_25_core/packages/
+XDC_ROOT  = C:/ti/xdctools_3_32_00_06_core/packages/
 
 BIOS_ROOT = C:/ti/tirtos_cc13xx_cc26xx_2_21_01_08/products/bios_6_46_01_38/packages/ti/sysbios/
 
@@ -16,14 +16,14 @@ BIOS_INC  = -I"C:/ti/tirtos_cc13xx_cc26xx_2_21_01_08/products/bios_6_46_01_38/pa
 
 TARGET_INC = -I"C:/ti/tirtos_cc13xx_cc26xx_2_21_01_08/products/bios_6_46_01_38/packages/"
 
-INCS = $(BIOS_INC) $(TARGET_INC)  --include_path="C:/ti/ccsv8/tools/compiler/ti-cgt-arm_18.1.3.LTS/include" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/examples/simple_peripheral/cc26xx/app/headstage" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/examples/simple_peripheral/cc26xx/app" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/inc" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/icall/inc" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/profiles/roles/cc26xx" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/profiles/roles" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/profiles/dev_info" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/profiles/simple_profile/cc26xx" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/profiles/simple_profile" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/common/cc26xx" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/components/heapmgr" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/controller/cc26xx/inc" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/components/hal/src/target/_common" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/target" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/components/hal/src/target/_common/cc26xx" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/components/hal/src/inc" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/components/osal/src/inc" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/components/services/src/sdata" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/components/services/src/saddr" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/components/icall/src/inc" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/inc" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/rom" --include_path="C:/ti/tirtos_cc13xx_cc26xx_2_21_01_08/products/cc26xxware_2_24_03_17272"  -IC:/ti/tirtos_cc13xx_cc26xx_2_21_01_08/products/bios_6_46_01_38/packages/ 
+INCS = $(BIOS_INC) $(TARGET_INC)  --include_path="C:/ti/ccsv8/tools/compiler/ti-cgt-arm_18.1.4.LTS/include" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/examples/simple_peripheral/cc26xx/app/headstage" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/examples/simple_peripheral/cc26xx/app" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/inc" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/icall/inc" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/profiles/roles/cc26xx" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/profiles/roles" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/profiles/dev_info" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/profiles/simple_profile/cc26xx" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/profiles/simple_profile" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/common/cc26xx" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/components/heapmgr" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/controller/cc26xx/inc" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/components/hal/src/target/_common" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/target" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/components/hal/src/target/_common/cc26xx" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/components/hal/src/inc" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/components/osal/src/inc" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/components/services/src/sdata" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/components/services/src/saddr" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/components/icall/src/inc" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/inc" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/rom" --include_path="C:/ti/tirtos_cc13xx_cc26xx_2_21_01_08/products/cc26xxware_2_24_03_17272"  -IC:/ti/tirtos_cc13xx_cc26xx_2_21_01_08/products/bios_6_46_01_38/packages/ 
 
-CC = C:/ti/ccsv8/tools/compiler/ti-cgt-arm_18.1.3.LTS/bin/armcl -c $(CCOPTS) -I C:/ti/ccsv8/tools/compiler/ti-cgt-arm_18.1.3.LTS/include
-ASM = C:/ti/ccsv8/tools/compiler/ti-cgt-arm_18.1.3.LTS/bin/armcl -c $(CCOPTS) -I C:/ti/ccsv8/tools/compiler/ti-cgt-arm_18.1.3.LTS/include
-AR = C:/ti/ccsv8/tools/compiler/ti-cgt-arm_18.1.3.LTS/bin/armar rq
+CC = C:/ti/ccsv8/tools/compiler/ti-cgt-arm_18.1.4.LTS/bin/armcl -c $(CCOPTS) -I C:/ti/ccsv8/tools/compiler/ti-cgt-arm_18.1.4.LTS/include
+ASM = C:/ti/ccsv8/tools/compiler/ti-cgt-arm_18.1.4.LTS/bin/armcl -c $(CCOPTS) -I C:/ti/ccsv8/tools/compiler/ti-cgt-arm_18.1.4.LTS/include
+AR = C:/ti/ccsv8/tools/compiler/ti-cgt-arm_18.1.4.LTS/bin/armar rq
 
-DEL = C:/ti/xdctools_3_32_02_25_core/packages/../bin/rm -f
-CP = C:/ti/xdctools_3_32_02_25_core/packages/../bin/cp -f
+DEL = C:/ti/xdctools_3_32_00_06_core/packages/../bin/rm -f
+CP = C:/ti/xdctools_3_32_00_06_core/packages/../bin/cp -f
 
 define RM
 	$(if $(wildcard $1),$(DEL) $1,:)

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

@@ -76,6 +76,11 @@ static void ADCGainControl(uint8_t ADCLevel){
         PIN_setOutputValue(pin_handle, Turnon10K, 0);
         PIN_setOutputValue(pin_handle, Turnon100R, 1);
     }
+    else if(ADCLevel == 3){
+        // ADC gain level = 0, auto gain (using 200R resister)
+        PIN_setOutputValue(pin_handle, Turnon10K, 0);
+        PIN_setOutputValue(pin_handle, Turnon100R, 0);
+    }
     else{
         // default using 200R resister
         PIN_setOutputValue(pin_handle, Turnon10K, 0);
@@ -121,4 +126,102 @@ static void ADCChannelSelect(uint8_t ADCChannel){
     }
 }
 
+static void ReadVolt(uint8_t *buf){
+    // Read data twice since the first data we get is previous data
+    ADCChannelSelect(ADC_CH_VOLT);
+    CPUdelay(10);
+    ADC_read(buf);
+
+    ADCChannelSelect(ADC_CH_VOLT);
+    CPUdelay(10);
+    ADC_read(buf);
+}
+
+static void ReadCurrent(uint8_t *buf){
+    // Read data twice since the first data we get is previous data
+    ADCGainControl(INSTRUCTION.ADCGainLevel);
+    ADCChannelSelect(ADC_CH_CURRENT);
+    CPUdelay(10);
+    ADC_read(buf);
+
+    ADCChannelSelect(ADC_CH_CURRENT);
+    CPUdelay(10);
+    ADC_read(buf);
+}
+
+// theoretical boundary <20, 10~500, >100 (uA)
+#define GAIN_SMALL_BOUNDARY 40000  // 40 uA = 40,000,000 pA
+#define GAIN_MID_BOUNDARY1  20000  // 20 uA = 20,000,000 pA
+#define GAIN_MID_BOUNDARY2  400000 // 400 uA = 400,000,000 pA
+#define GAIN_LARGE_BOUNDARY 200000 // 200 uA = 200,000 nA
+
+static int32_t AutoGainReadCurrent(uint8_t *buf){
+    int32_t Real_Current = 0;
+
+    if(INSTRUCTION.ADCGainLevel == GAIN_AUTO){
+        INSTRUCTION.ADCGainLevel = GAIN_200R;
+//        LED_color(DARKLED, 0x00, 0x00, 0xFF);
+    }
+
+    if(INSTRUCTION.ADCGainLevel == GAIN_200R){
+        ReadCurrent(spi_ADC_rxbuf);
+        Real_Current = DecodeADCValue(INSTRUCTION.ADCGainLevel, ADC_CH_CURRENT, spi_ADC_rxbuf);
+
+        // switch to mid range current
+        if(Real_Current < GAIN_LARGE_BOUNDARY && Real_Current > -1*GAIN_LARGE_BOUNDARY){
+            INSTRUCTION.ADCGainLevel = GAIN_10K;
+            ReadCurrent(spi_ADC_rxbuf);
+            Real_Current = DecodeADCValue(INSTRUCTION.ADCGainLevel, ADC_CH_CURRENT, spi_ADC_rxbuf);
+//            LED_color(DARKLED, 0x00, 0xFF, 0x00);
+
+//            // switch to small range current
+//            if (Real_Current < GAIN_MID_BOUNDARY1 && Real_Current > -1*GAIN_MID_BOUNDARY1){
+//                INSTRUCTION.ADCGainLevel = GAIN_200K;
+//                ReadCurrent(spi_ADC_rxbuf);
+//                Real_Current = DecodeADCValue(INSTRUCTION.ADCGainLevel, ADC_CH_CURRENT, spi_ADC_rxbuf);
+//                LED_color(DARKLED, 0xFF, 0x00, 0x00);
+//            }
+        }
+    }
+    else if(INSTRUCTION.ADCGainLevel == GAIN_10K){
+        ReadCurrent(spi_ADC_rxbuf);
+        Real_Current = DecodeADCValue(INSTRUCTION.ADCGainLevel, ADC_CH_CURRENT, spi_ADC_rxbuf);
+
+        // switch to large range current
+        if(Real_Current > GAIN_MID_BOUNDARY2 || Real_Current < -1*GAIN_MID_BOUNDARY2){
+            INSTRUCTION.ADCGainLevel = GAIN_200R;
+            ReadCurrent(spi_ADC_rxbuf);
+            Real_Current = DecodeADCValue(INSTRUCTION.ADCGainLevel, ADC_CH_CURRENT, spi_ADC_rxbuf);
+//            LED_color(DARKLED, 0x00, 0x00, 0xFF);
+        }
+
+        // switch to small range current
+        else if (Real_Current < GAIN_MID_BOUNDARY1 && Real_Current > -1*GAIN_MID_BOUNDARY1){
+            INSTRUCTION.ADCGainLevel = GAIN_200K;
+            ReadCurrent(spi_ADC_rxbuf);
+            Real_Current = DecodeADCValue(INSTRUCTION.ADCGainLevel, ADC_CH_CURRENT, spi_ADC_rxbuf);
+//            LED_color(DARKLED, 0xFF, 0x00, 0x00);
+        }
+    }
+    else if(INSTRUCTION.ADCGainLevel == GAIN_200K){
+        ReadCurrent(spi_ADC_rxbuf);
+        Real_Current = DecodeADCValue(INSTRUCTION.ADCGainLevel, ADC_CH_CURRENT, spi_ADC_rxbuf);
+
+        // switch to mid range current
+        if(Real_Current > GAIN_SMALL_BOUNDARY || Real_Current < -1*GAIN_SMALL_BOUNDARY){
+            INSTRUCTION.ADCGainLevel = GAIN_10K;
+            ReadCurrent(spi_ADC_rxbuf);
+            Real_Current = DecodeADCValue(INSTRUCTION.ADCGainLevel, ADC_CH_CURRENT, spi_ADC_rxbuf);
+//            LED_color(DARKLED, 0x00, 0xFF, 0x00);
+           // switch to large range current
+//           if(Real_Current > GAIN_MID_BOUNDARY2 || Real_Current < -1*GAIN_MID_BOUNDARY2){
+//               INSTRUCTION.ADCGainLevel = GAIN_200R;
+//               ReadCurrent(spi_ADC_rxbuf);
+//               Real_Current = DecodeADCValue(INSTRUCTION.ADCGainLevel, ADC_CH_CURRENT, spi_ADC_rxbuf);
+//           }
+       }
+    }
+    return Real_Current;
+}
+
 #endif

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

@@ -0,0 +1,209 @@
+
+#ifndef ELITECCMODE
+#define ELITECCMODE
+
+static void CCModeDACControl(int32_t IUC_Measure_Difference);
+
+static int32_t CCModeReadCurrent(CCMode *CC){
+
+    static bool IVSwitch = false;
+
+    CCModeDACEnable = 1;    // This flag will control DAC working
+
+    // set current value and ADC gain level
+    CCCurrent2IUC(CC);
+
+    // decode ADC value and put it into notify buffer
+    if(IVSwitch){
+        IVSwitch = false;
+        if(INSTRUCTION.AutoGainEnable){
+            CC->_MeasureData = AutoGainReadCurrent(spi_ADC_rxbuf);
+        }
+        else{
+            ReadCurrent(spi_ADC_rxbuf);
+            CC->_MeasureData = DecodeADCValue(INSTRUCTION.ADCGainLevel, ADC_CH_CURRENT, spi_ADC_rxbuf);
+        }
+    }
+    else{
+        IVSwitch = true;
+        /** read battery voltage **/
+        // read ADC volt
+        ReadVolt(spi_ADC_rxbuf);
+
+        // decode ADC value and put it into notify buffer
+        CC->BatteryV = DecodeADCValue(INSTRUCTION.ADCGainLevel, ADC_CH_VOLT, spi_ADC_rxbuf);
+    }
+    NotifyCurrent[0] = (uint8_t) (CC->_MeasureData >> 24);
+    NotifyCurrent[1] = (uint8_t) ((CC->_MeasureData & 0x00FF0000) >> 16);
+    NotifyCurrent[2] = (uint8_t) ((CC->_MeasureData & 0x0000FF00) >> 8);
+    NotifyCurrent[3] = (uint8_t) (CC->_MeasureData & 0x000000FF);
+
+    NotifyVolt[0] = (uint8_t) (CC->BatteryV >> 24);
+    NotifyVolt[1] = (uint8_t) ((CC->BatteryV & 0x00FF0000) >> 16);
+    NotifyVolt[2] = (uint8_t) ((CC->BatteryV & 0x0000FF00) >> 8);
+    NotifyVolt[3] = (uint8_t) (CC->BatteryV & 0x000000FF);
+
+    return CC->_MeasureData;
+}
+
+static int32_t CCModeVoltOut(CCMode *CC){
+    int32_t MeasureCurrent = 0, IUCCurrent = 0, ADCRealVolt = 0;
+
+    if(!CCModeDACEnable){
+        // DAC should not work now
+        return 0;
+    }
+
+    IUCCurrent = CC->_Transform2RealnA(CC);
+
+    MeasureCurrent = CC->_MeasureData;
+    CCModeDACControl(IUCCurrent - MeasureCurrent);
+
+//    NotifyCurrent[0] = (uint8_t) (IUCCurrent >> 24);
+//    NotifyCurrent[1] = (uint8_t) ((IUCCurrent & 0x00FF0000) >> 16);
+//    NotifyCurrent[2] = (uint8_t) ((IUCCurrent & 0x0000FF00) >> 8);
+//    NotifyCurrent[3] = (uint8_t) (IUCCurrent & 0x000000FF);
+//
+//    NotifyImpedance[0] = (uint8_t) (MeasureCurrent >> 24);
+//    NotifyImpedance[1] = (uint8_t) ((MeasureCurrent & 0x00FF0000) >> 16);
+//    NotifyImpedance[2] = (uint8_t) ((MeasureCurrent & 0x0000FF00) >> 8);
+//    NotifyImpedance[3] = (uint8_t) (MeasureCurrent & 0x000000FF);
+
+//    DACCode2Real2Notify(Usercode_Correction_to_DAC(INSTRUCTION.VoltConstant));
+//    if(IUCCurrent > 1000){
+//        ADCRealVolt = 2*(INSTRUCTION.VoltConstant - 25000)/10 - IUCCurrent*200/1e6;
+//    }
+//    else{
+//      ADCRealVolt = 2*(INSTRUCTION.VoltConstant - 25000)/10 - IUCCurrent*200/1e7;
+//    }
+
+    CCModeDACEnable = 0;
+    return MeasureCurrent;
+}
+
+static void CCModeDACControl(int32_t IUC_Measure_Difference){
+    int32_t step;
+    if(IUC_Measure_Difference < 100 && IUC_Measure_Difference > -100){
+        step = (IUC_Measure_Difference > 0) ? 1:-1;
+    }
+    else if(IUC_Measure_Difference < 1000 && IUC_Measure_Difference > -1000){
+        step = IUC_Measure_Difference / 100;
+    }
+    else if(IUC_Measure_Difference < 10000 && IUC_Measure_Difference > -10000){
+        step = IUC_Measure_Difference / 1000;
+    }
+    else{
+        step = IUC_Measure_Difference / 1e4;
+    }
+
+    // over/under flow
+    if( (INSTRUCTION.VoltConstant + step) > MAX_DAC_UC || (INSTRUCTION.VoltConstant + step) < MIN_DAC_UC ){
+        if(step > 0){
+            INSTRUCTION.VoltConstant = (INSTRUCTION.VoltConstant + MAX_DAC_UC)/2;
+        }
+        else{
+            INSTRUCTION.VoltConstant = (INSTRUCTION.VoltConstant + MIN_DAC_UC)/2;
+        }
+    }
+    else{
+        INSTRUCTION.VoltConstant = INSTRUCTION.VoltConstant + step;
+    }
+    DAC_outputV(Usercode_Correction_to_DAC(INSTRUCTION.VoltConstant));
+
+//    NotifyCurrent[0] = (uint8_t) ( step >> 24);
+//    NotifyCurrent[1] = (uint8_t) (( step & 0x00FF0000) >> 16);
+//    NotifyCurrent[2] = (uint8_t) (( step & 0x0000FF00) >> 8);
+//    NotifyCurrent[3] = (uint8_t) ( step & 0x000000FF);
+}
+
+// XXX : should we reset DAC output after STOP?
+static void CCModeReverseCurrent(CCMode *CC){
+    if(CC->StandBy){
+        if(CT.StandByCounter == CC->StandByTime){
+            CC->StandBy = false;
+            CT.StandByCounter = 0;
+        }
+        else{
+            CT.StandByCounter ++;
+        }
+    }
+    else{
+        // reverse charge/discharge
+        if(CC->BatteryV == CC->VMax){
+            CC->StandBy = true;
+            CC->value = CC->DischargeCurrent;
+        }
+        else if(CC->BatteryV == CC->VMin){
+            CC->StandBy = true;
+            CC->value = CC->ChargeCurrent;
+        }
+    }
+}
+
+/* Transform setting CC into IUC
+*
+* User code in CC mode : 0 ~ 3000000
+* Real current value : -15.00000 ~ 15.00000 mA
+*  => user code = 1500000 mapping to 0.00000 mA
+*/
+static void CCCurrent2IUC(CCMode *CC){
+    int32_t CurrentValue = 0;
+
+    CC->value = INSTRUCTION.ConstantCurrent;
+    CurrentValue = CC->value - CC_ZERO_POINT;
+
+    /* set ADC level */
+    // largest current
+    if (CurrentValue > 10000 || CurrentValue < -10000){
+        CC->lv = GAIN_200R;
+    }
+    // mid range current
+    else if (CurrentValue > 1000 || CurrentValue < -1000){
+        CC->lv = GAIN_10K;
+    }
+    // least range current
+    else{
+        CC->lv = GAIN_200K;
+    }
+}
+
+/*********************************************************************
+ * @fn      Transform2RealnA
+ *
+ * @brief   transform an IUC into real current value in nA.
+ *
+ * @param   self, which is an IUC
+ *
+ * @return  an int32_t current value in nA
+ */
+//static int32_t _Transform2RealnA(CCMode *self){
+//    int32_t IUCReal;
+//
+//    // self->value : 0 ~ 3000000 (which is -1500000 ~ 1500000 (10nA) )
+//    IUCReal = (self->value - CC_ZERO_POINT) * 10;
+//    return IUCReal;
+//}
+//
+//static void SetMeasureCurrent(CCMode *self, int32_t current){
+//    self->_MeasureCurrent = current;
+//}
+//
+//static int32_t GetMeasureCurrent(CCMode *self){
+//    return self->_MeasureCurrent;
+//}
+
+//static CURRENT_USER_CODE *InitCurrentUserCode(){
+//    CCMode *CurrentUserCode = malloc(sizeof(CCMode));
+//    CurrentUserCode->value = CC_ZERO_POINT;
+//    CurrentUserCode->lv = GAIN_AUTO;
+//    CurrentUserCode->Vmax = MAX_DAC_UC;  // max DAC UserCode
+//    CurrentUserCode->Vmin = MIN_DAC_UC;  // min DAC UserCode
+//    CurrentUserCode-> _MeasureData = 0;
+//    CurrentUserCode->_Transform2RealnA = &_Transform2RealnA;
+//    CurrentUserCode->SetMeasureData = &SetMeasureCurrent;
+//    CurrentUserCode->GetMeasureData = &GetMeasureCurrent;
+//    return CurrentUserCode;
+//}
+
+
+#endif

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

@@ -0,0 +1,245 @@
+
+#ifndef ELITECV
+#define ELITECV
+
+static uint16_t SWVCurve(WorkMode *WorkModeData) {
+    static uint8_t  counter;
+    static uint16_t outputV;
+    static uint16_t Volt;
+    static bool     direction_up;
+
+    // reset origin volt at the begin
+    if (DACReset) {
+        Volt    = INSTRUCTION.VoltOrigin;
+        outputV = INSTRUCTION.VoltOrigin;
+        if (INSTRUCTION.VoltOrigin < INSTRUCTION.VoltFinal)
+            direction_up = true;
+        else
+            direction_up = false;
+        counter  = 1;
+        DACReset = false;
+    }
+
+    if (counter == 2 * PulseWidth)
+        counter = 1;
+    else
+        counter++;
+
+    // output a certain volt
+    outputV = Volt;
+    DAC_outputV(outputV);
+
+    // VoltValue = (ramp1*16 + ramp0/16) * 3.05;
+
+    // check if we reach the final volt
+    if ((outputV >= INSTRUCTION.VoltFinal && direction_up) || (outputV <= INSTRUCTION.VoltFinal && !direction_up)) {
+        PeriodicEvent = false;
+        DACReset      = true;
+    }
+
+    // prepare the next output volt
+    if (direction_up) {
+        if (counter == PulseWidth)
+            Volt = Volt + Amplitude;
+        else if (counter == 2 * PulseWidth)
+            Volt = Volt - (Amplitude - INSTRUCTION.Step);
+        else
+            Volt = Volt;
+    } else {
+        if (counter == PulseWidth)
+            Volt = Volt - Amplitude;
+        else if (counter == 2 * PulseWidth)
+            Volt = Volt + (Amplitude - INSTRUCTION.Step);
+        else
+            Volt = Volt;
+    }
+
+    return outputV;
+}
+
+static uint16_t DPVCurve(WorkMode *WorkModeData) {
+    static uint8_t  counter;
+    static uint16_t Volt1;
+    static uint16_t Volt2;
+    static uint16_t outputV;
+    static bool     direction_up;
+
+    // reset origin volt at the begin
+    if (DACReset) {
+        if (INSTRUCTION.VoltOrigin < INSTRUCTION.VoltFinal)
+            direction_up = true;
+        else
+            direction_up = false;
+
+        Volt1 = INSTRUCTION.VoltOrigin;
+        if (direction_up)
+            Volt2 = INSTRUCTION.VoltOrigin + Amplitude;
+        else
+            Volt2 = INSTRUCTION.VoltOrigin - Amplitude;
+
+        counter  = 1;
+        DACReset = false;
+    }
+
+    if (counter == PulsePeriod)
+        counter = 1;
+    else
+        counter++;
+
+    // output a certain volt
+    if (counter <= (PulsePeriod - PulseWidth)) {
+        outputV = Volt1;
+        DAC_outputV(Volt1);
+    } else {
+        outputV = Volt2;
+        DAC_outputV(Volt2);
+    }
+
+
+    // VoltValue = (ramp1*16 + ramp0/16) * 3.05;
+
+    // check if we reach the final volt
+    if (((outputV >= INSTRUCTION.VoltFinal) && direction_up) || ((outputV <= INSTRUCTION.VoltFinal) && !direction_up)) {
+        PeriodicEvent = false;
+        DACReset      = true;
+    }
+
+    // check overflow/underflow and prepare for next output
+    if (direction_up) {
+        if (Volt1 + INSTRUCTION.Step < Volt1)
+            Volt1 = 0xffff;
+        else
+            Volt1 = Volt1 + INSTRUCTION.Step;
+        if (Volt2 + INSTRUCTION.Step < Volt2)
+            Volt2 = 0xffff;
+        else
+            Volt2 = Volt2 + INSTRUCTION.Step;
+    } else {
+        if (Volt1 - INSTRUCTION.Step > Volt1)
+            Volt1 = 0x0000;
+        else
+            Volt1 = Volt1 - INSTRUCTION.Step;
+        if (Volt2 - INSTRUCTION.Step > Volt2)
+            Volt2 = 0x0000;
+        else
+            Volt2 = Volt2 - INSTRUCTION.Step;
+    }
+
+    if (counter + 1 <= (PulsePeriod - PulseWidth)) {
+        return Volt1;
+    } else {
+        return Volt2;
+    }
+}
+
+static uint16_t CVCurve(CVMode *CV) {
+    static uint16_t DACOutCode;
+    static bool direction_up;           // direction_up = true, if Vfinal > Vorigin
+    static bool current_direction_up;   // current_direction_up = true, Vstep => positive. vice versa
+
+    // reset origin volt at the begin
+    if (DACReset) {
+        DACUserCode = CV->_VOrigin;
+        if (INSTRUCTION.VoltFinal > CV->_VOrigin) {
+            direction_up         = true;
+            current_direction_up = true;
+        } else {
+            direction_up         = false;
+            current_direction_up = false;
+        }
+
+        DACOutCode = Usercode_Correction_to_DAC(DACUserCode);
+        DAC_outputV(DACOutCode);    // output VOLT_ORIGIN
+        DACReset   = false;
+
+        return DACOutCode;
+    }
+
+    if (CT.StepTimeCounter == CV->_StepTime) {
+
+        // Decide next direction
+        if (direction_up) {
+            if (DACUserCode >= CV->_VStop) {
+                current_direction_up = false;  // problem occurs when origin == 0000 final == ffff!!!!!!
+            } else if (DACUserCode <= CV->_VOrigin) {
+                current_direction_up = true;
+                if (CV->_CycleNumber == 0) {
+                    PeriodicEvent = false;  // periodic event end
+                    DACReset      = true;
+                }
+                CV->_CycleNumber--;
+            }
+        } else {
+            if (DACUserCode <= CV->_VStop) {
+                current_direction_up = true;  // problem occurs when origin == 0000 final == ffff!!!!!!
+            } else if (DACUserCode >= CV->_VOrigin) {
+                current_direction_up = false;
+                if (CV->_CycleNumber == 0) {
+                    PeriodicEvent = false;  // periodic event end
+                    DACReset      = true;
+                }
+                CV->_CycleNumber--;
+            }
+        }
+
+        // Next output voltage
+        if (direction_up) {
+            if (current_direction_up) {
+                // DACUserCode overflow ?
+                if (DACUserCode + CV->_Step < DACUserCode) {
+                    DACUserCode = CV->_VStop;
+                }
+                else if (DACUserCode + CV->_Step > CV->_VStop) {
+                    DACUserCode =CV->_VStop;
+                }
+                else {
+                    DACUserCode = DACUserCode + CV->_Step;
+                }
+            }
+            else {
+                // DACUserCode underflow ?
+                if (DACUserCode - CV->_Step > DACUserCode || DACUserCode > 60000) {
+                    DACUserCode = CV->_VOrigin;
+                }
+
+                // reach Vorigin ?
+                else if (DACUserCode - CV->_Step <  CV->_VOrigin) {
+                    DACUserCode = CV->_VOrigin;
+                }
+                else {
+                    DACUserCode = DACUserCode - CV->_Step;
+                }
+            }
+        }
+        else {
+            if (current_direction_up) {
+                if (DACUserCode + CV->_Step < DACUserCode) {
+                     DACUserCode = CV->_VOrigin;
+                }
+                else if (DACUserCode + CV->_Step >  CV->_VOrigin) {
+                    DACUserCode = CV->_VOrigin;
+                }
+                else {
+                     DACUserCode = DACUserCode + CV->_Step;
+                }
+            }
+            else {
+                if (DACUserCode - CV->_Step > DACUserCode || DACUserCode > 60000) {
+                     DACUserCode = CV->_VStop ;
+                }
+                else if (DACUserCode - CV->_Step < CV->_VStop) {
+                    DACUserCode = CV->_VStop;
+                }
+                else {
+                     DACUserCode = DACUserCode - CV->_Step;
+                }
+            }
+        }
+        DACOutCode = Usercode_Correction_to_DAC(DACUserCode);
+        DAC_outputV(DACOutCode);
+    }
+    return DACOutCode;
+}
+
+
+#endif

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

@@ -2,41 +2,38 @@
 #ifndef EliteDAC
 #define EliteDAC
 
-static bool DACreset = true;
-/* DAC reset parameter */
-#define DACzero 0x85B2
-#define DACposMax 0x0000
-#define DACnegMax 0xFFFF
+static bool DACReset;
 
-#ifdef ELITE_VERSION_1_3
-#define DACOUT 0x30
 
-static void DAC_outputV(uint16_t voltLV) {
-    // C = command, X = don't care, D = data
-    // CCCC XXXX = command
-    // DDDD DDDD = v1
-    // DDDD XXXX = v2
-
-    uint8_t v1, v2 = 0;
-    v1 = (uint8_t) (voltLV >> 4) & 0xFF;
-    v2 = (uint8_t) ((voltLV & 0x000F) << 4) & 0xF0;
-
-    spi_DACtxbuf[0] = command;
-    spi_DACtxbuf[1] = v1;
-    spi_DACtxbuf[2] = v2;
-    for (int i = 3; i < SPI_DAC_SIZE; i++) {
-        spi_DACtxbuf[i] = 0;
-    }
-
-    DAC_SPI(SPI_DAC_SIZE, spi_DACtxbuf, spi_rxbuf);
-}
-#endif
+//#ifdef ELITE_VERSION_1_3
+//#define DACOUT 0x30
+//
+//static void DAC_outputV(uint16_t voltLV) {
+//    // C = command, X = don't care, D = data
+//    // CCCC XXXX = command
+//    // DDDD DDDD = v1
+//    // DDDD XXXX = v2
+//
+//    uint8_t v1, v2 = 0;
+//    v1 = (uint8_t) (voltLV >> 4) & 0xFF;
+//    v2 = (uint8_t) ((voltLV & 0x000F) << 4) & 0xF0;
+//
+//    spi_DACtxbuf[0] = command;
+//    spi_DACtxbuf[1] = v1;
+//    spi_DACtxbuf[2] = v2;
+//    for (int i = 3; i < SPI_DAC_SIZE; i++) {
+//        spi_DACtxbuf[i] = 0;
+//    }
+//
+//    DAC_SPI(SPI_DAC_SIZE, spi_DACtxbuf, spi_rxbuf);
+//}
+//#endif
 
 #ifdef ELITE_VERSION_1_4
 #define DACCLS 0x02
 #define DACOUT 0x31
 
-static void DAC_outputV(uint16_t voltLV) {
+static uint16_t DAC_outputV(uint16_t voltLV) {
     // C = command, X = don't care, D = data
     // CCCC CCCC = command
     // DDDD DDDD = v1
@@ -55,8 +52,14 @@ static void DAC_outputV(uint16_t voltLV) {
     spi_DACtxbuf[2] = v2;
 
     DAC_SPI(SPI_DAC_SIZE, spi_DACtxbuf, spi_rxbuf);
+    return voltLV;
 }
 
 #endif
 
+static int32_t User2Real(uint16_t UserCode){
+    /* transfer usercode to real voltage value (mV) */
+    return (int32_t) ((UserCode - 25000)*2)/10;
+}
+
 #endif

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

@@ -1,30 +1,10 @@
-
 #ifndef EliteCorrection
 #define EliteCorrection
 
 #include "EliteDAC.h"
 #include "EliteADC.h"
 
-/* DAC reset parameter */
-#define DACzero 0x85A2
-#define DACposMax 0x0000
-#define DACnegMax 0xFFFF
 
-typedef struct _formula{
-
-    int32_t coeff = 0;
-    int32_t offset = 0;
-
-}Formula;
-
-typedef struct _correction{
-
-    Formula ADC_volt = 0;
-    Formula ADC_current[3] = 0;
-    uint32_t Gain0Boundary[2] = {0, 0};
-    uint32_t Gain1BoundARY[2] = {0, 0};
-
-}Correction_data;
 
 /*
 *   Correction Array include all the correction coeff and offset
@@ -34,175 +14,727 @@ typedef struct _correction{
 *   code is the code we read from ADC buffer
 *
 *   ADC measure Voltage
-*   Correction[0] = ADC Volt coeff
-*   Correction[1] = ADC Volt offset  => RealVolt = Correction[0] * code + Correction[1]
+*   RealVolt = Correction.ADC_volt.coeff * code + Correction.ADC_volt.offset
 *
 *   ADC measure Current
-*   Correctino[2] = ADC gain_lv0 coeff
-*   Correction[3] = ADC gain_lv0 offset => RealCurrent = Correction[2] * code + Correction[3]
-*   Correctino[4] = ADC gain_lv1 coeff
-*   Correction[5] = ADC gain_lv1 offset => RealCurrent = Correction[4] * code + Correction[5]
-*   Correctino[6] = ADC gain_lv2 coeff
-*   Correction[7] = ADC gain_lv2 offset => RealCurrent = Correction[6] * code + Correction[7]
+*   ADCGain:  0 => 200k, 1 => 10k, 2 => 200R
+*   RealCurrent = Correction.ADC_current[ADCGain].coeff * code + Correction.ADC_current[ADCGain].offset
 *
 *   DAC output Voltage
-*   Correction[8] = DAC coeff
-*   Correction[9] = DAC offset  => RealVolt = Correction[8] * DACcode + Correction[9]
+*   RealVolt = Correction.DAC2RealV.coeff * DACcode + Correction.DAC2RealV.offset
+*
+*   Usercode to DACcode
+*   DACcode = Correction.Usercode2DAC.coeff * code + Correction.Usercode2DAC.offset
 *
 */
-#define BORAD_Chao_I
 
-#ifdef BORAD_CLASS_LEADER
-static Correction_data Correction;
 
-Correction.ADC_volt.coeff = (-629);
-Correction.ADC_volt.offset = 15447740;
+#define BOARD_EARTH
 
-Correction.ADC_current_200k.coeff = 3056;
-Correction.ADC_current_200k.offset = -74771591;
+typedef struct _formula{
 
-Correction.ADC_current_10K.coeff = 65461;
-Correction.ADC_current_10K.offset = -1601786957;
+    long long coeff;
+    long long offset;
 
-Correction.ADC_current_200R.coeff = 3369;
-Correction.ADC_current_200R.offset = -82598293;
+}Formula;
 
-Correction.Gain0Boundary[0] = 0x5F75;
-Correction.Gain0Boundary[1] = 0x5FB2;
+struct _correction{
 
-Correction.Gain1Boundary[0] = 0x5999;
-Correction.Gain1Boundary[1] = 0x6589;
+    Formula ADC_volt;
+    Formula ADC_current[3];
+    Formula DAC2RealV;
+    Formula Usercode2DAC;
+    uint16_t Gain0Boundary[2];
+    uint16_t Gain1Boundary[4];
+    uint16_t Gain2Boundary[2];
+
+} Correction =
+#ifdef BOARD_CLASS_LEADER
+{
+.ADC_volt.coeff = (-6292889),
+.ADC_volt.offset = 103042367157,
+
+.ADC_current[0].coeff = 310073435,
+.ADC_current[0].offset = -5059684947850,
+
+.ADC_current[1].coeff = 655940088,
+.ADC_current[1].offset = -10703396200801,
+
+.ADC_current[2].coeff = 31129894,
+.ADC_current[2].offset = -507980196120,
+
+.DAC2RealV.coeff = (-18959656),
+.DAC2RealV.offset = 565743281498,
+
+.Usercode2DAC.coeff = (-10517325),
+.Usercode2DAC.offset = 561574831511,
+
+.Gain0Boundary[0] = 0x5F75,
+.Gain0Boundary[1] = 0x5FB2,
+
+.Gain1Boundary[0] = 0x5999,
+.Gain1Boundary[1] = 0x6589
+};
 #endif
 
-
 #ifdef BORAD_TRICERATOPS
-static Correction_data Correction;
+{
+.ADC_volt.coeff = (-6259045),
+.ADC_volt.offset = 150606390230,
 
-Correction.ADC_volt.coeff = (-626);
-Correction.ADC_volt.offset = 15065046;
+.ADC_current[0].coeff = 30675739,
+.ADC_current[0].offset = (-736666253953),
 
-Correction.ADC_current_200k.coeff = 0;
-Correction.ADC_current_200k.offset = 0;
+.ADC_current[1].coeff = 749057318,
+.ADC_current[1].offset = (-17984432358007),
 
-Correction.ADC_current_10K.coeff = 0;
-Correction.ADC_current_10K.offset = 0;
+.ADC_current[2].coeff = 31242587,
+.ADC_current[2].offset = (-750184492407),
 
-Correction.ADC_current_200R.coeff = 0;
-Correction.ADC_current_200R.offset = 0;
+.DAC2RealV.coeff = (-18909689),
+.DAC2RealV.offset = 644251481046,
 
-Correction.Gain0Boundary[0] = 0;
-Correction.Gain0Boundary[1] = 0;
+.Usercode2DAC.coeff = (-10576588),
+.Usercode2DAC.offset = 605113842000,
 
-Correction.Gain1Boundary[0] = 0;
-Correction.Gain1Boundary[1] = 0;
+.Gain0Boundary[0] = 0x5DAA,
+.Gain0Boundary[1] = 0x5DF2,
+
+.Gain1Boundary[0] = 0x57E8,
+.Gain1Boundary[1] = 0x63B1
+};
 #endif
 
-#ifdef BORAD_Chao_I
-static Correction_data Correction;
+#ifdef BORAD_CHAO_I
+{
+.ADC_volt.coeff = (-6278082),
+.ADC_volt.offset = 151228681410,
 
-Correction.ADC_volt.coeff = (-627);
-Correction.ADC_volt.offset = 15122868;
+.ADC_current[0].coeff = 30908391,
+.ADC_current[0].offset = (-741477595514),
 
-Correction.ADC_current_200k.coeff = 3091;
-Correction.ADC_current_200k.offset = (-74147760);
+.ADC_current[1].coeff = 661271310,
+.ADC_current[1].offset = (-15864495597969),
 
-Correction.ADC_current_10K.coeff = 66127;
-Correction.ADC_current_10K.offset = (-1586449560);
+.ADC_current[2].coeff = 31183513,
+.ADC_current[2].offset = (-748178468530),
 
-Correction.ADC_current_200R.coeff = 3118;
-Correction.ADC_current_200R.offset = (74817847);
+.DAC2RealV.coeff = (-18975108),
+.DAC2RealV.offset = 644442607989,
 
-Correction.Gain0Boundary[0] = 0x5D96;
-Correction.Gain0Boundary[1] = 0x5DD9;
+.Usercode2DAC.coeff = (-10540121),
+.Usercode2DAC.offset = 603128277368,
 
-Correction.Gain1Boundary[0] = 0x57CD;
-Correction.Gain1Boundary[1] = 0x639F;
+.Gain0Boundary[0] = 0x5D96,
+.Gain0Boundary[1] = 0x5DD9,
+
+.Gain1Boundary[0] = 0x57CD,
+.Gain1Boundary[1] = 0x639F
+};
 #endif
 
 #ifdef BOARD_TWENTY_ONE
-static Correction_data Correction;
+{
+.ADC_volt.coeff = (-6258074),
+.ADC_volt.offset = 152210580945,
 
-Correction.ADC_volt.coeff = (-625);
-Correction.ADC_volt.offset = 15221058;
+.ADC_current[0].coeff = 30022512,
+.ADC_current[0].offset = -729552647201,
 
-Correction.ADC_current[0].coeff = 3002;
-Correction.ADC_current[0].offset = -72955265;
+.ADC_current[1].coeff = 658398533,
+.ADC_current[1].offset = -16001498741131,
 
-Correction.ADC_current[1].coeff = 65840;
-Correction.ADC_current[1].offset = -1600149874;
+.ADC_current[2].coeff = 30908351000,
+.ADC_current[2].offset = -746548614824000,
 
-Correction.ADC_current[2].coeff = 3090;
-Correction.ADC_current[2].offset = -75102578;
+.DAC2RealV.coeff = (-19007867),
+.DAC2RealV.offset = 646316924837,
 
-Correction.Gain0Boundary[0] = 0x5ECD;
-Correction.Gain0Boundary[1] = 0x5F0D;
+.Usercode2DAC.coeff = (-10521952),
+.Usercode2DAC.offset = 603074812599,
 
-Correction.Gain1Boundary[0] = 0x5900;
-Correction.Gain1Boundary[1] = 0x64DD;
+.Gain0Boundary[0] = 0x5ECD,
+.Gain0Boundary[1] = 0x5F0D,
+
+.Gain1Boundary[0] = 0x5900,
+.Gain1Boundary[1] = 0x64DD
+};
 #endif
 
+#ifdef BOARD_JOHN_CENA
+{
+.ADC_volt.coeff = (-6286465),
+.ADC_volt.offset = 151630618248,
+
+.ADC_current[0].coeff = 30960625,
+.ADC_current[0].offset = -747979808432,
+
+.ADC_current[1].coeff = 652738209,
+.ADC_current[1].offset = -15767733896990,
+
+.ADC_current[2].coeff = 30959456,
+.ADC_current[2].offset = -748026885843,
+
+.DAC2RealV.coeff = (-18880478),
+.DAC2RealV.offset = 629012735316,
+
+.Usercode2DAC.coeff = (-10592952),
+.Usercode2DAC.offset = 604535526400,
+
+.Gain0Boundary[0] = 0x7653, // 20 uA
+.Gain0Boundary[1] = 0x4504, // -20 uA
+
+.Gain1Boundary[0] = 0x7C69, // 500 uA
+.Gain1Boundary[1] = 0x405D, // -500 uA
+.Gain1Boundary[2] = 0x5F4A, //  10 uA
+.Gain1Boundary[3] = 0x5D7D, // -10 uA
+
+.Gain2Boundary[0] = 0x5EC2, // 300 uA
+.Gain2Boundary[1] = 0x5E01, // -300 uA
+//.Gain0SupportRange =
+//.Gain1SupportRange[0] =
+//.Gain1SupportRange[1] =
+//.Gain2SupportRange =
+};
+#endif
+
+
+#ifdef BOARD_GENIUS
+{
+.ADC_volt.coeff = (-6236652),
+.ADC_volt.offset = 101533279052,
+
+.ADC_current[0].coeff = 31094976,
+.ADC_current[0].offset = (-507114075439),
+
+.ADC_current[1].coeff = 31218018,
+.ADC_current[1].offset = (-508593562044),
+
+.ADC_current[2].coeff = 557826631,
+.ADC_current[2].offset = (-9088752534070),
+
+.DAC2RealV.coeff = (-18990774),
+.DAC2RealV.offset = 570886531263,
+
+.Usercode2DAC.coeff = (-10605006),
+.Usercode2DAC.offset = 566878948150,
+
+.Gain0Boundary[0] = 0x5D96,
+.Gain0Boundary[1] = 0x5DD9,
+
+.Gain1Boundary[0] = 0x57CD,
+.Gain1Boundary[1] = 0x639F
+};
+#endif
+
+#ifdef BOARD_DA_SHUN
+{
+.ADC_volt.coeff = (-6280824),
+.ADC_volt.offset = 151787055168,
+
+.ADC_current[0].coeff = 25109217,
+.ADC_current[0].offset = (-606888506534),
+
+.ADC_current[1].coeff = 657619639,
+.ADC_current[1].offset = (-15894373245404),
+
+.ADC_current[2].coeff = 31040178,
+.ADC_current[2].offset = (-750263570000),
+
+.DAC2RealV.coeff = (-18975834),
+.DAC2RealV.offset = 647359124391,
+
+.Usercode2DAC.coeff = (-10539718),
+.Usercode2DAC.offset = 604829309500,
+
+.Gain0Boundary[0] = 0x5E2F,
+.Gain0Boundary[1] = 0x5E96,
+
+.Gain1Boundary[0] = 0x5878,
+.Gain1Boundary[1] = 0x645A
+};
+#endif
+
+#ifdef BOARD_CHIEN_YU
+{
+.ADC_volt.coeff = (-6279056),
+.ADC_volt.offset = 150985844279,
+
+.ADC_current[0].coeff = 31788227 ,
+.ADC_current[0].offset = (-765340735866),
+
+.ADC_current[1].coeff = 657619858,
+.ADC_current[1].offset = (-15835988865283),
+
+.ADC_current[2].coeff = 31116362,
+.ADC_current[2].offset = (-749402214847),
+
+.DAC2RealV.coeff = (-18935149),
+.DAC2RealV.offset = 643063752893,
+
+.Usercode2DAC.coeff = (-10567567),
+.Usercode2DAC.offset = 603991718526,
+
+.Gain0Boundary[0] = 0x5DE5,
+.Gain0Boundary[1] = 0x5E30,
+
+.Gain1Boundary[0] = 0x5820,
+.Gain1Boundary[1] = 0x6408
+};
+#endif
+
+#ifdef BOARD_LITTLE_STAR
+{
+.ADC_volt.coeff = (-6224192),
+.ADC_volt.offset = 101472884698,
+
+.ADC_current[0].coeff = 31293602,
+.ADC_current[0].offset = (-510187416959),
+
+.ADC_current[1].coeff = 655130048,
+.ADC_current[1].offset = (-10680093830418),
+
+.ADC_current[2].coeff = 31450484,
+.ADC_current[2].offset = (-512697942950),
+
+.DAC2RealV.coeff = (-18690126),
+.DAC2RealV.offset = 564319610294 ,
+
+.Usercode2DAC.coeff = (-10524846),
+.Usercode2DAC.offset = 561713962333,
+
+.Gain0Boundary[0] = 0x5E2F,
+.Gain0Boundary[1] = 0x5E96,
+
+.Gain1Boundary[0] = 0x5878,
+.Gain1Boundary[1] = 0x645A
+};
+#endif
+
+#ifdef BOARD_517
+{
+.ADC_volt.coeff = (-6244769),
+.ADC_volt.offset = 101714685687,
+
+.ADC_current[0].coeff = 30919726,
+.ADC_current[0].offset = (-503489101786),
+
+.ADC_current[1].coeff = 654824495,
+.ADC_current[1].offset = (-10660542778914),
+
+.ADC_current[2].coeff = 31376265,
+.ADC_current[2].offset = (-510797752348),
+
+.DAC2RealV.coeff = (-18690126),
+.DAC2RealV.offset = 564319610294 ,
+
+.Usercode2DAC.coeff = (-10500774),
+.Usercode2DAC.offset = 560779455904,
+
+.Gain0Boundary[0] = 0x5E2F,
+.Gain0Boundary[1] = 0x5E96,
+
+.Gain1Boundary[0] = 0x5878,
+.Gain1Boundary[1] = 0x645A
+};
+#endif
+
+#ifdef BOARD_FISH_VET
+{
+.ADC_volt.coeff = (-6243954),
+.ADC_volt.offset = 101956814341,
+
+.ADC_current[0].coeff = 6208753,
+.ADC_current[0].offset = (-101076436901),
+
+.ADC_current[1].coeff = 68760643,
+.ADC_current[1].offset = (-1123221851971),
+
+.ADC_current[2].coeff = 61882330000,
+.ADC_current[2].offset = (-10103859661590),
+
+.DAC2RealV.coeff = (-18690126),
+.DAC2RealV.offset = 564319610294,
+
+.Usercode2DAC.coeff = (-10517326),
+.Usercode2DAC.offset = 561574831512,
+
+.Gain0Boundary[0] = 0x5E2F,
+.Gain0Boundary[1] = 0x5E96,
+
+.Gain1Boundary[0] = 0x5878,
+.Gain1Boundary[1] = 0x645A
+};
+#endif
+
+#ifdef BOARD_KELLY
+{
+.ADC_volt.coeff = (-6238112),
+.ADC_volt.offset = 101628014509,
+
+.ADC_current[0].coeff = 6087943,
+.ADC_current[0].offset = (-99768174580),
+
+.ADC_current[1].coeff = 68915156,
+.ADC_current[1].offset = (-1121470119188),
+
+.ADC_current[2].coeff = 61800515,
+.ADC_current[2].offset = (-1006755993534),
+
+.DAC2RealV.coeff = (-18690126),
+.DAC2RealV.offset = 564319610294,
+
+.Usercode2DAC.coeff = (-10528309),
+.Usercode2DAC.offset = 561035476688,
+
+.Gain0Boundary[0] = 0x5E2F,
+.Gain0Boundary[1] = 0x5E96,
+
+.Gain1Boundary[0] = 0x5878,
+.Gain1Boundary[1] = 0x645A
+};
+#endif
+
+#ifdef BOARD_BAY_BAY
+{
+.ADC_volt.coeff = (-6223734),
+.ADC_volt.offset = 101647006833,
+
+.ADC_current[0].coeff = 31039179,
+.ADC_current[0].offset = (-506383432096),
+
+.ADC_current[1].coeff = 647940355,
+.ADC_current[1].offset = (-10611041889224),
+
+.ADC_current[2].coeff = 31094976,
+.ADC_current[2].offset = (-507114075439),
+
+.DAC2RealV.coeff = (-18690126),
+.DAC2RealV.offset = 564319610294,
+
+.Usercode2DAC.coeff = (-10541677),
+.Usercode2DAC.offset = 562208801371,
+
+.Gain0Boundary[0] = 0x5E2F,
+.Gain0Boundary[1] = 0x5E96,
+
+.Gain1Boundary[0] = 0x5878,
+.Gain1Boundary[1] = 0x645A
+};
+#endif
+
+#ifdef BOARD_MEOWMI
+{
+.ADC_volt.coeff = (-6265015),
+.ADC_volt.offset = 101843650153,
+
+.ADC_current[0].coeff = 62522034,
+.ADC_current[0].offset = (-1016702373525),
+
+.ADC_current[1].coeff = 31613132,
+.ADC_current[1].offset = (-514033175600),
+
+.ADC_current[2].coeff = 565897139,
+.ADC_current[2].offset = (-9201204539440),
+
+.DAC2RealV.coeff = (-18990774),
+.DAC2RealV.offset = 570886531263,
+
+.Usercode2DAC.coeff = (-10541427),
+.Usercode2DAC.offset = 562159124753,
+
+.Gain0Boundary[0] = 0x5D96,
+.Gain0Boundary[1] = 0x5DD9,
+
+.Gain1Boundary[0] = 0x57CD,
+.Gain1Boundary[1] = 0x639F
+};
+#endif
+
+#ifdef BOARD_EUROPEAN
+{
+.ADC_volt.coeff = (-6264190),
+.ADC_volt.offset = 101683809669,
+
+.ADC_current[0].coeff = 31301451,
+.ADC_current[0].offset = (-508301866021),
+
+.ADC_current[1].coeff = 656423459,
+.ADC_current[1].offset = (-10660544072862),
+
+.ADC_current[2].coeff = 31414514000,
+.ADC_current[2].offset = (-510185549182000),
+
+.DAC2RealV.coeff = (-18990774),
+.DAC2RealV.offset = 570886531263,
+
+.Usercode2DAC.coeff = (-10513774),
+.Usercode2DAC.offset = 559795292677,
+
+.Gain0Boundary[0] = 0x5D96,
+.Gain0Boundary[1] = 0x5DD9,
+
+.Gain1Boundary[0] = 0x57CD,
+.Gain1Boundary[1] = 0x639F
+};
+#endif
+
+#ifdef BOARD_EARTH
+{
+.ADC_volt.coeff = (-6256660),
+.ADC_volt.offset = 101658275678,
+
+.ADC_current[0].coeff = 31271240,
+.ADC_current[0].offset = (-508496329863),
+
+.ADC_current[1].coeff = 659931818,
+.ADC_current[1].offset = (-10729666444387),
+
+.ADC_current[2].coeff = 31485559000,
+.ADC_current[2].offset = (-511907957163000),
+
+.DAC2RealV.coeff = (-19047143),
+.DAC2RealV.offset = 565935714286,
+
+.Usercode2DAC.coeff = (-10500262),
+.Usercode2DAC.offset = 559630236100,
+
+.Gain0Boundary[0] = 0x5D96,
+.Gain0Boundary[1] = 0x5DD9,
+
+.Gain1Boundary[0] = 0x57CD,
+.Gain1Boundary[1] = 0x639F
+};
+#endif
+
+#ifdef BOARD_WATER_STAR
+{
+.ADC_volt.coeff = (-6259808),
+.ADC_volt.offset = 102009860128,
+
+.ADC_current[0].coeff = 31335917,
+.ADC_current[0].offset = (-511426612252),
+
+.ADC_current[1].coeff = 658172815,
+.ADC_current[1].offset = (-10738251896209),
+
+.ADC_current[2].coeff = 31482687000,
+.ADC_current[2].offset = (-513650531545000),
+
+.DAC2RealV.coeff = (-10548297),
+.DAC2RealV.offset = 562611756757,
+
+.Usercode2DAC.coeff = (-10500262),
+.Usercode2DAC.offset = 559630236100,
+
+.Gain0Boundary[0] = 0x5D96,
+.Gain0Boundary[1] = 0x5DD9,
+
+.Gain1Boundary[0] = 0x57CD,
+.Gain1Boundary[1] = 0x639F
+};
+#endif
+
+#ifdef BOARD_MARS
+{
+.ADC_volt.coeff = (-6270623),
+.ADC_volt.offset = 102383421553,
+
+.ADC_current[0].coeff = 31187022,
+.ADC_current[0].offset = (-509159321195),
+
+.ADC_current[1].coeff = 655981611,
+.ADC_current[1].offset = (-10709717111320),
+
+.ADC_current[2].coeff = 31256968,
+.ADC_current[2].offset = (-510275213115),
+
+.DAC2RealV.coeff = (-18937347),
+.DAC2RealV.offset = 568558163265,
+
+.Usercode2DAC.coeff = (-10561141),
+.Usercode2DAC.offset = 564249134291,
+
+.Gain0Boundary[0] = 0x5D96,
+.Gain0Boundary[1] = 0x5DD9,
+
+.Gain1Boundary[0] = 0x57CD,
+.Gain1Boundary[1] = 0x639F
+};
+#endif
+
+#ifdef BOARD_VENUS
+{
+.ADC_volt.coeff = (-6268996),
+.ADC_volt.offset = 102204055818,
+
+.ADC_current[0].coeff = 31131930,
+.ADC_current[0].offset = (-507382432547),
+
+.ADC_current[1].coeff = 654620883,
+.ADC_current[1].offset = (-10668953588943),
+
+.ADC_current[2].coeff = 31245260000,
+.ADC_current[2].offset = (-509181085054000),
+
+.DAC2RealV.coeff = (-19009388),
+.DAC2RealV.offset = 567032653061,
+
+.Usercode2DAC.coeff = (-10521117),
+.Usercode2DAC.offset = 561308254899,
+
+.Gain0Boundary[0] = 0x5D96,
+.Gain0Boundary[1] = 0x5DD9,
+
+.Gain1Boundary[0] = 0x57CD,
+.Gain1Boundary[1] = 0x639F
+};
+#endif
+
+#ifdef BOARD_MERCURY
+{
+.ADC_volt.coeff = (-6259808),
+.ADC_volt.offset = 102009860128,
+
+.ADC_current[0].coeff = 31335917,
+.ADC_current[0].offset = (-511426612252),
+
+.ADC_current[1].coeff = 658172815,
+.ADC_current[1].offset = (-10738251896209),
+
+.ADC_current[2].coeff = 31482687000,
+.ADC_current[2].offset = (-513650531545000),
+
+.DAC2RealV.coeff = (-19009388),
+.DAC2RealV.offset = 567032653061,
+
+.Usercode2DAC.coeff = (-10548297),
+.Usercode2DAC.offset = 562611756757,
+
+.Gain0Boundary[0] = 0x5D96,
+.Gain0Boundary[1] = 0x5DD9,
+
+.Gain1Boundary[0] = 0x57CD,
+.Gain1Boundary[1] = 0x639F
+};
+#endif
 
 // this function turn ADC measure value (0xXXXX) into real voltage
 // unit should be mV
 static int32_t DecodeADCVolt(uint16_t ADC_measure){
-    int32_t ADCRealVolt = 0;
+    long long ADCRealVolt = 0;
 
     ADCRealVolt = (Correction.ADC_volt.coeff * ADC_measure + Correction.ADC_volt.offset);
-    ADCRealVolt = ADCRealVolt / 1000;
-    return ADCRealVolt;
+    ADCRealVolt = ADCRealVolt / 1e7;
+
+    return (int32_t) (ADCRealVolt);
 }
 
 // this function turn ADC measure value (0xXXXX) into real current
 // unit should be pA
-/* Decode ADC current for twenty-one */
 static int32_t DecodeADCCurrent(uint8_t ADCGain, uint16_t ADC_measure){
-    int32_t ADCRealCurrent = 0;
-    int32_t coeff[3] = {0}, offset[3] = {0};
+    long long ADCRealCurrent = 0;
 
-    ADCRealCurrent = (Correction.ADC_current[ADCGain].coeff * ADC_measure + Correction.ADC_current[ADCGain].offset)/1000;
-    return ADCRealCurrent;
+    ADCRealCurrent = (Correction.ADC_current[ADCGain].coeff * ADC_measure + Correction.ADC_current[ADCGain].offset)/1e7;
+
+    // Current unit is pA;
+    // If ADCGain is GAIN_200R unit is nA
+    return (int32_t) (ADCRealCurrent);
+}
+
+static int32_t DecodeResister(uint8_t ADCGainLevel, uint16_t CurrentMeasure, uint16_t VoltMeasure){
+    long long ADCRealCurrent=0, ADCRealVolt=0;
+    int32_t resister_32;
+
+    // get measure current
+    ADCRealCurrent = (Correction.ADC_current[ADCGainLevel].coeff * CurrentMeasure + Correction.ADC_current[ADCGainLevel].offset)/1e7;
+
+    // get measure volt
+    // This step is necessary, if the measure resister !>> 10 ohm
+    ADCRealVolt = (Correction.ADC_volt.coeff * VoltMeasure + Correction.ADC_volt.offset);
+    ADCRealVolt = ADCRealVolt / 1e4;
+
+//    if (INSTRUCTION.ADCGainLevel == GAIN_200R){
+    resister_32 = (int32_t) ((ADCRealVolt) / (ADCRealCurrent/1e3)); // nV / uA = mV
+//    }
+//    else{
+//        resister_32 = (int32_t) ((ADCRealVolt) / (ADCRealCurrent/1e6)); // nV / uA = mV
+//    }
+    int32_t volt_32 = (int32_t) (ADCRealVolt);
+    int32_t current_32 = (int32_t) (ADCRealCurrent);
+
+    NotifyVolt[0] = (uint8_t) (volt_32 >> 24);
+    NotifyVolt[1] = (uint8_t) ((volt_32 & 0x00FF0000) >> 16);
+    NotifyVolt[2] = (uint8_t) ((volt_32 & 0x0000FF00) >> 8);
+    NotifyVolt[3] = (uint8_t) (volt_32 & 0x000000FF);
+
+    NotifyCurrent[0] = (uint8_t) (current_32 >> 24);
+    NotifyCurrent[1] = (uint8_t) ((current_32 & 0x00FF0000) >> 16);
+    NotifyCurrent[2] = (uint8_t) ((current_32 & 0x0000FF00) >> 8);
+    NotifyCurrent[3] = (uint8_t) (current_32 & 0x000000FF);
+
+    NotifyImpedance[0] = (uint8_t) (resister_32 >> 24);
+    NotifyImpedance[1] = (uint8_t) ((resister_32 & 0x00FF0000) >> 16);
+    NotifyImpedance[2] = (uint8_t) ((resister_32 & 0x0000FF00) >> 8);
+    NotifyImpedance[3] = (uint8_t) (resister_32 & 0x000000FF);
+
+    return resister_32;
 }
 
 // Decode ADC measure value (could be a volt or current) and put it into notify buffer
 static int32_t DecodeADCValue(uint8_t ADCGain, uint8_t ADCChannel, uint8_t *ADC_raw){
 
     uint16_t ADC_measure = (uint16_t) (ADC_raw[0] << 8) | (uint16_t) (ADC_raw[1]);
-    int32_t ADCRealVolt = 0, ret = 0;
+    int32_t ADCRealVolt = 0, ret = 0, ADCRealCurrent = 0;
 
     // return real volt to controller
     if(ADCChannel == ADC_CH_VOLT){
         ADCRealVolt = DecodeADCVolt(ADC_measure);
-        NotifyVolt[0] = (uint8_t) (ADCRealVolt >> 24);
-        NotifyVolt[1] = (uint8_t) ((ADCRealVolt & 0x00FF0000) >> 16);
-        NotifyVolt[2] = (uint8_t) ((ADCRealVolt & 0x0000FF00) >> 8);
-        NotifyVolt[3] = (uint8_t) (ADCRealVolt & 0x000000FF);
         ret = ADCRealVolt;
     }
 
     // return real current to controller
     else if(ADCChannel == ADC_CH_CURRENT){
-        
-        if (INSTRUCTION.eliteFxn == IVCurve) {
-            ADCRealCurrent += DecodeADCCurrent(ADCGain, ADC_measure);
 
-            if ((SampleRate_counter % 10) == 0) {
-                ADCRealCurrent = ADCRealCurrent / 10;
-                
-                if (avg_number > 2) {       // to discard the first 20 current sample data
-                    ADCRealCurrent_avg = (ADCRealCurrent + ADCRealCurrent_avg*(avg_number - 3)) / (avg_number - 2);
+        if ( (INSTRUCTION.eliteFxn == IV_CURVE) || (INSTRUCTION.eliteFxn == CV_CURVE)) {
+            // wait 0.1 sec until circuit stable => discard first data means wait 0.1 sec
+            if(DiscardIVFirstData){
+                DiscardIVFirstData ++;
+                DecodeADCCurrent(ADCGain, ADC_measure);
+                ret = DecodeADCCurrent(ADCGain, ADC_measure);
+
+                // DiscardIVFirstData :1,2; discard two data
+                // DiscardIVFirstData = 0; recording data
+                if(DiscardIVFirstData == 3){
+                    DiscardIVFirstData = 0;
                 }
-                avg_number ++;
-                ADCRealCurrent = 0;
+                return ret;
             }
-            if (StepTimeCounter == StepTime - 1) {
-                NotifyCurrent[0] = (uint8_t) (ADCRealCurrent_avg >> 24);
-                NotifyCurrent[1] = (uint8_t) ((ADCRealCurrent_avg & 0x00FF0000) >> 16);
-                NotifyCurrent[2] = (uint8_t) ((ADCRealCurrent_avg & 0x0000FF00) >> 8);
-                NotifyCurrent[3] = (uint8_t) (ADCRealCurrent_avg & 0x000000FF);
-                avg_number = 1;
-                ADCRealCurrent_avg = 0;
+
+            // return a real time current (used for deciding auto gain)
+            ret = DecodeADCCurrent(ADCGain, ADC_measure);
+            ADCRealCurrent_long = ADCRealCurrent_long + ret;
+            avg_number ++;
+
+            if (CT.StepTimeCounter == INSTRUCTION.StepTime - 1) {
+                DiscardIVFirstData = 1;
+                ADCRealCurrent_long = ADCRealCurrent_long / avg_number;
+                NotifyCurrent[0] = (uint8_t) (ADCRealCurrent_long >> 24);
+                NotifyCurrent[1] = (uint8_t) ((ADCRealCurrent_long & 0x00FF0000) >> 16);
+                NotifyCurrent[2] = (uint8_t) ((ADCRealCurrent_long & 0x0000FF00) >> 8);
+                NotifyCurrent[3] = (uint8_t) (ADCRealCurrent_long & 0x000000FF);
+                avg_number = 0;
+                ADCRealCurrent_long = 0;
+
+                int32_t G = ADCGain;
+                NotifyImpedance[0] = (uint8_t) (G >> 24);
+                NotifyImpedance[1] = (uint8_t) ((G & 0x00FF0000) >> 16);
+                NotifyImpedance[2] = (uint8_t) ((G & 0x0000FF00) >> 8);
+                NotifyImpedance[3] = (uint8_t) (G & 0x000000FF);
             }
         }
+
+        // IT curve
         else {
             ADCRealCurrent = DecodeADCCurrent(ADCGain, ADC_measure);
             NotifyCurrent[0] = (uint8_t) (ADCRealCurrent >> 24);
@@ -211,7 +743,6 @@ static int32_t DecodeADCValue(uint8_t ADCGain, uint8_t ADCChannel, uint8_t *ADC_
             NotifyCurrent[3] = (uint8_t) (ADCRealCurrent & 0x000000FF);
             ret = ADCRealCurrent;
         }
-        
     }
 
     else{
@@ -256,35 +787,29 @@ static void ADC_overflow(uint8_t gain, uint8_t *rawdata){
 // User will enter -5V~+5V in UI.
 // websever and controler use 0~50000 represent -5~+5V
 // this function should turn 0~50000 into DACcode which output the exactly voltage user want
-
 static uint16_t Usercode_Correction_to_DAC(uint16_t usercode)
 {
-    // DACcode to real_voltage correction function
-    //DACcode = -1.0548523(usercode) + 60597.718
-    int32_t usercode_32;
+    long long usercode_32;
     uint16_t DACcode = 0;
-    int32_t coeff = (-1054), offset = 60597718;
 
-    usercode_32 = (int32_t)(usercode);
+    usercode_32 = (long long)(usercode);
 
-    DACcode = (uint16_t) ((coeff * usercode_32 + offset)/1000);
+    DACcode = (uint16_t) ((Correction.Usercode2DAC.coeff * usercode_32 + Correction.Usercode2DAC.offset)/1e7);
 
     return DACcode;
 }
 
+
 static int32_t DAC_to_realV(uint16_t DACcode)
 {
-    //volt = (DAC -6.4893275)/(-0.0001896)
-
     int32_t RealV = 0;
-    int32_t volt_32 = 0;
-    int32_t coeff = (-1896), offset = 64893275;//*10e7
+    long long usercode_32;
 
-    volt_32 = DACcode;
-//    RealV = (volt_32 - offset) / coeff;
-    RealV = (-1896) * volt_32 + offset;
-    RealV = RealV / 10e3; //(mV)
+    usercode_32 = ((DACcode * 1e7) - Correction.Usercode2DAC.offset) / Correction.Usercode2DAC.coeff;
 
+    RealV = (int32_t) (usercode_32 / 5) - 5000;
+
+    // return mV
     return RealV;
 }
 

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

@@ -0,0 +1,21 @@
+
+#ifndef ELITE_FLAG_CT_INIT
+#define ELITE_FLAG_CT_INIT
+
+static void InitCT(){
+    CT.SampleRate_counter = 1;
+    CT.StepTimeCounter = 1;
+    CT.NotifyCounter = 1;
+    CT.StandByCounter = 0;
+}
+
+static void InitFlag(){
+    PeriodicEvent = false;      // is there an PeriodicEvent?
+    InitPeriodicEvent = true;   // need to create a WorkModeData?
+    DACReset = true;
+    CCModeDACEnable = 0;        // to make sure DAC work after ADC
+    Free_Work_Mode = true;      // Free(WorkModeData)
+//    DiscardIVFirstData = 0;
+}
+
+#endif

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

@@ -0,0 +1,38 @@
+/* Copyright (c) 2019. BioPro. Scientific.
+ */
+#ifndef HEADSTAGE_GPTIMER_H
+#define HEADSTAGE_GPTIMER_H
+
+#include <Board.h>
+#include <ti/drivers/timer/GPTimerCC26XX.h>
+#include <ti/sysbios/BIOS.h>
+#include <xdc/runtime/Types.h>
+
+#define EVT_PERIODIC_GPTIMER EVT_PERIODIC_0
+
+static GPTimerCC26XX_Handle gptimer_handle;
+
+static void elite_gptimer_callback(GPTimerCC26XX_Handle handle, GPTimerCC26XX_IntMask interruptMask);
+
+#define elite_gptimer_start() GPTimerCC26XX_start(gptimer_handle)
+#define elite_gptimer_stop() GPTimerCC26XX_stop(gptimer_handle)
+#define elite_gptimer_close() GPTimerCC26XX_close(gptimer_handle)
+#define CLOCK_FREQ 4000  // clock freq = 0.1 ms
+
+#define elite_gptimer_open()                                                                          \
+    do {                                                                                              \
+        GPTimerCC26XX_Params params;                                                                  \
+        GPTimerCC26XX_Params_init(&params);                                                           \
+        params.width          = GPT_CONFIG_16BIT;                                                     \
+        params.mode           = GPT_MODE_PERIODIC_DOWN;                                               \
+        params.debugStallMode = GPTimerCC26XX_DEBUG_STALL_OFF;                                        \
+        gptimer_handle        = GPTimerCC26XX_open(Board_GPTIMER0A, &params);                         \
+        Types_FreqHz  freq;                                                                           \
+        BIOS_getCpuFreq(&freq);                                                                       \
+        GPTimerCC26XX_Value loadVal = freq.lo / 1000 - 1; /*47999*/                                   \
+        GPTimerCC26XX_setLoadValue(gptimer_handle, loadVal);                                          \
+        GPTimerCC26XX_setLoadValue(gptimer_handle, CLOCK_FREQ); /* 0.1 ms*/                           \
+        GPTimerCC26XX_registerInterrupt(gptimer_handle, elite_gptimer_callback, GPT_INT_TIMEOUT);     \
+    } while (0)
+
+#endif  // HEADSTAGE_GPTIMER_H

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

@@ -0,0 +1,78 @@
+
+#ifndef ELITEIT
+#define ELITEIT
+
+#define absolute(a) ((a<0)? -a:a)
+
+//static int32_t IT_Plot() {
+//    // read ADC current
+//    int32_t Real_Current = 0;
+//    ADCGainControl(INSTRUCTION.ADCGainLevel);
+//    ADCChannelSelect(ADC_CH_CURRENT);
+//    CPUdelay(10);
+//    ADC_read(spi_ADC_rxbuf);
+//
+//    // check if ADC over/under flow
+//    // let the output saturate if over/under flow
+////    ADC_overflow(INSTRUCTION.ADCGainLevel, spi_ADC_rxbuf);
+//
+//    // decode ADC value and put it into notify buffer
+//    Real_Current = DecodeADCValue(INSTRUCTION.ADCGainLevel, ADC_CH_CURRENT, spi_ADC_rxbuf);
+//
+//    return Real_Current;
+//}
+
+static int32_t IT_Plot(WorkMode *WorkModeData) {
+
+    switch (INSTRUCTION.eliteFxn) {
+            case IV_CURVE:{
+                #define CURRENT_MODE WorkModeData->IV
+                break;
+            }
+            case CV_CURVE:{
+                #define CURRENT_MODE WorkModeData->CV
+                break;
+            }
+            case IT_CURVE:{
+                #define CURRENT_MODE WorkModeData->IT
+                break;
+            }
+            case POTENTIAL_STATE:{
+                #define CURRENT_MODE WorkModeData->PS
+            }
+            default: {
+                #define CURRENT_MODE WorkModeData->IV
+                break;
+            }
+    }
+   
+    // read ADC current
+    int32_t Real_Current = 0;
+
+    if(INSTRUCTION.AutoGainEnable){
+        Real_Current = AutoGainReadCurrent(spi_ADC_rxbuf);
+    }
+    else{
+        ReadCurrent(spi_ADC_rxbuf);
+        Real_Current = DecodeADCValue(INSTRUCTION.ADCGainLevel, ADC_CH_CURRENT, spi_ADC_rxbuf);
+    }
+
+    // IT->SetMeasureData((struct Measure *) IT, Real_Current);
+    // Real_Current = IT->GetMeasureData((struct Measure *) IT);
+    CURRENT_MODE->_MeasureData = Real_Current;
+
+
+//     if(INSTRUCTION.eliteFxn == IV_CURVE){
+//         if(absolute(Real_Current) > CURRENT_MODE->_LimitValue){
+////             PeriodicEvent = false;  //Real current exceed expected limit value, force stop
+////             DACReset      = true;
+//             reset();
+//         }
+//     }
+
+
+    return Real_Current;
+}
+
+
+#endif

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

@@ -0,0 +1,142 @@
+
+#ifndef ELITEIV
+#define ELITEIV
+
+static uint16_t VoltScan(WorkMode *WorkModeData) {
+    uint16_t Voltage;
+    if (INSTRUCTION.VoltOrigin == INSTRUCTION.VoltFinal) {
+        Voltage = Usercode_Correction_to_DAC(INSTRUCTION.VoltOrigin);
+        DAC_outputV(Voltage);
+        PeriodicEvent = false;
+        return Voltage;
+    } else if (INSTRUCTION.eliteFxn == SQUARE_WAVE_VOLTAMMETRY) {
+        Voltage = SWVCurve(WorkModeData);
+    } else if (INSTRUCTION.eliteFxn == DIFFERENTIAL_PULSE_VOLTAMMETRY) {
+        Voltage = DPVCurve(WorkModeData);
+    } else if (INSTRUCTION.eliteFxn == CV_CURVE) {
+        Voltage = CVCurve(WorkModeData->CV);
+    } else if (INSTRUCTION.eliteFxn == POTENTIAL_STATE ) {
+        Voltage = PSCurve(WorkModeData->PS);
+    }
+
+    // IV plot mode
+    else {
+        Voltage = OneWayVoltScan(WorkModeData->IV);
+    }
+
+    return Voltage;
+}
+
+static uint16_t OneWayVoltScan(IVMode *IV) {
+    static uint16_t DACOutCode;
+
+    // reset origin volt at the begin
+    if (DACReset) {
+//        DACUserCode = IV->GetVOrigin((struct VoltOutPara *) IV);
+        DACUserCode = IV->_VOrigin;
+        DACOutCode = Usercode_Correction_to_DAC(DACUserCode);
+        DACReset   = false;
+
+        // output VOLT_ORIGIN
+        DAC_outputV(DACOutCode);
+        return DACOutCode;
+    }
+
+    if (CT.StepTimeCounter == IV->_StepTime){
+        if (IV->_VOrigin < IV->_VStop) {
+            // output the next output volt
+            DACUserCode = DACUserCode + IV->_Step;
+            DACOutCode = Usercode_Correction_to_DAC(DACUserCode);
+            DAC_outputV(DACOutCode);
+
+            // end IV task if we reach INSTRUCTION.VoltFinal
+            if (DACUserCode >= IV->_VStop) {
+                PeriodicEvent = false;
+                DACReset      = true;
+            }
+        } else {
+
+            DACUserCode = DACUserCode - IV->_Step;
+
+            // check if DACUserCode underflow
+            if(DACUserCode >= 60000){
+//                LED_color(DARKLED, 0xFF, 0x00, 0x00);
+                DACUserCode = IV->_VStop;
+            }
+
+//            int32_t DACUC = DACUserCode;
+//            NotifyImpedance[0] = (uint8_t) (DACUC >> 24);
+//            NotifyImpedance[1] = (uint8_t) ((DACUC & 0x00FF0000) >> 16);
+//            NotifyImpedance[2] = (uint8_t) ((DACUC & 0x0000FF00) >> 8);
+//            NotifyImpedance[3] = (uint8_t) (DACUC & 0x000000FF);
+
+            // output the next output volt
+            DACOutCode = Usercode_Correction_to_DAC(DACUserCode);
+            DAC_outputV(DACOutCode);
+
+//             // end IV task if we reach INSTRUCTION.VoltFinal
+//             if (DACUserCode <= IV->_VStop){
+//                 PeriodicEvent = false;
+//                 DACReset      = true;
+// //                reset();
+        }
+    }
+    return DACOutCode;
+}
+
+static void IV_Plot(IVMode *IV) {
+    static uint8_t VoltCurrentSwitch = 0;
+    uint16_t ADC_measure = 0;
+
+    if(VoltCurrentSwitch < 5){
+        ReadCurrent(spi_ADC_rxbuf);
+        VoltCurrentSwitch ++;
+    }
+    else if(VoltCurrentSwitch == 5){
+        // read current
+        ReadCurrent(spi_ADC_rxbuf);
+        ADC_measure = (uint16_t) (spi_ADC_rxbuf[0] << 8) | (uint16_t) (spi_ADC_rxbuf[1]);
+        IV->_MeasureData = DecodeADCCurrent(INSTRUCTION.ADCGainLevel, ADC_measure);
+        VoltCurrentSwitch ++;
+    }
+    else if(VoltCurrentSwitch <9){
+        // read volt
+        ReadVolt(spi_ADC_rxbuf);
+        VoltCurrentSwitch++;
+    }
+    else if(VoltCurrentSwitch == 9){
+        /** read battery voltage **/
+        ReadVolt(spi_ADC_rxbuf);
+        ADC_measure = (uint16_t) (spi_ADC_rxbuf[0] << 8) | (uint16_t) (spi_ADC_rxbuf[1]);
+        IV->MeasureVolt = DecodeADCVolt(ADC_measure);
+        VoltCurrentSwitch++;
+    }
+    else{
+        VoltCurrentSwitch = 0;
+    }
+
+    NotifyCurrent[0] = (uint8_t) (IV->_MeasureData >> 24);
+    NotifyCurrent[1] = (uint8_t) ((IV->_MeasureData & 0x00FF0000) >> 16);
+    NotifyCurrent[2] = (uint8_t) ((IV->_MeasureData & 0x0000FF00) >> 8);
+    NotifyCurrent[3] = (uint8_t) (IV->_MeasureData & 0x000000FF);
+
+    NotifyVolt[0] = (uint8_t) (IV->MeasureVolt >> 24);
+    NotifyVolt[1] = (uint8_t) ((IV->MeasureVolt & 0x00FF0000) >> 16);
+    NotifyVolt[2] = (uint8_t) ((IV->MeasureVolt & 0x0000FF00) >> 8);
+    NotifyVolt[3] = (uint8_t) (IV->MeasureVolt & 0x000000FF);
+
+    if (IV->_VOrigin < IV->_VStop) {
+        if(IV->MeasureVolt >= (IV->_VStop - DAC_ZERO)/5){
+            PeriodicEvent = false;
+            DACReset      = true;
+        }
+    }
+    else{
+        if(IV->MeasureVolt <= (IV->_VStop - DAC_ZERO)/5){
+            PeriodicEvent = false;
+            DACReset      = true;
+        }
+    }
+}
+
+#endif

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

@@ -0,0 +1,130 @@
+
+#ifndef ELITEINSTRUCTION
+#define ELITEINSTRUCTION
+
+/** ADC gain level **/
+#define GAIN_200K   0x00 // largest gain
+#define GAIN_10K    0x01
+#define GAIN_200R   0x02 // the least gain
+#define GAIN_AUTO   0x03
+
+/** Resister meter **/
+#define RESISTER_METER_SMALL    0x00
+#define RESISTER_METER_MIDDLE1  0x01
+#define RESISTER_METER_MIDDLE2  0x02
+#define RESISTER_METER_LARGE    0x03
+
+/** CC mode parameter **/
+// CurrentLV
+#define CURRENT_LV_NA 0x00
+#define CURRENT_LV_UA 0x01
+#define CURRENT_LV_MA 0x02
+
+/* DAC reset parameter */
+#define DAC_ZERO 25000
+#define DAC_POS_MAX 0x0000
+#define DAC_NEG_MAX 0xFFFF
+
+// Step time macro
+#define STEPTIME_HALF_SEC 5000
+#define STEPTIME_ONE_SEC 10000
+#define STEPTIME_TWO_SEC 20000
+
+/*==============================
+ ==== headstage instruction ====
+ =============================*/
+struct HEADSTAGE_INSTRUCTION {
+    /** chip ID */
+    uint8_t chip_id;
+
+    /** Sample rate **/
+     // SampleRate = SampleRateTable[SampleRateIndex]
+    uint8_t SampleRateIndex;
+    uint32_t SampleRate;
+
+    /** DAC parameter **/
+     // volt san parameter
+    uint16_t VoltOrigin;
+    uint16_t VoltFinal;
+    uint16_t Step;
+    uint16_t  StepTime;
+
+     // constant volt
+    uint16_t VoltConstant;
+
+    /** ADC parameter **/
+    uint8_t ADCGainLevel;
+
+    uint8_t AutoGainEnable;
+
+    /** Notify parameter **/
+    uint16_t NotifyRate;
+
+    /** Constant Current Parameter **/
+    int32_t ConstantCurrent;
+
+    /** Resister Measure **/
+    uint8_t ResisterMeter;
+
+    // elite function
+    uint8_t eliteFxn;
+
+    uint8_t CycleNumber;
+
+} INSTRUCTION = {0};
+
+/*********************************************************************
+ * @fn      InitEliteInstruction
+ *
+ * @brief   Init all INSTRUCTION variable.
+ *
+ * @param   None.
+ *
+ * @return  None.
+ */
+static void InitEliteInstruction(){
+    INSTRUCTION.chip_id = 0;
+    INSTRUCTION.SampleRateIndex = 1;
+    INSTRUCTION.SampleRate = 100;
+    INSTRUCTION.VoltOrigin = DAC_ZERO;
+    INSTRUCTION.VoltFinal = DAC_ZERO;
+    INSTRUCTION.Step = 0x0005; // 0x0005 = 1mV
+    INSTRUCTION.StepTime = STEPTIME_HALF_SEC;    // about 0.5 sec
+    INSTRUCTION.VoltConstant = DAC_ZERO;  // is about 0V
+    INSTRUCTION.ADCGainLevel = GAIN_AUTO;
+    INSTRUCTION.AutoGainEnable = 1;
+    INSTRUCTION.NotifyRate = STEPTIME_ONE_SEC/10;
+    INSTRUCTION.ResisterMeter = RESISTER_METER_LARGE;
+    INSTRUCTION.ConstantCurrent = 0x00000000;
+    INSTRUCTION.eliteFxn = 0; // default is a null event
+    INSTRUCTION.CycleNumber = 0;
+}
+
+/*********************************************************************
+ * @fn      GetInstructionParameter
+ *
+ * @brief   Get Constant Current mode parameter.
+ *
+ * @param   ins - instruction including current value and unit
+ *
+ * @return  None.
+ */
+static void GetInstructionParameter(uint8 *ins){
+    // CurrentLV=0 => unit is nA
+    // CurrentLV=1 => unit is uA
+    // CurrentLV=2 => unit is mA
+//    INSTRUCTION.CurrentLV = (*ins);
+
+    // ConstantCurrentRange=0 => current value is 0~499
+    // ConstantCurrentRange=1 => current value is 500~999
+//    INSTRUCTION.ConstantCurrentRange = (*ins) & 0x0F;
+
+    // ConstantCurrent divide ConstantCurrentRange into 50000 count (thus each count is 0.01)
+        // e.g. 485.7 uA can be represent by
+        // CurrentLV = 1 (unit is uA)
+        // ConstantCurrentRange = 0 (current range is 0~499)
+        // ConstantCurrent = 48570
+    INSTRUCTION.ConstantCurrent = (uint32_t) (*(ins+1))<<24 | (uint32_t) (*(ins+2))<<16 | (uint32_t) (*(ins+3))<<8 | (uint32_t) (*(ins+4));
+}
+
+#endif

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

@@ -0,0 +1,70 @@
+
+#ifndef ELITEKEYDETECT
+#define ELITEKEYDETECT
+
+#define CLOCK_ONE_SECOND 10000
+
+static bool TurnOnElite(uint8_t key) {
+    static uint16_t TurnOnCounter = 0;
+
+    if (key == 0) {
+        // press 1 sec, power on LED
+        if (TurnOnCounter >= CLOCK_ONE_SECOND) {
+            PIN_setOutputValue(pin_handle, enable_5v, 1);  // enable 5V
+            TurnOn10V();
+            LEDPowerON();
+            return true;
+        } else {
+            TurnOnCounter++;
+            return false;
+        }
+    } else {
+        TurnOnCounter = 0;
+        PIN_setOutputValue(pin_handle, enable_5v, 0);  // enable 5V
+        return false;
+    }
+}
+
+static void EliteKeyPress(uint8_t key) {
+    static uint16_t ShutDownCounter = 0;
+    static uint8_t OriginEliteFxn  = 0;
+
+    if (key == 0) {
+        // key = 0 if press
+        // press key => bight LED
+
+        if (ShutDownCounter == CLOCK_ONE_SECOND) {
+            KeyWorkModeLED();
+        }
+
+        // press 3~4 sec, shutdown 2650
+        else if (ShutDownCounter > (CLOCK_ONE_SECOND*3) ) {
+            LED_color(DARKLED, 0xFF, 0xFF, 0x00);
+            PIN_setOutputValue(pin_handle, enable_5v, 0);  // disable 5V
+        }
+        ShutDownCounter ++;
+    } else {
+        if (OriginEliteFxn == INSTRUCTION.eliteFxn) {  // old function == currunt instruction
+            if (ShutDownCounter != 0) {
+                // dark LED
+                WorkModeLED();
+                ShutDownCounter = 0;
+            }
+        } else {  // old function != currunt instruction
+            OriginEliteFxn = INSTRUCTION.eliteFxn;
+            if (ShutDownCounter != 0) {
+                ShutDownCounter = 0;
+            }
+            // dark mode LED
+            WorkModeLED();
+        }
+    }
+}
+
+static void TurnOn10V() {
+    If10Von = true;
+    PIN_setOutputValue(pin_handle, enable_10v, 1);
+    CPUdelay(8000);
+}
+
+#endif

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

@@ -0,0 +1,134 @@
+
+#ifndef ELITELED
+#define ELITELED
+
+#define DARKLED 0xE1
+#define LIGHTLED 0xE8
+static void LED_color(uint8_t bright, uint8_t red, uint8_t green, uint8_t blue);
+#define LEDPowerON() LED_color(DARKLED, 0x00, 0xFA, 0x00)
+#define WORKLED() LED_color(0xE2, 0x00, 0x40, 0x40)
+#define KEYLED() LED_color(LIGHTLED, 0xF0, 0xA0, 0x00)
+
+static void LED_color(uint8_t bright, uint8_t red, uint8_t green, uint8_t blue) {
+    spi_LEDtxbuf[0] = 0x0000;
+    spi_LEDtxbuf[1] = 0x0000;
+    for (int i = 2; i < SPI_LED_SIZE - 2; i += 2) {
+        spi_LEDtxbuf[i]     = 0xE000 | ((uint16_t)bright << 8) | blue;
+        spi_LEDtxbuf[i + 1] = ((uint16_t)green << 8) | red;
+    }
+
+    spi_LEDtxbuf[SPI_LED_SIZE - 2] = 0xffff;
+    spi_LEDtxbuf[SPI_LED_SIZE - 1] = 0xffff;
+
+    LED_SPI(SPI_LED_SIZE, spi_LEDtxbuf, spi_LEDrxbuf);
+}
+
+static void WorkModeLED() {
+    switch (INSTRUCTION.eliteFxn) {
+    case IV_CURVE: {
+        WORKLED();
+        break;
+    }
+    case CV_CURVE: {
+        WORKLED();
+        break;
+    }
+    case DIFFERENTIAL_PULSE_VOLTAMMETRY: {
+        WORKLED();
+        break;
+    }
+    case SQUARE_WAVE_VOLTAMMETRY: {
+        WORKLED();
+        break;
+    }
+    case VOLT_OUTPUT: {
+        WORKLED();
+        break;
+    }
+    case ZT_CURVE: {
+        WORKLED();
+        break;
+    }
+    case VT_CURVE: {
+        WORKLED();
+        break;
+    }
+    case IT_CURVE: {
+        WORKLED();
+        break;
+    }
+    case CONSTANT_CURRENT:{
+        WORKLED();
+        break;
+    }
+    case VIS_RST: {
+        LEDPowerON();
+        break;
+    }
+    case ADC_TEST: {
+        WORKLED();
+        break;
+    }
+
+    default: {
+        LEDPowerON();
+        break;
+    }
+    }
+}
+
+static void KeyWorkModeLED() {
+    KEYLED();
+    /*
+    switch(INSTRUCTION.eliteFxn){
+        case IV_CURVE:{
+            LED_color(LIGHTLED, 0xF0, 0xF0, 0x00);
+            break;
+        }
+        case CV_CURVE:{
+            LED_color(LIGHTLED, 0xF0, 0xF0, 0x00);
+            break;
+        }
+        case DIFFERENTIAL_PULSE_VOLTAMMETRY:{
+            LED_color(LIGHTLED, 0xF0, 0xF0, 0x00);
+            break;
+        }
+        case SQUARE_WAVE_VOLTAMMETRY:{
+            LED_color(LIGHTLED, 0xF0, 0xF0, 0x00);
+            break;
+        }
+        case VOLT_OUTPUT:{
+            LED_color(LIGHTLED, 0xF0, 0xF0, 0x00);
+            break;
+        }
+        case ZT_CURVE:{
+            LED_color(LIGHTLED, 0xF0, 0xF0, 0x00);
+            break;
+        }
+        case VT_CURVE:{
+            LED_color(LIGHTLED, 0xF0, 0xF0, 0x00);
+            break;
+        }
+        case IT_CURVE:{
+            LED_color(LIGHTLED, 0xF0, 0xF0, 0x00);
+            break;
+        }
+
+        case VIS_RST:{
+            LED_color(LIGHTLED, 0xF0, 0xF0, 0x00);
+            break;
+        }
+        case ADC_TEST:{
+            LED_color(LIGHTLED, 0xF0, 0xF0, 0x00);
+            break;
+        }
+
+        default:{
+            LED_color(LIGHTLED, 0xF0, 0xF0, 0x00);
+            break;
+        }
+    }
+    */
+}
+
+#endif

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

@@ -30,6 +30,37 @@ static uint8_t NotifyImpedance[4] = {0};
  */
 static uint32_t notify_counter = 0;
 
+// ****************** New Notify Format ******************************** //
+/*
+ * Notify format
+ *
+ *
+         |               |   1           |       2       |           3   |
+         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 2
+         -----------------------------------------------------------------
+         |    header     |
+         |    current                                                    |
+         | voltage or impedance                                          |
+         |  mode & gain  |
+         |    time stamp                                                 |
+         |  cycle number |
+
+
+    mode & gain
+        this byte include Elite working mode and ADC gain level
+        we use "(mode & 0xF0) | (gain & 0x0F)" to encode these two information
+
+     cycle number
+         for cyclic voltammetry use, we save it as channel number.
+         0xFF
+
+  * header = device ID
+  * I = current (0.001nA), V = voltage (mV),
+  * Z = impedance (k ohm), T = time (ms)
+  *
+  *
+*/
+// ********* End New Format Notify ***************************************** //
 
 /*
  * Notify format
@@ -55,6 +86,27 @@ static uint32_t notify_counter = 0;
   *
   *
 */
+static void SendNotify() {
+    not_buf[0] = INSTRUCTION.chip_id;
 
+    for (int i = 0; i < 4; i++) {
+        not_buf[i + 1] = NotifyCurrent[i];
+        not_buf[i + 5] = NotifyVolt[i];
+        not_buf[i + 9] = NotifyImpedance[i];
+    }
+
+    // 1 Timestamp = 32 usec;  31 Timestamp ~= 1 msec
+    not_time_stamp = (Timestamp_get32()) / 31;  // msec
+
+    not_buf[13] = not_time_stamp & 0xff;
+    not_buf[14] = (not_time_stamp >> 8) & 0xff;
+    not_buf[15] = (not_time_stamp >> 16) & 0xff;
+    not_buf[16] = (not_time_stamp >> 24) & 0xff;
+
+    // cyclic voltametry cycle number
+    not_buf[17] = INSTRUCTION.CycleNumber;
+
+    SimpleProfile_SetParameter(BLE_DAT_BUFF_CHAR, BLE_DAT_BUFF_SIZE, not_buf);
+}
 
 #endif

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

@@ -0,0 +1,175 @@
+
+#ifndef ELITEPS
+#define ELITEPS
+
+static uint16_t PSCurve(PSMode *PS) {
+    static uint16_t DACOutCode;
+    static uint16_t DAC_ControlVolt;
+    static bool direction_up;           // direction_up = true, if Vfinal > Vorigin
+    static bool current_direction_up;   // current_direction_up = true, Vstep => positive. vice versa
+
+    // reset origin volt at the begin
+    if (DACReset) {
+        PS->_ControlVolt = PS->_VOrigin;
+        if (INSTRUCTION.VoltFinal > PS->_VOrigin) {
+            direction_up         = true;
+            current_direction_up = true;
+        } else {
+            direction_up         = false;
+            current_direction_up = false;
+        }
+
+        DACOutCode = Usercode_Correction_to_DAC(PS->_ControlVolt);
+        DAC_outputV(DACOutCode);    // output VOLT_ORIGIN
+        DACReset   = false;
+
+        return DACOutCode;
+    }
+
+    if (CT.StepTimeCounter == PS->_StepTime) {
+
+        // Decide next direction
+        if (direction_up) {
+            if (PS->_ControlVolt >= PS->_VStop) {
+                current_direction_up = false;  // problem occurs when origin == 0000 final == ffff!!!!!!
+            } else if (PS->_ControlVolt <= PS->_VOrigin) {
+                current_direction_up = true;
+                if (PS->_CycleNumber == 0) {
+                    PeriodicEvent = false;  // periodic event end
+                    DACReset      = true;
+                }
+                PS->_CycleNumber--;
+            }
+        } else {
+            if (PS->_ControlVolt <= PS->_VStop) {
+                current_direction_up = true;  // problem occurs when origin == 0000 final == ffff!!!!!!
+            } else if (PS->_ControlVolt >= PS->_VOrigin) {
+                current_direction_up = false;
+                if (PS->_CycleNumber == 0) {
+                    PeriodicEvent = false;  // periodic event end
+                    DACReset      = true;
+                }
+                PS->_CycleNumber--;
+            }
+        }
+
+        // Next output voltage
+        if (direction_up) {
+            if (current_direction_up) {
+                // PS->_ControlVolt overflow ?
+                if (PS->_ControlVolt + PS->_Step < PS->_ControlVolt) {
+                    PS->_ControlVolt = PS->_VStop;
+                }
+                else if (PS->_ControlVolt + PS->_Step > PS->_VStop) {
+                    PS->_ControlVolt =PS->_VStop;
+                }
+                else {
+                    PS->_ControlVolt = PS->_ControlVolt + PS->_Step;
+                }
+            }
+            else {
+                // PS->_ControlVolt underflow ?
+                if (PS->_ControlVolt - PS->_Step > PS->_ControlVolt || PS->_ControlVolt > 60000) {
+                    PS->_ControlVolt = PS->_VOrigin;
+                }
+
+                // reach Vorigin ?
+                else if (PS->_ControlVolt - PS->_Step <  PS->_VOrigin) {
+                    PS->_ControlVolt = PS->_VOrigin;
+                }
+                else {
+                    PS->_ControlVolt = PS->_ControlVolt - PS->_Step;
+                }
+            }
+        }
+        else {
+            if (current_direction_up) {
+                if (PS->_ControlVolt + PS->_Step < PS->_ControlVolt) {
+                     PS->_ControlVolt = PS->_VOrigin;
+                }
+                else if (PS->_ControlVolt + PS->_Step >  PS->_VOrigin) {
+                    PS->_ControlVolt = PS->_VOrigin;
+                }
+                else {
+                     PS->_ControlVolt = PS->_ControlVolt + PS->_Step;
+                }
+            }
+            else {
+                if (PS->_ControlVolt - PS->_Step > PS->_ControlVolt || PS->_ControlVolt > 60000) {
+                     PS->_ControlVolt = PS->_VStop ;
+                }
+                else if (PS->_ControlVolt - PS->_Step < PS->_VStop) {
+                    PS->_ControlVolt = PS->_VStop;
+                }
+                else {
+                    PS->_ControlVolt = PS->_ControlVolt - PS->_Step;
+                }
+            }
+        }
+
+        DACOutCode = PS->_MeasureVolt - PS->_ControlVolt;
+
+        DACOutCode = Usercode_Correction_to_DAC(DACOutCode);
+        DAC_outputV(DACOutCode);
+    }
+
+    DAC_ControlVolt = Usercode_Correction_to_DAC(PS->_ControlVolt);
+    return DAC_ControlVolt;
+}
+
+static void PS_Plot(PSMode* PS){
+    static uint8_t VoltCurrentSwitch = 0;
+    uint16_t ADC_measure = 0;
+
+    if(VoltCurrentSwitch < 5){
+        ReadCurrent(spi_ADC_rxbuf);
+        VoltCurrentSwitch ++;
+    }
+    else if(VoltCurrentSwitch == 5){
+        // read current
+        ReadCurrent(spi_ADC_rxbuf);
+        ADC_measure = (uint16_t) (spi_ADC_rxbuf[0] << 8) | (uint16_t) (spi_ADC_rxbuf[1]);
+        PS->_MeasureData = DecodeADCCurrent(INSTRUCTION.ADCGainLevel, ADC_measure);
+        VoltCurrentSwitch ++;
+    }
+    else if(VoltCurrentSwitch <9){
+        // read volt
+        ReadVolt(spi_ADC_rxbuf);
+        VoltCurrentSwitch++;
+    }
+    else if(VoltCurrentSwitch == 9){
+        /** read battery voltage **/
+        ReadVolt(spi_ADC_rxbuf);
+        ADC_measure = (uint16_t) (spi_ADC_rxbuf[0] << 8) | (uint16_t) (spi_ADC_rxbuf[1]);
+        PS->_MeasureVolt = DecodeADCVolt(ADC_measure);
+        VoltCurrentSwitch++;
+    }
+    else{
+        VoltCurrentSwitch = 0;
+    }
+
+    NotifyCurrent[0] = (uint8_t) (PS->_MeasureData >> 24);
+    NotifyCurrent[1] = (uint8_t) ((PS->_MeasureData & 0x00FF0000) >> 16);
+    NotifyCurrent[2] = (uint8_t) ((PS->_MeasureData & 0x0000FF00) >> 8);
+    NotifyCurrent[3] = (uint8_t) (PS->_MeasureData & 0x000000FF);
+
+    // NotifyVolt[0] = (uint8_t) (PS->_MeasureVolt >> 24);
+    // NotifyVolt[1] = (uint8_t) ((PS->_MeasureVolt & 0x00FF0000) >> 16);
+    // NotifyVolt[2] = (uint8_t) ((PS->_MeasureVolt & 0x0000FF00) >> 8);
+    // NotifyVolt[3] = (uint8_t) (PS->_MeasureVolt & 0x000000FF);
+
+    // if (PS->_VOrigin < PS->_VStop) {
+    //     if(PS->MeasureVolt >= (PS->_VStop - DAC_ZERO)/5){
+    //         PeriodicEvent = false;
+    //         DACReset      = true;
+    //     }
+    // }
+    // else{
+    //     if(PS->MeasureVolt <= (PS->_VStop - DAC_ZERO)/5){
+    //         PeriodicEvent = false;
+    //         DACReset      = true;
+    //     }
+    // }
+}
+
+#endif

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

@@ -0,0 +1,123 @@
+
+#ifndef ELITERESET
+#define ELITERESET
+
+static void reset() {
+    InitFlag();
+    InitCT();
+
+    // IV/CV mode reset
+    DiscardIVFirstData = 0;
+    avg_number          = 0;
+    ADCRealCurrent_long = 0;
+
+    ADCGainControl(INSTRUCTION.ADCGainLevel);
+    DAC_outputV(Usercode_Correction_to_DAC(INSTRUCTION.VoltConstant));
+
+    if (INSTRUCTION.eliteFxn == CONSTANT_CURRENT){
+        INSTRUCTION.eliteFxn = 0;
+
+    }
+
+    LEDPowerON();
+    for (int i = 0; i < BLE_INS_BUFF_SIZE; i++) {
+        ins_buf[i] = 0;
+    }
+
+    for (int i = 0; i < SPI_LED_SIZE; i++) {
+        spi_LEDtxbuf[i] = 0;
+        spi_LEDrxbuf[i] = 0;
+    }
+
+    for (int i = 0; i < SPI_DAC_SIZE; i++) {
+        spi_DACtxbuf[i] = 0;
+        spi_rxbuf[i]    = 0;
+    }
+
+    for (int i = 0; i < SPI_ADC_SIZE; i++) {
+        spi_ADC_txbuf[i] = 0;
+        spi_ADC_rxbuf[i] = 0;
+    }
+
+    for (int i = 0; i < BLE_DAT_BUFF_SIZE; i++) {
+        not_buf[i] = 0;
+    }
+
+    PIN_setOutputValue(pin_handle, ADC_CS, 1);  // ADC_CS HIGH
+    PIN_setOutputValue(pin_handle, DAC_CS, 1);  // DAC_CS HIGH
+    CPUdelay(1600);
+}
+
+static void Eliteinterrupt() {
+    InitFlag();
+    InitCT();
+
+    // IV/CV mode reset
+    DiscardIVFirstData = 0;
+    avg_number          = 0;
+    ADCRealCurrent_long = 0;
+//    ADCGainControl(INSTRUCTION.ADCGainLevel);
+//    DAC_outputV(Usercode_Correction_to_DAC(INSTRUCTION.VoltConstant));
+
+    LEDPowerON();
+    for (int i = 0; i < BLE_INS_BUFF_SIZE; i++) {
+        ins_buf[i] = 0;
+    }
+
+    for (int i = 0; i < SPI_LED_SIZE; i++) {
+        spi_LEDtxbuf[i] = 0;
+        spi_LEDrxbuf[i] = 0;
+    }
+
+    for (int i = 0; i < SPI_DAC_SIZE; i++) {
+        spi_DACtxbuf[i] = 0;
+        spi_rxbuf[i]    = 0;
+    }
+
+    for (int i = 0; i < SPI_ADC_SIZE; i++) {
+        spi_ADC_txbuf[i] = 0;
+        spi_ADC_rxbuf[i] = 0;
+    }
+
+    for (int i = 0; i < BLE_DAT_BUFF_SIZE; i++) {
+        not_buf[i] = 0;
+    }
+
+    PIN_setOutputValue(pin_handle, ADC_CS, 1);  // ADC_CS HIGH
+    PIN_setOutputValue(pin_handle, DAC_CS, 1);  // DAC_CS HIGH
+    CPUdelay(8000);
+}
+
+static void CleanBuffer() {
+    InitFlag();
+    InitEliteInstruction();
+    InitCT();
+    DiscardIVFirstData = 0;
+    avg_number          = 0;
+    ADCRealCurrent_long = 0;
+
+    for (int i = 0; i < SPI_LED_SIZE; i++) {
+        spi_LEDtxbuf[i] = 0;
+        spi_LEDrxbuf[i] = 0;
+    }
+
+    for (int i = 0; i < SPI_DAC_SIZE; i++) {
+        spi_DACtxbuf[i] = 0;
+        spi_rxbuf[i]    = 0;
+    }
+
+    for (int i = 0; i < SPI_ADC_SIZE; i++) {
+        spi_ADC_txbuf[i] = 0;
+        spi_ADC_rxbuf[i] = 0;
+    }
+
+    for (int i = 0; i < BLE_DAT_BUFF_SIZE; i++) {
+        not_buf[i] = 0;
+    }
+
+    PIN_setOutputValue(pin_handle, ADC_CS, 1);  // ADC_CS HIGH
+    PIN_setOutputValue(pin_handle, DAC_CS, 1);  // DAC_CS HIGH
+    CPUdelay(8000);
+}
+
+#endif

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

@@ -0,0 +1,22 @@
+
+#ifndef ELITEVT
+#define ELITEVT
+
+static void VT_Plot(VTMode *VT) {
+    // ADC gain is don't care when measuring voltage
+    uint8_t ADCGain = 0;
+
+    // read ADC volt
+    ReadVolt(spi_ADC_rxbuf);
+
+    // decode ADC value and put it into notify buffer
+    VT->SetMeasureData((struct Measure *) VT, DecodeADCValue(ADCGain, ADC_CH_VOLT, spi_ADC_rxbuf));
+
+    int32_t ADCRealVolt = VT->GetMeasureData((struct Measure *) VT);
+    NotifyVolt[0] = (uint8_t) (ADCRealVolt >> 24);
+    NotifyVolt[1] = (uint8_t) ((ADCRealVolt & 0x00FF0000) >> 16);
+    NotifyVolt[2] = (uint8_t) ((ADCRealVolt & 0x0000FF00) >> 8);
+    NotifyVolt[3] = (uint8_t) (ADCRealVolt & 0x000000FF);
+}
+
+#endif

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

@@ -0,0 +1,586 @@
+/**
+*
+* struct WorkMode{
+*   // Measure Only
+*   ITMode;
+*   VTMode;
+*
+*   // Measure + VoltOut
+*   RTMode;
+*   IVMode;
+*   CVMode;
+*
+*   // Volt out only
+*   VOutMode
+* }
+*
+* -------------------------------
+* // Measure Only
+* struct ITMode{
+*   MeasureData
+*   SetMeasureData()
+*   GetMeasureData()
+* }
+*
+* -------------------------------
+* // VoltOut parameter
+* stuct VOutMode{
+*   Vout_UC
+*   VoltOrigin
+*   Vstop;
+*   Step;
+*   StepTime;
+*   CycleNumber;
+* }
+*
+*/
+
+#ifndef ELITE_WORK_DATA
+#define ELITE_WORK_DATA
+
+#include "EliteInstruction.h"
+#define IV_CURVE 0b00010000
+#define CV_CURVE 0b00100000
+#define VOLT_OUTPUT 0b00110000
+#define ZT_CURVE 0b01000000
+#define VT_CURVE 0b01010000
+#define IT_CURVE 0b01100000
+#define SET_SAMPLE_RATE 0b01110000
+#define SET_ADC_GAIN 0b10000000
+#define DIFFERENTIAL_PULSE_VOLTAMMETRY 0b10100000
+#define SQUARE_WAVE_VOLTAMMETRY 0b10110000
+#define POTENTIAL_STATE 0b11000000
+#define CONSTANT_CURRENT 0b11010000
+#define SET_RESISTER_LEVEL 0b11100000
+
+static bool Free_Work_Mode = false;
+typedef void (*InitWorkData) ();
+
+/***** Template of Measure and VoltOut parameter *****/
+#define MEASURE \
+    int32_t _MeasureData;    \
+    void (*SetMeasureData) (struct Measure *, int32_t);  \
+    int32_t (*GetMeasureData) (struct Measure *)
+
+/* VoltOut is an UserCode */
+/* VOrigin, VStop, Step are all UserCode */
+#define VOUT_PARA \
+    uint16_t _VoltOut;  \
+    uint16_t _VOrigin;  \
+    uint16_t _VStop;    \
+    uint16_t _Step;     \
+    uint16_t _StepTime;  \
+    uint16_t _CycleNumber
+//    void (*SetVoltOut) (struct VoltOutPara *, uint16_t);  \
+//    uint16_t (*GetVoltOut) (struct VoltOutPara *);  \
+//    void (*SetVOrigin) (struct VoltOutPara *, uint16_t);  \
+//    uint16_t (*GetVOrigin) (struct VoltOutPara *);  \
+//    void (*SetVStop) (struct VoltOutPara *, uint16_t);  \
+//    uint16_t (*GetVStop) (struct VoltOutPara *);  \
+//    void (*SetStep) (struct VoltOutPara *, uint16_t);  \
+//    uint16_t (*GetStep) (struct VoltOutPara *);  \
+//    void (*SetStepTime) (struct VoltOutPara *, uint16_t);  \
+//    uint16_t (*GetStepTime) (struct VoltOutPara *);  \
+//    void (*SetCycleNumber) (struct VoltOutPara *, uint16_t);  \
+//    uint16_t (*GetCycleNumber) (struct VoltOutPara *)
+
+#define LIMIT \
+    uint32_t _LimitValue; \
+    void (*SetLimitValue) (struct Limit *, uint32_t); \
+    uint32_t (*GetLimitValue) (struct Limit*)
+
+struct Measure{
+    MEASURE;
+};
+
+struct VoltOutPara{
+    VOUT_PARA;
+};
+
+struct Limit{
+    LIMIT;
+};
+/***** End of Measure and VoltOut parameter *****/
+
+
+/***** Measure Only Mode *****/
+void _SetMeasureData(struct Measure *self, int32_t Data){
+    self->_MeasureData = Data;
+}
+
+int32_t _GetMeasureData(struct Measure *self){
+    return self->_MeasureData;
+}
+
+
+/**** Limit Mode ****/
+//LimitValue
+void _SetLimitValue(struct Limit *self, uint32_t LimitValue){
+    self->_LimitValue = LimitValue;
+}
+uint32_t _GetLimitValue(struct Limit *self){
+    return self->_LimitValue;
+}
+
+/* IT Mode Data */
+typedef struct _ITMode{
+    MEASURE;
+    LIMIT;
+}ITMode;
+
+ITMode * InitITMode(){
+    ITMode *ret = malloc(sizeof(ITMode));
+    ret->_MeasureData = 0;
+    ret->SetMeasureData = &_SetMeasureData;
+    ret->GetMeasureData = &_GetMeasureData;
+
+    ret->_LimitValue = 0;
+    
+    ret->SetLimitValue = &_SetLimitValue;
+    ret->GetLimitValue = &_GetLimitValue;
+    return ret;
+}
+/* End of IT Mode Data */
+
+/* VT Mode Data */
+typedef struct _VTMode{
+    MEASURE;
+}VTMode;
+
+VTMode * InitVTMode(){
+    VTMode *ret = malloc(sizeof(VTMode));
+    ret->_MeasureData = 0;
+    ret->SetMeasureData = &_SetMeasureData;
+    ret->GetMeasureData = &_GetMeasureData;
+    return ret;
+}
+/* End of VT Mode Data */
+/***** End of Measure Only Mode *****/
+
+
+/**** VoltOut Only Mode ****/
+// VoltOut
+void _SetVoltOut(struct VoltOutPara *self, uint16_t VoltOut){
+    self->_VoltOut = VoltOut;
+}
+uint16_t _GetVoltOut(struct VoltOutPara *self){
+    return self->_VoltOut;
+}
+
+// VOrigin
+void _SetVOrigin(struct VoltOutPara *self, uint16_t VOrigin){
+    self->_VOrigin = VOrigin;
+}
+uint16_t _GetVOrigin(struct VoltOutPara *self){
+    return self->_VOrigin;
+}
+
+// VStop
+void _SetVStop(struct VoltOutPara *self, uint16_t VStop){
+    self->_VStop = VStop;
+}
+uint16_t _GetVStop(struct VoltOutPara *self){
+    return self->_VStop;
+}
+
+// Step
+void _SetStep(struct VoltOutPara *self, uint16_t Step){
+    self->_Step = Step;
+}
+uint16_t _GetStep(struct VoltOutPara *self){
+    return self->_Step;
+}
+
+// StepTime
+void _SetStepTime(struct VoltOutPara *self, uint16_t StepTime){
+    self->_StepTime = StepTime;
+}
+uint16_t _GetStepTime(struct VoltOutPara *self){
+    return self->_StepTime;
+}
+
+// CycleNumber
+void _SetCycleNumber(struct VoltOutPara *self, uint16_t CycleNumber){
+    self->_CycleNumber = CycleNumber;
+}
+uint16_t _GetCycleNumber(struct VoltOutPara *self){
+    return self->_CycleNumber;
+}
+
+
+/* VoltOut Mode Data */
+typedef struct _VoltOutMode{
+    VOUT_PARA;
+}VoltOutMode;
+
+VoltOutMode *InitVoltOutMode(){
+    VoltOutMode *ret = malloc(sizeof(VoltOutMode));
+    ret->_VoltOut = INSTRUCTION.VoltConstant;  // 25000 is DAC_ZERO
+    ret->_VOrigin = DAC_ZERO;
+    ret->_VStop = DAC_ZERO;
+    ret->_Step  =   0;
+    ret->_StepTime = 10000; // STEPTIME_ONE_SEC
+    ret->_CycleNumber = 1;
+
+//    ret->SetVoltOut = &_SetVoltOut;
+//    ret->GetVoltOut = &_GetVoltOut;
+//    ret->SetVOrigin = &_SetVOrigin;
+//    ret->GetVOrigin = &_GetVOrigin;
+//    ret->SetVStop = &_SetVStop;
+//    ret->GetVStop = &_GetVStop;
+//    ret->SetStep = &_SetStep;
+//    ret->GetStep = &_GetStep;
+//    ret->SetStepTime = &_SetStepTime;
+//    ret->GetStepTime = &_GetStepTime;
+//    ret->SetCycleNumber = &_SetCycleNumber;
+//    ret->GetCycleNumber = &_GetCycleNumber;
+    return ret;
+}
+/* End of VoltOut Mode Data */
+/**** End of VoltOut Only Mode ****/
+
+
+/**** Measure + VoltOut Mode ****/
+/* IV Mode Data */
+typedef struct _IVMode{
+    MEASURE;
+    int32_t MeasureVolt;
+
+    VOUT_PARA;
+    LIMIT;
+}IVMode;
+
+IVMode *InitIVMode(){
+    IVMode *ret = malloc(sizeof(IVMode));
+    ret->_MeasureData = 0;
+    ret->SetMeasureData = &_SetMeasureData;
+    ret->GetMeasureData = &_GetMeasureData;
+    ret->MeasureVolt = 0;
+
+    ret->_VoltOut = DAC_ZERO;
+    ret->_VOrigin = INSTRUCTION.VoltOrigin;
+    ret->_VStop = INSTRUCTION.VoltFinal;
+    ret->_Step  = INSTRUCTION.Step;
+    ret->_StepTime = INSTRUCTION.StepTime;
+    ret->_CycleNumber = 1;
+
+//    ret->SetVoltOut = &_SetVoltOut;
+//    ret->GetVoltOut = &_GetVoltOut;
+//    ret->SetVOrigin = &_SetVOrigin;
+//    ret->GetVOrigin = &_GetVOrigin;
+//    ret->SetVStop = &_SetVStop;
+//    ret->GetVStop = &_GetVStop;
+//    ret->SetStep = &_SetStep;
+//    ret->GetStep = &_GetStep;
+//    ret->SetStepTime = &_SetStepTime;
+//    ret->GetStepTime = &_GetStepTime;
+//    ret->SetCycleNumber = &_SetCycleNumber;
+//    ret->GetCycleNumber = &_GetCycleNumber;
+
+    ret->_LimitValue = 1e5;
+    
+    ret->SetLimitValue = &_SetLimitValue;
+    ret->GetLimitValue = &_GetLimitValue;
+    return ret;
+}
+/* End of IV Mode Data */
+
+/* RT Mode Data */
+typedef struct _RTMode{
+    MEASURE;
+    VOUT_PARA;
+}RTMode;
+
+RTMode * InitRTMode(){
+    RTMode *ret = malloc(sizeof(RTMode));
+    ret->_MeasureData = 0;
+    ret->SetMeasureData = &_SetMeasureData;
+    ret->GetMeasureData = &_GetMeasureData;
+
+    ret->_VoltOut = DAC_ZERO;  // 25000 is DAC_ZERO
+    ret->_VOrigin = DAC_ZERO;
+    ret->_VStop = DAC_ZERO;
+    ret->_Step  =   0;
+    ret->_StepTime = 10000; // STEPTIME_ONE_SEC
+    ret->_CycleNumber = 1;
+
+//    ret->SetVoltOut = &_SetVoltOut;
+//    ret->GetVoltOut = &_GetVoltOut;
+//    ret->SetVOrigin = &_SetVOrigin;
+//    ret->GetVOrigin = &_GetVOrigin;
+//    ret->SetVStop = &_SetVStop;
+//    ret->GetVStop = &_GetVStop;
+//    ret->SetStep = &_SetStep;
+//    ret->GetStep = &_GetStep;
+//    ret->SetStepTime = &_SetStepTime;
+//    ret->GetStepTime = &_GetStepTime;
+//    ret->SetCycleNumber = &_SetCycleNumber;
+//    ret->GetCycleNumber = &_GetCycleNumber;
+    return ret;
+}
+/* End of RT Mode Data */
+
+/* CV Mode*/
+typedef struct _CVMode{
+    MEASURE;
+    VOUT_PARA;
+}CVMode;
+
+CVMode * InitCVMode(){
+    CVMode *ret = malloc(sizeof(CVMode));
+    ret->_MeasureData = 0;
+    ret->SetMeasureData = &_SetMeasureData;
+    ret->GetMeasureData = &_GetMeasureData;
+
+    ret->_VoltOut = DAC_ZERO;  // 25000 is DAC_ZERO
+    ret->_VOrigin = INSTRUCTION.VoltOrigin;
+    ret->_VStop = INSTRUCTION.VoltFinal;
+    ret->_Step  = INSTRUCTION.Step;
+    ret->_StepTime = INSTRUCTION.StepTime; // STEPTIME_ONE_SEC
+    ret->_CycleNumber = INSTRUCTION.CycleNumber;
+
+//    ret->SetVoltOut = &_SetVoltOut;
+//    ret->GetVoltOut = &_GetVoltOut;
+//    ret->SetVOrigin = &_SetVOrigin;
+//    ret->GetVOrigin = &_GetVOrigin;
+//    ret->SetVStop = &_SetVStop;
+//    ret->GetVStop = &_GetVStop;
+//    ret->SetStep = &_SetStep;
+//    ret->GetStep = &_GetStep;
+//    ret->SetStepTime = &_SetStepTime;
+//    ret->GetStepTime = &_GetStepTime;
+//    ret->SetCycleNumber = &_SetCycleNumber;
+//    ret->GetCycleNumber = &_GetCycleNumber;
+    return ret;
+}
+/*End of CV Mode*/
+
+/* Const Current Mode */
+#define CC_ZERO_POINT     1500000
+#define MAX_DAC_UC    50000
+#define MIN_DAC_UC      0
+#define CURRENT_LV_ONE      1
+#define CURRENT_LV_ZERO     0
+
+/*********************************************************************
+ * @struct  Constant Current Code
+ *
+ * @brief   A struct to handle CC mode command
+ */
+typedef struct _CCMode{
+    // measure value
+    MEASURE;    // current
+    int32_t BatteryV;
+
+    /** Experience Setting **/
+    /** current value **/
+    // current value divide current level into 3,000,001 pieces
+    // 1,500,000 is zero point
+    int32_t value;
+
+    /** ADC level range: 0-2 **/
+    // constant current value will decide ADC gain level
+    // if |1500000 - value| > 10000 (+-100 uA)     => lv = GAIN_200R
+    // else if |1500000 - valule| > 1000 (+-10 uA) => lv = GAIN_10K
+    // else lv = GAIN_200K
+    uint8_t lv;
+
+    /* Vmax and Vmin */
+    // Vmax protect battery charge
+    // Vmin protect battery discharge
+    // uint = mV
+    uint16_t VMax;
+    uint16_t VMin;
+
+    /* Charge/Discharge Current */
+    int32_t ChargeCurrent;
+    int32_t DischargeCurrent;
+    uint8_t CycleNumber;
+
+    bool StandBy;
+    uint32_t StandByTime;
+
+    /** transform a current user code (IUC) to real current in nA **/
+    int32_t (*_Transform2RealnA)(struct _CCMode *);
+}CCMode;
+
+/*********************************************************************
+ * @fn      Transform2RealnA
+ *
+ * @brief   transform an IUC into real current value in nA.
+ *
+ * @param   self, which is an IUC
+ *
+ * @return  an int32_t current value in nA
+ */
+int32_t _Transform2RealnA(CCMode *self){
+    int32_t IUCReal;
+
+    // self->value : 0 ~ 3000000 (which is -1500000 ~ 1500000 (10nA) )
+    IUCReal = (self->value - CC_ZERO_POINT) * 10;
+    return IUCReal;
+}
+
+CCMode * InitCCMode(){
+    CCMode *ret = malloc(sizeof(CCMode));
+    ret->_MeasureData = 0;
+    ret->SetMeasureData = &_SetMeasureData;
+    ret->GetMeasureData = &_GetMeasureData;
+    ret->BatteryV = 0;
+
+    ret->value = CC_ZERO_POINT;
+    ret->lv = INSTRUCTION.ADCGainLevel;
+    ret->VMax = MAX_DAC_UC;  // max DAC UserCode
+    ret->VMin = MIN_DAC_UC;  // min DAC UserCode
+    ret->ChargeCurrent = 0;
+    ret->DischargeCurrent = 0;
+    ret->CycleNumber = 0;
+    ret->StandBy = false;
+    ret->StandByTime = 0;
+    ret->_Transform2RealnA = &_Transform2RealnA;
+    return ret;
+}
+/*End of Const Current Mode Mode*/
+
+/** Potential State Mode **/
+typedef struct _PS{
+    // measure
+    MEASURE; // circuit current
+    int16_t _ControlVolt;
+    int32_t _MeasureVolt;
+    VOUT_PARA;
+}PSMode;
+
+PSMode *InitPSMode(){
+    PSMode *ret = malloc(sizeof(PSMode));
+    ret->_MeasureData = 0;
+    ret->SetMeasureData = &_SetMeasureData;
+    ret->GetMeasureData = &_GetMeasureData;
+    ret->_ControlVolt = INSTRUCTION.VoltOrigin;
+    ret->_MeasureVolt = INSTRUCTION.VoltOrigin;
+
+    ret->_VoltOut = DAC_ZERO;  // 25000 is DAC_ZERO
+    ret->_VOrigin = INSTRUCTION.VoltOrigin;
+    ret->_VStop = INSTRUCTION.VoltFinal;
+    ret->_Step  = INSTRUCTION.Step;
+    ret->_StepTime = INSTRUCTION.StepTime; // STEPTIME_ONE_SEC
+    ret->_CycleNumber = INSTRUCTION.CycleNumber;
+    return ret;
+}
+
+/** End of Potential State Mode **/
+
+typedef union _WorkMode{
+    // Measure only
+    ITMode *IT;
+    VTMode *VT;
+
+    // Output Only
+    VoltOutMode *VO;
+
+    // Measure + Output
+    IVMode *IV;
+    CVMode *CV;
+    RTMode *RT;
+    CCMode *CC;
+    PSMode *PS;
+}WorkMode;
+
+WorkMode *CreateWorkMode(){
+    WorkMode *ret = malloc(sizeof(WorkMode));
+    return ret;
+}
+
+void InitWorkMode(WorkMode *WM){
+    switch(INSTRUCTION.eliteFxn){
+        case IV_CURVE:
+            WM->IV = InitIVMode();
+            break;
+        case CV_CURVE:
+            WM->CV = InitCVMode();
+            break;
+        case VOLT_OUTPUT:
+            WM->VO = InitVoltOutMode();
+            break;
+        case ZT_CURVE:
+            WM->RT = InitRTMode();
+            break;
+        case VT_CURVE:
+            WM->VT = InitVTMode();
+            break;
+        case IT_CURVE:
+            WM->IT = InitITMode();
+            break;
+        case CONSTANT_CURRENT:
+            WM->CC = InitCCMode();
+            break;
+        case POTENTIAL_STATE:
+            WM->PS = InitPSMode();
+            break;
+        default:
+            WM->VT = InitVTMode();
+            break;
+    }
+}
+
+void FreeWorkMode(WorkMode *WM){
+    switch(INSTRUCTION.eliteFxn){
+        case IV_CURVE:
+            if(WM->IV != NULL){
+                free(WM->IV);
+                WM->IV = NULL;
+            }
+            break;
+        case CV_CURVE:
+            if(WM->CV != NULL){
+                free(WM->CV);
+                WM->CV = NULL;
+            }
+            break;
+        case VOLT_OUTPUT:
+            if(WM->VO != NULL){
+                free(WM->VO);
+                WM->VO = NULL;
+            }
+            break;
+        case ZT_CURVE:
+            if(WM->RT != NULL){
+                free(WM->RT);
+                WM->RT = NULL;
+            }
+            break;
+        case VT_CURVE:
+            if(WM->VT != NULL){
+                free(WM->VT);
+                WM->VT = NULL;
+            }
+            break;
+        case IT_CURVE:
+            if(WM->IT != NULL){
+                free(WM->IT);
+                WM->IT = NULL;
+            }
+            break;
+        case CONSTANT_CURRENT:
+            if(WM->CC != NULL){
+                free(WM->CC);
+                WM->CC = NULL;
+            }
+            break;
+        case POTENTIAL_STATE:
+            if(WM->PS != NULL){
+                free(WM->PS);
+                WM->PS = NULL;
+            }
+            break;
+        default:
+            if(WM->IV != NULL){
+                free(WM->IV);
+                WM->IV = NULL;
+            }
+            break;
+    }
+//    free(WM);
+}
+
+#endif

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

@@ -0,0 +1,108 @@
+
+#ifndef ELITEZT
+#define ELITEZT
+
+static void ZT_notify(int32_t impedance);
+
+// output a certain voltage e.g. 2v
+// and measure the input voltage
+// => calculate the resister
+// change the output voltage step
+// => get a R-T curve (with resolution = 1 sample/volt step )
+static void ZT_Plot(RTMode *RT) {
+//    int32_t Real_Resister = 0;
+    static uint16_t CurrentMeasure=0, VoltMeasure=0;
+    uint8_t SPICurrent[SPI_ADC_SIZE]={0}, SPIVolt[SPI_ADC_SIZE]={0};
+    static uint8_t VoltCurrentSwitch = 0;
+
+    int32_t volt_32 = 0;
+    int32_t current_32 = 0;
+    int32_t resister_32 = 0;
+
+    if(INSTRUCTION.AutoGainEnable){
+        current_32 = AutoGainReadCurrent(SPICurrent);
+    }
+    else{
+        ReadCurrent(spi_ADC_rxbuf);
+        current_32 = DecodeADCValue(INSTRUCTION.ADCGainLevel, ADC_CH_CURRENT, spi_ADC_rxbuf);
+    }
+
+
+    volt_32 = User2Real(INSTRUCTION.VoltConstant)*1e4;
+//    ReadVolt(SPIVolt);
+//    VoltMeasure = (uint16_t) (SPIVolt[0] << 8) | (uint16_t) (SPIVolt[1]);
+//    volt_32 = DecodeADCVolt(VoltMeasure)*1e4;
+    resister_32 = volt_32 / current_32;
+
+    NotifyVolt[0] = (uint8_t) (volt_32 >> 24);
+    NotifyVolt[1] = (uint8_t) ((volt_32 & 0x00FF0000) >> 16);
+    NotifyVolt[2] = (uint8_t) ((volt_32 & 0x0000FF00) >> 8);
+    NotifyVolt[3] = (uint8_t) (volt_32 & 0x000000FF);
+
+    NotifyCurrent[0] = (uint8_t) (current_32 >> 24);
+    NotifyCurrent[1] = (uint8_t) ((current_32 & 0x00FF0000) >> 16);
+    NotifyCurrent[2] = (uint8_t) ((current_32 & 0x0000FF00) >> 8);
+    NotifyCurrent[3] = (uint8_t) (current_32 & 0x000000FF);
+
+    NotifyImpedance[0] = (uint8_t) (resister_32 >> 24);
+    NotifyImpedance[1] = (uint8_t) ((resister_32 & 0x00FF0000) >> 16);
+    NotifyImpedance[2] = (uint8_t) ((resister_32 & 0x0000FF00) >> 8);
+    NotifyImpedance[3] = (uint8_t) (resister_32 & 0x000000FF);
+
+    // set ADC GAIN
+//    if(INSTRUCTION.ResisterMeter == RESISTER_METER_LARGE){
+//        INSTRUCTION.ADCGainLevel = GAIN_200R;
+//    }
+//    else if(INSTRUCTION.ResisterMeter == RESISTER_METER_MIDDLE2){
+//        INSTRUCTION.ADCGainLevel = GAIN_200R;
+//    }
+//    else if(INSTRUCTION.ResisterMeter == RESISTER_METER_MIDDLE1){
+//        INSTRUCTION.ADCGainLevel = GAIN_10K;
+//    }
+//    else{
+//        INSTRUCTION.ADCGainLevel = GAIN_200K;
+//    }
+//    ADCGainControl(INSTRUCTION.ADCGainLevel);
+
+    // Use 9-th measure value as real-measure value
+    // because some value in the begin are garbage
+//    if(VoltCurrentSwitch < 9){
+//        ADCChannelSelect(ADC_CH_CURRENT);
+//        CPUdelay(10);
+//        ADC_read(SPICurrent);
+//        VoltCurrentSwitch ++;
+//    }
+//    else if(VoltCurrentSwitch == 9){
+//        // read current
+//        ADCChannelSelect(ADC_CH_CURRENT);
+//        CPUdelay(10);
+//        ADC_read(SPICurrent);
+//        CurrentMeasure = (uint16_t) (SPICurrent[0] << 8) | (uint16_t) (SPICurrent[1]);
+//        VoltCurrentSwitch ++;
+//    }
+//    else if(VoltCurrentSwitch <18){
+//        // read volt
+//        ADCChannelSelect(ADC_CH_VOLT);
+//        CPUdelay(10);
+//        ADC_read(SPIVolt);
+//        VoltCurrentSwitch++;
+//    }
+//    else if(VoltCurrentSwitch == 18){
+//        // read volt
+//        ADCChannelSelect(ADC_CH_VOLT);
+//        CPUdelay(10);
+//        ADC_read(SPIVolt);
+//        VoltMeasure = (uint16_t) (SPIVolt[0] << 8) | (uint16_t) (SPIVolt[1]);
+//        VoltCurrentSwitch++;
+//    }
+//    else{
+//        VoltCurrentSwitch = 0;
+//    }
+
+    // decode ADC value and put it into notify buffer
+//    DecodeResister(INSTRUCTION.ADCGainLevel, CurrentMeasure, VoltMeasure);
+//    Real_Resister = DecodeADCValue(INSTRUCTION.ADCGainLevel, ADC_CH_CURRENT, spi_ADC_rxbuf);
+}
+
+
+#endif

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

@@ -190,14 +190,14 @@ MUX
 PGA
     programmable gain amplifier configuration
         (Full Scale Range = FSR)
-        000 = FSR is ��6.144 V
-        001 = FSR is ��4.096 V
-        010 = FSR is ��2.048 V (default)
-        011 = FSR is ��1.024 V
-        100 = FSR is ��0.512 V
-        101 = FSR is ��0.256 V
-        110 = FSR is ��0.256 V
-        111 = FSR is ��0.256 V
+        000 = FSR is  6.144 V
+        001 = FSR is  4.096 V
+        010 = FSR is  2.048 V (default)
+        011 = FSR is  1.024 V
+        100 = FSR is  0.512 V
+        101 = FSR is  0.256 V
+        110 = FSR is  0.256 V
+        111 = FSR is  0.256 V
 
 M
     ADC operating mode
@@ -402,21 +402,12 @@ characteristic change event
 #endif  // ICALL_EVENTS
 #include <ti/sysbios/hal/Hwi.h>
 #include <ti/sysbios/knl/Queue.h>
-#include "EliteADC.h"
-#include "EliteDAC.h"
-#include "EliteSPI.h"
-#include "Elite_PIN.h"
-
 
 #define DARKLED 0xE1
 #define LIGHTLED 0xE8
 static void LED_color(uint8_t bright, uint8_t red, uint8_t green, uint8_t blue);
 #define LEDPowerON() LED_color(DARKLED, 0x00, 0xFA, 0x00)
 
-#ifdef ELITE_VERSION_1_4
-#include "EliteI2C.h"
-#endif
-
 #ifdef USE_ICALL
 #include <icall.h>
 #else
@@ -426,11 +417,11 @@ static void LED_color(uint8_t bright, uint8_t red, uint8_t green, uint8_t blue);
 // Internal Events for RTOS application
 #ifndef RTOSPARA
 #define RTOSPARA
-#define SBP_STATE_CHANGE_EVT    0x0001
-#define SBP_CHAR_CHANGE_EVT     0x0002
-#define SBP_PERIODIC_EVT        0x0004
-#define SBP_CONN_EVT_END_EVT    0x0008
-#define SBP_KEY_CHANGE_EVT      0x0010
+#define SBP_STATE_CHANGE_EVT 0x0001
+#define SBP_CHAR_CHANGE_EVT 0x0002
+#define SBP_PERIODIC_EVT 0x0004
+#define SBP_CONN_EVT_END_EVT 0x0008
+#define SBP_KEY_CHANGE_EVT 0x0010
 #endif
 
 static Clock_Struct periodicClock;
@@ -440,6 +431,7 @@ static Clock_Struct periodicClock;
 #include "simple_gatt_profile.h"
 
 static bool            PeriodicEvent = false;
+static bool InitPeriodicEvent = true;
 static ICall_Semaphore semaphore;
 static uint16_t        events;
 
@@ -500,60 +492,6 @@ static uint8 channel_table[CHANNEL_COUNT] = {0};
  */
 static int8    channel_pointer            = -1;
 static uint8_t not_buf[BLE_DAT_BUFF_SIZE] = {0};
-/*==============================
- ==== headstage instruction ====
- =============================*/
-struct HEADSTAGE_INSTRUCTION {
-    /** chip ID */
-    uint8_t chip_id;
-
-    /** RATE. ADC clock/sampling rate value*/
-    uint32_t adc_clock_rate;
-
-    /** CS **/
-    uint8_t chip_select;
-
-    // ADC
-
-    /** SS **/
-    uint8_t single_short;
-
-    /** MUX **/
-    uint8_t multi_config;
-
-    /** PGA **/
-    uint8_t gain_amp_config;
-
-    /** M **/
-    uint8_t operating_mode;
-
-    /** DR **/
-    uint8_t adc_data_rate;
-
-    uint8_t temp_sensor;
-
-    uint8_t pullup_R_enable;
-
-    uint8_t no_operation;
-
-    uint8_t reserved;
-
-    // LED
-
-    uint8_t global;
-
-    uint8_t blue;
-
-    uint8_t green;
-
-    uint8_t red;
-
-    // elite function
-    uint8_t eliteFxn;
-
-    uint8_t CycleNumber;
-
-} INSTRUCTION = {0};
 
 /*=====================================
  ==== headstage function prototype ====
@@ -599,8 +537,9 @@ static void    ADCGainControl(uint8_t ADCLevel);
 static void    ADCChannelSelect(uint8_t ADCChannel);
 static int32_t DecodeADCVolt(uint16_t ADC_measure);
 static int32_t DecodeADCCurrent(uint8_t ADCGain, uint16_t ADC_measure);
+static void Impedance_Calculate(uint16_t Voltage, int32_t Current);
 static int32_t DecodeADCValue(uint8_t ADCGain, uint8_t ADCChannel, uint8_t *ADC_raw);
-static void ADC_overflow(uint8_t gain, uint8_t *rawdata);
+static void    ADC_overflow(uint8_t gain, uint8_t *rawdata);
 
 // DAC function
 static uint16_t Usercode_Correction_to_DAC(uint16_t usercode);
@@ -640,47 +579,43 @@ static void set_update_instruction_callback(update_instruction_callback_type cal
 #define VIS_SHIFT_100R 0b10000000
 
 // real instruction
-#define IVCurve 0b00010000
-#define CyclicVoltammetry 0b00100000
-#define fxnGen 0b00110000
-#define ZTCurve 0b01000000
-#define VTCurve 0b01010000
-#define ITCurve 0b01100000
-#define SetSampleRate 0b01110000
-#define SetADCGain 0b10000000
-#define DifferentialPulseVoltammetry 0b10100000
-#define SquareWaveVoltammetry 0b10110000
-#define PotentialState 0b11000000
+#define IV_CURVE 0b00010000
+#define CV_CURVE 0b00100000
+#define VOLT_OUTPUT 0b00110000
+#define ZT_CURVE 0b01000000
+#define VT_CURVE 0b01010000
+#define IT_CURVE 0b01100000
+#define SET_SAMPLE_RATE 0b01110000
+#define SET_ADC_GAIN 0b10000000
+#define DIFFERENTIAL_PULSE_VOLTAMMETRY 0b10100000
+#define SQUARE_WAVE_VOLTAMMETRY 0b10110000
+#define POTENTIAL_STATE 0b11000000
+#define CONSTANT_CURRENT 0b11010000
+#define SET_RESISTER_LEVEL 0b11100000
 
 // CIS instruction
 
 // test instruction
-
-#define ADCTEST 0b10010000
+#define ADC_TEST 0b10010000
 
 // DAC and ADC function
-static void    DAC_outputV(uint16_t voltLV);
+static uint16_t DAC_outputV(uint16_t voltLV);
 static int32_t DAC_to_realV(uint16_t DACcode);
 
-// input parameter
-static uint16_t VoltOrigin = DACzero;
-static uint16_t VoltFinal  = DACposMax;
-static uint16_t Step       = 0x009E;  // 10 => 0xA0 ~= 30.5 mv
+static uint16_t DACUserCode = 0x0000;
 
-static uint16_t SampleRateTable[6] = {1, 10, 100, 500, 1000, 10000};  // 1 =>100 Hz, 10000=>0.01 Hz
-static uint16_t SampleRate         = 1;
-static uint16_t SampleRate_counter = 1;
+static uint32_t SampleRateTable[6] = {100, 1000, 10000, 50000, 100000, 1000000};  // 1 =>100 Hz, 10000=>0.01 Hz
 
 // record value for IV curve to calculate average current
-static int16_t avg_number = 1;
-static int32_t ADCRealCurrent = 0;
-static int32_t ADCRealCurrent_avg = 0;
+static uint8_t DiscardIVFirstData = 1;
+static uint16_t   avg_number          = 0;
+static long long ADCRealCurrent_long = 0;
 
-#define GAIN_200K 0x00
-#define GAIN_10K  0x01
-#define GAIN_200R 0x02
-#define GAIN_AUTO 0x03
-static uint8_t ADCGainLevel = GAIN_200K;
+// Constant Current Mode function
+static uint8_t CCModeDACEnable = 0;
+static int32_t CCModeReadCurrent();
+static int32_t CCModeVoltOut();
+static void CCCurrent2IUC();
 
 // for DPVCurve SWVCurve
 static uint16_t Amplitude;
@@ -689,32 +624,43 @@ static uint16_t PulseWidth_16;
 static uint8_t  PulsePeriod;
 static uint16_t PulsePeriod_16;
 
-static uint8_t  StepTime        = 20;  // 0x30 = 2'd48 ~= 2 second, 24 = 0x18 = 1 sec
-static uint16_t StepTime_16     = 0;
-static uint8_t  StepTimeCounter = 1;
+struct _CT{
+    uint32_t SampleRate_counter;
+    uint16_t StepTimeCounter;
+    uint16_t NotifyCounter;
+    uint32_t StandByCounter;
+}CT = {0};
 
+static void InitFlag();
+static void InitCT();
+
+#include "EliteWorkData.h"
 // real instruction fxn
-static uint16_t VoltScan();                   // used in I-V and cyclic
-static void     Notify_IV(uint16_t Voltage);  // send notify voltage after VoltScan()
+static uint16_t VoltScan(WorkMode *WorkModeData);       // used in I-V and cyclic
+static void     DACCode2Real2Notify(uint16_t DACcode);  // send notify voltage after VoltScan()
+
+//static void    VOLT_OUTPUT();
+static void    ZT_Plot(RTMode *RT);
+static void    VT_Plot(VTMode *VT);
+static void    IV_Plot(IVMode *IV);
+static void    PS_Plot(PSMode *PS);
+static int32_t IT_Plot(WorkMode *WorkModeData);
 
-static void fxn_Gen();
-static void ZT_plot(uint16_t outV, uint16_t inV);
-static void VT_Plot();
-static int32_t IT_Plot();
 
 // the following fxn do the same thing
 // IVCurve_T is called if Vorigin > Vfinal, vice versa
 static uint16_t OldDAC2UserCode(uint16_t OldDAC);
+static uint16_t StepCode2DACcode(uint16_t StepCode);
 static uint8_t  OldStep2NewStep(uint8_t OldStep);
-static uint8_t  OldStep2NewStepTime(uint8_t StepTime);
+static uint16_t OldStep2NewStepTime(uint8_t StepTime);
 static uint8_t  IVdone = 0;
 
-static uint16_t IVCurve_T();
-static uint16_t IVCurve_T2();
+static uint16_t OneWayVoltScan(IVMode *IV);
 static void     ramp_test();
-static uint16_t DPVCurve();
-static uint16_t CVCurve();
-static uint16_t SWVCurve();
+static uint16_t DPVCurve(WorkMode *WorkModeData);
+static uint16_t CVCurve(CVMode *CV);
+static uint16_t SWVCurve(WorkMode *WorkModeData);
+static uint16_t PSCurve(PSMode *PS);
 
 static void reset();
 static void Eliteinterrupt();
@@ -725,6 +671,32 @@ static void SendNotify();
 static bool If10Von = false;
 static void TurnOn10V();
 
+
+#include "EliteInstruction.h"
+#include "EliteADC.h"
+#include "EliteDAC.h"
+#include "EliteSPI.h"
+#include "Elite_PIN.h"
+
+#ifdef ELITE_VERSION_1_4
+#include "EliteI2C.h"
+#endif
+
+#include "EliteDeviceCorrection.h"
+#include "EliteNotify.h"
+#include "EliteFlagCTInit.h"
+#include "EliteReset.h"
+#include "EliteLED.h"
+#include "EliteKeyDetect.h"
+#include "EliteCCMode.h"
+#include "EliteIVCurve.h"
+#include "EliteCVCurve.h"
+#include "ElitePSCurve.h"
+#include "EliteITCurve.h"
+#include "EliteVTCurve.h"
+#include "EliteZTCurve.h"
+#include "impedance_meter.h"
+
 // update instruction for Z meter
 static void update_ZM_instruction(uint8 *ins) {
     uint8_t ins_type    = ins[0] & 0b11110000;
@@ -732,9 +704,7 @@ static void update_ZM_instruction(uint8 *ins) {
     INSTRUCTION.chip_id = chip_ID;
 
     uint8_t oper        = ins[1] & 0xF0;  // this is don't care in RIS
-    uint8_t data_length = ins[1] & 0x0F;
-
-    DACreset = true;
+//    uint8_t data_length = ins[1] & 0x0F;
 
     if (!If10Von) {
         // TurnOn10V();
@@ -744,52 +714,53 @@ static void update_ZM_instruction(uint8 *ins) {
     /***  These are real instruction  ***/
     case INS_TYPE_RIS: {
         switch (ins[2]) {
-        case IVCurve: {
-            CleanBuffer();
-            INSTRUCTION.eliteFxn = IVCurve;
-            DACreset             = true;
+        case IV_CURVE: {
+//            CleanBuffer();
+            INSTRUCTION.eliteFxn = IV_CURVE;
+            DACReset = true;
+            INSTRUCTION.SampleRate = 1000;
 
             if (ins[3] | ins[4]) {
-                VoltOrigin = ((uint16_t)(ins[3]) << 8) | (uint16_t)(ins[4]);
-                VoltOrigin = Usercode_Correction_to_DAC(VoltOrigin);
+                INSTRUCTION.VoltOrigin = ((uint16_t)(ins[3]) << 8) | (uint16_t)(ins[4]);
+//                INSTRUCTION.VoltOrigin = Usercode_Correction_to_DAC(INSTRUCTION.VoltOrigin);
             }
             if (ins[5] | ins[6]) {
-                VoltFinal = ((uint16_t)(ins[5]) << 8) | (uint16_t)(ins[6]);
-                VoltFinal = Usercode_Correction_to_DAC(VoltFinal);
+                INSTRUCTION.VoltFinal = ((uint16_t)(ins[5]) << 8) | (uint16_t)(ins[6]);
+//                INSTRUCTION.VoltFinal = Usercode_Correction_to_DAC(INSTRUCTION.VoltFinal);
             }
 
             if (ins[7] | ins[8]) {
-                Step = ((uint16_t)(ins[7]) << 8) | (uint16_t)(ins[8]);
-                Step = Usercode_Correction_to_DAC(Step);
+                INSTRUCTION.Step = ((uint16_t)(ins[7]) << 8) | (uint16_t)(ins[8]);
+                INSTRUCTION.Step = StepCode2DACcode(INSTRUCTION.Step);
             }
             if (ins[9]) {
-                StepTime = ins[9];
-                StepTime = OldStep2NewStepTime(StepTime);
+                INSTRUCTION.StepTime = ins[9];
+                INSTRUCTION.StepTime = OldStep2NewStepTime(INSTRUCTION.StepTime);
             }
             break;
         }
 
-        case DifferentialPulseVoltammetry: {
-            CleanBuffer();
-            INSTRUCTION.eliteFxn = DifferentialPulseVoltammetry;
-            DACreset             = true;
+        case DIFFERENTIAL_PULSE_VOLTAMMETRY: {
+//            CleanBuffer();
+            INSTRUCTION.eliteFxn = DIFFERENTIAL_PULSE_VOLTAMMETRY;
+            DACReset             = true;
 
             if (ins[3] | ins[4]) {
-                VoltOrigin = ((uint16_t)(ins[3]) << 8) | (uint16_t)(ins[4]);
-                VoltOrigin = Usercode_Correction_to_DAC(VoltOrigin);
+                INSTRUCTION.VoltOrigin = ((uint16_t)(ins[3]) << 8) | (uint16_t)(ins[4]);
+                INSTRUCTION.VoltOrigin = Usercode_Correction_to_DAC(INSTRUCTION.VoltOrigin);
             }
             if (ins[5] | ins[6]) {
-                VoltFinal = ((uint16_t)(ins[5]) << 8) | (uint16_t)(ins[6]);
-                VoltFinal = Usercode_Correction_to_DAC(VoltFinal);
+                INSTRUCTION.VoltFinal = ((uint16_t)(ins[5]) << 8) | (uint16_t)(ins[6]);
+                INSTRUCTION.VoltFinal = Usercode_Correction_to_DAC(INSTRUCTION.VoltFinal);
             }
 
             if (ins[7] | ins[8]) {
-                Step = ((uint16_t)(ins[7]) << 8) | (uint16_t)(ins[8]);
-                Step = Usercode_Correction_to_DAC(Step);
+                INSTRUCTION.Step = ((uint16_t)(ins[7]) << 8) | (uint16_t)(ins[8]);
+                INSTRUCTION.Step = StepCode2DACcode(INSTRUCTION.Step);
             }
             if (ins[9]) {
-                StepTime = ins[9];
-                StepTime = OldStep2NewStepTime(StepTime);
+                INSTRUCTION.StepTime = ins[9];
+                INSTRUCTION.StepTime = OldStep2NewStepTime(INSTRUCTION.StepTime);
             }
             if (ins[10] | ins[11]) {
                 Amplitude = ((uint16_t)(ins[10]) << 8) | (uint16_t)(ins[11]);
@@ -804,26 +775,26 @@ static void update_ZM_instruction(uint8 *ins) {
             break;
         }
 
-        case SquareWaveVoltammetry: {
-            CleanBuffer();
-            INSTRUCTION.eliteFxn = SquareWaveVoltammetry;
-            DACreset             = true;
+        case SQUARE_WAVE_VOLTAMMETRY: {
+//            CleanBuffer();
+            INSTRUCTION.eliteFxn = SQUARE_WAVE_VOLTAMMETRY;
+            DACReset             = true;
 
             if (ins[3] | ins[4]) {
-                VoltOrigin = ((uint16_t)(ins[3]) << 8) | (uint16_t)(ins[4]);
-                VoltOrigin = Usercode_Correction_to_DAC(VoltOrigin);
+                INSTRUCTION.VoltOrigin = ((uint16_t)(ins[3]) << 8) | (uint16_t)(ins[4]);
+                INSTRUCTION.VoltOrigin = Usercode_Correction_to_DAC(INSTRUCTION.VoltOrigin);
             }
             if (ins[5] | ins[6]) {
-                VoltFinal = ((uint16_t)(ins[5]) << 8) | (uint16_t)(ins[6]);
-                VoltFinal = Usercode_Correction_to_DAC(VoltFinal);
+                INSTRUCTION.VoltFinal = ((uint16_t)(ins[5]) << 8) | (uint16_t)(ins[6]);
+                INSTRUCTION.VoltFinal = Usercode_Correction_to_DAC(INSTRUCTION.VoltFinal);
             }
             if (ins[7] | ins[8]) {
-                Step = ((uint16_t)(ins[7]) << 8) | (uint16_t)(ins[8]);
-                Step = Usercode_Correction_to_DAC(Step);
+                INSTRUCTION.Step = ((uint16_t)(ins[7]) << 8) | (uint16_t)(ins[8]);
+                INSTRUCTION.Step = StepCode2DACcode(INSTRUCTION.Step);
             }
             if (ins[9]) {
-                StepTime = ins[9];
-                StepTime = OldStep2NewStepTime(StepTime);
+                INSTRUCTION.StepTime = ins[9];
+                INSTRUCTION.StepTime = OldStep2NewStepTime(INSTRUCTION.StepTime);
             }
             if (ins[10] | ins[11]) {
                 Amplitude = ((uint16_t)(ins[10]) << 8) | (uint16_t)(ins[11]);
@@ -834,28 +805,28 @@ static void update_ZM_instruction(uint8 *ins) {
             }
             break;
         }
-
-        case CyclicVoltammetry: {
-            CleanBuffer();
-            INSTRUCTION.eliteFxn = CyclicVoltammetry;
-            DACreset             = true;
+        case CV_CURVE: {
+//            CleanBuffer();
+            INSTRUCTION.eliteFxn = CV_CURVE;
+            DACReset             = true;
+            INSTRUCTION.SampleRate = 1000;
 
             if (ins[3] | ins[4]) {
-                VoltOrigin = ((uint16_t)(ins[3]) << 8) | (uint16_t)(ins[4]);
-                VoltOrigin = Usercode_Correction_to_DAC(VoltOrigin);
+                INSTRUCTION.VoltOrigin = ((uint16_t)(ins[3]) << 8) | (uint16_t)(ins[4]);
+    //                INSTRUCTION.VoltOrigin = Usercode_Correction_to_DAC(INSTRUCTION.VoltOrigin);
             }
             if (ins[5] | ins[6]) {
-                VoltFinal = ((uint16_t)(ins[5]) << 8) | (uint16_t)(ins[6]);
-                VoltFinal = Usercode_Correction_to_DAC(VoltFinal);
+                INSTRUCTION.VoltFinal = ((uint16_t)(ins[5]) << 8) | (uint16_t)(ins[6]);
+    //                INSTRUCTION.VoltFinal = Usercode_Correction_to_DAC(INSTRUCTION.VoltFinal);
             }
 
             if (ins[7] | ins[8]) {
-                Step = ((uint16_t)(ins[7]) << 8) | (uint16_t)(ins[8]);
-                Step = Usercode_Correction_to_DAC(Step);
+                INSTRUCTION.Step = ((uint16_t)(ins[7]) << 8) | (uint16_t)(ins[8]);
+                INSTRUCTION.Step = StepCode2DACcode(INSTRUCTION.Step);
             }
             if (ins[9]) {
-                StepTime = ins[9];
-                StepTime = OldStep2NewStepTime(StepTime);
+                INSTRUCTION.StepTime = ins[9];
+                INSTRUCTION.StepTime = OldStep2NewStepTime(INSTRUCTION.StepTime);
             }
             if (ins[10]) {
                 INSTRUCTION.CycleNumber = ins[10];
@@ -864,84 +835,136 @@ static void update_ZM_instruction(uint8 *ins) {
             break;
         }
 
-        case fxnGen: {
-            INSTRUCTION.eliteFxn = fxnGen;
-            uint16_t volt        = 0;
-            int32_t  RealV       = 0;
-            volt                 = ((uint16_t)(ins[3]) << 8) | (uint16_t)(ins[4]);
-            // DAC_outputV(DACOUT, volt); //delete 'command' parameter
-            volt = Usercode_Correction_to_DAC(volt);
-            DAC_outputV(volt);
-            //                    RealV = DAC_to_realV(volt);
-
+        case VOLT_OUTPUT: {
+            INSTRUCTION.eliteFxn = VOLT_OUTPUT;
+            INSTRUCTION.VoltConstant = ( ((uint16_t)(ins[3])) << 8) | (uint16_t)(ins[4]);
             break;
         }
 
         // impedance test
-        case ZTCurve: {
-            CleanBuffer();
-            INSTRUCTION.eliteFxn = ZTCurve;
+        case ZT_CURVE: {
+//            CleanBuffer();
+            INSTRUCTION.eliteFxn = ZT_CURVE;
+//            INSTRUCTION.VoltConstant = ( ((uint16_t)(ins[3])) << 8) | (uint16_t)(ins[4]);
             break;
         }
 
-        case VTCurve: {
-            CleanBuffer();
-            INSTRUCTION.eliteFxn = VTCurve;
-            StepTime             = 0x01;
-
+        case VT_CURVE: {
+//            CleanBuffer();
+            INSTRUCTION.eliteFxn = VT_CURVE;
             //                    SimpleProfile_SetParameter(BLE_DAT_BUFF_CHAR, BLE_DAT_BUFF_SIZE, not_buf);
             //                    VT_Plot(); // enable 10v = 0
             break;
         }
 
-        case ITCurve: {
-            CleanBuffer();
-            INSTRUCTION.eliteFxn = ITCurve;
-            StepTime             = 0x01;
-//            IT_Plot(); // enable 10v = 1
-
-
+        case IT_CURVE: {
+//            CleanBuffer();
+            INSTRUCTION.eliteFxn = IT_CURVE;
+            //            IT_Plot(); // enable 10v = 1
             break;
         }
-        case SetSampleRate: {
-            uint8_t index      = 0;
-            index              = ins[3];
-            SampleRate         = SampleRateTable[index];
-            SampleRate_counter = 1;
+        case SET_SAMPLE_RATE: {
+            INSTRUCTION.SampleRateIndex = ins[3];
+            INSTRUCTION.SampleRate = SampleRateTable[INSTRUCTION.SampleRateIndex];
+            CT.SampleRate_counter = 1;
             break;
         }
-        case PotentialState: {
-            INSTRUCTION.eliteFxn = PotentialState;
+        case POTENTIAL_STATE: {
+            INSTRUCTION.eliteFxn = POTENTIAL_STATE;
+            DACReset             = true;
+            INSTRUCTION.SampleRate = 1000;
 
-            // test
-            not_buf[0] = ins[3];
-            not_buf[1] = ins[4];
-            not_buf[2] = ins[5];
-            not_buf[3] = ins[6];
-            //                    SimpleProfile_SetParameter(BLE_DAT_BUFF_CHAR, BLE_DAT_BUFF_SIZE, not_buf);
+            if (ins[3] | ins[4]) {
+                INSTRUCTION.VoltOrigin = ((uint16_t)(ins[3]) << 8) | (uint16_t)(ins[4]);
+    //                INSTRUCTION.VoltOrigin = Usercode_Correction_to_DAC(INSTRUCTION.VoltOrigin);
+            }
+            if (ins[5] | ins[6]) {
+                INSTRUCTION.VoltFinal = ((uint16_t)(ins[5]) << 8) | (uint16_t)(ins[6]);
+    //                INSTRUCTION.VoltFinal = Usercode_Correction_to_DAC(INSTRUCTION.VoltFinal);
+            }
 
+            if (ins[7] | ins[8]) {
+                INSTRUCTION.Step = ((uint16_t)(ins[7]) << 8) | (uint16_t)(ins[8]);
+                INSTRUCTION.Step = StepCode2DACcode(INSTRUCTION.Step);
+            }
+            if (ins[9]) {
+                INSTRUCTION.StepTime = ins[9];
+                INSTRUCTION.StepTime = OldStep2NewStepTime(INSTRUCTION.StepTime);
+            }
+            if (ins[10]) {
+                INSTRUCTION.CycleNumber = ins[10];
+            }
+
+            // // test
+            // not_buf[0] = ins[3];
+            // not_buf[1] = ins[4];
+            // not_buf[2] = ins[5];
+            // not_buf[3] = ins[6];
+            // SimpleProfile_SetParameter(BLE_DAT_BUFF_CHAR, BLE_DAT_BUFF_SIZE, not_buf);
             break;
         }
 
-        case SetADCGain: {
-            ADCGainLevel = ins[3];
+        case CONSTANT_CURRENT:{
+            INSTRUCTION.eliteFxn = CONSTANT_CURRENT;
+            INSTRUCTION.SampleRate = 10;
+            INSTRUCTION.ConstantCurrent = ( (uint32_t) (ins[3])<<24 | (uint32_t) (ins[4])<<16 | (uint32_t) (ins[5])<<8 | (uint32_t) (ins[6]) );
+            INSTRUCTION.NotifyRate = 1000;
+//            GetInstructionParameter(ins+2);
+//            CCCurrent2IUC();
             break;
         }
 
-        case ADCTEST: {
-            INSTRUCTION.eliteFxn = ADCTEST;
+        case SET_ADC_GAIN: {
+            INSTRUCTION.ADCGainLevel = ins[3];
+            if(INSTRUCTION.ADCGainLevel != GAIN_AUTO){
+                INSTRUCTION.AutoGainEnable = 0;
+            }
+            else{
+                INSTRUCTION.AutoGainEnable = 1;
+            }
+//            if(INSTRUCTION.ADCGainLevel == GAIN_200R){
+//                LED_color(DARKLED, 0x0F, 0x00, 0x00);
+//            }
+//            else if(INSTRUCTION.ADCGainLevel == GAIN_10K){
+//                LED_color(DARKLED, 0x0F, 0x00, 0x0F);
+//            }
+//            else if(INSTRUCTION.ADCGainLevel == GAIN_200K){
+//                LED_color(DARKLED, 0x0F, 0x02, 0xFF);
+//            }
+            break;
+        }
+
+        case SET_RESISTER_LEVEL:{
+            INSTRUCTION.ResisterMeter = ins[3];
+            break;
+        }
+
+        case ADC_TEST: {
+            INSTRUCTION.eliteFxn = ADC_TEST;
             int32_t ADCRealValue = 0;
             uint8_t CIS_buf[9]   = {0};
 
-            ADCGainControl(ins[3]);
-            ADCChannelSelect(ins[4]);
-            CPUdelay(1600);
-            ADC_read(spi_ADC_rxbuf);
+//            for(int i=0 ; i<10 ; i++){
+                ADCGainControl(ins[3]);
+                ADCChannelSelect(ins[4]);
+                CPUdelay(10);
+                ADC_read(spi_ADC_rxbuf);
+//                CPUdelay(10);
+//
+//                ADCValueTemp = ( uint16_t) (spi_ADC_rxbuf[0]) << 8 | (uint16_t) (spi_ADC_rxbuf[1]);
+//                ADCValueAVG = ADCValueAVG + ADCValueTemp;
+//            }
+//            ADCValueAVG = ADCValueAVG / 10;
+//            ADCValueTemp = (uint16_t) (ADCValueAVG);
 
             CIS_buf[0] = chip_ID;
-            for (int i = 0; i < 4; i++) {
-                CIS_buf[i + 1] = spi_ADC_rxbuf[i];
+            for(int i=0; i<4 ; i++){
+                CIS_buf[i+1] = spi_ADC_rxbuf[i];
             }
+//            CIS_buf[1] = (uint8_t) ((ADCValueTemp & 0xFF00) >> 8);
+//            CIS_buf[2] = (uint8_t) (ADCValueTemp & 0x00FF);
+//            CIS_buf[3] = spi_ADC_rxbuf[2];
+//            CIS_buf[4] = spi_ADC_rxbuf[3];
 
             // decode ADC measure value
             ADCRealValue = DecodeADCValue(ins[3], ins[4], spi_ADC_rxbuf);
@@ -1166,12 +1189,12 @@ static void headstage_gptimer_callback(GPTimerCC26XX_Handle handle, GPTimerCC26X
 /*=======================================
  ==== headstage specific declaration ====
  ======================================*/
-#include "EliteDeviceCorrection.h"
-#include "EliteNotify.h"
-#include "impedance_meter.h"
 
 /*========================
- ==== gap information ====
+
+
+
+p information ====
  =======================*/
 
 #ifndef DEVICE_NAME

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

@@ -102,6 +102,7 @@
 
 #include "simple_peripheral.h"
 
+#include "EliteGPTimer.h"
 #include "headstage.h"
 
 #if defined(USE_FPGA) || defined(DEBUG_SW_TRACE)
@@ -527,6 +528,8 @@ static void SimpleBLEPeripheral_init(void) {
     HCI_LE_ReadMaxDataLenCmd();
 }
 
+
+#include "EliteWorkData.h"
 /*********************************************************************
  * @fn      SimpleBLEPeripheral_taskFxn
  *
@@ -540,20 +543,23 @@ static void SimpleBLEPeripheral_init(void) {
 // static void detectKey_clockHandler(UArg arg);
 
 static void SimpleBLEPeripheral_taskFxn(UArg a0, UArg a1) {
+
+#define CLOCK_ONE_SECOND 10000
     // Initialize application
     SimpleBLEPeripheral_init();
     headstage_init_device_info();
-    //    headstage_gptimer_init();
 
     ZM_init();
     Elite_SPI_init();
+    WorkMode *WorkModeData = CreateWorkMode();
 
     uint8_t key         = 0;
-    uint8_t counter6994 = 0;
+    uint16_t counter6994 = 0;
     bool    EliteOn     = 0;
 
-    Util_constructClock(&periodicClock, SimpleBLEPeripheral_clockHandler, SBP_PERIODIC_EVT_PERIOD, 0, false, SBP_PERIODIC_EVT);  // create a clock clockduration = 42(~=0.01 sec)
-    Util_startClock(&periodicClock);  // start the clock, timeup => call SimpleBLEPeripheral_clockHandler => wake up the device
+    // init DAC, set output ~= 0 V
+    DAC_outputV(Usercode_Correction_to_DAC(25000));
+    elite_gptimer_start();
 
     // Application main loops
     for (;;) {
@@ -602,16 +608,16 @@ static void SimpleBLEPeripheral_taskFxn(UArg a0, UArg a1) {
                     ICall_free(pMsg);
                 }
             }
-
+        }
+        if(events & SBP_PERIODIC_EVT){
+            events &= ~SBP_PERIODIC_EVT;
             if (!PeriodicEvent) {                 // if there is no periodic event
-                Util_startClock(&periodicClock);  // manually restart the clock
                 key = PIN_getInputValue(switch_on);
                 if (EliteOn) {
-                    if (counter6994 < 175) {  // counter6994 enable a IC after 35 counts
+                    if (counter6994 < CLOCK_ONE_SECOND/2) {  // counter6994 enable a IC after 35 counts
                         counter6994++;
-                    } else if (counter6994 == 175) {
+                    } else if (counter6994 == CLOCK_ONE_SECOND/2) {
                         PIN_setOutputValue(pin_handle, shutdown_6994, 1);  // OFF = 1 => turn off 6994
-
                         //                        #ifdef ELITE_VERSION_1_4
                         //                        SPI_close(spiHandle0);
                         //                        I2Cinit();
@@ -621,26 +627,32 @@ static void SimpleBLEPeripheral_taskFxn(UArg a0, UArg a1) {
                         counter6994++;
                     }
                     EliteKeyPress(key);
-
+                    if(Free_Work_Mode){
+                        FreeWorkMode(WorkModeData);
+                        InitEliteInstruction();
+                        ADCGainControl(INSTRUCTION.ADCGainLevel);
+                        DAC_outputV(Usercode_Correction_to_DAC(INSTRUCTION.VoltConstant));
+                        Free_Work_Mode = false;
+                    }
                 } else {
                     EliteOn = TurnOnElite(key);
                 }
-                // if(DAC_reset) DAC_outputV(0x0000); //set DAC to 0v when no periodic event
-            } else {                              // if there is periodic event
-                Util_startClock(&periodicClock);  // manually restart the clock
-                SimpleBLEPeripheral_performPeriodicTask();
+            }
+            // if there is periodic event
+            else {
+                if(InitPeriodicEvent){
+                    InitWorkMode(WorkModeData);
+                    InitPeriodicEvent = false;
+                }
+
+                // Perform periodic application task
+                SimpleBLEPeripheral_performPeriodicTask(WorkModeData);
 
                 key = PIN_getInputValue(switch_on);
                 EliteKeyPress(key);  // onPress=> key = 0; 1.lighten LED 2.long press shut down 2650
             }
         }
-//         if(events & SBP_PERIODIC_EVT){
-//             Util_startClock(&periodicClock);
-//             events &= ~SBP_PERIODIC_EVT;
 
-// //            Perform periodic application task
-//             SimpleBLEPeripheral_performPeriodicTask();
-//         }
         //        if (events & SBP_PERIODIC_EVT)
         //        {
         //          events &= ~SBP_PERIODIC_EVT;