TODO: delete auto gain

[CC] This is a stable version
[CC mode] read Vin
2019-11-11 19:11:12 +08:00 · 2019-11-11 11:06:55 +08:00 · 2019-11-11 10:52:21 +08:00 · 2019-11-11 10:46:13 +08:00 · 2019-11-11 10:26:13 +08:00 · 2019-11-08 17:38:55 +08:00
109 changed files with 6811 additions and 4936 deletions
@@ -1 +0,0 @@
-../simplelink/ble_sdk_2_02_02_25/src/common/cc26xx/
@@ -1 +0,0 @@
-../simplelink/ble_sdk_2_02_02_25/src/controller/cc26xx/inc/
@@ -1 +0,0 @@
-../tirtos_cc13xx_cc26xx_2_21_01_08/products/cc26xxware_2_24_03_17272/
@@ -1 +0,0 @@
-../simplelink/ble_sdk_2_02_02_25/src/components/hal/src/inc/
@@ -1 +0,0 @@
-../simplelink/ble_sdk_2_02_02_25/src/components/hal/src/target/_common/
@@ -1 +0,0 @@
-../simplelink/ble_sdk_2_02_02_25/src/components/hal/src/target/_common/cc26xx/
@@ -1 +0,0 @@
-../simplelink/ble_sdk_2_02_02_25/src/components/heapmgr/
@@ -1 +0,0 @@
-../simplelink/ble_sdk_2_02_02_25/src/examples/host_test/cc26xx/app/
@@ -1 +0,0 @@
-../simplelink/ble_sdk_2_02_02_25/src/icall/inc/
@@ -1 +0,0 @@
-../simplelink/ble_sdk_2_02_02_25/src/components/icall/src/inc/
@@ -1 +0,0 @@
-../simplelink/ble_sdk_2_02_02_25/src/inc/
@@ -1 +0,0 @@
-../simplelink/ble_sdk_2_02_02_25/src/components/npi/
@@ -1 +0,0 @@
-../simplelink/ble_sdk_2_02_02_25/src/components/osal/src/inc/
@@ -1 +0,0 @@
-../simplelink/ble_sdk_2_02_02_25/src/profiles/roles/
@@ -1 +0,0 @@
-../simplelink/ble_sdk_2_02_02_25/src/profiles/dev_info/
@@ -1 +0,0 @@
-../simplelink/ble_sdk_2_02_02_25/src/profiles/simple_profile/
@@ -1 +0,0 @@
-../simplelink/ble_sdk_2_02_02_25/src/rom/
@@ -1 +0,0 @@
-../simplelink/ble_sdk_2_02_02_25/src/components/services/src/saddr/
@@ -1 +0,0 @@
-../simplelink/ble_sdk_2_02_02_25/src/components/services/src/sdata/
@@ -1 +0,0 @@
-../simplelink/ble_sdk_2_02_02_25/src/examples/simple_peripheral/cc26xx/app/
@@ -1 +0,0 @@
-../simplelink/ble_sdk_2_02_02_25/src/target/
@@ -9,6 +9,6 @@
 	<linkerCommandFile value="cc26x0f128.cmd"/>
 	<rts value="libc.a"/>
 	<createSlaveProjects value=""/>
-	<connection value="common/targetdb/connections/TIXDS100v3_Dot7_Connection.xml"/>
+	<connection value="common/targetdb/connections/TIXDS110_Connection.xml"/>
 	<isTargetManual value="false"/>
 </projectOptions>
@@ -18,13 +18,13 @@
 			<storageModule moduleId="cdtBuildSystem" version="4.0.0">
 				<configuration artifactExtension="out" artifactName="${ProjName}" buildProperties="" cleanCommand="${CG_CLEAN_CMD}" description="" errorParsers="org.eclipse.rtsc.xdctools.parsers.ErrorParser;com.ti.rtsc.XDCtools.parsers.ErrorParser;com.ti.ccstudio.errorparser.CoffErrorParser;com.ti.ccstudio.errorparser.LinkErrorParser;com.ti.ccstudio.errorparser.AsmErrorParser;org.eclipse.cdt.core.GmakeErrorParser" id="com.ti.ccstudio.buildDefinitions.TMS470.Default.67178137" name="FlashROM" parent="com.ti.ccstudio.buildDefinitions.TMS470.Default" postbuildStep="${CG_TOOL_HEX} -order MS --memwidth=8 --romwidth=8 --intel -o      ${ProjName}.hex ${ProjName}.out" prebuildStep="">
 					<folderInfo id="com.ti.ccstudio.buildDefinitions.TMS470.Default.67178137." name="/" resourcePath="">
-						<toolChain id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exe.DebugToolchain.308833195" name="TI Build Tools" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exe.DebugToolchain" targetTool="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exe.linkerDebug.2125878104">
-							<option id="com.ti.ccstudio.buildDefinitions.core.OPT_TAGS.2138235341" superClass="com.ti.ccstudio.buildDefinitions.core.OPT_TAGS" valueType="stringList">
+						<toolChain id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exe.DebugToolchain.1369151231" name="TI Build Tools" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exe.DebugToolchain" targetTool="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exe.linkerDebug.223507680">
+							<option id="com.ti.ccstudio.buildDefinitions.core.OPT_TAGS.732777020" superClass="com.ti.ccstudio.buildDefinitions.core.OPT_TAGS" valueType="stringList">
 								<listOptionValue builtIn="false" value="DEVICE_CONFIGURATION_ID=Cortex M.CC2650F128"/>
 								<listOptionValue builtIn="false" value="DEVICE_ENDIANNESS=little"/>
 								<listOptionValue builtIn="false" value="OUTPUT_FORMAT=ELF"/>
 								<listOptionValue builtIn="false" value="RUNTIME_SUPPORT_LIBRARY=libc.a"/>
-								<listOptionValue builtIn="false" value="XDC_VERSION=3.32.0.06_core"/>
+								<listOptionValue builtIn="false" value="XDC_VERSION=3.32.2.25_core"/>
 								<listOptionValue builtIn="false" value="INACTIVE_REPOS="/>
 								<listOptionValue builtIn="false" value="EXPANDED_REPOS="/>
 								<listOptionValue builtIn="false" value="RTSC_PRODUCTS=com.ti.rtsc.TIRTOSCC13XX_CC26XX:2.21.01.08;"/>
@@ -34,17 +34,17 @@
 								<listOptionValue builtIn="false" value="LINK_ORDER=TOOLS/ccs_linker_defines.cmd;TOOLS/cc26xx_app.cmd;"/>
 								<listOptionValue builtIn="false" value="RTSC_MBS_VERSION=2.2.0"/>
 							</option>
-							<option id="com.ti.ccstudio.buildDefinitions.core.OPT_CODEGEN_VERSION.243195404" name="Compiler version" superClass="com.ti.ccstudio.buildDefinitions.core.OPT_CODEGEN_VERSION" value="18.1.4.LTS" valueType="string"/>
-							<targetPlatform id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exe.targetPlatformDebug.955793533" name="Platform" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exe.targetPlatformDebug"/>
-							<builder buildPath="${BuildDirectory}" id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exe.builderDebug.638576662" keepEnvironmentInBuildfile="false" name="GNU Make" parallelBuildOn="true" parallelizationNumber="optimal" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exe.builderDebug"/>
-							<tool id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exe.compilerDebug.1016177761" name="ARM Compiler" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exe.compilerDebug">
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.SILICON_VERSION.2070806136" name="Target processor version (--silicon_version, -mv)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.SILICON_VERSION" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.SILICON_VERSION.7M3" valueType="enumerated"/>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.CODE_STATE.1411365061" name="Designate code state, 16-bit (thumb) or 32-bit (--code_state)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.CODE_STATE" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.CODE_STATE.16" valueType="enumerated"/>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.ABI.193495829" name="Application binary interface. (--abi)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.ABI" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.ABI.eabi" valueType="enumerated"/>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.LITTLE_ENDIAN.1573436637" name="Little endian code [See 'General' page to edit] (--little_endian, -me)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.LITTLE_ENDIAN" value="true" valueType="boolean"/>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.OPT_LEVEL.978889992" name="Optimization level (--opt_level, -O)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.OPT_LEVEL" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.OPT_LEVEL.4" valueType="enumerated"/>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.OPT_FOR_SPEED.1392883332" name="Speed vs. size trade-offs (--opt_for_speed, -mf)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.OPT_FOR_SPEED" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.OPT_FOR_SPEED.0" valueType="enumerated"/>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.INCLUDE_PATH.511635494" name="Add dir to #include search path (--include_path, -I)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.INCLUDE_PATH" valueType="includePath">
+							<option id="com.ti.ccstudio.buildDefinitions.core.OPT_CODEGEN_VERSION.579299287" superClass="com.ti.ccstudio.buildDefinitions.core.OPT_CODEGEN_VERSION" value="18.1.4.LTS" valueType="string"/>
+							<targetPlatform id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exe.targetPlatformDebug.2112816025" name="Platform" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exe.targetPlatformDebug"/>
+							<builder buildPath="${BuildDirectory}" id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exe.builderDebug.1418617668" name="GNU Make.FlashROM" parallelBuildOn="true" parallelizationNumber="optimal" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exe.builderDebug"/>
+							<tool id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exe.compilerDebug.1368914557" name="ARM Compiler" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exe.compilerDebug">
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.SILICON_VERSION.872349905" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.SILICON_VERSION" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.SILICON_VERSION.7M3" valueType="enumerated"/>
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.CODE_STATE.1023813954" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.CODE_STATE" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.CODE_STATE.16" valueType="enumerated"/>
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.ABI.1674413144" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.ABI" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.ABI.eabi" valueType="enumerated"/>
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.LITTLE_ENDIAN.184317276" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.LITTLE_ENDIAN" value="true" valueType="boolean"/>
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.OPT_LEVEL.1068578615" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.OPT_LEVEL" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.OPT_LEVEL.4" valueType="enumerated"/>
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.OPT_FOR_SPEED.1943600764" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.OPT_FOR_SPEED" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.OPT_FOR_SPEED.0" valueType="enumerated"/>
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.INCLUDE_PATH.644525479" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.INCLUDE_PATH" valueType="includePath">
 									<listOptionValue builtIn="false" value="${CG_TOOL_ROOT}/include"/>
 									<listOptionValue builtIn="false" value="C:\ti\simplelink\ble_sdk_2_02_02_25\src\examples\simple_peripheral\cc26xx\app\headstage"/>
 									<listOptionValue builtIn="false" value="${SRC_EX}/examples/simple_peripheral/cc26xx/app"/>
@@ -70,10 +70,11 @@
 									<listOptionValue builtIn="false" value="${SRC_BLE_CORE}/rom"/>
 									<listOptionValue builtIn="false" value="${CC26XXWARE}"/>
 								</option>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DEFINE.521147483" name="Pre-define NAME (--define, -D)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DEFINE" valueType="definedSymbols">
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DEFINE.1330623088" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DEFINE" valueType="definedSymbols">
 									<listOptionValue builtIn="false" value="BOARD_DISPLAY_EXCLUDE_UART"/>
 									<listOptionValue builtIn="false" value="POWER_SAVING"/>
 									<listOptionValue builtIn="false" value="BOOSTXL_CC2650MA"/>
+									<listOptionValue builtIn="false" value="HEADSTAGE_MA_USE_SPI2"/>
 									<listOptionValue builtIn="false" value="CC26XX"/>
 									<listOptionValue builtIn="false" value="GAPROLE_TASK_STACK_SIZE=540"/>
 									<listOptionValue builtIn="false" value="HEAPMGR_SIZE=0"/>
@@ -85,71 +86,71 @@
 									<listOptionValue builtIn="false" value="xdc_runtime_Assert_DISABLE_ALL"/>
 									<listOptionValue builtIn="false" value="xdc_runtime_Log_DISABLE_ALL"/>
 								</option>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DEBUGGING_MODEL.1861999587" name="Debugging model" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DEBUGGING_MODEL" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DEBUGGING_MODEL.SYMDEBUG__DWARF" valueType="enumerated"/>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.C_DIALECT.1867564782" name="C Dialect" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.C_DIALECT" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.C_DIALECT.C99" valueType="enumerated"/>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.GCC.2052831394" name="Enable support for GCC extensions (DEPRECATED) (--gcc)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.GCC" value="true" valueType="boolean"/>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DIAG_SUPPRESS.1102242787" name="Suppress diagnostic &lt;id&gt; (--diag_suppress, -pds)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DIAG_SUPPRESS" valueType="stringList">
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DEBUGGING_MODEL.1308360247" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DEBUGGING_MODEL" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DEBUGGING_MODEL.SYMDEBUG__DWARF" valueType="enumerated"/>
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.C_DIALECT.504235202" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.C_DIALECT" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.C_DIALECT.C99" valueType="enumerated"/>
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.GCC.105967788" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.GCC" value="true" valueType="boolean"/>
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DIAG_SUPPRESS.698913237" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DIAG_SUPPRESS" valueType="stringList">
 									<listOptionValue builtIn="false" value="48"/>
 								</option>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DIAG_WARNING.727880917" name="Treat diagnostic &lt;id&gt; as warning (--diag_warning, -pdsw)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DIAG_WARNING" valueType="stringList">
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DIAG_WARNING.1399241416" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DIAG_WARNING" valueType="stringList">
 									<listOptionValue builtIn="false" value="225"/>
 								</option>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DIAG_WRAP.996618365" name="Wrap diagnostic messages (--diag_wrap)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DIAG_WRAP" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DIAG_WRAP.off" valueType="enumerated"/>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DISPLAY_ERROR_NUMBER.858761211" name="Emit diagnostic identifier numbers (--display_error_number, -pden)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DISPLAY_ERROR_NUMBER" value="true" valueType="boolean"/>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.GEN_FUNC_SUBSECTIONS.96303422" name="Place each function in a separate subsection (--gen_func_subsections, -ms)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.GEN_FUNC_SUBSECTIONS" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.GEN_FUNC_SUBSECTIONS.on" valueType="enumerated"/>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.CMD_FILE.1634706392" name="Read options from specified file (--cmd_file, -@)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.CMD_FILE" valueType="stringList">
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DIAG_WRAP.867926379" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DIAG_WRAP" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DIAG_WRAP.off" valueType="enumerated"/>
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DISPLAY_ERROR_NUMBER.980626282" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.DISPLAY_ERROR_NUMBER" value="true" valueType="boolean"/>
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.GEN_FUNC_SUBSECTIONS.374992114" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.GEN_FUNC_SUBSECTIONS" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.GEN_FUNC_SUBSECTIONS.on" valueType="enumerated"/>
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.CMD_FILE.1890491357" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compilerID.CMD_FILE" valueType="stringList">
 									<listOptionValue builtIn="false" value="${SRC_EX}/config/build_components.opt"/>
 									<listOptionValue builtIn="false" value="${ORG_PROJ_DIR}/build_config.opt"/>
 									<listOptionValue builtIn="false" value="${ORG_PROJ_DIR}/../../ccs/config/ccs_compiler_defines.bcfg"/>
 								</option>
-								<inputType id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compiler.inputType__C_SRCS.1149005836" name="C Sources" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compiler.inputType__C_SRCS"/>
-								<inputType id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compiler.inputType__CPP_SRCS.404213358" name="C++ Sources" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compiler.inputType__CPP_SRCS"/>
-								<inputType id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compiler.inputType__ASM_SRCS.1356338499" name="Assembly Sources" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compiler.inputType__ASM_SRCS"/>
-								<inputType id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compiler.inputType__ASM2_SRCS.1609020645" name="Assembly Sources" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compiler.inputType__ASM2_SRCS"/>
+								<inputType id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compiler.inputType__C_SRCS.263445006" name="C Sources" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compiler.inputType__C_SRCS"/>
+								<inputType id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compiler.inputType__CPP_SRCS.1235873701" name="C++ Sources" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compiler.inputType__CPP_SRCS"/>
+								<inputType id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compiler.inputType__ASM_SRCS.207268648" name="Assembly Sources" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compiler.inputType__ASM_SRCS"/>
+								<inputType id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compiler.inputType__ASM2_SRCS.1068957263" name="Assembly Sources" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.compiler.inputType__ASM2_SRCS"/>
 							</tool>
-							<tool id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exe.linkerDebug.2125878104" name="ARM Linker" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exe.linkerDebug">
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.STACK_SIZE.1993482378" name="Set C system stack size (--stack_size, -stack)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.STACK_SIZE" value="256" valueType="string"/>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.HEAP_SIZE.833137428" name="Heap size for C/C++ dynamic memory allocation (--heap_size, -heap)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.HEAP_SIZE" value="0" valueType="string"/>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.MAP_FILE.1072440081" name="Link information (map) listed into &lt;file&gt; (--map_file, -m)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.MAP_FILE" value="&quot;${ProjName}.map&quot;" valueType="string"/>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.OUTPUT_FILE.95815077" name="Specify output file name (--output_file, -o)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.OUTPUT_FILE" value="${ProjName}.out" valueType="string"/>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.LIBRARY.1766117832" name="Include library file or command file as input (--library, -l)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.LIBRARY" valueType="libs">
+							<tool id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exe.linkerDebug.223507680" name="ARM Linker" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exe.linkerDebug">
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.STACK_SIZE.698430423" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.STACK_SIZE" value="256" valueType="string"/>
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.HEAP_SIZE.402182782" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.HEAP_SIZE" value="0" valueType="string"/>
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.MAP_FILE.1628689699" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.MAP_FILE" value="&quot;${ProjName}.map&quot;" valueType="string"/>
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.OUTPUT_FILE.2141951901" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.OUTPUT_FILE" value="${ProjName}.out" valueType="string"/>
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.LIBRARY.679112687" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.LIBRARY" valueType="libs">
 									<listOptionValue builtIn="false" value="libc.a"/>
 									<listOptionValue builtIn="false" value="${CC26XXWARE}/driverlib/bin/ccs/driverlib.lib"/>
 									<listOptionValue builtIn="false" value="${ROM}/common_rom_releases/03282014/common_rom.symbols"/>
 								</option>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.SEARCH_PATH.1149343368" name="Add &lt;dir&gt; to library search path (--search_path, -i)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.SEARCH_PATH" valueType="libPaths">
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.SEARCH_PATH.650613345" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.SEARCH_PATH" valueType="libPaths">
 									<listOptionValue builtIn="false" value="${CG_TOOL_ROOT}/lib"/>
 									<listOptionValue builtIn="false" value="${CG_TOOL_ROOT}/include"/>
 								</option>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.DIAG_SUPPRESS.512740056" name="Suppress diagnostic &lt;id&gt; (--diag_suppress)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.DIAG_SUPPRESS" valueType="stringList">
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.DIAG_SUPPRESS.782343525" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.DIAG_SUPPRESS" valueType="stringList">
 									<listOptionValue builtIn="false" value="10247-D"/>
 									<listOptionValue builtIn="false" value="16002-D"/>
 								</option>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.DIAG_WRAP.755787473" name="Wrap diagnostic messages (--diag_wrap)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.DIAG_WRAP" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.DIAG_WRAP.off" valueType="enumerated"/>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.DISPLAY_ERROR_NUMBER.1039632635" name="Emit diagnostic identifier numbers (--display_error_number)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.DISPLAY_ERROR_NUMBER" value="true" valueType="boolean"/>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.XML_LINK_INFO.160090718" name="Detailed link information data-base into &lt;file&gt; (--xml_link_info, -xml_link_info)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.XML_LINK_INFO" value="&quot;${ProjName}_linkInfo.xml&quot;" valueType="string"/>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.COMPRESS_DWARF.1907564273" name="Aggressively reduce size of the DWARF information (--compress_dwarf)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.COMPRESS_DWARF" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.COMPRESS_DWARF.on" valueType="enumerated"/>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.UNUSED_SECTION_ELIMINATION.1278577864" name="Eliminate sections not needed in the executable (--unused_section_elimination)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.UNUSED_SECTION_ELIMINATION" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.UNUSED_SECTION_ELIMINATION.on" valueType="enumerated"/>
-								<inputType id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exeLinker.inputType__CMD_SRCS.1166775149" name="Linker Command Files" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exeLinker.inputType__CMD_SRCS"/>
-								<inputType id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exeLinker.inputType__CMD2_SRCS.1192919935" name="Linker Command Files" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exeLinker.inputType__CMD2_SRCS"/>
-								<inputType id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exeLinker.inputType__GEN_CMDS.1491242603" name="Generated Linker Command Files" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exeLinker.inputType__GEN_CMDS"/>
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.DIAG_WRAP.1555270082" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.DIAG_WRAP" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.DIAG_WRAP.off" valueType="enumerated"/>
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.DISPLAY_ERROR_NUMBER.16105060" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.DISPLAY_ERROR_NUMBER" value="true" valueType="boolean"/>
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.XML_LINK_INFO.1713299511" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.XML_LINK_INFO" value="&quot;${ProjName}_linkInfo.xml&quot;" valueType="string"/>
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.COMPRESS_DWARF.68776981" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.COMPRESS_DWARF" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.COMPRESS_DWARF.on" valueType="enumerated"/>
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.UNUSED_SECTION_ELIMINATION.1860389255" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.UNUSED_SECTION_ELIMINATION" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.linkerID.UNUSED_SECTION_ELIMINATION.on" valueType="enumerated"/>
+								<inputType id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exeLinker.inputType__CMD_SRCS.152379533" name="Linker Command Files" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exeLinker.inputType__CMD_SRCS"/>
+								<inputType id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exeLinker.inputType__CMD2_SRCS.158095632" name="Linker Command Files" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exeLinker.inputType__CMD2_SRCS"/>
+								<inputType id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exeLinker.inputType__GEN_CMDS.978853236" name="Generated Linker Command Files" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.exeLinker.inputType__GEN_CMDS"/>
 							</tool>
-							<tool id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.hex.1967400950" name="ARM Hex Utility" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.hex">
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.hex.ROMWIDTH.1242139870" name="Specify rom width (--romwidth, -romwidth=width)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.hex.ROMWIDTH" value="8" valueType="string"/>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.hex.MEMWIDTH.1863065780" name="Specify memory width (--memwidth, -memwidth=width)" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.hex.MEMWIDTH" value="8" valueType="string"/>
-								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.hex.OUTPUT_FORMAT.47746446" name="Output format" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.hex.OUTPUT_FORMAT" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.hex.OUTPUT_FORMAT.INTEL" valueType="enumerated"/>
+							<tool id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.hex.2015106526" name="ARM Hex Utility" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.hex">
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.hex.ROMWIDTH.1270425102" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.hex.ROMWIDTH" value="8" valueType="string"/>
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.hex.MEMWIDTH.16813235" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.hex.MEMWIDTH" value="8" valueType="string"/>
+								<option id="com.ti.ccstudio.buildDefinitions.TMS470_18.1.hex.OUTPUT_FORMAT.318851558" superClass="com.ti.ccstudio.buildDefinitions.TMS470_18.1.hex.OUTPUT_FORMAT" value="com.ti.ccstudio.buildDefinitions.TMS470_18.1.hex.OUTPUT_FORMAT.INTEL" valueType="enumerated"/>
 							</tool>
-							<tool id="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.1864525425" name="XDCtools" superClass="com.ti.rtsc.buildDefinitions.XDC_3.16.tool">
-								<option id="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.XDC_PATH.46430604" name="Package repositories (--xdcpath)" superClass="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.XDC_PATH" valueType="stringList">
+							<tool id="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.927640565" name="XDCtools" superClass="com.ti.rtsc.buildDefinitions.XDC_3.16.tool">
+								<option id="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.XDC_PATH.1908494509" superClass="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.XDC_PATH" valueType="stringList">
 									<listOptionValue builtIn="false" value="${COM_TI_RTSC_TIRTOSCC13XX_CC26XX_REPOS}"/>
 									<listOptionValue builtIn="false" value="${TARGET_CONTENT_BASE}"/>
 								</option>
-								<option id="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.TARGET.313008504" name="Target (-t)" superClass="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.TARGET" value="ti.targets.arm.elf.M3" valueType="string"/>
-								<option id="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.PLATFORM.807892561" name="Platform (-p)" superClass="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.PLATFORM" value="ti.platforms.simplelink:CC2640F128" valueType="string"/>
-								<option id="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.PLATFORM_RAW.1808973543" name="Platform (-p)" superClass="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.PLATFORM_RAW" value="ti.platforms.simplelink:CC2640F128" valueType="string"/>
-								<option id="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.BUILD_PROFILE.1028195441" name="Build-profile (-r)" superClass="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.BUILD_PROFILE" value="release" valueType="string"/>
-								<option id="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.CODEGEN_TOOL_DIR.295955151" name="Compiler tools directory (-c)" superClass="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.CODEGEN_TOOL_DIR" value="${CG_TOOL_ROOT}" valueType="string"/>
-								<option id="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.COMPILE_OPTIONS.128448790" name="Additional compiler options (--compileOptions)" superClass="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.COMPILE_OPTIONS" value="&quot;${COMPILER_FLAGS}&quot;" valueType="string"/>
+								<option id="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.TARGET.1746187707" superClass="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.TARGET" value="ti.targets.arm.elf.M3" valueType="string"/>
+								<option id="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.PLATFORM.884959194" superClass="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.PLATFORM" value="ti.platforms.simplelink:CC2640F128" valueType="string"/>
+								<option id="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.PLATFORM_RAW.943624305" superClass="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.PLATFORM_RAW" value="ti.platforms.simplelink:CC2640F128" valueType="string"/>
+								<option id="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.BUILD_PROFILE.1521167272" superClass="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.BUILD_PROFILE" value="release" valueType="string"/>
+								<option id="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.CODEGEN_TOOL_DIR.1901654533" superClass="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.CODEGEN_TOOL_DIR" value="${CG_TOOL_ROOT}" valueType="string"/>
+								<option id="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.COMPILE_OPTIONS.138005453" superClass="com.ti.rtsc.buildDefinitions.XDC_3.16.tool.COMPILE_OPTIONS" value="&quot;${COMPILER_FLAGS}&quot;" valueType="string"/>
 							</tool>
 						</toolChain>
 					</folderInfo>
@@ -1,19 +1,20 @@
 <?xml version="1.0" encoding="UTF-8" standalone="no"?>
 <configurations XML_version="1.2" id="configurations_0">
-<configuration XML_version="1.2" id="Texas Instruments XDS100v3 USB Debug Probe_0">
-        <instance XML_version="1.2" desc="Texas Instruments XDS100v3 USB Debug Probe_0" href="connections/TIXDS100v3_Dot7_Connection.xml" id="Texas Instruments XDS100v3 USB Debug Probe_0" xml="TIXDS100v3_Dot7_Connection.xml" xmlpath="connections"/>
-        <connection XML_version="1.2" id="Texas Instruments XDS100v3 USB Debug Probe_0">
-            <instance XML_version="1.2" href="drivers/tixds100v2icepick_c.xml" id="drivers" xml="tixds100v2icepick_c.xml" xmlpath="drivers"/>
-            <instance XML_version="1.2" href="drivers/tixds100v2cs_dap.xml" id="drivers" xml="tixds100v2cs_dap.xml" xmlpath="drivers"/>
-            <instance XML_version="1.2" href="drivers/tixds100v2cortexM.xml" id="drivers" xml="tixds100v2cortexM.xml" xmlpath="drivers"/>
-            <property Type="choicelist" Value="2" id="The Converter Usage">
-                <choice Name="Generate 1149.7 2-pin advanced modes" value="enable">
-                    <property Type="choicelist" Value="1" id="The Converter 1149.7 Frequency">
-                        <choice Name="Overclock with user specified value" value="unused">
-                            <property Type="choicelist" Value="5" id="-- Choose a value from 1.0MHz to 50.0MHz"/>
-                        </choice>
-                    </property>
-                    <property Type="choicelist" Value="5" id="The Target Scan Format"/>
+<configuration XML_version="1.2" id="Texas Instruments XDS110 USB Debug Probe_0">
+        <instance XML_version="1.2" desc="Texas Instruments XDS110 USB Debug Probe_0" href="connections/TIXDS110_Connection.xml" id="Texas Instruments XDS110 USB Debug Probe_0" xml="TIXDS110_Connection.xml" xmlpath="connections"/>
+        <connection XML_version="1.2" id="Texas Instruments XDS110 USB Debug Probe_0">
+            <instance XML_version="1.2" href="drivers/tixds510icepick_c.xml" id="drivers" xml="tixds510icepick_c.xml" xmlpath="drivers"/>
+            <instance XML_version="1.2" href="drivers/tixds510cs_dap.xml" id="drivers" xml="tixds510cs_dap.xml" xmlpath="drivers"/>
+            <instance XML_version="1.2" href="drivers/tixds510cortexM.xml" id="drivers" xml="tixds510cortexM.xml" xmlpath="drivers"/>
+            <property Type="choicelist" Value="1" id="Power Selection">
+                <choice Name="Probe supplied power" value="1">
+                    <property Type="stringfield" Value="3.3" id="Voltage Level"/>
+                </choice>
+            </property>
+            <property Type="choicelist" Value="0" id="JTAG Signal Isolation"/>
+            <property Type="choicelist" Value="4" id="SWD Mode Settings">
+                <choice Name="cJTAG (1149.7) 2-pin advanced modes" value="enable">
+                    <property Type="choicelist" Value="1" id="XDS110 Aux Port"/>
                </choice>
            </property>
            <platform XML_version="1.2" id="platform_0">
@@ -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")
@@ -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/

@@ -22,8 +22,8 @@ CC = C:/ti/ccsv8/tools/compiler/ti-cgt-arm_18.1.4.LTS/bin/armcl -c $(CCOPTS) -I
 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,:)
@@ -16,7 +16,7 @@
 # sources were generated) is:
 #    C:\ti\simplelink\ble_sdk_2_02_02_25\examples\cc2650lp\host_test\ccs\config\src
 #
-GEN_SRC_DIR ?= ../../config/src
+GEN_SRC_DIR ?= ../../../../../ti/simplelink/ble_sdk_2_02_02_25/examples/cc2650lp/host_test/ccs/config/src

 ifeq (,$(wildcard $(GEN_SRC_DIR)))
 $(error "ERROR: GEN_SRC_DIR must be set to the directory containing the generated sources")
@@ -16,11 +16,11 @@ 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.4.LTS/include" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/examples/host_test/cc26xx/app/cc2650" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/examples/host_test/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/common/cc26xx" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/components/npi/src" --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_16.9.4.LTS/include" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/examples/host_test/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/common/cc26xx" --include_path="C:/ti/simplelink/ble_sdk_2_02_02_25/src/components/npi/src" --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.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
+CC = C:/ti/ccsv8/tools/compiler/ti-cgt-arm_16.9.4.LTS/bin/armcl -c $(CCOPTS) -I C:/ti/ccsv8/tools/compiler/ti-cgt-arm_16.9.4.LTS/include
+ASM = C:/ti/ccsv8/tools/compiler/ti-cgt-arm_16.9.4.LTS/bin/armcl -c $(CCOPTS) -I C:/ti/ccsv8/tools/compiler/ti-cgt-arm_16.9.4.LTS/include
+AR = C:/ti/ccsv8/tools/compiler/ti-cgt-arm_16.9.4.LTS/bin/armar rq

 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
@@ -16,7 +16,7 @@
 # sources were generated) is:
 #    C:\ti\simplelink\ble_sdk_2_02_02_25\examples\cc2650lp\simple_peripheral\ccs\config\src
 #
-GEN_SRC_DIR ?= ../../config/src
+GEN_SRC_DIR ?= ../../../../../ti/simplelink/ble_sdk_2_02_02_25/examples/cc2650lp/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")
@@ -80,6 +80,7 @@ const PIN_Config BoardGpioInitTable[] = {
    Board_UART_TX | PIN_GPIO_OUTPUT_EN | PIN_GPIO_HIGH | PIN_PUSHPULL,                        /* UART TX */
   Board_SRDY | PIN_GPIO_OUTPUT_EN | PIN_GPIO_HIGH | PIN_PUSHPULL,                           /* SRDY */
   Board_MRDY | PIN_INPUT_EN | PIN_PULLDOWN,                                                 /* MRDY */
+
    PIN_TERMINATE
 };

@@ -189,57 +190,6 @@ const UDMACC26XX_Config UDMACC26XX_config[] = {
 *  ============================= UDMA end =====================================
 */

-/*
- *  ========================== SPI DMA begin ===================================
- */
-/* Place into subsections to allow the TI linker to remove items properly */
-#if defined(__TI_COMPILER_VERSION__)
-#pragma DATA_SECTION(SPI_config, ".const:SPI_config")
-#pragma DATA_SECTION(spiCC26XXDMAHWAttrs, ".const:spiCC26XXDMAHWAttrs")
-#endif
-
-/* Include drivers */
-#include <ti/drivers/spi/SPICC26XXDMA.h>
-
-/* SPI objects */
-SPICC26XXDMA_Object spiCC26XXDMAObjects[BOOSTXL_CC2650MA_SPICOUNT];
-
-/* SPI configuration structure, describing which pins are to be used */
-const SPICC26XXDMA_HWAttrsV1 spiCC26XXDMAHWAttrs[BOOSTXL_CC2650MA_UDMACOUNT] = {
-    {
-        .baseAddr           = SSI0_BASE,
-        .intNum             = INT_SSI0_COMB,
-        .intPriority        = ~0,
-        .swiPriority        = 0,
-        .powerMngrId        = PowerCC26XX_PERIPH_SSI0,
-        .defaultTxBufValue  = 0,
-        .rxChannelBitMask   = 1<<UDMA_CHAN_SSI0_RX,
-        .txChannelBitMask   = 1<<UDMA_CHAN_SSI0_TX,
-        .mosiPin            = Board_SPI0_MOSI,
-        .misoPin            = Board_SPI0_MISO,
-        .clkPin             = Board_SPI0_CLK,
-        .csnPin             = Board_SPI0_CS
-    },
-};
-
-/* SPI configuration structure */
-const SPI_Config SPI_config[] = {
-    {
-         .fxnTablePtr = &SPICC26XXDMA_fxnTable,
-         .object      = &spiCC26XXDMAObjects[0],
-         .hwAttrs     = &spiCC26XXDMAHWAttrs[0]
-    },
-    {
-         .fxnTablePtr = &SPICC26XXDMA_fxnTable,
-         .object      = &spiCC26XXDMAObjects[1],
-         .hwAttrs     = &spiCC26XXDMAHWAttrs[1]
-    },
-    {NULL, NULL, NULL}
-};
-/*
- *  ========================== SPI DMA end =====================================
-*/
-

 /*
 *  ========================== Crypto begin ====================================
@@ -89,24 +89,24 @@ extern const PIN_Config BoardGpioInitTable[];
 */

 /* Connector J1 */
-#define Board_BP_Pin_J1_2              DIO7
+#define Board_BP_Pin_J1_2              IOID_UNUSED
 #define Board_BP_Pin_J1_3              DIO0
 #define Board_BP_Pin_J1_4              DIO1
 #define Board_BP_Pin_J1_5              DIO2
 #define Board_BP_Pin_J1_6              DIO3
-#define Board_BP_Pin_J1_7              DIO10
+#define Board_BP_Pin_J1_7              DIO11        /* SCLK */
 #define Board_BP_Pin_J1_8              DIO4
 #define Board_BP_Pin_J1_9              DIO5
 #define Board_BP_Pin_J1_10             DIO6

 /* Connector J2 */
-#define Board_BP_Pin_J2_19             DIO8
-#define Board_BP_Pin_J2_18             DIO9          /* CS */
+#define Board_BP_Pin_J2_19             IOID_UNUSED
+#define Board_BP_Pin_J2_18             IOID_UNUSED
 #define Board_BP_Pin_J2_17             IOID_UNUSED   /* NC */
-#define Board_BP_Pin_J2_15             DIO11         /* MOSI */
-#define Board_BP_Pin_J2_14             DIO12         /* MISO */
-#define Board_BP_Pin_J2_13             DIO13
-#define Board_BP_Pin_J2_12             DIO14
+#define Board_BP_Pin_J2_15             DIO8         /* MOSI */
+#define Board_BP_Pin_J2_14             DIO7         /* MISO */
+#define Board_BP_Pin_J2_13             DIO9         /* DAC_CS */
+#define Board_BP_Pin_J2_12             DIO12        /* ADC_CS */
 #define Board_BP_Pin_J2_11             IOID_UNUSED   /* NC */

 /* Mapping of BoosterPack Connector Pins to BoosterPack Standard Functions (reflecting the BoosterPack Standard)
@@ -125,12 +125,12 @@ extern const PIN_Config BoardGpioInitTable[];

 /* Connector J2 */
 #define Board_BP_PWM_0                 Board_BP_Pin_J2_19
-#define Board_BP_SPI_CS_Wireless       Board_BP_Pin_J2_18
+#define Board_BP_SPI_CS_Wireless       PIN_UNASSIGNED
 #define Board_BP_GPIO_3                Board_BP_Pin_J2_17
 #define Board_BP_SPI_MOSI              Board_BP_Pin_J2_15
 #define Board_BP_SPI_MISO              Board_BP_Pin_J2_14
-#define Board_BP_SPI_CS_Display        Board_BP_Pin_J2_13
-#define Board_BP_SPI_CS_Other          Board_BP_Pin_J2_12
+#define Board_BP_SPI_CS_Display        PIN_UNASSIGNED
+#define Board_BP_SPI_CS_Other          PIN_UNASSIGNED
 #define Board_BP_GPIO_2                Board_BP_Pin_J2_11


@@ -145,11 +145,11 @@ extern const PIN_Config BoardGpioInitTable[];
 #define Board_UART_TX                  Board_BP_UART_Rx          /* RXD */
 #define Board_UART_RX                  Board_BP_UART_Tx          /* TXD */

-/* SPI Board */
-#define Board_SPI0_MISO                Board_BP_SPI_MISO
-#define Board_SPI0_MOSI                Board_BP_SPI_MOSI
-#define Board_SPI0_CLK                 Board_BP_SPI_CLK
-#define Board_SPI0_CS                  Board_BP_SPI_CS_Wireless
+
+
+//#define Board_SPI0_MISO                PIN_UNASSIGNED
+//#define Board_SPI0_MOSI                PIN_UNASSIGNED
+

 /* Power Management Board */
 #define Board_SRDY                     Board_BP_Pin_J2_19
@@ -170,6 +170,7 @@ extern const PIN_Config BoardGpioInitTable[];
 *  ==========================================================================*/
 /* Generic SPI instance identifiers */
 #define Board_SPI0                  BOOSTXL_CC2650MA_SPI0
+#define Board_SPI1                  BOOSTXL_CC2650MA_SPI1
 /* Generic UART instance identifiers */
 #define Board_UART                  BOOSTXL_CC2650MA_UART0
 /* Generic TRNG instance identiifer */
@@ -208,15 +209,7 @@ typedef enum BOOSTXL_CC2650MA_CryptoName {
 } BOOSTXL_CC2650MA_CryptoName;


-/*!
- *  @def    BOOSTXL_CC2650MA_SPIName
- *  @brief  Enum of SPI names on the CC2650 Booster Pack
- */
-typedef enum BOOSTXL_CC2650MA_SPIName {
-    BOOSTXL_CC2650MA_SPI0 = 0,

-    BOOSTXL_CC2650MA_SPICOUNT
-} BOOSTXL_CC2650MA_SPIName;

 /*!
 *  @def    BOOSTXL_CC2650MA_TRNGName
@@ -39,6 +39,7 @@ extern "C" {

 #include <ti/drivers/Power.h>

+//#include "BOOSTXL_CC2650MA.h"
 #include "BOOSTXL_CC2650MA.h"

 /* These #defines allow us to reuse TI-RTOS across other device families */
@@ -79,23 +79,22 @@ extern const PIN_Config BoardGpioInitTable[];

 /* UART Board */
 #define Board_UART_RX               IOID_2          /* RXD  */
-#define Board_UART_TX               IOID_3          /* TXD  */
+#define Board_UART_TX               PIN_UNASSIGNED  /* TXD  */
 #define Board_UART_CTS              IOID_19         /* CTS  */
 #define Board_UART_RTS              IOID_18         /* RTS */

 /* SPI Board */
-#define Board_SPI0_MISO             IOID_8          /* RF1.20 */
-#define Board_SPI0_MOSI             IOID_9          /* RF1.18 */
-#define Board_SPI0_CLK              IOID_10         /* RF1.16 */
+#define Board_SPI0_MISO             IOID_0          /* RF1.20 */
+#define Board_SPI0_MOSI             IOID_1          /* RF1.18 */
+#define Board_SPI0_CLK              IOID_3         /* RF1.16 */
 #define Board_SPI0_CSN              PIN_UNASSIGNED
 #define Board_SPI1_MISO             PIN_UNASSIGNED
-#define Board_SPI1_MOSI             PIN_UNASSIGNED
-#define Board_SPI1_CLK              PIN_UNASSIGNED
+#define Board_SPI1_MOSI             IOID_8          /* LED_MOSI */
+#define Board_SPI1_CLK              IOID_9          /* LED_CLK */
+
+
 #define Board_SPI1_CSN              PIN_UNASSIGNED

-/* I2C */
-#define Board_I2C0_SCL0             IOID_4
-#define Board_I2C0_SDA0             IOID_5

 /* SPI */
 #define Board_SPI_FLASH_CS          IOID_20
@@ -103,8 +102,8 @@ extern const PIN_Config BoardGpioInitTable[];
 #define Board_FLASH_CS_OFF          1

 /* Booster pack generic */
-#define Board_DIO0                  IOID_0
-#define Board_DIO1_RFSW             IOID_1
+#define Board_DIO0                  PIN_UNASSIGNED
+#define Board_DIO1_RFSW             PIN_UNASSIGNED
 #define Board_DIO12                 IOID_12
 #define Board_DIO15                 IOID_15
 #define Board_DIO16_TDO             IOID_16
@@ -55,7 +55,7 @@ extern "C"
 // includes
 // ****************************************************************************
 #include "hal_types.h"
-#include "npi/src/inc/npi_config.h"
+#include "inc/npi_config.h"

 // ****************************************************************************
 // defines
@@ -9,7 +9,7 @@
 Target Device: CC2650, CC2640

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

@@ -45,121 +45,87 @@
 Release Date: 2018-04-02 18:03:35
 *****************************************************************************/

-/*********************************************************************
- * INCLUDES
- */
-
 #include <ti/sysbios/knl/Task.h>
+
 #include <ti/sysbios/hal/Hwi.h>
+
 #include <ti/sysbios/knl/Clock.h>
+
 #include <ti/sysbios/knl/Semaphore.h>
+
 #include <ti/sysbios/knl/Queue.h>

 #include <string.h>

 #include "hal_types.h"
+
 #include "hci_tl.h"
+
 #include "hci_ext.h"
+
 #include "gatt.h"
+
 #include "hci.h"

 #include "gapgattserver.h"
+
 #include "gattservapp.h"

 #include "gapbondmgr.h"
+
+#define OSAL_SNV 0
+
 #include "osal_snv.h"
+
 #include "icall_apimsg.h"

 #include "util.h"
-#include <ti/mw/display/Display.h>

 #include "inc/npi_ble.h"
+
 #include "inc/npi_task.h"
+
 #include <inc/hw_types.h>
+
 #include "hal_defs.h"

-#if defined ( USE_RCOSC )
-#include "rcosc_calibration.h"
-#endif // USE_RCOSC
-
-#if defined ( GATT_TEST ) || defined ( GATT_QUAL )
-  #include "gatttest.h"
+#if defined(GATT_TEST) || defined(GATT_QUAL)
+#include "gatttest.h"
 #endif

 #include "host_test_app.h"

-#if defined( USE_FPGA ) || defined( DEBUG_SW_TRACE )
-#include <driverlib/ioc.h>
-#endif // USE_FPGA | DEBUG_SW_TRACE
+//#define PERIODIC_USE_GPTIMER

-/*********************************************************************
- * CONSTANTS
- */
+#include "cc2650/cc2650_util.h"
+
+//#include "cc2650/cc2650_slave.h"
+
+#include "cc2650/cc2650_master.h"

 // LE Event Lengths
-#define HCI_CMD_COMPLETE_EVENT_LEN              3
-#define HCI_CMD_VS_COMPLETE_EVENT_LEN           2
-#define HCI_CMD_STATUS_EVENT_LEN                4
-#define HCI_PHY_UPDATE_COMPLETE_EVENT_LEN       6
+#define HCI_CMD_COMPLETE_EVENT_LEN 3
+#define HCI_CMD_VS_COMPLETE_EVENT_LEN 2
+#define HCI_CMD_STATUS_EVENT_LEN 4
+#define HCI_PHY_UPDATE_COMPLETE_EVENT_LEN 6
+
+static void HTA_init(void);
+static void HTA_main(UArg a0, UArg a1);
+static void HTA_handle_gap_event(ICall_HciExtEvt *message);
+static void HTA_handle_att_event(gattMsgEvent_t *message);
+static void HTA_handle_ble_event(ICall_HciExtEvt *message);
+static void send_command_complete_event(uint8 eventCode, uint16 opcode, uint8 numParam, uint8 *param);
+static void send_command_status_event(uint8_t eventCode, uint16_t status, uint16_t opcode);
+static void send_ble_complete_event(uint8 eventLen, uint8 *pEvent);
+
+extern void AssertHandler(uint8 assertCause, uint8 assertSubCause);

 // Task configuration
-#define HTA_TASK_PRIORITY                       1
-#define HTA_TASK_STACK_SIZE                     644
+#define HTA_TASK_STACK_SIZE 512
+Task_Struct hta_task;
+Char        hta_task_stack[HTA_TASK_STACK_SIZE];

-/*********************************************************************
- * GLOBAL VARIABLES
- */
-
-// Display Interface
-Display_Handle dispHandle = NULL;
-
-/*********************************************************************
- * LOCAL VARIABLES
- */
-// Entity ID globally used to check for source and/or destination of messages
-static ICall_EntityID selfEntity;
-
-// Semaphore globally used to post events to the application thread
-static ICall_Semaphore sem;
-
-// Task configuration
-Task_Struct htaTask;
-Char htaTaskStack[HTA_TASK_STACK_SIZE];
-
-#if !defined ( GATT_DB_OFF_CHIP )
-  static uint8 deviceName[GAP_DEVICE_NAME_LEN] = { 0 };
-  static uint16 appearance = 17;
-#endif
-
-// Stack build revision
-ICall_BuildRevision buildRev;
-
-/*********************************************************************
- * LOCAL FUNCTIONS
- */
-
-static void HostTestApp_init(void);
-static void HostTestApp_taskFxn(UArg a0, UArg a1);
-
-static void HostTestApp_processGapEvent(ICall_HciExtEvt *pMsg);
-static void HostTestApp_processBLEEvent(ICall_HciExtEvt *pMsg);
-
-static void sendCommandCompleteEvent(uint8 eventCode, uint16 opcode,
-                                     uint8 numParam, uint8 *param);
-static void sendCommandStatusEvent(uint8_t eventCode, uint16_t status,
-                                   uint16_t opcode);
-static void sendBLECompleteEvent(uint8 eventLen, uint8 *pEvent);
-
-/*********************************************************************
- * EXTERN FUNCTIONS
- */
-extern void AssertHandler(uint8 assertCause, uint8 assertSubcause);
-
-/*********************************************************************
- * PUBLIC FUNCTIONS
- */
-
-/*********************************************************************
+/*
 * @fn      HostTestApp_createTask
 *
 * @brief   Task creation function for the Host Test App.
@@ -168,21 +134,30 @@ extern void AssertHandler(uint8 assertCause, uint8 assertSubcause);
 *
 * @return  none
 */
-void HostTestApp_createTask(void)
-{
-  Task_Params taskParams;
+void HostTestApp_createTask(void) {
+    /* main task */
+    Task_Params task_main_parameter;
+    Task_Params_init(&task_main_parameter);
+    task_main_parameter.stack     = hta_task_stack;
+    task_main_parameter.stackSize = HTA_TASK_STACK_SIZE;
+    task_main_parameter.priority  = 1;

-  // Configure task
-  Task_Params_init(&taskParams);
-  taskParams.stack = htaTaskStack;
-  taskParams.stackSize = HTA_TASK_STACK_SIZE;
-  taskParams.priority = HTA_TASK_PRIORITY;
-
-  Task_construct(&htaTask, HostTestApp_taskFxn, &taskParams, NULL);
+    Task_construct(&hta_task, HTA_main, &task_main_parameter, NULL);
 }

-/*********************************************************************
- * @fn      HostTestApp_init
+// Entity ID globally used to check for source and/or destination of messages
+static ICall_EntityID self;
+
+// Semaphore globally used to post events to the application thread
+extern ICall_Semaphore semaphore;
+
+extern uint16_t event_flags;
+
+// Stack build revision
+ICall_BuildRevision build_reversion;
+
+/*
+ * @fn      HTA_init
 *
 * @brief   Called during initialization and contains application
 *          specific initialization (ie. hardware initialization/setup,
@@ -193,118 +168,30 @@ void HostTestApp_createTask(void)
 *
 * @return  none
 */
-static void HostTestApp_init(void)
-{
-  // Register the current thread as an ICall dispatcher application
-  // so that the application can send and receive messages.
-  ICall_registerApp(&selfEntity, &sem);
+static void HTA_init(void) {
+    // Register the current thread as an ICall dispatcher application
+    // so that the application can send and receive messages.
+    ICall_registerApp(&self, &semaphore);

-#if defined( USE_FPGA )
-  // configure RF Core SMI Data Link
-  IOCPortConfigureSet(IOID_12, IOC_PORT_RFC_GPO0, IOC_STD_OUTPUT);
-  IOCPortConfigureSet(IOID_11, IOC_PORT_RFC_GPI0, IOC_STD_INPUT);
+    // Initialize GATT Client
+    VOID GATT_InitClient();

-  // configure RF Core SMI Command Link
-  IOCPortConfigureSet(IOID_10, IOC_IOCFG0_PORT_ID_RFC_SMI_CL_OUT, IOC_STD_OUTPUT);
-  IOCPortConfigureSet(IOID_9, IOC_IOCFG0_PORT_ID_RFC_SMI_CL_IN, IOC_STD_INPUT);
+    // Register to receive incoming ATT Indications or Notifications of attribute values.
+    GATT_RegisterForInd(self);

-  // configure RF Core tracer IO
-  IOCPortConfigureSet(IOID_8, IOC_PORT_RFC_TRC, IOC_STD_OUTPUT);
-#else // !USE_FPGA
-  #if defined( DEBUG_SW_TRACE )
-    // configure RF Core tracer IO
-    IOCPortConfigureSet(IOID_8, IOC_PORT_RFC_TRC, IOC_STD_OUTPUT | IOC_CURRENT_4MA | IOC_SLEW_ENABLE);
-  #endif // DEBUG_SW_TRACE
-#endif // USE_FPGA
+    // Register for GATT local events and ATT Responses pending for transmission.
+    GATT_RegisterForMsgs(self);

-  // Set device's Sleep Clock Accuracy
-  //HCI_EXT_SetSCACmd(40);
-
-#if defined( USE_RCOSC )
-  RCOSC_enableCalibration();
-#endif // USE_RCOSC
-
-  dispHandle = Display_open(Display_Type_LCD, NULL);
-
-  // Register for unprocessed HCI/Host event messages
-  GAP_RegisterForMsgs(selfEntity);
-
-  // Initialize GATT Client
-  VOID GATT_InitClient();
-
-  // Get build revision
-  VOID Util_buildRevision(&buildRev);
-
-#if !defined ( GATT_DB_OFF_CHIP )
-
-  #if defined ( GATT_QUAL )
-    VOID GATTQual_AddService( GATT_ALL_SERVICES ); // Includes GAP and GATT Services
-  #else
    // Add our services to GATT Server
-    VOID GGS_AddService( GATT_ALL_SERVICES );
-    VOID GATTServApp_AddService( GATT_ALL_SERVICES );
-    #if defined ( GATT_TEST )
-      VOID GATTTest_AddService( GATT_ALL_SERVICES );
-    #endif
-  #endif
+    GGS_AddService(GATT_ALL_SERVICES);
+    GATTServApp_AddService(GATT_ALL_SERVICES);

-  // Set device name
-  if ((buildRev.hostInfo & CENTRAL_CFG) && (buildRev.hostInfo & PERIPHERAL_CFG))
-  {
-    memcpy(deviceName, "TI BLE All", 10);
-  }
-  else if (buildRev.hostInfo & CENTRAL_CFG)
-  {
-    memcpy(deviceName, "TI BLE Central", 14);
-  }
-  else if (buildRev.hostInfo & PERIPHERAL_CFG)
-  {
-    memcpy(deviceName, "TI BLE Peripheral",  17);
-  }
-  else
-  {
-    memcpy(deviceName, "TI BLE Unknown",  14);
-  }
-
-  VOID GGS_SetParameter(GGS_DEVICE_NAME_ATT, strlen((char *)deviceName), deviceName);
-  VOID GGS_SetParameter(GGS_APPEARANCE_ATT, sizeof(uint16), (void*)&appearance);
-
-#endif // GATT_DB_OFF_CHIP
-
-  Display_print0(dispHandle, 0, 0, "TI BLEv2.0");
-  Display_print0(dispHandle, 1, 0, "HostTestApp");
-
-  // Display Host build configuration
-  if ((buildRev.hostInfo & CENTRAL_CFG) && (buildRev.hostInfo & PERIPHERAL_CFG))
-  {
-    Display_print0(dispHandle, 2, 0, "All");
-  }
-  else if ((buildRev.hostInfo & CENTRAL_CFG) &&
-           (buildRev.hostInfo & BROADCASTER_CFG))
-  {
-    Display_print0(dispHandle, 2, 0, "Cent+Bcast");
-  }
-  else if ((buildRev.hostInfo & PERIPHERAL_CFG) &&
-           (buildRev.hostInfo & OBSERVER_CFG))
-  {
-    Display_print0(dispHandle, 2, 0, "Peri+Observ");
-  }
-  else if (buildRev.hostInfo & CENTRAL_CFG)
-  {
-    Display_print0(dispHandle, 2, 0, "Central");
-  }
-  else if (buildRev.hostInfo & PERIPHERAL_CFG)
-  {
-    Display_print0(dispHandle, 2, 0, "Peripheral");
-  }
-  else
-  {
-    Display_print1(dispHandle, 2, 0, "Unknown build cfg %d", buildRev.hostInfo);
-  }
+    // Register for unprocessed HCI/Host event messages
+    GAP_RegisterForMsgs(self);
 }

-/*********************************************************************
- * @fn      HostTestApp_taskFxn
+/*
+ * @fn      HTA_main
 *
 * @brief   Application task entry point for the Host Test App.
 *
@@ -312,365 +199,340 @@ static void HostTestApp_init(void)
 *
 * @return  none
 */
-static void HostTestApp_taskFxn(UArg a0, UArg a1)
-{
-  // Initialize application
-  HostTestApp_init();
+static void HTA_main(UArg a0, UArg a1) {
+    // Initialize application
+    HTA_init();
+    HTA_util_init();
+    HTA_main_init();

-  // Application main loop
-  for (;;)
-  {
-    // Waits for a signal to the semaphore associated with the calling thread.
-    // Note that the semaphore associated with a thread is signaled when a
-    // message is queued to the message receive queue of the thread or when
-    // ICall_signal() function is called onto the semaphore.
-    ICall_Errno errno = ICall_wait(ICALL_TIMEOUT_FOREVER);
+    // Application main loop
+    for (;;) {
+        // Waits for a signal to the semaphore associated with the calling thread.
+        // Note that the semaphore associated with a thread is signaled when a
+        // message is queued to the message receive queue of the thread or when
+        // ICall_signal() function is called onto the semaphore.
+        ICall_Errno errno = ICall_wait(ICALL_TIMEOUT_FOREVER);

-    if (errno == ICALL_ERRNO_SUCCESS)
-    {
-      ICall_EntityID dest;
-      ICall_ServiceEnum src;
-      ICall_HciExtEvt *pMsg = NULL;
+        if (errno == ICALL_ERRNO_SUCCESS) {
+            ICall_EntityID    dest;
+            ICall_ServiceEnum src;
+            ICall_HciExtEvt * message = NULL;

-      if (ICall_fetchServiceMsg(&src, &dest,
-                                (void **)&pMsg) == ICALL_ERRNO_SUCCESS)
-      {
-        bool dealloc = true;
+            if (ICall_fetchServiceMsg(&src, &dest, (void **)&message) == ICALL_ERRNO_SUCCESS) {
+                bool dealloc = true;

-        if ((src == ICALL_SERVICE_CLASS_BLE) && (dest == selfEntity))
-        {
-          // Process incoming messages
-          switch (pMsg->hdr.event)
-          {
-            case HCI_GAP_EVENT_EVENT:
-              HostTestApp_processGapEvent(pMsg);
-              break;
+                if ((src == ICALL_SERVICE_CLASS_BLE) && (dest == self)) {
+                    // Process incoming messages
+                    switch (message->hdr.event) {
+                    case HCI_GAP_EVENT_EVENT:
+                        HTA_handle_gap_event(message);
+                        break;

-            default:
-              break;
-          }
+                    case GATT_MSG_EVENT:
+                        HTA_handle_att_event((gattMsgEvent_t *)message);
+                        break;
+
+                    case GAP_MSG_EVENT:
+                        break;
+                    }
+                }
+
+                if (dealloc && message) {
+                    ICall_freeMsg(message);
+                }
+            }
        }

-        if (dealloc == true)
-        {
-          ICall_freeMsg(pMsg);
+        if (event_flags > 0) {
+            HTA_event_call();
        }
-      }
    }
-  }
 }

-/*********************************************************************
- * @fn      HostTestApp_processGapEvent
+/*
+ * @fn      HTA_handle_gap_event
 *
 * @brief   Process an incoming GAP Event.
 *
- * @param   pMsg - message to process
+ * @param   message - message to process
 *
 * @return  none
 */
-static void HostTestApp_processGapEvent(ICall_HciExtEvt *pMsg)
-{
-  switch(pMsg->hdr.status)
-  {
-    case HCI_COMMAND_COMPLETE_EVENT_CODE:
-      {
-        hciEvt_CmdComplete_t *pkt = (hciEvt_CmdComplete_t *)pMsg;
+static void HTA_handle_gap_event(ICall_HciExtEvt *message) {
+    switch (message->hdr.status) {
+    case HCI_COMMAND_COMPLETE_EVENT_CODE: {
+        hciEvt_CmdComplete_t *pkt = (hciEvt_CmdComplete_t *)message;

-        if (lastAppOpcodeSent == pkt->cmdOpcode)
-        {
-          // app processes this as it was embedded msg to stack
+        if (lastAppOpcodeSent == pkt->cmdOpcode) {
+            // application processes this as it was embedded message to stack

-          // Reset last opcode sent
-          lastAppOpcodeSent = 0xFFFF;
+            // Reset last opcode sent
+            lastAppOpcodeSent = 0xFFFF;
+        } else {
+            osal_msg_hdr_t *msgHdr;
+            uint8           len;
+
+            msgHdr = (osal_msg_hdr_t *)message;
+            msgHdr--;  // Backup to the message header
+
+            len = (uint8)(msgHdr->len - sizeof(hciEvt_CmdComplete_t));
+
+            send_command_complete_event(HCI_COMMAND_COMPLETE_EVENT_CODE, pkt->cmdOpcode, len, pkt->pReturnParam);
        }
-        else
-        {
-          osal_msg_hdr_t *msgHdr;
-          uint8 len;
-
-          msgHdr = (osal_msg_hdr_t *)pMsg;
-          msgHdr--; // Backup to the msg header
-
-          len = (uint8)(msgHdr->len - sizeof ( hciEvt_CmdComplete_t ));
-
-          sendCommandCompleteEvent(HCI_COMMAND_COMPLETE_EVENT_CODE,
-                                   pkt->cmdOpcode, len, pkt->pReturnParam);
-        }
-      }
-      break;
+        break;
+    }

    case HCI_DISCONNECTION_COMPLETE_EVENT_CODE:
-      break;
+        break;

-    case HCI_COMMAND_STATUS_EVENT_CODE:
-      {
-        hciEvt_CommandStatus_t *pkt = (hciEvt_CommandStatus_t *)pMsg;
+    case HCI_COMMAND_STATUS_EVENT_CODE: {
+        hciEvt_CommandStatus_t *pkt = (hciEvt_CommandStatus_t *)message;

-        if (lastAppOpcodeSent == pkt->cmdOpcode)
-        {
-          // app processes this as it was embedded msg to stack
+        if (lastAppOpcodeSent == pkt->cmdOpcode) {
+            // app processes this as it was embedded msg to stack

-          // Reset last opcode sent
-          lastAppOpcodeSent = 0xFFFF;
+            // Reset last opcode sent
+            lastAppOpcodeSent = 0xFFFF;
+        } else if (pkt->cmdOpcode == HCI_LE_SET_PHY) {
+            send_command_status_event(HCI_COMMAND_STATUS_EVENT_CODE, pkt->cmdStatus, pkt->cmdOpcode);
        }
-        else if (pkt->cmdOpcode == HCI_LE_SET_PHY)
-        {
-          sendCommandStatusEvent(HCI_COMMAND_STATUS_EVENT_CODE, pkt->cmdStatus,
-                                 pkt->cmdOpcode);
+        break;
+    }
+
+    case HCI_LE_EVENT_CODE: {
+        HTA_handle_ble_event(message);
+        break;
+    }
+
+    case HCI_BLE_HARDWARE_ERROR_EVENT_CODE: {
+        AssertHandler(HAL_ASSERT_CAUSE_HARDWARE_ERROR, 0);
+        break;
+    }
+
+    case HCI_VE_EVENT_CODE: {
+        hciEvt_VSCmdComplete_t *pkt = (hciEvt_VSCmdComplete_t *)message;
+
+        if (lastAppOpcodeSent == pkt->cmdOpcode) {
+            // app processes this as it was embedded msg to stack
+
+            // Reset last opcode sent
+            lastAppOpcodeSent = 0xFFFF;
+        } else {
+            send_command_complete_event(HCI_VE_EVENT_CODE, pkt->cmdOpcode, pkt->length, pkt->pEventParam);
        }
-      }
-      break;
-
-    case HCI_LE_EVENT_CODE:
-      {
-        HostTestApp_processBLEEvent(pMsg);
-      }
-      break;
-
-    case HCI_BLE_HARDWARE_ERROR_EVENT_CODE:
-      {
-        AssertHandler(HAL_ASSERT_CAUSE_HARDWARE_ERROR,0);
-      }
-      break;
-
-    case HCI_VE_EVENT_CODE:
-      {
-        hciEvt_VSCmdComplete_t *pkt = (hciEvt_VSCmdComplete_t *)pMsg;
-
-        if (lastAppOpcodeSent == pkt->cmdOpcode)
-        {
-          // app processes this as it was embedded msg to stack
-
-          // Reset last opcode sent
-          lastAppOpcodeSent = 0xFFFF;
-        }
-        else
-        {
-          sendCommandCompleteEvent(HCI_VE_EVENT_CODE, pkt->cmdOpcode,
-                                   pkt->length, pkt->pEventParam);
-        }
-      }
-      break;
-
-    default:
-      break;
-  }
+        break;
+    }
+    }
 }

-/*********************************************************************
- * @fn      HostTestApp_processBLEEvent
+static void HTA_handle_att_event(gattMsgEvent_t *message) {
+    uint8_t method = message->method;
+
+    if (message->hdr.status == blePending) {
+        // pass
+    } else if ((method == ATT_READ_RSP) || (method == ATT_ERROR_RSP && message->msg.errorRsp.reqOpcode == ATT_READ_REQ)) {
+        // pass
+    } else if ((method == ATT_WRITE_RSP) || (method == ATT_ERROR_RSP && message->msg.errorRsp.reqOpcode == ATT_WRITE_REQ)) {
+        // pass
+    } else if (method == ATT_HANDLE_VALUE_NOTI) {
+#ifdef HTA_PIN_RS
+        if (!PIN_getInputValue(HTA_PIN_RS)) {
+#endif
+            attHandleValueNoti_t *att_notify = (attHandleValueNoti_t *)(&message->msg);
+            HTA_main_handle_notify(att_notify->len, att_notify->pValue);
+#ifdef HTA_PIN_RS
+        }
+#endif
+    }
+
+    // Free message. Needed only for ATT Protocol messages
+    GATT_bm_free(&message->msg, message->method);
+}
+
+/*
+ * @fn      HTA_handle_ble_event
 *
 * @brief   Process an incoming BLE Event.

- * @param   pMsg - message to process
+ * @param   message - message to process
 *
 * @return  None.
 */
-static void HostTestApp_processBLEEvent(ICall_HciExtEvt *pMsg)
-{
-  hciEvt_BLEPhyUpdateComplete_t *pEvt = (hciEvt_BLEPhyUpdateComplete_t *)pMsg;
-  uint8 event[HCI_PHY_UPDATE_COMPLETE_EVENT_LEN];
-  uint8 eventLen;
+static void HTA_handle_ble_event(ICall_HciExtEvt *message) {
+    hciEvt_BLEPhyUpdateComplete_t *pEvt = (hciEvt_BLEPhyUpdateComplete_t *)message;

-  switch (pEvt->BLEEventCode)
-  {
-    case HCI_BLE_PHY_UPDATE_COMPLETE_EVENT:
-      {
-        event[0] = HCI_BLE_PHY_UPDATE_COMPLETE_EVENT; // event code
-        event[1] = pEvt->status;                      // status
-        event[2] = LO_UINT16(pEvt->connHandle);       // connection handle (LSB)
-        event[3] = HI_UINT16(pEvt->connHandle);       // connection handle (MSB)
-        event[4] = pEvt->txPhy;                       // TX PHY
-        event[5] = pEvt->rxPhy;                       // RX PHY
+    uint8 event[HCI_PHY_UPDATE_COMPLETE_EVENT_LEN];
+    uint8 eventLen = 0;
+
+    switch (pEvt->BLEEventCode) {
+    case HCI_BLE_PHY_UPDATE_COMPLETE_EVENT: {
+        event[0] = HCI_BLE_PHY_UPDATE_COMPLETE_EVENT;  // event code
+        event[1] = pEvt->status;                       // status
+        event[2] = LO_UINT16(pEvt->connHandle);        // connection handle (LSB)
+        event[3] = HI_UINT16(pEvt->connHandle);        // connection handle (MSB)
+        event[4] = pEvt->txPhy;                        // TX PHY
+        event[5] = pEvt->rxPhy;                        // RX PHY

        eventLen = HCI_PHY_UPDATE_COMPLETE_EVENT_LEN;
-      }
-      break;
+        break;
+    }
+    }

-    default:
-      eventLen = 0;
-      break;
-  }
-
-  if (eventLen > 0)
-  {
-    // Send BLE Complete Event
-    sendBLECompleteEvent(eventLen, event);
-  }
+    if (eventLen) {
+        // Send BLE Complete Event
+        send_ble_complete_event(eventLen, event);
+    }
 }

-//*****************************************************************************
-// the function prototypes
-
-/*******************************************************************************
+/*
 * This generic function sends a Command Complete or a Vendor Specific Command
 * Complete Event to the Host.
 *
 */
-static void sendCommandCompleteEvent(uint8_t eventCode, uint16_t opcode,
-                                     uint8_t numParam, uint8_t *param)
-{
-  npiPkt_t *msg;
-  uint8_t   totalLength;
-  uint8_t   txLen = 0; // Length to transmit
+static void send_command_complete_event(uint8_t eventCode, uint16_t opcode, uint8_t numParam, uint8_t *param) {
+    npiPkt_t *msg;
+    uint8_t   totalLength;
+    uint8_t   txLen = 0;  // Length to transmit

-  // The initial length will be:
-  // OSAL message header(4) - not part of packet sent to HCI Host!
-  // Minimum Event Data: Packet Type(1) + Event Code(1) + Length(1)
-  // Return Parameters (0..N)
-  totalLength = sizeof(npiPkt_t) + HCI_EVENT_MIN_LENGTH + numParam;
+    // The initial length will be:
+    // OSAL message header(4) - not part of packet sent to HCI Host!
+    // Minimum Event Data: Packet Type(1) + Event Code(1) + Length(1)
+    // Return Parameters (0..N)
+    totalLength = sizeof(npiPkt_t) + HCI_EVENT_MIN_LENGTH + numParam;

-  // adjust the size of the event packet based on event code
-  // Note: If not a vendor specific event, then the event includes:
-  //       Command Complete Data: Number of HCI Commands Allowed(1) + Command Opcode(2)
-  // Note: If a vendor specific event, then the event includes:
-  //       Vendor Specific Command Complete Data: Vendor Specific Event Opcode(2)
-  totalLength += ( (eventCode != HCI_VE_EVENT_CODE)  ?
-                   HCI_CMD_COMPLETE_EVENT_LEN        :
-                   HCI_CMD_VS_COMPLETE_EVENT_LEN );
+    // adjust the size of the event packet based on event code
+    // Note: If not a vendor specific event, then the event includes:
+    //       Command Complete Data: Number of HCI Commands Allowed(1) + Command Opcode(2)
+    // Note: If a vendor specific event, then the event includes:
+    //       Vendor Specific Command Complete Data: Vendor Specific Event Opcode(2)
+    totalLength += ((eventCode != HCI_VE_EVENT_CODE) ? HCI_CMD_COMPLETE_EVENT_LEN : HCI_CMD_VS_COMPLETE_EVENT_LEN);

-  // allocate memory for OSAL hdr + packet
-  msg = (npiPkt_t *)ICall_allocMsg(totalLength);
-  if (msg)
-  {
-    // OSAL message event, status, and pointer to packet
-    msg->hdr.event  = HCI_EVENT_PACKET;
-    msg->hdr.status = 0xFF;
-    msg->pData      = (uint8*)(msg+1);
+    // allocate memory for OSAL hdr + packet
+    msg = (npiPkt_t *)ICall_allocMsg(totalLength);

-    // fill in Command Complete Event data
-    msg->pData[0] = HCI_EVENT_PACKET;
-    msg->pData[1] = eventCode;
+    if (msg) {
+        // OSAL message event, status, and pointer to packet
+        msg->hdr.event  = HCI_EVENT_PACKET;
+        msg->hdr.status = 0xFF;
+        msg->pData      = (uint8 *)(msg + 1);

-    txLen += 2;
+        // fill in Command Complete Event data
+        msg->pData[0] = HCI_EVENT_PACKET;
+        msg->pData[1] = eventCode;

-    // check if this isn't a vendor specific event
-    if ( eventCode != HCI_VE_EVENT_CODE )
-    {
-      msg->pData[2] = numParam + HCI_CMD_COMPLETE_EVENT_LEN;
-      msg->pData[3] = 1;// hciCtrlCmdToken;     // event parameter 1
-      msg->pData[4] = LO_UINT16( opcode ); // event parameter 2
-      msg->pData[5] = HI_UINT16( opcode ); // event parameter 2
+        txLen += 2;

-      txLen += 4;
+        // check if this isn't a vendor specific event
+        if (eventCode != HCI_VE_EVENT_CODE) {
+            msg->pData[2] = numParam + HCI_CMD_COMPLETE_EVENT_LEN;
+            msg->pData[3] = 1;                  // hciCtrlCmdToken;     // event parameter 1
+            msg->pData[4] = LO_UINT16(opcode);  // event parameter 2
+            msg->pData[5] = HI_UINT16(opcode);  // event parameter 2

-      // remaining event parameters
-      (void)memcpy(&msg->pData[6], param, numParam);
+            txLen += 4;

-      txLen += numParam;
+            // remaining event parameters
+            (void)memcpy(&msg->pData[6], param, numParam);
+
+            txLen += numParam;
+
+        } else {  // it is a vendor specific event
+            // less one byte as number of complete packets not used in vendor specific event
+            msg->pData[2] = numParam + HCI_CMD_VS_COMPLETE_EVENT_LEN;
+            msg->pData[3] = param[0];           // event parameter 0: event opcode LSB
+            msg->pData[4] = param[1];           // event parameter 1: event opcode MSB
+            msg->pData[5] = param[2];           // event parameter 2: status
+            msg->pData[6] = LO_UINT16(opcode);  // event parameter 3: command opcode LSB
+            msg->pData[7] = HI_UINT16(opcode);  // event parameter 3: command opcode MSB
+
+            txLen += 6;
+
+            // remaining event parameters
+            // Note: The event opcode and status were already placed in the msg packet.
+            (void)memcpy(&msg->pData[8], &param[3], numParam - HCI_EVENT_MIN_LENGTH);
+
+            txLen += (numParam - HCI_EVENT_MIN_LENGTH);
+        }
+
+        msg->pktLen = txLen;
+
+        NPITask_sendToHost((uint8_t *)msg);
    }
-    else // it is a vendor specific event
-    {
-      // less one byte as number of complete packets not used in vendor specific event
-      msg->pData[2] = numParam + HCI_CMD_VS_COMPLETE_EVENT_LEN;
-      msg->pData[3] = param[0];            // event parameter 0: event opcode LSB
-      msg->pData[4] = param[1];            // event parameter 1: event opcode MSB
-      msg->pData[5] = param[2];            // event parameter 2: status
-      msg->pData[6] = LO_UINT16( opcode ); // event parameter 3: command opcode LSB
-      msg->pData[7] = HI_UINT16( opcode ); // event parameter 3: command opcode MSB
-
-      txLen += 6;
-
-      // remaining event parameters
-      // Note: The event opcode and status were already placed in the msg packet.
-      (void)memcpy(&msg->pData[8], &param[3], numParam-HCI_EVENT_MIN_LENGTH);
-
-      txLen += (numParam-HCI_EVENT_MIN_LENGTH);
-    }
-
-    msg->pktLen = txLen;
-
-    NPITask_sendToHost((uint8_t *)msg);
-  }
 }

-/*******************************************************************************
+/*
 * This generic function sends a Command Complete or a Vendor Specific Command
 * Complete Event to the Host.
 *
 */
-static void sendCommandStatusEvent(uint8_t eventCode, uint16_t status,
-                                   uint16_t opcode)
-{
-  npiPkt_t *msg;
-  uint8_t   totalLength;
+static void send_command_status_event(uint8_t eventCode, uint16_t status, uint16_t opcode) {
+    npiPkt_t *msg;
+    uint8_t   totalLength;

-  // The initial length will be:
-  // OSAL message header(4) - not part of packet sent to HCI Host!
-  // Minimum Event Data: Packet Type(1) + Event Code(1) + Length(1)
-  // Command Status Event Data: Status (1) + Num HCI Cmd Pkt (1) + Cmd Opcode (2)
-  totalLength = sizeof(npiPkt_t)     +
-                HCI_EVENT_MIN_LENGTH +
-                HCI_CMD_STATUS_EVENT_LEN;
+    // The initial length will be:
+    // OSAL message header(4) - not part of packet sent to HCI Host!
+    // Minimum Event Data: Packet Type(1) + Event Code(1) + Length(1)
+    // Command Status Event Data: Status (1) + Num HCI Cmd Pkt (1) + Cmd Opcode (2)
+    totalLength = sizeof(npiPkt_t) + HCI_EVENT_MIN_LENGTH + HCI_CMD_STATUS_EVENT_LEN;

-  // allocate memory for OSAL hdr + packet
-  msg = (npiPkt_t *)ICall_allocMsg(totalLength);
-  if (msg)
-  {
-    // OSAL message event, status, and pointer to packet
-    msg->hdr.event  = HCI_EVENT_PACKET;
-    msg->hdr.status = 0xFF;
+    // allocate memory for OSAL hdr + packet
+    msg = (npiPkt_t *)ICall_allocMsg(totalLength);
+    if (msg) {
+        // OSAL message event, status, and pointer to packet
+        msg->hdr.event  = HCI_EVENT_PACKET;
+        msg->hdr.status = 0xFF;

-    // fill in length and data pointer
-    msg->pktLen = HCI_EVENT_MIN_LENGTH + HCI_CMD_STATUS_EVENT_LEN;
-    msg->pData  = (uint8*)(msg+1);
+        // fill in length and data pointer
+        msg->pktLen = HCI_EVENT_MIN_LENGTH + HCI_CMD_STATUS_EVENT_LEN;
+        msg->pData  = (uint8 *)(msg + 1);

-    // fill in Command Complete Event data
-    msg->pData[0] = HCI_EVENT_PACKET;
-    msg->pData[1] = eventCode;
-    msg->pData[2] = HCI_CMD_STATUS_EVENT_LEN;
-    msg->pData[3] = status;
-    msg->pData[4] = 1;                 // number of HCI command packets
-    msg->pData[5] = LO_UINT16(opcode); // opcode (LSB)
-    msg->pData[6] = HI_UINT16(opcode); // opcode (MSB)
+        // fill in Command Complete Event data
+        msg->pData[0] = HCI_EVENT_PACKET;
+        msg->pData[1] = eventCode;
+        msg->pData[2] = HCI_CMD_STATUS_EVENT_LEN;
+        msg->pData[3] = status;
+        msg->pData[4] = 1;                  // number of HCI command packets
+        msg->pData[5] = LO_UINT16(opcode);  // opcode (LSB)
+        msg->pData[6] = HI_UINT16(opcode);  // opcode (MSB)

-    NPITask_sendToHost((uint8_t *)msg);
-  }
-}
-
-/*******************************************************************************
- * This is a generic function used to send BLE Complete Event to the
- * Host processor.
- *
- */
-static void sendBLECompleteEvent(uint8 eventLen, uint8 *pEvent)
-{
-  npiPkt_t *msg;
-  uint8_t   totalLength;
-
-  // The initial length will be:
-  // OSAL message header(4) - not part of packet sent to HCI Host!
-  // Minimum Event Data: Packet Type(1) + Event Code(1) + Length(1)
-  // Event Data: eventLen
-  totalLength = sizeof(npiPkt_t) + HCI_EVENT_MIN_LENGTH + eventLen;
-
-  // allocate memory for OSAL hdr + packet
-  msg = (npiPkt_t *)ICall_allocMsg(totalLength);
-  if (msg)
-  {
-    // OSAL message event, status, and pointer to packet
-    msg->hdr.event  = HCI_EVENT_PACKET;
-    msg->hdr.status = 0xFF;
-
-    // fill in length and data pointer
-    msg->pktLen = HCI_EVENT_MIN_LENGTH + eventLen;
-    msg->pData  = (uint8*)(msg+1);
-
-    // fill in BLE Complete Event data
-    msg->pData[0] = HCI_EVENT_PACKET;
-    msg->pData[1] = HCI_LE_EVENT_CODE;
-    msg->pData[2] = eventLen;
-
-    // populate event data
-    if (eventLen > 0)
-    {
-      memcpy(&msg->pData[3], pEvent, eventLen);
+        NPITask_sendToHost((uint8_t *)msg);
    }
-
-    NPITask_sendToHost((uint8_t *)msg);
-  }
 }

-/*********************************************************************
-*********************************************************************/
+/*
+ * This is a generic function used to send BLE Complete Event to the Host processor.
+ */
+static void send_ble_complete_event(uint8 eventLen, uint8 *pEvent) {
+    npiPkt_t *msg;
+    uint8_t   totalLength;
+
+    // The initial length will be:
+    // OSAL message header(4) - not part of packet sent to HCI Host!
+    // Minimum Event Data: Packet Type(1) + Event Code(1) + Length(1)
+    // Event Data: eventLen
+    totalLength = sizeof(npiPkt_t) + HCI_EVENT_MIN_LENGTH + eventLen;
+
+    // allocate memory for OSAL hdr + packet
+    msg = (npiPkt_t *)ICall_allocMsg(totalLength);
+    if (msg) {
+        // OSAL message event, status, and pointer to packet
+        msg->hdr.event  = HCI_EVENT_PACKET;
+        msg->hdr.status = 0xFF;
+
+        // fill in length and data pointer
+        msg->pktLen = HCI_EVENT_MIN_LENGTH + eventLen;
+        msg->pData  = (uint8 *)(msg + 1);
+
+        // fill in BLE Complete Event data
+        msg->pData[0] = HCI_EVENT_PACKET;
+        msg->pData[1] = HCI_LE_EVENT_CODE;
+        msg->pData[2] = eventLen;
+
+        // populate event data
+        if (eventLen > 0) {
+            memcpy(&msg->pData[3], pEvent, eventLen);
+        }
+
+        NPITask_sendToHost((uint8_t *)msg);
+    }
+}
@@ -9,7 +9,7 @@
 Target Device: CC2650, CC2640

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

@@ -49,37 +49,16 @@
 #define HOSTESTAPP_H

 #ifdef __cplusplus
-extern "C"
-{
+extern "C" {
 #endif

-/*********************************************************************
- * INCLUDES
- */
-
-/*********************************************************************
- * CONSTANTS
- */
-
-/*********************************************************************
- * MACROS
- */
-
-/*********************************************************************
- * FUNCTIONS
- */
-
 /*
 * Task creation function for the Host Test App.
 */
 extern void HostTestApp_createTask(void);

-
-/*********************************************************************
-*********************************************************************/
-
 #ifdef __cplusplus
 }
 #endif

-#endif /* HOSTESTAPP_H */
+#endif
@@ -8,7 +8,7 @@
 Target Device: CC2650, CC2640

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

@@ -44,26 +44,29 @@
 Release Date: 2018-04-02 18:03:35
 *****************************************************************************/

-/*******************************************************************************
- * INCLUDES
- */
-
 #include <xdc/runtime/Error.h>
+
 #include <ti/drivers/Power.h>
+
 #include <ti/drivers/power/PowerCC26XX.h>
+
 #include <ti/sysbios/BIOS.h>

-#include "icall.h"
-#include "hal_assert.h"
 #include "board.h"
+
+#include "hal_assert.h"
+
+#include "icall.h"
+
 #include "inc/npi_task.h"

 #include "host_test_app.h"

 /* Header files required to enable instruction fetch cache */
-#include <inc/hw_memmap.h>
 #include <driverlib/vims.h>

+#include <inc/hw_memmap.h>
+
 #ifndef USE_DEFAULT_USER_CFG

 #include "ble_user_config.h"
@@ -71,70 +74,12 @@
 // BLE user defined configuration
 bleUserCfg_t user0Cfg = BLE_USER_CFG;

-#endif // USE_DEFAULT_USER_CFG
+#endif  // USE_DEFAULT_USER_CFG

-#include <ti/mw/display/Display.h>
-
-#ifdef USE_FPGA
-#include <inc/hw_prcm.h>
-#endif // USE_FPGA
-
-/*******************************************************************************
- * MACROS
- */
-
-/*******************************************************************************
- * CONSTANTS
- */
-
-#if defined( USE_FPGA )
-  #define RFC_MODE_BLE                 PRCM_RFCMODESEL_CURR_MODE1
-  #define RFC_MODE_ANT                 PRCM_RFCMODESEL_CURR_MODE4
-  #define RFC_MODE_EVERYTHING_BUT_ANT  PRCM_RFCMODESEL_CURR_MODE5
-  #define RFC_MODE_EVERYTHING          PRCM_RFCMODESEL_CURR_MODE6
-  //
-  #define SET_RFC_BLE_MODE(mode) HWREG( PRCM_BASE + PRCM_O_RFCMODESEL ) = (mode)
-#endif // USE_FPGA
-
-/*******************************************************************************
- * TYPEDEFS
- */
-
-/*******************************************************************************
- * LOCAL VARIABLES
- */
-
-/*******************************************************************************
- * GLOBAL VARIABLES
- */
-
-#ifdef CC1350_LAUNCHXL
-#ifdef POWER_SAVING
-// Power Notify Object for wake-up callbacks
-Power_NotifyObj rFSwitchPowerNotifyObj;
-static uint8_t rFSwitchNotifyCb(uint8_t eventType, uint32_t *eventArg,
-                                uint32_t *clientArg);
-#endif //POWER_SAVING
-
-PIN_State  radCtrlState;
-PIN_Config radCtrlCfg[] =
-{
-  Board_DIO1_RFSW   | PIN_GPIO_OUTPUT_EN | PIN_GPIO_LOW  | PIN_PUSHPULL | PIN_DRVSTR_MAX, /* RF SW Switch defaults to 2.4GHz path*/
-  Board_DIO30_SWPWR | PIN_GPIO_OUTPUT_EN | PIN_GPIO_HIGH | PIN_PUSHPULL | PIN_DRVSTR_MAX, /* Power to the RF Switch */
-  PIN_TERMINATE
-};
-PIN_Handle radCtrlHandle;
-#endif //CC1350_LAUNCHXL
-
-/*******************************************************************************
- * EXTERNS
- */

 extern void AssertHandler(uint8 assertCause, uint8 assertSubcause);

-extern Display_Handle dispHandle;
-
-/*******************************************************************************
+/*
 * @fn          Main
 *
 * @brief       Application Main
@@ -149,68 +94,38 @@ extern Display_Handle dispHandle;
 *
 * @return      None.
 */
-int main()
-{
-#if defined( USE_FPGA )
-  HWREG(PRCM_BASE + PRCM_O_PDCTL0) &= ~PRCM_PDCTL0_RFC_ON;
-  HWREG(PRCM_BASE + PRCM_O_PDCTL1) &= ~PRCM_PDCTL1_RFC_ON;
-#endif // USE_FPGA
+int main() {

-  /* Register Application callback to trap asserts raised in the Stack */
-  RegisterAssertCback(AssertHandler);
+    /* Register Application callback to trap asserts raised in the Stack */
+    RegisterAssertCback(AssertHandler);

-  PIN_init(BoardGpioInitTable);
+    PIN_init(BoardGpioInitTable);

-#ifdef CC1350_LAUNCHXL
-  // Enable 2.4GHz Radio
-  radCtrlHandle = PIN_open(&radCtrlState, radCtrlCfg);
+    // Enable iCache prefetching
+    VIMSConfigure(VIMS_BASE, TRUE, TRUE);

-#ifdef POWER_SAVING
-  Power_registerNotify(&rFSwitchPowerNotifyObj,
-                       PowerCC26XX_ENTERING_STANDBY | PowerCC26XX_AWAKE_STANDBY,
-                       (Power_NotifyFxn) rFSwitchNotifyCb, NULL);
-#endif //POWER_SAVING
-#endif //CC1350_LAUNCHXL
+    // Enable cache
+    VIMSModeSet(VIMS_BASE, VIMS_MODE_ENABLED);

-#if defined( USE_FPGA )
-  // set RFC mode to support BLE
-  // Note: This must be done before the RF Core is released from reset!
-  SET_RFC_BLE_MODE(RFC_MODE_BLE);
-#endif // USE_FPGA
+    /* Initialize ICall module */
+    ICall_init();

-  // Enable iCache prefetching
-  VIMSConfigure(VIMS_BASE, TRUE, TRUE);
+    /* Start tasks of external images */
+    ICall_createRemoteTasks();

-  // Enable cache
-  VIMSModeSet(VIMS_BASE, VIMS_MODE_ENABLED);
+    /* Kick off application */
+    HostTestApp_createTask();

-#if !defined( POWER_SAVING ) || defined( USE_FPGA )
-  /* Set constraints for Standby, powerdown and idle mode */
-  // PowerCC26XX_SB_DISALLOW may be redundant
-  Power_setConstraint(PowerCC26XX_SB_DISALLOW);
-  Power_setConstraint(PowerCC26XX_IDLE_PD_DISALLOW);
-#endif // POWER_SAVING | USE_FPGA
+    /* Kick off NPI */
+    NPITask_createTask(ICALL_SERVICE_CLASS_BLE);

-  /* Initialize ICall module */
-  ICall_init();
+    /* enable interrupts and start SYS/BIOS */
+    BIOS_start();

-  /* Start tasks of external images */
-  ICall_createRemoteTasks();
-
-  /* Kick off application */
-  HostTestApp_createTask();
-
-  /* Kick off NPI */
-  NPITask_createTask(ICALL_SERVICE_CLASS_BLE);
-
-  /* enable interrupts and start SYS/BIOS */
-  BIOS_start();
-
-  return 0;
+    return 0;
 }

-
-/*******************************************************************************
+/*
 * @fn          AssertHandler
 *
 * @brief       This is the Application's callback handler for asserts raised
@@ -246,57 +161,9 @@ int main()
 *
 * @return      None.
 */
-void AssertHandler(uint8 assertCause, uint8 assertSubcause)
-{
-  // Open the display if the app has not already done so
-  if ( !dispHandle )
-  {
-    dispHandle = Display_open(Display_Type_LCD, NULL);
-  }
+void AssertHandler(uint8 assertCause, uint8 assertSubcause) {}

-  Display_print0(dispHandle, 0, 0, ">>>STACK ASSERT");
-
-  // check the assert cause
-  switch (assertCause)
-  {
-    // This assert is raised from the BLE Stack when a malloc failure occurs.
-    case HAL_ASSERT_CAUSE_OUT_OF_MEMORY:
-      Display_print0(dispHandle, 0, 0, "***ERROR***");
-      Display_print0(dispHandle, 2, 0, ">> OUT OF MEMORY!");
-      break;
-
-    case HAL_ASSERT_CAUSE_INTERNAL_ERROR:
-      // check the subcause
-      if (assertSubcause == HAL_ASSERT_SUBCAUSE_FW_INERNAL_ERROR)
-      {
-        Display_print0(dispHandle, 0, 0, "***ERROR***");
-        Display_print0(dispHandle, 2, 0, ">> INTERNAL FW ERROR!");
-      }
-      else
-      {
-        Display_print0(dispHandle, 0, 0, "***ERROR***");
-        Display_print0(dispHandle, 2, 0, ">> INTERNAL ERROR!");
-      }
-      break;
-
-    // An assert originating from an ICall failure.
-    case HAL_ASSERT_CAUSE_ICALL_ABORT:
-      Display_print0(dispHandle, 0, 0, "***ERROR***");
-      Display_print0(dispHandle, 2, 0, ">> ICALL ABORT!");
-      HAL_ASSERT_SPINLOCK;
-      break;
-
-    default:
-      Display_print0(dispHandle, 0, 0, "***ERROR***");
-      Display_print0(dispHandle, 2, 0, ">> DEFAULT SPINLOCK!");
-      HAL_ASSERT_SPINLOCK;
-  }
-
-  return;
-}
-
-
-/*******************************************************************************
+/*
 * @fn          exceptionHandler
 *
 * @brief       Generic spinlock to trap RTOS raised errors.
@@ -311,13 +178,11 @@ void AssertHandler(uint8 assertCause, uint8 assertSubcause)
 *
 * @return      None.
 */
-void exceptionHandler( void )
-{
-  volatile uint8 i = 1;
-  while(i);
+void exceptionHandler(void) {
+     for (;;);
 }

-/*******************************************************************************
+/*
 * @fn          smallErrorHook
 *
 * @brief       Error handler to be hooked into TI-RTOS.
@@ -332,45 +197,6 @@ void exceptionHandler( void )
 *
 * @return      None.
 */
-void smallErrorHook(Error_Block *eb)
-{
-  for (;;);
+void smallErrorHook(Error_Block *eb) {
+    for (;;);
 }
-
-#if defined (CC1350_LAUNCHXL) && defined (POWER_SAVING)
-/*******************************************************************************
- * @fn          rFSwitchNotifyCb
- *
- * @brief       Power driver callback to toggle RF switch on Power state
- *              transitions.
- *
- * input parameters
- *
- * @param   eventType - The state change.
- * @param   eventArg  - Not used.
- * @param   clientArg - Not used.
- *
- * @return  Power_NOTIFYDONE to indicate success.
- */
-static uint8_t rFSwitchNotifyCb(uint8_t eventType, uint32_t *eventArg,
-                                uint32_t *clientArg)
-{
-  if (eventType == PowerCC26XX_ENTERING_STANDBY)
-  {
-    // Power down RF Switch
-    PIN_setOutputValue(radCtrlHandle, Board_DIO30_SWPWR, 0);
-  }
-  else if (eventType == PowerCC26XX_AWAKE_STANDBY)
-  {
-    // Power up RF Switch
-    PIN_setOutputValue(radCtrlHandle, Board_DIO30_SWPWR, 1);
-  }
-
-  // Notification handled successfully
-  return Power_NOTIFYDONE;
-}
-#endif //CC1350_LAUNCHXL || POWER_SAVING
-
-
-/*******************************************************************************
- */
@@ -0,0 +1,179 @@
+{
+  "name": "Elite-ZM",
+  "version": "1.2.30",
+  "match_rule": {
+    "local_name_pattern": "Elite-ZM.+",
+    "major_product_number": 0,
+    "minor_product_number": 2,
+    "major_version_number": 1,
+    "minor_version_number": 2
+  },
+  "constant": {
+    "ADC_CHANNEL_NUMBER": [
+      12,
+      13,
+      14,
+      15
+    ],
+    "VOLT_MAX": 4095
+  },
+  "parameters": {
+    "CHANNEL": {
+      "description": "record channels",
+      "record_meta": true,
+      "domain": "property",
+      "value": [
+        0,
+        1,
+        2
+      ]
+    },
+    "SAMPLE_RATE": {
+      "description": "data sampling rate",
+      "record_meta": true,
+      "domain": "constant",
+      "value": 1
+    },
+    "AMP_GAIN": {
+      "description": "amp gain",
+      "record_meta": true,
+      "domain": "constant",
+      "value": 1
+    },
+    "MODE": {
+      "description": "working mode",
+      "value": [
+        "I-V Curve",
+        "Cyclic Voltammetry",
+        "Function Generator",
+        "Z-T Curve",
+        "V-T Curve",
+        "I-T Curve",
+        "ADC test"
+      ]
+    },
+    "VOLT_ORIGIN": {
+      "description": "Origin Voltage of Scan",
+      "domain": [
+        "VOLT_MAX"
+      ]
+    },
+    "VOLT_FINAL": {
+      "description": "The last Voltage of Scan",
+      "domain": [
+        "VOLT_MAX"
+      ],
+      "value": "1365 * VALUE"
+    },
+    "VOLT_STEP": {
+      "description": "Voltage Step",
+      "domain": [
+        5
+      ]
+    },
+    "STEP_TIME": {
+      "description": "How much time between two step",
+      "domain": [
+        4
+      ]
+    },
+    "DAC_VOLT": {
+      "description": "DAC output Voltage",
+      "domain": [
+        "VOLT_MAX"
+      ]
+    },
+    "ADC_CHANNEL": {
+      "description": "read ADC data",
+      "value": [
+        "ANA0",
+        "ANA1",
+        "ANA2",
+        "ANA3"
+      ]
+    }
+  },
+  "instruction": {
+    "start": [
+      {
+        "expression": "MODE",
+        "when": {
+          "0": "curve_iv",
+          "1": "curve_cv",
+          "2": "func_gen",
+          "6": "adc_test"
+        }
+      }
+    ],
+    "data_format": [
+      "_data_format('TDC4VAF2')"
+    ],
+    "curve_iv": [
+      "data_format",
+      "_notify(True)",
+      "curve_iv0",
+      "_sync(True)",
+      "VIS_STI"
+    ],
+    "curve_iv0": {
+      "type": "RIS",
+      "parameter": {
+        "va": "(VOLT_ORIGIN + 1) * 0x0010",
+        "vb": "(VOLT_FINAL + 1) * 0x0010",
+        "dv": "VOLT_STEP * 0x40",
+        "dt": "STEP_TIME * 0x12"
+      },
+      "data": [
+        "1X10;2B>va;2B>vb;B>dv;B>dt"
+      ]
+    },
+    "curve_cv": [
+      "data_format",
+      "_notify(True)",
+      "curve_cv0",
+      "_sync(True)",
+      "VIS_STI"
+    ],
+    "curve_cv0": {
+      "type": "RIS",
+      "parameter": {
+        "va": "(VOLT_ORIGIN + 1) * 0x0010",
+        "vb": "(VOLT_FINAL + 1) * 0x0010",
+        "dv": "VOLT_STEP * 0x40",
+        "dt": "STEP_TIME * 0x12"
+      },
+      "data": [
+        "1X20;2B>va;2B>vb;B>dv;B>dt"
+      ]
+    },
+    "func_gen": [
+      "data_format",
+      "func_gen0",
+      "VIS_STI"
+    ],
+    "func_gen0": {
+      "type": "RIS",
+      "parameter": {
+        "v": "(DAC_VOLT + 1) * 0x0010"
+      },
+      "data": [
+        "X30;X30;2B>v"
+      ]
+    },
+    "adc_test": [
+      "data_format",
+      "_notify(True)",
+      "adc_test0",
+      "_sync(True)",
+      "VIS_STI"
+    ],
+    "adc_test0": {
+      "type": "RIS",
+      "data": [
+        "X90;B>ADC_CHANNEL"
+      ]
+    }
+  }
+}
+
+
@@ -0,0 +1,227 @@
+
+#ifndef EliteADC
+#define EliteADC
+
+#include "Elite_PIN.h"
+#include "EliteSPI.h"
+#include "EliteNotify.h"
+
+
+// Elite ADC macro
+// ADC command, Elite will use these cmd to control ADC
+#define CMD_CURRENT_MEASURE 0xC5
+#define CMD_VOLT_MEASURE    0xD5
+#define CMD_DAC_MEASURE     0xE5
+#define CMD_BATTERY_MEASURE 0xF5
+
+// controller command, these are command from control box
+#define ADC_CH_CURRENT      0x00
+#define ADC_CH_VOLT         0x01
+#define ADC_CH_DAC          0x02
+#define ADC_CH_BAT          0x03
+
+static void ADC_write(uint8_t ADCin) {
+   /*
+    *   This function can only define [15]~[8] through ADCin
+    *   [7]~[0] should always be 0b11101011
+    *
+    *   [15]        : SS, 0 = no effect, 1 = start work, default 0b0
+    *   [14]~[12]   : MUX[2:0], default 0b000
+    *   [11]~[9]    : PGA[2:0], default 0b010 = FSR is ±2.048
+    *   [8]         : mode, 0 = continuous, 1 = one shot, default 0b1 (Power-down and single-shot mode )
+    *
+    *   [7]~[5]     : data rate, default 0b100 = 128 SPS
+    *   [4]         : Temperature? default 0b0 = ADC mode
+    *   [3]         : Pullup enable, default 0b1 = Pullup resistor enabled
+    *   [2]~[1]     : NOP, default 0b01
+    *   [0]         : reserved, default 0b1
+    *
+    */
+
+//    spi_ADC_txbuf[0] = 0b00000101;
+    for(int i=0 ; i<SPI_ADC_SIZE ; i++){
+        spi_ADC_txbuf[i] = 0;
+        spi_ADC_rxbuf[i] = 0;
+    }
+
+    spi_ADC_txbuf[0] = ADCin;
+    spi_ADC_txbuf[1] = 0b11101011;
+
+
+    ADC_SPI(2, spi_ADC_txbuf, spi_ADC_rxbuf);
+}
+
+static void ADC_read(uint8_t *ADCdata){
+    for(int i=0 ; i<SPI_ADC_SIZE ; i++){
+        spi_ADC_txbuf[i] = 0;
+        spi_ADC_rxbuf[i] = 0;
+    }
+
+    ADC_SPI(SPI_ADC_SIZE, spi_ADC_txbuf, ADCdata);
+}
+
+static void ADCGainControl(uint8_t ADCLevel){
+    if(ADCLevel == 0){
+        // ADC gain level = 0, using 200R resister
+        PIN_setOutputValue(pin_handle, Turnon10K, 0);
+        PIN_setOutputValue(pin_handle, Turnon100R, 0);
+    }
+    else if(ADCLevel == 1){
+        // ADC gain level = 1, using 10K resister
+        PIN_setOutputValue(pin_handle, Turnon10K, 1);
+        PIN_setOutputValue(pin_handle, Turnon100R, 0);
+    }
+    else if(ADCLevel == 2){
+        // ADC gain level = 2, using 100R resister
+        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);
+        PIN_setOutputValue(pin_handle, Turnon100R, 0);
+    }
+}
+
+
+static void ADCChannelSelect(uint8_t ADCChannel){
+    // set ADC parameter
+    // 0xC1~F1 = reading AIN0~AIN3. Using FSR+-6V, resolution = 187.5uV
+    // 0xC5~F5 = reading AIN0~AIN3. Using FSR+-2V, resolution = 62.5 uV
+    switch(ADCChannel){
+        // AINp is AIN0; AINn is GND
+        // measure AIN0, which is a current measure
+        case ADC_CH_CURRENT :{
+            ADC_write(CMD_CURRENT_MEASURE);
+            break;
+        }
+
+        // AINp is AIN1; AINn is GND
+        // AIN1, which is a volt measure
+        case ADC_CH_VOLT :{
+            ADC_write(CMD_VOLT_MEASURE);
+            break;
+        }
+
+        // AINp is AIN2; AINn is GND
+        // AIN2, measure DAC voltage (Note that this is NOT DAC real output value!!)
+        case ADC_CH_DAC :{
+            ADC_write(CMD_DAC_MEASURE);
+            break;
+        }
+
+        // measure battery volt
+        case ADC_CH_BAT :{
+            ADC_write(CMD_BATTERY_MEASURE);
+            break;
+        }
+        default :{
+            break;
+        }
+    }
+}
+
+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
@@ -0,0 +1,232 @@
+
+#ifndef ELITECCMODE
+#define ELITECCMODE
+
+static void CCModeDACControl(int32_t IUC_Measure_Difference);
+
+static int32_t CCModeReadCurrent(CCMode *CC){
+
+    static uint8_t VoltCurrentSwitch = 0;
+
+    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
+
+    // Use 9-th measure value as real-measure value
+    // because some value in the begin are garbage
+    if(VoltCurrentSwitch < 9){
+        ReadCurrent(spi_ADC_rxbuf);
+        VoltCurrentSwitch ++;
+    }
+    else if(VoltCurrentSwitch == 9){
+        // read current
+        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);
+        }
+        VoltCurrentSwitch ++;
+    }
+    else if(VoltCurrentSwitch <18){
+        // read volt
+        ReadVolt(spi_ADC_rxbuf);
+        VoltCurrentSwitch++;
+    }
+    else if(VoltCurrentSwitch == 18){
+        // read volt
+        ReadVolt(spi_ADC_rxbuf);
+        CC->BatteryV = DecodeADCValue(INSTRUCTION.ADCGainLevel, ADC_CH_VOLT, spi_ADC_rxbuf);
+
+        // if Iin connect to battery +, Vout connect to battery -
+//        CC->BatteryV = CC->BatteryV - (CC->value - CC_ZERO_POINT)*10/1e5;   // I_set * 10R = V_Iin2GND (mA * ohm)
+
+        // if Iin connect to battery -, Vout connect to battery +
+        CC->BatteryV = CC->BatteryV + (CC->value - CC_ZERO_POINT)*10/1e5;   // I_set * 10R = V_Iin2GND (mA * ohm)
+
+        VoltCurrentSwitch++;
+    }
+    else{
+        VoltCurrentSwitch = 0;
+    }
+
+
+//    /** 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);
+//
+    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{
+//        CC->BatteryV = 2*(INSTRUCTION.VoltConstant - 25000)/10 - IUCCurrent*200/1e7;
+//    }
+
+//    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);
+
+    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));
+}
+
+// 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
@@ -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
@@ -0,0 +1,65 @@
+
+#ifndef EliteDAC
+#define EliteDAC
+
+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_4
+#define DACCLS 0x02
+#define DACOUT 0x31
+
+static uint16_t DAC_outputV(uint16_t voltLV) {
+    // C = command, X = don't care, D = data
+    // CCCC CCCC = command
+    // DDDD DDDD = v1
+    // DDDD DDDD = v2
+
+    // command
+    // 0x02 = clear
+    // 0x31 = output voltage
+
+    uint8_t v1, v2 = 0;
+    v1 = (uint8_t) ((voltLV & 0xFF00) >> 8);
+    v2 = (uint8_t) (voltLV & 0x00FF);
+
+    spi_DACtxbuf[0] = DACOUT;
+    spi_DACtxbuf[1] = v1;
+    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
@@ -0,0 +1,789 @@
+#ifndef EliteCorrection
+#define EliteCorrection
+
+#include "EliteDAC.h"
+#include "EliteADC.h"
+
+
+
+/*
+*   Correction Array include all the correction coeff and offset
+*
+*   Correction formula format is " RealValue = coeff * code + offset "
+*   RealValue can be RealCurrent, RealVolt, or RealResister ...
+*   code is the code we read from ADC buffer
+*
+*   ADC measure Voltage
+*   RealVolt = Correction.ADC_volt.coeff * code + Correction.ADC_volt.offset
+*
+*   ADC measure Current
+*   ADCGain:  0 => 200k, 1 => 10k, 2 => 200R
+*   RealCurrent = Correction.ADC_current[ADCGain].coeff * code + Correction.ADC_current[ADCGain].offset
+*
+*   DAC output Voltage
+*   RealVolt = Correction.DAC2RealV.coeff * DACcode + Correction.DAC2RealV.offset
+*
+*   Usercode to DACcode
+*   DACcode = Correction.Usercode2DAC.coeff * code + Correction.Usercode2DAC.offset
+*
+*/
+
+
+#define BOARD_MERCURY
+
+typedef struct _formula{
+
+    long long coeff;
+    long long offset;
+
+}Formula;
+
+struct _correction{
+
+    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
+{
+.ADC_volt.coeff = (-6259045),
+.ADC_volt.offset = 150606390230,
+
+.ADC_current[0].coeff = 30675739,
+.ADC_current[0].offset = (-736666253953),
+
+.ADC_current[1].coeff = 749057318,
+.ADC_current[1].offset = (-17984432358007),
+
+.ADC_current[2].coeff = 31242587,
+.ADC_current[2].offset = (-750184492407),
+
+.DAC2RealV.coeff = (-18909689),
+.DAC2RealV.offset = 644251481046,
+
+.Usercode2DAC.coeff = (-10576588),
+.Usercode2DAC.offset = 605113842000,
+
+.Gain0Boundary[0] = 0x5DAA,
+.Gain0Boundary[1] = 0x5DF2,
+
+.Gain1Boundary[0] = 0x57E8,
+.Gain1Boundary[1] = 0x63B1
+};
+#endif
+
+#ifdef BORAD_CHAO_I
+{
+.ADC_volt.coeff = (-6278082),
+.ADC_volt.offset = 151228681410,
+
+.ADC_current[0].coeff = 30908391,
+.ADC_current[0].offset = (-741477595514),
+
+.ADC_current[1].coeff = 661271310,
+.ADC_current[1].offset = (-15864495597969),
+
+.ADC_current[2].coeff = 31183513,
+.ADC_current[2].offset = (-748178468530),
+
+.DAC2RealV.coeff = (-18975108),
+.DAC2RealV.offset = 644442607989,
+
+.Usercode2DAC.coeff = (-10540121),
+.Usercode2DAC.offset = 603128277368,
+
+.Gain0Boundary[0] = 0x5D96,
+.Gain0Boundary[1] = 0x5DD9,
+
+.Gain1Boundary[0] = 0x57CD,
+.Gain1Boundary[1] = 0x639F
+};
+#endif
+
+#ifdef BOARD_TWENTY_ONE
+{
+.ADC_volt.coeff = (-6258074),
+.ADC_volt.offset = 152210580945,
+
+.ADC_current[0].coeff = 30022512,
+.ADC_current[0].offset = -729552647201,
+
+.ADC_current[1].coeff = 658398533000,
+.ADC_current[1].offset = -16001498741131000,
+
+.ADC_current[2].coeff = 30908351000,
+.ADC_current[2].offset = -746548614824000,
+
+.DAC2RealV.coeff = (-19007867),
+.DAC2RealV.offset = 646316924837,
+
+.Usercode2DAC.coeff = (-10521952),
+.Usercode2DAC.offset = 603074812599,
+
+.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 = 30959456000,
+.ADC_current[2].offset = -748026885843000,
+
+.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_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){
+    long long ADCRealVolt = 0;
+
+    ADCRealVolt = (Correction.ADC_volt.coeff * ADC_measure + Correction.ADC_volt.offset);
+    ADCRealVolt = ADCRealVolt / 1e7;
+
+    return (int32_t) (ADCRealVolt);
+}
+
+// this function turn ADC measure value (0xXXXX) into real current
+// unit should be pA
+static int32_t DecodeADCCurrent(uint8_t ADCGain, uint16_t ADC_measure){
+    long long ADCRealCurrent = 0;
+
+    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, ADCRealCurrent = 0;
+
+    // return real volt to controller
+    if(ADCChannel == ADC_CH_VOLT){
+        ADCRealVolt = DecodeADCVolt(ADC_measure);
+        ret = ADCRealVolt;
+    }
+
+    // return real current to controller
+    else if(ADCChannel == ADC_CH_CURRENT){
+
+        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;
+                }
+                return ret;
+            }
+
+            // 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);
+            NotifyCurrent[1] = (uint8_t) ((ADCRealCurrent & 0x00FF0000) >> 16);
+            NotifyCurrent[2] = (uint8_t) ((ADCRealCurrent & 0x0000FF00) >> 8);
+            NotifyCurrent[3] = (uint8_t) (ADCRealCurrent & 0x000000FF);
+            ret = ADCRealCurrent;
+        }
+    }
+
+    else{
+        // not support AIN2 / AIN3 yet
+    }
+    return ret;
+}
+
+// #0 board, (0x5f75 <= rawdata) && (rawdata <= 0x5fb2)
+//           ((0x5f97 < rawdata) && (rawdata < 0x6589)) || ((0x5999 < rawdata) && (rawdata < 0x5f93))
+
+static void ADC_overflow(uint8_t gain, uint8_t *rawdata){
+
+    // Gain boundary defines different ADC gain level working area
+    // Gain0Boundary = {lowerbound, upperbound}, is the lower and upper bound of gain level 0 working area.
+
+    uint16_t U16Rawdata = 0;
+    U16Rawdata = (((uint16_t) (rawdata[0]))<<8) | ((uint16_t) (rawdata[1]));
+
+    if(gain == GAIN_200K){
+        if( U16Rawdata <= Correction.Gain0Boundary[0]){
+            rawdata[0] = Correction.Gain0Boundary[0] >> 4;
+            rawdata[1] = (uint8_t) (Correction.Gain0Boundary[0] & 0x00FF);
+        }
+        else if(U16Rawdata >= Correction.Gain0Boundary[1]){
+            rawdata[0] = (uint8_t) (Correction.Gain0Boundary[1] >> 4);
+            rawdata[1] = (uint8_t) (Correction.Gain0Boundary[1] & 0x00FF);
+        }
+    }
+    else if(gain == GAIN_10K){
+        if( U16Rawdata <= Correction.Gain1Boundary[0]){
+            rawdata[0] = Correction.Gain1Boundary[0] >> 4;
+            rawdata[1] = (uint8_t) (Correction.Gain1Boundary[0] & 0x00FF);
+        }
+        else if(U16Rawdata >= Correction.Gain1Boundary[1]){
+            rawdata[0] = (uint8_t) (Correction.Gain1Boundary[1] >> 4);
+            rawdata[1] = (uint8_t) (Correction.Gain1Boundary[1] & 0x00FF);
+        }
+    }
+}
+
+// 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)
+{
+    long long usercode_32;
+    uint16_t DACcode = 0;
+
+    usercode_32 = (long long)(usercode);
+
+    DACcode = (uint16_t) ((Correction.Usercode2DAC.coeff * usercode_32 + Correction.Usercode2DAC.offset)/1e7);
+
+    return DACcode;
+}
+
+
+static int32_t DAC_to_realV(uint16_t DACcode)
+{
+    int32_t RealV = 0;
+    long long usercode_32;
+
+    usercode_32 = ((DACcode * 1e7) - Correction.Usercode2DAC.offset) / Correction.Usercode2DAC.coeff;
+
+    RealV = (int32_t) (usercode_32 / 5) - 5000;
+
+    // return mV
+    return RealV;
+}
+
+
+#endif
@@ -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
@@ -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
@@ -0,0 +1,95 @@
+
+#ifndef ELITE_I2C
+#define ELITE_I2C
+
+/*
+* Read I2C example in
+* http://software-dl.ti.com/dsps/dsps_public_sw/sdo_sb/targetcontent/tirtos/2_14_02_22/
+*        exports/tirtos_full_2_14_02_22/docs/doxygen/html/_i2_c_c_c26_x_x_8h.html
+*
+*/
+
+#include <ti/drivers/I2C.h>
+#include <ti/drivers/Power.h>
+#include <stdint.h>
+#include <stdbool.h>
+#include <stddef.h>
+
+// I2C
+static I2C_Handle I2Chandle;
+static I2C_Params I2Cparams;
+static I2C_Transaction i2cTrans;
+
+#define I2CBufSize 4
+static uint8_t I2CtxBuf[I2CBufSize];      // Transmit buffer
+static uint8_t I2CrxBuf[I2CBufSize];      // Receive buffer
+bool transferDone = false;
+
+static void I2CCallbackFunction(I2C_Handle handle, I2C_Transaction *msg, bool transfer) {
+    if(transfer){
+        transferDone = true;
+    }
+}
+
+static void I2Cinit(){
+    I2C_init();
+
+    // Configure I2C parameters.
+    I2C_Params_init(&I2Cparams);
+
+    I2Cparams.transferMode  = I2C_MODE_CALLBACK;
+    I2Cparams.transferCallbackFxn = I2CCallbackFunction;
+    I2Cparams.bitRate  = I2C_100kHz;
+
+    // Initialize master I2C transaction structure
+    i2cTrans.writeCount   = I2CBufSize;
+    i2cTrans.writeBuf     = I2CtxBuf;
+    i2cTrans.readCount    = I2CBufSize;
+    i2cTrans.readBuf      = I2CrxBuf;
+    i2cTrans.slaveAddress = 0xA0;
+
+    for(int i=0 ; i<10 ; i++){
+        I2CtxBuf[i] = 0;
+        I2CrxBuf[i] = 0;
+    }
+
+    // Open I2C
+    I2Chandle = I2C_open(Board_I2C, &I2Cparams);
+
+}
+#define WriteMem 0b10100001
+#define ReadMem  0b10100000
+
+static void I2CWrite(uint8_t addr, uint8_t data){
+    for(int i=0 ; i<I2CBufSize ; i++){
+        I2CtxBuf[i] = 0;
+        I2CrxBuf[i] = 0;
+    }
+
+    I2CtxBuf[0] = WriteMem;
+    I2CtxBuf[1] = addr;
+    I2CtxBuf[2] = data;
+
+//    I2Chandle = I2C_open(Board_I2C, &I2Cparams);
+    I2C_transfer(I2Chandle, &i2cTrans);
+//    I2C_close(I2Chandle);
+}
+
+
+static void I2CRead(uint8_t addr){
+    for(int i=0 ; i<I2CBufSize ; i++){
+        I2CtxBuf[i] = 0;
+        I2CrxBuf[i] = 0;
+    }
+
+    I2CtxBuf[0] = ReadMem;
+    I2CtxBuf[1] = addr;
+
+//    I2Chandle = I2C_open(Board_I2C, &I2Cparams);
+    I2C_transfer(I2Chandle, &i2cTrans);
+//    I2C_close(I2Chandle);
+}
+
+
+#endif  // ELITE_I2C
+
@@ -0,0 +1,75 @@
+
+#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;
+            }
+            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
@@ -0,0 +1,86 @@
+
+#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);
+    }
+
+    // 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;
+}
+
+#endif
@@ -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
@@ -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
@@ -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
@@ -0,0 +1,112 @@
+
+#ifndef ELITENOTIFY
+#define ELITENOTIFY
+
+#include "headstage.h"
+
+/**
+ * notify data buffer.
+ * the length equals to the characteristic 4 which value is 20 bytes.
+ *
+ */
+
+
+#define NOT_BUF_OFFSET_INIT 8
+
+/**
+ * the index where to start insert data into buffer.
+ * start from 6.
+ */
+static size_t not_buf_offset = NOT_BUF_OFFSET_INIT;
+
+static uint32_t not_time_stamp;
+
+static uint8_t NotifyCurrent[4] = {0};
+static uint8_t NotifyVolt[4] = {0};
+static uint8_t NotifyImpedance[4] = {0};
+
+/**
+ * counter of notify send.
+ */
+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
+ *
+ *
+         |               |   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                                                    |
+         |    impedance                                                  |
+         |    time stamp                                                 |
+         |  cycle number |
+
+     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)
+  *
+  *
+*/
+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
@@ -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
@@ -0,0 +1,88 @@
+
+#ifndef ELITE_SPI
+#define ELITE_SPI
+
+/*
+* Read SPI example in
+* http://software-dl.ti.com/dsps/dsps_public_sw/sdo_sb/targetcontent/tirtos/2_14_02_22/
+*        exports/tirtos_full_2_14_02_22/docs/doxygen/html/_s_p_i_c_c26_x_x_d_m_a_8h.html
+*/
+
+#include <Board.h>
+#include <ti/drivers/SPI.h>
+#include <ti/drivers/dma/UDMACC26XX.h>
+#include <ti/drivers/spi/SPICC26XXDMA.h>
+#include "Elite_PIN.h"
+
+/* application use SPI parameters and buffers */
+#define SPI_LED_SIZE 28
+#define SPI_DAC_SIZE 3
+#define SPI_ADC_SIZE 4
+
+static uint16_t spi_LEDtxbuf[SPI_LED_SIZE] = {0};
+static uint16_t spi_LEDrxbuf[SPI_LED_SIZE] = {0};
+
+static uint8_t spi_DACtxbuf[SPI_DAC_SIZE] = {0};
+static uint8_t spi_rxbuf[SPI_DAC_SIZE]    = {0};
+
+static uint8_t spi_ADC_txbuf[SPI_ADC_SIZE] = {0};
+static uint8_t spi_ADC_rxbuf[SPI_ADC_SIZE] = {0};
+
+/* system use SPI parameters */
+static SPI_Handle      spiHandle0 = NULL;  // SPI0  = LED
+static SPI_Handle      spiHandle1 = NULL;  // SPI1  = ADC +DAC
+static SPI_Params      spiParams0;
+static SPI_Params      spiParams1;
+static SPI_Transaction LED_transaction;
+static SPI_Transaction ADC_DAC_transaction;
+
+
+static void Elite_SPI_init(){
+    SPI_init();
+    SPI_Params_init(&spiParams0);
+    spiParams0.bitRate     = 2000;  // 12k
+    spiParams0.mode        = SPI_MASTER;
+    spiParams0.dataSize    = 16;
+    spiParams0.frameFormat = SPI_POL0_PHA1;
+    spiHandle0 = SPI_open(Board_SPI0, &spiParams0);  // LED SPI
+
+    SPI_Params_init(&spiParams1);
+    spiParams1.bitRate     = 1000000;  // 1M
+    spiParams1.mode        = SPI_MASTER;
+    spiParams1.dataSize    = 8;
+    spiParams1.frameFormat = SPI_POL0_PHA1;
+    spiHandle1 = SPI_open(Board_SPI1, &spiParams1);  // ADC DAC SPI
+}
+
+static void LED_SPI(uint8_t length, uint16_t *spi_txbuf, uint16_t *spi_rxbuf) {
+    LED_transaction.count = length;
+    LED_transaction.txBuf = spi_txbuf;
+    LED_transaction.rxBuf = spi_rxbuf;
+
+    SPI_transfer(spiHandle0, &LED_transaction);
+}
+
+static void ADC_SPI(uint8_t length, uint8_t *spi_txbuf, uint8_t *spi_rxbuf) {
+    ADC_DAC_transaction.count = length;
+    ADC_DAC_transaction.txBuf = spi_txbuf;
+    ADC_DAC_transaction.rxBuf = spi_rxbuf;
+
+    PIN_setOutputValue(pin_handle, DAC_CS, 1);  // DAC_CS HIGH
+    PIN_setOutputValue(pin_handle, ADC_CS, 0);  // ADC_CS LOW
+    SPI_transfer(spiHandle1, &ADC_DAC_transaction);
+    PIN_setOutputValue(pin_handle, ADC_CS, 1);  // ADC_CS HIGH
+
+}
+
+static void DAC_SPI(uint8_t length, uint8_t *spi_txbuf, uint8_t *spi_rxbuf) {
+   ADC_DAC_transaction.count = length;
+   ADC_DAC_transaction.txBuf = spi_txbuf;
+   ADC_DAC_transaction.rxBuf = spi_rxbuf;
+
+   PIN_setOutputValue(pin_handle, ADC_CS, 1);  // ADC_CS HIGH
+   PIN_setOutputValue(pin_handle, DAC_CS, 0);  // DAC_CS LOW
+   SPI_transfer(spiHandle1, &ADC_DAC_transaction);
+   PIN_setOutputValue(pin_handle, DAC_CS, 1);  // DAC_CS HIGH
+}
+
+#endif // ELITE_SPI
@@ -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
@@ -0,0 +1,574 @@
+/**
+*
+* 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;
+    VOUT_PARA;
+    LIMIT;
+}IVMode;
+
+IVMode *InitIVMode(){
+    IVMode *ret = malloc(sizeof(IVMode));
+    ret->_MeasureData = 0;
+    ret->SetMeasureData = &_SetMeasureData;
+    ret->GetMeasureData = &_GetMeasureData;
+
+    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
+    int32_t ReferenceVolt;
+
+    VOUT_PARA;
+}PSMode;
+
+PSMode *InitPSMode(){
+    PSMode *ret = malloc(sizeof(PSMode));
+    ret->_MeasureData = 0;
+    ret->SetMeasureData = &_SetMeasureData;
+    ret->GetMeasureData = &_GetMeasureData;
+    ret->ReferenceVolt = 0;
+
+    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;
+
+        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;
+        default:
+            if(WM->IV != NULL){
+                free(WM->IV);
+                WM->IV = NULL;
+            }
+            break;
+    }
+//    free(WM);
+}
+
+#endif
@@ -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
@@ -0,0 +1,190 @@
+
+#ifndef Elite_PIN
+#define Elite_PIN
+
+#include <ti/drivers/pin/PINCC26XX.h>
+#include <Board.h>
+#include <ti/drivers/PIN.h>
+
+/* SPI Board */
+#define Board_SPI0_MISO                 PIN_UNASSIGNED
+#define Board_SPI0_MOSI                 IOID_1
+#define Board_SPI0_CLK                  IOID_0
+#define Board_SPI0_CS                   PIN_UNASSIGNED
+
+#define Board_SPI1_MISO                 IOID_3
+#define Board_SPI1_MOSI                 IOID_2
+#define Board_SPI1_CLK                  IOID_4
+#define Board_SPI1_CS                   PIN_UNASSIGNED
+
+#define ADC_CS                          IOID_8
+#define DAC_CS                          IOID_9
+
+#define Turnon100R                      IOID_5
+#define Turnon10K                       IOID_6
+
+/* I2C */
+#ifdef ELITE_VERSION_1_4
+#define Board_I2C0_SCL0                 IOID_7
+#define Board_I2C0_SDA0                 IOID_1
+#endif
+
+#define shutdown_6994                   IOID_10
+#define switch_on                       IOID_11
+#define enable_10v                      IOID_12
+#define enable_5v                       IOID_13
+
+PIN_Handle       pin_handle;
+static PIN_State ZM_rst;
+
+const PIN_Config BLE_IO[] = {
+    //
+    ADC_CS | PIN_GPIO_OUTPUT_EN | PIN_GPIO_LOW | PIN_PUSHPULL | PIN_DRVSTR_MAX,  // ADC_CS
+    DAC_CS | PIN_GPIO_OUTPUT_EN | PIN_GPIO_LOW | PIN_PUSHPULL | PIN_DRVSTR_MAX,  // DAC_CS
+
+    enable_10v | PIN_GPIO_OUTPUT_EN | PIN_GPIO_LOW | PIN_PUSHPULL | PIN_DRVSTR_MAX,     // 10V_enable
+    enable_5v | PIN_GPIO_OUTPUT_EN | PIN_GPIO_LOW | PIN_PUSHPULL | PIN_DRVSTR_MAX,      // 5V_enable
+    shutdown_6994 | PIN_GPIO_OUTPUT_EN | PIN_GPIO_LOW | PIN_PUSHPULL | PIN_DRVSTR_MAX,  // turn off power
+    Turnon100R | PIN_GPIO_OUTPUT_EN | PIN_GPIO_LOW | PIN_PUSHPULL | PIN_DRVSTR_MAX,
+    Turnon10K | PIN_GPIO_OUTPUT_EN | PIN_GPIO_LOW | PIN_PUSHPULL | PIN_DRVSTR_MAX,
+    switch_on | PIN_INPUT_EN | PIN_PULLDOWN,
+
+    PIN_TERMINATE
+};
+
+/*!
+ *  @def    BOOSTXL_CC2650MA_SPIName
+ *  @brief  Enum of SPI names on the CC2650 Booster Pack
+ */
+typedef enum BOOSTXL_CC2650MA_SPIName {
+    BOOSTXL_CC2650MA_SPI0 = 0,
+    BOOSTXL_CC2650MA_SPI1 = 1,
+
+    BOOSTXL_CC2650MA_SPICOUNT
+} BOOSTXL_CC2650MA_SPIName;
+
+/*
+ *  ========================== SPI DMA begin ===================================
+ */
+/* Place into subsections to allow the TI linker to remove items properly */
+#if defined(__TI_COMPILER_VERSION__)
+#pragma DATA_SECTION(SPI_config, ".const:SPI_config")
+#pragma DATA_SECTION(spiCC26XXDMAHWAttrs, ".const:spiCC26XXDMAHWAttrs")
+#endif
+
+/* Include drivers */
+#include <ti/drivers/spi/SPICC26XXDMA.h>
+
+/* SPI objects */
+SPICC26XXDMA_Object spiCC26XXDMAObjects[BOOSTXL_CC2650MA_SPICOUNT];
+
+/* SPI configuration structure, describing which pins are to be used */
+const SPICC26XXDMA_HWAttrsV1 spiCC26XXDMAHWAttrs[BOOSTXL_CC2650MA_SPICOUNT] = {
+    {
+        .baseAddr           = SSI0_BASE,
+        .intNum             = INT_SSI0_COMB,
+        .intPriority        = ~0,
+        .swiPriority        = 0,
+        .powerMngrId        = PowerCC26XX_PERIPH_SSI0,
+        .defaultTxBufValue  = 0,
+        .rxChannelBitMask   = 1<<UDMA_CHAN_SSI0_RX,
+        .txChannelBitMask   = 1<<UDMA_CHAN_SSI0_TX,
+        .mosiPin            = Board_SPI0_MOSI,
+        .misoPin            = Board_SPI0_MISO,
+        .clkPin             = Board_SPI0_CLK,
+        .csnPin             = Board_SPI0_CS
+    },
+    {
+        .baseAddr           = SSI1_BASE,
+        .intNum             = INT_SSI1_COMB,
+        .intPriority        = ~0,
+        .swiPriority        = 0,
+        .powerMngrId        = PowerCC26XX_PERIPH_SSI1,
+        .defaultTxBufValue  = 0,
+        .rxChannelBitMask   = 1<<UDMA_CHAN_SSI1_RX,
+        .txChannelBitMask   = 1<<UDMA_CHAN_SSI1_TX,
+        .mosiPin            = Board_SPI1_MOSI,
+        .misoPin            = Board_SPI1_MISO,
+        .clkPin             = Board_SPI1_CLK,
+        .csnPin             = Board_SPI1_CS
+    },
+};
+
+/* SPI configuration structure */
+const SPI_Config SPI_config[] = {
+    {
+         .fxnTablePtr = &SPICC26XXDMA_fxnTable,
+         .object      = &spiCC26XXDMAObjects[0],
+         .hwAttrs     = &spiCC26XXDMAHWAttrs[0]
+    },
+    {
+         .fxnTablePtr = &SPICC26XXDMA_fxnTable,
+         .object      = &spiCC26XXDMAObjects[1],
+         .hwAttrs     = &spiCC26XXDMAHWAttrs[1]
+    },
+    {NULL, NULL, NULL}
+};
+/*
+ *  ========================== SPI DMA end =====================================
+*/
+
+
+/*
+ *  ============================= I2C Begin=====================================
+*/
+
+#ifdef ELITE_VERSION_1_4
+
+/* Generic I2C instance identifiers */
+#define Board_I2C                   CC2650_MA_I2C0
+/*!
+ *  @def    CC2650_LAUNCHXL_I2CName
+ *  @brief  Enum of I2C names on the CC2650 dev board
+ */
+typedef enum CC2650_MA_I2CName {
+    CC2650_MA_I2C0 = 0,
+
+    CC2650_MA_I2CCOUNT
+} CC2650_MA_I2CName;
+
+/* Place into subsections to allow the TI linker to remove items properly */
+#if defined(__TI_COMPILER_VERSION__)
+#pragma DATA_SECTION(I2C_config, ".const:I2C_config")
+#pragma DATA_SECTION(i2cCC26xxHWAttrs, ".const:i2cCC26xxHWAttrs")
+#endif
+
+/* Include drivers */
+#include <ti/drivers/i2c/I2CCC26XX.h>
+
+/* I2C objects */
+I2CCC26XX_Object i2cCC26xxObjects[CC2650_MA_I2CCOUNT];
+
+/* I2C configuration structure, describing which pins are to be used */
+const I2CCC26XX_HWAttrsV1 i2cCC26xxHWAttrs[CC2650_MA_I2CCOUNT] = {
+    {
+        .baseAddr = I2C0_BASE,
+        .powerMngrId = PowerCC26XX_PERIPH_I2C0,
+        .intNum = INT_I2C_IRQ,
+        .intPriority = ~0,
+        .swiPriority = 0,
+        .sdaPin = Board_I2C0_SDA0,
+        .sclPin = Board_I2C0_SCL0,
+    }
+};
+
+/* I2C configuration structure */
+const I2C_Config I2C_config[] = {
+    {
+        .fxnTablePtr = &I2CCC26XX_fxnTable,
+        .object = &i2cCC26xxObjects[0],
+        .hwAttrs = &i2cCC26xxHWAttrs[0]
+    },
+    {NULL, NULL, NULL}
+};
+/*
+ *  ========================== I2C end =========================================
+ */
+#endif
+
+#endif
+
@@ -0,0 +1,305 @@
+
+#ifndef HEADSTAGE_H
+#error "headstage.h not include"
+#endif
+
+#ifdef HEADSTAGE_H_H
+#error "headstage_*.h has be included"
+#endif
+
+#ifndef HEADSTAGE_TNI_H
+#define HEADSTAGE_H_H
+#define HEADSTAGE_TNI_H
+
+// product information
+#define DEVICE_NAME "Elite-v0.1"
+#define MAJOR_PRODUCT_NUMBER 0
+#define MINOR_PRODUCT_NUMBER 1
+#define MAJOR_VERSION_NUMBER 0
+#define MINOR_VERSION_NUMBER 1
+
+// header
+#include <ti/drivers/PIN.h>
+#include "board.h"
+
+/*============
+ ==== SPI ====
+ ===========*/
+
+/* application use SPI parameters and buffers */
+
+#define SPI_BUFFER_SIZE 16
+
+static uint8_t spi_txbuf[SPI_BUFFER_SIZE] = {0};
+static uint8_t spi_rxbuf[SPI_BUFFER_SIZE] = {0};
+
+/*=============================
+ ==== headstage variable ====
+ ============================*/
+
+PIN_Handle       pin_handle;
+static PIN_State DBS_rst;
+
+// DBS reset pin
+
+const PIN_Config BLE_IO[] = {
+    //
+    IOID_9 | PIN_GPIO_OUTPUT_EN | PIN_GPIO_LOW | PIN_PUSHPULL,
+    IOID_2 | PIN_GPIO_OUTPUT_EN | PIN_GPIO_LOW | PIN_PUSHPULL,
+    IOID_3 | PIN_GPIO_OUTPUT_EN | PIN_GPIO_LOW | PIN_PUSHPULL,
+    IOID_13 | PIN_GPIO_OUTPUT_EN | PIN_GPIO_LOW | PIN_PUSHPULL,
+    PIN_TERMINATE  //
+};
+
+/**
+ * ADC clock switch signal.
+ */
+static bool adc_clock_signal = FALSE;
+
+/*=======================================
+ ==== headstage function declaration ====
+ ======================================*/
+
+static void headstage_tni_update_instruction_callback(uint8_t ins_type, uint8_t ins_op, uint8_t ins_len, uint8_t *ins);
+
+/*=============================
+ ==== ramp data generating ====
+ ============================*/
+
+static uint16_t ramp_data_counter = 0;
+
+static void create_ramp(uint8_t *buff) {
+    buff[0] = 0b10110000 | (0b00001111 & (uint8_t)(ramp_data_counter >> 6));
+    buff[1] = (uint8_t)(ramp_data_counter << 2);
+    ramp_data_counter += 1;
+}
+
+/*=======================================
+ ==== headstage function implemented ====
+ ======================================*/
+
+/**
+ * change channel value to little endian
+ */
+static uint8 encode_channel(uint8 channel) {
+    return 0x0F & (((channel & 0b1000) >> 3) |  //
+                   ((channel & 0b0100) >> 1) |  //
+                   ((channel & 0b0010) << 1) |  //
+                   ((channel & 0b0001) << 3));
+}
+
+static void headstage_init() {
+    set_update_instruction_callback(headstage_tni_update_instruction_callback);
+
+    // initialize the DBS reset pin
+    pin_handle = PIN_open(&DBS_rst, BLE_IO);
+    PIN_setOutputValue(pin_handle, IOID_9, 1);
+    PIN_setOutputValue(pin_handle, IOID_2, 0);
+    PIN_setOutputValue(pin_handle, IOID_3, 0);
+}
+
+/**
+ * change the recording clock bit in the instruction buffer.
+ */
+static void update_ins_rec_clock(uint8_t *buf, bool adc_clock_signal) {
+    buf[3] = (buf[3] & 0b11110000) | ((adc_clock_signal) ? 0b1000 : 0);
+}
+
+/**
+ * change the recording channel bit in the instruction buffer.
+ */
+static void update_ins_rec_channel(uint8_t *buf, uint8 channel) {
+    buf[1] = (buf[1] & 0b00001111) | (encode_channel(channel) << 4);
+}
+
+/**
+ * change the stimulation enable bit in the instruction buffer.
+ */
+static void update_ins_sti_enable(uint8_t *buf, bool enable) {
+    buf[1] = (buf[1] & 0b11111101) | ((enable) ? 0b10 : 0);
+}
+
+/**
+ * change the stimulating channel bit in the instruction buffer.
+ */
+static void update_ins_sti_channel(uint8_t *buf, uint8 sti_chp, uint8 sti_chn) {
+    buf[2] = (buf[2] & 0b11110000) | encode_channel(sti_chp);
+    buf[3] = (buf[3] & 0b00001111) | (encode_channel(sti_chn) << 4);
+}
+
+static void update_ins_buffer() {
+    uint8 header      = 0b10100000;
+    uint8 amp_gain    = (INSTRUCTION.amp_gain & 0b11) << 3;
+    uint8 amp_lbf     = INSTRUCTION.amp_low_band_freq & 0b111;
+    uint8 channel     = 0;  // should be call update_ins_channel to modify this value
+    uint8 chopper     = (INSTRUCTION.chopper) ? 0b00001000 : 0;
+    uint8 fast_settle = (INSTRUCTION.fast_settle) ? 0b00000100 : 0;
+    uint8 sti_enable  = (INSTRUCTION.work_mode != STI_MODE_DISABLE) ? 0b00000010 : 0;
+    uint8 sti_volt_l  = (INSTRUCTION.sti_volt & 0b11111) >> 4;
+    uint8 sti_volt_h  = (INSTRUCTION.sti_volt & 0b01111) << 4;
+    uint8 sti_chp     = INSTRUCTION.sti_channel_pmos & 0b1111;
+    uint8 sti_chn     = (INSTRUCTION.sti_channel_nmos & 0b1111) << 4;
+    uint8 clk_signal  = 0;  // should be call update_ins_clock to modify this value
+
+    spi_txbuf[0] = header | amp_gain | amp_lbf;
+    spi_txbuf[1] = channel | chopper | fast_settle | sti_enable | sti_volt_l;
+    spi_txbuf[2] = sti_volt_h | sti_chp;
+    spi_txbuf[3] = sti_chn | clk_signal;
+}
+
+static bool update_ins_rec_buffer() {
+    adc_clock_signal = (adc_clock_signal) ? FALSE : TRUE;  // switch adc_clock
+    update_ins_rec_clock(spi_txbuf, adc_clock_signal);
+
+    if (adc_clock_signal) {
+        // change to next channel
+
+        if (next_active_channel()) {
+            update_ins_rec_channel(spi_txbuf, channel_pointer);
+        } else {
+            // no channel active
+            return false;
+        }
+    }
+
+    return true;
+}
+
+/**
+ * Change the instruction content for SPI buffer, which is depended on the
+ * work_mode. Expend the remind instruction according to the base instruction
+ * which allocated at the beginning 4 bytes of the SPI buffer.
+ *
+ * ========= ===========
+ * work_mode ins pattern
+ * ========= ===========
+ * POS, NEG  4 F  D 0
+ * P2N, N2P  4 4' F D
+ * AWF       not impl
+ * ========= ===========
+ *
+ * pattern *4*
+ *     stimulation instruction.
+ *
+ * pattern *F*
+ *     set pmos channel to 0xF, release the remain voltage in the capacitance.
+ *
+ * pattern *D*
+ *     disable stimulation
+ *
+ * pattern *0*
+ *     nop.
+ *
+ * @param: buf: pointer of the SPI buffer.
+ */
+static void update_ins_sti_buffer() {
+    switch (INSTRUCTION.work_mode) {
+    case STI_MODE_POS:
+    case STI_MODE_NEG:
+        // copy [4:7]
+        spi_txbuf[4] = spi_txbuf[0];
+        spi_txbuf[5] = spi_txbuf[1];
+        spi_txbuf[6] = spi_txbuf[2];
+        spi_txbuf[7] = spi_txbuf[3];
+        // copy [8:B]
+        spi_txbuf[8]  = spi_txbuf[0];
+        spi_txbuf[9]  = spi_txbuf[1];
+        spi_txbuf[10] = spi_txbuf[2];
+        spi_txbuf[11] = spi_txbuf[3];
+        // reset [C:F]
+        spi_txbuf[12] = 0;
+        spi_txbuf[13] = 0;
+        spi_txbuf[14] = 0;
+        spi_txbuf[15] = 0;
+        // change content
+        update_ins_sti_enable(spi_txbuf, TRUE);
+        // ins buf [4:7]
+        update_ins_sti_enable(spi_txbuf + 4, TRUE);
+        update_ins_sti_channel(spi_txbuf + 4, 0xF, INSTRUCTION.sti_channel_pmos);
+        // ins buf [8:B]
+        update_ins_sti_enable(spi_txbuf + 8, FALSE);
+        break;
+    case STI_MODE_P2N:
+    case STI_MODE_N2P:
+        // copy [4:7]
+        spi_txbuf[4] = spi_txbuf[0];
+        spi_txbuf[5] = spi_txbuf[1];
+        spi_txbuf[6] = spi_txbuf[2];
+        spi_txbuf[7] = spi_txbuf[3];
+        // copy [8:B]
+        spi_txbuf[8]  = spi_txbuf[0];
+        spi_txbuf[9]  = spi_txbuf[1];
+        spi_txbuf[10] = spi_txbuf[2];
+        spi_txbuf[11] = spi_txbuf[3];
+        // copy [C:F]
+        spi_txbuf[12] = spi_txbuf[0];
+        spi_txbuf[13] = spi_txbuf[1];
+        spi_txbuf[14] = spi_txbuf[2];
+        spi_txbuf[15] = spi_txbuf[3];
+        // change content
+        update_ins_sti_enable(spi_txbuf + 0, TRUE);
+        update_ins_sti_channel(spi_txbuf + 0, INSTRUCTION.sti_channel_pmos, INSTRUCTION.sti_channel_nmos);
+        // ins buf [4:7]
+        update_ins_sti_enable(spi_txbuf + 4, TRUE);
+        update_ins_sti_channel(spi_txbuf + 4, INSTRUCTION.sti_channel_nmos, INSTRUCTION.sti_channel_pmos);
+        // ins buf [8:B]
+        update_ins_sti_enable(spi_txbuf + 8, TRUE);
+        update_ins_sti_channel(spi_txbuf + 8, 0xF, INSTRUCTION.sti_channel_nmos);
+        // ins buf [C:F]
+        update_ins_sti_enable(spi_txbuf + 12, FALSE);
+        break;
+    case STI_MODE_AWF:
+        // XXX define the voltage change
+        break;
+    default:
+        // do nothing
+        break;
+    }
+}
+
+static void headstage_tni_update_instruction_callback(uint8_t ins_type, uint8_t ins_op, uint8_t ins_len, uint8_t *ins) {
+    switch (ins_type) {
+    case INS_TYPE_VIS: {
+    // reset
+    case VIS_RST:
+        // reset. reset all variable
+        adc_clock_signal = FALSE;
+        memset(spi_txbuf, 0, SPI_BUFFER_SIZE);
+        break;
+
+    // interrupt
+    case VIS_INT:
+        // stop. reset channel table
+        ramp_data_counter = 0;
+        memset(spi_txbuf, 0, SPI_BUFFER_SIZE);
+        break;
+    }
+    case INS_TYPE_RIS:
+    default:
+        break;
+    }
+}
+
+static uint8_t *spi_transact_rec_instruction() {
+    if (IS_REC_MODE(INSTRUCTION.work_mode)) {
+        PIN_setOutputValue(pin_handle, IOID_13, 1);  // DBS_P2S turn on
+        headstage_spi_transaction(SPI_BUFFER_SIZE, spi_txbuf, spi_rxbuf);
+        PIN_setOutputValue(pin_handle, IOID_13, 0);  // DBS_P2S turn off
+
+    } else if (IS_ARM_MODE(INSTRUCTION.work_mode) && !adc_clock_signal) {
+        create_ramp(spi_rxbuf);
+    }
+
+    if (adc_clock_signal) {
+        return NULL;
+    } else {
+        return spi_rxbuf;
+    }
+}
+
+static uint8_t *spi_transact_sti_instruction() {
+    headstage_spi_transaction(16, spi_txbuf, NULL);
+    return NULL;
+}
+
+#endif
@@ -0,0 +1,272 @@
+/*
+ * impedance_meter.h
+ *
+ *  Created on: 2019/01/15
+ *      Author: benny
+ */
+#ifndef HEADSTAGE_H
+#error "headstage.h not include"
+#endif
+
+#ifdef HEADSTAGE_H_H
+#error "headstage_*.h has be included"
+#endif
+
+#ifndef IMPEDANCE_METER_H_
+#define HEADSTAGE_H_H
+#define IMPEDANCE_METER_H_
+
+// header
+#include <ti/drivers/PIN.h>
+#include "board.h"
+#include "EliteWorkData.h"
+
+static void SimpleBLEPeripheral_performPeriodicTask(WorkMode *WorkModeData);
+
+static void SimpleBLEPeripheral_clockHandler(UArg arg) {
+    // Store the event.
+//    events |= SBP_PERIODIC_EVT;
+
+    // Wake up the application.
+//    Semaphore_post(semaphore);  // send samaphore to jump out of infinite waiting(simple_peripheral.c line570)
+
+}
+static void elite_gptimer_callback(GPTimerCC26XX_Handle handle, GPTimerCC26XX_IntMask interruptMask) {
+    events |= SBP_PERIODIC_EVT;
+    Semaphore_post(semaphore);
+}
+
+
+static void ZM_update_instruction_callback(uint8_t ins_type, uint8_t chip_ID, uint8_t *ins);
+
+static void ZM_init() {
+    set_update_instruction_callback(ZM_update_instruction_callback);
+
+    // initialize
+    pin_handle = PIN_open(&ZM_rst, BLE_IO);
+
+    PIN_setOutputValue(pin_handle, shutdown_6994, 1);  // OFF = 1 => turn off 6994
+    PIN_setOutputValue(pin_handle, enable_10v, 0);     // enable 10V
+
+    PIN_setOutputValue(pin_handle, ADC_CS, 1);  // ADC_CS HIGH
+    PIN_setOutputValue(pin_handle, DAC_CS, 1);  // DAC_CS HIGH
+
+    InitEliteInstruction();
+    ADCGainControl(GAIN_AUTO);
+    elite_gptimer_open();
+
+    //    PIN_registerIntCb(pin_handle, switch_on_callback);
+    //    PIN_setInterrupt(pin_handle, switch_on | PIN_IRQ_POSEDGE);
+}
+
+static void ZM_update_instruction_callback(uint8_t ins_type, uint8_t chip_ID, uint8_t *ins) {}
+
+
+static void DACCode2Real2Notify(uint16_t DACcode) {
+    int32_t RealV;
+    RealV = DAC_to_realV(DACcode);
+
+    NotifyVolt[0] = (uint8_t)((RealV & 0xFF000000) >> 24);
+    NotifyVolt[1] = (uint8_t)((RealV & 0x00FF0000) >> 16);
+    NotifyVolt[2] = (uint8_t)((RealV & 0x0000FF00) >> 8);
+    NotifyVolt[3] = (uint8_t)(RealV & 0x000000FF);
+}
+
+#define IsPeriodicMode() (  \
+(INSTRUCTION.eliteFxn == IV_CURVE) || \
+(INSTRUCTION.eliteFxn == CV_CURVE) || \
+(INSTRUCTION.eliteFxn == IT_CURVE) || \
+(INSTRUCTION.eliteFxn == VT_CURVE) || \
+(INSTRUCTION.eliteFxn == ZT_CURVE) || \
+(INSTRUCTION.eliteFxn == CONSTANT_CURRENT)  \
+)
+
+/*********************************************************************
+ * @fn      SimpleBLEPeripheral_performPeriodicTask
+ *
+ * @brief   Control periodic event such as DAC out, ADC read, and send notify.
+ *
+ * @param   None.
+ *
+ * @return  None.
+ */
+static void SimpleBLEPeripheral_performPeriodicTask(WorkMode *WorkModeData) {
+    if ( IsPeriodicMode() ){
+
+        // DAC counter
+        if (CT.StepTimeCounter == INSTRUCTION.StepTime){
+            CT.StepTimeCounter = 1;
+        }
+        else{
+            CT.StepTimeCounter++;
+        }
+
+        // ADC counter
+        if (CT.SampleRate_counter == INSTRUCTION.SampleRate){
+            CT.SampleRate_counter = 1;
+        }
+        else{
+            CT.SampleRate_counter++;
+        }
+
+        // notify counter
+        if (CT.NotifyCounter == INSTRUCTION.NotifyRate){
+            CT.NotifyCounter = 1;
+        }
+        else{
+            CT.NotifyCounter ++;
+        }
+
+        /** Periodic Event **/
+        // Default working flow is DAC out -> ADC read -> send notify
+        // We will need a flag to control DAC, if we want to exchange to ADC -> DAC -> notify
+        // This flag can be named by FxnNameDACReset
+
+        // In IV, CV, and func-gen mode, DAC will output voltage
+        // else DAC do nothing.
+        EliteDACControl(WorkModeData);
+
+        // Control ADC to sample rate
+        EliteADCControl(WorkModeData);
+
+        // Notify control, check if we need to send notify
+        EliteNotifyControl();
+    }
+
+    else if(INSTRUCTION.eliteFxn == VOLT_OUTPUT){
+        // assign WorkModeData->VO  = INSTRUCTION.VoltConstant
+        WorkModeData->VO->_VoltOut = INSTRUCTION.VoltConstant;
+
+        // UserCode -> DAC code -> DAC out
+        DAC_outputV(Usercode_Correction_to_DAC(WorkModeData->VO->_VoltOut));
+        FreeWorkMode(WorkModeData);
+        PeriodicEvent = false;
+        InitPeriodicEvent = true;
+    }
+    else{
+        PeriodicEvent = false;
+    }
+}
+
+static void EliteDACControl(WorkMode *WorkModeData) {
+    if ((INSTRUCTION.eliteFxn == IV_CURVE) || (INSTRUCTION.eliteFxn == CV_CURVE)) {
+        // output a certain voltage and put it into NotifyVolt
+        DACCode2Real2Notify(VoltScan(WorkModeData));
+    }
+
+    else if (INSTRUCTION.eliteFxn == ZT_CURVE){
+        if(INSTRUCTION.ResisterMeter == RESISTER_METER_SMALL){
+            // output 1V
+            if (DACReset) {
+                INSTRUCTION.VoltConstant = 25000 + 5000;
+                DAC_outputV(Usercode_Correction_to_DAC(INSTRUCTION.VoltConstant));
+                DACReset = false;
+            }
+        }
+        else{
+            // output 1V
+            if (DACReset) {
+                INSTRUCTION.VoltConstant = 25000 + 5000;
+                DAC_outputV(Usercode_Correction_to_DAC(INSTRUCTION.VoltConstant));
+                DACReset = false;
+            }
+        }
+    }
+    else if(INSTRUCTION.eliteFxn == CONSTANT_CURRENT){
+        if (DACReset) {
+            DAC_outputV(Usercode_Correction_to_DAC(25000));
+            DACReset = false;
+        }
+        CCModeVoltOut(WorkModeData->CC);
+    }
+
+    else{
+        // IT, VT need only ADC measure
+        return;
+    }
+}
+
+static void EliteADCControl(WorkMode *WorkModeData) {
+    if (CT.SampleRate_counter == INSTRUCTION.SampleRate - 1) {
+        switch (INSTRUCTION.eliteFxn) {
+            case IV_CURVE:{
+                IT_Plot(WorkModeData);
+                break;
+            }
+            case CV_CURVE:{
+                IT_Plot(WorkModeData);
+                break;
+            }
+            case IT_CURVE:{
+                IT_Plot(WorkModeData);
+                break;
+            }
+            case VT_CURVE:{
+                // read volt through ADC and put it into notify buffer
+                VT_Plot(WorkModeData->VT);
+                break;
+            }
+            case ZT_CURVE:{
+                ZT_Plot(WorkModeData->RT);
+                break;
+            }
+            case CONSTANT_CURRENT:{
+                CCModeReadCurrent(WorkModeData->CC);
+                CCModeReverseCurrent(WorkModeData->CC);
+                break;
+            }
+            default:{
+                IT_Plot(WorkModeData);
+                break;
+            }
+        }
+    }
+}
+
+static void EliteNotifyControl() {
+    if ((INSTRUCTION.eliteFxn == IV_CURVE) || (INSTRUCTION.eliteFxn == CV_CURVE)) {
+        // output the last notify, and reset Elite
+        if (!PeriodicEvent) {
+            SendNotify();
+            reset();
+        } else if (CT.StepTimeCounter == INSTRUCTION.StepTime - 1) {
+            SendNotify();
+        }
+    }
+    else if(INSTRUCTION.eliteFxn == CONSTANT_CURRENT){
+        if(CT.NotifyCounter == INSTRUCTION.NotifyRate){
+            SendNotify();
+        }
+    }
+    else if (CT.SampleRate_counter == INSTRUCTION.SampleRate) {
+        SendNotify();
+    }
+}
+
+
+static uint16_t StepCode2DACcode(uint16_t StepCode){
+    return (StepCode * 0x0005);
+}
+
+static uint16_t OldStep2NewStepTime(uint8_t StepTime) {
+    uint8_t StepTimeLevel = 0;
+    StepTimeLevel = StepTime / 0x12;
+
+    switch (StepTimeLevel) {
+    case 0: {  //0.5 sec
+        LED_color(LIGHTLED, 0xFF, 0xFF, 0xFF);
+        return STEPTIME_HALF_SEC;
+    }
+    case 1: {  //1 sec
+        return STEPTIME_ONE_SEC;
+    }
+    case 2: {  //2 sec
+        return STEPTIME_TWO_SEC;
+    }
+    default: {  //1 sec
+        return STEPTIME_ONE_SEC;
+    }
+    }
+}
+
+#endif /* IMPEDANCE_METER_H_ */
@@ -136,7 +136,7 @@ PIN_Handle radCtrlHandle;

 extern void AssertHandler(uint8 assertCause, uint8 assertSubcause);

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

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


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

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

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

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

@@ -50,14 +50,14 @@
 */
 #include <string.h>

-#include "bcomdef.h"
-#include "osal.h"
-#include "linkdb.h"
 #include "att.h"
+#include "bcomdef.h"
+#include "gapbondmgr.h"
 #include "gatt.h"
 #include "gatt_uuid.h"
 #include "gattservapp.h"
-#include "gapbondmgr.h"
+#include "linkdb.h"
+#include "osal.h"

 #include "simple_gatt_profile.h"

@@ -69,7 +69,7 @@
 * CONSTANTS
 */

-#define SERVAPP_NUM_ATTR_SUPPORTED        17
+#define SERVAPP_NUM_ATTR_SUPPORTED 17

 /*********************************************************************
 * TYPEDEFS
@@ -79,40 +79,22 @@
 * GLOBAL VARIABLES
 */
 // Simple GATT Profile Service UUID: 0xFFF0
-CONST uint8 simpleProfileServUUID[ATT_BT_UUID_SIZE] =
-{
-  LO_UINT16(SIMPLEPROFILE_SERV_UUID), HI_UINT16(SIMPLEPROFILE_SERV_UUID)
-};
+CONST uint8 simpleProfileServUUID[ATT_BT_UUID_SIZE] = {LO_UINT16(SIMPLEPROFILE_SERV_UUID), HI_UINT16(SIMPLEPROFILE_SERV_UUID)};

 // Characteristic 1 UUID: 0xFFF1
-CONST uint8 simpleProfilechar1UUID[ATT_BT_UUID_SIZE] =
-{
-  LO_UINT16(SIMPLEPROFILE_CHAR1_UUID), HI_UINT16(SIMPLEPROFILE_CHAR1_UUID)
-};
+CONST uint8 simpleProfilechar1UUID[ATT_BT_UUID_SIZE] = {LO_UINT16(SIMPLEPROFILE_CHAR1_UUID), HI_UINT16(SIMPLEPROFILE_CHAR1_UUID)};

 // Characteristic 2 UUID: 0xFFF2
-CONST uint8 simpleProfilechar2UUID[ATT_BT_UUID_SIZE] =
-{
-  LO_UINT16(SIMPLEPROFILE_CHAR2_UUID), HI_UINT16(SIMPLEPROFILE_CHAR2_UUID)
-};
+CONST uint8 simpleProfilechar2UUID[ATT_BT_UUID_SIZE] = {LO_UINT16(SIMPLEPROFILE_CHAR2_UUID), HI_UINT16(SIMPLEPROFILE_CHAR2_UUID)};

 // Characteristic 3 UUID: 0xFFF3
-CONST uint8 simpleProfilechar3UUID[ATT_BT_UUID_SIZE] =
-{
-  LO_UINT16(SIMPLEPROFILE_CHAR3_UUID), HI_UINT16(SIMPLEPROFILE_CHAR3_UUID)
-};
+CONST uint8 simpleProfilechar3UUID[ATT_BT_UUID_SIZE] = {LO_UINT16(SIMPLEPROFILE_CHAR3_UUID), HI_UINT16(SIMPLEPROFILE_CHAR3_UUID)};

 // Characteristic 4 UUID: 0xFFF4
-CONST uint8 simpleProfilechar4UUID[ATT_BT_UUID_SIZE] =
-{
-  LO_UINT16(SIMPLEPROFILE_CHAR4_UUID), HI_UINT16(SIMPLEPROFILE_CHAR4_UUID)
-};
+CONST uint8 simpleProfilechar4UUID[ATT_BT_UUID_SIZE] = {LO_UINT16(SIMPLEPROFILE_CHAR4_UUID), HI_UINT16(SIMPLEPROFILE_CHAR4_UUID)};

 // Characteristic 5 UUID: 0xFFF5
-CONST uint8 simpleProfilechar5UUID[ATT_BT_UUID_SIZE] =
-{
-  LO_UINT16(SIMPLEPROFILE_CHAR5_UUID), HI_UINT16(SIMPLEPROFILE_CHAR5_UUID)
-};
+CONST uint8 simpleProfilechar5UUID[ATT_BT_UUID_SIZE] = {LO_UINT16(SIMPLEPROFILE_CHAR5_UUID), HI_UINT16(SIMPLEPROFILE_CHAR5_UUID)};

 /*********************************************************************
 * EXTERNAL VARIABLES
@@ -133,29 +115,27 @@ static simpleProfileCBs_t *simpleProfile_AppCBs = NULL;
 */

 // Simple Profile Service attribute
-static CONST gattAttrType_t simpleProfileService = { ATT_BT_UUID_SIZE, simpleProfileServUUID };
-
+static CONST gattAttrType_t simpleProfileService = {ATT_BT_UUID_SIZE, simpleProfileServUUID};

 // Simple Profile Characteristic 1 Properties
-static uint8 simpleProfileChar1Props = GATT_PROP_READ | GATT_PROP_WRITE;
+static uint8 simpleProfileChar1Props = GATT_PROP_READ;

 // Characteristic 1 Value
-static uint8 simpleProfileChar1 = 0;
+#define SIMPLEPROFILE_CHAR1_LEN 20
+static uint8 simpleProfileChar1[SIMPLEPROFILE_CHAR1_LEN] = {0};

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

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

 // Characteristic 2 Value
-static uint8 simpleProfileChar2 = 0;
+static uint8 simpleProfileChar2[SIMPLEPROFILE_CHAR2_LEN] = {0};

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

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

@@ -165,7 +145,6 @@ static uint8 simpleProfileChar3[SIMPLEPROFILE_CHAR3_LEN] = {0};
 // Simple Profile Characteristic 3 User Description
 static uint8 simpleProfileChar3UserDesp[17] = "Characteristic 3";

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

@@ -181,12 +160,11 @@ static gattCharCfg_t *simpleProfileChar4Config;
 // Simple Profile Characteristic 4 User Description
 static uint8 simpleProfileChar4UserDesp[17] = "Characteristic 4";

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

 // Characteristic 5 Value
-static uint8 simpleProfileChar5[SIMPLEPROFILE_CHAR5_LEN] = { 0, 0, 0, 0, 0 };
+static uint8 simpleProfileChar5[SIMPLEPROFILE_CHAR5_LEN] = {0, 0, 0, 0, 0};

 // Simple Profile Characteristic 5 User Description
 static uint8 simpleProfileChar5UserDesp[17] = "Characteristic 5";
@@ -195,157 +173,69 @@ static uint8 simpleProfileChar5UserDesp[17] = "Characteristic 5";
 * Profile Attributes - Table
 */

-static gattAttribute_t simpleProfileAttrTbl[SERVAPP_NUM_ATTR_SUPPORTED] =
-{
-  // Simple Profile Service
-  {
-    { ATT_BT_UUID_SIZE, primaryServiceUUID }, /* type */
-    GATT_PERMIT_READ,                         /* permissions */
-    0,                                        /* handle */
-    (uint8 *)&simpleProfileService            /* pValue */
-  },
+static gattAttribute_t simpleProfileAttrTbl[SERVAPP_NUM_ATTR_SUPPORTED] = {
+    // Simple Profile Service
+    {
+        {ATT_BT_UUID_SIZE, primaryServiceUUID}, /* type */
+        GATT_PERMIT_READ,                       /* permissions */
+        0,                                      /* handle */
+        (uint8 *)&simpleProfileService          /* pValue */
+    },

    // Characteristic 1 Declaration
-    {
-      { ATT_BT_UUID_SIZE, characterUUID },
-      GATT_PERMIT_READ,
-      0,
-      &simpleProfileChar1Props
-    },
+    {{ATT_BT_UUID_SIZE, characterUUID}, GATT_PERMIT_READ, 0, &simpleProfileChar1Props},

-      // Characteristic Value 1
-      {
-        { ATT_BT_UUID_SIZE, simpleProfilechar1UUID },
-        GATT_PERMIT_READ | GATT_PERMIT_WRITE,
-        0,
-        &simpleProfileChar1
-      },
+    // Characteristic Value 1
+    {{ATT_BT_UUID_SIZE, simpleProfilechar1UUID}, GATT_PERMIT_READ, 0, simpleProfileChar1},

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

    // Characteristic 2 Declaration
-    {
-      { ATT_BT_UUID_SIZE, characterUUID },
-      GATT_PERMIT_READ,
-      0,
-      &simpleProfileChar2Props
-    },
+    {{ATT_BT_UUID_SIZE, characterUUID}, GATT_PERMIT_READ, 0, &simpleProfileChar2Props},

-      // Characteristic Value 2
-      {
-        { ATT_BT_UUID_SIZE, simpleProfilechar2UUID },
-        GATT_PERMIT_READ,
-        0,
-        &simpleProfileChar2
-      },
+    // Characteristic Value 2
+    {{ATT_BT_UUID_SIZE, simpleProfilechar2UUID}, GATT_PERMIT_READ, 0, simpleProfileChar2},

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

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

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

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

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

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

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

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

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

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

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

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

 /*********************************************************************
 * PROFILE CALLBACKS
@@ -359,11 +249,10 @@ static bStatus_t simpleProfile_WriteAttrCB(uint16_t connHandle,
 // pfnAuthorizeAttrCB to check a client's authorization prior to calling
 // pfnReadAttrCB or pfnWriteAttrCB, so no checks for authorization need to be
 // made within these functions.
-CONST gattServiceCBs_t simpleProfileCBs =
-{
-  simpleProfile_ReadAttrCB,  // Read callback function pointer
-  simpleProfile_WriteAttrCB, // Write callback function pointer
-  NULL                       // Authorization callback function pointer
+CONST gattServiceCBs_t simpleProfileCBs = {
+    simpleProfile_ReadAttrCB,   // Read callback function pointer
+    simpleProfile_WriteAttrCB,  // Write callback function pointer
+    NULL                        // Authorization callback function pointer
 };

 /*********************************************************************
@@ -381,35 +270,26 @@ CONST gattServiceCBs_t simpleProfileCBs =
 *
 * @return  Success or Failure
 */
-bStatus_t SimpleProfile_AddService( uint32 services )
-{
-  uint8 status;
+bStatus_t SimpleProfile_AddService(uint32 services) {
+    uint8 status;

-  // Allocate Client Characteristic Configuration table
-  simpleProfileChar4Config = (gattCharCfg_t *)ICall_malloc( sizeof(gattCharCfg_t) *
-                                                            linkDBNumConns );
-  if ( simpleProfileChar4Config == NULL )
-  {
-    return ( bleMemAllocError );
-  }
+    // Allocate Client Characteristic Configuration table
+    simpleProfileChar4Config = (gattCharCfg_t *)ICall_malloc(sizeof(gattCharCfg_t) * linkDBNumConns);
+    if (simpleProfileChar4Config == NULL) {
+        return (bleMemAllocError);
+    }

-  // Initialize Client Characteristic Configuration attributes
-  GATTServApp_InitCharCfg( INVALID_CONNHANDLE, simpleProfileChar4Config );
+    // Initialize Client Characteristic Configuration attributes
+    GATTServApp_InitCharCfg(INVALID_CONNHANDLE, simpleProfileChar4Config);

-  if ( services & SIMPLEPROFILE_SERVICE )
-  {
-    // Register GATT attribute list and CBs with GATT Server App
-    status = GATTServApp_RegisterService( simpleProfileAttrTbl,
-                                          GATT_NUM_ATTRS( simpleProfileAttrTbl ),
-                                          GATT_MAX_ENCRYPT_KEY_SIZE,
-                                          &simpleProfileCBs );
-  }
-  else
-  {
-    status = SUCCESS;
-  }
+    if (services & SIMPLEPROFILE_SERVICE) {
+        // Register GATT attribute list and CBs with GATT Server App
+        status = GATTServApp_RegisterService(simpleProfileAttrTbl, GATT_NUM_ATTRS(simpleProfileAttrTbl), GATT_MAX_ENCRYPT_KEY_SIZE, &simpleProfileCBs);
+    } else {
+        status = SUCCESS;
+    }

-  return ( status );
+    return (status);
 }

 /*********************************************************************
@@ -422,18 +302,14 @@ bStatus_t SimpleProfile_AddService( uint32 services )
 *
 * @return  SUCCESS or bleAlreadyInRequestedMode
 */
-bStatus_t SimpleProfile_RegisterAppCBs( simpleProfileCBs_t *appCallbacks )
-{
-  if ( appCallbacks )
-  {
-    simpleProfile_AppCBs = appCallbacks;
+bStatus_t SimpleProfile_RegisterAppCBs(simpleProfileCBs_t *appCallbacks) {
+    if (appCallbacks) {
+        simpleProfile_AppCBs = appCallbacks;

-    return ( SUCCESS );
-  }
-  else
-  {
-    return ( bleAlreadyInRequestedMode );
-  }
+        return (SUCCESS);
+    } else {
+        return (bleAlreadyInRequestedMode);
+    }
 }

 /*********************************************************************
@@ -450,77 +326,61 @@ bStatus_t SimpleProfile_RegisterAppCBs( simpleProfileCBs_t *appCallbacks )
 *
 * @return  bStatus_t
 */
-bStatus_t SimpleProfile_SetParameter( uint8 param, uint8 len, void *value )
-{
-  bStatus_t ret = SUCCESS;
-  switch ( param )
-  {
+bStatus_t SimpleProfile_SetParameter(uint8 param, uint8 len, void *value) {
+    bStatus_t ret = SUCCESS;
+    switch (param) {
    case SIMPLEPROFILE_CHAR1:
-      if ( len == sizeof ( uint8 ) )
-      {
-        simpleProfileChar1 = *((uint8*)value);
-      }
-      else
-      {
-        ret = bleInvalidRange;
-      }
-      break;
+        if (len <= SIMPLEPROFILE_CHAR1_LEN) {
+            memcpy(simpleProfileChar1, value, len);
+            //        simpleProfileChar1 = *((uint8*)value);
+        } else {
+            ret = bleInvalidRange;
+        }
+        break;

    case SIMPLEPROFILE_CHAR2:
-      if ( len == sizeof ( uint8 ) )
-      {
-        simpleProfileChar2 = *((uint8*)value);
-      }
-      else
-      {
-        ret = bleInvalidRange;
-      }
-      break;
+        if (len <= SIMPLEPROFILE_CHAR2_LEN) {
+            memcpy(simpleProfileChar2, value, len);
+            //        simpleProfileChar2 = *((uint8*)value);
+
+        } else {
+            ret = bleInvalidRange;
+        }
+        break;

    case SIMPLEPROFILE_CHAR3:
-      if ( len <= SIMPLEPROFILE_CHAR3_LEN )
-      {
-        memcpy(simpleProfileChar3,value,len);
-      }
-      else
-      {
-        ret = bleInvalidRange;
-      }
-      break;
+        if (len <= SIMPLEPROFILE_CHAR3_LEN) {
+            memcpy(simpleProfileChar3, value, len);
+        } else {
+            ret = bleInvalidRange;
+        }
+        break;

    case SIMPLEPROFILE_CHAR4:
-      if ( len <= SIMPLEPROFILE_CHAR4_LEN )
-      {
-          memcpy( simpleProfileChar4, value, len);
+        if (len <= SIMPLEPROFILE_CHAR4_LEN) {
+            memcpy(simpleProfileChar4, value, len);

-        // See if Notification has been enabled
-        GATTServApp_ProcessCharCfg( simpleProfileChar4Config, simpleProfileChar4, FALSE,
-                                    simpleProfileAttrTbl, GATT_NUM_ATTRS( simpleProfileAttrTbl ),
-                                    INVALID_TASK_ID, simpleProfile_ReadAttrCB );
-      }
-      else
-      {
-        ret = bleInvalidRange;
-      }
-      break;
+            // See if Notification has been enabled
+            GATTServApp_ProcessCharCfg(simpleProfileChar4Config, simpleProfileChar4, FALSE, simpleProfileAttrTbl, GATT_NUM_ATTRS(simpleProfileAttrTbl), INVALID_TASK_ID, simpleProfile_ReadAttrCB);
+        } else {
+            ret = bleInvalidRange;
+        }
+        break;

    case SIMPLEPROFILE_CHAR5:
-      if ( len == SIMPLEPROFILE_CHAR5_LEN )
-      {
-        VOID memcpy( simpleProfileChar5, value, SIMPLEPROFILE_CHAR5_LEN );
-      }
-      else
-      {
-        ret = bleInvalidRange;
-      }
-      break;
+        if (len == SIMPLEPROFILE_CHAR5_LEN) {
+            VOID memcpy(simpleProfileChar5, value, SIMPLEPROFILE_CHAR5_LEN);
+        } else {
+            ret = bleInvalidRange;
+        }
+        break;

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

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

 /*********************************************************************
@@ -536,37 +396,37 @@ bStatus_t SimpleProfile_SetParameter( uint8 param, uint8 len, void *value )
 *
 * @return  bStatus_t
 */
-bStatus_t SimpleProfile_GetParameter( uint8 param, void *value )
-{
-  bStatus_t ret = SUCCESS;
-  switch ( param )
-  {
+bStatus_t SimpleProfile_GetParameter(uint8 param, void *value) {
+    bStatus_t ret = SUCCESS;
+    switch (param) {
    case SIMPLEPROFILE_CHAR1:
-      *((uint8*)value) = simpleProfileChar1;
-      break;
+        memcpy(value, simpleProfileChar1, SIMPLEPROFILE_CHAR1_LEN);
+        //      *((uint8*)value) = simpleProfileChar1;
+        break;

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

    case SIMPLEPROFILE_CHAR3:
-        memcpy( value, simpleProfileChar3, SIMPLEPROFILE_CHAR3_LEN );
-      break;
+        memcpy(value, simpleProfileChar3, SIMPLEPROFILE_CHAR3_LEN);
+        break;

    case SIMPLEPROFILE_CHAR4:
-        memcpy( value, simpleProfileChar4, SIMPLEPROFILE_CHAR4_LEN );
-      break;
+        memcpy(value, simpleProfileChar4, SIMPLEPROFILE_CHAR4_LEN);
+        break;

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

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

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

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

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

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

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

-  if ( pAttr->type.len == ATT_BT_UUID_SIZE )
-  {
-    // 16-bit UUID
-    uint16 uuid = BUILD_UINT16( pAttr->type.uuid[0], pAttr->type.uuid[1]);
-    switch ( uuid )
-    {
-      case SIMPLEPROFILE_CHAR1_UUID:
-
-        //Validate the value
-        // Make sure it's not a blob oper
-        if ( offset == 0 )
-        {
-          if ( len != 1 )
-          {
-            status = ATT_ERR_INVALID_VALUE_SIZE;
-          }
-        }
-        else
-        {
-          status = ATT_ERR_ATTR_NOT_LONG;
-        }
-
-        //Write the value
-        if ( status == SUCCESS )
-        {
-          uint8 *pCurValue = (uint8 *)pAttr->pValue;
-          *pCurValue = pValue[0];
-
-          if( pAttr->pValue == &simpleProfileChar1 )
-          {
-            notifyApp = SIMPLEPROFILE_CHAR1;
-          }
-        }
-
-        break;
-      case SIMPLEPROFILE_CHAR3_UUID:
-          if ( offset == 0 )
-          {
-            if ( len > SIMPLEPROFILE_CHAR3_LEN )
+    if (pAttr->type.len == ATT_BT_UUID_SIZE) {
+        // 16-bit UUID
+        uint16 uuid = BUILD_UINT16(pAttr->type.uuid[0], pAttr->type.uuid[1]);
+        switch (uuid) {
+            // Validate the value
+            // Make sure it's not a blob oper
+            /*
+            if ( offset == 0 )
            {
-              status = ATT_ERR_INVALID_VALUE_SIZE;
+              if ( len != 1 )
+              {
+                status = ATT_ERR_INVALID_VALUE_SIZE;
+              }
            }
-          }
-          else
-          {
-            status = ATT_ERR_ATTR_NOT_LONG;
-          }
-
-          //Write the value
-          if ( status == SUCCESS )
-          {
-              // Copy pValue into the variable we point to from the attribute table.
-              memcpy(pAttr->pValue + offset, pValue, len);
-
-            if( pAttr->pValue == simpleProfileChar3 )
+            else
            {
-              notifyApp = SIMPLEPROFILE_CHAR3;
+              status = ATT_ERR_ATTR_NOT_LONG;
            }
-          }

-          break;
-      case GATT_CLIENT_CHAR_CFG_UUID:
-        status = GATTServApp_ProcessCCCWriteReq( connHandle, pAttr, pValue, len,
-                                                 offset, GATT_CLIENT_CFG_NOTIFY );
-        break;
+            //Write the value
+            if ( status == SUCCESS )
+            {
+              uint8 *pCurValue = (uint8 *)pAttr->pValue;
+              *pCurValue = pValue[0];

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

-  // If a characteristic value changed then callback function to notify application of change
-  if ( (notifyApp != 0xFF ) && simpleProfile_AppCBs && simpleProfile_AppCBs->pfnSimpleProfileChange )
-  {
-    simpleProfile_AppCBs->pfnSimpleProfileChange( notifyApp );
-  }
+    // If a characteristic value changed then callback function to notify application of change
+    if ((notifyApp != 0xFF) && simpleProfile_AppCBs && simpleProfile_AppCBs->pfnSimpleProfileChange) {
+        simpleProfile_AppCBs->pfnSimpleProfileChange(notifyApp);
+    }

-  return ( status );
+    return (status);
 }

 /*********************************************************************
@@ -334,7 +334,7 @@ bStatus_t SimpleProfile_RegisterAppCB(simpleProfileWrite_t writeCB,
 * @param   value - pointer to data to write.  This is dependent on
 *          the parameter ID and WILL be cast to the appropriate
 *          data type (example: data type of uint16 will be cast to
- *          uint16 pointer).
+ *          uint16 pointer).1
 *
 * @return  bStatus_t
 */
@@ -85,8 +85,9 @@ extern "C"

 // Length of Characteristic 5 in bytes
 #define SIMPLEPROFILE_CHAR5_LEN           5
-#define SIMPLEPROFILE_CHAR4_LEN           8
-#define SIMPLEPROFILE_CHAR3_LEN           8
+#define SIMPLEPROFILE_CHAR4_LEN           20
+#define SIMPLEPROFILE_CHAR3_LEN           20
+#define SIMPLEPROFILE_CHAR2_LEN           20

 /*********************************************************************
 * TYPEDEFS
@@ -97,7 +98,7 @@ extern "C"
 * MACROS
 */

-/*********************************************************************
+/*********************************************************************c
 * Profile Callbacks
 */

--- a/Show More
+++ b/Show More
				`@@ -1 +0,0 @@`
				`../simplelink/ble_sdk_2_02_02_25/src/common/cc26xx/`
				`@@ -1 +0,0 @@`
				`../tirtos_cc13xx_cc26xx_2_21_01_08/products/cc26xxware_2_24_03_17272/`
				`@@ -1 +0,0 @@`
				`../simplelink/ble_sdk_2_02_02_25/src/examples/host_test/cc26xx/app/`
				`@@ -1 +0,0 @@`
				`../simplelink/ble_sdk_2_02_02_25/src/icall/inc/`
				`@@ -1 +0,0 @@`
				`../simplelink/ble_sdk_2_02_02_25/src/profiles/roles/`
				`@@ -1 +0,0 @@`
				`../simplelink/ble_sdk_2_02_02_25/src/target/`