移除无用的文件
authorSnickerSun <snickersun@163.com>
Wed, 27 Dec 2023 14:49:58 +0000 (22:49 +0800)
committerSnickerSun <snickersun@163.com>
Wed, 27 Dec 2023 14:49:58 +0000 (22:49 +0800)
移动button,lcd,touch驱动到 code/sdk/drivers/peripheral,同时在目录中添加 acc mag ppg驱动路径

88 files changed:
autuobuild.sh
code/sdk/application/battery/battery.c.txt [deleted file]
code/sdk/application/brandy/brandy_standard/thread_pri_init.c.bak [deleted file]
code/sdk/drivers/CMakeLists.txt
code/sdk/drivers/drivers/driver/touch/CMakeLists.txt.bak [deleted file]
code/sdk/drivers/drivers/driver/touch/ft6x46_touch/ft6x46_ctrl.h.bak [deleted file]
code/sdk/drivers/drivers/driver/touch/touch_screen_drv.c.bak [deleted file]
code/sdk/drivers/peripheral/CMakeLists.txt [new file with mode: 0644]
code/sdk/drivers/peripheral/acc/CMakeLists.txt [new file with mode: 0644]
code/sdk/drivers/peripheral/acc/lis2doc_STdC/README.txt [new file with mode: 0644]
code/sdk/drivers/peripheral/acc/lis2doc_STdC/driver/lis2doc_reg.c [new file with mode: 0644]
code/sdk/drivers/peripheral/acc/lis2doc_STdC/driver/lis2doc_reg.h [new file with mode: 0644]
code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_activity.c [new file with mode: 0644]
code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_free_fall.c [new file with mode: 0644]
code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_orientation.c [new file with mode: 0644]
code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_read_data_polling.c [new file with mode: 0644]
code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_read_data_single.c [new file with mode: 0644]
code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_read_fifo.c [new file with mode: 0644]
code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_self_test.c [new file with mode: 0644]
code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_tap_double.c [new file with mode: 0644]
code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_tap_single.c [new file with mode: 0644]
code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_wake_up.c [new file with mode: 0644]
code/sdk/drivers/peripheral/button/CMakeLists.txt [moved from code/sdk/drivers/drivers/driver/button/CMakeLists.txt with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/button/button.c [moved from code/sdk/drivers/drivers/driver/button/button.c with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/button/button.h [moved from code/sdk/drivers/drivers/driver/button/button.h with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/lcd/CMakeLists.txt [moved from code/sdk/drivers/drivers/driver/lcd/CMakeLists.txt with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/lcd/lcd_bus.c [moved from code/sdk/drivers/drivers/driver/lcd/lcd_bus.c with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/lcd/lcd_bus.h [moved from code/sdk/drivers/drivers/driver/lcd/lcd_bus.h with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/lcd/lcd_common.c [moved from code/sdk/drivers/drivers/driver/lcd/lcd_common.c with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/lcd/lcd_common.h [moved from code/sdk/drivers/drivers/driver/lcd/lcd_common.h with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/lcd/lcd_config.c [moved from code/sdk/drivers/drivers/driver/lcd/lcd_config.c with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/lcd/lcd_config.h [moved from code/sdk/drivers/drivers/driver/lcd/lcd_config.h with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/lcd/lcd_mipi.c [moved from code/sdk/drivers/drivers/driver/lcd/lcd_mipi.c with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/lcd/lcd_mipi.h [moved from code/sdk/drivers/drivers/driver/lcd/lcd_mipi.h with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/lcd/lcd_private.c [moved from code/sdk/drivers/drivers/driver/lcd/lcd_private.c with 94% similarity, mode: 0644]
code/sdk/drivers/peripheral/lcd/lcd_private.h [moved from code/sdk/drivers/drivers/driver/lcd/lcd_private.h with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/lcd/lcd_qspi.c [moved from code/sdk/drivers/drivers/driver/lcd/lcd_qspi.c with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/lcd/lcd_qspi.h [moved from code/sdk/drivers/drivers/driver/lcd/lcd_qspi.h with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/lcd/soc_lcd_api.c [moved from code/sdk/drivers/drivers/driver/lcd/soc_lcd_api.c with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/lcd/soc_lcd_api.h [moved from code/sdk/drivers/drivers/driver/lcd/soc_lcd_api.h with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/mag/CMakeLists.txt [new file with mode: 0644]
code/sdk/drivers/peripheral/mag/mmc5603/Customer.c [new file with mode: 0644]
code/sdk/drivers/peripheral/mag/mmc5603/Customer.h [new file with mode: 0644]
code/sdk/drivers/peripheral/mag/mmc5603/MMC5603.c [new file with mode: 0644]
code/sdk/drivers/peripheral/mag/mmc5603/MMC5603.h [new file with mode: 0644]
code/sdk/drivers/peripheral/mag/mmc5603/main_sample.c [new file with mode: 0644]
code/sdk/drivers/peripheral/ppg/CMakeLists.txt [new file with mode: 0644]
code/sdk/drivers/peripheral/ppg/hx3695/Gcc_HaiSiLib_hx3695_Hrs_Spo2_hrv_20231215_v0.1.a [new file with mode: 0644]
code/sdk/drivers/peripheral/ppg/hx3695/hx3695.c [new file with mode: 0644]
code/sdk/drivers/peripheral/ppg/hx3695/hx3695.h [new file with mode: 0644]
code/sdk/drivers/peripheral/ppg/hx3695/hx3695_check_touch.c [new file with mode: 0644]
code/sdk/drivers/peripheral/ppg/hx3695/hx3695_check_touch.h [new file with mode: 0644]
code/sdk/drivers/peripheral/ppg/hx3695/hx3695_factory_test.c [new file with mode: 0644]
code/sdk/drivers/peripheral/ppg/hx3695/hx3695_factory_test.h [new file with mode: 0644]
code/sdk/drivers/peripheral/ppg/hx3695/hx3695_hrs_agc.c [new file with mode: 0644]
code/sdk/drivers/peripheral/ppg/hx3695/hx3695_hrs_agc.h [new file with mode: 0644]
code/sdk/drivers/peripheral/ppg/hx3695/hx3695_hrv_agc.c [new file with mode: 0644]
code/sdk/drivers/peripheral/ppg/hx3695/hx3695_hrv_agc.h [new file with mode: 0644]
code/sdk/drivers/peripheral/ppg/hx3695/hx3695_spo2_agc.c [new file with mode: 0644]
code/sdk/drivers/peripheral/ppg/hx3695/hx3695_spo2_agc.h [new file with mode: 0644]
code/sdk/drivers/peripheral/ppg/hx3695/tyhx_hrs_alg.h [new file with mode: 0644]
code/sdk/drivers/peripheral/ppg/hx3695/tyhx_hrv_alg.h [new file with mode: 0644]
code/sdk/drivers/peripheral/ppg/hx3695/tyhx_spo2_alg.h [new file with mode: 0644]
code/sdk/drivers/peripheral/touch/CMakeLists.txt [moved from code/sdk/drivers/drivers/driver/touch/CMakeLists.txt with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/touch/ft6x46_touch/ft6x46_ctrl.c [moved from code/sdk/drivers/drivers/driver/touch/ft6x46_touch/ft6x46_ctrl.c with 98% similarity, mode: 0644]
code/sdk/drivers/peripheral/touch/ft6x46_touch/ft6x46_ctrl.h [moved from code/sdk/drivers/drivers/driver/touch/ft6x46_touch/ft6x46_ctrl.h with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/touch/ft6x46_touch/ft6x46_drv1.c [moved from code/sdk/drivers/drivers/driver/touch/ft6x46_touch/ft6x46_drv1.c with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/touch/ft6x46_touch/ft6x46_drv1.h [moved from code/sdk/drivers/drivers/driver/touch/ft6x46_touch/ft6x46_drv1.h with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/touch/ft6x46_touch/ft6x46_touch1.c [moved from code/sdk/drivers/drivers/driver/touch/ft6x46_touch/ft6x46_touch1.c with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/touch/ft6x46_touch/ft6x46_touch1.h [moved from code/sdk/drivers/drivers/driver/touch/ft6x46_touch/ft6x46_touch1.h with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/touch/tma525b_touch/tma525b_ctrl.c [moved from code/sdk/drivers/drivers/driver/touch/tma525b_touch/tma525b_ctrl.c with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/touch/tma525b_touch/tma525b_ctrl.h [moved from code/sdk/drivers/drivers/driver/touch/tma525b_touch/tma525b_ctrl.h with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/touch/tma525b_touch/tma525b_drv1.c [moved from code/sdk/drivers/drivers/driver/touch/tma525b_touch/tma525b_drv1.c with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/touch/tma525b_touch/tma525b_drv1.h [moved from code/sdk/drivers/drivers/driver/touch/tma525b_touch/tma525b_drv1.h with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/touch/tma525b_touch/tma525b_touch1.c [moved from code/sdk/drivers/drivers/driver/touch/tma525b_touch/tma525b_touch1.c with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/touch/tma525b_touch/tma525b_touch1.h [moved from code/sdk/drivers/drivers/driver/touch/tma525b_touch/tma525b_touch1.h with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/touch/touch_screen_def.h [moved from code/sdk/drivers/drivers/driver/touch/touch_screen_def.h with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/touch/touch_screen_drv.c [moved from code/sdk/drivers/drivers/driver/touch/touch_screen_drv.c with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/touch/touch_screen_drv.h [moved from code/sdk/drivers/drivers/driver/touch/touch_screen_drv.h with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/touch/touch_screen_queue1.c [moved from code/sdk/drivers/drivers/driver/touch/touch_screen_queue1.c with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/touch/touch_screen_queue1.h [moved from code/sdk/drivers/drivers/driver/touch/touch_screen_queue1.h with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/touch/ztw523_touch/ztw523_ctrl.c [moved from code/sdk/drivers/drivers/driver/touch/ztw523_touch/ztw523_ctrl.c with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/touch/ztw523_touch/ztw523_ctrl.h [moved from code/sdk/drivers/drivers/driver/touch/ztw523_touch/ztw523_ctrl.h with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/touch/ztw523_touch/ztw523_drv1.c [moved from code/sdk/drivers/drivers/driver/touch/ztw523_touch/ztw523_drv1.c with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/touch/ztw523_touch/ztw523_drv1.h [moved from code/sdk/drivers/drivers/driver/touch/ztw523_touch/ztw523_drv1.h with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/touch/ztw523_touch/ztw523_touch1.c [moved from code/sdk/drivers/drivers/driver/touch/ztw523_touch/ztw523_touch1.c with 100% similarity, mode: 0644]
code/sdk/drivers/peripheral/touch/ztw523_touch/ztw523_touch1.h [moved from code/sdk/drivers/drivers/driver/touch/ztw523_touch/ztw523_touch1.h with 100% similarity, mode: 0644]
code/sdk/middleware/chips/brandy/pm/pm_adapt/pm_lp_stub.c.bak [deleted file]

index 72e1210..dd1a3fc 100644 (file)
@@ -29,7 +29,7 @@ cp_releasepackage()
        packsource=$HOMEDIR/code/sdk/tools/pkg/fwpkg/brandy/upload_app.fwpkg
        echo do release copy
        mkdir -p $releasedir
-       cp -r build.log $package_dir $releasedir/
+       cp -r $HOMEDIR/build.log $package_dir $releasedir/
        cp $packsource $releasedir/$filename
        echo $filename > $releasedir/readme.txt
        echo branch name $CURRENT_BRANCH >> $releasedir/readme.txt
@@ -65,4 +65,4 @@ build_target()
        cd $HOMEDIR
 }
  
-build_target | tee build.log
+build_target | tee $HOMEDIR/build.log
diff --git a/code/sdk/application/battery/battery.c.txt b/code/sdk/application/battery/battery.c.txt
deleted file mode 100644 (file)
index 638a40e..0000000
+++ /dev/null
@@ -1,463 +0,0 @@
-/**
- * Copyright (c) @CompanyNameMagicTag 2022-2022. All rights reserved. \n
- *
- * Description: Test adc source \n
- * Author: @CompanyNameTag \n
- * History: \n
- * 2022-08-16, Create file. \n
- */
-
-#include "adc.h"
-#define TEST_PARAM_ARGC_1 1
-#define TEST_PARAM_ARGC_2 2
-#define TEST_PARAM_ARGC_3 3
-#define TEST_PARAM_ARGC_4 4
-#define TEST_PARAM_ARGC_5 5
-#define TEST_PARAM_ARGC_6 6
-#define TEST_PARAM_ARGC_7 7
-#define TEST_PARAM_4_BYTES 4
-#define TEST_PARAM_8_BYTES 8
-typedef enum {
-    SUITE_OK = 0,
-    SUITE_UNKNOWN_FUNCTION = -1,
-    SUITE_ERROR_TIMED_OUT = -2,
-    SUITE_ERROR_BAD_PARAMS = -3,
-    SUITE_ERROR_PIN_ALLOCATION = -4,
-    SUITE_ERROR_PIN_DEALLOCATION = -5,
-    SUITE_ERROR_UNEXPECTED_INTERRUPT = -6,
-    SUITE_ALLOC_FAILED = -7,
-    SUITE_CONFIG_FAILED = -8,
-    SUITE_TEST_FAILED = -254,
-} battery_error_e;
-
-#if defined(CONFIG_ADC_SUPPORT_AFE)
-
-#error CONFIG_ADC_SUPPORT_AFE
-
-#include "hal_adc_v152.h"
-#include "hal_adc_v152_regs_op.h"
-#else
-#include "hal_adc_v151.h"
-#include "hal_adc_v151_regs_op.h"
-#endif
-#include "adc_porting.h"
-
-#include "pinctrl.h"
-
-#include "debug_print.h"
-#include "soc_osal.h"
-#include "tcxo.h"
-#include "irmalloc.h"
-#include "errcode.h"
-#include "common_def.h"
-
-#include "battery.h"
-
-#if defined(CONFIG_ADC_SUPPORT_AFE)
-
-
-#define ADC_AUTO_SAMPLE_TEST_TIMES      1000
-#define HADC_DEFAULT_CALI               \
-{                                       \
-    .hadc_os_code = 0x68,               \
-    .hadc_wt_b22  = 0x75fdd,            \
-    .hadc_wt_b21  = 0x3ef67,            \
-    .hadc_wt_b20  = 0x1f7ae,            \
-    .hadc_wt_b19  = 0xfc3d,             \
-    .hadc_wt_b18  = 0x7e22,             \
-    .hadc_wt_b17  = 0x7dc9,             \
-    .hadc_wt_b16  = 0x3f01,             \
-    .hadc_wt_b15  = 0x1f80,             \
-    .hadc_wt_b14  = 0xfc5,              \
-    .hadc_wt_b13  = 0x800,              \
-    .hadc_wt_b12  = 0x800,              \
-    .hadc_wt_b11  = 0x400,              \
-    .hadc_wt_b10  = 0x200,              \
-    .hadc_wt_b9   = 0x100,              \
-    .dac_code1    = 0x200,              \
-    .dac_code2    = 0x1d5,              \
-}
-
-afe_config_t g_afe_config = HADC_DEFAULT_CALI;
-static bool g_afe_open_flag = false;
-
-static int gadc_open_test(int argc, char *argv[])
-{
-    if (argc < 1) {
-        return SUITE_ERROR_BAD_PARAMS;
-    }
-    adc_v152_gadc_channel_sel_t gadc_channel = (adc_v152_gadc_channel_sel_t)strtol(argv[0], NULL, 0);
-    if (gadc_channel > SINGLE_END_AINN4) {
-        return SUITE_ERROR_BAD_PARAMS;
-    }
-    errcode_t ret = uapi_adc_init(ADC_CLOCK_NONE);
-    if (ret != ERRCODE_SUCC) {
-        return ret;
-    }
-    uapi_adc_open_channel(gadc_channel);
-    uapi_adc_power_en(AFE_GADC_MODE, true);
-    adc_calibration(AFE_GADC_MODE, true, false, false);
-    hadc_gain_set(PGA_GAIN_EIGHT, IA_GAIN_SIXTEEN);
-    uapi_adc_manual_sample((adc_channel_t)AFE_GADC_MODE);
-    g_afe_open_flag = true;
-    return SUITE_OK;
-}
-
-static int hadc_open_test(int argc, char *argv[])
-{
-    UNUSED(argc);
-    UNUSED(argv);
-    bool cali_en = (bool)strtol(argv[0], NULL, 0);
-    errcode_t ret = uapi_adc_init(ADC_CLOCK_NONE);
-    if (ret != ERRCODE_SUCC) {
-        return ret;
-    }
-    uapi_adc_power_en(AFE_HADC_MODE, true);
-    if (cali_en) {
-        adc_calibration(AFE_HADC_MODE, true, true, true);
-        g_afe_config.hadc_os_code = reg32(0x57036244);  // hadc_os_code
-        g_afe_config.hadc_wt_b22  = reg32(0x570361B0);  // hadc_wt_b22
-        g_afe_config.hadc_wt_b21  = reg32(0x570361B4);  // hadc_wt_b21
-        g_afe_config.hadc_wt_b20  = reg32(0x570361B8);  // hadc_wt_b20
-        g_afe_config.hadc_wt_b19  = reg32(0x570361BC);  // hadc_wt_b19
-        g_afe_config.hadc_wt_b18  = reg32(0x570361C0);  // hadc_wt_b18
-        g_afe_config.hadc_wt_b17  = reg32(0x570361C4);  // hadc_wt_b17
-        g_afe_config.hadc_wt_b16  = reg32(0x570361C8);  // hadc_wt_b16
-        g_afe_config.hadc_wt_b15  = reg32(0x570361CC);  // hadc_wt_b15
-        g_afe_config.hadc_wt_b14  = reg32(0x570361D0);  // hadc_wt_b14
-        g_afe_config.hadc_wt_b13  = reg32(0x570361D4);  // hadc_wt_b13
-        g_afe_config.hadc_wt_b12  = reg32(0x570361D8);  // hadc_wt_b12
-        g_afe_config.hadc_wt_b11  = reg32(0x570361DC);  // hadc_wt_b11
-        g_afe_config.hadc_wt_b10  = reg32(0x570361E0);  // hadc_wt_b10
-        g_afe_config.hadc_wt_b9   = reg32(0x570361E4);  // hadc_wt_b9
-        g_afe_config.dac_code1    = reg32(0x570363D4);  // dac_code1
-        g_afe_config.dac_code2    = reg32(0x570363D8);  // dac_code2
-    } else {
-        afe_config_t afe_config = g_afe_config;
-        adc_set_cali_code(AFE_HADC_MODE, &afe_config);
-    }
-    uapi_adc_manual_sample(HADC_CHANNEL_0);
-    g_afe_open_flag = true;
-    return SUITE_OK;
-}
-
-static int adc_auto_sample_test(int argc, char *argv[])
-{
-    if (argc < 1) {
-        return SUITE_ERROR_BAD_PARAMS;
-    }
-    if (!g_afe_open_flag) {
-        return SUITE_TEST_FAILED;
-    }
-    adc_v152_gadc_channel_sel_t channel = (adc_v152_gadc_channel_sel_t)strtol(argv[0], NULL, 0);
-    uapi_adc_open_channel(channel);
-    int adc_value = 0;
-    adc_channel_t ch = channel <= SINGLE_END_AINN4 ? (adc_channel_t)AFE_GADC_MODE : HADC_CHANNEL_0;
-    uint32_t irq_sts = osal_irq_lock();
-    for (int i = 0; i < ADC_AUTO_SAMPLE_TEST_TIMES; i++) {
-        adc_value =  uapi_adc_auto_sample(ch);
-        suite_log_stringf("adc: 0x%x = %d\n", adc_value, adc_value);
-    }
-    UNUSED(adc_value);
-    osal_irq_restore(irq_sts);
-    return SUITE_OK;
-}
-
-static int hadc_power_on(int argc, char *argv[])
-{
-    UNUSED(argc);
-    UNUSED(argv);
-    uapi_adc_power_en(AFE_HADC_MODE, true);
-    adc_set_cali_code(AFE_HADC_MODE, &g_afe_config);
-    return SUITE_OK;
-}
-
-static int hadc_power_off(int argc, char *argv[])
-{
-    UNUSED(argc);
-    UNUSED(argv);
-    uapi_adc_power_en(AFE_HADC_MODE, false);
-    return SUITE_OK;
-}
-
-#else
-#define HAL_ADC_SAMPLE_NUMBER_CONFIG_0 10  /* Channel with buffer manual sample average number. */
-#define HAL_ADC_SAMPLE_NUMBER_CONFIG_1 10  /* Channel without buffer manual sample average number. */
-#define HAL_ADC_DISCARD_NUMBER_CONFIG_0 8  /* Channel with buffer manual sample discard number. */
-#define HAL_ADC_DISCARD_NUMBER_CONFIG_1 8  /* Channel without buffer manual sample discard number. */
-
-#define adc_trans_sytick_to_voltage(x) ((float)(((float)(x) * 17) / 40960))
-#define adc_trans_sytick_to_voltage_diff(x) ((float)(((float)((x) - 2048) * 17) / 20480))
-// #define adc_trans_sytick_to_voltage_without_auto_scan(x) ((float)(((float)(x) * 18) / 40960))
-#define adc_trans_sytick_to_voltage_without_auto_scan(x) ((float)(((float)(x) * 18) / 40960))
-
-static uint32_t g_adc_sample_times = 0;
-static uint32_t g_adc_sample_discard = 0;
-static uint32_t g_adc_sample_stick = 0;
-
-#define TESTADC_DISACRD_DELAY_MS      3
-#define MINIMUM_VOLTAGE_RANGE         2
-#define MAXIMUM_VOLTAGE_RANGE         17
-
-static uint32_t adc_get_sample_times(void)
-{
-    return g_adc_sample_times;
-}
-
-static uint32_t adc_get_sample_discard(void)
-{
-    return g_adc_sample_discard;
-}
-
-static void adc_set_sample_stick(uint32_t stick)
-{
-    g_adc_sample_stick = stick;
-}
-
-static uint32_t adc_get_sample_stick(void)
-{
-    return g_adc_sample_stick;
-}
-
-static float adc_stick_transfer_voltage(uint16_t stick, adc_channel_t channel)
-{
-#if defined(CONFIG_ADC_SUPPORT_AUTO_SCAN)
-    hal_adc_type_info_t *adc_cfg_info = NULL;
-    adc_cfg_info = adc_port_get_cfg();
-    /* diff channel: (stick - 2048)/ 2048 * 1.8 ; */
-    if (adc_cfg_info != NULL && adc_cfg_info[channel].channel_type == HAL_ADC_CHANNEL_TYPE_DIF_BUF) {
-        return adc_trans_sytick_to_voltage_diff(stick);
-    } else {
-        return adc_trans_sytick_to_voltage(stick);
-    }
-#else
-    UNUSED(channel);
-    return adc_trans_sytick_to_voltage_without_auto_scan(stick);
-#endif
-}
-
-static bool adc_get_sample_result(float *voltage, uint8_t channel)
-{
-    uint32_t sample_number = 0;
-    uint32_t discard_number = 0;
-    uint32_t stick = 0;
-    uint32_t sample_zero_count = 0;
-
-#if defined(CONFIG_ADC_SUPPORT_AUTO_SCAN)
-    if (uapi_adc_auto_scan_is_enabled()) { return false; }
-#endif /* CONFIG_ADC_SUPPORT_AUTO_SCAN */
-
-    if (channel >= ADC_CHANNEL_4) {
-        sample_number = HAL_ADC_SAMPLE_NUMBER_CONFIG_1;
-        discard_number = HAL_ADC_DISCARD_NUMBER_CONFIG_1;
-    } else {
-        sample_number = HAL_ADC_SAMPLE_NUMBER_CONFIG_0;
-        discard_number = HAL_ADC_DISCARD_NUMBER_CONFIG_0;
-    }
-
-    if (g_adc_sample_times != 0) {
-        sample_number = adc_get_sample_times();
-    }
-
-    if (g_adc_sample_discard != 0) {
-        discard_number = adc_get_sample_discard();
-    }
-
-    /* after channel is enabled, sample result is error in previous samplings, need to be discarded */
-    for (uint32_t i = 0; i < discard_number; i++) {
-        uapi_adc_manual_sample(ADC_CHANNEL_NONE);
-        uapi_tcxo_delay_ms((uint64_t)TESTADC_DISACRD_DELAY_MS);
-    }
-
-    for (uint32_t i = 0; i < sample_number; i++) {
-        uint32_t irq_sts = osal_irq_lock();
-        uint32_t sample_result = (uint32_t)uapi_adc_manual_sample(ADC_CHANNEL_NONE);
-        osal_printk("sample_result = %d.\r\n", sample_result);
-        if (sample_result == 0) { sample_zero_count++; }
-        stick += sample_result;
-        osal_irq_restore(irq_sts);
-    }
-    sample_number -= sample_zero_count;
-    if (sample_number > 0) {
-        stick = (stick / sample_number);
-    } else {
-        *voltage = 0;
-        return false;
-    }
-
-    adc_set_sample_stick(stick);
-    *voltage = adc_stick_transfer_voltage((uint16_t)stick, channel);
-
-    UNUSED(discard_number);
-    return true;
-}
-
-/**
- * @brief  Get voltage by the channel. Available voltage rang is 0V ~ 1.7V.
- * @param  voltage The sample result of voltage.
- * @param  channel The adc channel.
- * @return true when select channel success, false when seclect channel failed.
- */
-static bool adc_get_voltage_by_channel(float *voltage, uint8_t channel)
-{
-    bool ret = false;
-
-    uapi_adc_power_en(AFE_SCAN_MODE_MAX_NUM, true);
-    ret = uapi_adc_open_channel(channel);
-    if (ret == ERRCODE_SUCC) {
-        ret = adc_get_sample_result(voltage, channel);
-        if (ret) {
-            uapi_adc_close_channel(channel);
-            uapi_adc_power_en(AFE_SCAN_MODE_MAX_NUM, false);
-            return true;
-        }
-    } else {
-        osal_printk("uapi_adc_open_channel failed : %d\r\n", ret);
-    }
-
-    *voltage = 0;
-    uapi_adc_close_channel(channel);
-    uapi_adc_power_en(AFE_SCAN_MODE_MAX_NUM, false);
-    return false;
-}
-
-
-
-#if defined(CONFIG_ADC_SUPPORT_AUTO_SCAN)
-static bool g_adc_scan_continue = false;
-static void adc_callback(uint8_t ch, uint32_t *buffer, uint32_t length, bool *next)
-{
-    osal_printk("[IRQ]channel: %d, buffer:0x%x, len: %d. \r\n", ch, buffer, length);
-    uint64_t data = 0;
-#if defined(CONFIG_ADC_SUPPORT_LONG_SAMPLE)
-    osal_printk("sample data head: %d %d %d %d\r\n", buffer[0], buffer[TEST_PARAM_ARGC_1],
-        buffer[TEST_PARAM_ARGC_2], buffer[TEST_PARAM_ARGC_3]);
-    osal_printk("sample data tail: %d %d %d %d\r\n", buffer[length - TEST_PARAM_ARGC_4],
-        buffer[length - TEST_PARAM_ARGC_3], buffer[length - TEST_PARAM_ARGC_2], buffer[length - TEST_PARAM_ARGC_1]);
-#else
-    for (uint32_t i = 0; i < length; i++) {
-        osal_printk("[%d]data: %d\r\n", i, buffer[i]);
-        data += buffer[i];
-    }
-
-    if (length != 0) {
-        data = data / length;
-    }
-    osal_printk("average data: %d\r\n", (uint32_t)data);
-#endif
-    *next = g_adc_scan_continue;
-    UNUSED(ch);
-    UNUSED(buffer);
-    UNUSED(length);
-    UNUSED(next);
-}
-
-static int adc_stop_auto_scan(int argc, char *argv[])
-{
-    adc_channel_t channel;
-    if (argc != 1) { /* 1: Indicates the number of input parameters */
-        return SUITE_ERROR_BAD_PARAMS;
-    }
-    channel = (adc_channel_t)strtol(argv[0], NULL, 0);
-    if (uapi_adc_auto_scan_ch_disable((uint8_t)channel) == ERRCODE_SUCC) {
-        return SUITE_OK;
-    } else {
-        return SUITE_TEST_FAILED;
-    }
-}
-
-static int adc_start_auto_scan(int argc, char *argv[])
-{
-    pin_t pin;
-    pin_mode_t mode;
-#if defined(CONFIG_ADC_SUPPORT_LONG_SAMPLE)
-    if (argc != 7) { /* 7: Indicates the number of input parameters */
-        return SUITE_ERROR_BAD_PARAMS;
-    }
-#else
-    if (argc != 6) { /* 6: Indicates the number of input parameters */
-        return SUITE_ERROR_BAD_PARAMS;
-    }
-#endif
-    adc_channel_t channel;
-    channel = (adc_channel_t)strtol(argv[0], NULL, 0);
-    g_adc_scan_continue = (bool)strtol(argv[TEST_PARAM_ARGC_1], NULL, 0);
-    pin = (pin_t)strtol(argv[TEST_PARAM_ARGC_2], NULL, 0);
-    mode = (pin_mode_t)strtol(argv[TEST_PARAM_ARGC_3], NULL, 0);
-    adc_scan_config_t config = {
-        .type = (uint8_t)strtol(argv[TEST_PARAM_ARGC_4], NULL, 0),
-        .threshold_l = 0.5, /* 0.5: Threshold scan volatage(v) lower limit. */
-        .threshold_h = 1.5, /* 1.5: Threshold scan volatage(v) upper limit. */
-        .freq = (uint8_t)strtol(argv[TEST_PARAM_ARGC_5], NULL, 0),
-#if defined(CONFIG_ADC_SUPPORT_LONG_SAMPLE)
-        .long_sample_time = (uint32_t)strtol(argv[TEST_PARAM_ARGC_6], NULL, 0),
-#endif
-    };
-    osal_printk("chan: %d, freq: %d\r\n", channel, config.freq);
-#if defined(CONFIG_ADC_SUPPORT_LONG_SAMPLE)
-    osal_printk("long_sample_time = %d\n", config.long_sample_time);
-#endif
-
-    uapi_pin_set_mode(pin, mode);
-    uapi_adc_power_en(AFE_SCAN_MODE_MAX_NUM, true);
-    if (uapi_adc_auto_scan_ch_enable((uint8_t)channel, config, adc_callback) == ERRCODE_SUCC) {
-        return SUITE_OK;
-    } else {
-        return SUITE_TEST_FAILED;
-    }
-}
-#endif /* CONFIG_ADC_SUPPORT_AUTO_SCAN */
-#endif /* CONFIG_ADC_SUPPORT_AFE */
-bool battery_get_voltage_by_channel(float *voltage, uint8_t channel)
-{
-
-#if defined(CONFIG_ADC_SUPPORT_AFE)
-    // uapi_suite_add_function("gadc_open_test", "GAFE init & enable test <Sample end: 0~7>", gadc_open_test);
-    // uapi_suite_add_function("hadc_open_test", "HAFE init & enable test <Cali enable>", hadc_open_test);
-    // uapi_suite_add_function("auto_sample_test", "AFE auto sample test Params: <Sample end: GAFE:0~7 HAFE:8>",
-    //                              adc_auto_sample_test);
-    // uapi_suite_add_function("hadc_power_off", "HAFE low power test, power off hafe", hadc_power_off);
-    // uapi_suite_add_function("hadc_power_on", "HAFE low power test, power on hafe ", hadc_power_on);
-#else
-    uapi_adc_init(ADC_CLOCK_500KHZ);
-    // uapi_adc_power_en(AFE_SCAN_MODE_MAX_NUM, true);
-    // uapi_suite_add_function("adc_manual_test", "Params: <Channel>, <sample_times>, <discard_times>,"
-        // "<pin number>, <pin mode>", adc_manual_test);
-      // adc_channel_t channel;
-    
-    uint64_t time1, time2;
-    uint32_t param_index = 0;
-    // channel = (adc_channel_t)strtol(argv[param_index++], NULL, 0);
-    // g_adc_sample_times = (uint32_t)strtol(argv[param_index++], NULL, 0);
-    // g_adc_sample_discard = (uint32_t)strtol(argv[param_index++], NULL, 0);
-    // pin = (pin_t)strtol(argv[param_index++], NULL, 0);
-    // mode = (pin_mode_t)strtol(argv[param_index++], NULL, 0);
-    osal_printk("channel: %d, sample times: %d, discard: %d.\r\n", channel, g_adc_sample_times, g_adc_sample_discard);
-
-    // uapi_pin_set_mode(pin, mode);
-#if defined(CONFIG_ADC_SUPPORT_AUTO_SCAN)
-    uapi_adc_auto_scan_disable();
-#endif /* CONFIG_ADC_SUPPORT_AUTO_SCAN */
-    // osal_printk("PINMUX SET DONE\r\n");
-
-    time1 = uapi_tcxo_get_us();
-
-    if (!adc_get_voltage_by_channel(voltage, channel)) {
-        osal_printk("adc get sample result failed.\r\n");
-        return SUITE_TEST_FAILED;
-    }
-    time2 = uapi_tcxo_get_us();
-
-    osal_printk("tick: %d, Sample time: %d. \r\n", adc_get_sample_stick(),
-        (uint64_t)(time2 - time1));
-    osal_printk("voltage: %.4f.\r\n", voltage);
-
-        
-#if defined(CONFIG_ADC_SUPPORT_AUTO_SCAN)
-    // uapi_suite_add_function("adc_start_auto_scan", "Params: <Channel>, <scan mode:0|1 >, <freq>, <bool: continue>,"
-        // "<pin number>, <pin mode>", adc_start_auto_scan);
-    // uapi_suite_add_function("adc_stop_auto_scan", "Params: <Channel>", adc_stop_auto_scan);
-#endif /* CONFIG_ADC_SUPPORT_AUTO_SCAN */
-#endif /* CONFIG_ADC_SUPPORT_AFE */
-    return true;
-}
diff --git a/code/sdk/application/brandy/brandy_standard/thread_pri_init.c.bak b/code/sdk/application/brandy/brandy_standard/thread_pri_init.c.bak
deleted file mode 100755 (executable)
index d0b58dc..0000000
+++ /dev/null
@@ -1,259 +0,0 @@
-/*
- * Copyright (c) CompanyNameMagicTag 2021-2022. All rights reserved.
- * Description:   Application Core OS Priority Initialize Interface for Standard
- * Author:
- * Create: 2022-12-03
- */
-#include "debug_print.h"
-#include "thread_init.h"
-#include "common_def.h"
-#include "pm.h"
-#include "watchdog.h"
-#ifdef CFG_DRIVERS_MMC
-#ifdef __LITEOS__
-#include "soc/mmc.h"
-#endif
-#include "soc_mmc.h"
-#endif
-#include "soc_lcd_api.h"
-#ifdef CFG_DRIVERS_NANDFLASH
-#include "nandflash_config.h"
-#endif
-#if defined(TPTYPE_TMA525B)
-#include "tma525b_drv1.h"
-#elif defined(TPTYPE_ZTW523)
-#include "ztw523_touch1.h"
-#else
-#include "ztw523_touch1.h"
-#endif
-#include "thread_pri_init.h"
-#if DSP_EXIST == YES
-#include "soc_uapi_audio_sys.h"
-#include "soc_uapi_vendor.h"
-#include "soc_uapi_sound.h"
-/* Audio codec vendor select according to hardware connection:
- * define AUDIO_SMARTPA_AW88166 : macro to init smartpa aw88166;
- * define AUDIO_SMARTPA_AW88166_I2S_ID UAPI_SND_OUT_PORT_I2S0 : macro to specify i2s id connecting to smartpa aw88166;
- */
-#define AUDIO_SMARTPA_AW88262
-#define AUDIO_SMARTPA_AW88262_I2S_ID UAPI_SND_OUT_PORT_I2S2
-
-#endif /* DSP_EXIST */
-#include "panic.h"
-#include "board_init.h"
-#include "kernel_init.h"
-#ifdef SUPPORT_AT_OHOSFWK
-#include "ohosfwk_startup.h"
-#endif
-
-#define EMMC_BASE_ADDR              0x52062000
-#define TASK_PRIORITY_APP           (osPriority_t)(17)
-#define TICK_TEN_MS                 (10U)
-
-static void thread_main(const void *unused);
-void bt_acore_btc_ipc_receive_init(void);
-
-app_task_definition_t g_thread_pri = { { "thread_pri", 0, NULL, 0, NULL, (0x1000), TASK_PRIORITY_APP, 0, 0 },
-                                       (osThreadFunc_t)thread_main, NULL, NULL, USE_DTCM_MEM };
-store_class g_store_init_select = STORE_CLASS_NAND;
-
-#if defined(ENABLE_UIKIT) || defined(ENABLE_LVGL)
-static void sample_gfx_init(void)
-{
-#if defined(TPTYPE_TMA525B)
-    tma525b_host_init_sample();
-#elif defined(TPTYPE_ZTW523)
-    ztw523_host_init_sample();
-#else
-    ztw523_host_init_sample();
-#endif
-    uapi_lcd_init();
-#ifdef SUPPORT_GPU_GMMU
-    drv_gmmu_module_init();
-#endif
-    uapi_vau_module_init();
-    uapi_dpu_module_init();
-#ifdef SUPPORT_GPU_JPEG
-    uapi_jpeg_module_init();
-#endif
-}
-#endif
-
-#ifdef CFG_DRIVERS_MMC
-static void emmc_init(void)
-{
-    /**
-     * FPGA解复位, 设置CMD_CONFLICT_CHECK
-     * 之后才能设置管脚
-     */
-    writew(EMMC_BASE_ADDR + 0x508, 0);
-    init_emmc_pinmux();
-    int ret = emmc_drv_context_init();
-    if (ret != ENOERR) {
-        PRINT("emmc init error:[%d]"NEWLINE, ret);
-    }
-    mmc_set_first_init_flag(true);
-    mmc_set_sleep_init_flag(true);
-    PRINT("emmc init success\r\n");
-}
-#endif
-
-#ifdef CFG_DRIVERS_NANDFLASH
-static void nandflash_init(void)
-{
-    int32_t ret = 0;
-    ret = nandflash_filesystem_init();
-    if (ret != 0) {
-        PRINT("nandflash init error[%d]"NEWLINE, ret);
-    }
-    PRINT("nandflash init success\r\n");
-}
-#endif
-
-static void board_version_class_print(void)
-{
-    PRINT("**********startup info**********\r\n");
-    PRINT("os init class is %s."NEWLINE, (g_os_init_select == OS_CLASS_LITEOS) ? "liteos" : "freertos");
-    PRINT("store init class is %s."NEWLINE, (g_store_init_select == STORE_CLASS_NAND) ? "nandflash" : "emmc");
-    PRINT("display init class is %s."NEWLINE, (g_display_init_select == DISPLAY_CLASS_QSPI) ? "QSPI" : "MIPI");
-    PRINT("board init class is %s."NEWLINE, (g_board_init_select == BOARD_CLASS_E0B2) ? "E0B2" : "E0B4");
-    PRINT("psram density is %s."NEWLINE, (get_psram_density() == PSRAM_DENSITY_16M) ? "16MB" : "32MB");
-    PRINT("**********startup info**********\r\n");
-}
-
-#if DSP_EXIST == YES
-/**
- * The sample code of the vendor,
- * which will be implemented by the customer in the future
- */
-#ifdef AUDIO_SMARTPA_AW88262
-td_s32 audio_aw88262_init(const uapi_vendor_codec_attr *attr);
-td_s32 audio_aw88262_deinit(td_void);
-
-static uapi_vendor_driver g_aw88262_driver = {
-    .out_port = AUDIO_SMARTPA_AW88262_I2S_ID,
-    .init = audio_aw88262_init,
-    .deinit = audio_aw88262_deinit,
-    .set_aef_profile = TD_NULL,
-};
-
-static td_s32 audio_aw88262_register_driver(void)
-{
-    return uapi_audio_vendor_register(&g_aw88262_driver);
-}
-#endif /* AUDIO_SMARTPA_AW88262 */
-
-#ifdef AUDIO_SMARTPA_AW88166
-td_s32 audio_aw88166_init(const uapi_vendor_codec_attr *attr);
-td_s32 audio_aw88166_deinit(td_void); /* Call when device power off */
-td_s32 audio_aw88166_start(const uapi_vendor_codec_attr *attr);
-td_s32 audio_aw88166_stop(td_void);
-td_s32 audio_aw88166_set_aef_profile(uapi_snd_aef_profile aef_profile);
-
-static uapi_vendor_driver g_aw88166_driver = {
-    .out_port = AUDIO_SMARTPA_AW88166_I2S_ID,
-    .init = audio_aw88166_start,
-    .deinit = audio_aw88166_stop,
-    .set_aef_profile = audio_aw88166_set_aef_profile,
-};
-
-static td_s32 audio_aw88166_register_driver(void)
-{
-    const uapi_vendor_codec_attr attr = {};
-
-    audio_aw88166_init(&attr); /* Init aw88166 once when device power on */
-
-    return uapi_audio_vendor_register(&g_aw88166_driver);
-}
-#endif /* AUDIO_SMARTPA_AW88166 */
-
-static void audio_smartpa_init(void)
-{
-    uint32_t ret;
-
-#ifdef AUDIO_SMARTPA_AW88262
-    ret = (uint32_t)audio_aw88262_register_driver();
-    if (ret != 0) {
-        PRINT("aw88262 register driver error\r\n");
-    }
-#endif /* AUDIO_SMARTPA_AW88262 */
-
-#ifdef AUDIO_SMARTPA_AW88166
-    ret = (uint32_t)audio_aw88166_register_driver();
-    if (ret != 0) {
-        PRINT("aw88166 register driver error\r\n");
-    }
-#endif /* AUDIO_SMARTPA_AW88166 */
-}
-#endif /* DSP_EXIST */
-
-#if DSP_EXIST == YES
-static void audio_init()
-{
-    (void)osDelay(TICK_TEN_MS);
-    uapi_watchdog_kick();
-
-    audio_smartpa_init();
-
-    uint32_t ret = (uint32_t)uapi_audio_init();
-    if (ret != 0) {
-        PRINT("audio init error:[%d]\r\n", ret);
-    } else {
-        PRINT("audio init OK\r\n");
-    }
-}
-#endif
-
-static void thread_main(const void *unused)
-{
-    PRINT("thread_main start "NEWLINE);
-    unused(unused);
-    bt_acore_btc_ipc_receive_init();
-    uapi_pm_control(PM_BT_POWER_UP_AND_RUN);
-    los_vfs_init();
-    uint32_t ret = dpal_driver_base_init();
-    if (ret != 0) {
-        PRINT("dpal driver base init error"NEWLINE);
-        panic(PANIC_ASSERT, __LINE__);
-    }
-#ifdef CFG_DRIVERS_MMC
-    emmc_init();
-    g_store_init_select = STORE_CLASS_EMMC;
-    sdiom_internal_freq_handler_register(mmc_set_internal_clk);
-#endif
-#ifdef CFG_DRIVERS_NANDFLASH
-    nandflash_init();
-    g_store_init_select = STORE_CLASS_NAND;
-#endif
-    uapi_pm_control(PM_DISPLAY_POWER_UP_AND_RUN);
-    (void)osDelay(TICK_TEN_MS);
-
-#if defined(ENABLE_UIKIT) || defined(ENABLE_LVGL)
-    sample_gfx_init();
-#else
-    uapi_pm_control(PM_DISPLAY_POWER_OFF);
-#endif
-
-#if DSP_EXIST == YES
-    audio_init();
-#endif
-    board_version_class_print();
-    uapi_watchdog_kick();
-    thread_init();
-    button_app_init();
-    uapi_calendar_init();
-#ifdef SUPPORT_AT_OHOSFWK
-    ohos_startup();
-#endif
-    uapi_pm_remove_sleep_veto(PM_ID_DEBUG);
-    set_startup_finish_flag();
-}
-
-void thread_pri_init(void)
-{
-    /* Create tasks */
-    g_thread_pri.task_handle = osThreadNew(g_thread_pri.func, NULL, &(g_thread_pri.attr));
-    if (g_thread_pri.task_handle == NULL) {
-        PRINT("create thread pri failed!");
-    }
-}
index bf356eb..73b9301 100755 (executable)
@@ -6,4 +6,5 @@
 add_subdirectory_if_exist(drivers)
 add_subdirectory_if_exist(boards)
 add_subdirectory_if_exist(chips)
-add_subdirectory_if_exist(adapter)
\ No newline at end of file
+add_subdirectory_if_exist(adapter)
+add_subdirectory_if_exist(peripheral)
diff --git a/code/sdk/drivers/drivers/driver/touch/CMakeLists.txt.bak b/code/sdk/drivers/drivers/driver/touch/CMakeLists.txt.bak
deleted file mode 100755 (executable)
index 6782d9c..0000000
+++ /dev/null
@@ -1,80 +0,0 @@
-#===============================================================================
-# @brief    cmake file
-# Copyright (c) @CompanyNameMagicTag 2023-2023. All rights reserved.
-#===============================================================================
-set(COMPONENT_NAME "touch")
-
-set(SOURCES
-    ${CMAKE_CURRENT_SOURCE_DIR}/touch_screen_drv.c
-    ${CMAKE_CURRENT_SOURCE_DIR}/touch_screen_queue1.c
-)
-
-if("TPTYPE_TMA525B" IN_LIST DEFINES)
-set(SOURCES ${SOURCES}
-    ${CMAKE_CURRENT_SOURCE_DIR}/tma525b_touch/tma525b_ctrl.c
-    ${CMAKE_CURRENT_SOURCE_DIR}/tma525b_touch/tma525b_drv1.c
-    ${CMAKE_CURRENT_SOURCE_DIR}/tma525b_touch/tma525b_touch1.c
-)
-elseif("TPTYPE_ZTW523" IN_LIST DEFINES)
-set(SOURCES ${SOURCES}
-    ${CMAKE_CURRENT_SOURCE_DIR}/ztw523_touch/ztw523_ctrl.c
-    ${CMAKE_CURRENT_SOURCE_DIR}/ztw523_touch/ztw523_drv1.c
-    ${CMAKE_CURRENT_SOURCE_DIR}/ztw523_touch/ztw523_touch1.c
-)
-else()
-set(SOURCES ${SOURCES}
-    ${CMAKE_CURRENT_SOURCE_DIR}/ztw523_touch/ztw523_ctrl.c
-    ${CMAKE_CURRENT_SOURCE_DIR}/ztw523_touch/ztw523_drv1.c
-    ${CMAKE_CURRENT_SOURCE_DIR}/ztw523_touch/ztw523_touch1.c
-)
-endif()
-
-if("TPTYPE_TMA525B" IN_LIST DEFINES)
-set(PUBLIC_HEADER
-    ${CMAKE_CURRENT_SOURCE_DIR}
-    ${CMAKE_CURRENT_SOURCE_DIR}/tma525b_touch
-    ${ROOT_DIR}/middleware/services/gui/hal/input/include
-)
-elseif("TPTYPE_ZTW523" IN_LIST DEFINES)
-set(PUBLIC_HEADER
-    ${CMAKE_CURRENT_SOURCE_DIR}
-    ${CMAKE_CURRENT_SOURCE_DIR}/ztw523_touch
-    ${ROOT_DIR}/middleware/services/gui/hal/input/include
-)
-else()
-set(PUBLIC_HEADER
-    ${CMAKE_CURRENT_SOURCE_DIR}
-    ${CMAKE_CURRENT_SOURCE_DIR}/ztw523_touch
-    ${ROOT_DIR}/middleware/services/gui/hal/input/include
-)
-endif()
-
-set(PRIVATE_HEADER
-)
-
-set(PRIVATE_DEFINES
-)
-
-set(PUBLIC_DEFINES
-)
-
-# use this when you want to add ccflags like -include xxx
-set(COMPONENT_PUBLIC_CCFLAGS
-)
-
-set(COMPONENT_CCFLAGS
-    -Wno-incompatible-function-pointer-types
-    -Wno-unused-function
-)
-
-set(WHOLE_LINK
-    true
-)
-
-set(MAIN_COMPONENT
-    false
-)
-
-build_component()
-
-install_sdk(${CMAKE_CURRENT_SOURCE_DIR} "*")
diff --git a/code/sdk/drivers/drivers/driver/touch/ft6x46_touch/ft6x46_ctrl.h.bak b/code/sdk/drivers/drivers/driver/touch/ft6x46_touch/ft6x46_ctrl.h.bak
deleted file mode 100755 (executable)
index 2e66c59..0000000
+++ /dev/null
@@ -1,78 +0,0 @@
-/*
- * Copyright (c) @CompanyNameMagicTag 2021-2022. All rights reserved.
- * Description: ztw523 touch driver.
- * Author: @CompanyNameTag
- * Create: 2022-04-12
- */
-
-#ifndef FT6X46_CTRL_H
-#define FT6X46_CTRL_H
-
-#include "stdio.h"
-#include "debug_print.h"
-#include "stdint.h"
-#include "td_base.h"
-#include "platform_core.h"
-#include "ft6x46_touch1.h"
-
-/* host peripheral definitions */
-#if 0//CHIP_ASIC
-#define ZTW523_I2C_BUS            I2C_BUS_1
-#define ZTW523_INT_GPIO           S_AGPIO5
-#define ZTW523_RESET_GPIO         S_AGPIO4
-#else
-#define ZTW523_I2C_BUS            I2C_BUS_5
-#define ZTW523_INT_GPIO           S_MGPIO11
-#define ZTW523_RST_REG            0x5600201c
-#define ZTW523_RST_HIGH           3
-#define ZTW523_RST_LOW            0
-#endif
-
-#define ZTW523_I2C_ADDR           0x20
-#define FT6X46_I2C_ADDR           0x38
-#define ZTW523_I2C_SPEED          I2C_SPEED_MODE_SS
-#define ZTW523_REG_BYTE_LEN       2
-#define OFFSET_8_BITS             8
-#define ZTW523_REG_WRITE_LEN      4
-
-#define ZTW523_CMD_SEND_LEN       2
-#define FT6X46_CMD_SEND_LEN       1
-
-#define ZTW523_REG_DATA_LEN       2
-#define ZTW523_I2C_TIME_MAX       3
-
-#define ZTW523_I2C_SEND_INDEX0    0
-#define ZTW523_I2C_SEND_INDEX1    1
-#define ZTW523_I2C_SEND_INDEX2    2
-#define ZTW523_I2C_SEND_INDEX3    3
-typedef struct {
-    uint32_t int_gpio;
-    i2c_bus_t i2c_id;
-    uint32_t i2c_speed;
-} ztw523_ctrl_attr;
-
-typedef ext_errno (*ztw523_bus_init)(ztw523_ctrl_attr *attr);
-
-typedef struct {
-    ztw523_ctrl_attr attr;
-    ztw523_bus_init bus_init;
-} ztw523_ctrl_ops;
-
-ext_errno ztw523_host_peripheral_init(ztw523_ctrl_attr *attr);
-ext_errno ztw523_register_handle(const ztw523_ctrl_ops *peri_data, touch_callback func);
-ext_errno ztw523_unregister_handle(const ztw523_ctrl_ops *peri_data);
-ext_errno ztw523_reset(void);
-void ztw523_resume_reset(void);
-void ztw523_delay(uint32_t ms);
-
-ext_errno tp_i2c_data_read(uint16_t reg_addr, uint8_t *data_buf, uint32_t data_len);
-ext_errno tp_i2c_cmd_write(uint16_t cmd);
-ext_errno tp_i2c_reg_write(uint16_t reg_addr, uint16_t reg_cfg);
-ext_errno tp_i2c_data_write(uint16_t reg_addr, uint8_t *data_buf, uint32_t data_len);
-
-
-ext_errno tp_ft6x46_i2c_data_read(uint8_t reg_addr, uint8_t *data_buf, uint32_t data_len);
-ext_errno tp_ft6x46_i2c_data_write(uint8_t reg_addr, uint8_t *data_buf, uint16_t data_len);
-ext_errno tp_ft6x46_i2c_data_write_reg(uint8_t addr, uint8_t val);
-
-#endif
diff --git a/code/sdk/drivers/drivers/driver/touch/touch_screen_drv.c.bak b/code/sdk/drivers/drivers/driver/touch/touch_screen_drv.c.bak
deleted file mode 100755 (executable)
index c98e7c3..0000000
+++ /dev/null
@@ -1,405 +0,0 @@
-/*
- * Copyright (c) @CompanyNameMagicTag 2021-2021. All rights reserved.
- * Description: touch screen driver.
- * Author: @CompanyNameTag
- * Create: 2022-04-12
- */
-
-#include "touch_screen_drv.h"
-#include "tcxo.h"
-#include "common_def.h"
-#include "soc_osal.h"
-#include "touch_screen_def.h"
-#include "input_app.h"
-#if defined(TPTYPE_TMA525B)
-#include "tma525b_drv1.h"
-#elif defined(TPTYPE_ZTW523)
-#include "ztw523_drv1.h"
-#else
-#include "ztw523_drv1.h"
-#endif
-
-#define TOUCH_SCREEN_DEV_NAME_LEN 16
-#define TOUCH_SCREEN_DEVNAME "input/event"
-#define TOUCH_SCREEN_DYNAMIC_MINOR 65
-#define TOUCH_SCREEN_CMDID_MAX 16
-
-#define TOUCH_SCREEN_TASK_PRIO      5
-#define TOUCH_SCREEN_TASK_SIZE      0x800
-#define TOUCH_SCREEN_QUEUE_MAX_SIZE 60
-#define TOUCH_SCREEN_READY_EVENT    (1 << 0)
-
-struct ts_driver_data g_touch_drv = {0};
-struct ts_driver_data *g_attr = NULL;
-
-report_event_cb g_report_event_cb = NULL;
-
-#if defined(SUPPORT_POWER_MANAGER)
-event_callback_func g_power_manager_cb = NULL;
-#endif
-
-static struct ts_driver_data *touch_screen_get_driver_data(void)
-{
-    return &g_touch_drv;
-}
-
-static uint32_t touch_screen_get_state(struct ts_driver_data *tsdd)
-{
-    if (tsdd != NULL && tsdd->queue != NULL) {
-        return (uint32_t)ts_queue_is_empty(tsdd->queue);
-    }
-
-    if (tsdd == NULL) {
-        tp_err("tsdd is null!");
-        return EXT_ERR_FAILURE;
-    }
-    if (tsdd->queue == NULL) {
-        tp_err("tsdd queue is null!");
-    }
-
-    return EXT_ERR_FAILURE;
-}
-
-static void convert_touch_info(input_dev_data_t* data, input_event_info* touch_info)
-{
-    data->x = (int16_t)touch_info->tp_event_info.x_axis[0];
-    data->y = (int16_t)touch_info->tp_event_info.y_axis[0];
-    data->type = INDEV_TYPE_TOUCH;
-    data->timestamp = (uint32_t)touch_info->tv_usec;
-    if ((touch_info->tp_event == MC_TP_PRESS) || (touch_info->tp_event == MC_TP_MOVE)) {
-        data->state = INDEV_STATE_PRESS;
-    } else if (touch_info->tp_event == MC_TP_RELEASE) {
-        data->state = INDEV_STATE_RELEASE;
-    } else {
-        data->state = INDEV_STATE_UNKNOWN;
-    }
-}
-
-static void report_or_enqueue_event(input_event_info* touch_info, struct ts_driver_data *tsdd)
-{
-    if (g_report_event_cb != NULL) {
-        input_dev_data_t data;
-        convert_touch_info(&data, touch_info);
-        if (data.state == INDEV_STATE_UNKNOWN) {
-            return;
-        }
-        g_report_event_cb(&data);
-    } else {
-        int32_t ret = ts_en_queue(tsdd->queue, touch_info);
-        if (ret != EXT_ERR_SUCCESS) {
-            tp_err("Failed to enqueue ts queue! ret=0x%x", ret);
-        }
-    }
-}
-#if defined(SUPPORT_POWER_MANAGER)
-static void report_event_to_power_manager(input_event_info *touch_info)
-{
-    if (g_power_manager_cb != NULL) {
-        input_dev_data_t data;
-        convert_touch_info(&data, touch_info);
-        if (data.state == INDEV_STATE_UNKNOWN) {
-            return;
-        }
-        g_power_manager_cb(data.state, 0);
-    }
-    return;
-}
-
-uint32_t ts_register_power_manager_cb(event_callback_func callback)
-{
-    if (g_power_manager_cb != NULL) {
-        return EXT_ERR_FAILURE;
-    }
-    g_power_manager_cb = callback;
-    return EXT_ERR_SUCCESS;
-}
-#endif
-ext_errno touch_info_process(void)
-{
-    struct ts_driver_data *tsdd = touch_screen_get_driver_data();
-    input_event_info touch_info;
-    int32_t ret = 0;
-
-    if (tsdd->touch_api->touch_get_tpinfo != NULL) {
-        ret = tsdd->touch_api->touch_get_tpinfo((uint8_t *)(&touch_info), sizeof(input_event_info));
-        if (ret != EXT_ERR_SUCCESS) {
-            tp_err("get touch info fail! ret=0x%x", ret);
-        }
-
-        report_or_enqueue_event(&touch_info, tsdd);
-#if defined(SUPPORT_POWER_MANAGER)
-        report_event_to_power_manager(&touch_info);
-#endif
-    }
-
-    return EXT_ERR_SUCCESS;
-}
-
-static void ts_callback_func(void)
-{
-    ext_errno ret;
-    if (g_attr != NULL) {
-        common_notify_mail_t mail = {0};
-        mail.comm.app = APP_TOUCH;
-        ret = osal_msg_queue_write_copy(get_app_queue_id(), (void *)&mail,
-                                        sizeof(common_notify_mail_t), 0);
-        if (ret != OSAL_SUCCESS) {
-            tp_err("touch app msg send failed! err=0x%x! \r\n", ret);
-        }
-    }
-}
-
-static ext_errno ts_register_callback(struct ts_driver_data *attr)
-{
-    ext_errno ret = EXT_ERR_FAILURE;
-    g_attr = attr;
-
-    if (attr->touch_api->register_callback != NULL) {
-        ret = attr->touch_api->register_callback(attr->private_data, ts_callback_func);
-        if (ret != EXT_ERR_SUCCESS) {
-            tp_err("register touch screen callback fail! ret=0x%x", ret);
-            return ret;
-        }
-    } else {
-        tp_err("touch screen callback register func is empty!");
-    }
-
-    return ret;
-}
-
-static ext_errno ts_unregister_callback(struct ts_driver_data *attr)
-{
-    ext_errno ret = EXT_ERR_FAILURE;
-
-    if (attr->touch_api->unregister_callback != NULL) {
-        ret = attr->touch_api->unregister_callback(attr->private_data);
-        if (ret != EXT_ERR_SUCCESS) {
-            tp_err("unregister touch screen callback fail! ret=0x%x", ret);
-            return ret;
-        }
-        g_attr = NULL;
-    } else {
-        tp_err("touch screen callback unregister func is empty!");
-    }
-
-    return ret;
-}
-
-static int32_t ts_dev_open(const void *private_data)
-{
-    int32_t ret;
-    struct ts_driver_data *tsdd = NULL;
-    if (private_data == NULL) {
-        tp_err("ts_open: invalid dev or driver_data!\n");
-        return EXT_ERR_FAILURE;
-    }
-
-    // todo: get tsdd from private_data
-    tsdd = touch_screen_get_driver_data();
-    tsdd->queue = ts_init_queue(TOUCH_SCREEN_QUEUE_MAX_SIZE);
-    if (tsdd->queue == NULL) {
-        tp_err("create touch screen queue fail!\r\n");
-        return EXT_ERR_FAILURE;
-    }
-    ret = osal_event_init(&(tsdd->event));
-    if (ret != EXT_ERR_SUCCESS) {
-        tp_err("touch osal_event_init fail! ret=0x%x\r\n", ret);
-        return ret;
-    }
-
-    tsdd->task_handle = osal_kthread_create((osal_kthread_handler)touch_info_process,
-                                            (void *)touch_screen_get_driver_data(),
-                                            "touch_screen", TOUCH_SCREEN_TASK_SIZE);
-    if (tsdd->task_handle == NULL) {
-        tp_err("create touch screen thread fail!\r\n");
-        return EXT_ERR_FAILURE;
-    }
-    osal_kthread_set_priority(tsdd->task_handle, TOUCH_SCREEN_TASK_PRIO);
-
-    if (tsdd->touch_api->touch_init != NULL) {
-        ret = tsdd->touch_api->touch_init(tsdd->private_data);
-        if (ret != EXT_ERR_SUCCESS) {
-            tp_err("touch_init fail! ret=0x%x\r\n", ret);
-            return ret;
-        }
-    }
-
-    ret = ts_register_callback(tsdd);
-    if (ret != EXT_ERR_SUCCESS) {
-        tp_err("register callback fail! ret=0x%x\r\n", ret);
-        return ret;
-    }
-
-    return EXT_ERR_SUCCESS;
-}
-
-static int32_t ts_dev_release(const void *private_data)
-{
-    int32_t ret;
-    struct ts_driver_data *tsdd = NULL;
-    if (private_data == NULL) {
-        tp_err("ts_dev_release: invalid dev or driver_data!\n");
-        return EXT_ERR_FAILURE;
-    }
-
-    // todo: get tsdd from private_data
-    tsdd = touch_screen_get_driver_data();
-    ret = ts_unregister_callback(tsdd);
-    if (ret != EXT_ERR_SUCCESS) {
-        tp_err("unregister callback fail! ret=0x%x\r\n", ret);
-        return ret;
-    }
-    return EXT_ERR_SUCCESS;
-}
-
-static uint32_t ts_dev_poll(const osal_poll *osal_poll, const void *private_data)
-{
-    unused(osal_poll);
-    unused(private_data);
-    // todo: get tsdd from private_data
-    struct ts_driver_data *tsdd = NULL;
-    tsdd = touch_screen_get_driver_data();
-    if (tsdd == NULL) {
-        tp_err("ts_driver_data is NULL");
-        return EXT_ERR_FAILURE;
-    }
-
-    if (tsdd->ops->priv_operator != NULL && tsdd->ops->priv_operator(tsdd) == 0) {
-        return OSAL_POLLIN | OSAL_POLLRDNORM;
-    }
-
-    return EXT_ERR_SUCCESS;
-}
-
-static int32_t ts_ioctl_read_touch_info(uint32_t cmd, void *arg, const void *private_data)
-{
-    unused(cmd);
-    ext_errno ret;
-    struct ts_driver_data *tsdd = NULL;
-    input_event_info *touch_info = (input_event_info *)arg;
-
-    if (private_data == NULL) {
-        tp_err("invalid dev or driver_data!");
-        return EXT_ERR_FAILURE;
-    }
-
-    // todo: get tsdd from private_data
-    tsdd = touch_screen_get_driver_data();
-    if (tsdd->queue == NULL) {
-        tp_err("invalid touch screen queue!");
-        return EXT_ERR_FAILURE;
-    }
-
-    ret = ts_de_queue(tsdd->queue, touch_info);
-    if (ret != EXT_ERR_SUCCESS) {
-        tp_err("get touch info fail! ret=0x%x", ret);
-        return ret;
-    }
-
-    return EXT_ERR_SUCCESS;
-}
-
-static osal_ioctl_cmd g_ts_cmd_list[TOUCH_SCREEN_CMDID_MAX] = {
-    {TOUCH_SCREEN_GET_EVENT, ts_ioctl_read_touch_info},
-};
-
-static osal_dev *g_ts_dev = NULL;
-static osal_fileops g_ts_ops = {
-    .open = ts_dev_open,
-    .release = ts_dev_release,
-    .poll = ts_dev_poll,
-    .cmd_list = g_ts_cmd_list,
-    .cmd_cnt = sizeof(g_ts_cmd_list) / sizeof(g_ts_cmd_list[0]),
-};
-
-struct ts_ops g_ts_status_ops = {
-    .priv_operator  = touch_screen_get_state,
-};
-
-static ext_errno touch_screen_register_device(void)
-{
-    ext_errno ret;
-
-    g_touch_drv.private_data = touch_screen_get_peri_attr();
-    g_touch_drv.touch_api = touch_screen_get_api();
-    g_touch_drv.ops = &g_ts_status_ops;
-    g_ts_dev = osal_dev_create(TOUCH_SCREEN_DEVNAME);
-    g_ts_dev->minor = TOUCH_SCREEN_DYNAMIC_MINOR;
-    g_ts_dev->fops = &g_ts_ops;
-
-    ret = osal_dev_register(g_ts_dev);
-    if (ret != 0) {
-        tp_err("touch screen osal_dev_register --------failed! ret=0x%x\n", ret);
-        return EXT_ERR_FAILURE;
-    }
-
-    return EXT_ERR_SUCCESS;
-}
-
-ext_errno touch_screen_module_init(void)
-{
-    ext_errno ret;
-
-    ret = touch_screen_register_device();
-    if (ret != EXT_ERR_SUCCESS) {
-        tp_err("touch_screen_register_device ----------failed! ret=0x%x\n", ret);
-    }
-    tp_err("touch_screen_register_device ----------succ!!!\n");
-
-    return EXT_ERR_SUCCESS;
-}
-
-ext_errno touch_screen_module_deinit(void)
-{
-    return EXT_ERR_SUCCESS;
-}
-
-uint32_t ts_register_report_event_cb(report_event_cb callback)
-{
-    if (g_report_event_cb != NULL) {
-        return EXT_ERR_FAILURE;
-    }
-    g_report_event_cb = callback;
-    return EXT_ERR_SUCCESS;
-}
-
-uint32_t ts_unregister_report_event_cb(void)
-{
-    g_report_event_cb = NULL;
-    return EXT_ERR_SUCCESS;
-}
-
-uint32_t ts_init(void)
-{
-    int32_t ret;
-    struct ts_driver_data *tsdd = NULL;
-
-    g_touch_drv.private_data = touch_screen_get_peri_attr();
-    g_touch_drv.touch_api = touch_screen_get_api();
-    g_touch_drv.ops = &g_ts_status_ops;
-    tsdd = touch_screen_get_driver_data();
-    tsdd->queue = ts_init_queue(TOUCH_SCREEN_QUEUE_MAX_SIZE);
-    if (tsdd->queue == NULL) {
-        tp_err("create touch screen queue fail!\r\n");
-        return EXT_ERR_FAILURE;
-    }
-
-    ret = ts_register_callback(tsdd);
-    if (ret != EXT_ERR_SUCCESS) {
-        tp_err("register callback fail! ret=0x%x\r\n", ret);
-        return EXT_ERR_FAILURE;
-    }
-
-    return EXT_ERR_SUCCESS;
-}
-
-uint32_t ts_read(const input_dev_data_t* data)
-{
-    unused(data);
-    return EXT_ERR_SUCCESS;
-}
-
-uint32_t ts_close(void)
-{
-    return EXT_ERR_SUCCESS;
-}
diff --git a/code/sdk/drivers/peripheral/CMakeLists.txt b/code/sdk/drivers/peripheral/CMakeLists.txt
new file mode 100644 (file)
index 0000000..663c754
--- /dev/null
@@ -0,0 +1,11 @@
+#===============================================================================
+# @brief    cmake make file
+# Copyright (c) @CompanyNameMagicTag 2022-2022. All rights reserved.
+#===============================================================================
+# add_subdirectory(hal ${PROJECT_BINARY_DIR}/hal)
+add_subdirectory_if_exist(acc)
+add_subdirectory_if_exist(button)
+add_subdirectory_if_exist(lcd)
+add_subdirectory_if_exist(mag)
+add_subdirectory_if_exist(ppg)
+add_subdirectory_if_exist(touch)
diff --git a/code/sdk/drivers/peripheral/acc/CMakeLists.txt b/code/sdk/drivers/peripheral/acc/CMakeLists.txt
new file mode 100644 (file)
index 0000000..12d59f5
--- /dev/null
@@ -0,0 +1,64 @@
+#===============================================================================
+# @brief    cmake file
+# Copyright (c) @CompanyNameMagicTag 2023-2023. All rights reserved.
+#===============================================================================
+set(COMPONENT_NAME "acc_sensor")
+
+set(SOURCES
+    ${CMAKE_CURRENT_SOURCE_DIR}/touch_screen_drv.c
+    ${CMAKE_CURRENT_SOURCE_DIR}/touch_screen_queue1.c
+)
+
+if("ACC_LIS2DOC" IN_LIST DEFINES)
+set(SOURCES ${SOURCES}
+    ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/Customer.c
+    ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/main_sample.c
+    ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/MMC5603.c
+)
+else()
+set(SOURCES ${SOURCES}
+    ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/Customer.c
+    ${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/main_sample.c
+    ${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/MMC5603.c
+)
+endif()
+
+if("ACC_LIS2DOC" IN_LIST DEFINES)
+set(PUBLIC_HEADER
+    ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC
+)
+else()
+set(PUBLIC_HEADER
+    {CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC
+)
+endif()
+
+set(PRIVATE_HEADER
+)
+
+set(PRIVATE_DEFINES
+)
+
+set(PUBLIC_DEFINES
+)
+
+# use this when you want to add ccflags like -include xxx
+set(COMPONENT_PUBLIC_CCFLAGS
+)
+
+set(COMPONENT_CCFLAGS
+    -Wno-incompatible-function-pointer-types
+    -Wno-unused-function
+)
+
+set(WHOLE_LINK
+    true
+)
+
+set(MAIN_COMPONENT
+    false
+)
+
+build_component()
+
+install_sdk(${CMAKE_CURRENT_SOURCE_DIR} "*")
diff --git a/code/sdk/drivers/peripheral/acc/lis2doc_STdC/README.txt b/code/sdk/drivers/peripheral/acc/lis2doc_STdC/README.txt
new file mode 100644 (file)
index 0000000..ba55230
--- /dev/null
@@ -0,0 +1,18 @@
+\r
+In the 'driver' folder there are the driver files of Mems Sensor (.h and .c)    \r
+to be included in your project.                                                 \r
+                                                                                \r
+Driver documentation can be generate using Doxigen tool.                        \r
+                                                                                \r
+The driver is platform independent, you need only to complete the two functions \r
+for write and read from Mems Hardware Bus.                                      \r
+                                                                                \r
+The files (.c) in 'example' folder, are examples showing how to integrate           \r
+the Standard C driver in a project. They are written for STM32                  \r
+Microcontroller using CubeMX API, but you can use it as a guideline for         \r
+every hardware.                                                                 \r
+                                                                                \r
+www.st.com/mems                                                                 \r
+                                                                                \r
+LIS2DOC DS rev1                                                              \r
+\r
diff --git a/code/sdk/drivers/peripheral/acc/lis2doc_STdC/driver/lis2doc_reg.c b/code/sdk/drivers/peripheral/acc/lis2doc_STdC/driver/lis2doc_reg.c
new file mode 100644 (file)
index 0000000..90d9b53
--- /dev/null
@@ -0,0 +1,3195 @@
+/**\r
+  ******************************************************************************\r
+  * @file    lis2doc_reg.c\r
+  * @author  Sensors Software Solution Team\r
+  * @brief   LIS2DOC driver file\r
+  ******************************************************************************\r
+  * @attention\r
+  *\r
+  * <h2><center>&copy; Copyright (c) 2021 STMicroelectronics.\r
+  * All rights reserved.</center></h2>\r
+  *\r
+  * This software component is licensed by ST under BSD 3-Clause license,\r
+  * the "License"; You may not use this file except in compliance with the\r
+  * License. You may obtain a copy of the License at:\r
+  *                        opensource.org/licenses/BSD-3-Clause\r
+  *\r
+  ******************************************************************************\r
+  */\r
+\r
+#include "lis2doc_reg.h"\r
+\r
+/**\r
+  * @defgroup  LIS2DOC\r
+  * @brief     This file provides a set of functions needed to drive the\r
+  *            lis2doc enhanced inertial module.\r
+  * @{\r
+  *\r
+  */\r
+\r
+/**\r
+  * @defgroup  LIS2DOC_Interfaces_Functions\r
+  * @brief     This section provide a set of functions used to read and\r
+  *            write a generic register of the device.\r
+  *            MANDATORY: return 0 -> no Error.\r
+  * @{\r
+  *\r
+  */\r
+\r
+/**\r
+  * @brief  Read generic device register\r
+  *\r
+  * @param  ctx   read / write interface definitions(ptr)\r
+  * @param  reg   register to read\r
+  * @param  data  pointer to buffer that store the data read(ptr)\r
+  * @param  len   number of consecutive register to read\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t __weak lis2doc_read_reg(stmdev_ctx_t *ctx, uint8_t reg,\r
+                                 uint8_t *data,\r
+                                 uint16_t len)\r
+{\r
+  int32_t ret;\r
+\r
+  ret = ctx->read_reg(ctx->handle, reg, data, len);\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Write generic device register\r
+  *\r
+  * @param  ctx   read / write interface definitions(ptr)\r
+  * @param  reg   register to write\r
+  * @param  data  pointer to data to write in register reg(ptr)\r
+  * @param  len   number of consecutive register to write\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t __weak lis2doc_write_reg(stmdev_ctx_t *ctx, uint8_t reg,\r
+                                  uint8_t *data,\r
+                                  uint16_t len)\r
+{\r
+  int32_t ret;\r
+\r
+  ret = ctx->write_reg(ctx->handle, reg, data, len);\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @}\r
+  *\r
+  */\r
+\r
+/**\r
+  * @defgroup    LIS2DOC_Sensitivity\r
+  * @brief       These functions convert raw-data into engineering units.\r
+  * @{\r
+  *\r
+  */\r
+\r
+float_t lis2doc_from_fs2_to_mg(int16_t lsb)\r
+{\r
+  return ((float_t)lsb) * 0.061f;\r
+}\r
+\r
+float_t lis2doc_from_fs4_to_mg(int16_t lsb)\r
+{\r
+  return ((float_t)lsb) * 0.122f;\r
+}\r
+\r
+float_t lis2doc_from_fs8_to_mg(int16_t lsb)\r
+{\r
+  return ((float_t)lsb) * 0.244f;\r
+}\r
+\r
+float_t lis2doc_from_fs16_to_mg(int16_t lsb)\r
+{\r
+  return ((float_t)lsb) * 0.488f;\r
+}\r
+\r
+float_t lis2doc_from_fs2_lp1_to_mg(int16_t lsb)\r
+{\r
+  return ((float_t)lsb) * 0.061f;\r
+}\r
+\r
+float_t lis2doc_from_fs4_lp1_to_mg(int16_t lsb)\r
+{\r
+  return ((float_t)lsb) * 0.122f;\r
+}\r
+\r
+float_t lis2doc_from_fs8_lp1_to_mg(int16_t lsb)\r
+{\r
+  return ((float_t)lsb) * 0.244f;\r
+}\r
+\r
+float_t lis2doc_from_fs16_lp1_to_mg(int16_t lsb)\r
+{\r
+  return ((float_t)lsb) * 0.488f;\r
+}\r
+\r
+float_t lis2doc_from_lsb_to_celsius(int16_t lsb)\r
+{\r
+  return (((float_t)lsb / 256.0f) + 25.0f);\r
+}\r
+\r
+/**\r
+  * @}\r
+  *\r
+  */\r
+\r
+/**\r
+  * @defgroup  LIS2DOC_Data_Generation\r
+  * @brief     This section groups all the functions concerning\r
+  *            data generation\r
+  * @{\r
+  *\r
+  */\r
+\r
+/**\r
+  * @brief  Select accelerometer operating modes.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of mode / lp_mode in reg CTRL1\r
+  *                  and low_noise in reg CTRL6\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_power_mode_set(stmdev_ctx_t *ctx,\r
+                                lis2doc_mode_t val)\r
+{\r
+  lis2doc_ctrl1_t ctrl1;\r
+  lis2doc_ctrl6_t ctrl6;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL1, (uint8_t *) &ctrl1, 1);\r
+  if (ret != 0) { return ret; }\r
+\r
+  ctrl1.sdrc_en = val.sdrc;\r
+  ctrl1.lpm_en = val.lpm;\r
+  ctrl1.hpm_en = val.hpm;\r
+\r
+  ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL1, (uint8_t *) &ctrl1, 1);\r
+  if (ret != 0) { return ret; }\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL6, (uint8_t *) &ctrl6, 1);\r
+  ctrl6.low_noise = val.low_noise;\r
+  ret += lis2doc_write_reg(ctx, LIS2DOC_CTRL6, (uint8_t *) &ctrl6, 1);\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Select accelerometer operating modes.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of mode / lp_mode in reg CTRL1\r
+  *                  and low_noise in reg CTRL6\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_power_mode_get(stmdev_ctx_t *ctx,\r
+                                lis2doc_mode_t *val)\r
+{\r
+  lis2doc_ctrl1_t ctrl1;\r
+  lis2doc_ctrl6_t ctrl6;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL1, (uint8_t *) &ctrl1, 1);\r
+  ret += lis2doc_read_reg(ctx, LIS2DOC_CTRL6, (uint8_t *) &ctrl6, 1);\r
+  if (ret != 0) { return ret; }\r
+\r
+  val->sdrc = ctrl1.sdrc_en;\r
+  val->lpm = ctrl1.lpm_en;\r
+  val->hpm = ctrl1.hpm_en;\r
+  val->low_noise = ctrl6.low_noise;\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Accelerometer data rate selection.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of odr in reg CTRL1\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_data_rate_set(stmdev_ctx_t *ctx, lis2doc_odr_t val)\r
+{\r
+  lis2doc_ctrl1_t ctrl1;\r
+  lis2doc_ctrl3_t ctrl3;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL1, (uint8_t *) &ctrl1, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    ctrl1.odr = (uint8_t) val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL1, (uint8_t *) &ctrl1, 1);\r
+  }\r
+\r
+  if (ret == 0)\r
+  {\r
+    ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) &ctrl3, 1);\r
+  }\r
+\r
+  if (ret == 0)\r
+  {\r
+    ctrl3.slp_mode = ((uint8_t) val & 0x30U) >> 4;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) &ctrl3, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Accelerometer data rate selection.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      Get the values of odr in reg CTRL1\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_data_rate_get(stmdev_ctx_t *ctx, lis2doc_odr_t *val)\r
+{\r
+  lis2doc_ctrl1_t ctrl1;\r
+  lis2doc_ctrl3_t ctrl3;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL1, (uint8_t *) &ctrl1, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) &ctrl3, 1);\r
+\r
+    switch ((ctrl3.slp_mode << 4) + ctrl1.odr)\r
+    {\r
+      case LIS2DOC_XL_ODR_OFF:\r
+        *val = LIS2DOC_XL_ODR_OFF;\r
+        break;\r
+\r
+      case LIS2DOC_XL_ODR_1Hz6_LP_ONLY:\r
+        *val = LIS2DOC_XL_ODR_1Hz6_LP_ONLY;\r
+        break;\r
+\r
+      case LIS2DOC_XL_ODR_12Hz5:\r
+        *val = LIS2DOC_XL_ODR_12Hz5;\r
+        break;\r
+\r
+      case LIS2DOC_XL_ODR_25Hz:\r
+        *val = LIS2DOC_XL_ODR_25Hz;\r
+        break;\r
+\r
+      case LIS2DOC_XL_ODR_50Hz:\r
+        *val = LIS2DOC_XL_ODR_50Hz;\r
+        break;\r
+\r
+      case LIS2DOC_XL_ODR_100Hz:\r
+        *val = LIS2DOC_XL_ODR_100Hz;\r
+        break;\r
+\r
+      case LIS2DOC_XL_ODR_200Hz:\r
+        *val = LIS2DOC_XL_ODR_200Hz;\r
+        break;\r
+\r
+      case LIS2DOC_XL_ODR_400Hz:\r
+        *val = LIS2DOC_XL_ODR_400Hz;\r
+        break;\r
+\r
+      case LIS2DOC_XL_ODR_800Hz:\r
+        *val = LIS2DOC_XL_ODR_800Hz;\r
+        break;\r
+\r
+      case LIS2DOC_XL_ODR_1k6Hz:\r
+        *val = LIS2DOC_XL_ODR_1k6Hz;\r
+        break;\r
+\r
+      case LIS2DOC_XL_SET_SW_TRIG:\r
+        *val = LIS2DOC_XL_SET_SW_TRIG;\r
+        break;\r
+\r
+      case LIS2DOC_XL_SET_PIN_TRIG:\r
+        *val = LIS2DOC_XL_SET_PIN_TRIG;\r
+        break;\r
+\r
+      default:\r
+        *val = LIS2DOC_XL_ODR_OFF;\r
+        break;\r
+    }\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Block data update.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of bdu in reg CTRL2\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_block_data_update_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+  lis2doc_ctrl2_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.bdu = val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Block data update.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of bdu in reg CTRL2\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_block_data_update_get(stmdev_ctx_t *ctx,\r
+                                       uint8_t *val)\r
+{\r
+  lis2doc_ctrl2_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) &reg, 1);\r
+  *val = reg.bdu;\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Accelerometer full-scale selection.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of fs in reg CTRL6\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_full_scale_set(stmdev_ctx_t *ctx, lis2doc_fs_t val)\r
+{\r
+  lis2doc_ctrl6_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL6, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.fs = (uint8_t) val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL6, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Accelerometer full-scale selection.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      Get the values of fs in reg CTRL6\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_full_scale_get(stmdev_ctx_t *ctx, lis2doc_fs_t *val)\r
+{\r
+  lis2doc_ctrl6_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL6, (uint8_t *) &reg, 1);\r
+\r
+  switch (reg.fs)\r
+  {\r
+    case LIS2DOC_2g:\r
+      *val = LIS2DOC_2g;\r
+      break;\r
+\r
+    case LIS2DOC_4g:\r
+      *val = LIS2DOC_4g;\r
+      break;\r
+\r
+    case LIS2DOC_8g:\r
+      *val = LIS2DOC_8g;\r
+      break;\r
+\r
+    case LIS2DOC_16g:\r
+      *val = LIS2DOC_16g;\r
+      break;\r
+\r
+    default:\r
+      *val = LIS2DOC_2g;\r
+      break;\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  The STATUS_REG register of the device.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      union of registers from STATUS to\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_status_reg_get(stmdev_ctx_t *ctx,\r
+                                lis2doc_status_t *val)\r
+{\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_STATUS, (uint8_t *) val, 1);\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Accelerometer new data available.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of drdy in reg STATUS\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_flag_data_ready_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+  lis2doc_status_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_STATUS, (uint8_t *) &reg, 1);\r
+  *val = reg.drdy;\r
+\r
+  return ret;\r
+}\r
+/**\r
+  * @brief   Read all the interrupt/status flag of the device.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      registers STATUS_DUP, WAKE_UP_SRC,\r
+  *                  TAP_SRC, SIXD_SRC, ALL_INT_SRC\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_all_sources_get(stmdev_ctx_t *ctx,\r
+                                 lis2doc_all_sources_t *val)\r
+{\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_STATUS_DUP, (uint8_t *) val, 5);\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Accelerometer X-axis user offset correction expressed in two’s\r
+  *         complement, weight depends on bit USR_OFF_W. The value must be\r
+  *         in the range [-127 127].[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  buff     buffer that contains data to write\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_usr_offset_x_set(stmdev_ctx_t *ctx, uint8_t *buff)\r
+{\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_write_reg(ctx, LIS2DOC_X_OFS_USR, buff, 1);\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Accelerometer X-axis user offset correction expressed in two’s\r
+  *         complement, weight depends on bit USR_OFF_W. The value must be\r
+  *         in the range [-127 127].[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  buff     buffer that stores data read\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_usr_offset_x_get(stmdev_ctx_t *ctx, uint8_t *buff)\r
+{\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_X_OFS_USR, buff, 1);\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Accelerometer Y-axis user offset correction expressed in two’s\r
+  *         complement, weight depends on bit USR_OFF_W. The value must be\r
+  *         in the range [-127 127].[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  buff     buffer that contains data to write\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_usr_offset_y_set(stmdev_ctx_t *ctx, uint8_t *buff)\r
+{\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_write_reg(ctx, LIS2DOC_Y_OFS_USR, buff, 1);\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Accelerometer Y-axis user offset correction expressed in two’s\r
+  *         complement, weight depends on bit USR_OFF_W. The value must be\r
+  *         in the range [-127 127].[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  buff     buffer that stores data read\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_usr_offset_y_get(stmdev_ctx_t *ctx, uint8_t *buff)\r
+{\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_Y_OFS_USR, buff, 1);\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Accelerometer Z-axis user offset correction expressed in two’s\r
+  *         complement, weight depends on bit USR_OFF_W. The value must be\r
+  *         in the range [-127 127].[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  buff     buffer that contains data to write\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_usr_offset_z_set(stmdev_ctx_t *ctx, uint8_t *buff)\r
+{\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_write_reg(ctx, LIS2DOC_Z_OFS_USR, buff, 1);\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Accelerometer Z-axis user offset correction expressed in two’s\r
+  *         complement, weight depends on bit USR_OFF_W. The value must be\r
+  *         in the range [-127 127].[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  buff     buffer that stores data read\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_usr_offset_z_get(stmdev_ctx_t *ctx, uint8_t *buff)\r
+{\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_Z_OFS_USR, buff, 1);\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Weight of XL user offset bits of registers X_OFS_USR,\r
+  *         Y_OFS_USR, Z_OFS_USR.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of usr_off_w in\r
+  *                               reg CTRL_REG7\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_offset_weight_set(stmdev_ctx_t *ctx,\r
+                                   lis2doc_usr_off_w_t val)\r
+{\r
+  lis2doc_ctrl_reg7_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.usr_off_w = (uint8_t) val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Weight of XL user offset bits of registers X_OFS_USR,\r
+  *         Y_OFS_USR, Z_OFS_USR.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      Get the values of usr_off_w in reg CTRL_REG7\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_offset_weight_get(stmdev_ctx_t *ctx,\r
+                                   lis2doc_usr_off_w_t *val)\r
+{\r
+  lis2doc_ctrl_reg7_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) &reg, 1);\r
+\r
+  switch (reg.usr_off_w)\r
+  {\r
+    case LIS2DOC_LSb_977ug:\r
+      *val = LIS2DOC_LSb_977ug;\r
+      break;\r
+\r
+    case LIS2DOC_LSb_15mg6:\r
+      *val = LIS2DOC_LSb_15mg6;\r
+      break;\r
+\r
+    default:\r
+      *val = LIS2DOC_LSb_977ug;\r
+      break;\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @}\r
+  *\r
+  */\r
+\r
+/**\r
+  * @defgroup  LIS2DOC_Data_Output\r
+  * @brief     This section groups all the data output functions.\r
+  * @{\r
+  *\r
+  */\r
+\r
+/**\r
+  * @brief  Temperature data output register (r). L and H registers\r
+  *         together express a 16-bit word in two’s complement.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      buffer that stores data read\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_temperature_raw_get(stmdev_ctx_t *ctx, int16_t *val)\r
+{\r
+  uint8_t buff[2];\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_OUT_T_L, buff, 2);\r
+  *val = (int16_t)buff[1];\r
+  *val = (*val * 256) + (int16_t)buff[0];\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Linear acceleration output register. The value is expressed as\r
+  *         a 16-bit word in two’s complement.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      buffer that stores data read\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_acceleration_raw_get(stmdev_ctx_t *ctx, int16_t *val)\r
+{\r
+  uint8_t buff[6];\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_OUT_X_L, buff, 6);\r
+  val[0] = (int16_t)buff[1];\r
+  val[0] = (val[0] * 256) + (int16_t)buff[0];\r
+  val[1] = (int16_t)buff[3];\r
+  val[1] = (val[1] * 256) + (int16_t)buff[2];\r
+  val[2] = (int16_t)buff[5];\r
+  val[2] = (val[2] * 256) + (int16_t)buff[4];\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @}\r
+  *\r
+  */\r
+\r
+/**\r
+  * @defgroup  LIS2DOC_Common\r
+  * @brief     This section groups common useful functions.\r
+  * @{\r
+  *\r
+  */\r
+\r
+/**\r
+  * @brief  Device Who am I.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  buff     buffer that stores data read\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_device_id_get(stmdev_ctx_t *ctx, uint8_t *buff)\r
+{\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_WHO_AM_I, buff, 1);\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Register address automatically incremented during multiple byte\r
+  *         access with a serial interface.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of if_add_inc in reg CTRL2\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_auto_increment_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+  lis2doc_ctrl2_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.if_add_inc = val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Register address automatically incremented during multiple\r
+  *         byte access with a serial interface.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of if_add_inc in reg CTRL2\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_auto_increment_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+  lis2doc_ctrl2_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) &reg, 1);\r
+  *val = reg.if_add_inc;\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Software reset. Restore the default values in user registers.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of soft_reset in reg CTRL2\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_reset_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+  lis2doc_ctrl2_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.soft_reset = val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Software reset. Restore the default values in user registers.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of soft_reset in reg CTRL2\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_reset_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+  lis2doc_ctrl2_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) &reg, 1);\r
+  *val = reg.soft_reset;\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Reboot memory content. Reload the calibration parameters.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of boot in reg CTRL2\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_boot_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+  lis2doc_ctrl2_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.boot = val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Reboot memory content. Reload the calibration parameters.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of boot in reg CTRL2\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_boot_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+  lis2doc_ctrl2_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) &reg, 1);\r
+  *val = reg.boot;\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Sensor self-test enable.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of st in reg CTRL3\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_self_test_set(stmdev_ctx_t *ctx, lis2doc_st_t val)\r
+{\r
+  lis2doc_ctrl3_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.st = (uint8_t) val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Sensor self-test enable.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      Get the values of st in reg CTRL3\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_self_test_get(stmdev_ctx_t *ctx, lis2doc_st_t *val)\r
+{\r
+  lis2doc_ctrl3_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) &reg, 1);\r
+\r
+  switch (reg.st)\r
+  {\r
+    case LIS2DOC_XL_ST_DISABLE:\r
+      *val = LIS2DOC_XL_ST_DISABLE;\r
+      break;\r
+\r
+    case LIS2DOC_XL_ST_POSITIVE:\r
+      *val = LIS2DOC_XL_ST_POSITIVE;\r
+      break;\r
+\r
+    case LIS2DOC_XL_ST_NEGATIVE:\r
+      *val = LIS2DOC_XL_ST_NEGATIVE;\r
+      break;\r
+\r
+    default:\r
+      *val = LIS2DOC_XL_ST_DISABLE;\r
+      break;\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Data-ready pulsed / letched mode.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of drdy_pulsed in reg CTRL_REG7\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_data_ready_mode_set(stmdev_ctx_t *ctx,\r
+                                     lis2doc_drdy_pulsed_t val)\r
+{\r
+  lis2doc_ctrl_reg7_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.drdy_pulsed = (uint8_t) val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Data-ready pulsed / letched mode.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      Get the values of drdy_pulsed in reg CTRL_REG7\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_data_ready_mode_get(stmdev_ctx_t *ctx,\r
+                                     lis2doc_drdy_pulsed_t *val)\r
+{\r
+  lis2doc_ctrl_reg7_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) &reg, 1);\r
+\r
+  switch (reg.drdy_pulsed)\r
+  {\r
+    case LIS2DOC_DRDY_LATCHED:\r
+      *val = LIS2DOC_DRDY_LATCHED;\r
+      break;\r
+\r
+    case LIS2DOC_DRDY_PULSED:\r
+      *val = LIS2DOC_DRDY_PULSED;\r
+      break;\r
+\r
+    default:\r
+      *val = LIS2DOC_DRDY_LATCHED;\r
+      break;\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @}\r
+  *\r
+  */\r
+\r
+/**\r
+  * @defgroup  LIS2DOC_Filters\r
+  * @brief     This section group all the functions concerning the filters\r
+  *            configuration.\r
+  * @{\r
+  *\r
+  */\r
+\r
+/**\r
+  * @brief  Accelerometer filtering path for outputs.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of fds in reg CTRL6\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_filter_path_set(stmdev_ctx_t *ctx,\r
+                                 lis2doc_fds_t val)\r
+{\r
+  lis2doc_ctrl6_t ctrl6;\r
+  lis2doc_ctrl_reg7_t ctrl_reg7;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL6, (uint8_t *) &ctrl6, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    ctrl6.fds = ((uint8_t) val & 0x10U) >> 4;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL6, (uint8_t *) &ctrl6, 1);\r
+  }\r
+\r
+  if (ret == 0)\r
+  {\r
+    ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7,\r
+                            (uint8_t *) &ctrl_reg7, 1);\r
+  }\r
+\r
+  if (ret == 0)\r
+  {\r
+    ctrl_reg7.usr_off_on_out = (uint8_t) val & 0x01U;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL_REG7,\r
+                             (uint8_t *) &ctrl_reg7, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Accelerometer filtering path for outputs.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      Get the values of fds in reg CTRL6\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_filter_path_get(stmdev_ctx_t *ctx,\r
+                                 lis2doc_fds_t *val)\r
+{\r
+  lis2doc_ctrl6_t ctrl6;\r
+  lis2doc_ctrl_reg7_t ctrl_reg7;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL6, (uint8_t *) &ctrl6, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7,\r
+                            (uint8_t *) &ctrl_reg7, 1);\r
+\r
+    switch ((ctrl6.fds << 4) + ctrl_reg7.usr_off_on_out)\r
+    {\r
+      case LIS2DOC_LPF_ON_OUT:\r
+        *val = LIS2DOC_LPF_ON_OUT;\r
+        break;\r
+\r
+      case LIS2DOC_USER_OFFSET_ON_OUT:\r
+        *val = LIS2DOC_USER_OFFSET_ON_OUT;\r
+        break;\r
+\r
+      case LIS2DOC_HIGH_PASS_ON_OUT:\r
+        *val = LIS2DOC_HIGH_PASS_ON_OUT;\r
+        break;\r
+\r
+      default:\r
+        *val = LIS2DOC_LPF_ON_OUT;\r
+        break;\r
+    }\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief   Accelerometer cutoff filter frequency. Valid for low and high\r
+  *          pass filter.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of bw_filt in reg CTRL6\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_filter_bandwidth_set(stmdev_ctx_t *ctx,\r
+                                      lis2doc_bw_filt_t val)\r
+{\r
+  lis2doc_ctrl6_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL6, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.bw_filt = (uint8_t) val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL6, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief   Accelerometer cutoff filter frequency. Valid for low and\r
+  *          high pass filter.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      Get the values of bw_filt in reg CTRL6\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_filter_bandwidth_get(stmdev_ctx_t *ctx,\r
+                                      lis2doc_bw_filt_t *val)\r
+{\r
+  lis2doc_ctrl6_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL6, (uint8_t *) &reg, 1);\r
+\r
+  switch (reg.bw_filt)\r
+  {\r
+    case LIS2DOC_ODR_DIV_2:\r
+      *val = LIS2DOC_ODR_DIV_2;\r
+      break;\r
+\r
+    case LIS2DOC_ODR_DIV_4:\r
+      *val = LIS2DOC_ODR_DIV_4;\r
+      break;\r
+\r
+    case LIS2DOC_ODR_DIV_10:\r
+      *val = LIS2DOC_ODR_DIV_10;\r
+      break;\r
+\r
+    case LIS2DOC_ODR_DIV_20:\r
+      *val = LIS2DOC_ODR_DIV_20;\r
+      break;\r
+\r
+    default:\r
+      *val = LIS2DOC_ODR_DIV_2;\r
+      break;\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Enable HP filter reference mode.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of hp_ref_mode in reg CTRL_REG7\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_reference_mode_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+  lis2doc_ctrl_reg7_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.hp_ref_mode = val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Enable HP filter reference mode.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of hp_ref_mode in reg CTRL_REG7\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_reference_mode_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+  lis2doc_ctrl_reg7_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) &reg, 1);\r
+  *val = reg.hp_ref_mode;\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @}\r
+  *\r
+  */\r
+\r
+/**\r
+  * @defgroup   LIS2DOC_Serial_Interface\r
+  * @brief      This section groups all the functions concerning main serial\r
+  *             interface management (not auxiliary)\r
+  * @{\r
+  *\r
+  */\r
+\r
+/**\r
+  * @brief  SPI Serial Interface Mode selection.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of sim in reg CTRL2\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_spi_mode_set(stmdev_ctx_t *ctx, lis2doc_sim_t val)\r
+{\r
+  lis2doc_ctrl2_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.sim = (uint8_t) val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  SPI Serial Interface Mode selection.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      Get the values of sim in reg CTRL2\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_spi_mode_get(stmdev_ctx_t *ctx, lis2doc_sim_t *val)\r
+{\r
+  lis2doc_ctrl2_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) &reg, 1);\r
+\r
+  switch (reg.sim)\r
+  {\r
+    case LIS2DOC_SPI_4_WIRE:\r
+      *val = LIS2DOC_SPI_4_WIRE;\r
+      break;\r
+\r
+    case LIS2DOC_SPI_3_WIRE:\r
+      *val = LIS2DOC_SPI_3_WIRE;\r
+      break;\r
+\r
+    default:\r
+      *val = LIS2DOC_SPI_4_WIRE;\r
+      break;\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Disable / Enable I2C interface.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of i2c_disable in\r
+  *                                 reg CTRL2\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_i2c_interface_set(stmdev_ctx_t *ctx,\r
+                                   lis2doc_i2c_disable_t val)\r
+{\r
+  lis2doc_ctrl2_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.i2c_disable = (uint8_t) val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Disable / Enable I2C interface.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      Get the values of i2c_disable in reg CTRL2\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_i2c_interface_get(stmdev_ctx_t *ctx,\r
+                                   lis2doc_i2c_disable_t *val)\r
+{\r
+  lis2doc_ctrl2_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) &reg, 1);\r
+\r
+  switch (reg.i2c_disable)\r
+  {\r
+    case LIS2DOC_I2C_ENABLE:\r
+      *val = LIS2DOC_I2C_ENABLE;\r
+      break;\r
+\r
+    case LIS2DOC_I2C_DISABLE:\r
+      *val = LIS2DOC_I2C_DISABLE;\r
+      break;\r
+\r
+    default:\r
+      *val = LIS2DOC_I2C_ENABLE;\r
+      break;\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Disconnect CS pull-up.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of cs_pu_disc in reg CTRL2\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_cs_mode_set(stmdev_ctx_t *ctx,\r
+                             lis2doc_cs_pu_disc_t val)\r
+{\r
+  lis2doc_ctrl2_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.cs_pu_disc = (uint8_t) val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Disconnect CS pull-up.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      Get the values of cs_pu_disc in reg CTRL2\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_cs_mode_get(stmdev_ctx_t *ctx,\r
+                             lis2doc_cs_pu_disc_t *val)\r
+{\r
+  lis2doc_ctrl2_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) &reg, 1);\r
+\r
+  switch (reg.cs_pu_disc)\r
+  {\r
+    case LIS2DOC_PULL_UP_CONNECT:\r
+      *val = LIS2DOC_PULL_UP_CONNECT;\r
+      break;\r
+\r
+    case LIS2DOC_PULL_UP_DISCONNECT:\r
+      *val = LIS2DOC_PULL_UP_DISCONNECT;\r
+      break;\r
+\r
+    default:\r
+      *val = LIS2DOC_PULL_UP_CONNECT;\r
+      break;\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @}\r
+  *\r
+  */\r
+\r
+/**\r
+  * @defgroup  LIS2DOC_Interrupt_Pins\r
+  * @brief     This section groups all the functions that manage interrupt pins\r
+  * @{\r
+  *\r
+  */\r
+\r
+/**\r
+  * @brief  Interrupt active-high/low.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of h_lactive in reg CTRL3\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_pin_polarity_set(stmdev_ctx_t *ctx,\r
+                                  lis2doc_h_lactive_t val)\r
+{\r
+  lis2doc_ctrl3_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.h_lactive = (uint8_t) val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Interrupt active-high/low.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      Get the values of h_lactive in reg CTRL3\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_pin_polarity_get(stmdev_ctx_t *ctx,\r
+                                  lis2doc_h_lactive_t *val)\r
+{\r
+  lis2doc_ctrl3_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) &reg, 1);\r
+\r
+  switch (reg.h_lactive)\r
+  {\r
+    case LIS2DOC_ACTIVE_HIGH:\r
+      *val = LIS2DOC_ACTIVE_HIGH;\r
+      break;\r
+\r
+    case LIS2DOC_ACTIVE_LOW:\r
+      *val = LIS2DOC_ACTIVE_LOW;\r
+      break;\r
+\r
+    default:\r
+      *val = LIS2DOC_ACTIVE_HIGH;\r
+      break;\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Latched/pulsed interrupt.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of lir in reg CTRL3\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_int_notification_set(stmdev_ctx_t *ctx,\r
+                                      lis2doc_lir_t val)\r
+{\r
+  lis2doc_ctrl3_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.lir = (uint8_t) val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Latched/pulsed interrupt.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      Get the values of lir in reg CTRL3\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_int_notification_get(stmdev_ctx_t *ctx,\r
+                                      lis2doc_lir_t *val)\r
+{\r
+  lis2doc_ctrl3_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) &reg, 1);\r
+\r
+  switch (reg.lir)\r
+  {\r
+    case LIS2DOC_INT_PULSED:\r
+      *val = LIS2DOC_INT_PULSED;\r
+      break;\r
+\r
+    case LIS2DOC_INT_LATCHED:\r
+      *val = LIS2DOC_INT_LATCHED;\r
+      break;\r
+\r
+    default:\r
+      *val = LIS2DOC_INT_PULSED;\r
+      break;\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Push-pull/open drain selection on interrupt pads.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of pp_od in reg CTRL3\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_pin_mode_set(stmdev_ctx_t *ctx, lis2doc_pp_od_t val)\r
+{\r
+  lis2doc_ctrl3_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.pp_od = (uint8_t) val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Push-pull/open drain selection on interrupt pads.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      Get the values of pp_od in reg CTRL3\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_pin_mode_get(stmdev_ctx_t *ctx,\r
+                              lis2doc_pp_od_t *val)\r
+{\r
+  lis2doc_ctrl3_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) &reg, 1);\r
+\r
+  switch (reg.pp_od)\r
+  {\r
+    case LIS2DOC_PUSH_PULL:\r
+      *val = LIS2DOC_PUSH_PULL;\r
+      break;\r
+\r
+    case LIS2DOC_OPEN_DRAIN:\r
+      *val = LIS2DOC_OPEN_DRAIN;\r
+      break;\r
+\r
+    default:\r
+      *val = LIS2DOC_PUSH_PULL;\r
+      break;\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Select the signal that need to route on int1 pad.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      register CTRL4_INT1_PAD_CTRL.\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_pin_int1_route_set(stmdev_ctx_t *ctx,\r
+                                    lis2doc_ctrl4_int1_pad_ctrl_t *val)\r
+{\r
+  lis2doc_ctrl5_int2_pad_ctrl_t ctrl5_int2_pad_ctrl;\r
+  lis2doc_ctrl_reg7_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL5_INT2_PAD_CTRL,\r
+                          (uint8_t *)&ctrl5_int2_pad_ctrl, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  if (ret == 0)\r
+  {\r
+    if ((val->int1_tap |\r
+         val->int1_ff |\r
+         val->int1_wu |\r
+         val->int1_single_tap |\r
+         val->int1_6d |\r
+         ctrl5_int2_pad_ctrl.int2_sleep_state |\r
+         ctrl5_int2_pad_ctrl.int2_sleep_chg) != PROPERTY_DISABLE)\r
+    {\r
+      reg.interrupts_enable = PROPERTY_ENABLE;\r
+    }\r
+\r
+    else\r
+    {\r
+      reg.interrupts_enable = PROPERTY_DISABLE;\r
+    }\r
+\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL4_INT1_PAD_CTRL,\r
+                             (uint8_t *) val, 1);\r
+  }\r
+\r
+  if (ret == 0)\r
+  {\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Select the signal that need to route on int1 pad.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      register CTRL4_INT1_PAD_CTRL.\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_pin_int1_route_get(stmdev_ctx_t *ctx,\r
+                                    lis2doc_ctrl4_int1_pad_ctrl_t *val)\r
+{\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL4_INT1_PAD_CTRL,\r
+                          (uint8_t *) val, 1);\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief   Select the signal that need to route on int2 pad.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      register CTRL5_INT2_PAD_CTRL.\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_pin_int2_route_set(stmdev_ctx_t *ctx,\r
+                                    lis2doc_ctrl5_int2_pad_ctrl_t *val)\r
+{\r
+  lis2doc_ctrl4_int1_pad_ctrl_t ctrl4_int1_pad_ctrl;\r
+  lis2doc_ctrl_reg7_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL4_INT1_PAD_CTRL,\r
+                          (uint8_t *) &ctrl4_int1_pad_ctrl, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  if (ret == 0)\r
+  {\r
+    if ((ctrl4_int1_pad_ctrl.int1_tap |\r
+         ctrl4_int1_pad_ctrl.int1_ff |\r
+         ctrl4_int1_pad_ctrl.int1_wu |\r
+         ctrl4_int1_pad_ctrl.int1_single_tap |\r
+         ctrl4_int1_pad_ctrl.int1_6d |\r
+         val->int2_sleep_state | val->int2_sleep_chg) != PROPERTY_DISABLE)\r
+    {\r
+      reg.interrupts_enable = PROPERTY_ENABLE;\r
+    }\r
+\r
+    else\r
+    {\r
+      reg.interrupts_enable = PROPERTY_DISABLE;\r
+    }\r
+\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL5_INT2_PAD_CTRL,\r
+                             (uint8_t *) val, 1);\r
+  }\r
+\r
+  if (ret == 0)\r
+  {\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Select the signal that need to route on int2 pad.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      register CTRL5_INT2_PAD_CTRL\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_pin_int2_route_get(stmdev_ctx_t *ctx,\r
+                                    lis2doc_ctrl5_int2_pad_ctrl_t *val)\r
+{\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL5_INT2_PAD_CTRL,\r
+                          (uint8_t *) val, 1);\r
+\r
+  return ret;\r
+}\r
+/**\r
+  * @brief All interrupt signals become available on INT1 pin.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of int2_on_int1 in reg CTRL_REG7\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_all_on_int1_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+  lis2doc_ctrl_reg7_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.int2_on_int1 = val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  All interrupt signals become available on INT1 pin.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of int2_on_int1 in reg CTRL_REG7\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_all_on_int1_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+  lis2doc_ctrl_reg7_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) &reg, 1);\r
+  *val = reg.int2_on_int1;\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @}\r
+  *\r
+  */\r
+\r
+/**\r
+  * @defgroup  LIS2DOC_Wake_Up_Event\r
+  * @brief     This section groups all the functions that manage the Wake\r
+  *            Up event generation.\r
+  * @{\r
+  *\r
+  */\r
+\r
+/**\r
+  * @brief  Threshold for wakeup.1 LSB = FS_XL / 64.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of wk_ths in reg WAKE_UP_THS\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_wkup_threshold_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+  lis2doc_wake_up_ths_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_THS, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.wk_ths = val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_WAKE_UP_THS, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Threshold for wakeup.1 LSB = FS_XL / 64.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of wk_ths in reg WAKE_UP_THS\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_wkup_threshold_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+  lis2doc_wake_up_ths_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_THS, (uint8_t *) &reg, 1);\r
+  *val = reg.wk_ths;\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Wake up duration event.1LSb = 1 / ODR.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of wake_dur in reg WAKE_UP_DUR\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_wkup_dur_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+  lis2doc_wake_up_dur_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_DUR, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.wake_dur = val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_WAKE_UP_DUR, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Wake up duration event.1LSb = 1 / ODR.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of wake_dur in reg WAKE_UP_DUR\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_wkup_dur_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+  lis2doc_wake_up_dur_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_DUR, (uint8_t *) &reg, 1);\r
+  *val = reg.wake_dur;\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Data sent to wake-up interrupt function.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of usr_off_on_wu in reg CTRL_REG7\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_wkup_feed_data_set(stmdev_ctx_t *ctx,\r
+                                    lis2doc_usr_off_on_wu_t val)\r
+{\r
+  lis2doc_ctrl_reg7_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.usr_off_on_wu = (uint8_t) val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Data sent to wake-up interrupt function.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      Get the values of usr_off_on_wu in reg CTRL_REG7\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_wkup_feed_data_get(stmdev_ctx_t *ctx,\r
+                                    lis2doc_usr_off_on_wu_t *val)\r
+{\r
+  lis2doc_ctrl_reg7_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) &reg, 1);\r
+\r
+  switch (reg.usr_off_on_wu)\r
+  {\r
+    case LIS2DOC_HP_FEED:\r
+      *val = LIS2DOC_HP_FEED;\r
+      break;\r
+\r
+    case LIS2DOC_USER_OFFSET_FEED:\r
+      *val = LIS2DOC_USER_OFFSET_FEED;\r
+      break;\r
+\r
+    default:\r
+      *val = LIS2DOC_HP_FEED;\r
+      break;\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @}\r
+  *\r
+  */\r
+\r
+/**\r
+  * @defgroup   LIS2DOC_Activity/Inactivity_Detection\r
+  * @brief      This section groups all the functions concerning\r
+  *             activity/inactivity detection.\r
+  * @{\r
+  *\r
+  */\r
+\r
+/**\r
+  * @brief  Config activity / inactivity or\r
+  *         stationary / motion detection.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of sleep_on / stationary in\r
+  *                  reg WAKE_UP_THS / WAKE_UP_DUR\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_act_mode_set(stmdev_ctx_t *ctx,\r
+                              lis2doc_sleep_on_t val)\r
+{\r
+  lis2doc_wake_up_ths_t wake_up_ths;\r
+  lis2doc_wake_up_dur_t wake_up_dur;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_THS,\r
+                          (uint8_t *) &wake_up_ths, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_DUR,\r
+                            (uint8_t *) &wake_up_dur, 1);\r
+  }\r
+\r
+  if (ret == 0)\r
+  {\r
+    wake_up_ths.sleep_on = (uint8_t) val & 0x01U;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_WAKE_UP_THS,\r
+                             (uint8_t *) &wake_up_ths, 1);\r
+  }\r
+\r
+  if (ret == 0)\r
+  {\r
+    wake_up_dur.stationary = ((uint8_t)val & 0x02U) >> 1;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_WAKE_UP_DUR,\r
+                             (uint8_t *) &wake_up_dur, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Config activity / inactivity or\r
+  *         stationary / motion detection. [get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      Get the values of sleep_on in reg WAKE_UP_THS\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_act_mode_get(stmdev_ctx_t *ctx,\r
+                              lis2doc_sleep_on_t *val)\r
+{\r
+  lis2doc_wake_up_ths_t wake_up_ths;\r
+  lis2doc_wake_up_dur_t wake_up_dur;;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_THS,\r
+                          (uint8_t *) &wake_up_ths, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_DUR,\r
+                            (uint8_t *) &wake_up_dur, 1);\r
+\r
+    switch ((wake_up_dur.stationary << 1) + wake_up_ths.sleep_on)\r
+    {\r
+      case LIS2DOC_NO_DETECTION:\r
+        *val = LIS2DOC_NO_DETECTION;\r
+        break;\r
+\r
+      case LIS2DOC_DETECT_ACT_INACT:\r
+        *val = LIS2DOC_DETECT_ACT_INACT;\r
+        break;\r
+\r
+      case LIS2DOC_DETECT_STAT_MOTION:\r
+        *val = LIS2DOC_DETECT_STAT_MOTION;\r
+        break;\r
+\r
+      default:\r
+        *val = LIS2DOC_NO_DETECTION;\r
+        break;\r
+    }\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Duration to go in sleep mode (1 LSb = 512 / ODR).[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of sleep_dur in reg WAKE_UP_DUR\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_act_sleep_dur_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+  lis2doc_wake_up_dur_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_DUR, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.sleep_dur = val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_WAKE_UP_DUR, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Duration to go in sleep mode (1 LSb = 512 / ODR).[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of sleep_dur in reg WAKE_UP_DUR\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_act_sleep_dur_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+  lis2doc_wake_up_dur_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_DUR, (uint8_t *) &reg, 1);\r
+  *val = reg.sleep_dur;\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @}\r
+  *\r
+  */\r
+\r
+/**\r
+  * @defgroup  LIS2DOC_Tap_Generator\r
+  * @brief     This section groups all the functions that manage the tap\r
+  *            and double tap event generation.\r
+  * @{\r
+  *\r
+  */\r
+\r
+/**\r
+  * @brief  Threshold for tap recognition.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of tap_thsx in reg TAP_THS_X\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_tap_threshold_x_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+  lis2doc_tap_ths_x_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_X, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.tap_thsx = val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_TAP_THS_X, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Threshold for tap recognition.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of tap_thsx in reg TAP_THS_X\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_tap_threshold_x_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+  lis2doc_tap_ths_x_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_X, (uint8_t *) &reg, 1);\r
+  *val = reg.tap_thsx;\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Threshold for tap recognition.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of tap_thsy in reg TAP_THS_Y\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_tap_threshold_y_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+  lis2doc_tap_ths_y_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_Y, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.tap_thsy = val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_TAP_THS_Y, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Threshold for tap recognition.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of tap_thsy in reg TAP_THS_Y\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_tap_threshold_y_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+  lis2doc_tap_ths_y_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_Y, (uint8_t *) &reg, 1);\r
+  *val = reg.tap_thsy;\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Selection of axis priority for TAP detection.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of tap_prior in reg TAP_THS_Y\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_tap_axis_priority_set(stmdev_ctx_t *ctx,\r
+                                       lis2doc_tap_prior_t val)\r
+{\r
+  lis2doc_tap_ths_y_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_Y, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.tap_prior = (uint8_t) val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_TAP_THS_Y, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Selection of axis priority for TAP detection.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      Get the values of tap_prior in reg TAP_THS_Y\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_tap_axis_priority_get(stmdev_ctx_t *ctx,\r
+                                       lis2doc_tap_prior_t *val)\r
+{\r
+  lis2doc_tap_ths_y_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_Y, (uint8_t *) &reg, 1);\r
+\r
+  switch (reg.tap_prior)\r
+  {\r
+    case LIS2DOC_XYZ:\r
+      *val = LIS2DOC_XYZ;\r
+      break;\r
+\r
+    case LIS2DOC_YXZ:\r
+      *val = LIS2DOC_YXZ;\r
+      break;\r
+\r
+    case LIS2DOC_XZY:\r
+      *val = LIS2DOC_XZY;\r
+      break;\r
+\r
+    case LIS2DOC_ZYX:\r
+      *val = LIS2DOC_ZYX;\r
+      break;\r
+\r
+    case LIS2DOC_YZX:\r
+      *val = LIS2DOC_YZX;\r
+      break;\r
+\r
+    case LIS2DOC_ZXY:\r
+      *val = LIS2DOC_ZXY;\r
+      break;\r
+\r
+    default:\r
+      *val = LIS2DOC_XYZ;\r
+      break;\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Threshold for tap recognition.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of tap_thsz in reg TAP_THS_Z\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_tap_threshold_z_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+  lis2doc_tap_ths_z_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_Z, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.tap_thsz = val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_TAP_THS_Z, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Threshold for tap recognition.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of tap_thsz in reg TAP_THS_Z\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_tap_threshold_z_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+  lis2doc_tap_ths_z_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_Z, (uint8_t *) &reg, 1);\r
+  *val = reg.tap_thsz;\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Enable Z direction in tap recognition.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of tap_z_en in reg TAP_THS_Z\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_tap_detection_on_z_set(stmdev_ctx_t *ctx,\r
+                                        uint8_t val)\r
+{\r
+  lis2doc_tap_ths_z_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_Z, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.tap_z_en = val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_TAP_THS_Z, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Enable Z direction in tap recognition.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of tap_z_en in reg TAP_THS_Z\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_tap_detection_on_z_get(stmdev_ctx_t *ctx,\r
+                                        uint8_t *val)\r
+{\r
+  lis2doc_tap_ths_z_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_Z, (uint8_t *) &reg, 1);\r
+  *val = reg.tap_z_en;\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Enable Y direction in tap recognition.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of tap_y_en in reg TAP_THS_Z\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_tap_detection_on_y_set(stmdev_ctx_t *ctx,\r
+                                        uint8_t val)\r
+{\r
+  lis2doc_tap_ths_z_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_Z, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.tap_y_en = val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_TAP_THS_Z, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Enable Y direction in tap recognition.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of tap_y_en in reg TAP_THS_Z\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_tap_detection_on_y_get(stmdev_ctx_t *ctx,\r
+                                        uint8_t *val)\r
+{\r
+  lis2doc_tap_ths_z_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_Z, (uint8_t *) &reg, 1);\r
+  *val = reg.tap_y_en;\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Enable X direction in tap recognition.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of tap_x_en in reg TAP_THS_Z\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_tap_detection_on_x_set(stmdev_ctx_t *ctx,\r
+                                        uint8_t val)\r
+{\r
+  lis2doc_tap_ths_z_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_Z, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.tap_x_en = val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_TAP_THS_Z, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Enable X direction in tap recognition.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of tap_x_en in reg TAP_THS_Z\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_tap_detection_on_x_get(stmdev_ctx_t *ctx,\r
+                                        uint8_t *val)\r
+{\r
+  lis2doc_tap_ths_z_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_Z, (uint8_t *) &reg, 1);\r
+  *val = reg.tap_x_en;\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Maximum duration is the maximum time of an overthreshold signal\r
+  *         detection to be recognized as a tap event. The default value\r
+  *         of these bits is 00b which corresponds to 4*ODR_XL time.\r
+  *         If the SHOCK[1:0] bits are set to a different value, 1LSB\r
+  *         corresponds to 8*ODR_XL time.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of shock in reg INT_DUR\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_tap_shock_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+  lis2doc_int_dur_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_INT_DUR, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.shock = val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_INT_DUR, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Maximum duration is the maximum time of an overthreshold signal\r
+  *         detection to be recognized as a tap event. The default value\r
+  *         of these bits is 00b which corresponds to 4*ODR_XL time.\r
+  *         If the SHOCK[1:0] bits are set to a different value, 1LSB\r
+  *         corresponds to 8*ODR_XL time.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of shock in reg INT_DUR\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_tap_shock_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+  lis2doc_int_dur_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_INT_DUR, (uint8_t *) &reg, 1);\r
+  *val = reg.shock;\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Quiet time is the time after the first detected tap in which\r
+  *         there must not be any overthreshold event.\r
+  *         The default value of these bits is 00b which corresponds\r
+  *         to 2*ODR_XL time. If the QUIET[1:0] bits are set to a different\r
+  *         value, 1LSB corresponds to 4*ODR_XL time.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of quiet in reg INT_DUR\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_tap_quiet_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+  lis2doc_int_dur_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_INT_DUR, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.quiet = val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_INT_DUR, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Quiet time is the time after the first detected tap in which\r
+  *         there must not be any overthreshold event.\r
+  *         The default value of these bits is 00b which corresponds\r
+  *         to 2*ODR_XL time. If the QUIET[1:0] bits are set to a different\r
+  *         value, 1LSB corresponds to 4*ODR_XL time.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of quiet in reg INT_DUR\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_tap_quiet_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+  lis2doc_int_dur_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_INT_DUR, (uint8_t *) &reg, 1);\r
+  *val = reg.quiet;\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  When double tap recognition is enabled, this register expresses\r
+  *         the maximum time between two consecutive detected taps to\r
+  *         determine a double tap event.\r
+  *         The default value of these bits is 0000b which corresponds\r
+  *         to 16*ODR_XL time. If the DUR[3:0] bits are set to a different\r
+  *         value, 1LSB corresponds to 32*ODR_XL time.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of latency in reg INT_DUR\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_tap_dur_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+  lis2doc_int_dur_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_INT_DUR, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.latency = val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_INT_DUR, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  When double tap recognition is enabled, this register expresses\r
+  *         the maximum time between two consecutive detected taps to\r
+  *         determine a double tap event.\r
+  *         The default value of these bits is 0000b which corresponds\r
+  *         to 16*ODR_XL time. If the DUR[3:0] bits are set to a different\r
+  *         value, 1LSB corresponds to 32*ODR_XL time.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of latency in reg INT_DUR\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_tap_dur_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+  lis2doc_int_dur_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_INT_DUR, (uint8_t *) &reg, 1);\r
+  *val = reg.latency;\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Single/double-tap event enable.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of single_double_tap in reg WAKE_UP_THS\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_tap_mode_set(stmdev_ctx_t *ctx,\r
+                              lis2doc_single_double_tap_t val)\r
+{\r
+  lis2doc_wake_up_ths_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_THS, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.single_double_tap = (uint8_t) val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_WAKE_UP_THS, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Single/double-tap event enable.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      Get the values of single_double_tap in reg WAKE_UP_THS\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_tap_mode_get(stmdev_ctx_t *ctx,\r
+                              lis2doc_single_double_tap_t *val)\r
+{\r
+  lis2doc_wake_up_ths_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_THS, (uint8_t *) &reg, 1);\r
+\r
+  switch (reg.single_double_tap)\r
+  {\r
+    case LIS2DOC_ONLY_SINGLE:\r
+      *val = LIS2DOC_ONLY_SINGLE;\r
+      break;\r
+\r
+    case LIS2DOC_BOTH_SINGLE_DOUBLE:\r
+      *val = LIS2DOC_BOTH_SINGLE_DOUBLE;\r
+      break;\r
+\r
+    default:\r
+      *val = LIS2DOC_ONLY_SINGLE;\r
+      break;\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Read the tap / double tap source register.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  lis2doc_tap_src: union of registers from TAP_SRC to\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_tap_src_get(stmdev_ctx_t *ctx,\r
+                             lis2doc_tap_src_t *val)\r
+{\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_SRC, (uint8_t *) val, 1);\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @}\r
+  *\r
+  */\r
+\r
+/**\r
+  * @defgroup   LIS2DOC_Six_Position_Detection(6D/4D)\r
+  * @brief      This section groups all the functions concerning six\r
+  *             position detection (6D).\r
+  * @{\r
+  *\r
+  */\r
+\r
+/**\r
+  * @brief  Threshold for 4D/6D function.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of 6d_ths in reg TAP_THS_X\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_6d_threshold_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+  lis2doc_tap_ths_x_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_X, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg._6d_ths = val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_TAP_THS_X, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Threshold for 4D/6D function.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of 6d_ths in reg TAP_THS_X\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_6d_threshold_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+  lis2doc_tap_ths_x_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_X, (uint8_t *) &reg, 1);\r
+  *val = reg._6d_ths;\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  4D orientation detection enable.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of 4d_en in reg TAP_THS_X\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_4d_mode_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+  lis2doc_tap_ths_x_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_X, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg._4d_en = val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_TAP_THS_X, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  4D orientation detection enable.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of 4d_en in reg TAP_THS_X\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_4d_mode_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+  lis2doc_tap_ths_x_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_X, (uint8_t *) &reg, 1);\r
+  *val = reg._4d_en;\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Read the 6D tap source register.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      union of registers from SIXD_SRC\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_6d_src_get(stmdev_ctx_t *ctx,\r
+                            lis2doc_sixd_src_t *val)\r
+{\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_SIXD_SRC, (uint8_t *) val, 1);\r
+\r
+  return ret;\r
+}\r
+/**\r
+  * @brief  Data sent to 6D interrupt function.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of lpass_on6d in reg CTRL_REG7\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_6d_feed_data_set(stmdev_ctx_t *ctx,\r
+                                  lis2doc_lpass_on6d_t val)\r
+{\r
+  lis2doc_ctrl_reg7_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.lpass_on6d = (uint8_t) val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Data sent to 6D interrupt function.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      Get the values of lpass_on6d in reg CTRL_REG7\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_6d_feed_data_get(stmdev_ctx_t *ctx,\r
+                                  lis2doc_lpass_on6d_t *val)\r
+{\r
+  lis2doc_ctrl_reg7_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) &reg, 1);\r
+\r
+  switch (reg.lpass_on6d)\r
+  {\r
+    case LIS2DOC_ODR_DIV_2_FEED:\r
+      *val = LIS2DOC_ODR_DIV_2_FEED;\r
+      break;\r
+\r
+    case LIS2DOC_LPF2_FEED:\r
+      *val = LIS2DOC_LPF2_FEED;\r
+      break;\r
+\r
+    default:\r
+      *val = LIS2DOC_ODR_DIV_2_FEED;\r
+      break;\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @}\r
+  *\r
+  */\r
+\r
+/**\r
+  * @defgroup  LIS2DOC_Free_Fall\r
+  * @brief     This section group all the functions concerning\r
+  *            the free fall detection.\r
+  * @{\r
+  *\r
+  */\r
+\r
+/**\r
+  * @brief  Free fall duration event(1LSb = 1 / ODR).[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of ff_dur in reg\r
+  *                  WAKE_UP_DUR /F REE_FALL\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_ff_dur_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+  lis2doc_wake_up_dur_t wake_up_dur;\r
+  lis2doc_free_fall_t free_fall;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_DUR,\r
+                          (uint8_t *) &wake_up_dur, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    ret = lis2doc_read_reg(ctx, LIS2DOC_FREE_FALL,\r
+                            (uint8_t *) &free_fall, 1);\r
+  }\r
+\r
+  if (ret == 0)\r
+  {\r
+    wake_up_dur.ff_dur = ((uint8_t) val & 0x20U) >> 5;\r
+    free_fall.ff_dur = (uint8_t) val & 0x1FU;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_WAKE_UP_DUR,\r
+                             (uint8_t *) &wake_up_dur, 1);\r
+  }\r
+\r
+  if (ret == 0)\r
+  {\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_FREE_FALL,\r
+                             (uint8_t *) &free_fall, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Free fall duration event(1LSb = 1 / ODR).[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of ff_dur in\r
+  *                  reg WAKE_UP_DUR /F REE_FALL\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_ff_dur_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+  lis2doc_wake_up_dur_t wake_up_dur;\r
+  lis2doc_free_fall_t free_fall;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_DUR,\r
+                          (uint8_t *) &wake_up_dur, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    ret = lis2doc_read_reg(ctx, LIS2DOC_FREE_FALL,\r
+                            (uint8_t *) &free_fall, 1);\r
+    *val = (wake_up_dur.ff_dur << 5) + free_fall.ff_dur;\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Free fall threshold setting.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of ff_ths in reg FREE_FALL\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_ff_threshold_set(stmdev_ctx_t *ctx,\r
+                                  lis2doc_ff_ths_t val)\r
+{\r
+  lis2doc_free_fall_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_FREE_FALL, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.ff_ths = (uint8_t) val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_FREE_FALL, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Free fall threshold setting.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      Get the values of ff_ths in reg FREE_FALL\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_ff_threshold_get(stmdev_ctx_t *ctx,\r
+                                  lis2doc_ff_ths_t *val)\r
+{\r
+  lis2doc_free_fall_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_FREE_FALL, (uint8_t *) &reg, 1);\r
+\r
+  switch (reg.ff_ths)\r
+  {\r
+    case LIS2DOC_FF_TSH_5LSb_FS2g:\r
+      *val = LIS2DOC_FF_TSH_5LSb_FS2g;\r
+      break;\r
+\r
+    case LIS2DOC_FF_TSH_7LSb_FS2g:\r
+      *val = LIS2DOC_FF_TSH_7LSb_FS2g;\r
+      break;\r
+\r
+    case LIS2DOC_FF_TSH_8LSb_FS2g:\r
+      *val = LIS2DOC_FF_TSH_8LSb_FS2g;\r
+      break;\r
+\r
+    case LIS2DOC_FF_TSH_10LSb_FS2g:\r
+      *val = LIS2DOC_FF_TSH_10LSb_FS2g;\r
+      break;\r
+\r
+    case LIS2DOC_FF_TSH_11LSb_FS2g:\r
+      *val = LIS2DOC_FF_TSH_11LSb_FS2g;\r
+      break;\r
+\r
+    case LIS2DOC_FF_TSH_13LSb_FS2g:\r
+      *val = LIS2DOC_FF_TSH_13LSb_FS2g;\r
+      break;\r
+\r
+    case LIS2DOC_FF_TSH_15LSb_FS2g:\r
+      *val = LIS2DOC_FF_TSH_15LSb_FS2g;\r
+      break;\r
+\r
+    case LIS2DOC_FF_TSH_16LSb_FS2g:\r
+      *val = LIS2DOC_FF_TSH_16LSb_FS2g;\r
+      break;\r
+\r
+    default:\r
+      *val = LIS2DOC_FF_TSH_5LSb_FS2g;\r
+      break;\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @}\r
+  *\r
+  */\r
+\r
+/**\r
+  * @defgroup  LIS2DOC_Fifo\r
+  * @brief     This section group all the functions concerning the fifo usage\r
+  * @{\r
+  *\r
+  */\r
+\r
+/**\r
+  * @brief  FIFO watermark level selection.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of fth in reg FIFO_CTRL\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_fifo_watermark_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+  lis2doc_fifo_ctrl_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_FIFO_CTRL, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.fth = val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_FIFO_CTRL, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  FIFO watermark level selection.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of fth in reg FIFO_CTRL\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_fifo_watermark_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+  lis2doc_fifo_ctrl_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_FIFO_CTRL, (uint8_t *) &reg, 1);\r
+  *val = reg.fth;\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  FIFO mode selection.[set]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of fmode in reg FIFO_CTRL\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_fifo_mode_set(stmdev_ctx_t *ctx,\r
+                               lis2doc_fmode_t val)\r
+{\r
+  lis2doc_fifo_ctrl_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_FIFO_CTRL, (uint8_t *) &reg, 1);\r
+\r
+  if (ret == 0)\r
+  {\r
+    reg.fmode = (uint8_t) val;\r
+    ret = lis2doc_write_reg(ctx, LIS2DOC_FIFO_CTRL, (uint8_t *) &reg, 1);\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  FIFO mode selection.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      Get the values of fmode in reg FIFO_CTRL\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_fifo_mode_get(stmdev_ctx_t *ctx,\r
+                               lis2doc_fmode_t *val)\r
+{\r
+  lis2doc_fifo_ctrl_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_FIFO_CTRL, (uint8_t *) &reg, 1);\r
+\r
+  switch (reg.fmode)\r
+  {\r
+    case LIS2DOC_BYPASS_MODE:\r
+      *val = LIS2DOC_BYPASS_MODE;\r
+      break;\r
+\r
+    case LIS2DOC_FIFO_MODE:\r
+      *val = LIS2DOC_FIFO_MODE;\r
+      break;\r
+\r
+    case LIS2DOC_STREAM_TO_FIFO_MODE:\r
+      *val = LIS2DOC_STREAM_TO_FIFO_MODE;\r
+      break;\r
+\r
+    case LIS2DOC_BYPASS_TO_STREAM_MODE:\r
+      *val = LIS2DOC_BYPASS_TO_STREAM_MODE;\r
+      break;\r
+\r
+    case LIS2DOC_STREAM_MODE:\r
+      *val = LIS2DOC_STREAM_MODE;\r
+      break;\r
+\r
+    default:\r
+      *val = LIS2DOC_BYPASS_MODE;\r
+      break;\r
+  }\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @brief  Number of unread samples stored in FIFO.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of diff in reg FIFO_SAMPLES\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_fifo_data_level_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+  lis2doc_fifo_samples_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_FIFO_SAMPLES, (uint8_t *) &reg, 1);\r
+  *val = reg.diff;\r
+\r
+  return ret;\r
+}\r
+/**\r
+  * @brief  FIFO overrun status.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of fifo_ovr in reg FIFO_SAMPLES\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_fifo_ovr_flag_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+  lis2doc_fifo_samples_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_FIFO_SAMPLES, (uint8_t *) &reg, 1);\r
+  *val = reg.fifo_ovr;\r
+\r
+  return ret;\r
+}\r
+/**\r
+  * @brief  FIFO threshold status flag.[get]\r
+  *\r
+  * @param  ctx      read / write interface definitions\r
+  * @param  val      change the values of fifo_fth in reg FIFO_SAMPLES\r
+  * @retval          interface status (MANDATORY: return 0 -> no Error)\r
+  *\r
+  */\r
+int32_t lis2doc_fifo_wtm_flag_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+  lis2doc_fifo_samples_t reg;\r
+  int32_t ret;\r
+\r
+  ret = lis2doc_read_reg(ctx, LIS2DOC_FIFO_SAMPLES, (uint8_t *) &reg, 1);\r
+  *val = reg.fifo_fth;\r
+\r
+  return ret;\r
+}\r
+\r
+/**\r
+  * @}\r
+  *\r
+  */\r
+\r
+/**\r
+  * @}\r
+  *\r
+  */\r
+\r
+/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/\r
diff --git a/code/sdk/drivers/peripheral/acc/lis2doc_STdC/driver/lis2doc_reg.h b/code/sdk/drivers/peripheral/acc/lis2doc_STdC/driver/lis2doc_reg.h
new file mode 100644 (file)
index 0000000..05dad36
--- /dev/null
@@ -0,0 +1,1070 @@
+/**\r
+  ******************************************************************************\r
+  * @file    lis2doc_reg.h\r
+  * @author  Sensors Software Solution Team\r
+  * @brief   This file contains all the functions prototypes for the\r
+  *          lis2doc_reg.c driver.\r
+  ******************************************************************************\r
+  * @attention\r
+  *\r
+  * <h2><center>&copy; Copyright (c) 2021 STMicroelectronics.\r
+  * All rights reserved.</center></h2>\r
+  *\r
+  * This software component is licensed by ST under BSD 3-Clause license,\r
+  * the "License"; You may not use this file except in compliance with the\r
+  * License. You may obtain a copy of the License at:\r
+  *                        opensource.org/licenses/BSD-3-Clause\r
+  *\r
+  ******************************************************************************\r
+  */\r
+\r
+/* Define to prevent recursive inclusion -------------------------------------*/\r
+#ifndef LIS2DOC_REGS_H\r
+#define LIS2DOC_REGS_H\r
+\r
+#ifdef __cplusplus\r
+extern "C" {\r
+#endif\r
+\r
+/* Includes ------------------------------------------------------------------*/\r
+#include <stdint.h>\r
+#include <stddef.h>\r
+#include <math.h>\r
+\r
+/** @addtogroup LIS2DOC\r
+  * @{\r
+  *\r
+  */\r
+\r
+/** @defgroup  Endianness definitions\r
+  * @{\r
+  *\r
+  */\r
+\r
+#ifndef DRV_BYTE_ORDER\r
+#ifndef __BYTE_ORDER__\r
+\r
+#define DRV_LITTLE_ENDIAN 1234\r
+#define DRV_BIG_ENDIAN    4321\r
+\r
+/** if _BYTE_ORDER is not defined, choose the endianness of your architecture\r
+  * by uncommenting the define which fits your platform endianness\r
+  */\r
+//#define DRV_BYTE_ORDER    DRV_BIG_ENDIAN\r
+#define DRV_BYTE_ORDER    DRV_LITTLE_ENDIAN\r
+\r
+#else /* defined __BYTE_ORDER__ */\r
+\r
+#define DRV_LITTLE_ENDIAN  __ORDER_LITTLE_ENDIAN__\r
+#define DRV_BIG_ENDIAN     __ORDER_BIG_ENDIAN__\r
+#define DRV_BYTE_ORDER     __BYTE_ORDER__\r
+\r
+#endif /* __BYTE_ORDER__*/\r
+#endif /* DRV_BYTE_ORDER */\r
+\r
+/**\r
+  * @}\r
+  *\r
+  */\r
+\r
+/** @defgroup STMicroelectronics sensors common types\r
+  * @{\r
+  *\r
+  */\r
+\r
+#ifndef MEMS_SHARED_TYPES\r
+#define MEMS_SHARED_TYPES\r
+\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+  uint8_t bit0       : 1;\r
+  uint8_t bit1       : 1;\r
+  uint8_t bit2       : 1;\r
+  uint8_t bit3       : 1;\r
+  uint8_t bit4       : 1;\r
+  uint8_t bit5       : 1;\r
+  uint8_t bit6       : 1;\r
+  uint8_t bit7       : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+  uint8_t bit7       : 1;\r
+  uint8_t bit6       : 1;\r
+  uint8_t bit5       : 1;\r
+  uint8_t bit4       : 1;\r
+  uint8_t bit3       : 1;\r
+  uint8_t bit2       : 1;\r
+  uint8_t bit1       : 1;\r
+  uint8_t bit0       : 1;\r
+#endif /* DRV_BYTE_ORDER */\r
+} bitwise_t;\r
+\r
+#define PROPERTY_DISABLE                (0U)\r
+#define PROPERTY_ENABLE                 (1U)\r
+\r
+/** @addtogroup  Interfaces_Functions\r
+  * @brief       This section provide a set of functions used to read and\r
+  *              write a generic register of the device.\r
+  *              MANDATORY: return 0 -> no Error.\r
+  * @{\r
+  *\r
+  */\r
+\r
+typedef int32_t (*stmdev_write_ptr)(void *, uint8_t, const uint8_t *, uint16_t);\r
+typedef int32_t (*stmdev_read_ptr)(void *, uint8_t, uint8_t *, uint16_t);\r
+typedef void (*stmdev_mdelay_ptr)(uint32_t millisec);\r
+\r
+typedef struct\r
+{\r
+  /** Component mandatory fields **/\r
+  stmdev_write_ptr  write_reg;\r
+  stmdev_read_ptr   read_reg;\r
+  /** Component optional fields **/\r
+  stmdev_mdelay_ptr   mdelay;\r
+  /** Customizable optional pointer **/\r
+  void *handle;\r
+} stmdev_ctx_t;\r
+\r
+/**\r
+  * @}\r
+  *\r
+  */\r
+\r
+#endif /* MEMS_SHARED_TYPES */\r
+\r
+#ifndef MEMS_UCF_SHARED_TYPES\r
+#define MEMS_UCF_SHARED_TYPES\r
+\r
+/** @defgroup    Generic address-data structure definition\r
+  * @brief       This structure is useful to load a predefined configuration\r
+  *              of a sensor.\r
+  *              You can create a sensor configuration by your own or using\r
+  *              Unico / Unicleo tools available on STMicroelectronics\r
+  *              web site.\r
+  *\r
+  * @{\r
+  *\r
+  */\r
+\r
+typedef struct\r
+{\r
+  uint8_t address;\r
+  uint8_t data;\r
+} ucf_line_t;\r
+\r
+/**\r
+  * @}\r
+  *\r
+  */\r
+\r
+#endif /* MEMS_UCF_SHARED_TYPES */\r
+\r
+/**\r
+  * @}\r
+  *\r
+  */\r
+\r
+/** @defgroup LIS2DOC_Infos\r
+  * @{\r
+  *\r
+  */\r
+\r
+/** I2C Device Address 8 bit format  if SA0=0 -> 31 if SA0=1 -> 33 **/\r
+#define LIS2DOC_I2C_ADD_L   0x31U\r
+#define LIS2DOC_I2C_ADD_H   0x33U\r
+\r
+/** Device Identification (Who am I) **/\r
+#define LIS2DOC_ID            0x44U\r
+\r
+/**\r
+  * @}\r
+  *\r
+  */\r
+\r
+#define LIS2DOC_OUT_T_L                     0x0DU\r
+#define LIS2DOC_OUT_T_H                     0x0EU\r
+#define LIS2DOC_WHO_AM_I                    0x0FU\r
+#define LIS2DOC_CTRL1                       0x20U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+  uint8_t not_used_00                : 1;\r
+  uint8_t lpm_en                     : 1;\r
+  uint8_t hpm_en                     : 1;\r
+  uint8_t sdrc_en                    : 1;\r
+  uint8_t odr                        : 4;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+  uint8_t odr                        : 4;\r
+  uint8_t sdrc_en                    : 1;\r
+  uint8_t hpm_en                     : 1;\r
+  uint8_t lpm_en                     : 1;\r
+  uint8_t not_used_00                : 1;\r
+#endif /* DRV_BYTE_ORDER */\r
+\r
+} lis2doc_ctrl1_t;\r
+\r
+#define LIS2DOC_CTRL2                       0x21U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+  uint8_t sim                        : 1;\r
+  uint8_t i2c_disable                : 1;\r
+  uint8_t if_add_inc                 : 1;\r
+  uint8_t bdu                        : 1;\r
+  uint8_t cs_pu_disc                 : 1;\r
+  uint8_t not_used_01                : 1;\r
+  uint8_t soft_reset                 : 1;\r
+  uint8_t boot                       : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+  uint8_t boot                       : 1;\r
+  uint8_t soft_reset                 : 1;\r
+  uint8_t not_used_01                : 1;\r
+  uint8_t cs_pu_disc                 : 1;\r
+  uint8_t bdu                        : 1;\r
+  uint8_t if_add_inc                 : 1;\r
+  uint8_t i2c_disable                : 1;\r
+  uint8_t sim                        : 1;\r
+#endif /* DRV_BYTE_ORDER */\r
+\r
+} lis2doc_ctrl2_t;\r
+\r
+#define LIS2DOC_CTRL3                       0x22U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+uint8_t slp_mode                   :\r
+  2;  /* slp_mode_sel + slp_mode_1 */\r
+  uint8_t not_used_01                : 1;\r
+  uint8_t h_lactive                  : 1;\r
+  uint8_t lir                        : 1;\r
+  uint8_t pp_od                      : 1;\r
+  uint8_t st                         : 2;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+  uint8_t st                         : 2;\r
+  uint8_t pp_od                      : 1;\r
+  uint8_t lir                        : 1;\r
+  uint8_t h_lactive                  : 1;\r
+  uint8_t not_used_01                : 1;\r
+uint8_t slp_mode                   :\r
+  2;  /* slp_mode_sel + slp_mode_1 */\r
+#endif /* DRV_BYTE_ORDER */\r
+\r
+} lis2doc_ctrl3_t;\r
+\r
+#define LIS2DOC_CTRL4_INT1_PAD_CTRL         0x23U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+  uint8_t int1_drdy                  : 1;\r
+  uint8_t int1_fth                   : 1;\r
+  uint8_t int1_diff5                 : 1;\r
+  uint8_t int1_tap                   : 1;\r
+  uint8_t int1_ff                    : 1;\r
+  uint8_t int1_wu                    : 1;\r
+  uint8_t int1_single_tap            : 1;\r
+  uint8_t int1_6d                    : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+  uint8_t int1_6d                    : 1;\r
+  uint8_t int1_single_tap            : 1;\r
+  uint8_t int1_wu                    : 1;\r
+  uint8_t int1_ff                    : 1;\r
+  uint8_t int1_tap                   : 1;\r
+  uint8_t int1_diff5                 : 1;\r
+  uint8_t int1_fth                   : 1;\r
+  uint8_t int1_drdy                  : 1;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_ctrl4_int1_pad_ctrl_t;\r
+\r
+#define LIS2DOC_CTRL5_INT2_PAD_CTRL         0x24U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+  uint8_t int2_drdy                  : 1;\r
+  uint8_t int2_fth                   : 1;\r
+  uint8_t int2_diff5                 : 1;\r
+  uint8_t int2_ovr                   : 1;\r
+  uint8_t int2_drdy_t                : 1;\r
+  uint8_t int2_boot                  : 1;\r
+  uint8_t int2_sleep_chg             : 1;\r
+  uint8_t int2_sleep_state           : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+  uint8_t int2_sleep_state           : 1;\r
+  uint8_t int2_sleep_chg             : 1;\r
+  uint8_t int2_boot                  : 1;\r
+  uint8_t int2_drdy_t                : 1;\r
+  uint8_t int2_ovr                   : 1;\r
+  uint8_t int2_diff5                 : 1;\r
+  uint8_t int2_fth                   : 1;\r
+  uint8_t int2_drdy                  : 1;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_ctrl5_int2_pad_ctrl_t;\r
+\r
+#define LIS2DOC_CTRL6                       0x25U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+  uint8_t not_used_01                : 2;\r
+  uint8_t low_noise                  : 1;\r
+  uint8_t fds                        : 1;\r
+  uint8_t fs                         : 2;\r
+  uint8_t bw_filt                    : 2;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+  uint8_t bw_filt                    : 2;\r
+  uint8_t fs                         : 2;\r
+  uint8_t fds                        : 1;\r
+  uint8_t low_noise                  : 1;\r
+  uint8_t not_used_01                : 2;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_ctrl6_t;\r
+\r
+#define LIS2DOC_OUT_T                       0x26U\r
+#define LIS2DOC_STATUS                      0x27U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+  uint8_t drdy                       : 1;\r
+  uint8_t ff_ia                      : 1;\r
+  uint8_t _6d_ia                     : 1;\r
+  uint8_t single_tap                 : 1;\r
+  uint8_t double_tap                 : 1;\r
+  uint8_t sleep_state                : 1;\r
+  uint8_t wu_ia                      : 1;\r
+  uint8_t fifo_ths                   : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+  uint8_t fifo_ths                   : 1;\r
+  uint8_t wu_ia                      : 1;\r
+  uint8_t sleep_state                : 1;\r
+  uint8_t double_tap                 : 1;\r
+  uint8_t single_tap                 : 1;\r
+  uint8_t _6d_ia                     : 1;\r
+  uint8_t ff_ia                      : 1;\r
+  uint8_t drdy                       : 1;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_status_t;\r
+\r
+#define LIS2DOC_OUT_X_L                     0x28U\r
+#define LIS2DOC_OUT_X_H                     0x29U\r
+#define LIS2DOC_OUT_Y_L                     0x2AU\r
+#define LIS2DOC_OUT_Y_H                     0x2BU\r
+#define LIS2DOC_OUT_Z_L                     0x2CU\r
+#define LIS2DOC_OUT_Z_H                     0x2DU\r
+#define LIS2DOC_FIFO_CTRL                   0x2EU\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+  uint8_t fth                        : 5;\r
+  uint8_t fmode                      : 3;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+  uint8_t fmode                      : 3;\r
+  uint8_t fth                        : 5;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_fifo_ctrl_t;\r
+\r
+#define LIS2DOC_FIFO_SAMPLES                0x2FU\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+  uint8_t diff                       : 6;\r
+  uint8_t fifo_ovr                   : 1;\r
+  uint8_t fifo_fth                   : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+  uint8_t fifo_fth                   : 1;\r
+  uint8_t fifo_ovr                   : 1;\r
+  uint8_t diff                       : 6;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_fifo_samples_t;\r
+\r
+#define LIS2DOC_TAP_THS_X                   0x30U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+  uint8_t tap_thsx                    : 5;\r
+  uint8_t _6d_ths                     : 2;\r
+  uint8_t _4d_en                      : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+  uint8_t _4d_en                      : 1;\r
+  uint8_t _6d_ths                     : 2;\r
+  uint8_t tap_thsx                    : 5;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_tap_ths_x_t;\r
+\r
+#define LIS2DOC_TAP_THS_Y                   0x31U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+  uint8_t tap_thsy                   : 5;\r
+  uint8_t tap_prior                  : 3;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+  uint8_t tap_prior                  : 3;\r
+  uint8_t tap_thsy                   : 5;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_tap_ths_y_t;\r
+\r
+#define LIS2DOC_TAP_THS_Z                   0x32U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+  uint8_t tap_thsz                   : 5;\r
+  uint8_t tap_z_en                   : 1;\r
+  uint8_t tap_y_en                   : 1;\r
+  uint8_t tap_x_en                   : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+  uint8_t tap_x_en                   : 1;\r
+  uint8_t tap_y_en                   : 1;\r
+  uint8_t tap_z_en                   : 1;\r
+  uint8_t tap_thsz                   : 5;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_tap_ths_z_t;\r
+\r
+#define LIS2DOC_INT_DUR                     0x33U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+  uint8_t shock                      : 2;\r
+  uint8_t quiet                      : 2;\r
+  uint8_t latency                    : 4;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+  uint8_t latency                    : 4;\r
+  uint8_t quiet                      : 2;\r
+  uint8_t shock                      : 2;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_int_dur_t;\r
+\r
+#define LIS2DOC_WAKE_UP_THS                 0x34U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+  uint8_t wk_ths                     : 6;\r
+  uint8_t sleep_on                   : 1;\r
+  uint8_t single_double_tap          : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+  uint8_t single_double_tap          : 1;\r
+  uint8_t sleep_on                   : 1;\r
+  uint8_t wk_ths                     : 6;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_wake_up_ths_t;\r
+\r
+#define LIS2DOC_WAKE_UP_DUR                 0x35U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+  uint8_t sleep_dur                  : 4;\r
+  uint8_t stationary                 : 1;\r
+  uint8_t wake_dur                   : 2;\r
+  uint8_t ff_dur                     : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+  uint8_t ff_dur                     : 1;\r
+  uint8_t wake_dur                   : 2;\r
+  uint8_t stationary                 : 1;\r
+  uint8_t sleep_dur                  : 4;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_wake_up_dur_t;\r
+\r
+#define LIS2DOC_FREE_FALL                   0x36U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+  uint8_t ff_ths                     : 3;\r
+  uint8_t ff_dur                     : 5;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+  uint8_t ff_dur                     : 5;\r
+  uint8_t ff_ths                     : 3;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_free_fall_t;\r
+\r
+#define LIS2DOC_STATUS_DUP                  0x37U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+  uint8_t drdy                       : 1;\r
+  uint8_t ff_ia                      : 1;\r
+  uint8_t _6d_ia                     : 1;\r
+  uint8_t single_tap                 : 1;\r
+  uint8_t double_tap                 : 1;\r
+  uint8_t sleep_state_ia             : 1;\r
+  uint8_t drdy_t                     : 1;\r
+  uint8_t ovr                        : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+  uint8_t ovr                        : 1;\r
+  uint8_t drdy_t                     : 1;\r
+  uint8_t sleep_state_ia             : 1;\r
+  uint8_t double_tap                 : 1;\r
+  uint8_t single_tap                 : 1;\r
+  uint8_t _6d_ia                     : 1;\r
+  uint8_t ff_ia                      : 1;\r
+  uint8_t drdy                       : 1;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_status_dup_t;\r
+\r
+#define LIS2DOC_WAKE_UP_SRC                 0x38U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+  uint8_t z_wu                       : 1;\r
+  uint8_t y_wu                       : 1;\r
+  uint8_t x_wu                       : 1;\r
+  uint8_t wu_ia                      : 1;\r
+  uint8_t sleep_state_ia             : 1;\r
+  uint8_t ff_ia                      : 1;\r
+  uint8_t not_used_01                : 2;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+  uint8_t not_used_01                : 2;\r
+  uint8_t ff_ia                      : 1;\r
+  uint8_t sleep_state_ia             : 1;\r
+  uint8_t wu_ia                      : 1;\r
+  uint8_t x_wu                       : 1;\r
+  uint8_t y_wu                       : 1;\r
+  uint8_t z_wu                       : 1;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_wake_up_src_t;\r
+\r
+#define LIS2DOC_TAP_SRC                     0x39U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+  uint8_t z_tap                      : 1;\r
+  uint8_t y_tap                      : 1;\r
+  uint8_t x_tap                      : 1;\r
+  uint8_t tap_sign                   : 1;\r
+  uint8_t double_tap                 : 1;\r
+  uint8_t single_tap                 : 1;\r
+  uint8_t tap_ia                     : 1;\r
+  uint8_t not_used_01                : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+  uint8_t not_used_01                : 1;\r
+  uint8_t tap_ia                     : 1;\r
+  uint8_t single_tap                 : 1;\r
+  uint8_t double_tap                 : 1;\r
+  uint8_t tap_sign                   : 1;\r
+  uint8_t x_tap                      : 1;\r
+  uint8_t y_tap                      : 1;\r
+  uint8_t z_tap                      : 1;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_tap_src_t;\r
+\r
+#define LIS2DOC_SIXD_SRC                    0x3AU\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+  uint8_t xl                         : 1;\r
+  uint8_t xh                         : 1;\r
+  uint8_t yl                         : 1;\r
+  uint8_t yh                         : 1;\r
+  uint8_t zl                         : 1;\r
+  uint8_t zh                         : 1;\r
+  uint8_t _6d_ia                     : 1;\r
+  uint8_t not_used_01                : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+  uint8_t not_used_01                : 1;\r
+  uint8_t _6d_ia                     : 1;\r
+  uint8_t zh                         : 1;\r
+  uint8_t zl                         : 1;\r
+  uint8_t yh                         : 1;\r
+  uint8_t xh                         : 1;\r
+  uint8_t yl                         : 1;\r
+  uint8_t xh                         : 1;\r
+  uint8_t xl                         : 1;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_sixd_src_t;\r
+\r
+#define LIS2DOC_ALL_INT_SRC                 0x3BU\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+  uint8_t ff_ia                      : 1;\r
+  uint8_t wu_ia                      : 1;\r
+  uint8_t single_tap                 : 1;\r
+  uint8_t double_tap                 : 1;\r
+  uint8_t _6d_ia                     : 1;\r
+  uint8_t sleep_change_ia            : 1;\r
+  uint8_t not_used_01                : 2;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+  uint8_t not_used_01                : 2;\r
+  uint8_t sleep_change_ia            : 1;\r
+  uint8_t _6d_ia                     : 1;\r
+  uint8_t double_tap                 : 1;\r
+  uint8_t single_tap                 : 1;\r
+  uint8_t wu_ia                      : 1;\r
+  uint8_t ff_ia                      : 1;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_all_int_src_t;\r
+\r
+#define LIS2DOC_X_OFS_USR                   0x3CU\r
+#define LIS2DOC_Y_OFS_USR                   0x3DU\r
+#define LIS2DOC_Z_OFS_USR                   0x3EU\r
+#define LIS2DOC_CTRL_REG7                   0x3FU\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+  uint8_t lpass_on6d                 : 1;\r
+  uint8_t hp_ref_mode                : 1;\r
+  uint8_t usr_off_w                  : 1;\r
+  uint8_t usr_off_on_wu              : 1;\r
+  uint8_t usr_off_on_out             : 1;\r
+  uint8_t interrupts_enable          : 1;\r
+  uint8_t int2_on_int1               : 1;\r
+  uint8_t drdy_pulsed                : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+  uint8_t drdy_pulsed                : 1;\r
+  uint8_t int2_on_int1               : 1;\r
+  uint8_t interrupts_enable          : 1;\r
+  uint8_t usr_off_on_out             : 1;\r
+  uint8_t usr_off_on_wu              : 1;\r
+  uint8_t usr_off_w                  : 1;\r
+  uint8_t hp_ref_mode                : 1;\r
+  uint8_t lpass_on6d                 : 1;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_ctrl_reg7_t;\r
+\r
+/**\r
+  * @defgroup LIS2DOC_Register_Union\r
+  * @brief    This union group all the registers having a bit-field\r
+  *           description.\r
+  *           This union is useful but it's not needed by the driver.\r
+  *\r
+  *           REMOVING this union you are compliant with:\r
+  *           MISRA-C 2012 [Rule 19.2] -> " Union are not allowed "\r
+  *\r
+  * @{\r
+  *\r
+  */\r
+typedef union\r
+{\r
+  lis2doc_ctrl1_t                   ctrl1;\r
+  lis2doc_ctrl2_t                   ctrl2;\r
+  lis2doc_ctrl3_t                   ctrl3;\r
+  lis2doc_ctrl4_int1_pad_ctrl_t     ctrl4_int1_pad_ctrl;\r
+  lis2doc_ctrl5_int2_pad_ctrl_t     ctrl5_int2_pad_ctrl;\r
+  lis2doc_ctrl6_t                   ctrl6;\r
+  lis2doc_status_t                  status;\r
+  lis2doc_fifo_ctrl_t               fifo_ctrl;\r
+  lis2doc_fifo_samples_t            fifo_samples;\r
+  lis2doc_tap_ths_x_t               tap_ths_x;\r
+  lis2doc_tap_ths_y_t               tap_ths_y;\r
+  lis2doc_tap_ths_z_t               tap_ths_z;\r
+  lis2doc_int_dur_t                 int_dur;\r
+  lis2doc_wake_up_ths_t             wake_up_ths;\r
+  lis2doc_wake_up_dur_t             wake_up_dur;\r
+  lis2doc_free_fall_t               free_fall;\r
+  lis2doc_status_dup_t              status_dup;\r
+  lis2doc_wake_up_src_t             wake_up_src;\r
+  lis2doc_tap_src_t                 tap_src;\r
+  lis2doc_sixd_src_t                sixd_src;\r
+  lis2doc_all_int_src_t             all_int_src;\r
+  lis2doc_ctrl_reg7_t               ctrl_reg7;\r
+  bitwise_t                          bitwise;\r
+  uint8_t                            byte;\r
+} lis2doc_reg_t;\r
+\r
+/**\r
+  * @}\r
+  *\r
+  */\r
+\r
+#ifndef __weak\r
+#define __weak __attribute__((weak))\r
+#endif /* __weak */\r
+\r
+/*\r
+ * These are the basic platform dependent I/O routines to read\r
+ * and write device registers connected on a standard bus.\r
+ * The driver keeps offering a default implementation based on function\r
+ * pointers to read/write routines for backward compatibility.\r
+ * The __weak directive allows the final application to overwrite\r
+ * them with a custom implementation.\r
+ */\r
+\r
+int32_t lis2doc_read_reg(stmdev_ctx_t *ctx, uint8_t reg,\r
+                          uint8_t *data,\r
+                          uint16_t len);\r
+int32_t lis2doc_write_reg(stmdev_ctx_t *ctx, uint8_t reg,\r
+                           uint8_t *data,\r
+                           uint16_t len);\r
+\r
+float_t lis2doc_from_fs2_to_mg(int16_t lsb);\r
+float_t lis2doc_from_fs4_to_mg(int16_t lsb);\r
+float_t lis2doc_from_fs8_to_mg(int16_t lsb);\r
+float_t lis2doc_from_fs16_to_mg(int16_t lsb);\r
+\r
+float_t lis2doc_from_fs2_lp1_to_mg(int16_t lsb);\r
+float_t lis2doc_from_fs4_lp1_to_mg(int16_t lsb);\r
+float_t lis2doc_from_fs8_lp1_to_mg(int16_t lsb);\r
+float_t lis2doc_from_fs16_lp1_to_mg(int16_t lsb);\r
+\r
+float_t lis2doc_from_lsb_to_celsius(int16_t lsb);\r
+\r
+typedef struct\r
+{\r
+  uint8_t sdrc       : 1;\r
+  uint8_t lpm        : 1;\r
+  uint8_t hpm        : 1;\r
+  uint8_t low_noise  : 1;\r
+} lis2doc_mode_t;\r
+int32_t lis2doc_power_mode_set(stmdev_ctx_t *ctx,\r
+                                lis2doc_mode_t val);\r
+int32_t lis2doc_power_mode_get(stmdev_ctx_t *ctx,\r
+                                lis2doc_mode_t *val);\r
+\r
+typedef enum\r
+{\r
+  LIS2DOC_XL_ODR_OFF            = 0x00,\r
+  LIS2DOC_XL_ODR_1Hz6_LP_ONLY   = 0x01,\r
+  LIS2DOC_XL_ODR_12Hz5          = 0x02,\r
+  LIS2DOC_XL_ODR_25Hz           = 0x03,\r
+  LIS2DOC_XL_ODR_50Hz           = 0x04,\r
+  LIS2DOC_XL_ODR_100Hz          = 0x05,\r
+  LIS2DOC_XL_ODR_200Hz          = 0x06,\r
+  LIS2DOC_XL_ODR_400Hz          = 0x07,\r
+  LIS2DOC_XL_ODR_800Hz          = 0x08,\r
+  LIS2DOC_XL_ODR_1k6Hz          = 0x09,\r
+  LIS2DOC_XL_SET_SW_TRIG        = 0x32,  /* Use this only in SINGLE mode */\r
+  LIS2DOC_XL_SET_PIN_TRIG       = 0x12,  /* Use this only in SINGLE mode */\r
+} lis2doc_odr_t;\r
+int32_t lis2doc_data_rate_set(stmdev_ctx_t *ctx, lis2doc_odr_t val);\r
+int32_t lis2doc_data_rate_get(stmdev_ctx_t *ctx,\r
+                               lis2doc_odr_t *val);\r
+\r
+int32_t lis2doc_block_data_update_set(stmdev_ctx_t *ctx,\r
+                                       uint8_t val);\r
+int32_t lis2doc_block_data_update_get(stmdev_ctx_t *ctx,\r
+                                       uint8_t *val);\r
+\r
+typedef enum\r
+{\r
+  LIS2DOC_2g     = 0,\r
+  LIS2DOC_4g     = 1,\r
+  LIS2DOC_8g     = 2,\r
+  LIS2DOC_16g    = 3,\r
+} lis2doc_fs_t;\r
+int32_t lis2doc_full_scale_set(stmdev_ctx_t *ctx, lis2doc_fs_t val);\r
+int32_t lis2doc_full_scale_get(stmdev_ctx_t *ctx,\r
+                                lis2doc_fs_t *val);\r
+\r
+int32_t lis2doc_status_reg_get(stmdev_ctx_t *ctx,\r
+                                lis2doc_status_t *val);\r
+\r
+int32_t lis2doc_flag_data_ready_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+typedef struct\r
+{\r
+  lis2doc_status_dup_t   status_dup;\r
+  lis2doc_wake_up_src_t  wake_up_src;\r
+  lis2doc_tap_src_t      tap_src;\r
+  lis2doc_sixd_src_t     sixd_src;\r
+  lis2doc_all_int_src_t  all_int_src;\r
+} lis2doc_all_sources_t;\r
+int32_t lis2doc_all_sources_get(stmdev_ctx_t *ctx,\r
+                                 lis2doc_all_sources_t *val);\r
+\r
+int32_t lis2doc_usr_offset_x_set(stmdev_ctx_t *ctx, uint8_t *buff);\r
+int32_t lis2doc_usr_offset_x_get(stmdev_ctx_t *ctx, uint8_t *buff);\r
+\r
+int32_t lis2doc_usr_offset_y_set(stmdev_ctx_t *ctx, uint8_t *buff);\r
+int32_t lis2doc_usr_offset_y_get(stmdev_ctx_t *ctx, uint8_t *buff);\r
+\r
+int32_t lis2doc_usr_offset_z_set(stmdev_ctx_t *ctx, uint8_t *buff);\r
+int32_t lis2doc_usr_offset_z_get(stmdev_ctx_t *ctx, uint8_t *buff);\r
+\r
+typedef enum\r
+{\r
+  LIS2DOC_LSb_977ug    = 0,\r
+  LIS2DOC_LSb_15mg6    = 1,\r
+} lis2doc_usr_off_w_t;\r
+int32_t lis2doc_offset_weight_set(stmdev_ctx_t *ctx,\r
+                                   lis2doc_usr_off_w_t val);\r
+int32_t lis2doc_offset_weight_get(stmdev_ctx_t *ctx,\r
+                                   lis2doc_usr_off_w_t *val);\r
+\r
+int32_t lis2doc_temperature_raw_get(stmdev_ctx_t *ctx, int16_t *val);\r
+\r
+int32_t lis2doc_acceleration_raw_get(stmdev_ctx_t *ctx,\r
+                                      int16_t *val);\r
+\r
+int32_t lis2doc_device_id_get(stmdev_ctx_t *ctx, uint8_t *buff);\r
+\r
+int32_t lis2doc_auto_increment_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_auto_increment_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_reset_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_reset_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_boot_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_boot_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+typedef enum\r
+{\r
+  LIS2DOC_XL_ST_DISABLE      = 0,\r
+  LIS2DOC_XL_ST_POSITIVE     = 1,\r
+  LIS2DOC_XL_ST_NEGATIVE     = 2,\r
+} lis2doc_st_t;\r
+int32_t lis2doc_self_test_set(stmdev_ctx_t *ctx, lis2doc_st_t val);\r
+int32_t lis2doc_self_test_get(stmdev_ctx_t *ctx, lis2doc_st_t *val);\r
+\r
+typedef enum\r
+{\r
+  LIS2DOC_DRDY_LATCHED   = 0,\r
+  LIS2DOC_DRDY_PULSED    = 1,\r
+} lis2doc_drdy_pulsed_t;\r
+int32_t lis2doc_data_ready_mode_set(stmdev_ctx_t *ctx,\r
+                                     lis2doc_drdy_pulsed_t val);\r
+int32_t lis2doc_data_ready_mode_get(stmdev_ctx_t *ctx,\r
+                                     lis2doc_drdy_pulsed_t *val);\r
+\r
+typedef enum\r
+{\r
+  LIS2DOC_LPF_ON_OUT         = 0x00,\r
+  LIS2DOC_USER_OFFSET_ON_OUT  = 0x01,\r
+  LIS2DOC_HIGH_PASS_ON_OUT    = 0x10,\r
+} lis2doc_fds_t;\r
+int32_t lis2doc_filter_path_set(stmdev_ctx_t *ctx,\r
+                                 lis2doc_fds_t val);\r
+int32_t lis2doc_filter_path_get(stmdev_ctx_t *ctx,\r
+                                 lis2doc_fds_t *val);\r
+\r
+typedef enum\r
+{\r
+  LIS2DOC_ODR_DIV_2     = 0,\r
+  LIS2DOC_ODR_DIV_4     = 1,\r
+  LIS2DOC_ODR_DIV_10    = 2,\r
+  LIS2DOC_ODR_DIV_20    = 3,\r
+} lis2doc_bw_filt_t;\r
+int32_t lis2doc_filter_bandwidth_set(stmdev_ctx_t *ctx,\r
+                                      lis2doc_bw_filt_t val);\r
+int32_t lis2doc_filter_bandwidth_get(stmdev_ctx_t *ctx,\r
+                                      lis2doc_bw_filt_t *val);\r
+\r
+int32_t lis2doc_reference_mode_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_reference_mode_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+typedef enum\r
+{\r
+  LIS2DOC_SPI_4_WIRE   = 0,\r
+  LIS2DOC_SPI_3_WIRE   = 1,\r
+} lis2doc_sim_t;\r
+int32_t lis2doc_spi_mode_set(stmdev_ctx_t *ctx, lis2doc_sim_t val);\r
+int32_t lis2doc_spi_mode_get(stmdev_ctx_t *ctx, lis2doc_sim_t *val);\r
+\r
+typedef enum\r
+{\r
+  LIS2DOC_I2C_ENABLE    = 0,\r
+  LIS2DOC_I2C_DISABLE   = 1,\r
+} lis2doc_i2c_disable_t;\r
+int32_t lis2doc_i2c_interface_set(stmdev_ctx_t *ctx,\r
+                                   lis2doc_i2c_disable_t val);\r
+int32_t lis2doc_i2c_interface_get(stmdev_ctx_t *ctx,\r
+                                   lis2doc_i2c_disable_t *val);\r
+\r
+typedef enum\r
+{\r
+  LIS2DOC_PULL_UP_CONNECT     = 0,\r
+  LIS2DOC_PULL_UP_DISCONNECT  = 1,\r
+} lis2doc_cs_pu_disc_t;\r
+int32_t lis2doc_cs_mode_set(stmdev_ctx_t *ctx,\r
+                             lis2doc_cs_pu_disc_t val);\r
+int32_t lis2doc_cs_mode_get(stmdev_ctx_t *ctx,\r
+                             lis2doc_cs_pu_disc_t *val);\r
+\r
+typedef enum\r
+{\r
+  LIS2DOC_ACTIVE_HIGH  = 0,\r
+  LIS2DOC_ACTIVE_LOW   = 1,\r
+} lis2doc_h_lactive_t;\r
+int32_t lis2doc_pin_polarity_set(stmdev_ctx_t *ctx,\r
+                                  lis2doc_h_lactive_t val);\r
+int32_t lis2doc_pin_polarity_get(stmdev_ctx_t *ctx,\r
+                                  lis2doc_h_lactive_t *val);\r
+\r
+typedef enum\r
+{\r
+  LIS2DOC_INT_PULSED   = 0,\r
+  LIS2DOC_INT_LATCHED  = 1,\r
+} lis2doc_lir_t;\r
+int32_t lis2doc_int_notification_set(stmdev_ctx_t *ctx,\r
+                                      lis2doc_lir_t val);\r
+int32_t lis2doc_int_notification_get(stmdev_ctx_t *ctx,\r
+                                      lis2doc_lir_t *val);\r
+\r
+typedef enum\r
+{\r
+  LIS2DOC_PUSH_PULL   = 0,\r
+  LIS2DOC_OPEN_DRAIN  = 1,\r
+} lis2doc_pp_od_t;\r
+int32_t lis2doc_pin_mode_set(stmdev_ctx_t *ctx,\r
+                              lis2doc_pp_od_t val);\r
+int32_t lis2doc_pin_mode_get(stmdev_ctx_t *ctx,\r
+                              lis2doc_pp_od_t *val);\r
+\r
+int32_t lis2doc_pin_int1_route_set(stmdev_ctx_t *ctx,\r
+                                    lis2doc_ctrl4_int1_pad_ctrl_t *val);\r
+int32_t lis2doc_pin_int1_route_get(stmdev_ctx_t *ctx,\r
+                                    lis2doc_ctrl4_int1_pad_ctrl_t *val);\r
+\r
+int32_t lis2doc_pin_int2_route_set(stmdev_ctx_t *ctx,\r
+                                    lis2doc_ctrl5_int2_pad_ctrl_t *val);\r
+int32_t lis2doc_pin_int2_route_get(stmdev_ctx_t *ctx,\r
+                                    lis2doc_ctrl5_int2_pad_ctrl_t *val);\r
+\r
+int32_t lis2doc_all_on_int1_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_all_on_int1_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_wkup_threshold_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_wkup_threshold_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_wkup_dur_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_wkup_dur_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+typedef enum\r
+{\r
+  LIS2DOC_HP_FEED           = 0,\r
+  LIS2DOC_USER_OFFSET_FEED  = 1,\r
+} lis2doc_usr_off_on_wu_t;\r
+int32_t lis2doc_wkup_feed_data_set(stmdev_ctx_t *ctx,\r
+                                    lis2doc_usr_off_on_wu_t val);\r
+int32_t lis2doc_wkup_feed_data_get(stmdev_ctx_t *ctx,\r
+                                    lis2doc_usr_off_on_wu_t *val);\r
+\r
+typedef enum\r
+{\r
+  LIS2DOC_NO_DETECTION        = 0,\r
+  LIS2DOC_DETECT_ACT_INACT    = 1,\r
+  LIS2DOC_DETECT_STAT_MOTION  = 3,\r
+} lis2doc_sleep_on_t;\r
+int32_t lis2doc_act_mode_set(stmdev_ctx_t *ctx,\r
+                              lis2doc_sleep_on_t val);\r
+int32_t lis2doc_act_mode_get(stmdev_ctx_t *ctx,\r
+                              lis2doc_sleep_on_t *val);\r
+\r
+int32_t lis2doc_act_sleep_dur_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_act_sleep_dur_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_tap_threshold_x_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_tap_threshold_x_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_tap_threshold_y_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_tap_threshold_y_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+typedef enum\r
+{\r
+  LIS2DOC_XYZ    = 0,\r
+  LIS2DOC_YXZ    = 1,\r
+  LIS2DOC_XZY    = 2,\r
+  LIS2DOC_ZYX    = 3,\r
+  LIS2DOC_YZX    = 5,\r
+  LIS2DOC_ZXY    = 6,\r
+} lis2doc_tap_prior_t;\r
+int32_t lis2doc_tap_axis_priority_set(stmdev_ctx_t *ctx,\r
+                                       lis2doc_tap_prior_t val);\r
+int32_t lis2doc_tap_axis_priority_get(stmdev_ctx_t *ctx,\r
+                                       lis2doc_tap_prior_t *val);\r
+\r
+int32_t lis2doc_tap_threshold_z_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_tap_threshold_z_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_tap_detection_on_z_set(stmdev_ctx_t *ctx,\r
+                                        uint8_t val);\r
+int32_t lis2doc_tap_detection_on_z_get(stmdev_ctx_t *ctx,\r
+                                        uint8_t *val);\r
+\r
+int32_t lis2doc_tap_detection_on_y_set(stmdev_ctx_t *ctx,\r
+                                        uint8_t val);\r
+int32_t lis2doc_tap_detection_on_y_get(stmdev_ctx_t *ctx,\r
+                                        uint8_t *val);\r
+\r
+int32_t lis2doc_tap_detection_on_x_set(stmdev_ctx_t *ctx,\r
+                                        uint8_t val);\r
+int32_t lis2doc_tap_detection_on_x_get(stmdev_ctx_t *ctx,\r
+                                        uint8_t *val);\r
+\r
+int32_t lis2doc_tap_shock_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_tap_shock_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_tap_quiet_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_tap_quiet_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_tap_dur_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_tap_dur_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+typedef enum\r
+{\r
+  LIS2DOC_ONLY_SINGLE          = 0,\r
+  LIS2DOC_BOTH_SINGLE_DOUBLE   = 1,\r
+} lis2doc_single_double_tap_t;\r
+int32_t lis2doc_tap_mode_set(stmdev_ctx_t *ctx,\r
+                              lis2doc_single_double_tap_t val);\r
+int32_t lis2doc_tap_mode_get(stmdev_ctx_t *ctx,\r
+                              lis2doc_single_double_tap_t *val);\r
+\r
+int32_t lis2doc_tap_src_get(stmdev_ctx_t *ctx,\r
+                             lis2doc_tap_src_t *val);\r
+\r
+int32_t lis2doc_6d_threshold_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_6d_threshold_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_4d_mode_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_4d_mode_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_6d_src_get(stmdev_ctx_t *ctx,\r
+                            lis2doc_sixd_src_t *val);\r
+\r
+typedef enum\r
+{\r
+  LIS2DOC_ODR_DIV_2_FEED   = 0,\r
+  LIS2DOC_LPF2_FEED        = 1,\r
+} lis2doc_lpass_on6d_t;\r
+int32_t lis2doc_6d_feed_data_set(stmdev_ctx_t *ctx,\r
+                                  lis2doc_lpass_on6d_t val);\r
+int32_t lis2doc_6d_feed_data_get(stmdev_ctx_t *ctx,\r
+                                  lis2doc_lpass_on6d_t *val);\r
+\r
+int32_t lis2doc_ff_dur_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_ff_dur_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+typedef enum\r
+{\r
+  LIS2DOC_FF_TSH_5LSb_FS2g  = 0,\r
+  LIS2DOC_FF_TSH_7LSb_FS2g  = 1,\r
+  LIS2DOC_FF_TSH_8LSb_FS2g  = 2,\r
+  LIS2DOC_FF_TSH_10LSb_FS2g = 3,\r
+  LIS2DOC_FF_TSH_11LSb_FS2g = 4,\r
+  LIS2DOC_FF_TSH_13LSb_FS2g = 5,\r
+  LIS2DOC_FF_TSH_15LSb_FS2g = 6,\r
+  LIS2DOC_FF_TSH_16LSb_FS2g = 7,\r
+} lis2doc_ff_ths_t;\r
+int32_t lis2doc_ff_threshold_set(stmdev_ctx_t *ctx,\r
+                                  lis2doc_ff_ths_t val);\r
+int32_t lis2doc_ff_threshold_get(stmdev_ctx_t *ctx,\r
+                                  lis2doc_ff_ths_t *val);\r
+\r
+int32_t lis2doc_fifo_watermark_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_fifo_watermark_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+typedef enum\r
+{\r
+  LIS2DOC_BYPASS_MODE             = 0,\r
+  LIS2DOC_FIFO_MODE               = 1,\r
+  LIS2DOC_STREAM_TO_FIFO_MODE     = 3,\r
+  LIS2DOC_BYPASS_TO_STREAM_MODE   = 4,\r
+  LIS2DOC_STREAM_MODE             = 6,\r
+} lis2doc_fmode_t;\r
+int32_t lis2doc_fifo_mode_set(stmdev_ctx_t *ctx,\r
+                               lis2doc_fmode_t val);\r
+int32_t lis2doc_fifo_mode_get(stmdev_ctx_t *ctx,\r
+                               lis2doc_fmode_t *val);\r
+\r
+int32_t lis2doc_fifo_data_level_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_fifo_ovr_flag_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_fifo_wtm_flag_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+/**\r
+  * @}\r
+  *\r
+  */\r
+\r
+#ifdef __cplusplus\r
+}\r
+#endif\r
+\r
+#endif /*LIS2DOC_REGS_H */\r
+\r
+/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/\r
diff --git a/code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_activity.c b/code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_activity.c
new file mode 100644 (file)
index 0000000..c8ef645
--- /dev/null
@@ -0,0 +1,314 @@
+/*\r
+ ******************************************************************************\r
+ * @file    activity.c\r
+ * @author  Sensors Software Solution Team\r
+ * @brief   This file show the simplest way to detect activity/inactivity\r
+ *       from sensor.\r
+ *\r
+ ******************************************************************************\r
+ * @attention\r
+ *\r
+ * <h2><center>&copy; Copyright (c) 2020 STMicroelectronics.\r
+ * All rights reserved.</center></h2>\r
+ *\r
+ * This software component is licensed by ST under BSD 3-Clause license,\r
+ * the "License"; You may not use this file except in compliance with the\r
+ * License. You may obtain a copy of the License at:\r
+ *                        opensource.org/licenses/BSD-3-Clause\r
+ *\r
+ ******************************************************************************\r
+ */\r
+\r
+/*\r
+ * This example was developed using the following STMicroelectronics\r
+ * evaluation boards:\r
+ *\r
+ * - STEVAL_MKI109V3 + STEVAL-MKI179V1\r
+ * - NUCLEO_F411RE + X_NUCLEO_IKS01A3\r
+ * - DISCOVERY_SPC584B + X_NUCLEO_IKS01A3\r
+ *\r
+ * and STM32CubeMX tool with STM32CubeF4 MCU Package\r
+ *\r
+ * Used interfaces:\r
+ *\r
+ * STEVAL_MKI109V3    - Host side:   USB (Virtual COM)\r
+ *                    - Sensor side: SPI(Default) / I2C(supported)\r
+ *\r
+ * NUCLEO_STM32F411RE - Host side: UART(COM) to USB bridge\r
+ *                    - I2C(Default) / SPI(supported)\r
+ *\r
+ * DISCOVERY_SPC584B  - Host side: UART(COM) to USB bridge\r
+ *                    - Sensor side: I2C(Default) / SPI(supported)\r
+ *\r
+ * If you need to run this example on a different hardware platform a\r
+ * modification of the functions: `platform_write`, `platform_read`,\r
+ * `tx_com` and 'platform_init' is required.\r
+ *\r
+ */\r
+\r
+/* STMicroelectronics evaluation boards definition\r
+ *\r
+ * Please uncomment ONLY the evaluation boards in use.\r
+ * If a different hardware is used please comment all\r
+ * following target board and redefine yours.\r
+ */\r
+\r
+//#define STEVAL_MKI109V3  /* little endian */\r
+//#define NUCLEO_F411RE    /* little endian */\r
+//#define SPC584B_DIS      /* big endian */\r
+\r
+/* ATTENTION: By default the driver is little endian. If you need switch\r
+ *            to big endian please see "Endianness definitions" in the\r
+ *            header file of the driver (_reg.h).\r
+ */\r
+\r
+\r
+#if defined(STEVAL_MKI109V3)\r
+/* MKI109V3: Define communication interface */\r
+#define SENSOR_BUS hspi2\r
+/* MKI109V3: Vdd and Vddio power supply values */\r
+#define PWM_3V3 915\r
+\r
+#elif defined(NUCLEO_F411RE)\r
+/* NUCLEO_F411RE: Define communication interface */\r
+#define SENSOR_BUS hi2c1\r
+\r
+#elif defined(SPC584B_DIS)\r
+/* DISCOVERY_SPC584B: Define communication interface */\r
+#define SENSOR_BUS I2CD1\r
+\r
+#endif\r
+\r
+/* Includes ------------------------------------------------------------------*/\r
+#include <string.h>\r
+#include <stdio.h>\r
+#include "lis2doc_reg.h"\r
+\r
+#if defined(NUCLEO_F411RE)\r
+#include "stm32f4xx_hal.h"\r
+#include "usart.h"\r
+#include "gpio.h"\r
+#include "i2c.h"\r
+\r
+#elif defined(STEVAL_MKI109V3)\r
+#include "stm32f4xx_hal.h"\r
+#include "usbd_cdc_if.h"\r
+#include "gpio.h"\r
+#include "spi.h"\r
+#include "tim.h"\r
+\r
+#elif defined(SPC584B_DIS)\r
+#include "components.h"\r
+#endif\r
+\r
+/* Private macro -------------------------------------------------------------*/\r
+#define    BOOT_TIME            20 //ms\r
+\r
+/* Private variables ---------------------------------------------------------*/\r
+static lis2doc_mode_t pm;\r
+static uint8_t whoamI, rst;\r
+static uint8_t tx_buffer[1000];\r
+\r
+/* Extern variables ----------------------------------------------------------*/\r
+\r
+/* Private functions ---------------------------------------------------------*/\r
+\r
+/*\r
+ *   WARNING:\r
+ *   Functions declare in this section are defined at the end of this file\r
+ *   and are strictly related to the hardware platform used.\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+                              uint16_t len);\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+                             uint16_t len);\r
+static void tx_com( uint8_t *tx_buffer, uint16_t len );\r
+static void platform_delay(uint32_t ms);\r
+static void platform_init(void);\r
+\r
+\r
+/* Main Example --------------------------------------------------------------*/\r
+void lis2doc_activity(void)\r
+{\r
+  /* Initialize mems driver interface */\r
+  stmdev_ctx_t dev_ctx;\r
+  lis2doc_reg_t int_route;\r
+  dev_ctx.write_reg = platform_write;\r
+  dev_ctx.read_reg = platform_read;\r
+  dev_ctx.handle = &SENSOR_BUS;\r
+  /* Initialize platform specific hardware */\r
+  platform_init();\r
+  /* Wait sensor boot time */\r
+  platform_delay(BOOT_TIME);\r
+  /* Check device ID */\r
+  lis2doc_device_id_get(&dev_ctx, &whoamI);\r
+\r
+  if (whoamI != LIS2DOC_ID)\r
+    while (1) {\r
+      /* manage here device not found */\r
+    }\r
+\r
+  /* Restore default configuration */\r
+  lis2doc_reset_set(&dev_ctx, PROPERTY_ENABLE);\r
+\r
+  do {\r
+    lis2doc_reset_get(&dev_ctx, &rst);\r
+  } while (rst);\r
+\r
+  /* Set full scale */\r
+  lis2doc_full_scale_set(&dev_ctx, LIS2DOC_2g);\r
+  /* Configure filtering chain\r
+   * Accelerometer - filter path / bandwidth\r
+   */\r
+  lis2doc_filter_path_set(&dev_ctx, LIS2DOC_LPF_ON_OUT);\r
+  lis2doc_filter_bandwidth_set(&dev_ctx, LIS2DOC_ODR_DIV_4);\r
+\r
+  /* Configure power mode */\r
+  pm.lpm = 1;\r
+  pm.low_noise = 1;\r
+  lis2doc_power_mode_set(&dev_ctx, pm);\r
+\r
+  /* Set wake-up duration\r
+   * Wake up duration event 1LSb = 1 / ODR\r
+   */\r
+  lis2doc_wkup_dur_set(&dev_ctx, 2);\r
+  /* Set sleep duration\r
+   * Duration to go in sleep mode (1 LSb = 512 / ODR)\r
+   */\r
+  lis2doc_act_sleep_dur_set(&dev_ctx, 2);\r
+  /* Set Activity wake-up threshold\r
+   * Threshold for wake-up 1 LSB = FS_XL / 64\r
+   */\r
+  lis2doc_wkup_threshold_set(&dev_ctx, 2);\r
+  /* Data sent to wake-up interrupt function */\r
+  lis2doc_wkup_feed_data_set(&dev_ctx, LIS2DOC_HP_FEED);\r
+  /* Config activity / inactivity or stationary / motion detection */\r
+  lis2doc_act_mode_set(&dev_ctx, LIS2DOC_DETECT_ACT_INACT);\r
+  /* Enable activity detection interrupt */\r
+  lis2doc_pin_int1_route_get(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);\r
+  int_route.ctrl4_int1_pad_ctrl.int1_wu = PROPERTY_ENABLE;\r
+  lis2doc_pin_int1_route_set(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);\r
+  /* Set Output Data Rate */\r
+  lis2doc_data_rate_set(&dev_ctx, LIS2DOC_XL_ODR_200Hz);\r
+\r
+  /* Wait Events */\r
+  while (1) {\r
+    lis2doc_all_sources_t all_source;\r
+    /* Read status register */\r
+    lis2doc_all_sources_get(&dev_ctx, &all_source);\r
+\r
+    /* Check if Activity/Inactivity events */\r
+    if (all_source.wake_up_src.sleep_state_ia) {\r
+      sprintf((char *)tx_buffer, "Inactivity Detected\r\n");\r
+      tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
+    }\r
+\r
+    if (all_source.wake_up_src.wu_ia) {\r
+      sprintf((char *)tx_buffer, "Activity Detected\r\n");\r
+      tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
+    }\r
+  }\r
+}\r
+\r
+/*\r
+ * @brief  Write generic device register (platform dependent)\r
+ *\r
+ * @param  handle    customizable argument. In this examples is used in\r
+ *                   order to select the correct sensor bus handler.\r
+ * @param  reg       register to write\r
+ * @param  bufp      pointer to data to write in register reg\r
+ * @param  len       number of consecutive register to write\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+                              uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_I2C_Mem_Write(handle, LIS2DOC_I2C_ADD_H, reg,\r
+                    I2C_MEMADD_SIZE_8BIT, (uint8_t*) bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+  HAL_SPI_Transmit(handle, &reg, 1, 1000);\r
+  HAL_SPI_Transmit(handle, (uint8_t*) bufp, len, 1000);\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+  i2c_lld_write(handle,  LIS2DOC_I2C_ADD_H & 0xFE, reg, (uint8_t*) bufp, len);\r
+#endif\r
+  return 0;\r
+}\r
+\r
+/*\r
+ * @brief  Read generic device register (platform dependent)\r
+ *\r
+ * @param  handle    customizable argument. In this examples is used in\r
+ *                   order to select the correct sensor bus handler.\r
+ * @param  reg       register to read\r
+ * @param  bufp      pointer to buffer that store the data read\r
+ * @param  len       number of consecutive register to read\r
+ *\r
+ */\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+                             uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_I2C_Mem_Read(handle, LIS2DOC_I2C_ADD_H, reg,\r
+                   I2C_MEMADD_SIZE_8BIT, bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  reg |= 0x80;\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+  HAL_SPI_Transmit(handle, &reg, 1, 1000);\r
+  HAL_SPI_Receive(handle, bufp, len, 1000);\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+  i2c_lld_read(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, bufp, len);\r
+#endif\r
+  return 0;\r
+}\r
+\r
+/*\r
+ * @brief  Write generic device register (platform dependent)\r
+ *\r
+ * @param  tx_buffer     buffer to transmit\r
+ * @param  len           number of byte to send\r
+ *\r
+ */\r
+static void tx_com(uint8_t *tx_buffer, uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_UART_Transmit(&huart2, tx_buffer, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  CDC_Transmit_FS(tx_buffer, len);\r
+#elif defined(SPC584B_DIS)\r
+  sd_lld_write(&SD2, tx_buffer, len);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief  platform specific delay (platform dependent)\r
+ *\r
+ * @param  ms        delay in ms\r
+ *\r
+ */\r
+static void platform_delay(uint32_t ms)\r
+{\r
+#if defined(NUCLEO_F411RE) | defined(STEVAL_MKI109V3)\r
+  HAL_Delay(ms);\r
+#elif defined(SPC584B_DIS)\r
+  osalThreadDelayMilliseconds(ms);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief  platform specific initialization (platform dependent)\r
+ */\r
+static void platform_init(void)\r
+{\r
+#if defined(STEVAL_MKI109V3)\r
+  TIM3->CCR1 = PWM_3V3;\r
+  TIM3->CCR2 = PWM_3V3;\r
+  HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);\r
+  HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);\r
+  HAL_Delay(1000);\r
+#endif\r
+}
\ No newline at end of file
diff --git a/code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_free_fall.c b/code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_free_fall.c
new file mode 100644 (file)
index 0000000..1cdfe6d
--- /dev/null
@@ -0,0 +1,289 @@
+/*\r
+ ******************************************************************************\r
+ * @file    free_fall.c\r
+ * @author  Sensors Software Solution Team\r
+ * @brief   This file show the simplest way to detect free fall events\r
+ *          from sensor.\r
+ *\r
+ ******************************************************************************\r
+ * @attention\r
+ *\r
+ * <h2><center>&copy; Copyright (c) 2020 STMicroelectronics.\r
+ * All rights reserved.</center></h2>\r
+ *\r
+ * This software component is licensed by ST under BSD 3-Clause license,\r
+ * the "License"; You may not use this file except in compliance with the\r
+ * License. You may obtain a copy of the License at:\r
+ *                        opensource.org/licenses/BSD-3-Clause\r
+ *\r
+ ******************************************************************************\r
+ */\r
+\r
+/*\r
+ * This example was developed using the following STMicroelectronics\r
+ * evaluation boards:\r
+ *\r
+ * - STEVAL_MKI109V3 + STEVAL-MKI179V1\r
+ * - NUCLEO_F411RE + X_NUCLEO_IKS01A3\r
+ * - DISCOVERY_SPC584B + X_NUCLEO_IKS01A3\r
+ *\r
+ * and STM32CubeMX tool with STM32CubeF4 MCU Package\r
+ *\r
+ * Used interfaces:\r
+ *\r
+ * STEVAL_MKI109V3    - Host side:   USB (Virtual COM)\r
+ *                    - Sensor side: SPI(Default) / I2C(supported)\r
+ *\r
+ * NUCLEO_STM32F411RE - Host side: UART(COM) to USB bridge\r
+ *                    - I2C(Default) / SPI(supported)\r
+ *\r
+ * DISCOVERY_SPC584B  - Host side: UART(COM) to USB bridge\r
+ *                    - Sensor side: I2C(Default) / SPI(supported)\r
+ *\r
+ * If you need to run this example on a different hardware platform a\r
+ * modification of the functions: `platform_write`, `platform_read`,\r
+ * `tx_com` and 'platform_init' is required.\r
+ *\r
+ */\r
+\r
+/* STMicroelectronics evaluation boards definition\r
+ *\r
+ * Please uncomment ONLY the evaluation boards in use.\r
+ * If a different hardware is used please comment all\r
+ * following target board and redefine yours.\r
+ */\r
+\r
+//#define STEVAL_MKI109V3  /* little endian */\r
+//#define NUCLEO_F411RE    /* little endian */\r
+//#define SPC584B_DIS      /* big endian */\r
+\r
+/* ATTENTION: By default the driver is little endian. If you need switch\r
+ *            to big endian please see "Endianness definitions" in the\r
+ *            header file of the driver (_reg.h).\r
+ */\r
+\r
+\r
+#if defined(STEVAL_MKI109V3)\r
+/* MKI109V3: Define communication interface */\r
+#define SENSOR_BUS hspi2\r
+/* MKI109V3: Vdd and Vddio power supply values */\r
+#define PWM_3V3 915\r
+\r
+#elif defined(NUCLEO_F411RE)\r
+/* NUCLEO_F411RE: Define communication interface */\r
+#define SENSOR_BUS hi2c1\r
+\r
+#elif defined(SPC584B_DIS)\r
+/* DISCOVERY_SPC584B: Define communication interface */\r
+#define SENSOR_BUS I2CD1\r
+\r
+#endif\r
+\r
+/* Includes ------------------------------------------------------------------*/\r
+#include <string.h>\r
+#include <stdio.h>\r
+#include "lis2doc_reg.h"\r
+\r
+#if defined(NUCLEO_F411RE)\r
+#include "stm32f4xx_hal.h"\r
+#include "usart.h"\r
+#include "gpio.h"\r
+#include "i2c.h"\r
+\r
+#elif defined(STEVAL_MKI109V3)\r
+#include "stm32f4xx_hal.h"\r
+#include "usbd_cdc_if.h"\r
+#include "gpio.h"\r
+#include "spi.h"\r
+#include "tim.h"\r
+\r
+#elif defined(SPC584B_DIS)\r
+#include "components.h"\r
+#endif\r
+\r
+/* Private macro -------------------------------------------------------------*/\r
+#define    BOOT_TIME            20 //ms\r
+\r
+/* Private variables ---------------------------------------------------------*/\r
+static lis2doc_mode_t pm;\r
+static uint8_t whoamI, rst;\r
+static uint8_t tx_buffer[1000];\r
+\r
+/* Extern variables ----------------------------------------------------------*/\r
+\r
+/* Private functions ---------------------------------------------------------*/\r
+/*\r
+ *   WARNING:\r
+ *   Functions declare in this section are defined at the end of this file\r
+ *   and are strictly related to the hardware platform used.\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+                              uint16_t len);\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+                             uint16_t len);\r
+static void tx_com( uint8_t *tx_buffer, uint16_t len );\r
+static void platform_delay(uint32_t ms);\r
+static void platform_init(void);\r
+\r
+/* Main Example --------------------------------------------------------------*/\r
+void lis2doc_free_fall(void)\r
+{\r
+  /* Initialize mems driver interface */\r
+  stmdev_ctx_t dev_ctx;\r
+  lis2doc_reg_t int_route;\r
+  dev_ctx.write_reg = platform_write;\r
+  dev_ctx.read_reg = platform_read;\r
+  dev_ctx.handle = &SENSOR_BUS;\r
+  /* Initialize platform specific hardware */\r
+  platform_init();\r
+  /* Wait sensor boot time */\r
+  platform_delay(BOOT_TIME);\r
+  /* Check device ID */\r
+  lis2doc_device_id_get(&dev_ctx, &whoamI);\r
+\r
+  if (whoamI != LIS2DOC_ID)\r
+    while (1) {\r
+      /* manage here device not found */\r
+    }\r
+\r
+  /* Restore default configuration */\r
+  lis2doc_reset_set(&dev_ctx, PROPERTY_ENABLE);\r
+\r
+  do {\r
+    lis2doc_reset_get(&dev_ctx, &rst);\r
+  } while (rst);\r
+\r
+  /* Configure power mode */\r
+  pm.hpm = 1;\r
+  pm.low_noise = 1;\r
+  lis2doc_power_mode_set(&dev_ctx, pm);\r
+\r
+  /* Set Output Data Rate */\r
+  lis2doc_data_rate_set(&dev_ctx, LIS2DOC_XL_ODR_200Hz);\r
+  /* Set full scale to 2 g */\r
+  lis2doc_full_scale_set(&dev_ctx, LIS2DOC_2g);\r
+  /* Configure Free Fall duration and samples count */\r
+  lis2doc_ff_dur_set(&dev_ctx, 0x06);\r
+  lis2doc_ff_threshold_set(&dev_ctx, LIS2DOC_FF_TSH_10LSb_FS2g);\r
+  /* Enable free fall interrupt */\r
+  lis2doc_pin_int1_route_get(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);\r
+  int_route.ctrl4_int1_pad_ctrl.int1_ff = PROPERTY_ENABLE;\r
+  lis2doc_pin_int1_route_set(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);\r
+  /* Set latched interrupt */\r
+  lis2doc_int_notification_set(&dev_ctx, LIS2DOC_INT_LATCHED);\r
+\r
+  /* Wait Events */\r
+  while (1) {\r
+    /* Check Free Fall events */\r
+    lis2doc_all_sources_t src;\r
+    lis2doc_all_sources_get(&dev_ctx, &src);\r
+\r
+    if (src.wake_up_src.ff_ia) {\r
+      sprintf((char *)tx_buffer, "free fall detected\r\n");\r
+      tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
+    }\r
+  }\r
+}\r
+\r
+/*\r
+ * @brief  Write generic device register (platform dependent)\r
+ *\r
+ * @param  handle    customizable argument. In this examples is used in\r
+ *                   order to select the correct sensor bus handler.\r
+ * @param  reg       register to write\r
+ * @param  bufp      pointer to data to write in register reg\r
+ * @param  len       number of consecutive register to write\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+                              uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_I2C_Mem_Write(handle, LIS2DOC_I2C_ADD_H, reg,\r
+                    I2C_MEMADD_SIZE_8BIT, (uint8_t*) bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+  HAL_SPI_Transmit(handle, &reg, 1, 1000);\r
+  HAL_SPI_Transmit(handle, (uint8_t*) bufp, len, 1000);\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+  i2c_lld_write(handle,  LIS2DOC_I2C_ADD_H & 0xFE, reg, (uint8_t*) bufp, len);\r
+#endif\r
+  return 0;\r
+}\r
+\r
+/*\r
+ * @brief  Read generic device register (platform dependent)\r
+ *\r
+ * @param  handle    customizable argument. In this examples is used in\r
+ *                   order to select the correct sensor bus handler.\r
+ * @param  reg       register to read\r
+ * @param  bufp      pointer to buffer that store the data read\r
+ * @param  len       number of consecutive register to read\r
+ *\r
+ */\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+                             uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_I2C_Mem_Read(handle, LIS2DOC_I2C_ADD_H, reg,\r
+                   I2C_MEMADD_SIZE_8BIT, bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  reg |= 0x80;\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+  HAL_SPI_Transmit(handle, &reg, 1, 1000);\r
+  HAL_SPI_Receive(handle, bufp, len, 1000);\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+  i2c_lld_read(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, bufp, len);\r
+#endif\r
+  return 0;\r
+}\r
+\r
+/*\r
+ * @brief  Write generic device register (platform dependent)\r
+ *\r
+ * @param  tx_buffer     buffer to transmit\r
+ * @param  len           number of byte to send\r
+ *\r
+ */\r
+static void tx_com(uint8_t *tx_buffer, uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_UART_Transmit(&huart2, tx_buffer, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  CDC_Transmit_FS(tx_buffer, len);\r
+#elif defined(SPC584B_DIS)\r
+  sd_lld_write(&SD2, tx_buffer, len);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief  platform specific delay (platform dependent)\r
+ *\r
+ * @param  ms        delay in ms\r
+ *\r
+ */\r
+static void platform_delay(uint32_t ms)\r
+{\r
+#if defined(NUCLEO_F411RE) | defined(STEVAL_MKI109V3)\r
+  HAL_Delay(ms);\r
+#elif defined(SPC584B_DIS)\r
+  osalThreadDelayMilliseconds(ms);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief  platform specific initialization (platform dependent)\r
+ */\r
+static void platform_init(void)\r
+{\r
+#if defined(STEVAL_MKI109V3)\r
+  TIM3->CCR1 = PWM_3V3;\r
+  TIM3->CCR2 = PWM_3V3;\r
+  HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);\r
+  HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);\r
+  HAL_Delay(1000);\r
+#endif\r
+}
\ No newline at end of file
diff --git a/code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_orientation.c b/code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_orientation.c
new file mode 100644 (file)
index 0000000..df007e8
--- /dev/null
@@ -0,0 +1,314 @@
+/*\r
+ ******************************************************************************\r
+ * @file    orientation.c\r
+ * @author  Sensors Software Solution Team\r
+ * @brief   This file show the simplest way to detect 6D orientation from sensor.\r
+ *\r
+ ******************************************************************************\r
+ * @attention\r
+ *\r
+ * <h2><center>&copy; Copyright (c) 2020 STMicroelectronics.\r
+ * All rights reserved.</center></h2>\r
+ *\r
+ * This software component is licensed by ST under BSD 3-Clause license,\r
+ * the "License"; You may not use this file except in compliance with the\r
+ * License. You may obtain a copy of the License at:\r
+ *                        opensource.org/licenses/BSD-3-Clause\r
+ *\r
+ ******************************************************************************\r
+ */\r
+\r
+/*\r
+ * This example was developed using the following STMicroelectronics\r
+ * evaluation boards:\r
+ *\r
+ * - STEVAL_MKI109V3 + STEVAL-MKI179V1\r
+ * - NUCLEO_F411RE + X_NUCLEO_IKS01A3\r
+ * - DISCOVERY_SPC584B + X_NUCLEO_IKS01A3\r
+ *\r
+ * and STM32CubeMX tool with STM32CubeF4 MCU Package\r
+ *\r
+ * Used interfaces:\r
+ *\r
+ * STEVAL_MKI109V3    - Host side:   USB (Virtual COM)\r
+ *                    - Sensor side: SPI(Default) / I2C(supported)\r
+ *\r
+ * NUCLEO_STM32F411RE - Host side: UART(COM) to USB bridge\r
+ *                    - I2C(Default) / SPI(supported)\r
+ *\r
+ * DISCOVERY_SPC584B  - Host side: UART(COM) to USB bridge\r
+ *                    - Sensor side: I2C(Default) / SPI(supported)\r
+ *\r
+ * If you need to run this example on a different hardware platform a\r
+ * modification of the functions: `platform_write`, `platform_read`,\r
+ * `tx_com` and 'platform_init' is required.\r
+ *\r
+ */\r
+\r
+/* STMicroelectronics evaluation boards definition\r
+ *\r
+ * Please uncomment ONLY the evaluation boards in use.\r
+ * If a different hardware is used please comment all\r
+ * following target board and redefine yours.\r
+ */\r
+\r
+//#define STEVAL_MKI109V3  /* little endian */\r
+//#define NUCLEO_F411RE    /* little endian */\r
+//#define SPC584B_DIS      /* big endian */\r
+\r
+/* ATTENTION: By default the driver is little endian. If you need switch\r
+ *            to big endian please see "Endianness definitions" in the\r
+ *            header file of the driver (_reg.h).\r
+ */\r
+\r
+\r
+#if defined(STEVAL_MKI109V3)\r
+/* MKI109V3: Define communication interface */\r
+#define SENSOR_BUS hspi2\r
+/* MKI109V3: Vdd and Vddio power supply values */\r
+#define PWM_3V3 915\r
+\r
+#elif defined(NUCLEO_F411RE)\r
+/* NUCLEO_F411RE: Define communication interface */\r
+#define SENSOR_BUS hi2c1\r
+\r
+#elif defined(SPC584B_DIS)\r
+/* DISCOVERY_SPC584B: Define communication interface */\r
+#define SENSOR_BUS I2CD1\r
+\r
+#endif\r
+\r
+/* Includes ------------------------------------------------------------------*/\r
+#include <string.h>\r
+#include <stdio.h>\r
+#include "lis2doc_reg.h"\r
+\r
+#if defined(NUCLEO_F411RE)\r
+#include "stm32f4xx_hal.h"\r
+#include "usart.h"\r
+#include "gpio.h"\r
+#include "i2c.h"\r
+\r
+#elif defined(STEVAL_MKI109V3)\r
+#include "stm32f4xx_hal.h"\r
+#include "usbd_cdc_if.h"\r
+#include "gpio.h"\r
+#include "spi.h"\r
+#include "tim.h"\r
+\r
+#elif defined(SPC584B_DIS)\r
+#include "components.h"\r
+#endif\r
+\r
+/* Private macro -------------------------------------------------------------*/\r
+#define    BOOT_TIME            20 //ms\r
+\r
+/* Private variables ---------------------------------------------------------*/\r
+static lis2doc_mode_t pm;\r
+static uint8_t whoamI, rst;\r
+static uint8_t tx_buffer[1000];\r
+\r
+/* Extern variables ----------------------------------------------------------*/\r
+\r
+/* Private functions ---------------------------------------------------------*/\r
+/*\r
+ *   WARNING:\r
+ *   Functions declare in this section are defined at the end of this file\r
+ *   and are strictly related to the hardware platform used.\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+                              uint16_t len);\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+                             uint16_t len);\r
+static void tx_com( uint8_t *tx_buffer, uint16_t len );\r
+static void platform_delay(uint32_t ms);\r
+static void platform_init(void);\r
+\r
+/* Main Example --------------------------------------------------------------*/\r
+void lis2doc_orientation(void)\r
+{\r
+  /* Initialize mems driver interface */\r
+  stmdev_ctx_t dev_ctx;\r
+  lis2doc_reg_t int_route;\r
+  dev_ctx.write_reg = platform_write;\r
+  dev_ctx.read_reg = platform_read;\r
+  dev_ctx.handle = &SENSOR_BUS;\r
+  /* Initialize platform specific hardware */\r
+  platform_init();\r
+  /* Wait sensor boot time */\r
+  platform_delay(BOOT_TIME);\r
+  /* Check device ID */\r
+  lis2doc_device_id_get(&dev_ctx, &whoamI);\r
+\r
+  if (whoamI != LIS2DOC_ID)\r
+    while (1) {\r
+      /* manage here device not found */\r
+    }\r
+\r
+  /* Restore default configuration */\r
+  lis2doc_reset_set(&dev_ctx, PROPERTY_ENABLE);\r
+\r
+  do {\r
+    lis2doc_reset_get(&dev_ctx, &rst);\r
+  } while (rst);\r
+\r
+  /* Set full scale */\r
+  lis2doc_full_scale_set(&dev_ctx, LIS2DOC_2g);\r
+\r
+  /* Configure power mode */\r
+  pm.lpm = 1;\r
+  pm.low_noise = 1;\r
+  lis2doc_power_mode_set(&dev_ctx, pm);\r
+\r
+  /* Set threshold to 60 degrees */\r
+  lis2doc_6d_threshold_set(&dev_ctx, 0x02);\r
+  /* LPF2 on 6D function selection. */\r
+  lis2doc_6d_feed_data_set(&dev_ctx, LIS2DOC_LPF2_FEED);\r
+  /* Enable interrupt generation on 6D INT1 pin. */\r
+  lis2doc_pin_int1_route_get(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);\r
+  int_route.ctrl4_int1_pad_ctrl.int1_6d = PROPERTY_ENABLE;\r
+  lis2doc_pin_int1_route_set(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);\r
+  /* Set Output Data Rate */\r
+  lis2doc_data_rate_set(&dev_ctx, LIS2DOC_XL_ODR_200Hz);\r
+\r
+  /* Wait Events. */\r
+  while (1) {\r
+    lis2doc_all_sources_t all_source;\r
+    lis2doc_all_sources_get(&dev_ctx, &all_source);\r
+\r
+    /* Check 6D Orientation events */\r
+    if (all_source.sixd_src._6d_ia) {\r
+      sprintf((char *)tx_buffer, "6D Or. switched to ");\r
+\r
+      if (all_source.sixd_src.xh) {\r
+        strcat((char *)tx_buffer, "XH");\r
+      }\r
+\r
+      if (all_source.sixd_src.xl) {\r
+        strcat((char *)tx_buffer, "XL");\r
+      }\r
+\r
+      if (all_source.sixd_src.yh) {\r
+        strcat((char *)tx_buffer, "YH");\r
+      }\r
+\r
+      if (all_source.sixd_src.yl) {\r
+        strcat((char *)tx_buffer, "YL");\r
+      }\r
+\r
+      if (all_source.sixd_src.zh) {\r
+        strcat((char *)tx_buffer, "ZH");\r
+      }\r
+\r
+      if (all_source.sixd_src.zl) {\r
+        strcat((char *)tx_buffer, "ZL");\r
+      }\r
+\r
+      strcat((char *)tx_buffer, "\r\n");\r
+      tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
+    }\r
+  }\r
+}\r
+\r
+/*\r
+ * @brief  Write generic device register (platform dependent)\r
+ *\r
+ * @param  handle    customizable argument. In this examples is used in\r
+ *                   order to select the correct sensor bus handler.\r
+ * @param  reg       register to write\r
+ * @param  bufp      pointer to data to write in register reg\r
+ * @param  len       number of consecutive register to write\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+                              uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_I2C_Mem_Write(handle, LIS2DOC_I2C_ADD_H, reg,\r
+                    I2C_MEMADD_SIZE_8BIT, (uint8_t*) bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+  HAL_SPI_Transmit(handle, &reg, 1, 1000);\r
+  HAL_SPI_Transmit(handle, (uint8_t*) bufp, len, 1000);\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+  i2c_lld_write(handle,  LIS2DOC_I2C_ADD_H & 0xFE, reg, (uint8_t*) bufp, len);\r
+#endif\r
+  return 0;\r
+}\r
+\r
+/*\r
+ * @brief  Read generic device register (platform dependent)\r
+ *\r
+ * @param  handle    customizable argument. In this examples is used in\r
+ *                   order to select the correct sensor bus handler.\r
+ * @param  reg       register to read\r
+ * @param  bufp      pointer to buffer that store the data read\r
+ * @param  len       number of consecutive register to read\r
+ *\r
+ */\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+                             uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_I2C_Mem_Read(handle, LIS2DOC_I2C_ADD_H, reg,\r
+                   I2C_MEMADD_SIZE_8BIT, bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  reg |= 0x80;\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+  HAL_SPI_Transmit(handle, &reg, 1, 1000);\r
+  HAL_SPI_Receive(handle, bufp, len, 1000);\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+  i2c_lld_read(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, bufp, len);\r
+#endif\r
+  return 0;\r
+}\r
+\r
+/*\r
+ * @brief  Write generic device register (platform dependent)\r
+ *\r
+ * @param  tx_buffer     buffer to transmit\r
+ * @param  len           number of byte to send\r
+ *\r
+ */\r
+static void tx_com(uint8_t *tx_buffer, uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_UART_Transmit(&huart2, tx_buffer, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  CDC_Transmit_FS(tx_buffer, len);\r
+#elif defined(SPC584B_DIS)\r
+  sd_lld_write(&SD2, tx_buffer, len);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief  platform specific delay (platform dependent)\r
+ *\r
+ * @param  ms        delay in ms\r
+ *\r
+ */\r
+static void platform_delay(uint32_t ms)\r
+{\r
+#if defined(NUCLEO_F411RE) | defined(STEVAL_MKI109V3)\r
+  HAL_Delay(ms);\r
+#elif defined(SPC584B_DIS)\r
+  osalThreadDelayMilliseconds(ms);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief  platform specific initialization (platform dependent)\r
+ */\r
+static void platform_init(void)\r
+{\r
+#if defined(STEVAL_MKI109V3)\r
+  TIM3->CCR1 = PWM_3V3;\r
+  TIM3->CCR2 = PWM_3V3;\r
+  HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);\r
+  HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);\r
+  HAL_Delay(1000);\r
+#endif\r
+}
\ No newline at end of file
diff --git a/code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_read_data_polling.c b/code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_read_data_polling.c
new file mode 100644 (file)
index 0000000..a50ca78
--- /dev/null
@@ -0,0 +1,305 @@
+/*\r
+ ******************************************************************************\r
+ * @file    read_data_polling.c\r
+ * @author  Sensors Software Solution Team\r
+ * @brief   This file show the simplest way to get data from sensor.\r
+ *\r
+ ******************************************************************************\r
+ * @attention\r
+ *\r
+ * <h2><center>&copy; Copyright (c) 2020 STMicroelectronics.\r
+ * All rights reserved.</center></h2>\r
+ *\r
+ * This software component is licensed by ST under BSD 3-Clause license,\r
+ * the "License"; You may not use this file except in compliance with the\r
+ * License. You may obtain a copy of the License at:\r
+ *                        opensource.org/licenses/BSD-3-Clause\r
+ *\r
+ ******************************************************************************\r
+ */\r
+\r
+/*\r
+ * This example was developed using the following STMicroelectronics\r
+ * evaluation boards:\r
+ *\r
+ * - STEVAL_MKI109V3 + STEVAL-MKI179V1\r
+ * - NUCLEO_F411RE + X_NUCLEO_IKS01A3\r
+ * - DISCOVERY_SPC584B + X_NUCLEO_IKS01A3\r
+ *\r
+ * and STM32CubeMX tool with STM32CubeF4 MCU Package\r
+ *\r
+ * Used interfaces:\r
+ *\r
+ * STEVAL_MKI109V3    - Host side:   USB (Virtual COM)\r
+ *                    - Sensor side: SPI(Default) / I2C(supported)\r
+ *\r
+ * NUCLEO_STM32F411RE - Host side: UART(COM) to USB bridge\r
+ *                    - I2C(Default) / SPI(supported)\r
+ *\r
+ * DISCOVERY_SPC584B  - Host side: UART(COM) to USB bridge\r
+ *                    - Sensor side: I2C(Default) / SPI(supported)\r
+ *\r
+ * If you need to run this example on a different hardware platform a\r
+ * modification of the functions: `platform_write`, `platform_read`,\r
+ * `tx_com` and 'platform_init' is required.\r
+ *\r
+ */\r
+\r
+/* STMicroelectronics evaluation boards definition\r
+ *\r
+ * Please uncomment ONLY the evaluation boards in use.\r
+ * If a different hardware is used please comment all\r
+ * following target board and redefine yours.\r
+ */\r
+\r
+//#define STEVAL_MKI109V3  /* little endian */\r
+//#define NUCLEO_F411RE    /* little endian */\r
+//#define SPC584B_DIS      /* big endian */\r
+\r
+/* ATTENTION: By default the driver is little endian. If you need switch\r
+ *            to big endian please see "Endianness definitions" in the\r
+ *            header file of the driver (_reg.h).\r
+ */\r
+\r
+\r
+#if defined(STEVAL_MKI109V3)\r
+/* MKI109V3: Define communication interface */\r
+#define SENSOR_BUS hspi2\r
+/* MKI109V3: Vdd and Vddio power supply values */\r
+#define PWM_3V3 915\r
+\r
+#elif defined(NUCLEO_F411RE)\r
+/* NUCLEO_F411RE: Define communication interface */\r
+#define SENSOR_BUS hi2c1\r
+\r
+#elif defined(SPC584B_DIS)\r
+/* DISCOVERY_SPC584B: Define communication interface */\r
+#define SENSOR_BUS I2CD1\r
+\r
+#endif\r
+\r
+/* Includes ------------------------------------------------------------------*/\r
+#include <string.h>\r
+#include <stdio.h>\r
+#include "lis2doc_reg.h"\r
+\r
+#if defined(NUCLEO_F411RE)\r
+#include "stm32f4xx_hal.h"\r
+#include "usart.h"\r
+#include "gpio.h"\r
+#include "i2c.h"\r
+\r
+#elif defined(STEVAL_MKI109V3)\r
+#include "stm32f4xx_hal.h"\r
+#include "usbd_cdc_if.h"\r
+#include "gpio.h"\r
+#include "spi.h"\r
+#include "tim.h"\r
+\r
+#elif defined(SPC584B_DIS)\r
+#include "components.h"\r
+#endif\r
+\r
+/* Private macro -------------------------------------------------------------*/\r
+#define    BOOT_TIME            20 //ms\r
+\r
+/* Private variables ---------------------------------------------------------*/\r
+\r
+static lis2doc_mode_t pm;\r
+static int16_t data_raw_acceleration[3];\r
+static float acceleration_mg[3];\r
+static uint8_t whoamI, rst;\r
+static uint8_t tx_buffer[1000];\r
+\r
+/* Extern variables ----------------------------------------------------------*/\r
+\r
+/* Private functions ---------------------------------------------------------*/\r
+/*\r
+ *   WARNING:\r
+ *   Functions declare in this section are defined at the end of this file\r
+ *   and are strictly related to the hardware platform used.\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+                              uint16_t len);\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+                             uint16_t len);\r
+static void tx_com( uint8_t *tx_buffer, uint16_t len );\r
+static void platform_delay(uint32_t ms);\r
+static void platform_init(void);\r
+\r
+/* Main Example --------------------------------------------------------------*/\r
+void lis2doc_read_data_polling(void)\r
+{\r
+  /* Initialize mems driver interface */\r
+  stmdev_ctx_t dev_ctx;\r
+\r
+  dev_ctx.write_reg = platform_write;\r
+  dev_ctx.read_reg = platform_read;\r
+  dev_ctx.handle = &SENSOR_BUS;\r
+  /* Initialize platform specific hardware */\r
+  platform_init();\r
+  /* Wait sensor boot time */\r
+  platform_delay(BOOT_TIME);\r
+  /* Check device ID */\r
+  lis2doc_device_id_get(&dev_ctx, &whoamI);\r
+\r
+  if (whoamI != LIS2DOC_ID)\r
+    while (1) {\r
+      /* manage here device not found */\r
+    }\r
+\r
+  /* Restore default configuration */\r
+  lis2doc_reset_set(&dev_ctx, PROPERTY_ENABLE);\r
+\r
+  do {\r
+    lis2doc_reset_get(&dev_ctx, &rst);\r
+  } while (rst);\r
+\r
+  /* Enable Block Data Update */\r
+  lis2doc_block_data_update_set(&dev_ctx, PROPERTY_ENABLE);\r
+  /* Set full scale */\r
+  //lis2doc_full_scale_set(&dev_ctx, LIS2DOC_8g);\r
+  lis2doc_full_scale_set(&dev_ctx, LIS2DOC_2g);\r
+  /* Configure filtering chain\r
+   * Accelerometer - filter path / bandwidth\r
+   */\r
+  lis2doc_filter_path_set(&dev_ctx, LIS2DOC_LPF_ON_OUT);\r
+  lis2doc_filter_bandwidth_set(&dev_ctx, LIS2DOC_ODR_DIV_4);\r
+\r
+  /* Configure power mode */\r
+  pm.hpm = 1;\r
+  pm.low_noise = 1;\r
+  lis2doc_power_mode_set(&dev_ctx, pm);\r
+\r
+  /* Set Output Data Rate */\r
+  lis2doc_data_rate_set(&dev_ctx, LIS2DOC_XL_ODR_25Hz);\r
+\r
+  /* Read samples in polling mode (no int) */\r
+  while (1) {\r
+    uint8_t reg;\r
+    /* Read output only if new value is available */\r
+    lis2doc_flag_data_ready_get(&dev_ctx, &reg);\r
+\r
+    if (reg) {\r
+      /* Read acceleration data */\r
+      memset(data_raw_acceleration, 0x00, 3 * sizeof(int16_t));\r
+      lis2doc_acceleration_raw_get(&dev_ctx, data_raw_acceleration);\r
+      //acceleration_mg[0] = lis2doc_from_fs8_lp1_to_mg(data_raw_acceleration[0]);\r
+      //acceleration_mg[1] = lis2doc_from_fs8_lp1_to_mg(data_raw_acceleration[1]);\r
+      //acceleration_mg[2] = lis2doc_from_fs8_lp1_to_mg(data_raw_acceleration[2]);\r
+      acceleration_mg[0] = lis2doc_from_fs2_to_mg(\r
+                             data_raw_acceleration[0]);\r
+      acceleration_mg[1] = lis2doc_from_fs2_to_mg(\r
+                             data_raw_acceleration[1]);\r
+      acceleration_mg[2] = lis2doc_from_fs2_to_mg(\r
+                             data_raw_acceleration[2]);\r
+      sprintf((char *)tx_buffer,\r
+              "Acceleration [mg]:%4.2f\t%4.2f\t%4.2f\r\n",\r
+              acceleration_mg[0], acceleration_mg[1], acceleration_mg[2]);\r
+      tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
+    }\r
+  }\r
+}\r
+\r
+/*\r
+ * @brief  Write generic device register (platform dependent)\r
+ *\r
+ * @param  handle    customizable argument. In this examples is used in\r
+ *                   order to select the correct sensor bus handler.\r
+ * @param  reg       register to write\r
+ * @param  bufp      pointer to data to write in register reg\r
+ * @param  len       number of consecutive register to write\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+                              uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_I2C_Mem_Write(handle, LIS2DOC_I2C_ADD_H, reg,\r
+                    I2C_MEMADD_SIZE_8BIT, (uint8_t*) bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+  HAL_SPI_Transmit(handle, &reg, 1, 1000);\r
+  HAL_SPI_Transmit(handle, (uint8_t*) bufp, len, 1000);\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+  i2c_lld_write(handle,  LIS2DOC_I2C_ADD_H & 0xFE, reg, (uint8_t*) bufp, len);\r
+#endif\r
+  return 0;\r
+}\r
+\r
+/*\r
+ * @brief  Read generic device register (platform dependent)\r
+ *\r
+ * @param  handle    customizable argument. In this examples is used in\r
+ *                   order to select the correct sensor bus handler.\r
+ * @param  reg       register to read\r
+ * @param  bufp      pointer to buffer that store the data read\r
+ * @param  len       number of consecutive register to read\r
+ *\r
+ */\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+                             uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_I2C_Mem_Read(handle, LIS2DOC_I2C_ADD_H, reg,\r
+                   I2C_MEMADD_SIZE_8BIT, bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  reg |= 0x80;\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+  HAL_SPI_Transmit(handle, &reg, 1, 1000);\r
+  HAL_SPI_Receive(handle, bufp, len, 1000);\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+  i2c_lld_read(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, bufp, len);\r
+#endif\r
+  return 0;\r
+}\r
+\r
+/*\r
+ * @brief  Write generic device register (platform dependent)\r
+ *\r
+ * @param  tx_buffer     buffer to transmit\r
+ * @param  len           number of byte to send\r
+ *\r
+ */\r
+static void tx_com(uint8_t *tx_buffer, uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_UART_Transmit(&huart2, tx_buffer, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  CDC_Transmit_FS(tx_buffer, len);\r
+#elif defined(SPC584B_DIS)\r
+  sd_lld_write(&SD2, tx_buffer, len);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief  platform specific delay (platform dependent)\r
+ *\r
+ * @param  ms        delay in ms\r
+ *\r
+ */\r
+static void platform_delay(uint32_t ms)\r
+{\r
+#if defined(NUCLEO_F411RE) | defined(STEVAL_MKI109V3)\r
+  HAL_Delay(ms);\r
+#elif defined(SPC584B_DIS)\r
+  osalThreadDelayMilliseconds(ms);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief  platform specific initialization (platform dependent)\r
+ */\r
+static void platform_init(void)\r
+{\r
+#if defined(STEVAL_MKI109V3)\r
+  TIM3->CCR1 = PWM_3V3;\r
+  TIM3->CCR2 = PWM_3V3;\r
+  HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);\r
+  HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);\r
+  HAL_Delay(1000);\r
+#endif\r
+}\r
diff --git a/code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_read_data_single.c b/code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_read_data_single.c
new file mode 100644 (file)
index 0000000..fd30d09
--- /dev/null
@@ -0,0 +1,313 @@
+/*\r
+ ******************************************************************************\r
+ * @file    read_data_simple.c\r
+ * @author  Sensors Software Solution Team\r
+ * @brief   This file show the simplest way to get data from sensor.\r
+ *\r
+ ******************************************************************************\r
+ * @attention\r
+ *\r
+ * <h2><center>&copy; Copyright (c) 2020 STMicroelectronics.\r
+ * All rights reserved.</center></h2>\r
+ *\r
+ * This software component is licensed by ST under BSD 3-Clause license,\r
+ * the "License"; You may not use this file except in compliance with the\r
+ * License. You may obtain a copy of the License at:\r
+ *                        opensource.org/licenses/BSD-3-Clause\r
+ *\r
+ ******************************************************************************\r
+ */\r
+\r
+/*\r
+ * This example was developed using the following STMicroelectronics\r
+ * evaluation boards:\r
+ *\r
+ * - STEVAL_MKI109V3 + STEVAL-MKI179V1\r
+ * - NUCLEO_F411RE + X_NUCLEO_IKS01A3\r
+ * - DISCOVERY_SPC584B + X_NUCLEO_IKS01A3\r
+ *\r
+ * and STM32CubeMX tool with STM32CubeF4 MCU Package\r
+ *\r
+ * Used interfaces:\r
+ *\r
+ * STEVAL_MKI109V3    - Host side:   USB (Virtual COM)\r
+ *                    - Sensor side: SPI(Default) / I2C(supported)\r
+ *\r
+ * NUCLEO_STM32F411RE - Host side: UART(COM) to USB bridge\r
+ *                    - I2C(Default) / SPI(supported)\r
+ *\r
+ * DISCOVERY_SPC584B  - Host side: UART(COM) to USB bridge\r
+ *                    - Sensor side: I2C(Default) / SPI(supported)\r
+ *\r
+ * If you need to run this example on a different hardware platform a\r
+ * modification of the functions: `platform_write`, `platform_read`,\r
+ * `tx_com` and 'platform_init' is required.\r
+ *\r
+ */\r
+\r
+/* STMicroelectronics evaluation boards definition\r
+ *\r
+ * Please uncomment ONLY the evaluation boards in use.\r
+ * If a different hardware is used please comment all\r
+ * following target board and redefine yours.\r
+ */\r
+\r
+//#define STEVAL_MKI109V3  /* little endian */\r
+//#define NUCLEO_F411RE    /* little endian */\r
+//#define SPC584B_DIS      /* big endian */\r
+\r
+/* ATTENTION: By default the driver is little endian. If you need switch\r
+ *            to big endian please see "Endianness definitions" in the\r
+ *            header file of the driver (_reg.h).\r
+ */\r
+\r
+\r
+#if defined(STEVAL_MKI109V3)\r
+/* MKI109V3: Define communication interface */\r
+#define SENSOR_BUS hspi2\r
+/* MKI109V3: Vdd and Vddio power supply values */\r
+#define PWM_3V3 915\r
+\r
+#elif defined(NUCLEO_F411RE)\r
+/* NUCLEO_F411RE: Define communication interface */\r
+#define SENSOR_BUS hi2c1\r
+\r
+#elif defined(SPC584B_DIS)\r
+/* DISCOVERY_SPC584B: Define communication interface */\r
+#define SENSOR_BUS I2CD1\r
+\r
+#endif\r
+\r
+/* Includes ------------------------------------------------------------------*/\r
+#include <string.h>\r
+#include <stdio.h>\r
+#include "lis2doc_reg.h"\r
+\r
+#if defined(NUCLEO_F411RE)\r
+#include "stm32f4xx_hal.h"\r
+#include "usart.h"\r
+#include "gpio.h"\r
+#include "i2c.h"\r
+\r
+#elif defined(STEVAL_MKI109V3)\r
+#include "stm32f4xx_hal.h"\r
+#include "usbd_cdc_if.h"\r
+#include "gpio.h"\r
+#include "spi.h"\r
+#include "tim.h"\r
+\r
+#elif defined(SPC584B_DIS)\r
+#include "components.h"\r
+#endif\r
+\r
+/* Private macro -------------------------------------------------------------*/\r
+#define    BOOT_TIME            20 //ms\r
+\r
+/* Private variables ---------------------------------------------------------*/\r
+static lis2doc_mode_t pm;\r
+static int16_t data_raw_acceleration[3];\r
+static float acceleration_mg[3];\r
+static uint8_t whoamI, rst;\r
+static uint8_t tx_buffer[1000];\r
+static lis2doc_ctrl4_int1_pad_ctrl_t  ctrl4_int1_pad;\r
+\r
+/* Extern variables ----------------------------------------------------------*/\r
+\r
+/* Private functions ---------------------------------------------------------*/\r
+/*\r
+ *   WARNING:\r
+ *   Functions declare in this section are defined at the end of this file\r
+ *   and are strictly related to the hardware platform used.\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+                              uint16_t len);\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+                             uint16_t len);\r
+static void tx_com( uint8_t *tx_buffer, uint16_t len );\r
+static void platform_delay(uint32_t ms);\r
+static void platform_init(void);\r
+\r
+/* Main Example --------------------------------------------------------------*/\r
+void lis2doc_read_data_single(void)\r
+{\r
+  /* Initialize mems driver interface */\r
+  stmdev_ctx_t dev_ctx;\r
+  dev_ctx.write_reg = platform_write;\r
+  dev_ctx.read_reg = platform_read;\r
+  dev_ctx.handle = &SENSOR_BUS;\r
+  /* Initialize platform specific hardware */\r
+  platform_init();\r
+  /* Wait sensor boot time */\r
+  platform_delay(BOOT_TIME);\r
+  /* Check device ID */\r
+  lis2doc_device_id_get(&dev_ctx, &whoamI);\r
+\r
+  if (whoamI != LIS2DOC_ID)\r
+    while (1) {\r
+      /* manage here device not found */\r
+    }\r
+\r
+  /* Restore default configuration */\r
+  lis2doc_reset_set(&dev_ctx, PROPERTY_ENABLE);\r
+\r
+  do {\r
+    lis2doc_reset_get(&dev_ctx, &rst);\r
+  } while (rst);\r
+\r
+  /* Enable Block Data Update */\r
+  lis2doc_block_data_update_set(&dev_ctx, PROPERTY_ENABLE);\r
+  //lis2doc_cs_mode_set(&dev_ctx, LIS2DOC_PULL_UP_DISCONNECT);\r
+  //lis2doc_i2c_interface_set(&dev_ctx, LIS2DOC_I2C_DISABLE);\r
+  //lis2doc_spi_mode_set(&dev_ctx, LIS2DOC_SPI_3_WIRE);\r
+  lis2doc_int_notification_set(&dev_ctx, LIS2DOC_INT_LATCHED);\r
+  lis2doc_pin_polarity_set(&dev_ctx, LIS2DOC_ACTIVE_LOW);\r
+  lis2doc_pin_int1_route_get(&dev_ctx, &ctrl4_int1_pad);\r
+  ctrl4_int1_pad.int1_drdy = PROPERTY_ENABLE;\r
+  lis2doc_pin_int1_route_set(&dev_ctx, &ctrl4_int1_pad);\r
+  /* Set full scale */\r
+  lis2doc_full_scale_set(&dev_ctx, LIS2DOC_2g);\r
+  /* Configure filtering chain accelerometer */\r
+  lis2doc_filter_path_set(&dev_ctx, LIS2DOC_LPF_ON_OUT);\r
+  lis2doc_filter_bandwidth_set(&dev_ctx, LIS2DOC_ODR_DIV_10);\r
+\r
+  /* Configure power mode */\r
+  pm.lpm = 1;\r
+  pm.low_noise = 1;\r
+  lis2doc_power_mode_set(&dev_ctx, pm);\r
+\r
+  lis2doc_data_rate_set(&dev_ctx, LIS2DOC_XL_SET_SW_TRIG);\r
+\r
+  /* Read samples in polling mode (no int) */\r
+  while (1) {\r
+    /* polling on DRDY signal */\r
+    if (GPIO_PIN_RESET == HAL_GPIO_ReadPin(GPIOC, GPIO_PIN_0)) {\r
+      /* Read acceleration data */\r
+      memset(data_raw_acceleration, 0x00, 3 * sizeof(int16_t));\r
+      lis2doc_acceleration_raw_get(&dev_ctx, data_raw_acceleration);\r
+      acceleration_mg[0] = lis2doc_from_fs2_lp1_to_mg(\r
+                             data_raw_acceleration[0]);\r
+      acceleration_mg[1] = lis2doc_from_fs2_lp1_to_mg(\r
+                             data_raw_acceleration[1]);\r
+      acceleration_mg[2] = lis2doc_from_fs2_lp1_to_mg(\r
+                             data_raw_acceleration[2]);\r
+#ifdef STEVAL_MKI109V3\r
+\r
+      /* After data ready signal rise, is not possible to set a\r
+       * new trigger before 175us.\r
+       * I2C read data operation fit this constraint while SPI need\r
+       * a wait loop in order to guarantee it.\r
+       */\r
+      for (int i = 0; i < 0x3FF; i++);\r
+\r
+#endif\r
+      lis2doc_data_rate_set(&dev_ctx, LIS2DOC_XL_SET_SW_TRIG);\r
+      sprintf((char *)tx_buffer,\r
+              "Acceleration [mg]:%4.2f\t%4.2f\t%4.2f\r\n",\r
+              acceleration_mg[0], acceleration_mg[1], acceleration_mg[2]);\r
+      tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
+    }\r
+  }\r
+}\r
+\r
+/*\r
+ * @brief  Write generic device register (platform dependent)\r
+ *\r
+ * @param  handle    customizable argument. In this examples is used in\r
+ *                   order to select the correct sensor bus handler.\r
+ * @param  reg       register to write\r
+ * @param  bufp      pointer to data to write in register reg\r
+ * @param  len       number of consecutive register to write\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+                              uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_I2C_Mem_Write(handle, LIS2DOC_I2C_ADD_H, reg,\r
+                    I2C_MEMADD_SIZE_8BIT, (uint8_t*) bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+  HAL_SPI_Transmit(handle, &reg, 1, 1000);\r
+  HAL_SPI_Transmit(handle, (uint8_t*) bufp, len, 1000);\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+  i2c_lld_write(handle,  LIS2DOC_I2C_ADD_H & 0xFE, reg, (uint8_t*) bufp, len);\r
+#endif\r
+  return 0;\r
+}\r
+\r
+/*\r
+ * @brief  Read generic device register (platform dependent)\r
+ *\r
+ * @param  handle    customizable argument. In this examples is used in\r
+ *                   order to select the correct sensor bus handler.\r
+ * @param  reg       register to read\r
+ * @param  bufp      pointer to buffer that store the data read\r
+ * @param  len       number of consecutive register to read\r
+ *\r
+ */\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+                             uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_I2C_Mem_Read(handle, LIS2DOC_I2C_ADD_H, reg,\r
+                   I2C_MEMADD_SIZE_8BIT, bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  reg |= 0x80;\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+  HAL_SPI_Transmit(handle, &reg, 1, 1000);\r
+  HAL_SPI_Receive(handle, bufp, len, 1000);\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+  i2c_lld_read(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, bufp, len);\r
+#endif\r
+  return 0;\r
+}\r
+\r
+/*\r
+ * @brief  Write generic device register (platform dependent)\r
+ *\r
+ * @param  tx_buffer     buffer to transmit\r
+ * @param  len           number of byte to send\r
+ *\r
+ */\r
+static void tx_com(uint8_t *tx_buffer, uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_UART_Transmit(&huart2, tx_buffer, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  CDC_Transmit_FS(tx_buffer, len);\r
+#elif defined(SPC584B_DIS)\r
+  sd_lld_write(&SD2, tx_buffer, len);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief  platform specific delay (platform dependent)\r
+ *\r
+ * @param  ms        delay in ms\r
+ *\r
+ */\r
+static void platform_delay(uint32_t ms)\r
+{\r
+#if defined(NUCLEO_F411RE) | defined(STEVAL_MKI109V3)\r
+  HAL_Delay(ms);\r
+#elif defined(SPC584B_DIS)\r
+  osalThreadDelayMilliseconds(ms);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief  platform specific initialization (platform dependent)\r
+ */\r
+static void platform_init(void)\r
+{\r
+#if defined(STEVAL_MKI109V3)\r
+  TIM3->CCR1 = PWM_3V3;\r
+  TIM3->CCR2 = PWM_3V3;\r
+  HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);\r
+  HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);\r
+  HAL_Delay(1000);\r
+#endif\r
+}\r
diff --git a/code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_read_fifo.c b/code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_read_fifo.c
new file mode 100644 (file)
index 0000000..bfb7188
--- /dev/null
@@ -0,0 +1,311 @@
+/*\r
+ ******************************************************************************\r
+ * @file    read_fifo.c\r
+ * @author  Sensors Software Solution Team\r
+ * @brief   This file show how to get data from sensor FIFO.\r
+ *\r
+ ******************************************************************************\r
+ * @attention\r
+ *\r
+ * <h2><center>&copy; Copyright (c) 2021 STMicroelectronics.\r
+ * All rights reserved.</center></h2>\r
+ *\r
+ * This software component is licensed by ST under BSD 3-Clause license,\r
+ * the "License"; You may not use this file except in compliance with the\r
+ * License. You may obtain a copy of the License at:\r
+ *                        opensource.org/licenses/BSD-3-Clause\r
+ *\r
+ ******************************************************************************\r
+ */\r
+\r
+/*\r
+ * This example was developed using the following STMicroelectronics\r
+ * evaluation boards:\r
+ *\r
+ * - STEVAL_MKI109V3 + STEVAL-MKI179V1\r
+ * - NUCLEO_F411RE + X_NUCLEO_IKS01A3\r
+ * - DISCOVERY_SPC584B + X_NUCLEO_IKS01A3\r
+ *\r
+ * and STM32CubeMX tool with STM32CubeF4 MCU Package\r
+ *\r
+ * Used interfaces:\r
+ *\r
+ * STEVAL_MKI109V3    - Host side:   USB (Virtual COM)\r
+ *                    - Sensor side: SPI(Default) / I2C(supported)\r
+ *\r
+ * NUCLEO_STM32F411RE - Host side: UART(COM) to USB bridge\r
+ *                    - I2C(Default) / SPI(supported)\r
+ *\r
+ * DISCOVERY_SPC584B  - Host side: UART(COM) to USB bridge\r
+ *                    - Sensor side: I2C(Default) / SPI(supported)\r
+ *\r
+ * If you need to run this example on a different hardware platform a\r
+ * modification of the functions: `platform_write`, `platform_read`,\r
+ * `tx_com` and 'platform_init' is required.\r
+ *\r
+ */\r
+\r
+/* STMicroelectronics evaluation boards definition\r
+ *\r
+ * Please uncomment ONLY the evaluation boards in use.\r
+ * If a different hardware is used please comment all\r
+ * following target board and redefine yours.\r
+ */\r
+\r
+//#define STEVAL_MKI109V3  /* little endian */\r
+//#define NUCLEO_F411RE    /* little endian */\r
+//#define SPC584B_DIS      /* big endian */\r
+\r
+/* ATTENTION: By default the driver is little endian. If you need switch\r
+ *            to big endian please see "Endianness definitions" in the\r
+ *            header file of the driver (_reg.h).\r
+ */\r
+\r
+\r
+#if defined(STEVAL_MKI109V3)\r
+/* MKI109V3: Define communication interface */\r
+#define SENSOR_BUS hspi2\r
+/* MKI109V3: Vdd and Vddio power supply values */\r
+#define PWM_3V3 915\r
+\r
+#elif defined(NUCLEO_F411RE)\r
+/* NUCLEO_F411RE: Define communication interface */\r
+#define SENSOR_BUS hi2c1\r
+\r
+#elif defined(SPC584B_DIS)\r
+/* DISCOVERY_SPC584B: Define communication interface */\r
+#define SENSOR_BUS I2CD1\r
+\r
+#endif\r
+\r
+/* Includes ------------------------------------------------------------------*/\r
+#include <string.h>\r
+#include <stdio.h>\r
+#include "lis2doc_reg.h"\r
+\r
+#if defined(NUCLEO_F411RE)\r
+#include "stm32f4xx_hal.h"\r
+#include "usart.h"\r
+#include "gpio.h"\r
+#include "i2c.h"\r
+\r
+#elif defined(STEVAL_MKI109V3)\r
+#include "stm32f4xx_hal.h"\r
+#include "usbd_cdc_if.h"\r
+#include "gpio.h"\r
+#include "spi.h"\r
+#include "tim.h"\r
+\r
+#elif defined(SPC584B_DIS)\r
+#include "components.h"\r
+#endif\r
+\r
+/* Private macro -------------------------------------------------------------*/\r
+#define    BOOT_TIME            20 //ms\r
+\r
+/* Private variables ---------------------------------------------------------*/\r
+static lis2doc_mode_t pm;\r
+static int16_t data_raw_acceleration[3];\r
+static float acceleration_mg[3];\r
+static uint8_t whoamI, rst;\r
+static uint8_t tx_buffer[1000];\r
+\r
+/* Extern variables ----------------------------------------------------------*/\r
+\r
+/* Private functions ---------------------------------------------------------*/\r
+/*\r
+ *   WARNING:\r
+ *   Functions declare in this section are defined at the end of this file\r
+ *   and are strictly related to the hardware platform used.\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+                              uint16_t len);\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+                             uint16_t len);\r
+static void tx_com( uint8_t *tx_buffer, uint16_t len );\r
+static void platform_delay(uint32_t ms);\r
+static void platform_init(void);\r
+\r
+/* Main Example --------------------------------------------------------------*/\r
+void lis2doc_read_data_fifo(void)\r
+{\r
+  /* Initialize mems driver interface */\r
+  stmdev_ctx_t dev_ctx;\r
+  dev_ctx.write_reg = platform_write;\r
+  dev_ctx.read_reg = platform_read;\r
+  dev_ctx.handle = &SENSOR_BUS;\r
+  /* Initialize platform specific hardware */\r
+  platform_init();\r
+  /* Wait sensor boot time */\r
+  platform_delay(BOOT_TIME);\r
+  /* Check device ID */\r
+  lis2doc_device_id_get(&dev_ctx, &whoamI);\r
+\r
+  if (whoamI != LIS2DOC_ID)\r
+    while (1) {\r
+      /* manage here device not found */\r
+    }\r
+\r
+  /* Restore default configuration */\r
+  lis2doc_reset_set(&dev_ctx, PROPERTY_ENABLE);\r
+\r
+  do {\r
+    lis2doc_reset_get(&dev_ctx, &rst);\r
+  } while (rst);\r
+\r
+  /* Enable Block Data Update */\r
+  lis2doc_block_data_update_set(&dev_ctx, PROPERTY_ENABLE);\r
+  /* Set full scale */\r
+  //lis2doc_full_scale_set(&dev_ctx, LIS2DOC_8g);\r
+  lis2doc_full_scale_set(&dev_ctx, LIS2DOC_2g);\r
+  /* Configure filtering chain\r
+   * Accelerometer - filter path / bandwidth\r
+   */\r
+  lis2doc_filter_path_set(&dev_ctx, LIS2DOC_LPF_ON_OUT);\r
+  lis2doc_filter_bandwidth_set(&dev_ctx, LIS2DOC_ODR_DIV_4);\r
+  /* Configure FIFO */\r
+  lis2doc_fifo_watermark_set(&dev_ctx, 10);\r
+  lis2doc_fifo_mode_set(&dev_ctx, LIS2DOC_STREAM_MODE);\r
+\r
+  /* Configure power mode */\r
+  pm.hpm = 1;\r
+  pm.low_noise = 1;\r
+  lis2doc_power_mode_set(&dev_ctx, pm);\r
+\r
+  //lis2doc_power_mode_set(&dev_ctx, LIS2DOC_CONT_LOW_PWR_LOW_NOISE_12bit);\r
+  /* Set Output Data Rate */\r
+  lis2doc_data_rate_set(&dev_ctx, LIS2DOC_XL_ODR_25Hz);\r
+\r
+  /* Read samples in polling mode (no int) */\r
+  while (1) {\r
+    uint8_t val, i;\r
+    /* Read output only if new value is available */\r
+    lis2doc_fifo_wtm_flag_get(&dev_ctx, &val);\r
+\r
+    if (val) {\r
+      lis2doc_fifo_data_level_get(&dev_ctx, &val);\r
+\r
+      for (i = 0; i < val; i++) {\r
+        /* Read acceleration data */\r
+        memset(data_raw_acceleration, 0x00, 3 * sizeof(int16_t));\r
+        lis2doc_acceleration_raw_get(&dev_ctx, data_raw_acceleration);\r
+        //acceleration_mg[0] = lis2doc_from_fs8_lp1_to_mg(data_raw_acceleration[0]);\r
+        //acceleration_mg[1] = lis2doc_from_fs8_lp1_to_mg(data_raw_acceleration[1]);\r
+        //acceleration_mg[2] = lis2doc_from_fs8_lp1_to_mg(data_raw_acceleration[2]);\r
+        acceleration_mg[0] = lis2doc_from_fs2_to_mg(\r
+                               data_raw_acceleration[0]);\r
+        acceleration_mg[1] = lis2doc_from_fs2_to_mg(\r
+                               data_raw_acceleration[1]);\r
+        acceleration_mg[2] = lis2doc_from_fs2_to_mg(\r
+                               data_raw_acceleration[2]);\r
+        sprintf((char *)tx_buffer,\r
+                "Acceleration [mg]:%4.2f\t%4.2f\t%4.2f\r\n",\r
+                acceleration_mg[0], acceleration_mg[1], acceleration_mg[2]);\r
+        tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
+      }\r
+    }\r
+  }\r
+}\r
+\r
+/*\r
+ * @brief  Write generic device register (platform dependent)\r
+ *\r
+ * @param  handle    customizable argument. In this examples is used in\r
+ *                   order to select the correct sensor bus handler.\r
+ * @param  reg       register to write\r
+ * @param  bufp      pointer to data to write in register reg\r
+ * @param  len       number of consecutive register to write\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+                              uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_I2C_Mem_Write(handle, LIS2DOC_I2C_ADD_H, reg,\r
+                    I2C_MEMADD_SIZE_8BIT, (uint8_t*) bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+  HAL_SPI_Transmit(handle, &reg, 1, 1000);\r
+  HAL_SPI_Transmit(handle, (uint8_t*) bufp, len, 1000);\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+  i2c_lld_write(handle,  LIS2DOC_I2C_ADD_H & 0xFE, reg, (uint8_t*) bufp, len);\r
+#endif\r
+  return 0;\r
+}\r
+\r
+/*\r
+ * @brief  Read generic device register (platform dependent)\r
+ *\r
+ * @param  handle    customizable argument. In this examples is used in\r
+ *                   order to select the correct sensor bus handler.\r
+ * @param  reg       register to read\r
+ * @param  bufp      pointer to buffer that store the data read\r
+ * @param  len       number of consecutive register to read\r
+ *\r
+ */\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+                             uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_I2C_Mem_Read(handle, LIS2DOC_I2C_ADD_H, reg,\r
+                   I2C_MEMADD_SIZE_8BIT, bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  reg |= 0x80;\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+  HAL_SPI_Transmit(handle, &reg, 1, 1000);\r
+  HAL_SPI_Receive(handle, bufp, len, 1000);\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+  i2c_lld_read(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, bufp, len);\r
+#endif\r
+  return 0;\r
+}\r
+\r
+/*\r
+ * @brief  Write generic device register (platform dependent)\r
+ *\r
+ * @param  tx_buffer     buffer to transmit\r
+ * @param  len           number of byte to send\r
+ *\r
+ */\r
+static void tx_com(uint8_t *tx_buffer, uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_UART_Transmit(&huart2, tx_buffer, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  CDC_Transmit_FS(tx_buffer, len);\r
+#elif defined(SPC584B_DIS)\r
+  sd_lld_write(&SD2, tx_buffer, len);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief  platform specific delay (platform dependent)\r
+ *\r
+ * @param  ms        delay in ms\r
+ *\r
+ */\r
+static void platform_delay(uint32_t ms)\r
+{\r
+#if defined(NUCLEO_F411RE) | defined(STEVAL_MKI109V3)\r
+  HAL_Delay(ms);\r
+#elif defined(SPC584B_DIS)\r
+  osalThreadDelayMilliseconds(ms);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief  platform specific initialization (platform dependent)\r
+ */\r
+static void platform_init(void)\r
+{\r
+#if defined(STEVAL_MKI109V3)\r
+  TIM3->CCR1 = PWM_3V3;\r
+  TIM3->CCR2 = PWM_3V3;\r
+  HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);\r
+  HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);\r
+  HAL_Delay(1000);\r
+#endif\r
+}\r
diff --git a/code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_self_test.c b/code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_self_test.c
new file mode 100644 (file)
index 0000000..a2dbf44
--- /dev/null
@@ -0,0 +1,397 @@
+/*\r
+ ******************************************************************************\r
+ * @file    test_self_test.c\r
+ * @author  Sensors Software Solution Team\r
+ * @brief   This file run selt test procedure\r
+ *\r
+ ******************************************************************************\r
+ * @attention\r
+ *\r
+ * <h2><center>&copy; Copyright (c) 2020 STMicroelectronics.\r
+ * All rights reserved.</center></h2>\r
+ *\r
+ * This software component is licensed by ST under BSD 3-Clause license,\r
+ * the "License"; You may not use this file except in compliance with the\r
+ * License. You may obtain a copy of the License at:\r
+ *                        opensource.org/licenses/BSD-3-Clause\r
+ *\r
+ ******************************************************************************\r
+ */\r
+\r
+/*\r
+ * This example was developed using the following STMicroelectronics\r
+ * evaluation boards:\r
+ *\r
+ * - STEVAL_MKI109V3 + STEVAL-MKI179V1\r
+ * - NUCLEO_F411RE + X_NUCLEO_IKS01A3\r
+ * - DISCOVERY_SPC584B + X_NUCLEO_IKS01A3\r
+ *\r
+ * and STM32CubeMX tool with STM32CubeF4 MCU Package\r
+ *\r
+ * Used interfaces:\r
+ *\r
+ * STEVAL_MKI109V3    - Host side:   USB (Virtual COM)\r
+ *                    - Sensor side: SPI(Default) / I2C(supported)\r
+ *\r
+ * NUCLEO_STM32F411RE - Host side: UART(COM) to USB bridge\r
+ *                    - I2C(Default) / SPI(supported)\r
+ *\r
+ * DISCOVERY_SPC584B  - Host side: UART(COM) to USB bridge\r
+ *                    - Sensor side: I2C(Default) / SPI(supported)\r
+ *\r
+ * If you need to run this example on a different hardware platform a\r
+ * modification of the functions: `platform_write`, `platform_read`,\r
+ * `tx_com` and 'platform_init' is required.\r
+ *\r
+ */\r
+\r
+/* STMicroelectronics evaluation boards definition\r
+ *\r
+ * Please uncomment ONLY the evaluation boards in use.\r
+ * If a different hardware is used please comment all\r
+ * following target board and redefine yours.\r
+ */\r
+\r
+//#define STEVAL_MKI109V3  /* little endian */\r
+//#define NUCLEO_F411RE    /* little endian */\r
+//#define SPC584B_DIS      /* big endian */\r
+\r
+/* ATTENTION: By default the driver is little endian. If you need switch\r
+ *            to big endian please see "Endianness definitions" in the\r
+ *            header file of the driver (_reg.h).\r
+ */\r
+\r
+\r
+#if defined(STEVAL_MKI109V3)\r
+/* MKI109V3: Define communication interface */\r
+#define SENSOR_BUS hspi2\r
+/* MKI109V3: Vdd and Vddio power supply values */\r
+#define PWM_3V3 915\r
+\r
+#elif defined(NUCLEO_F411RE)\r
+/* NUCLEO_F411RE: Define communication interface */\r
+#define SENSOR_BUS hi2c1\r
+\r
+#elif defined(SPC584B_DIS)\r
+/* DISCOVERY_SPC584B: Define communication interface */\r
+#define SENSOR_BUS I2CD1\r
+\r
+#endif\r
+\r
+/* Includes ------------------------------------------------------------------*/\r
+#include <string.h>\r
+#include <stdio.h>\r
+#include "lis2doc_reg.h"\r
+\r
+#if defined(NUCLEO_F411RE)\r
+#include "stm32f4xx_hal.h"\r
+#include "usart.h"\r
+#include "gpio.h"\r
+#include "i2c.h"\r
+\r
+#elif defined(STEVAL_MKI109V3)\r
+#include "stm32f4xx_hal.h"\r
+#include "usbd_cdc_if.h"\r
+#include "gpio.h"\r
+#include "spi.h"\r
+#include "tim.h"\r
+\r
+#elif defined(SPC584B_DIS)\r
+#include "components.h"\r
+#endif\r
+\r
+typedef union {\r
+  int16_t i16bit[3];\r
+} axis3bit16_t;\r
+\r
+/* Private macro -------------------------------------------------------------*/\r
+#define    BOOT_TIME            20 //ms\r
+\r
+/* Self-test recommended samples */\r
+#define SELF_TEST_SAMPLES  5\r
+\r
+/* Self-test positive difference */\r
+#define ST_MIN_POS      70.0f\r
+#define ST_MAX_POS      1500.0f\r
+\r
+/* Private variables ---------------------------------------------------------*/\r
+static lis2doc_mode_t pm;\r
+static axis3bit16_t data_raw_acceleration[SELF_TEST_SAMPLES];\r
+static float acceleration_mg[SELF_TEST_SAMPLES][3];\r
+static uint8_t whoamI, rst;\r
+static uint8_t tx_buffer[1000];\r
+\r
+/* Extern variables ----------------------------------------------------------*/\r
+\r
+/* Private functions ---------------------------------------------------------*/\r
+/*\r
+ *   WARNING:\r
+ *   Functions declare in this section are defined at the end of this file\r
+ *   and are strictly related to the hardware platform used.\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+                              uint16_t len);\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+                             uint16_t len);\r
+static void tx_com( uint8_t *tx_buffer, uint16_t len );\r
+static void platform_delay(uint32_t ms);\r
+static void platform_init(void);\r
+\r
+/* Utility functions ---------------------------------------------------------*/\r
+static inline float ABSF(float _x)\r
+{\r
+  return (_x < 0.0f) ? -(_x) : _x;\r
+}\r
+\r
+static int flush_samples(stmdev_ctx_t *dev_ctx)\r
+{\r
+  lis2doc_reg_t reg;\r
+  axis3bit16_t dummy;\r
+  int samples = 0;\r
+  /*\r
+   * Discard old samples\r
+   */\r
+  lis2doc_status_reg_get(dev_ctx, &reg.status);\r
+\r
+  if (reg.status.drdy) {\r
+    lis2doc_acceleration_raw_get(dev_ctx, dummy.i16bit);\r
+    samples++;\r
+  }\r
+\r
+  return samples;\r
+}\r
+\r
+static void test_self_test_lis2doc(stmdev_ctx_t *dev_ctx)\r
+{\r
+  lis2doc_reg_t reg;\r
+  float media[3] = { 0.0f, 0.0f, 0.0f };\r
+  float mediast[3] = { 0.0f, 0.0f, 0.0f };\r
+  uint8_t match[3] = { 0, 0, 0 };\r
+  uint8_t j = 0;\r
+  uint16_t i = 0;\r
+  uint8_t k = 0;\r
+  uint8_t axis;\r
+  /* Restore default configuration */\r
+  lis2doc_reset_set(dev_ctx, PROPERTY_ENABLE);\r
+\r
+  do {\r
+    lis2doc_reset_get(dev_ctx, &rst);\r
+  } while (rst);\r
+\r
+  lis2doc_block_data_update_set(dev_ctx, PROPERTY_ENABLE);\r
+  lis2doc_full_scale_set(dev_ctx, LIS2DOC_4g);\r
+\r
+  /* Configure power mode */\r
+  pm.hpm = 1;\r
+  pm.low_noise = 1;\r
+  lis2doc_power_mode_set(dev_ctx, pm);\r
+\r
+  lis2doc_data_rate_set(dev_ctx, LIS2DOC_XL_ODR_50Hz);\r
+  HAL_Delay(100);\r
+  /* Flush old samples */\r
+  flush_samples(dev_ctx);\r
+\r
+  do {\r
+    lis2doc_status_reg_get(dev_ctx, &reg.status);\r
+\r
+    if (reg.status.drdy) {\r
+      /* Read accelerometer data */\r
+      memset(data_raw_acceleration[i].i16bit, 0x00, 3 * sizeof(int16_t));\r
+      lis2doc_acceleration_raw_get(dev_ctx,\r
+                                    data_raw_acceleration[i].i16bit);\r
+\r
+      for (axis = 0; axis < 3; axis++) {\r
+        acceleration_mg[i][axis] =\r
+          lis2doc_from_fs4_to_mg(data_raw_acceleration[i].i16bit[axis]);\r
+      }\r
+\r
+      i++;\r
+    }\r
+  } while (i < SELF_TEST_SAMPLES);\r
+\r
+  for (k = 0; k < 3; k++) {\r
+    for (j = 0; j < SELF_TEST_SAMPLES; j++) {\r
+      media[k] += acceleration_mg[j][k];\r
+    }\r
+\r
+    media[k] = (media[k] / j);\r
+  }\r
+\r
+  /* Enable self test mode */\r
+  lis2doc_self_test_set(dev_ctx, LIS2DOC_XL_ST_POSITIVE);\r
+  HAL_Delay(100);\r
+  i = 0;\r
+  /* Flush old samples */\r
+  flush_samples(dev_ctx);\r
+\r
+  do {\r
+    lis2doc_status_reg_get(dev_ctx, &reg.status);\r
+\r
+    if (reg.status.drdy) {\r
+      /* Read accelerometer data */\r
+      memset(data_raw_acceleration[i].i16bit, 0x00, 3 * sizeof(int16_t));\r
+      lis2doc_acceleration_raw_get(dev_ctx,\r
+                                    data_raw_acceleration[i].i16bit);\r
+\r
+      for (axis = 0; axis < 3; axis++)\r
+        acceleration_mg[i][axis] =\r
+          lis2doc_from_fs4_to_mg(data_raw_acceleration[i].i16bit[axis]);\r
+\r
+      i++;\r
+    }\r
+  } while (i < SELF_TEST_SAMPLES);\r
+\r
+  for (k = 0; k < 3; k++) {\r
+    for (j = 0; j < SELF_TEST_SAMPLES; j++) {\r
+      mediast[k] += acceleration_mg[j][k];\r
+    }\r
+\r
+    mediast[k] = (mediast[k] / j);\r
+  }\r
+\r
+  /* Check for all axis self test value range */\r
+  for (k = 0; k < 3; k++) {\r
+    if ((ABSF(mediast[k] - media[k]) >= ST_MIN_POS) &&\r
+        (ABSF(mediast[k] - media[k]) <= ST_MAX_POS)) {\r
+      match[k] = 1;\r
+    }\r
+\r
+    sprintf((char *)tx_buffer, "%d: |%f| <= |%f| <= |%f| %s\r\n", k,\r
+            ST_MIN_POS, ABSF(mediast[k] - media[k]), ST_MAX_POS,\r
+            match[k] == 1 ? "PASSED" : "FAILED");\r
+    tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
+  }\r
+\r
+  /* Disable self test mode */\r
+  lis2doc_data_rate_set(dev_ctx, LIS2DOC_XL_ODR_OFF);\r
+  lis2doc_self_test_set(dev_ctx, LIS2DOC_XL_ST_DISABLE);\r
+}\r
+\r
+/* Main Example --------------------------------------------------------------*/\r
+void lis2doc_self_test(void)\r
+{\r
+  /* Initialize mems driver interface */\r
+  stmdev_ctx_t dev_ctx;\r
+  dev_ctx.write_reg = platform_write;\r
+  dev_ctx.read_reg = platform_read;\r
+  dev_ctx.handle = &SENSOR_BUS;\r
+  /* Initialize platform specific hardware */\r
+  platform_init();\r
+  /* Wait sensor boot time */\r
+  platform_delay(BOOT_TIME);\r
+  /* Check device ID */\r
+  lis2doc_device_id_get(&dev_ctx, &whoamI);\r
+\r
+  if (whoamI != LIS2DOC_ID)\r
+    while (1) {\r
+      /* manage here device not found */\r
+    }\r
+\r
+  /* Start self test */\r
+  while (1) {\r
+    test_self_test_lis2doc(&dev_ctx);\r
+  }\r
+}\r
+\r
+/*\r
+ * @brief  Write generic device register (platform dependent)\r
+ *\r
+ * @param  handle    customizable argument. In this examples is used in\r
+ *                   order to select the correct sensor bus handler.\r
+ * @param  reg       register to write\r
+ * @param  bufp      pointer to data to write in register reg\r
+ * @param  len       number of consecutive register to write\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+                              uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_I2C_Mem_Write(handle, LIS2DOC_I2C_ADD_H, reg,\r
+                    I2C_MEMADD_SIZE_8BIT, (uint8_t*) bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+  HAL_SPI_Transmit(handle, &reg, 1, 1000);\r
+  HAL_SPI_Transmit(handle, (uint8_t*) bufp, len, 1000);\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+  i2c_lld_write(handle,  LIS2DOC_I2C_ADD_H & 0xFE, reg, (uint8_t*) bufp, len);\r
+#endif\r
+  return 0;\r
+}\r
+\r
+/*\r
+ * @brief  Read generic device register (platform dependent)\r
+ *\r
+ * @param  handle    customizable argument. In this examples is used in\r
+ *                   order to select the correct sensor bus handler.\r
+ * @param  reg       register to read\r
+ * @param  bufp      pointer to buffer that store the data read\r
+ * @param  len       number of consecutive register to read\r
+ *\r
+ */\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+                             uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_I2C_Mem_Read(handle, LIS2DOC_I2C_ADD_H, reg,\r
+                   I2C_MEMADD_SIZE_8BIT, bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  reg |= 0x80;\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+  HAL_SPI_Transmit(handle, &reg, 1, 1000);\r
+  HAL_SPI_Receive(handle, bufp, len, 1000);\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+  i2c_lld_read(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, bufp, len);\r
+#endif\r
+  return 0;\r
+}\r
+\r
+/*\r
+ * @brief  Write generic device register (platform dependent)\r
+ *\r
+ * @param  tx_buffer     buffer to transmit\r
+ * @param  len           number of byte to send\r
+ *\r
+ */\r
+static void tx_com(uint8_t *tx_buffer, uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_UART_Transmit(&huart2, tx_buffer, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  CDC_Transmit_FS(tx_buffer, len);\r
+#elif defined(SPC584B_DIS)\r
+  sd_lld_write(&SD2, tx_buffer, len);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief  platform specific delay (platform dependent)\r
+ *\r
+ * @param  ms        delay in ms\r
+ *\r
+ */\r
+static void platform_delay(uint32_t ms)\r
+{\r
+#if defined(NUCLEO_F411RE) | defined(STEVAL_MKI109V3)\r
+  HAL_Delay(ms);\r
+#elif defined(SPC584B_DIS)\r
+  osalThreadDelayMilliseconds(ms);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief  platform specific initialization (platform dependent)\r
+ */\r
+static void platform_init(void)\r
+{\r
+#if defined(STEVAL_MKI109V3)\r
+  TIM3->CCR1 = PWM_3V3;\r
+  TIM3->CCR2 = PWM_3V3;\r
+  HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);\r
+  HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);\r
+  HAL_Delay(1000);\r
+#endif\r
+}\r
diff --git a/code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_tap_double.c b/code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_tap_double.c
new file mode 100644 (file)
index 0000000..31ab3f1
--- /dev/null
@@ -0,0 +1,335 @@
+/*\r
+ ******************************************************************************\r
+ * @file    double_tap.c\r
+ * @author  Sensors Software Solution Team\r
+ * @brief   This file show the simplest way to detect double tap from sensor.\r
+ *\r
+ ******************************************************************************\r
+ * @attention\r
+ *\r
+ * <h2><center>&copy; Copyright (c) 2020 STMicroelectronics.\r
+ * All rights reserved.</center></h2>\r
+ *\r
+ * This software component is licensed by ST under BSD 3-Clause license,\r
+ * the "License"; You may not use this file except in compliance with the\r
+ * License. You may obtain a copy of the License at:\r
+ *                        opensource.org/licenses/BSD-3-Clause\r
+ *\r
+ ******************************************************************************\r
+ */\r
+\r
+/*\r
+ * This example was developed using the following STMicroelectronics\r
+ * evaluation boards:\r
+ *\r
+ * - STEVAL_MKI109V3 + STEVAL-MKI179V1\r
+ * - NUCLEO_F411RE + X_NUCLEO_IKS01A3\r
+ * - DISCOVERY_SPC584B + X_NUCLEO_IKS01A3\r
+ *\r
+ * and STM32CubeMX tool with STM32CubeF4 MCU Package\r
+ *\r
+ * Used interfaces:\r
+ *\r
+ * STEVAL_MKI109V3    - Host side:   USB (Virtual COM)\r
+ *                    - Sensor side: SPI(Default) / I2C(supported)\r
+ *\r
+ * NUCLEO_STM32F411RE - Host side: UART(COM) to USB bridge\r
+ *                    - I2C(Default) / SPI(supported)\r
+ *\r
+ * DISCOVERY_SPC584B  - Host side: UART(COM) to USB bridge\r
+ *                    - Sensor side: I2C(Default) / SPI(supported)\r
+ *\r
+ * If you need to run this example on a different hardware platform a\r
+ * modification of the functions: `platform_write`, `platform_read`,\r
+ * `tx_com` and 'platform_init' is required.\r
+ *\r
+ */\r
+\r
+/* STMicroelectronics evaluation boards definition\r
+ *\r
+ * Please uncomment ONLY the evaluation boards in use.\r
+ * If a different hardware is used please comment all\r
+ * following target board and redefine yours.\r
+ */\r
+\r
+//#define STEVAL_MKI109V3  /* little endian */\r
+//#define NUCLEO_F411RE    /* little endian */\r
+//#define SPC584B_DIS      /* big endian */\r
+\r
+/* ATTENTION: By default the driver is little endian. If you need switch\r
+ *            to big endian please see "Endianness definitions" in the\r
+ *            header file of the driver (_reg.h).\r
+ */\r
+\r
+\r
+#if defined(STEVAL_MKI109V3)\r
+/* MKI109V3: Define communication interface */\r
+#define SENSOR_BUS hspi2\r
+/* MKI109V3: Vdd and Vddio power supply values */\r
+#define PWM_3V3 915\r
+\r
+#elif defined(NUCLEO_F411RE)\r
+/* NUCLEO_F411RE: Define communication interface */\r
+#define SENSOR_BUS hi2c1\r
+\r
+#elif defined(SPC584B_DIS)\r
+/* DISCOVERY_SPC584B: Define communication interface */\r
+#define SENSOR_BUS I2CD1\r
+\r
+#endif\r
+\r
+/* Includes ------------------------------------------------------------------*/\r
+#include <string.h>\r
+#include <stdio.h>\r
+#include "lis2doc_reg.h"\r
+\r
+#if defined(NUCLEO_F411RE)\r
+#include "stm32f4xx_hal.h"\r
+#include "usart.h"\r
+#include "gpio.h"\r
+#include "i2c.h"\r
+\r
+#elif defined(STEVAL_MKI109V3)\r
+#include "stm32f4xx_hal.h"\r
+#include "usbd_cdc_if.h"\r
+#include "gpio.h"\r
+#include "spi.h"\r
+#include "tim.h"\r
+\r
+#elif defined(SPC584B_DIS)\r
+#include "components.h"\r
+#endif\r
+\r
+\r
+/* Private macro -------------------------------------------------------------*/\r
+#define    BOOT_TIME            20 //ms\r
+\r
+/* Private variables ---------------------------------------------------------*/\r
+static lis2doc_mode_t pm;\r
+static uint8_t whoamI, rst;\r
+static uint8_t tx_buffer[1000];\r
+\r
+/* Extern variables ----------------------------------------------------------*/\r
+\r
+/* Private functions ---------------------------------------------------------*/\r
+/*\r
+ *   WARNING:\r
+ *   Functions declare in this section are defined at the end of this file\r
+ *   and are strictly related to the hardware platform used.\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+                              uint16_t len);\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+                             uint16_t len);\r
+static void tx_com( uint8_t *tx_buffer, uint16_t len );\r
+static void platform_delay(uint32_t ms);\r
+static void platform_init(void);\r
+\r
+/* Main Example --------------------------------------------------------------*/\r
+void lis2doc_double_tap(void)\r
+{\r
+  /* Initialize mems driver interface */\r
+  stmdev_ctx_t dev_ctx;\r
+  lis2doc_reg_t int_route;\r
+  dev_ctx.write_reg = platform_write;\r
+  dev_ctx.read_reg = platform_read;\r
+  dev_ctx.handle = &SENSOR_BUS;\r
+  /* Initialize platform specific hardware */\r
+  platform_init();\r
+  /* Wait sensor boot time */\r
+  platform_delay(BOOT_TIME);\r
+  /* Check device ID */\r
+  lis2doc_device_id_get(&dev_ctx, &whoamI);\r
+\r
+  if (whoamI != LIS2DOC_ID)\r
+    while (1) {\r
+      /* manage here device not found */\r
+    }\r
+\r
+  /* Restore default configuration */\r
+  lis2doc_reset_set(&dev_ctx, PROPERTY_ENABLE);\r
+\r
+  do {\r
+    lis2doc_reset_get(&dev_ctx, &rst);\r
+  } while (rst);\r
+\r
+  /* Set full scale */\r
+  lis2doc_full_scale_set(&dev_ctx, LIS2DOC_2g);\r
+\r
+  /* Configure power mode */\r
+  pm.lpm = 1;\r
+  pm.low_noise = 1;\r
+  lis2doc_power_mode_set(&dev_ctx, pm);\r
+\r
+  /* Set Output Data Rate */\r
+  lis2doc_data_rate_set(&dev_ctx, LIS2DOC_XL_ODR_400Hz);\r
+  /* Enable Tap detection on X, Y, Z */\r
+  lis2doc_tap_detection_on_z_set(&dev_ctx, PROPERTY_ENABLE);\r
+  lis2doc_tap_detection_on_y_set(&dev_ctx, PROPERTY_ENABLE);\r
+  lis2doc_tap_detection_on_x_set(&dev_ctx, PROPERTY_ENABLE);\r
+  /* Set Tap threshold on all axis */\r
+  lis2doc_tap_threshold_x_set(&dev_ctx, 12);\r
+  lis2doc_tap_threshold_y_set(&dev_ctx, 12);\r
+  lis2doc_tap_threshold_z_set(&dev_ctx, 12);\r
+  /* Configure Double Tap parameter */\r
+  lis2doc_tap_dur_set(&dev_ctx, 7);\r
+  lis2doc_tap_quiet_set(&dev_ctx, 3);\r
+  lis2doc_tap_shock_set(&dev_ctx, 3);\r
+  /* Enable Double Tap detection */\r
+  lis2doc_tap_mode_set(&dev_ctx, LIS2DOC_BOTH_SINGLE_DOUBLE);\r
+  /* Enable single tap detection interrupt */\r
+  lis2doc_pin_int1_route_get(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);\r
+  int_route.ctrl4_int1_pad_ctrl.int1_tap = PROPERTY_ENABLE;\r
+  lis2doc_pin_int1_route_set(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);\r
+\r
+  /* Wait Events. */\r
+  while (1) {\r
+    lis2doc_all_sources_t all_source;\r
+    /* Check Double Tap events */\r
+    lis2doc_all_sources_get(&dev_ctx, &all_source);\r
+\r
+    if (all_source.tap_src.double_tap) {\r
+      sprintf((char *)tx_buffer, "Double Tap Detected: Sign %s",\r
+              all_source.tap_src.tap_sign ? "positive" : "negative");\r
+\r
+      if (all_source.tap_src.x_tap) {\r
+        sprintf((char *)tx_buffer, "%s on X", tx_buffer);\r
+      }\r
+\r
+      if (all_source.tap_src.y_tap) {\r
+        sprintf((char *)tx_buffer, "%s on Y", tx_buffer);\r
+      }\r
+\r
+      if (all_source.tap_src.z_tap) {\r
+        sprintf((char *)tx_buffer, "%s on Z", tx_buffer);\r
+      }\r
+\r
+      sprintf((char *)tx_buffer, "%s axis\r\n", tx_buffer);\r
+      tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
+    }\r
+\r
+    /* Check Single Tap events */\r
+    if (all_source.tap_src.single_tap) {\r
+      sprintf((char *)tx_buffer, "Tap Detected: Sign %s",\r
+              all_source.tap_src.tap_sign ? "positive" : "negative");\r
+\r
+      if (all_source.tap_src.x_tap) {\r
+        sprintf((char *)tx_buffer, "%s on X", tx_buffer);\r
+      }\r
+\r
+      if (all_source.tap_src.y_tap) {\r
+        sprintf((char *)tx_buffer, "%s on Y", tx_buffer);\r
+      }\r
+\r
+      if (all_source.tap_src.z_tap) {\r
+        sprintf((char *)tx_buffer, "%s on Z", tx_buffer);\r
+      }\r
+\r
+      sprintf((char *)tx_buffer, "%s axis\r\n", tx_buffer);\r
+      tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
+    }\r
+  }\r
+}\r
+\r
+/*\r
+ * @brief  Write generic device register (platform dependent)\r
+ *\r
+ * @param  handle    customizable argument. In this examples is used in\r
+ *                   order to select the correct sensor bus handler.\r
+ * @param  reg       register to write\r
+ * @param  bufp      pointer to data to write in register reg\r
+ * @param  len       number of consecutive register to write\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+                              uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_I2C_Mem_Write(handle, LIS2DOC_I2C_ADD_H, reg,\r
+                    I2C_MEMADD_SIZE_8BIT, (uint8_t*) bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+  HAL_SPI_Transmit(handle, &reg, 1, 1000);\r
+  HAL_SPI_Transmit(handle, (uint8_t*) bufp, len, 1000);\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+  i2c_lld_write(handle,  LIS2DOC_I2C_ADD_H & 0xFE, reg, (uint8_t*) bufp, len);\r
+#endif\r
+  return 0;\r
+}\r
+\r
+/*\r
+ * @brief  Read generic device register (platform dependent)\r
+ *\r
+ * @param  handle    customizable argument. In this examples is used in\r
+ *                   order to select the correct sensor bus handler.\r
+ * @param  reg       register to read\r
+ * @param  bufp      pointer to buffer that store the data read\r
+ * @param  len       number of consecutive register to read\r
+ *\r
+ */\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+                             uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_I2C_Mem_Read(handle, LIS2DOC_I2C_ADD_H, reg,\r
+                   I2C_MEMADD_SIZE_8BIT, bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  reg |= 0x80;\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+  HAL_SPI_Transmit(handle, &reg, 1, 1000);\r
+  HAL_SPI_Receive(handle, bufp, len, 1000);\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+  i2c_lld_read(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, bufp, len);\r
+#endif\r
+  return 0;\r
+}\r
+\r
+/*\r
+ * @brief  Write generic device register (platform dependent)\r
+ *\r
+ * @param  tx_buffer     buffer to transmit\r
+ * @param  len           number of byte to send\r
+ *\r
+ */\r
+static void tx_com(uint8_t *tx_buffer, uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_UART_Transmit(&huart2, tx_buffer, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  CDC_Transmit_FS(tx_buffer, len);\r
+#elif defined(SPC584B_DIS)\r
+  sd_lld_write(&SD2, tx_buffer, len);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief  platform specific delay (platform dependent)\r
+ *\r
+ * @param  ms        delay in ms\r
+ *\r
+ */\r
+static void platform_delay(uint32_t ms)\r
+{\r
+#if defined(NUCLEO_F411RE) | defined(STEVAL_MKI109V3)\r
+  HAL_Delay(ms);\r
+#elif defined(SPC584B_DIS)\r
+  osalThreadDelayMilliseconds(ms);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief  platform specific initialization (platform dependent)\r
+ */\r
+static void platform_init(void)\r
+{\r
+#if defined(STEVAL_MKI109V3)\r
+  TIM3->CCR1 = PWM_3V3;\r
+  TIM3->CCR2 = PWM_3V3;\r
+  HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);\r
+  HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);\r
+  HAL_Delay(1000);\r
+#endif\r
+}
\ No newline at end of file
diff --git a/code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_tap_single.c b/code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_tap_single.c
new file mode 100644 (file)
index 0000000..3a545b2
--- /dev/null
@@ -0,0 +1,312 @@
+/*\r
+ ******************************************************************************\r
+ * @file    single_tap.c\r
+ * @author  Sensors Software Solution Team\r
+ * @brief   This file show the simplest way to detect single tap from sensor.\r
+ *\r
+ ******************************************************************************\r
+ * @attention\r
+ *\r
+ * <h2><center>&copy; Copyright (c) 2020 STMicroelectronics.\r
+ * All rights reserved.</center></h2>\r
+ *\r
+ * This software component is licensed by ST under BSD 3-Clause license,\r
+ * the "License"; You may not use this file except in compliance with the\r
+ * License. You may obtain a copy of the License at:\r
+ *                        opensource.org/licenses/BSD-3-Clause\r
+ *\r
+ ******************************************************************************\r
+ */\r
+\r
+/*\r
+ * This example was developed using the following STMicroelectronics\r
+ * evaluation boards:\r
+ *\r
+ * - STEVAL_MKI109V3 + STEVAL-MKI179V1\r
+ * - NUCLEO_F411RE + X_NUCLEO_IKS01A3\r
+ * - DISCOVERY_SPC584B + X_NUCLEO_IKS01A3\r
+ *\r
+ * and STM32CubeMX tool with STM32CubeF4 MCU Package\r
+ *\r
+ * Used interfaces:\r
+ *\r
+ * STEVAL_MKI109V3    - Host side:   USB (Virtual COM)\r
+ *                    - Sensor side: SPI(Default) / I2C(supported)\r
+ *\r
+ * NUCLEO_STM32F411RE - Host side: UART(COM) to USB bridge\r
+ *                    - I2C(Default) / SPI(supported)\r
+ *\r
+ * DISCOVERY_SPC584B  - Host side: UART(COM) to USB bridge\r
+ *                    - Sensor side: I2C(Default) / SPI(supported)\r
+ *\r
+ * If you need to run this example on a different hardware platform a\r
+ * modification of the functions: `platform_write`, `platform_read`,\r
+ * `tx_com` and 'platform_init' is required.\r
+ *\r
+ */\r
+\r
+/* STMicroelectronics evaluation boards definition\r
+ *\r
+ * Please uncomment ONLY the evaluation boards in use.\r
+ * If a different hardware is used please comment all\r
+ * following target board and redefine yours.\r
+ */\r
+\r
+//#define STEVAL_MKI109V3  /* little endian */\r
+//#define NUCLEO_F411RE    /* little endian */\r
+//#define SPC584B_DIS      /* big endian */\r
+\r
+/* ATTENTION: By default the driver is little endian. If you need switch\r
+ *            to big endian please see "Endianness definitions" in the\r
+ *            header file of the driver (_reg.h).\r
+ */\r
+\r
+\r
+#if defined(STEVAL_MKI109V3)\r
+/* MKI109V3: Define communication interface */\r
+#define SENSOR_BUS hspi2\r
+/* MKI109V3: Vdd and Vddio power supply values */\r
+#define PWM_3V3 915\r
+\r
+#elif defined(NUCLEO_F411RE)\r
+/* NUCLEO_F411RE: Define communication interface */\r
+#define SENSOR_BUS hi2c1\r
+\r
+#elif defined(SPC584B_DIS)\r
+/* DISCOVERY_SPC584B: Define communication interface */\r
+#define SENSOR_BUS I2CD1\r
+\r
+#endif\r
+\r
+/* Includes ------------------------------------------------------------------*/\r
+#include <string.h>\r
+#include <stdio.h>\r
+#include "lis2doc_reg.h"\r
+\r
+#if defined(NUCLEO_F411RE)\r
+#include "stm32f4xx_hal.h"\r
+#include "usart.h"\r
+#include "gpio.h"\r
+#include "i2c.h"\r
+\r
+#elif defined(STEVAL_MKI109V3)\r
+#include "stm32f4xx_hal.h"\r
+#include "usbd_cdc_if.h"\r
+#include "gpio.h"\r
+#include "spi.h"\r
+#include "tim.h"\r
+\r
+#elif defined(SPC584B_DIS)\r
+#include "components.h"\r
+#endif\r
+\r
+\r
+/* Private macro -------------------------------------------------------------*/\r
+#define    BOOT_TIME            20 //ms\r
+\r
+/* Private variables ---------------------------------------------------------*/\r
+static lis2doc_mode_t pm;\r
+static uint8_t whoamI, rst;\r
+static uint8_t tx_buffer[1000];\r
+\r
+/* Extern variables ----------------------------------------------------------*/\r
+\r
+/* Private functions ---------------------------------------------------------*/\r
+/*\r
+ *   WARNING:\r
+ *   Functions declare in this section are defined at the end of this file\r
+ *   and are strictly related to the hardware platform used.\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+                              uint16_t len);\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+                             uint16_t len);\r
+static void tx_com( uint8_t *tx_buffer, uint16_t len );\r
+static void platform_delay(uint32_t ms);\r
+static void platform_init(void);\r
+\r
+/* Main Example --------------------------------------------------------------*/\r
+void lis2doc_single_tap(void)\r
+{\r
+  /* Initialize mems driver interface. */\r
+  stmdev_ctx_t dev_ctx;\r
+  lis2doc_reg_t int_route;\r
+  dev_ctx.write_reg = platform_write;\r
+  dev_ctx.read_reg = platform_read;\r
+  dev_ctx.handle = &SENSOR_BUS;\r
+  /* Initialize platform specific hardware */\r
+  platform_init();\r
+  /* Wait sensor boot time */\r
+  platform_delay(BOOT_TIME);\r
+  /* Check device ID */\r
+  lis2doc_device_id_get(&dev_ctx, &whoamI);\r
+\r
+  if (whoamI != LIS2DOC_ID)\r
+    while (1) {\r
+      /* manage here device not found */\r
+    }\r
+\r
+  /* Restore default configuration */\r
+  lis2doc_reset_set(&dev_ctx, PROPERTY_ENABLE);\r
+\r
+  do {\r
+    lis2doc_reset_get(&dev_ctx, &rst);\r
+  } while (rst);\r
+\r
+  /* Set full scale */\r
+  lis2doc_full_scale_set(&dev_ctx, LIS2DOC_2g);\r
+\r
+  /* Configure power mode */\r
+  pm.lpm = 1;\r
+  pm.low_noise = 1;\r
+  lis2doc_power_mode_set(&dev_ctx, pm);\r
+\r
+  /* Set Output Data Rate */\r
+  lis2doc_data_rate_set(&dev_ctx, LIS2DOC_XL_ODR_400Hz);\r
+  /* Enable Tap detection on X, Y, Z */\r
+  lis2doc_tap_detection_on_z_set(&dev_ctx, PROPERTY_ENABLE);\r
+  lis2doc_tap_detection_on_y_set(&dev_ctx, PROPERTY_ENABLE);\r
+  lis2doc_tap_detection_on_x_set(&dev_ctx, PROPERTY_ENABLE);\r
+  /* Set Tap threshold on all axis */\r
+  lis2doc_tap_threshold_x_set(&dev_ctx, 9);\r
+  lis2doc_tap_threshold_y_set(&dev_ctx, 9);\r
+  lis2doc_tap_threshold_z_set(&dev_ctx, 9);\r
+  /* Configure Single Tap parameter */\r
+  lis2doc_tap_quiet_set(&dev_ctx, 1);\r
+  lis2doc_tap_shock_set(&dev_ctx, 2);\r
+  /* Enable Single Tap detection only */\r
+  lis2doc_tap_mode_set(&dev_ctx, LIS2DOC_ONLY_SINGLE);\r
+  /* Enable single tap detection interrupt */\r
+  lis2doc_pin_int1_route_get(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);\r
+  int_route.ctrl4_int1_pad_ctrl.int1_single_tap = PROPERTY_ENABLE;\r
+  lis2doc_pin_int1_route_set(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);\r
+\r
+  /* Wait Events */\r
+  while (1) {\r
+    lis2doc_all_sources_t all_source;\r
+    /* Check Single Tap events */\r
+    lis2doc_all_sources_get(&dev_ctx, &all_source);\r
+\r
+    if (all_source.tap_src.single_tap) {\r
+      sprintf((char *)tx_buffer, "Tap Detected: Sign %s",\r
+              all_source.tap_src.tap_sign ? "positive" : "negative");\r
+\r
+      if (all_source.tap_src.x_tap) {\r
+        sprintf((char *)tx_buffer, "%s on X axis\r\n", tx_buffer);\r
+      }\r
+\r
+      if (all_source.tap_src.y_tap) {\r
+        sprintf((char *)tx_buffer, "%s on Y axis\r\n", tx_buffer);\r
+      }\r
+\r
+      if (all_source.tap_src.z_tap) {\r
+        sprintf((char *)tx_buffer, "%s on Z axis\r\n", tx_buffer);\r
+      }\r
+\r
+      tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
+    }\r
+  }\r
+}\r
+\r
+/*\r
+ * @brief  Write generic device register (platform dependent)\r
+ *\r
+ * @param  handle    customizable argument. In this examples is used in\r
+ *                   order to select the correct sensor bus handler.\r
+ * @param  reg       register to write\r
+ * @param  bufp      pointer to data to write in register reg\r
+ * @param  len       number of consecutive register to write\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+                              uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_I2C_Mem_Write(handle, LIS2DOC_I2C_ADD_H, reg,\r
+                    I2C_MEMADD_SIZE_8BIT, (uint8_t*) bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+  HAL_SPI_Transmit(handle, &reg, 1, 1000);\r
+  HAL_SPI_Transmit(handle, (uint8_t*) bufp, len, 1000);\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+  i2c_lld_write(handle,  LIS2DOC_I2C_ADD_H & 0xFE, reg, (uint8_t*) bufp, len);\r
+#endif\r
+  return 0;\r
+}\r
+\r
+/*\r
+ * @brief  Read generic device register (platform dependent)\r
+ *\r
+ * @param  handle    customizable argument. In this examples is used in\r
+ *                   order to select the correct sensor bus handler.\r
+ * @param  reg       register to read\r
+ * @param  bufp      pointer to buffer that store the data read\r
+ * @param  len       number of consecutive register to read\r
+ *\r
+ */\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+                             uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_I2C_Mem_Read(handle, LIS2DOC_I2C_ADD_H, reg,\r
+                   I2C_MEMADD_SIZE_8BIT, bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  reg |= 0x80;\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+  HAL_SPI_Transmit(handle, &reg, 1, 1000);\r
+  HAL_SPI_Receive(handle, bufp, len, 1000);\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+  i2c_lld_read(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, bufp, len);\r
+#endif\r
+  return 0;\r
+}\r
+\r
+/*\r
+ * @brief  Write generic device register (platform dependent)\r
+ *\r
+ * @param  tx_buffer     buffer to transmit\r
+ * @param  len           number of byte to send\r
+ *\r
+ */\r
+static void tx_com(uint8_t *tx_buffer, uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_UART_Transmit(&huart2, tx_buffer, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  CDC_Transmit_FS(tx_buffer, len);\r
+#elif defined(SPC584B_DIS)\r
+  sd_lld_write(&SD2, tx_buffer, len);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief  platform specific delay (platform dependent)\r
+ *\r
+ * @param  ms        delay in ms\r
+ *\r
+ */\r
+static void platform_delay(uint32_t ms)\r
+{\r
+#if defined(NUCLEO_F411RE) | defined(STEVAL_MKI109V3)\r
+  HAL_Delay(ms);\r
+#elif defined(SPC584B_DIS)\r
+  osalThreadDelayMilliseconds(ms);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief  platform specific initialization (platform dependent)\r
+ */\r
+static void platform_init(void)\r
+{\r
+#if defined(STEVAL_MKI109V3)\r
+  TIM3->CCR1 = PWM_3V3;\r
+  TIM3->CCR2 = PWM_3V3;\r
+  HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);\r
+  HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);\r
+  HAL_Delay(1000);\r
+#endif\r
+}\r
diff --git a/code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_wake_up.c b/code/sdk/drivers/peripheral/acc/lis2doc_STdC/examples/lis2doc_wake_up.c
new file mode 100644 (file)
index 0000000..e4cd954
--- /dev/null
@@ -0,0 +1,310 @@
+/*\r
+ ******************************************************************************\r
+ * @file    lis2doc_wake_up.c\r
+ * @author  Sensors Software Solution Team\r
+ * @brief   This file show the simplest way to detect wake_up from sensor.\r
+ *\r
+ ******************************************************************************\r
+ * @attention\r
+ *\r
+ * <h2><center>&copy; Copyright (c) 2020 STMicroelectronics.\r
+ * All rights reserved.</center></h2>\r
+ *\r
+ * This software component is licensed by ST under BSD 3-Clause license,\r
+ * the "License"; You may not use this file except in compliance with the\r
+ * License. You may obtain a copy of the License at:\r
+ *                        opensource.org/licenses/BSD-3-Clause\r
+ *\r
+ ******************************************************************************\r
+ */\r
+\r
+/*\r
+ * This example was developed using the following STMicroelectronics\r
+ * evaluation boards:\r
+ *\r
+ * - STEVAL_MKI109V3 + STEVAL-MKI179V1\r
+ * - NUCLEO_F411RE + X_NUCLEO_IKS01A3\r
+ * - DISCOVERY_SPC584B + X_NUCLEO_IKS01A3\r
+ *\r
+ * and STM32CubeMX tool with STM32CubeF4 MCU Package\r
+ *\r
+ * Used interfaces:\r
+ *\r
+ * STEVAL_MKI109V3    - Host side:   USB (Virtual COM)\r
+ *                    - Sensor side: SPI(Default) / I2C(supported)\r
+ *\r
+ * NUCLEO_STM32F411RE - Host side: UART(COM) to USB bridge\r
+ *                    - I2C(Default) / SPI(supported)\r
+ *\r
+ * DISCOVERY_SPC584B  - Host side: UART(COM) to USB bridge\r
+ *                    - Sensor side: I2C(Default) / SPI(supported)\r
+ *\r
+ * If you need to run this example on a different hardware platform a\r
+ * modification of the functions: `platform_write`, `platform_read`,\r
+ * `tx_com` and 'platform_init' is required.\r
+ *\r
+ */\r
+\r
+/* STMicroelectronics evaluation boards definition\r
+ *\r
+ * Please uncomment ONLY the evaluation boards in use.\r
+ * If a different hardware is used please comment all\r
+ * following target board and redefine yours.\r
+ */\r
+\r
+//#define STEVAL_MKI109V3  /* little endian */\r
+//#define NUCLEO_F411RE    /* little endian */\r
+//#define SPC584B_DIS      /* big endian */\r
+\r
+/* ATTENTION: By default the driver is little endian. If you need switch\r
+ *            to big endian please see "Endianness definitions" in the\r
+ *            header file of the driver (_reg.h).\r
+ */\r
+\r
+\r
+#if defined(STEVAL_MKI109V3)\r
+/* MKI109V3: Define communication interface */\r
+#define SENSOR_BUS hspi2\r
+/* MKI109V3: Vdd and Vddio power supply values */\r
+#define PWM_3V3 915\r
+\r
+#elif defined(NUCLEO_F411RE)\r
+/* NUCLEO_F411RE: Define communication interface */\r
+#define SENSOR_BUS hi2c1\r
+\r
+#elif defined(SPC584B_DIS)\r
+/* DISCOVERY_SPC584B: Define communication interface */\r
+#define SENSOR_BUS I2CD1\r
+\r
+#endif\r
+\r
+/* Includes ------------------------------------------------------------------*/\r
+#include <string.h>\r
+#include <stdio.h>\r
+#include "lis2doc_reg.h"\r
+\r
+#if defined(NUCLEO_F411RE)\r
+#include "stm32f4xx_hal.h"\r
+#include "usart.h"\r
+#include "gpio.h"\r
+#include "i2c.h"\r
+\r
+#elif defined(STEVAL_MKI109V3)\r
+#include "stm32f4xx_hal.h"\r
+#include "usbd_cdc_if.h"\r
+#include "gpio.h"\r
+#include "spi.h"\r
+#include "tim.h"\r
+\r
+#elif defined(SPC584B_DIS)\r
+#include "components.h"\r
+#endif\r
+\r
+/* Private macro -------------------------------------------------------------*/\r
+#define    BOOT_TIME            20 //ms\r
+\r
+/* Private variables ---------------------------------------------------------*/\r
+static lis2doc_mode_t pm;\r
+static uint8_t whoamI, rst;\r
+static uint8_t tx_buffer[1000];\r
+\r
+/* Extern variables ----------------------------------------------------------*/\r
+\r
+/* Private functions ---------------------------------------------------------*/\r
+/*\r
+ *   WARNING:\r
+ *   Functions declare in this section are defined at the end of this file\r
+ *   and are strictly related to the hardware platform used.\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+                              uint16_t len);\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+                             uint16_t len);\r
+static void tx_com( uint8_t *tx_buffer, uint16_t len );\r
+static void platform_delay(uint32_t ms);\r
+static void platform_init(void);\r
+\r
+/* Main Example --------------------------------------------------------------*/\r
+void lis2doc_wake_up(void)\r
+{\r
+  /* Initialize mems driver interface */\r
+  stmdev_ctx_t dev_ctx;\r
+  lis2doc_reg_t int_route;\r
+  dev_ctx.write_reg = platform_write;\r
+  dev_ctx.read_reg = platform_read;\r
+  dev_ctx.handle = &SENSOR_BUS;\r
+  /* Initialize platform specific hardware */\r
+  platform_init();\r
+  /* Wait sensor boot time */\r
+  platform_delay(BOOT_TIME);\r
+  /* Check device ID */\r
+  lis2doc_device_id_get(&dev_ctx, &whoamI);\r
+\r
+  if (whoamI != LIS2DOC_ID)\r
+    while (1) {\r
+      /* manage here device not found */\r
+    }\r
+\r
+  /* Restore default configuration */\r
+  lis2doc_reset_set(&dev_ctx, PROPERTY_ENABLE);\r
+\r
+  do {\r
+    lis2doc_reset_get(&dev_ctx, &rst);\r
+  } while (rst);\r
+\r
+  /* Set full scale */\r
+  lis2doc_full_scale_set(&dev_ctx, LIS2DOC_2g);\r
+\r
+  /* Configure power mode */\r
+  pm.lpm = 1;\r
+  pm.low_noise = 1;\r
+  lis2doc_power_mode_set(&dev_ctx, pm);\r
+\r
+  /* Set Output Data Rate */\r
+  lis2doc_data_rate_set(&dev_ctx, LIS2DOC_XL_ODR_200Hz);\r
+  /* Apply high-pass digital filter on Wake-Up function */\r
+  lis2doc_filter_path_set(&dev_ctx, LIS2DOC_HIGH_PASS_ON_OUT);\r
+  /* Apply high-pass digital filter on Wake-Up function\r
+   * Duration time is set to zero so Wake-Up interrupt signal\r
+   * is generated for each X,Y,Z filtered data exceeding the\r
+   * configured threshold\r
+   */\r
+  lis2doc_wkup_dur_set(&dev_ctx, 0);\r
+  /* Set wake-up threshold\r
+   * Set Wake-Up threshold: 1 LSb corresponds to FS_XL/2^6\r
+   */\r
+  lis2doc_wkup_threshold_set(&dev_ctx, 2);\r
+  /* Enable interrupt generation on Wake-Up INT1 pin */\r
+  lis2doc_pin_int1_route_get(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);\r
+  int_route.ctrl4_int1_pad_ctrl.int1_wu = PROPERTY_ENABLE;\r
+  lis2doc_pin_int1_route_set(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);\r
+\r
+  /* Wait Events */\r
+  while (1) {\r
+    lis2doc_all_sources_t all_source;\r
+    /* Check Wake-Up events */\r
+    lis2doc_all_sources_get(&dev_ctx, &all_source);\r
+\r
+    if (all_source.wake_up_src.wu_ia) {\r
+      sprintf((char *)tx_buffer, "Wake-Up event on ");\r
+\r
+      if (all_source.wake_up_src.x_wu) {\r
+        strcat((char *)tx_buffer, "X");\r
+      }\r
+\r
+      if (all_source.wake_up_src.y_wu) {\r
+        strcat((char *)tx_buffer, "Y");\r
+      }\r
+\r
+      if (all_source.wake_up_src.z_wu) {\r
+        strcat((char *)tx_buffer, "Z");\r
+      }\r
+\r
+      strcat((char *)tx_buffer, " direction\r\n");\r
+      tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
+    }\r
+  }\r
+}\r
+\r
+/*\r
+ * @brief  Write generic device register (platform dependent)\r
+ *\r
+ * @param  handle    customizable argument. In this examples is used in\r
+ *                   order to select the correct sensor bus handler.\r
+ * @param  reg       register to write\r
+ * @param  bufp      pointer to data to write in register reg\r
+ * @param  len       number of consecutive register to write\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+                              uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_I2C_Mem_Write(handle, LIS2DOC_I2C_ADD_H, reg,\r
+                    I2C_MEMADD_SIZE_8BIT, (uint8_t*) bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+  HAL_SPI_Transmit(handle, &reg, 1, 1000);\r
+  HAL_SPI_Transmit(handle, (uint8_t*) bufp, len, 1000);\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+  i2c_lld_write(handle,  LIS2DOC_I2C_ADD_H & 0xFE, reg, (uint8_t*) bufp, len);\r
+#endif\r
+  return 0;\r
+}\r
+\r
+/*\r
+ * @brief  Read generic device register (platform dependent)\r
+ *\r
+ * @param  handle    customizable argument. In this examples is used in\r
+ *                   order to select the correct sensor bus handler.\r
+ * @param  reg       register to read\r
+ * @param  bufp      pointer to buffer that store the data read\r
+ * @param  len       number of consecutive register to read\r
+ *\r
+ */\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+                             uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_I2C_Mem_Read(handle, LIS2DOC_I2C_ADD_H, reg,\r
+                   I2C_MEMADD_SIZE_8BIT, bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  reg |= 0x80;\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+  HAL_SPI_Transmit(handle, &reg, 1, 1000);\r
+  HAL_SPI_Receive(handle, bufp, len, 1000);\r
+  HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+  i2c_lld_read(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, bufp, len);\r
+#endif\r
+  return 0;\r
+}\r
+\r
+/*\r
+ * @brief  Write generic device register (platform dependent)\r
+ *\r
+ * @param  tx_buffer     buffer to transmit\r
+ * @param  len           number of byte to send\r
+ *\r
+ */\r
+static void tx_com(uint8_t *tx_buffer, uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+  HAL_UART_Transmit(&huart2, tx_buffer, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+  CDC_Transmit_FS(tx_buffer, len);\r
+#elif defined(SPC584B_DIS)\r
+  sd_lld_write(&SD2, tx_buffer, len);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief  platform specific delay (platform dependent)\r
+ *\r
+ * @param  ms        delay in ms\r
+ *\r
+ */\r
+static void platform_delay(uint32_t ms)\r
+{\r
+#if defined(NUCLEO_F411RE) | defined(STEVAL_MKI109V3)\r
+  HAL_Delay(ms);\r
+#elif defined(SPC584B_DIS)\r
+  osalThreadDelayMilliseconds(ms);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief  platform specific initialization (platform dependent)\r
+ */\r
+static void platform_init(void)\r
+{\r
+#if defined(STEVAL_MKI109V3)\r
+  TIM3->CCR1 = PWM_3V3;\r
+  TIM3->CCR2 = PWM_3V3;\r
+  HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);\r
+  HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);\r
+  HAL_Delay(1000);\r
+#endif\r
+}\r
old mode 100755 (executable)
new mode 100644 (file)
similarity index 94%
rename from code/sdk/drivers/drivers/driver/lcd/lcd_private.c
rename to code/sdk/drivers/peripheral/lcd/lcd_private.c
index 930d346..a28b693
@@ -56,7 +56,7 @@ static void lcd_drv_power_off(void)
 #endif
 #else
     uapi_gpio_set_val(RESET_LCD_GPIO, GPIO_LEVEL_LOW);
-    uapi_gpio_set_dir(RESET_LCD_GPIO, GPIO_DIRECTION_INPUT);
+    uapi_gpio_set_dir(RESET_LCD_GPIO, GPIO_DIRECTION_INPUT); //设置成Input,是为了解决漏电 ??
 #ifndef QSPI_DISPLAY
     uapi_gpio_set_val(VCI_LCD_GPIO, GPIO_LEVEL_LOW);
     uapi_gpio_set_dir(VCI_LCD_GPIO, GPIO_DIRECTION_INPUT);
diff --git a/code/sdk/drivers/peripheral/mag/CMakeLists.txt b/code/sdk/drivers/peripheral/mag/CMakeLists.txt
new file mode 100644 (file)
index 0000000..ce78370
--- /dev/null
@@ -0,0 +1,64 @@
+#===============================================================================
+# @brief    cmake file
+# Copyright (c) @CompanyNameMagicTag 2023-2023. All rights reserved.
+#===============================================================================
+set(COMPONENT_NAME "mag_sensor")
+
+set(SOURCES
+    ${CMAKE_CURRENT_SOURCE_DIR}/touch_screen_drv.c
+    ${CMAKE_CURRENT_SOURCE_DIR}/touch_screen_queue1.c
+)
+
+if("MAG_MMC5603" IN_LIST DEFINES)
+set(SOURCES ${SOURCES}
+    ${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/Customer.c
+    ${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/main_sample.c
+    ${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/MMC5603.c
+)
+else()
+set(SOURCES ${SOURCES}
+    ${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/Customer.c
+    ${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/main_sample.c
+    ${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/MMC5603.c
+)
+endif()
+
+if("MAG_MMC5603" IN_LIST DEFINES)
+set(PUBLIC_HEADER
+    ${CMAKE_CURRENT_SOURCE_DIR}/mmc5603
+)
+else()
+set(PUBLIC_HEADER
+    {CMAKE_CURRENT_SOURCE_DIR}/mmc5603
+)
+endif()
+
+set(PRIVATE_HEADER
+)
+
+set(PRIVATE_DEFINES
+)
+
+set(PUBLIC_DEFINES
+)
+
+# use this when you want to add ccflags like -include xxx
+set(COMPONENT_PUBLIC_CCFLAGS
+)
+
+set(COMPONENT_CCFLAGS
+    -Wno-incompatible-function-pointer-types
+    -Wno-unused-function
+)
+
+set(WHOLE_LINK
+    true
+)
+
+set(MAIN_COMPONENT
+    false
+)
+
+build_component()
+
+install_sdk(${CMAKE_CURRENT_SOURCE_DIR} "*")
diff --git a/code/sdk/drivers/peripheral/mag/mmc5603/Customer.c b/code/sdk/drivers/peripheral/mag/mmc5603/Customer.c
new file mode 100644 (file)
index 0000000..0540dbd
--- /dev/null
@@ -0,0 +1,76 @@
+#include "Customer.h"\r
+\r
+void Delay_Ms(int cnt)\r
+{\r
+       /*  cnt is the time to wait */\r
+       \r
+       /* \r
+       .\r
+       . Need to be implemented by user. \r
+       .\r
+       */\r
+       \r
+       return;\r
+}\r
+void Delay_Us(int cnt)\r
+{\r
+       /*  cnt is the time to wait */\r
+       \r
+       /* \r
+       .\r
+       . Need to be implemented by user. \r
+       .\r
+       */\r
+       \r
+       return;\r
+}\r
+int I2C_Write_Reg(unsigned char i2c_add, unsigned char reg_add, unsigned char cmd)\r
+{\r
+       /* i2c_add is the 7-bit i2c address of the sensor\r
+        * reg_add is the register address to wtite\r
+        * cmd is the value that need to be written to the register\r
+        * I2C operating successfully, return 1, otherwise return 0;\r
+        */\r
+       \r
+       /* \r
+       .\r
+       . Need to be implemented by user. \r
+       .\r
+       */       \r
+       \r
+       return 1;\r
+}\r
+int I2C_Read_Reg(unsigned char i2c_add, unsigned char reg_add, unsigned char *data)\r
+{\r
+       /* i2c_add is the 7-bit i2c address of the sensor\r
+        * reg_add is the register address to read\r
+        * data is the first address of the buffer that need to store the register value\r
+        * I2C operating successfully, return 1, otherwise return 0;    \r
+        */\r
+               \r
+       /* \r
+       .\r
+       . Need to be implemented by user. \r
+       .\r
+       */      \r
+        \r
+       return 1;\r
+}\r
+int I2C_MultiRead_Reg(unsigned char i2c_add, unsigned char reg_add, int num, unsigned char *data)\r
+{\r
+       /* i2c_add is the 7-bit i2c address of the sensor\r
+        * reg_add is the first register address to read\r
+        * num is the number of the register to read    \r
+        * data is the first address of the buffer that need to store the register value\r
+        * I2C operating successfully, return 1, otherwise return 0;    \r
+        */\r
+       \r
+       /* \r
+       .\r
+       . Need to be implemented by user. \r
+       .\r
+       */\r
+       \r
+       return 1;\r
+}\r
+\r
diff --git a/code/sdk/drivers/peripheral/mag/mmc5603/Customer.h b/code/sdk/drivers/peripheral/mag/mmc5603/Customer.h
new file mode 100644 (file)
index 0000000..a61a346
--- /dev/null
@@ -0,0 +1,25 @@
+\r
+/**\r
+ * @brief Delay function.\r
+ */\r
+void Delay_Ms(int cnt);\r
+\r
+/**\r
+ * @brief Delay function.\r
+ */\r
+void Delay_Us(int cnt);\r
+\r
+/**\r
+ * @brief I2C write register.\r
+ */\r
+int I2C_Write_Reg(unsigned char i2c_add, unsigned char reg_add, unsigned char cmd);\r
+\r
+/**\r
+ * @brief I2C read register.\r
+ */\r
+int I2C_Read_Reg(unsigned char i2c_add, unsigned char reg_add, unsigned char *data);\r
+\r
+/**\r
+ * @brief I2C multi read.\r
+ */\r
+int I2C_MultiRead_Reg(unsigned char i2c_add, unsigned char reg_add, int num, unsigned char *data);\r
diff --git a/code/sdk/drivers/peripheral/mag/mmc5603/MMC5603.c b/code/sdk/drivers/peripheral/mag/mmc5603/MMC5603.c
new file mode 100644 (file)
index 0000000..0ab08c7
--- /dev/null
@@ -0,0 +1,406 @@
+/*****************************************************************************\r
+ *  Copyright Statement:\r
+ *  --------------------\r
+ *  This software is protected by Copyright, and the information and source code\r
+ *  contained herein is confidential. The software including the source code\r
+ *  may not be copied and the information contained herein may not be used or\r
+ *  disclosed except with the written permission of MEMSIC Inc. (C) 2019\r
+ *****************************************************************************/\r
+\r
+ /**\r
+ * @brief\r
+ * This file implement magnetic sensor driver APIs.\r
+ * Modified history: \r
+ * V1.5: Update to 1 step factory selftest on 20190619\r
+ */\r
+\r
+#include "MMC5603.h"\r
+#include "Customer.h"\r
+\r
+#include "math.h"\r
+\r
+/* Indicate working mode of sensor */\r
+static uint8_t sensor_state = 1;\r
+\r
+/* Function declaration */\r
+\r
+/**\r
+ * @brief Factory test mode\r
+ */\r
+int MMC5603_Factory_Test_Mode(void);\r
+\r
+/**\r
+ * @brief SET operation \r
+ */\r
+void MMC5603_SET(void);\r
+\r
+/**\r
+ * @brief RESET operation \r
+ */\r
+void MMC5603_RESET(void);\r
+\r
+/**\r
+ * @brief OTP read done check\r
+ */\r
+int MMC5603_Check_OTP(void);\r
+\r
+/**\r
+ * @brief Check Product ID\r
+ */\r
+int MMC5603_CheckID(void);\r
+\r
+/**\r
+ * @brief Auto self-test registers configuration\r
+ */\r
+void MMC5603_Auto_SelfTest_Configuration(void);\r
+\r
+/**\r
+ * @brief Auto self-test\r
+ */\r
+int MMC5603_Auto_SelfTest(void);\r
+\r
+/*********************************************************************************\r
+* decription: Factory test mode \r
+*********************************************************************************/\r
+int MMC5603_Factory_Test_Mode(void)\r
+{\r
+       int i;\r
+       uint8_t data_reg[6] ={0};\r
+       uint16_t data_set[3] = {0};\r
+       uint16_t data_reset[3] = {0};   \r
+       uint32_t delta_data[3] = {0};\r
+       \r
+       const uint16_t thr_srst_low = 100;                      \r
+       \r
+       /* Write reg 0x1D */\r
+       /* Set Cmm_en bit '0', Disable continuous mode */       \r
+       I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL2, 0x00);\r
+       \r
+       Delay_Ms(20);\r
+       \r
+       /* Write reg 0x1B */\r
+       /* Set Auto_SR_en bit '0', Disable the function of automatic set/reset */\r
+       I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL0, 0x00);        \r
+       \r
+       /* Write reg 0x1C, Set BW<1:0> = 00 */\r
+       I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL1, 0x00);        \r
+                               \r
+       /* Do RESET operation */\r
+       MMC5603_RESET();        \r
+       /* Write 0x01 to register 0x1B, set Take_meas_M bit '1' */\r
+       I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL0, MMC5603_CMD_TMM);     \r
+       /* Delay 10 ms to finish the TM operation */\r
+       Delay_Ms(10);           \r
+       /* Read register data */\r
+       I2C_MultiRead_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_DATA, 6, data_reg);\r
+       /* Get high 16bits data */\r
+       data_reset[0] = (uint16_t)(data_reg[0] << 8 | data_reg[1]);     //X axis\r
+       data_reset[1] = (uint16_t)(data_reg[2] << 8 | data_reg[3]);     //Y axis                \r
+       data_reset[2] = (uint16_t)(data_reg[4] << 8 | data_reg[5]);     //Z axis \r
+       \r
+       /* Do SET operation */\r
+       MMC5603_SET();  \r
+       /* Write 0x01 to register 0x1B, set Take_meas_M bit '1' */\r
+       I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS,MMC5603_REG_CTRL0,MMC5603_CMD_TMM);       \r
+       /* Delay 10 ms to finish the TM operation */\r
+       Delay_Ms(10);           \r
+       /* Read register data */\r
+       I2C_MultiRead_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_DATA, 6, data_reg);\r
+       /* Get high 16bits data */\r
+       data_set[0] = (uint16_t)(data_reg[0] << 8 | data_reg[1]);       //X axis\r
+       data_set[1] = (uint16_t)(data_reg[2] << 8 | data_reg[3]);       //Y axis                \r
+       data_set[2] = (uint16_t)(data_reg[4] << 8 | data_reg[5]);       //Z axis        \r
+       \r
+       for(i=0;i<3;i++)\r
+       {\r
+               if(data_set[i] >= data_reset[i])\r
+                       delta_data[i] = data_set[i] - data_reset[i];\r
+               else\r
+                       delta_data[i] = data_reset[i] - data_set[i];\r
+       }\r
+       \r
+       /* If output < 100lsb, fail*/\r
+       if(delta_data[0]<thr_srst_low && delta_data[1]<thr_srst_low && delta_data[2]<thr_srst_low)\r
+               return -1;      // fail\r
+       \r
+       return 1;       //pass\r
+}\r
+\r
+/*********************************************************************************\r
+* decription: SET operation \r
+*********************************************************************************/\r
+void MMC5603_SET(void)\r
+{      \r
+       /* Write 0x08 to register 0x1B, set SET bit high */\r
+       I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL0, MMC5603_CMD_SET);     \r
+       \r
+       /* Delay to finish the SET operation */\r
+       Delay_Ms(1);\r
+       \r
+       return; \r
+}\r
+\r
+/*********************************************************************************\r
+* decription: RESET operation \r
+*********************************************************************************/\r
+void MMC5603_RESET(void)\r
+{      \r
+       /* Write 0x10 to register 0x1B, set RESET bit high */\r
+       I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL0, MMC5603_CMD_RESET);\r
+       \r
+       /* Delay to finish the RESET operation */\r
+       Delay_Ms(1);\r
+       \r
+       return; \r
+}\r
+\r
+/*********************************************************************************\r
+* decription: Product ID check\r
+*********************************************************************************/\r
+int MMC5603_CheckID(void)\r
+{\r
+       unsigned char pro_id = 0;\r
+       \r
+       /* Read register 0x39, check product ID */\r
+       I2C_Read_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_PRODUCTID1, &pro_id); \r
+       if(pro_id != MMC5603_PRODUCT_ID)\r
+               return -1;\r
+       \r
+       return 1;\r
+}\r
+\r
+/*********************************************************************************\r
+* decription: Auto self-test registers configuration\r
+*********************************************************************************/\r
+void MMC5603_Auto_SelfTest_Configuration(void)\r
+{\r
+       int i;\r
+       uint8_t reg_value[3];\r
+       int16_t st_thr_data[3]={0};\r
+       int16_t st_thr_new[3]={0};\r
+       \r
+       int16_t st_thd[3]={0};\r
+       uint8_t st_thd_reg[3];          \r
+\r
+       /* Read trim data from reg 0x27-0x29 */\r
+       I2C_MultiRead_Reg(MMC5603_7BITI2C_ADDRESS,MMC5603_REG_ST_X_VAL,3,reg_value);    \r
+       for(i=0;i<3;i++)\r
+       {\r
+               st_thr_data[i] = (int16_t)(reg_value[i]-128)*32; \r
+               if(st_thr_data[i]<0)\r
+                       st_thr_data[i] = -st_thr_data[i];\r
+               st_thr_new[i] = st_thr_data[i]-st_thr_data[i]/5;\r
+               \r
+               st_thd[i] = st_thr_new[i]/8;\r
+               if(st_thd[i]>255)\r
+                       st_thd_reg[i] = 0xFF;\r
+               else\r
+                       st_thd_reg[i] = (uint8_t)st_thd[i];\r
+       }\r
+       /* Write threshold into the reg 0x1E-0x20 */\r
+       I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_X_THD, st_thd_reg[0]);\r
+       I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_Y_THD, st_thd_reg[1]);\r
+       I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_Z_THD, st_thd_reg[2]);\r
+       \r
+       return;\r
+}\r
+\r
+/*********************************************************************************\r
+* decription: Auto self-test\r
+*********************************************************************************/\r
+int MMC5603_Auto_SelfTest(void)\r
+{\r
+       uint8_t reg_status = 0;\r
+       \r
+       /* Write 0x40 to register 0x1B, set Auto_st_en bit high */\r
+       I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL0, MMC5603_CMD_AUTO_ST_EN);\r
+       \r
+       /* Delay 15ms to finish the selftest process */\r
+       Delay_Ms(15);\r
+       \r
+       /* Read register 0x18, check Sat_sensor bit */\r
+       I2C_Read_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_STATUS1, &reg_status);        \r
+       if((reg_status&MMC5603_SAT_SENSOR))\r
+       {\r
+               return -1;\r
+       }\r
+       \r
+       return 1;\r
+}\r
+\r
+/*********************************************************************************\r
+* decription: Continuous mode configuration with auto set and reset\r
+*********************************************************************************/\r
+void MMC5603_Continuous_Mode_With_Auto_SR(uint8_t bandwith, uint8_t sampling_rate)\r
+{\r
+       /* Write reg 0x1C, Set BW<1:0> = bandwith */\r
+       I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL1, bandwith);\r
+       \r
+       /* Write reg 0x1A, set ODR<7:0> = sampling_rate */\r
+       I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_ODR, sampling_rate); \r
+       \r
+       /* Write reg 0x1B */\r
+       /* Set Auto_SR_en bit '1', Enable the function of automatic set/reset */\r
+       /* Set Cmm_freq_en bit '1', Start the calculation of the measurement period according to the ODR*/      \r
+       I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL0, MMC5603_CMD_CMM_FREQ_EN|MMC5603_CMD_AUTO_SR_EN);\r
+\r
+       /* Write reg 0x1D */\r
+       /* Set Cmm_en bit '1', Enter continuous mode */ \r
+       I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL2, MMC5603_CMD_CMM_EN);  \r
+       \r
+       return;\r
+}\r
+\r
+/*********************************************************************************\r
+* decription: Do selftest operation periodically\r
+*********************************************************************************/\r
+int MMC5603_Saturation_Checking(void)\r
+{      \r
+       int ret = 0; //1 pass, -1 fail, 0 elapsed time is less 5 seconds\r
+\r
+       /* If sampling rate is 50Hz, then do saturation checking every 250 loops, i.e. 5 seconds */\r
+       static int NumOfSamples = 250;\r
+       static int cnt = 0;\r
+\r
+       if((cnt++)>=NumOfSamples)\r
+       {\r
+               cnt = 0;\r
+               ret = MMC5603_Auto_SelfTest();\r
+               if(ret == -1)           \r
+               {\r
+                       /* Sensor is saturated, need to do SET operation */\r
+                       MMC5603_SET();          \r
+               }\r
+               \r
+               /* Do TM_M after selftest operation */\r
+               I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS,MMC5603_REG_CTRL0,MMC5603_CMD_TMM);       \r
+               Delay_Ms(8);\r
+       }\r
+\r
+       return ret;\r
+}\r
+\r
+/*********************************************************************************\r
+* decription: Auto switch the working mode between Auto_SR and SETonly\r
+*********************************************************************************/\r
+void MMC5603_Auto_Switch(uint16_t *mag)\r
+{\r
+       float mag_out[3];       \r
+       \r
+       mag_out[0] = ((float)mag[0] - MMC5603_16BIT_OFFSET)/MMC5603_16BIT_SENSITIVITY;\r
+       mag_out[1] = ((float)mag[1] - MMC5603_16BIT_OFFSET)/MMC5603_16BIT_SENSITIVITY;\r
+       mag_out[2] = ((float)mag[2] - MMC5603_16BIT_OFFSET)/MMC5603_16BIT_SENSITIVITY;\r
+       \r
+       if(sensor_state == 1)\r
+       {\r
+               /* If X or Y axis output exceed 10 Gauss, then switch to single mode */\r
+               if((fabs(mag_out[0])>10.0f) || (fabs(mag_out[1])>10.0f))\r
+               {       \r
+                       sensor_state = 2;\r
+                       \r
+                       /* Disable continuous mode */   \r
+                       I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL2, 0x00);\r
+                       Delay_Ms(15);//Delay 15ms to finish the last sampling\r
+                       \r
+                       /* Do SET operation */\r
+                       I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL0, MMC5603_CMD_SET);     \r
+                       Delay_Ms(1);//Delay 1ms to finish the SET operation\r
+                       \r
+                       /* Do TM_M before next data reading */\r
+                       I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS,MMC5603_REG_CTRL0,MMC5603_CMD_TMM);       \r
+                       Delay_Ms(8);//Delay 8ms to finish the TM_M operation                    \r
+               }       \r
+       }\r
+       else if(sensor_state == 2)\r
+       {\r
+               /* If both of X and Y axis output less than 8 Gauss, then switch to continuous mode with Auto_SR */\r
+               if((fabs(mag_out[0])<8.0f) && (fabs(mag_out[1])<8.0f))\r
+               {       \r
+                       sensor_state = 1;\r
+                       \r
+                       /* Enable continuous mode with Auto_SR */\r
+                       I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL0, MMC5603_CMD_CMM_FREQ_EN|MMC5603_CMD_AUTO_SR_EN);\r
+                       I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL2, MMC5603_CMD_CMM_EN);\r
+               }\r
+               else\r
+               {       \r
+                       /* Sensor checking */\r
+                       if(MMC5603_Saturation_Checking()==0)\r
+                       {                       \r
+                               /* Do TM_M before next data reading */\r
+                               I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS,MMC5603_REG_CTRL0,MMC5603_CMD_TMM);       \r
+                       }\r
+               }               \r
+       }\r
+       \r
+       return; \r
+}\r
+\r
+/*********************************************************************************\r
+* decription: Disable sensor continuous mode\r
+*********************************************************************************/\r
+void MMC5603_Disable(void)\r
+{\r
+       /* Write reg 0x1D */\r
+       /* Set Cmm_en bit '0', Disable continuous mode */       \r
+       I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL2, 0x00);\r
+       \r
+       Delay_Ms(20);\r
+       \r
+       return;\r
+}\r
+\r
+/*********************************************************************************\r
+* decription: Enable sensor\r
+*********************************************************************************/\r
+void MMC5603_Enable(void)\r
+{      \r
+       int ret = 0;\r
+       \r
+       /* Inite the sensor state */\r
+       sensor_state = 1;\r
+       \r
+       /* Check product ID */\r
+       ret = MMC5603_CheckID();\r
+       if(ret<0)\r
+               return; \r
+       \r
+       /* Auto self-test registers configuration */\r
+       MMC5603_Auto_SelfTest_Configuration();\r
+               \r
+       /* Do SET operation */\r
+       MMC5603_SET();          \r
+\r
+       /* Work mode setting */\r
+       MMC5603_Continuous_Mode_With_Auto_SR(MMC5603_CMD_BW00, 50);\r
+       \r
+       Delay_Ms(20);\r
+       \r
+       return;\r
+}\r
+\r
+/*********************************************************************************\r
+* decription: Read the data register and convert to magnetic field \r
+*********************************************************************************/\r
+void MMC5603_GetData(float *mag_out)\r
+{\r
+       uint8_t data_reg[6] ={0};\r
+       uint16_t data_temp[3] = {0};\r
+                       \r
+       /* Read register data */\r
+       I2C_MultiRead_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_DATA, 6, data_reg);\r
+       \r
+       /* Get high 16bits data */\r
+       data_temp[0] = (uint16_t)(data_reg[0] << 8 | data_reg[1]);      \r
+       data_temp[1] = (uint16_t)(data_reg[2] << 8 | data_reg[3]);                      \r
+       data_temp[2] = (uint16_t)(data_reg[4] << 8 | data_reg[5]); \r
+\r
+       /* Transform to unit Gauss */\r
+       mag_out[0] = ((float)data_temp[0] - MMC5603_16BIT_OFFSET)/MMC5603_16BIT_SENSITIVITY; \r
+       mag_out[1] = ((float)data_temp[1] - MMC5603_16BIT_OFFSET)/MMC5603_16BIT_SENSITIVITY;\r
+       mag_out[2] = ((float)data_temp[2] - MMC5603_16BIT_OFFSET)/MMC5603_16BIT_SENSITIVITY;\r
+\r
+       MMC5603_Auto_Switch(data_temp); \r
+                       \r
+       return;\r
+}\r
diff --git a/code/sdk/drivers/peripheral/mag/mmc5603/MMC5603.h b/code/sdk/drivers/peripheral/mag/mmc5603/MMC5603.h
new file mode 100644 (file)
index 0000000..e5a1691
--- /dev/null
@@ -0,0 +1,123 @@
+/*****************************************************************************\r
+ *  Copyright Statement:\r
+ *  --------------------\r
+ *  This software is protected by Copyright and the information and source code\r
+ *  contained herein is confidential. The software including the source code\r
+ *  may not be copied and the information contained herein may not be used or\r
+ *  disclosed except with the written permission of MEMSIC Inc. (C) 2019\r
+ *****************************************************************************/\r
+\r
+ /**\r
+ * @brief\r
+ * This file implement magnetic sensor driver APIs.\r
+ * Modified history: \r
+ * V1.5: Update to 1 step factory selftest on 20190619\r
+ */\r
+ \r
+#ifndef _MMC5603_H\r
+#define _MMC5603_H \r
+\r
+typedef   signed char  int8_t;                 // signed 8-bit number    (-128 to +127)\r
+typedef unsigned char  uint8_t;        // unsigned 8-bit number  (+0 to +255)\r
+typedef   signed short int16_t;        // signed 16-bt number    (-32768 to +32767)\r
+typedef unsigned short uint16_t;       // unsigned 16-bit number (+0 to +65535)\r
+typedef   signed int   int32_t;        // signed 32-bt number    (-2,147,483,648 to +2,147,483,647)\r
+typedef unsigned int   uint32_t;       // unsigned 32-bit number (+0 to +4,294,967,295)\r
+\r
+#define MMC5603_7BITI2C_ADDRESS                0x30\r
+\r
+#define MMC5603_REG_DATA                       0x00\r
+\r
+#define MMC5603_REG_STATUS1                    0x18\r
+#define MMC5603_REG_STATUS0                    0x19\r
+\r
+#define MMC5603_REG_ODR                                0x1A\r
+#define MMC5603_REG_CTRL0                      0x1B\r
+#define MMC5603_REG_CTRL1                      0x1C\r
+#define MMC5603_REG_CTRL2                      0x1D\r
+\r
+#define MMC5603_REG_X_THD                      0x1E\r
+#define MMC5603_REG_Y_THD                      0x1F\r
+#define MMC5603_REG_Z_THD                      0x20\r
+\r
+#define MMC5603_REG_ST_X_VAL           0x27\r
+#define MMC5603_REG_ST_Y_VAL           0x28\r
+#define MMC5603_REG_ST_Z_VAL           0x29\r
+\r
+#define MMC5603_REG_PRODUCTID1         0x39\r
+\r
+/* Bit definition for control register ODR 0x1A */\r
+#define MMC5603_CMD_ODR_1HZ                    0x01\r
+#define MMC5603_CMD_ODR_5HZ                    0x05\r
+#define MMC5603_CMD_ODR_10HZ           0x0A\r
+#define MMC5603_CMD_ODR_50HZ           0x32\r
+#define MMC5603_CMD_ODR_100HZ          0x64\r
+#define MMC5603_CMD_ODR_200HZ          0xC8\r
+#define MMC5603_CMD_ODR_255HZ          0xFF\r
+\r
+/* Bit definition for control register 0 0x1B */\r
+#define MMC5603_CMD_TMM                                0x01\r
+#define MMC5603_CMD_TMT                0x02\r
+#define MMC5603_CMD_START_MDT          0x04\r
+#define MMC5603_CMD_SET                                0x08\r
+#define MMC5603_CMD_RESET                      0x10\r
+#define MMC5603_CMD_AUTO_SR_EN         0x20\r
+#define MMC5603_CMD_AUTO_ST_EN         0x40\r
+#define MMC5603_CMD_CMM_FREQ_EN                0x80\r
+\r
+/* Bit definition for control register 1 0x1C */\r
+#define MMC5603_CMD_BW00                       0x00\r
+#define MMC5603_CMD_BW01                       0x01\r
+#define MMC5603_CMD_BW10                       0x02\r
+#define MMC5603_CMD_BW11                       0x03\r
+#define MMC5603_CMD_ST_ENP                     0x20\r
+#define MMC5603_CMD_ST_ENM                     0x40\r
+#define MMC5603_CMD_SW_RST                     0x80\r
+\r
+/* Bit definition for control register 2 0x1D */\r
+#define MMC5603_CMD_PART_SET1          0x00\r
+#define MMC5603_CMD_PART_SET25         0x01\r
+#define MMC5603_CMD_PART_SET75         0x02\r
+#define MMC5603_CMD_PART_SET100                0x03\r
+#define MMC5603_CMD_PART_SET250                0x04\r
+#define MMC5603_CMD_PART_SET500                0x05\r
+#define MMC5603_CMD_PART_SET1000       0x06\r
+#define MMC5603_CMD_PART_SET2000       0x07\r
+#define MMC5603_CMD_EN_PART_SET                0x08\r
+#define MMC5603_CMD_CMM_EN                     0x10\r
+#define MMC5603_CMD_INT_MDT_EN         0x20\r
+#define MMC5603_CMD_INT_MD_EN          0x40\r
+#define MMC5603_CMD_HPOWER                     0x80\r
+\r
+#define MMC5603_PRODUCT_ID                     0x10\r
+#define MMC5603_MM_DONE_INT                    0x01\r
+#define MMC5603_MT_DONE_INT                    0x02\r
+#define MMC5603_MDT_FLAG_INT           0x04\r
+#define MMC5603_ST_FAIL_INT                    0x08\r
+#define MMC5603_OTP_READ_DONE          0x10\r
+#define MMC5603_SAT_SENSOR                     0x20\r
+#define MMC5603_MM_DONE                                0x40\r
+#define MMC5603_MT_DONE                                0x80\r
+\r
+// 16-bit mode, null field output (32768)\r
+#define        MMC5603_16BIT_OFFSET            32768\r
+#define        MMC5603_16BIT_SENSITIVITY       1024\r
+\r
+/**\r
+ * @brief Enable the sensor\r
+ */\r
+void MMC5603_Enable(void);\r
+\r
+/**\r
+ * @brief Disable the sensor\r
+ */\r
+void MMC5603_Disable(void);\r
+\r
+/**\r
+ * @brief Get sensor data\r
+ * @param mag_out is the magnetic field vector, unit is gauss\r
+ */\r
+void MMC5603_GetData(float *mag_out);\r
+\r
+#endif\r
+\r
diff --git a/code/sdk/drivers/peripheral/mag/mmc5603/main_sample.c b/code/sdk/drivers/peripheral/mag/mmc5603/main_sample.c
new file mode 100644 (file)
index 0000000..2680f68
--- /dev/null
@@ -0,0 +1,28 @@
+#include "Customer.h"\r
+#include "MMC5603.h" \r
+\r
+float magnetic_field_x;\r
+float magnetic_field_y;\r
+float magnetic_field_z;\r
+\r
+int main(void)\r
+{\r
+       /* Magnetic field vector, unit is gauss */\r
+       float mag_raw_data[3] = {0.0};  \r
+       \r
+       /* Enable the sensor. */\r
+       MMC5603_Enable();       \r
+       \r
+       while(1)\r
+       {               \r
+               /* Get the MMC5603 data, unit is gauss */\r
+               MMC5603_GetData(mag_raw_data);  \r
+\r
+               magnetic_field_x = mag_raw_data[0];     //unit is gauss\r
+               magnetic_field_y = mag_raw_data[1];     //unit is gauss\r
+               magnetic_field_z = mag_raw_data[2];     //unit is gauss\r
+               \r
+               /* Sampling interval is 20ms, and the sampling rate is 50Hz. */\r
+               Delay_Ms(20);\r
+       }\r
+}\r
diff --git a/code/sdk/drivers/peripheral/ppg/CMakeLists.txt b/code/sdk/drivers/peripheral/ppg/CMakeLists.txt
new file mode 100644 (file)
index 0000000..f0d8850
--- /dev/null
@@ -0,0 +1,39 @@
+#===============================================================================
+# @brief    cmake file
+# Copyright (c) @CompanyNameMagicTag 2022-2023. All rights reserved.
+#===============================================================================
+set(COMPONENT_NAME "ppg_sensor")
+
+set(SOURCES
+    ${CMAKE_CURRENT_SOURCE_DIR}/button.c
+)
+
+set(PUBLIC_HEADER
+    ${CMAKE_CURRENT_SOURCE_DIR}
+)
+
+set(PRIVATE_HEADER
+)
+
+set(PRIVATE_DEFINES
+)
+
+set(PUBLIC_DEFINES
+)
+
+# use this when you want to add ccflags like -include xxx
+set(COMPONENT_PUBLIC_CCFLAGS
+)
+
+set(COMPONENT_CCFLAGS
+)
+
+set(WHOLE_LINK
+    true
+)
+
+set(MAIN_COMPONENT
+    false
+)
+
+build_component()
diff --git a/code/sdk/drivers/peripheral/ppg/hx3695/Gcc_HaiSiLib_hx3695_Hrs_Spo2_hrv_20231215_v0.1.a b/code/sdk/drivers/peripheral/ppg/hx3695/Gcc_HaiSiLib_hx3695_Hrs_Spo2_hrv_20231215_v0.1.a
new file mode 100644 (file)
index 0000000..4ef4b51
Binary files /dev/null and b/code/sdk/drivers/peripheral/ppg/hx3695/Gcc_HaiSiLib_hx3695_Hrs_Spo2_hrv_20231215_v0.1.a differ
diff --git a/code/sdk/drivers/peripheral/ppg/hx3695/hx3695.c b/code/sdk/drivers/peripheral/ppg/hx3695/hx3695.c
new file mode 100644 (file)
index 0000000..75b6706
--- /dev/null
@@ -0,0 +1,2991 @@
+#include <stdio.h>\r
+#include <stdbool.h>\r
+#include <stdint.h>\r
+#include <stdlib.h>\r
+#include <math.h>\r
+\r
+#include "tyhx_hrs_custom.h"\r
+#include "tyhx_mems.h"\r
+\r
+#ifdef CHIP_HX3695\r
+#include "hx3695.h"\r
+#ifdef HRS_ALG_LIB\r
+#include "hx3695_hrs_agc.h"\r
+#include "tyhx_hrs_alg.h"\r
+#endif\r
+#ifdef SPO2_ALG_LIB\r
+#include "hx3695_spo2_agc.h"\r
+#include "tyhx_spo2_alg.h"\r
+#endif\r
+#ifdef HRV_ALG_LIB\r
+#include "hx3695_hrv_agc.h"\r
+#include "tyhx_hrv_alg.h"\r
+#endif\r
+#ifdef CHECK_TOUCH_LIB\r
+#include "hx3695_check_touch.h"\r
+#endif\r
+#include "hx3695_factory_test.h"\r
+\r
+\r
+\r
+#ifdef SPO2_VECTOR\r
+#include "spo2_vec.h"\r
+uint32_t spo2_send_cnt = 0;\r
+uint32_t spo2_send_cnt1 = 0;\r
+int32_t red_buf_vec[8];\r
+int32_t ir_buf_vec[8];\r
+int32_t green_buf_vec[8];\r
+#endif\r
+\r
+#ifdef HR_VECTOR\r
+#include "hr_vec.h"\r
+uint32_t vec_send_cnt = 0;\r
+int32_t PPG_buf_vec[8];\r
+#endif\r
+\r
+#ifdef HRV_TESTVEC\r
+#include "hrv_testvec.h"\r
+#endif\r
+\r
+int32_t s_buf[256];\r
+uint32_t cnt_num = 0;\r
+uint32_t  phase3_rdy_num = 0;\r
+uint8_t fifo_data_buf[768];\r
+uint8_t hrs_phase_num= 3;\r
+uint8_t spo2_phase_num= 4;\r
+uint8_t hrv_phase_num = 4;\r
+extern uint8_t data_count;\r
+\r
+//spo2 agc\r
+const uint8_t  hx3695_spo2_agc_red_idac = RED_AGC_OFFSET;\r
+const uint8_t  hx3695_spo2_agc_ir_idac = IR_AGC_OFFSET;\r
+const uint8_t  hx3695_spo2_agc_ir_idac1 = IR_AGC_OFFSET;\r
+const uint8_t  hx3695_spo2_agc_ir_idac2 = IR_AGC_OFFSET;\r
+const uint8_t  hx3695_spo2_agc_green_idac = GREEN_AGC_OFFSET;\r
+//hrs agc\r
+const uint8_t  hx3695_hrs_agc_idac = HR_GREEN_AGC_OFFSET;\r
+const uint8_t  hx3695_hrs_g1_agc_idac = HR_GREEN1_AGC_OFFSET;\r
+const uint8_t  hx3695_hrs_g2_agc_idac = HR_GREEN2_AGC_OFFSET;                     \r
+const uint8_t  hx3695_hrs_g3_agc_idac = HR_GREEN3_AGC_OFFSET;\r
+//hrv agc\r
+const uint8_t  hx3695_hrv_agc_idac = HR_GREEN_AGC_OFFSET;\r
+\r
+const uint8_t  green_led_max_init = 128;\r
+const uint8_t  red_led_max_init = 255;\r
+const uint8_t  ir_led_max_init = 128;\r
+\r
+uint8_t low_vbat_flag =0;\r
+WORK_MODE_T work_mode_flag = HRS_MODE;\r
+const uint16_t static_thre_val = 150;\r
+const uint8_t gsen_lv_val = 0;\r
+uint8_t read_fifo_first_flg = 0;\r
+\r
+//HRS_INFRARED_THRES\r
+const int32_t  hrs_ir_unwear_thres = 20000;\r
+const int32_t  hrs_ir_wear_thres = 10000;\r
+//HRV_INFRARED_THRES\r
+const int32_t  hrv_ir_unwear_thres = 10000;      //demo143b  25000\r
+const int32_t  hrv_ir_wear_thres = 20000;\r
+//SPO2_INFRARED_THRES\r
+const int32_t  spo2_ir_unwear_thres = 8000;     //demo143b  25000   30000\r
+const int32_t  spo2_ir_wear_thres = 10000;\r
+const uint8_t  spo2_ir_wear_offset = 15;\r
+//CHECK_WEAR_MODE_THRES\r
+const int32_t  check_mode_unwear_thre = 20000;\r
+const int32_t  check_mode_wear_thre = 30000;\r
+\r
+uint8_t alg_ram[11 * 1024] __attribute__((aligned(4)));\r
+//uint8_t alg_ram[10] = {0};\r
+ppg_sensor_data_t ppg_s_data;\r
+\r
+\r
+//////// spo2 para and switches\r
+const  uint8_t   COUNT_BLOCK_NUM = 25;            //delay the block of some single good signal after a series of bad signal\r
+const  uint8_t   SPO2_LOW_XCORR_THRE = 30;        //(64*xcorr)'s square below this threshold, means error signal\r
+const  uint8_t   SPO2_CALI = 1;                       //spo2_result cali mode\r
+const  uint8_t   XCORR_MODE = 1;                  //xcorr mode switch\r
+const  uint8_t   QUICK_RESULT = 1;                //come out the spo2 result quickly ;0 is normal,1 is quick\r
+const  uint16_t  MEAN_NUM = 32;                  //the length of smooth-average ;the value of MEAN_NUM can be given only 256 and 512\r
+const  uint8_t   G_SENSOR = 0;                      //if =1, open the gsensor mode\r
+const  uint8_t   SPO2_GSEN_POW_THRE = 150;         //gsen pow judge move, range:0-200;\r
+const  uint32_t  SPO2_BASE_LINE_INIT = 135500;    //spo2 baseline init, = 103000 + ratio(a variable quantity,depends on different cases)*SPO2_SLOPE\r
+const  int32_t   SOP2_DEGLITCH_THRE = 100000;     //remove signal glitch over this threshold\r
+const  int32_t   SPO2_REMOVE_JUMP_THRE = 50000;  //remove signal jump over this threshold\r
+const  uint32_t  SPO2_SLOPE = 50000;              //increase this slope, spo2 reduce more\r
+const  uint16_t  SPO2_LOW_CLIP_END_TIME = 1500;   //low clip mode before this data_cnt, normal clip mode after this\r
+const  uint16_t  SPO2_LOW_CLIP_DN  = 150;         //spo2 reduce 0.15/s at most in low clip mode\r
+const  uint16_t  SPO2_NORMAL_CLIP_DN  = 500;      //spo2 reduce 0.5/s at most in normal clip mode\r
+const  uint8_t   SPO2_LOW_SNR_THRE = 40;          //snr below this threshold, means error signal\r
+const  uint16_t  IR_AC_TOUCH_THRE = 200;          //AC_min*0.3\r
+const  uint16_t  IR_FFT_POW_THRE = 500;           //fft_pow_min\r
+const  uint8_t   SLOPE_PARA_MAX = 28;\r
+const  uint8_t   SLOPE_PARA_MIN = 3;\r
+\r
+#ifdef SPO2_DATA_CALI\r
+static int32_t red_data_fifo[4] = {0};\r
+static int32_t ir_data_fifo[4] = {0};\r
+static int32_t red_dc_temp = 0;\r
+static int32_t ir_dc_temp = 0;\r
+static int32_t red_data_pre = 0;\r
+static int32_t ir_data_pre = 0;\r
+static int32_t red_jump_delta = 0;\r
+static int32_t ir_jump_delta = 0;\r
+static int32_t cali_data_cnt = 0;\r
+#endif\r
+\r
+// us ÑÓʱº¯Êý£¬ ¿Í»§ÐèÌîд\r
+void hx3695_delay_us(uint32_t us)\r
+{\r
+    tyhx_delay_us(us);\r
+}\r
+\r
+\r
+void hx3695_delay_ms(uint32_t ms)\r
+{\r
+    tyhx_delay_ms(ms);\r
+}\r
+\r
+// i2c Ð´º¯Êý£¬ ¿Í»§ÐèÌîд, µØÖ·0x44(7bit)\r
+bool hx3695_write_reg(uint8_t addr, uint8_t data)\r
+{\r
+\r
+    tyhx_write_reg(I2C_DEV_8ADDR,addr,data);\r
+    return true;\r
+}\r
+\r
+// i2c ¶Áº¯Êý£¬ ¿Í»§ÐèÌîд\r
+uint8_t hx3695_read_reg(uint8_t addr)\r
+{\r
+    uint8_t data_buf = 0;\r
+\r
+    tyhx_read_regs(I2C_DEV_8ADDR,addr,&data_buf,1);\r
+    return data_buf;\r
+}\r
+\r
+// i2c Á¬¶Áº¯Êý£¬ ¿Í»§ÐèÌîд\r
+bool hx3695_brust_read_reg(uint8_t addr, uint8_t *buf, uint8_t length)\r
+{\r
+    //TYHX_LOG("brust read\r\n");\r
+    tyhx_read_regs(I2C_DEV_8ADDR,addr,buf,length);\r
+    return true;\r
+}\r
+\r
+\r
+\r
+uint32_t hx3695_timers_start(void)\r
+{\r
+    tyhx_timer_start(TYHX_TIMER_320MS);\r
+    return 0;\r
+}\r
+uint32_t hx3695_timers_stop(void)\r
+{\r
+    tyhx_timer_stop(TYHX_TIMER_320MS);\r
+    return 0;\r
+}\r
+\r
+uint32_t gsen_read_timers_start(void)\r
+{\r
+    tyhx_timer_start(TYHX_TIMER_40MS);\r
+    return 0;\r
+}\r
+uint32_t gsen_read_timers_stop(void)\r
+{\r
+    tyhx_timer_stop(TYHX_TIMER_40MS);\r
+    return 0;\r
+}\r
+\r
+\r
+/* Íê³É¶ÁÈ¡PPGÊý¾Ý¶¨Ê±Æ÷½Ó¿Ú£¬ Ñ­»·µ÷Ó㬠ĬÈÏ320ms\r
+void heart_rate_meas_timeout_handler(void * p_context)\r
+*/\r
+void hx3695_320ms_timer_cfg(bool en)\r
+{\r
+    if(en)\r
+    {\r
+        hx3695_timers_start();\r
+    }\r
+    else\r
+    {\r
+        hx3695_timers_stop();\r
+    }\r
+\r
+}\r
+\r
+void hx3695_40ms_timer_cfg(bool en)\r
+{\r
+    if(en)\r
+    {\r
+        gsen_read_timers_start();\r
+    }\r
+    else\r
+    {\r
+        gsen_read_timers_stop();\r
+    }\r
+}\r
+\r
+#if defined(INT_MODE)\r
+/* Èç²ÉÓÃÖжÏģʽ£¬ ÈçÍê³ÉÖжϿªÆôºÍ¹Ø±Õ½Ó¿Ú\r
+void hx3695_ppg_Int_handle(void)\r
+*/\r
+void hx3695_gpioint_cfg(bool en)\r
+{\r
+    if(en)\r
+    {\r
+        hx3695_gpioint_enable();\r
+    }\r
+    else\r
+    {\r
+        hx3695_gpioint_disable();\r
+    }\r
+}\r
+#endif\r
+\r
+bool hx3695_chip_check(void)\r
+{\r
+    uint8_t i = 0;\r
+    uint8_t chip_id = 0;\r
+    for(i=0; i<10; i++)\r
+    {\r
+//        hx3695_write_reg(0x02, 0x00);\r
+//        hx3695_delay_ms(5);\r
+        chip_id = hx3695_read_reg(0x00);\r
+\r
+        if (chip_id == 0x65)\r
+        {\r
+            TYHX_LOG(" %x, hx3695_chip_check ok\r\n",chip_id);\r
+            return true;\r
+        }\r
+    }\r
+    TYHX_LOG(" %x, hx3695_chip_check fail!\r\n",chip_id);\r
+    return false;\r
+}\r
+\r
+uint8_t hx3695_read_fifo_size(void)\r
+{\r
+          uint8_t  data_len_h,data_len_l;\r
+          uint16_t fifo_data_length;\r
+               data_len_h = hx3695_read_reg(0x21);\r
+               data_len_l = hx3695_read_reg(0x20);\r
+               fifo_data_length = (((data_len_h&0x01)<<8)|data_len_l);\r
+\r
+    return fifo_data_length;\r
+}\r
+\r
+\r
+uint16_t hx3695_read_fifo_data(int32_t *buf, uint8_t phase_num, uint8_t sig)\r
+{\r
+    uint8_t data_flg_start = 0;\r
+               uint8_t data_flg_end = 0;\r
+//    int32_t data;\r
+    uint8_t databuf[3];\r
+    uint32_t ii=0;\r
+               uint16_t data_len_h = 0;\r
+               uint16_t data_len_l = 0;\r
+               uint16_t fifo_data_length = 0;\r
+               uint16_t fifo_read_length = 0;\r
+               uint16_t fifo_read_bytes = 0;\r
+               uint16_t fifo_out_length = 0;\r
+               uint16_t fifo_out_count = 0;\r
+               \r
+               data_len_h = hx3695_read_reg(0x21);\r
+               data_len_l = hx3695_read_reg(0x20);\r
+               fifo_data_length = (((data_len_h&0x01)<<8)|data_len_l);\r
+//       SEGGER_RTT_printf(0,"fifo_data_length =  %d\r\n", fifo_data_length);  \r
+               if(fifo_data_length<2*phase_num)\r
+               {\r
+                       return 0;\r
+               }\r
+               fifo_read_length = ((fifo_data_length-phase_num)/phase_num)*phase_num;\r
+//             SEGGER_RTT_printf(0,"fifo_data_length_change =  %d\r\n", fifo_read_length);\r
+               fifo_read_bytes = fifo_read_length*3;\r
+               if(read_fifo_first_flg == 1)\r
+               {\r
+                       hx3695_brust_read_reg(0x22, databuf, 3);        \r
+                       read_fifo_first_flg = 0;\r
+               }       \r
+               hx3695_brust_read_reg(0x22, fifo_data_buf, fifo_read_bytes);    \r
+//                                                     for(ii=0; ii<fifo_read_bytes; ii++)\r
+//                                                     {\r
+//                                                             SEGGER_RTT_printf(0,"%d/%d, %d\r\n", ii+1,fifo_read_bytes,fifo_data_buf[ii]);                           \r
+//                                                     }\r
+               for(ii=0; ii<fifo_read_length; ii++)\r
+               {\r
+                       if(sig==0)\r
+                       {\r
+                               buf[ii] = (int32_t)(fifo_data_buf[ii*3]|(fifo_data_buf[ii*3+1]<<8)|((fifo_data_buf[ii*3+2]&0x1f)<<16));\r
+                       }\r
+                       else\r
+                       {\r
+                               if((fifo_data_buf[ii*3+2]&0x10)!=0)\r
+                               {\r
+                                       buf[ii] = (int32_t)(fifo_data_buf[ii*3]|(fifo_data_buf[ii*3+1]<<8)|((fifo_data_buf[ii*3+2]&0x0f)<<16))-1048576;\r
+                               }\r
+                               else\r
+                               {\r
+                                       buf[ii] = (int32_t)(fifo_data_buf[ii*3]|(fifo_data_buf[ii*3+1]<<8)|((fifo_data_buf[ii*3+2]&0x1f)<<16));\r
+                               }\r
+                       }\r
+                       SEGGER_RTT_printf(0,"fifo_length =  %d/%d, %d %d\r\n", ii+1,fifo_read_length,buf[ii],fifo_data_buf[ii*3+2]>>5);                         \r
+               }\r
+               data_flg_start = fifo_data_buf[2]>>5;\r
+               data_flg_end = fifo_data_buf[fifo_read_bytes-1]>>5;\r
+               fifo_out_length = fifo_read_length;\r
+               if(data_flg_start>0)\r
+               {\r
+                       fifo_out_length = fifo_read_length-phase_num + data_flg_start;\r
+                       for(ii=0; ii<fifo_out_length; ii++)\r
+                       {\r
+                               buf[ii] = buf[ii+ phase_num - data_flg_start];\r
+                       }\r
+                       for(ii= fifo_out_length; ii< fifo_read_length; ii++)\r
+                       {\r
+                               buf[ii] = 0;\r
+                       }\r
+               }\r
+               if(data_flg_end < phase_num -1)\r
+               {\r
+                       for(ii=fifo_out_length; ii<fifo_out_length+phase_num-data_flg_end-1; ii++)\r
+                       hx3695_brust_read_reg(0x22, databuf, 3);\r
+                       buf[ii] = (int32_t)(databuf[0]|(databuf[1]<<8)|((databuf[2]&0x1f)<<16)); \r
+               }   \r
+               for(ii=0; ii<fifo_out_length; ii++)\r
+               {\r
+//                     SEGGER_RTT_printf(0,"fifo_buf  %d/%d, %d\r\n", ii+1,fifo_out_length,buf[ii]);                           \r
+               }\r
+               fifo_out_length = fifo_out_length+phase_num-data_flg_end - 1;\r
+               fifo_out_count = fifo_out_length/phase_num;\r
+               return fifo_out_count;\r
+}\r
+\r
+void hx3695_vin_check(uint16_t led_vin)\r
+{\r
+    low_vbat_flag = 0;\r
+    if(led_vin < 3700)\r
+    {\r
+        low_vbat_flag = 1;\r
+    }\r
+}\r
+\r
+void hx3695_ppg_off(void)\r
+{\r
+\r
+    hx3695_delay_ms(5);\r
+    hx3695_write_reg(0x5c, 0x02);\r
+}\r
+\r
+void hx3695_ppg_on(void)\r
+{\r
+    hx3695_write_reg(0x5c, 0x00);\r
+    hx3695_delay_ms(5);\r
+}\r
+\r
+void hx3695_data_reset(void)\r
+{\r
+#if defined(TIMMER_MODE)\r
+    hx3695_320ms_timer_cfg(false);\r
+    hx3695_40ms_timer_cfg(false);\r
+#elif defined(INT_MODE)\r
+    hx3695_gpioint_cfg(false);\r
+#endif\r
+#if defined(HRS_ALG_LIB)\r
+    hx3695_hrs_data_reset();\r
+#endif\r
+#if defined(SPO2_ALG_LIB)\r
+    hx3695_spo2_data_reset();\r
+#endif\r
+#if defined(HRV_ALG_LIB)\r
+    hx3695_hrv_data_reset();\r
+#endif\r
+    AGC_LOG("hx3695 data reset!\r\n");\r
+}\r
+\r
+#ifdef HRS_ALG_LIB\r
+// ÐÄÂÊģʽÏÂppg ³õʼ»¯ÅäÖÃ\r
+void hx3695_hrs_ppg_init(void) // ppg fs=25hz, phase conversion ready interupt en\r
+{\r
+    uint16_t sample_rate = 25;                  /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+    uint32_t prf_clk_num = 32000/sample_rate;   /*period in clk num, num = Fclk/fs */\r
+         \r
+//       uint16_t fifo_watermark= 81 ;\r
+    uint8_t adc_rst_post_num=0;       /* 00=16,01=32,10=64,11=128*/      \r
+         uint8_t samp_delay_leden_num = 0; /* 00=8,01=16,10=32,11=64*/ \r
+    uint8_t samp_copy_avg = 0;        /* 0=1, 1=2, 2=4 ,3=8, 4=16*/\r
+    uint8_t data_avg_num = 0;         /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+         uint8_t phase7_8_internal = 0;    /* phase7 and phase8 prf internal cfg */\r
+               \r
+    uint8_t phase1_enable = 1;     /*phase1_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase2_enable = 1;     /*phase2_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase3_enable = 1;     /*phase3_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase4_enable = 1;     /*phase4_enable  , 1 mean enable ; 0 mean disable */\r
+    uint8_t phase5_enable = 1;     /*phase5_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase6_enable = 1;     /*phase6_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase7_enable = 1;     /*phase7_enable  , 1 mean enable ; 0 mean disable */        \r
+         uint8_t phase8_enable = 1;     /*phase8_enable  , 1 mean enable ; 0 mean disable */ \r
+\r
+    uint8_t phase1_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase2_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase3_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase4_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase5_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+         uint8_t phase6_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase7_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase8_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+                        \r
+         uint8_t phase1_mux_sel = 0;    /* sel phase1*/\r
+               uint8_t phase2_mux_sel = 1;    /* sel phase2*/\r
+               uint8_t phase3_mux_sel = 2;    /* sel phase3*/\r
+               uint8_t phase4_mux_sel = 3;    /* sel phase4*/\r
+               uint8_t phase5_mux_sel = 4;    /* sel phase5*/\r
+               uint8_t phase6_mux_sel = 5;    /* sel phase6*/\r
+               uint8_t phase7_mux_sel = 6;    /* sel phase7*/\r
+               uint8_t phase8_mux_sel = 7;    /* sel phase8*/\r
+       \r
+\r
+         uint8_t phase1_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase1_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase1_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase1_led_drv1_cha_sel = 0;     /* 1 = ldr1  NG; 2 = ldr2   GR; 4 = ldr3  IR; 8 = ldr4 RED; */\r
+    uint8_t phase1_led_drv2_cha_sel = 0;    /*ldr5:0x20  ldr6: 0x40 red    ldr8 0x80  ir      */\r
+               uint8_t phase1_pd_sel = 0x03;          /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase1_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase1_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase1_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase1_ldr2_cur = 0;\r
+//             uint8_t phase1_of_idac1_cur = 0;\r
+//    uint8_t phase1_of_idac2_cur = 0;\r
+    uint8_t phase1_ad_inr_ctrl = 3;\r
+    uint8_t phase1_ad_of_idac_ctrl = 0;\r
+//    uint8_t afe_offset  =  0;\r
+    uint8_t phase1_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase1_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase1_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+\r
+\r
+         uint8_t phase2_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase2_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase2_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase2_led_drv1_cha_sel = 0x10;   //GREEN_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase2_led_drv2_cha_sel = 0;\r
+               uint8_t phase2_pd_sel = 0x03;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase2_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase2_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase2_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase2_ldr2_cur = 0;\r
+//             uint8_t phase2_of_idac1_cur = 0;\r
+//    uint8_t phase2_of_idac2_cur = 0;\r
+    uint8_t phase2_ad_inr_ctrl = 3;\r
+    uint8_t phase2_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase2_afe_offset  =  0;\r
+    uint8_t phase2_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase2_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase2_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+               \r
+    uint8_t phase3_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase3_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase3_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase3_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase3_led_drv2_cha_sel = 0;\r
+               uint8_t phase3_pd_sel = 0x03;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase3_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase3_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase3_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase3_ldr2_cur = 0;\r
+//             uint8_t phase3_of_idac1_cur = 0;\r
+//    uint8_t phase3_of_idac2_cur = 0;\r
+    uint8_t phase3_ad_inr_ctrl = 3;\r
+    uint8_t phase3_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase3_afe_offset  =  0;\r
+    uint8_t phase3_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase3_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase3_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+               \r
+    uint8_t phase4_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase4_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase4_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase4_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase4_led_drv2_cha_sel = 0;\r
+               uint8_t phase4_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase4_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase4_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase4_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase4_ldr2_cur = 0;\r
+//             uint8_t phase4_of_idac1_cur = 0;\r
+//    uint8_t phase4_of_idac2_cur = 0;\r
+    uint8_t phase4_ad_inr_ctrl = 3;\r
+    uint8_t phase4_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase4_afe_offset  =  0;\r
+    uint8_t phase4_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase4_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase4_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase5_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase5_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase5_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase5_led_drv1_cha_sel = 0x10;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase5_led_drv2_cha_sel = 0;\r
+               uint8_t phase5_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase5_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase5_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase5_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase5_ldr2_cur = 0;\r
+//             uint8_t phase5_of_idac1_cur = 0;\r
+//    uint8_t phase5_of_idac2_cur = 0;\r
+    uint8_t phase5_ad_inr_ctrl = 3;\r
+    uint8_t phase5_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase5_afe_offset  =  0;\r
+    uint8_t phase5_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase5_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase5_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase6_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase6_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase6_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase6_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase6_led_drv2_cha_sel = 0;\r
+               uint8_t phase6_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase6_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase6_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase6_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase6_ldr2_cur = 0;\r
+//             uint8_t phase6_of_idac1_cur = 0;\r
+//    uint8_t phase6_of_idac2_cur = 0;\r
+    uint8_t phase6_ad_inr_ctrl = 3;\r
+    uint8_t phase6_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase6_afe_offset  =  0;\r
+    uint8_t phase6_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase6_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase6_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase7_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase7_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase7_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase7_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase7_led_drv2_cha_sel = 0;\r
+               uint8_t phase7_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase7_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase7_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase7_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase7_ldr2_cur = 0;\r
+//             uint8_t phase7_of_idac1_cur = 0;\r
+//    uint8_t phase7_of_idac2_cur = 0;\r
+    uint8_t phase7_ad_inr_ctrl = 3;\r
+    uint8_t phase7_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase7_afe_offset  =  0;\r
+    uint8_t phase7_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase7_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase7_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase8_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase8_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase8_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase8_led_drv1_cha_sel = 0x40;   //IR_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase8_led_drv2_cha_sel = 0;\r
+               uint8_t phase8_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase8_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase8_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase8_ldr1_cur = 32;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase8_ldr2_cur = 0;\r
+//             uint8_t phase8_of_idac1_cur = 0;\r
+//    uint8_t phase8_of_idac2_cur = 0;\r
+    uint8_t phase8_ad_inr_ctrl = 3;\r
+    uint8_t phase8_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase8_afe_offset  =  0;\r
+    uint8_t phase8_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase8_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase8_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t init_wait_delay = 5 ; /* 0 = 31clk ; 1 = 64clk ; 2 = 127clk ; 3 = 255clk(d) ;\r
+                                     4 = 511clk; 5 = 1023clk; 6 = 2047; 7 = 4095clk */         \r
+                                                                                                                                                \r
+    uint8_t afe_reset = 3;        /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d) ;\r
+                                     4 = 255clk; 5 = 511clk; 6 = 1024; 7 = 2047clk */\r
+                                                                                                                                                \r
+               uint8_t afe_rst_cnvt = 1;               /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d)*/\r
+    \r
+    uint8_t led_en_idac_pre    = 2;    /* 0 = 8clk ; 1 = 16clk ; 2 = 32clk ; 3 = 64clk(d)*/ \r
+               \r
+               uint8_t led_en_idac     =       1;        /* 0 = 4clk ; 1 = 8clk ; 2 = 16clk ; 3 = 32clk(d)*/ \r
+                                                                                                                                                \r
+    uint8_t led_on_time = 2;      /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+                                     4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+                                                                                                                                                \r
+    hx3695_delay_ms(10);               \r
+               \r
+    hx3695_write_reg(0X2a, (uint8_t)prf_clk_num);    // prf bit<7:0>6\r
+    hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+    hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>      \r
+                  \r
+    hx3695_write_reg(0X25, (afe_rst_cnvt<<4| led_en_idac_pre<<2|led_en_idac)); \r
+               hx3695_write_reg(0X2d, phase7_8_internal); \r
+               hx3695_write_reg(0X2e, 0x33);// gpio ctrl \r
+    hx3695_write_reg(0X2f, ((afe_reset<<4)| init_wait_delay));\r
+               hx3695_write_reg(0X30, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+    hx3695_write_reg(0X72, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+\r
+\r
+    hx3695_write_reg(0X31, (led_on_time<<4| 0x00));\r
+               hx3695_write_reg(0X33, 0x83);// Öжϼ«ÐÔ¼°¿í¶ÈÅäÖã»\r
+               hx3695_write_reg(0X34, 0x00);// ÖжÏÌØÊâÅäÖã»\r
+               hx3695_write_reg(0X36, 0x00);// phase data ready ±êÖ¾ÉèÖã»\r
+               hx3695_write_reg(0X38, 0x00);\r
+               \r
+    hx3695_write_reg(0X3a, (phase1_inner_avg | (phase2_inner_avg<<4)));  \r
+    hx3695_write_reg(0X3b, (phase3_inner_avg | (phase4_inner_avg<<4)));  \r
+    hx3695_write_reg(0X3c, (phase5_inner_avg | (phase6_inner_avg<<4)));        \r
+    hx3695_write_reg(0X3d, (phase7_inner_avg | (phase8_inner_avg<<4)));        \r
+    hx3695_write_reg(0X3e, adc_rst_post_num<<6 | samp_delay_leden_num<<4 | samp_copy_avg); \r
+    hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+    hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+               \r
+               hx3695_write_reg(0X43, phase1_mux_sel);  \r
+               hx3695_write_reg(0X44, phase1_tia_cap<<4|phase1_tia_res); \r
+               hx3695_write_reg(0X45, phase1_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase1_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase1_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase1_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+\r
+    hx3695_write_reg(0X49, phase1_ad_inr_ctrl<<4|phase1_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase1_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase1_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase1_dsp_mov_avg_num | phase1_dsp_iir_lp_coeff<<4);\r
+\r
+//    hx3695_write_reg(0X4e, thred_value);\r
+//    hx3695_write_reg(0X4f, thred_value>>5);\r
+               \r
+    hx3695_write_reg(0X43, phase2_mux_sel);  \r
+               hx3695_write_reg(0X44, phase2_tia_cap<<4|phase2_tia_res); \r
+               hx3695_write_reg(0X45, phase2_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase2_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase2_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase2_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase2_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase2_ad_inr_ctrl<<4|phase2_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase2_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase2_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase2_dsp_mov_avg_num | phase2_dsp_iir_lp_coeff<<4);\r
+               \r
+//phase3 sel\r
+\r
+    hx3695_write_reg(0X43, phase3_mux_sel);  \r
+               hx3695_write_reg(0X44, phase3_tia_cap<<4|phase3_tia_res); \r
+               hx3695_write_reg(0X45, phase3_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase3_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase3_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase3_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase3_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase3_ad_inr_ctrl<<4|phase3_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase3_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase3_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase3_dsp_mov_avg_num | phase3_dsp_iir_lp_coeff<<4);\r
+               \r
+//phase4 sel\r
+\r
+    hx3695_write_reg(0X43, phase4_mux_sel);  \r
+               hx3695_write_reg(0X44, phase4_tia_cap<<4|phase4_tia_res); \r
+               hx3695_write_reg(0X45, phase4_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase4_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase4_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase4_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase4_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase4_ad_inr_ctrl<<4|phase4_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase4_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase4_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase4_dsp_mov_avg_num | phase4_dsp_iir_lp_coeff<<4);\r
+\r
+               hx3695_write_reg(0X43, phase5_mux_sel);  \r
+               hx3695_write_reg(0X44, phase5_tia_cap<<4|phase5_tia_res); \r
+               hx3695_write_reg(0X45, phase5_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase5_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase5_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase5_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase5_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase5_ad_inr_ctrl<<4|phase5_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase5_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase5_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase5_dsp_mov_avg_num | phase5_dsp_iir_lp_coeff<<4);\r
+               \r
+               \r
+         hx3695_write_reg(0X43, phase6_mux_sel);  \r
+               hx3695_write_reg(0X44, phase6_tia_cap<<4|phase6_tia_res); \r
+               hx3695_write_reg(0X45, phase6_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase6_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase6_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase6_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase6_ad_inr_ctrl<<4|phase6_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase6_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase6_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase6_dsp_mov_avg_num | phase6_dsp_iir_lp_coeff<<4);\r
+               \r
+       \r
+         hx3695_write_reg(0X43, phase7_mux_sel);  \r
+               hx3695_write_reg(0X44, phase7_tia_cap<<4|phase7_tia_res); \r
+               hx3695_write_reg(0X45, phase7_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase7_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase7_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase7_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase7_ad_inr_ctrl<<4|phase7_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase7_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase7_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase7_dsp_mov_avg_num | phase7_dsp_iir_lp_coeff<<4);\r
+               \r
+       \r
+         hx3695_write_reg(0X43, phase8_mux_sel);  \r
+               hx3695_write_reg(0X44, phase8_tia_cap<<4|phase8_tia_res); \r
+               hx3695_write_reg(0X45, phase8_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase8_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase8_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase8_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase8_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phas8_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase8_ad_inr_ctrl<<4|phase8_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase8_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase8_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase8_dsp_mov_avg_num | phase8_dsp_iir_lp_coeff<<4);\r
+               \r
+\r
+// analog circuit cfg \r
+    hx3695_write_reg(0X60, 0x14);      //\r
+               hx3695_write_reg(0X61, 0xf0);   \r
+               hx3695_write_reg(0X62, 0x22); \r
+               hx3695_write_reg(0X63, 0x15); \r
+                                                                                                                                                                                                                               \r
+               hx3695_write_reg(0X64, 0x08);   \r
+               hx3695_write_reg(0X65, 0x88); //bug\r
+               \r
+               hx3695_write_reg(0X66, 0x30);   // bits<3>=adc selftest en     0x30\r
+               hx3695_write_reg(0X67, 0x23);   \r
+               hx3695_write_reg(0X68, 0x46);   \r
+               hx3695_write_reg(0X69, 0x42);   \r
+               \r
+               hx3695_write_reg(0X39, 0xff);   // ofset idac1 phase enable cfg\r
+               hx3695_write_reg(0x73, 0xff);    //led_offset_idac phase enable\r
+               \r
+    hx3695_write_reg(0X6a, 0X0f);      \r
+               hx3695_write_reg(0X6b, 0X22);   \r
+               hx3695_write_reg(0X6c, 0X00);   \r
+               hx3695_write_reg(0X6d, 0X37);   \r
+               hx3695_write_reg(0X6e, 0X82);   \r
+               hx3695_write_reg(0X6f, 0X08);\r
+/////////FIFO and adc conversion ready config////////\r
+/////////FIFO and adc conversion ready config////////\r
+#if defined(PPG_INT_MODE)\r
+               hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble\r
+                hx3695_write_reg(0X33, 0x83);   // int width                                                                                                                                           \r
+     hx3695_write_reg(0X21, 0x00);   // fifo int sel,00=FIFO INT config clear\r
+                hx3695_write_reg(0X38, 0x01);   // int sel,00=close almost full int,04=enable almost full int\r
+#elif defined(INT_MODE)               //FIFO_ALL_MOST_FULL)\r
+                hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble\r
+                hx3695_write_reg(0X1c, (fifo_watermark&0xff));   //fifo_watermark\r
+                hx3695_write_reg(0X1d, fifo_watermark<<8);       //bit<0>=fifo_watermark[8]  \r
+                hx3695_write_reg(0X33, 0x83);   // int width   \r
+                hx3695_write_reg(0X21, 0x00);   // fifo int sel,00=FIFO INT config clear\r
+     hx3695_write_reg(0X38, 0x04);   // int sel,00=close almost full int,04=enable almost full int\r
+\r
+#else\r
+                hx3695_write_reg(0X1b, 0x92);    // bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble                                                                             \r
+     hx3695_write_reg(0X38, 0x01);   // int sel,00=close almost full int,04=enable almost full int\r
+     \r
+#endif\r
+\r
+               \r
+    hx3695_write_reg(0X26,(phase1_enable<<3)|(phase1_adc_osr)|(phase2_enable<<7)|(phase2_adc_osr<<4) ); \r
+    hx3695_write_reg(0X27,(phase3_enable<<3)|(phase3_adc_osr)|(phase4_enable<<7)|(phase4_adc_osr<<4) );  \r
+    hx3695_write_reg(0X28,(phase5_enable<<3)|(phase5_adc_osr)|(phase6_enable<<7)|(phase6_adc_osr<<4) );\r
+    hx3695_write_reg(0X29,(phase7_enable<<3)|(phase7_adc_osr)|(phase8_enable<<7)|(phase8_adc_osr<<4) );                \r
+\r
+//    hx3695_write_reg(0X5c, 0x02);//soft reset\r
+    hx3695_delay_ms(5);  \r
+    hx3695_write_reg(0X5c, 0x00);//release\r
+    read_fifo_first_flg = 1;\r
+    return ;\r
+}\r
+#endif\r
+\r
+#ifdef SPO2_ALG_LIB\r
+// ÑªÑõģʽÏ ³õʼ»¯ÅäÖÃ\r
+void hx3695_spo2_ppg_init(void) //20200615 ericy ppg fs=25hz, phase3 conversion ready interupt en\r
+{\r
+     uint16_t sample_rate = 25;                  /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+    uint32_t prf_clk_num = 32000/sample_rate;   /*period in clk num, num = Fclk/fs */\r
+         \r
+//       uint16_t fifo_watermark= 250 ;\r
+    uint8_t adc_rst_post_num=0;       /* 00=16,01=32,10=64,11=128*/      \r
+         uint8_t samp_delay_leden_num = 0; /* 00=8,01=16,10=32,11=64*/ \r
+    uint8_t samp_copy_avg = 0;        /* 0=1, 1=2, 2=4 ,3=8, 4=16*/\r
+    uint8_t data_avg_num = 0;         /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+         uint8_t phase7_8_internal = 0;    /* phase7 and phase8 prf internal cfg */\r
+       \r
+//       uint16_t  thred_value = 32500;\r
+       \r
+    uint8_t phase1_enable = 1;     /*phase1_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase2_enable = 1;     /*phase2_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase3_enable = 1;     /*phase3_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase4_enable = 1;     /*phase4_enable  , 1 mean enable ; 0 mean disable */\r
+    uint8_t phase5_enable = 1;     /*phase5_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase6_enable = 1;     /*phase6_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase7_enable = 1;     /*phase7_enable  , 1 mean enable ; 0 mean disable */        \r
+         uint8_t phase8_enable = 1;     /*phase8_enable  , 1 mean enable ; 0 mean disable */ \r
+\r
+    uint8_t phase1_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase2_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase3_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase4_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase5_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+         uint8_t phase6_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase7_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase8_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+                        \r
+         uint8_t phase1_mux_sel = 0;    /* sel phase1*/\r
+               uint8_t phase2_mux_sel = 1;    /* sel phase2*/\r
+               uint8_t phase3_mux_sel = 2;    /* sel phase3*/\r
+               uint8_t phase4_mux_sel = 3;    /* sel phase4*/\r
+               uint8_t phase5_mux_sel = 4;    /* sel phase5*/\r
+               uint8_t phase6_mux_sel = 5;    /* sel phase6*/\r
+               uint8_t phase7_mux_sel = 6;    /* sel phase7*/\r
+               uint8_t phase8_mux_sel = 7;    /* sel phase8*/\r
+       \r
+\r
+         uint8_t phase1_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase1_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase1_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase1_led_drv1_cha_sel = 0;     /* 1 = ldr1  NG; 2 = ldr2   GR; 4 = ldr3  IR; 8 = ldr4 RED; */\r
+    uint8_t phase1_led_drv2_cha_sel = 0;    /*ldr5:0x20  ldr6: 0x40 red    ldr8 0x80  ir      */\r
+               uint8_t phase1_pd_sel = 0x08;          /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase1_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase1_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase1_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase1_ldr2_cur = 0;\r
+//             uint8_t phase1_of_idac1_cur = 0;\r
+//    uint8_t phase1_of_idac2_cur = 0;\r
+    uint8_t phase1_ad_inr_ctrl = 3;\r
+    uint8_t phase1_ad_of_idac_ctrl = 0;\r
+//    uint8_t afe_offset  =  0;\r
+    uint8_t phase1_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase1_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase1_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+\r
+\r
+         uint8_t phase2_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase2_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase2_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase2_led_drv1_cha_sel = 0X10;   //GREEN_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase2_led_drv2_cha_sel = 0x00;\r
+               uint8_t phase2_pd_sel = 0x08;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase2_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase2_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase2_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase2_ldr2_cur = 0;\r
+//             uint8_t phase2_of_idac1_cur = 0;\r
+//    uint8_t phase2_of_idac2_cur = 0;\r
+    uint8_t phase2_ad_inr_ctrl = 3;\r
+    uint8_t phase2_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase2_afe_offset  =  0;\r
+    uint8_t phase2_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase2_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase2_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+               \r
+    uint8_t phase3_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase3_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase3_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase3_led_drv1_cha_sel = 0;    //RED_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase3_led_drv2_cha_sel = 0;\r
+               uint8_t phase3_pd_sel = 0x08;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase3_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase3_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase3_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase3_ldr2_cur = 0;\r
+//             uint8_t phase3_of_idac1_cur = 0;\r
+//    uint8_t phase3_of_idac2_cur = 0;\r
+    uint8_t phase3_ad_inr_ctrl = 3;\r
+    uint8_t phase3_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase3_afe_offset  =  0;\r
+    uint8_t phase3_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase3_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase3_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+               \r
+    uint8_t phase4_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase4_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase4_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase4_led_drv1_cha_sel = 0x20;    //IR_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase4_led_drv2_cha_sel = 0;\r
+               uint8_t phase4_pd_sel = 0x08;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase4_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase4_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase4_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase4_ldr2_cur = 0;\r
+//             uint8_t phase4_of_idac1_cur = 0;\r
+//    uint8_t phase4_of_idac2_cur = 0;\r
+    uint8_t phase4_ad_inr_ctrl = 3;\r
+    uint8_t phase4_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase4_afe_offset  =  0;\r
+    uint8_t phase4_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase4_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase4_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase5_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase5_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase5_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase5_led_drv1_cha_sel = 0x00;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase5_led_drv2_cha_sel = 0;\r
+               uint8_t phase5_pd_sel = 0x08;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase5_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase5_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase5_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase5_ldr2_cur = 0;\r
+//             uint8_t phase5_of_idac1_cur = 0;\r
+//    uint8_t phase5_of_idac2_cur = 0;\r
+    uint8_t phase5_ad_inr_ctrl = 3;\r
+    uint8_t phase5_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase5_afe_offset  =  0;\r
+    uint8_t phase5_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase5_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase5_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase6_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase6_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase6_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase6_led_drv1_cha_sel = 0x40;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase6_led_drv2_cha_sel = 0;\r
+               uint8_t phase6_pd_sel = 0x08;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase6_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase6_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase6_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase6_ldr2_cur = 0;\r
+//             uint8_t phase6_of_idac1_cur = 0;\r
+//    uint8_t phase6_of_idac2_cur = 0;\r
+    uint8_t phase6_ad_inr_ctrl = 3;\r
+    uint8_t phase6_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase6_afe_offset  =  0;\r
+    uint8_t phase6_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase6_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase6_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase7_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase7_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase7_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase7_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase7_led_drv2_cha_sel = 0;\r
+               uint8_t phase7_pd_sel = 0x08;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase7_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase7_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase7_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase7_ldr2_cur = 0;\r
+//             uint8_t phase7_of_idac1_cur = 0;\r
+//    uint8_t phase7_of_idac2_cur = 0;\r
+    uint8_t phase7_ad_inr_ctrl = 3;\r
+    uint8_t phase7_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase7_afe_offset  =  0;\r
+    uint8_t phase7_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase7_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase7_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase8_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase8_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase8_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase8_led_drv1_cha_sel = 0x40;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase8_led_drv2_cha_sel = 0;\r
+               uint8_t phase8_pd_sel = 0x08;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase8_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase8_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase8_ldr1_cur = 20;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase8_ldr2_cur = 0;\r
+//             uint8_t phase8_of_idac1_cur = 0;\r
+//    uint8_t phase8_of_idac2_cur = 0;\r
+    uint8_t phase8_ad_inr_ctrl = 3;\r
+    uint8_t phase8_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase8_afe_offset  =  0;\r
+    uint8_t phase8_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase8_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase8_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t init_wait_delay = 4 ; /* 0 = 31clk ; 1 = 64clk ; 2 = 127clk ; 3 = 255clk(d) ;\r
+                                     4 = 511clk; 5 = 1023clk; 6 = 2047; 7 = 4095clk */         \r
+                                                                                                                                                \r
+    uint8_t afe_reset = 3;        /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d) ;\r
+                                     4 = 255clk; 5 = 511clk; 6 = 1024; 7 = 2047clk */\r
+                                                                                                                                                \r
+               uint8_t afe_rst_cnvt = 1;               /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d)*/\r
+    \r
+    uint8_t led_en_idac_pre    = 2;    /* 0 = 8clk ; 1 = 16clk ; 2 = 32clk ; 3 = 64clk(d)*/ \r
+               \r
+               uint8_t led_en_idac     =       1;        /* 0 = 4clk ; 1 = 8clk ; 2 = 16clk ; 3 = 32clk(d)*/ \r
+                                                                                                                                                \r
+    uint8_t led_on_time = 2;      /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+                                     4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+                                                                                                                                                \r
+    hx3695_delay_ms(10);               \r
+                       \r
+    hx3695_write_reg(0X2a, (uint8_t)prf_clk_num);    // prf bit<7:0>6\r
+    hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+    hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>      \r
+                  \r
+    hx3695_write_reg(0X25, (afe_rst_cnvt<<4| led_en_idac_pre<<2|led_en_idac)); \r
+               hx3695_write_reg(0X2d, phase7_8_internal); \r
+               hx3695_write_reg(0X2e, 0x33);// gpio ctrl \r
+    hx3695_write_reg(0X2f, ((afe_reset<<4)| init_wait_delay));\r
+               hx3695_write_reg(0X30, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+    hx3695_write_reg(0X72, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+\r
+\r
+    hx3695_write_reg(0X31, (led_on_time<<4| 0x00));\r
+               hx3695_write_reg(0X33, 0x83);// Öжϼ«ÐÔ¼°¿í¶ÈÅäÖã»\r
+               hx3695_write_reg(0X34, 0x00);// ÖжÏÌØÊâÅäÖã»\r
+               hx3695_write_reg(0X36, 0x00);// phase data ready ±êÖ¾ÉèÖã»\r
+               hx3695_write_reg(0X38, 0x00);\r
+               \r
+    hx3695_write_reg(0X3a, (phase1_inner_avg | (phase2_inner_avg<<4)));  \r
+    hx3695_write_reg(0X3b, (phase3_inner_avg | (phase4_inner_avg<<4)));  \r
+    hx3695_write_reg(0X3c, (phase5_inner_avg | (phase6_inner_avg<<4)));        \r
+    hx3695_write_reg(0X3d, (phase7_inner_avg | (phase8_inner_avg<<4)));        \r
+    hx3695_write_reg(0X3e, adc_rst_post_num<<6 | samp_delay_leden_num<<4 | samp_copy_avg); \r
+    hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+    hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+               \r
+               hx3695_write_reg(0X43, phase1_mux_sel);  \r
+               hx3695_write_reg(0X44, phase1_tia_cap<<4|phase1_tia_res); \r
+               hx3695_write_reg(0X45, phase1_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase1_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase1_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase1_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49, phase1_ad_inr_ctrl<<4|phase1_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase1_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase1_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase1_dsp_mov_avg_num | phase1_dsp_iir_lp_coeff<<4);\r
+\r
+       \r
+    hx3695_write_reg(0X43, phase2_mux_sel);  \r
+               hx3695_write_reg(0X44, phase2_tia_cap<<4|phase2_tia_res); \r
+               hx3695_write_reg(0X45, phase2_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase2_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase2_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase2_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase2_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase2_ad_inr_ctrl<<4|phase2_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase2_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase2_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase2_dsp_mov_avg_num | phase2_dsp_iir_lp_coeff<<4);\r
+               \r
+//phase3 sel\r
+\r
+    hx3695_write_reg(0X43, phase3_mux_sel);  \r
+               hx3695_write_reg(0X44, phase3_tia_cap<<4|phase3_tia_res); \r
+               hx3695_write_reg(0X45, phase3_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase3_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase3_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase3_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase3_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase3_ad_inr_ctrl<<4|phase3_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase3_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase3_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase3_dsp_mov_avg_num | phase3_dsp_iir_lp_coeff<<4);\r
+               \r
+//phase4 sel\r
+\r
+    hx3695_write_reg(0X43, phase4_mux_sel);  \r
+               hx3695_write_reg(0X44, phase4_tia_cap<<4|phase4_tia_res); \r
+               hx3695_write_reg(0X45, phase4_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase4_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase4_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase4_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase4_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase4_ad_inr_ctrl<<4|phase4_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase4_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase4_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase4_dsp_mov_avg_num | phase4_dsp_iir_lp_coeff<<4);\r
+\r
+               hx3695_write_reg(0X43, phase5_mux_sel);  \r
+               hx3695_write_reg(0X44, phase5_tia_cap<<4|phase5_tia_res); \r
+               hx3695_write_reg(0X45, phase5_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase5_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase5_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase5_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase5_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase5_ad_inr_ctrl<<4|phase5_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase5_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase5_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase5_dsp_mov_avg_num | phase5_dsp_iir_lp_coeff<<4);\r
+               \r
+               \r
+         hx3695_write_reg(0X43, phase6_mux_sel);  \r
+               hx3695_write_reg(0X44, phase6_tia_cap<<4|phase6_tia_res); \r
+               hx3695_write_reg(0X45, phase6_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase6_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase6_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase6_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase6_ad_inr_ctrl<<4|phase6_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase6_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase6_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase6_dsp_mov_avg_num | phase6_dsp_iir_lp_coeff<<4);\r
+               \r
+       \r
+         hx3695_write_reg(0X43, phase7_mux_sel);  \r
+               hx3695_write_reg(0X44, phase7_tia_cap<<4|phase7_tia_res); \r
+               hx3695_write_reg(0X45, phase7_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase7_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase7_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase7_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase7_ad_inr_ctrl<<4|phase7_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase7_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase7_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase7_dsp_mov_avg_num | phase7_dsp_iir_lp_coeff<<4);\r
+               \r
+       \r
+         hx3695_write_reg(0X43, phase8_mux_sel);  \r
+               hx3695_write_reg(0X44, phase8_tia_cap<<4|phase8_tia_res); \r
+               hx3695_write_reg(0X45, phase8_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase8_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase8_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase8_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase8_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phas8_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase8_ad_inr_ctrl<<4|phase8_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase8_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase8_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase8_dsp_mov_avg_num | phase8_dsp_iir_lp_coeff<<4);\r
+               \r
+\r
+// analog circuit cfg \r
+    hx3695_write_reg(0X60, 0x14);      //\r
+               hx3695_write_reg(0X61, 0xf0);   \r
+               hx3695_write_reg(0X62, 0x22); \r
+               hx3695_write_reg(0X63, 0x15); \r
+                                                                                                                                                                                                                               \r
+               hx3695_write_reg(0X64, 0x08);   \r
+               hx3695_write_reg(0X65, 0x88); //bug\r
+               \r
+               hx3695_write_reg(0X66, 0x30);   // bits<3>=adc selftest en     0x30\r
+               hx3695_write_reg(0X67, 0x23);   \r
+               hx3695_write_reg(0X68, 0x46);   \r
+               hx3695_write_reg(0X69, 0x42);   \r
+               \r
+               hx3695_write_reg(0X39, 0xff);   // ofset idac1 phase enable cfg\r
+               hx3695_write_reg(0x73, 0xff);    //led_offset_idac phase enable\r
+               \r
+    hx3695_write_reg(0X6a, 0X0f);      \r
+               hx3695_write_reg(0X6b, 0X22);   \r
+               hx3695_write_reg(0X6c, 0X00);   \r
+               hx3695_write_reg(0X6d, 0X37);   \r
+               hx3695_write_reg(0X6e, 0X82);   \r
+               hx3695_write_reg(0X6f, 0X08);\r
+/////////FIFO and adc conversion ready config////////\r
+/////////FIFO and adc conversion ready config////////\r
+#if defined(PPG_INT_MODE)\r
+               hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble\r
+                hx3695_write_reg(0X33, 0x83);   // int width                                                                                                                                           \r
+     hx3695_write_reg(0X21, 0x00);   // fifo int sel,00=FIFO INT config clear\r
+                hx3695_write_reg(0X38, 0x08);   // int sel,00=close almost full int,04=enable almost full int\r
+#elif defined(INT_MODE)             //(FIFO_ALL_MOST_FULL)\r
+                hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble\r
+                hx3695_write_reg(0X1c, (fifo_watermark&0xff));   //fifo_watermark\r
+                hx3695_write_reg(0X1d, fifo_watermark<<8);       //bit<0>=fifo_watermark[8]  \r
+                hx3695_write_reg(0X33, 0x83);   // int width                                                                                                                                           \r
+     hx3695_write_reg(0X38, 0x04);   // int sel,00=close almost full int,04=enable almost full int\r
+\r
+#else\r
+               hx3695_write_reg(0X1b, 0x91);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble     \r
+     hx3695_write_reg(0X36, 0x00);                                                                                                                                                             \r
+                                                                                                                                               \r
+     hx3695_write_reg(0X38, 0x00);   // int sel,00=close almost full int,01= prf int  04=enable almost full int\r
+\r
+#endif\r
+\r
+               \r
+    hx3695_write_reg(0X26,(phase1_enable<<3)|(phase1_adc_osr)|(phase2_enable<<7)|(phase2_adc_osr<<4) ); \r
+    hx3695_write_reg(0X27,(phase3_enable<<3)|(phase3_adc_osr)|(phase4_enable<<7)|(phase4_adc_osr<<4) );  \r
+    hx3695_write_reg(0X28,(phase5_enable<<3)|(phase5_adc_osr)|(phase6_enable<<7)|(phase6_adc_osr<<4) );\r
+    hx3695_write_reg(0X29,(phase7_enable<<3)|(phase7_adc_osr)|(phase8_enable<<7)|(phase8_adc_osr<<4) );                \r
+\r
+    hx3695_write_reg(0X5c, 0x02);//soft reset\r
+    hx3695_delay_ms(5);  \r
+    hx3695_write_reg(0X5c, 0x00);//release\r
+//       uint8_t fifo_data_temp[3] = {0};\r
+//    hx3695_brust_read_reg(0x22, fifo_data_temp, 3); \r
+    read_fifo_first_flg = 1;\r
+    return ;\r
+\r
+}\r
+#endif\r
+\r
+#ifdef HRV_ALG_LIB\r
+// HRVģʽÏ ³õʼ»¯ÅäÖÃ\r
+void hx3695_hrv_ppg_init(void) //20200615 ericy ppg fs=25hz, phase3 conversion ready interupt en\r
+{\r
+   uint16_t sample_rate = 125;                  /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+    uint32_t prf_clk_num = 32000/sample_rate;   /*period in clk num, num = Fclk/fs */\r
+         \r
+;\r
+    uint8_t adc_rst_post_num=0;       /* 00=16,01=32,10=64,11=128*/      \r
+         uint8_t samp_delay_leden_num = 0; /* 00=8,01=16,10=32,11=64*/ \r
+    uint8_t samp_copy_avg = 0;        /* 0=1, 1=2, 2=4 ,3=8, 4=16*/\r
+    uint8_t data_avg_num = 0;         /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+         uint8_t phase7_8_internal = 0;    /* phase7 and phase8 prf internal cfg */\r
+       \r
+       uint8_t phase1_enable = 1;     /*phase1_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase2_enable = 1;     /*phase2_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase3_enable = 1;     /*phase3_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase4_enable = 1;     /*phase4_enable  , 1 mean enable ; 0 mean disable */\r
+    uint8_t phase5_enable = 0;     /*phase5_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase6_enable = 0;     /*phase6_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase7_enable = 0;     /*phase7_enable  , 1 mean enable ; 0 mean disable */        \r
+         uint8_t phase8_enable = 0;     /*phase8_enable  , 1 mean enable ; 0 mean disable */ \r
+\r
+    uint8_t phase1_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase2_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase3_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase4_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase5_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+         uint8_t phase6_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase7_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase8_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+                        \r
+         uint8_t phase1_mux_sel = 0;    /* sel phase1*/\r
+               uint8_t phase2_mux_sel = 1;    /* sel phase2*/\r
+               uint8_t phase3_mux_sel = 2;    /* sel phase3*/\r
+               uint8_t phase4_mux_sel = 3;    /* sel phase4*/\r
+               uint8_t phase5_mux_sel = 4;    /* sel phase5*/\r
+               uint8_t phase6_mux_sel = 5;    /* sel phase6*/\r
+               uint8_t phase7_mux_sel = 6;    /* sel phase7*/\r
+               uint8_t phase8_mux_sel = 7;    /* sel phase8*/\r
+       \r
+\r
+         uint8_t phase1_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase1_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase1_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase1_led_drv1_cha_sel = 0X10;     /* 1 = ldr1  NG; 2 = ldr2   GR; 4 = ldr3  IR; 8 = ldr4 RED; */\r
+    uint8_t phase1_led_drv2_cha_sel = 0;    /*ldr5:0x20  ldr6: 0x40 red    ldr8 0x80  ir      */\r
+               uint8_t phase1_pd_sel = 0x0a;          /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase1_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase1_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase1_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase1_ldr2_cur = 0;\r
+//             uint8_t phase1_of_idac1_cur = 0;\r
+//    uint8_t phase1_of_idac2_cur = 0;\r
+    uint8_t phase1_ad_inr_ctrl = 3;\r
+    uint8_t phase1_ad_of_idac_ctrl = 0;\r
+//    uint8_t afe_offset  =  0;\r
+    uint8_t phase1_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase1_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase1_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+\r
+\r
+         uint8_t phase2_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase2_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase2_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase2_led_drv1_cha_sel = 0;   //GREEN_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase2_led_drv2_cha_sel = 0;\r
+               uint8_t phase2_pd_sel = 0x0a;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase2_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase2_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase2_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase2_ldr2_cur = 0;\r
+//             uint8_t phase2_of_idac1_cur = 0;\r
+//    uint8_t phase2_of_idac2_cur = 0;\r
+    uint8_t phase2_ad_inr_ctrl = 3;\r
+    uint8_t phase2_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase2_afe_offset  =  0;\r
+    uint8_t phase2_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase2_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase2_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+               \r
+    uint8_t phase3_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase3_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase3_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase3_led_drv1_cha_sel = 0x40;    //RED_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase3_led_drv2_cha_sel = 0;\r
+               uint8_t phase3_pd_sel = 0x0a;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase3_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase3_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase3_ldr1_cur = 15;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase3_ldr2_cur = 0;\r
+//             uint8_t phase3_of_idac1_cur = 0;\r
+//    uint8_t phase3_of_idac2_cur = 0;\r
+    uint8_t phase3_ad_inr_ctrl = 3;\r
+    uint8_t phase3_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase3_afe_offset  =  0;\r
+    uint8_t phase3_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase3_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase3_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+               \r
+    uint8_t phase4_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase4_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase4_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase4_led_drv1_cha_sel = 0;    //IR_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase4_led_drv2_cha_sel = 0;\r
+               uint8_t phase4_pd_sel = 0x0a;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase4_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase4_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase4_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase4_ldr2_cur = 0;\r
+//             uint8_t phase4_of_idac1_cur = 0;\r
+//    uint8_t phase4_of_idac2_cur = 0;\r
+    uint8_t phase4_ad_inr_ctrl = 3;\r
+    uint8_t phase4_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase4_afe_offset  =  0;\r
+    uint8_t phase4_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase4_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase4_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase5_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase5_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase5_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase5_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase5_led_drv2_cha_sel = 0;\r
+               uint8_t phase5_pd_sel = 0x0a;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase5_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase5_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase5_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase5_ldr2_cur = 0;\r
+//             uint8_t phase5_of_idac1_cur = 0;\r
+//    uint8_t phase5_of_idac2_cur = 0;\r
+    uint8_t phase5_ad_inr_ctrl = 3;\r
+    uint8_t phase5_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase5_afe_offset  =  0;\r
+    uint8_t phase5_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase5_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase5_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase6_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase6_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase6_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase6_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase6_led_drv2_cha_sel = 0;\r
+               uint8_t phase6_pd_sel = 0x0a;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase6_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase6_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase6_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase6_ldr2_cur = 0;\r
+//             uint8_t phase6_of_idac1_cur = 0;\r
+//    uint8_t phase6_of_idac2_cur = 0;\r
+    uint8_t phase6_ad_inr_ctrl = 3;\r
+    uint8_t phase6_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase6_afe_offset  =  0;\r
+    uint8_t phase6_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase6_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase6_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase7_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase7_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase7_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase7_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase7_led_drv2_cha_sel = 0;\r
+               uint8_t phase7_pd_sel = 0x0a;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase7_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase7_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase7_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase7_ldr2_cur = 0;\r
+//             uint8_t phase7_of_idac1_cur = 0;\r
+//    uint8_t phase7_of_idac2_cur = 0;\r
+    uint8_t phase7_ad_inr_ctrl = 3;\r
+    uint8_t phase7_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase7_afe_offset  =  0;\r
+    uint8_t phase7_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase7_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase7_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase8_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase8_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase8_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase8_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase8_led_drv2_cha_sel = 0;\r
+               uint8_t phase8_pd_sel = 0x0a;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase8_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase8_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase8_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase8_ldr2_cur = 0;\r
+//             uint8_t phase8_of_idac1_cur = 0;\r
+//    uint8_t phase8_of_idac2_cur = 0;\r
+    uint8_t phase8_ad_inr_ctrl = 3;\r
+    uint8_t phase8_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase8_afe_offset  =  0;\r
+    uint8_t phase8_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase8_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase8_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t init_wait_delay = 4 ; /* 0 = 31clk ; 1 = 64clk ; 2 = 127clk ; 3 = 255clk(d) ;\r
+                                     4 = 511clk; 5 = 1023clk; 6 = 2047; 7 = 4095clk */         \r
+                                                                                                                                                \r
+    uint8_t afe_reset = 3;        /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d) ;\r
+                                     4 = 255clk; 5 = 511clk; 6 = 1024; 7 = 2047clk */\r
+                                                                                                                                                \r
+               uint8_t afe_rst_cnvt = 1;               /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d)*/\r
+    \r
+    uint8_t led_en_idac_pre    = 2;    /* 0 = 8clk ; 1 = 16clk ; 2 = 32clk ; 3 = 64clk(d)*/ \r
+               \r
+               uint8_t led_en_idac     =       1;        /* 0 = 4clk ; 1 = 8clk ; 2 = 16clk ; 3 = 32clk(d)*/ \r
+                                                                                                                                                \r
+    uint8_t led_on_time = 2;      /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+                                     4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+                                                                                                                                                \r
+    hx3695_delay_ms(10);               \r
+                       \r
+    hx3695_write_reg(0X2a, (uint8_t)prf_clk_num);    // prf bit<7:0>6\r
+    hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+    hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>      \r
+                  \r
+    hx3695_write_reg(0X25, (afe_rst_cnvt<<4| led_en_idac_pre<<2|led_en_idac)); \r
+               hx3695_write_reg(0X2d, phase7_8_internal); \r
+               hx3695_write_reg(0X2e, 0x33);// gpio ctrl \r
+    hx3695_write_reg(0X2f, ((afe_reset<<4)| init_wait_delay));\r
+               hx3695_write_reg(0X30, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+    hx3695_write_reg(0X72, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+\r
+\r
+    hx3695_write_reg(0X31, (led_on_time<<4| 0x00));\r
+               hx3695_write_reg(0X33, 0x83);// Öжϼ«ÐÔ¼°¿í¶ÈÅäÖã»\r
+               hx3695_write_reg(0X34, 0x00);// ÖжÏÌØÊâÅäÖã»\r
+               hx3695_write_reg(0X36, 0x00);// phase data ready ±êÖ¾ÉèÖã»\r
+               hx3695_write_reg(0X38, 0x00);\r
+               \r
+    hx3695_write_reg(0X3a, (phase1_inner_avg | (phase2_inner_avg<<4)));  \r
+    hx3695_write_reg(0X3b, (phase3_inner_avg | (phase4_inner_avg<<4)));  \r
+    hx3695_write_reg(0X3c, (phase5_inner_avg | (phase6_inner_avg<<4)));        \r
+    hx3695_write_reg(0X3d, (phase7_inner_avg | (phase8_inner_avg<<4)));        \r
+    hx3695_write_reg(0X3e, adc_rst_post_num<<6 | samp_delay_leden_num<<4 | samp_copy_avg); \r
+    hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+    hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+               \r
+               hx3695_write_reg(0X43, phase1_mux_sel);  \r
+               hx3695_write_reg(0X44, phase1_tia_cap<<4|phase1_tia_res); \r
+               hx3695_write_reg(0X45, phase1_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase1_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase1_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase1_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49, phase1_ad_inr_ctrl<<4|phase1_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase1_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase1_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase1_dsp_mov_avg_num | phase1_dsp_iir_lp_coeff<<4);\r
+\r
+       \r
+    hx3695_write_reg(0X43, phase2_mux_sel);  \r
+               hx3695_write_reg(0X44, phase2_tia_cap<<4|phase2_tia_res); \r
+               hx3695_write_reg(0X45, phase2_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase2_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase2_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase2_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase2_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase2_ad_inr_ctrl<<4|phase2_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase2_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase2_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase2_dsp_mov_avg_num | phase2_dsp_iir_lp_coeff<<4);\r
+               \r
+//phase3 sel\r
+\r
+    hx3695_write_reg(0X43, phase3_mux_sel);  \r
+               hx3695_write_reg(0X44, phase3_tia_cap<<4|phase3_tia_res); \r
+               hx3695_write_reg(0X45, phase3_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase3_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase3_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase3_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase3_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase3_ad_inr_ctrl<<4|phase3_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase3_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase3_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase3_dsp_mov_avg_num | phase3_dsp_iir_lp_coeff<<4);\r
+               \r
+//phase4 sel\r
+\r
+    hx3695_write_reg(0X43, phase4_mux_sel);  \r
+               hx3695_write_reg(0X44, phase4_tia_cap<<4|phase4_tia_res); \r
+               hx3695_write_reg(0X45, phase4_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase4_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase4_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase4_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase4_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase4_ad_inr_ctrl<<4|phase4_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase4_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase4_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase4_dsp_mov_avg_num | phase4_dsp_iir_lp_coeff<<4);\r
+\r
+               hx3695_write_reg(0X43, phase5_mux_sel);  \r
+               hx3695_write_reg(0X44, phase5_tia_cap<<4|phase5_tia_res); \r
+               hx3695_write_reg(0X45, phase5_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase5_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase5_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase5_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase5_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase5_ad_inr_ctrl<<4|phase5_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase5_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase5_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase5_dsp_mov_avg_num | phase5_dsp_iir_lp_coeff<<4);\r
+               \r
+               \r
+         hx3695_write_reg(0X43, phase6_mux_sel);  \r
+               hx3695_write_reg(0X44, phase6_tia_cap<<4|phase6_tia_res); \r
+               hx3695_write_reg(0X45, phase6_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase6_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase6_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase6_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase6_ad_inr_ctrl<<4|phase6_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase6_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase6_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase6_dsp_mov_avg_num | phase6_dsp_iir_lp_coeff<<4);\r
+               \r
+       \r
+         hx3695_write_reg(0X43, phase7_mux_sel);  \r
+               hx3695_write_reg(0X44, phase7_tia_cap<<4|phase7_tia_res); \r
+               hx3695_write_reg(0X45, phase7_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase7_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase7_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase7_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase7_ad_inr_ctrl<<4|phase7_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase7_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase7_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase7_dsp_mov_avg_num | phase7_dsp_iir_lp_coeff<<4);\r
+               \r
+       \r
+         hx3695_write_reg(0X43, phase8_mux_sel);  \r
+               hx3695_write_reg(0X44, phase8_tia_cap<<4|phase8_tia_res); \r
+               hx3695_write_reg(0X45, phase8_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase8_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase8_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase8_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase8_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phas8_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase8_ad_inr_ctrl<<4|phase8_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase8_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase8_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase8_dsp_mov_avg_num | phase8_dsp_iir_lp_coeff<<4);\r
+               \r
+\r
+// analog circuit cfg \r
+    hx3695_write_reg(0X60, 0x14);      //\r
+               hx3695_write_reg(0X61, 0xf0);   \r
+               hx3695_write_reg(0X62, 0x22); \r
+               hx3695_write_reg(0X63, 0x15); \r
+                                                                                                                                                                                                                               \r
+               hx3695_write_reg(0X64, 0x08);   \r
+               hx3695_write_reg(0X65, 0x88); //bug\r
+               \r
+               hx3695_write_reg(0X66, 0x30);   // bits<3>=adc selftest en     0x30\r
+               hx3695_write_reg(0X67, 0x23);   \r
+               hx3695_write_reg(0X68, 0x46);   \r
+               hx3695_write_reg(0X69, 0x42);   \r
+               \r
+               hx3695_write_reg(0X39, 0xff);   // ofset idac1 phase enable cfg\r
+               hx3695_write_reg(0x73, 0xff);    //led_offset_idac phase enable\r
+               \r
+    hx3695_write_reg(0X6a, 0X0f);      \r
+               hx3695_write_reg(0X6b, 0X22);   \r
+               hx3695_write_reg(0X6c, 0X00);   \r
+               hx3695_write_reg(0X6d, 0X37);   \r
+               hx3695_write_reg(0X6e, 0X82);   \r
+               hx3695_write_reg(0X6f, 0X08);\r
+/////////FIFO and adc conversion ready config////////\r
+/////////FIFO and adc conversion ready config////////\r
+#if defined(PPG_INT_MODE)\r
+               hx3695_write_reg(0X1b, 0x00);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble\r
+                hx3695_write_reg(0X33, 0x83);   // int width                                                                                                                                           \r
+     hx3695_write_reg(0X21, 0x00);   // fifo int sel,00=FIFO INT config clear\r
+                hx3695_write_reg(0X38, 0x08);   // int sel,00=close almost full int,04=enable almost full int\r
+#elif defined(INT_MODE)             //(FIFO_ALL_MOST_FULL)\r
+                hx3695_write_reg(0X1b, 0x90);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble\r
+                hx3695_write_reg(0X1c, (fifo_watermark&0xff));   //fifo_watermark\r
+                hx3695_write_reg(0X1d, fifo_watermark<<8);       //bit<0>=fifo_watermark[8]  \r
+                hx3695_write_reg(0X33, 0x83);   // int width                                                                                                                                           \r
+     hx3695_write_reg(0X38, 0x04);   // int sel,00=close almost full int,04=enable almost full int\r
+\r
+#else\r
+               hx3695_write_reg(0X1b, 0x90);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble     \r
+     hx3695_write_reg(0X36, 0x00);                                                                                                                                                             \r
+                                                                                                                                               \r
+     hx3695_write_reg(0X38, 0x00);   // int sel,00=close almost full int,01= prf int  04=enable almost full int\r
+\r
+#endif\r
+\r
+               \r
+    hx3695_write_reg(0X26,(phase1_enable<<3)|(phase1_adc_osr)|(phase2_enable<<7)|(phase2_adc_osr<<4) ); \r
+    hx3695_write_reg(0X27,(phase3_enable<<3)|(phase3_adc_osr)|(phase4_enable<<7)|(phase4_adc_osr<<4) );  \r
+    hx3695_write_reg(0X28,(phase5_enable<<3)|(phase5_adc_osr)|(phase6_enable<<7)|(phase6_adc_osr<<4) );\r
+    hx3695_write_reg(0X29,(phase7_enable<<3)|(phase7_adc_osr)|(phase8_enable<<7)|(phase8_adc_osr<<4) );                \r
+\r
+    hx3695_write_reg(0X5c, 0x02);//soft reset\r
+    hx3695_delay_ms(5);  \r
+    hx3695_write_reg(0X5c, 0x00);//release\r
+//       uint8_t fifo_data_temp[3] = {0};\r
+//    hx3695_brust_read_reg(0x22, fifo_data_temp, 3); \r
+    read_fifo_first_flg = 1;\r
+    return ;\r
+}\r
+#endif\r
+\r
+#ifdef CHECK_TOUCH_LIB\r
+void hx3695_check_touch_init(void) //\r
+{     \r
+         uint16_t sample_rate = 25;                  /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+    uint32_t prf_clk_num = 32000/sample_rate;   /*period in clk num, num = Fclk/fs */\r
+         \r
+//       uint16_t fifo_watermark= 250 ;\r
+    uint8_t adc_rst_post_num= 0;       /* 00=16,01=32,10=64,11=128*/      \r
+         uint8_t samp_delay_leden_num = 0; /* 00=8,01=16,10=32,11=64*/ \r
+    uint8_t samp_copy_avg = 0;        /* 0=1, 1=2, 2=4 ,3=8, 4=16*/\r
+    uint8_t data_avg_num = 0;         /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+         uint8_t phase7_8_internal = 0;   //0x18;    /* phase7 and phase8 prf internal cfg */\r
+       \r
+//       uint16_t  thred_value = 32500;\r
+       \r
+    uint8_t phase1_enable = 0;     /*phase1_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase2_enable = 0;     /*phase2_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase3_enable = 0;     /*phase3_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase4_enable = 0;     /*phase4_enable  , 1 mean enable ; 0 mean disable */\r
+    uint8_t phase5_enable = 0;     /*phase5_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase6_enable = 0;     /*phase6_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase7_enable = 1;     /*phase7_enable  , 1 mean enable ; 0 mean disable */        \r
+         uint8_t phase8_enable = 1;     /*phase8_enable  , 1 mean enable ; 0 mean disable */ \r
+\r
+    uint8_t phase1_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase2_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase3_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase4_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase5_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+         uint8_t phase6_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase7_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase8_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+                        \r
+         uint8_t phase1_mux_sel = 0;    /* sel phase1*/\r
+               uint8_t phase2_mux_sel = 1;    /* sel phase2*/\r
+               uint8_t phase3_mux_sel = 2;    /* sel phase3*/\r
+               uint8_t phase4_mux_sel = 3;    /* sel phase4*/\r
+               uint8_t phase5_mux_sel = 4;    /* sel phase5*/\r
+               uint8_t phase6_mux_sel = 5;    /* sel phase6*/\r
+               uint8_t phase7_mux_sel = 6;    /* sel phase7*/\r
+               uint8_t phase8_mux_sel = 7;    /* sel phase8*/\r
+       \r
+\r
+         uint8_t phase1_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase1_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase1_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase1_led_drv1_cha_sel = 0;     /* 1 = ldr1  NG; 2 = ldr2   GR; 4 = ldr3  IR; 8 = ldr4 RED; */\r
+    uint8_t phase1_led_drv2_cha_sel = 0;    /*ldr5:0x20  ldr6: 0x40 red    ldr8 0x80  ir      */\r
+               uint8_t phase1_pd_sel = 0x0c;          /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase1_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase1_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase1_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase1_ldr2_cur = 0;\r
+//             uint8_t phase1_of_idac1_cur = 0;\r
+//    uint8_t phase1_of_idac2_cur = 0;\r
+    uint8_t phase1_ad_inr_ctrl = 3;\r
+    uint8_t phase1_ad_of_idac_ctrl = 0;\r
+//    uint8_t afe_offset  =  0;\r
+    uint8_t phase1_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase1_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase1_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+\r
+\r
+         uint8_t phase2_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase2_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase2_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase2_led_drv1_cha_sel = 0;   //GREEN_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase2_led_drv2_cha_sel = 0;\r
+               uint8_t phase2_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase2_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase2_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase2_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase2_ldr2_cur = 0;\r
+//             uint8_t phase2_of_idac1_cur = 0;\r
+//    uint8_t phase2_of_idac2_cur = 0;\r
+    uint8_t phase2_ad_inr_ctrl = 3;\r
+    uint8_t phase2_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase2_afe_offset  =  0;\r
+    uint8_t phase2_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase2_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase2_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+               \r
+    uint8_t phase3_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase3_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase3_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase3_led_drv1_cha_sel = 0;     //RED_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase3_led_drv2_cha_sel = 0;\r
+               uint8_t phase3_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase3_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase3_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase3_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase3_ldr2_cur = 0;\r
+//             uint8_t phase3_of_idac1_cur = 0;\r
+//    uint8_t phase3_of_idac2_cur = 0;\r
+    uint8_t phase3_ad_inr_ctrl = 3;\r
+    uint8_t phase3_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase3_afe_offset  =  0;\r
+    uint8_t phase3_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase3_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase3_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+               \r
+    uint8_t phase4_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase4_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase4_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase4_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase4_led_drv2_cha_sel = 0;\r
+               uint8_t phase4_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase4_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase4_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase4_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase4_ldr2_cur = 0;\r
+//             uint8_t phase4_of_idac1_cur = 0;\r
+//    uint8_t phase4_of_idac2_cur = 0;\r
+    uint8_t phase4_ad_inr_ctrl = 3;\r
+    uint8_t phase4_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase4_afe_offset  =  0;\r
+    uint8_t phase4_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase4_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase4_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase5_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase5_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase5_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase5_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase5_led_drv2_cha_sel = 0;\r
+               uint8_t phase5_pd_sel = 4;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase5_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase5_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase5_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase5_ldr2_cur = 0;\r
+//             uint8_t phase5_of_idac1_cur = 0;\r
+//    uint8_t phase5_of_idac2_cur = 0;\r
+    uint8_t phase5_ad_inr_ctrl = 3;\r
+    uint8_t phase5_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase5_afe_offset  =  0;\r
+    uint8_t phase5_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase5_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase5_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase6_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase6_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase6_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase6_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase6_led_drv2_cha_sel = 0;\r
+               uint8_t phase6_pd_sel = 4;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase6_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase6_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase6_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase6_ldr2_cur = 0;\r
+//             uint8_t phase6_of_idac1_cur = 0;\r
+//    uint8_t phase6_of_idac2_cur = 0;\r
+    uint8_t phase6_ad_inr_ctrl = 3;\r
+    uint8_t phase6_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase6_afe_offset  =  0;\r
+    uint8_t phase6_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase6_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase6_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase7_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase7_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase7_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase7_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase7_led_drv2_cha_sel = 0;\r
+               uint8_t phase7_pd_sel = 0x00;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase7_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase7_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase7_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase7_ldr2_cur = 0;\r
+//             uint8_t phase7_of_idac1_cur = 0;\r
+//    uint8_t phase7_of_idac2_cur = 0;\r
+    uint8_t phase7_ad_inr_ctrl = 3;\r
+    uint8_t phase7_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase7_afe_offset  =  0;\r
+    uint8_t phase7_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase7_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase7_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase8_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase8_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase8_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase8_led_drv1_cha_sel = 0x40;    //IR_LED_SLE    /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase8_led_drv2_cha_sel = 0;\r
+               uint8_t phase8_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase8_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase8_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase8_ldr1_cur = 20;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase8_ldr2_cur = 0;\r
+//             uint8_t phase8_of_idac1_cur = 0;\r
+//    uint8_t phase8_of_idac2_cur = 0;\r
+    uint8_t phase8_ad_inr_ctrl = 3;\r
+    uint8_t phase8_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase8_afe_offset  =  0;\r
+    uint8_t phase8_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase8_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase8_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t init_wait_delay = 4 ; /* 0 = 31clk ; 1 = 64clk ; 2 = 127clk ; 3 = 255clk(d) ;\r
+                                     4 = 511clk; 5 = 1023clk; 6 = 2047; 7 = 4095clk */         \r
+                                                                                                                                                \r
+    uint8_t afe_reset = 3;        /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d) ;\r
+                                     4 = 255clk; 5 = 511clk; 6 = 1024; 7 = 2047clk */\r
+                                                                                                                                                \r
+               uint8_t afe_rst_cnvt = 1;               /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d)*/\r
+    \r
+    uint8_t led_en_idac_pre    = 2;    /* 0 = 8clk ; 1 = 16clk ; 2 = 32clk ; 3 = 64clk(d)*/ \r
+               \r
+               uint8_t led_en_idac     =       1;        /* 0 = 4clk ; 1 = 8clk ; 2 = 16clk ; 3 = 32clk(d)*/ \r
+                                                                                                                                                \r
+    uint8_t led_on_time = 2;      /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+                                     4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+                                                                                                                                                \r
+    hx3695_delay_ms(10);               \r
+                       \r
+    hx3695_write_reg(0X2a, (uint8_t)prf_clk_num);    // prf bit<7:0>6\r
+    hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+    hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>      \r
+                  \r
+    hx3695_write_reg(0X25, (afe_rst_cnvt<<4| led_en_idac_pre<<2|led_en_idac)); \r
+               hx3695_write_reg(0X2d, phase7_8_internal); \r
+               hx3695_write_reg(0X2e, 0x33);// gpio ctrl \r
+    hx3695_write_reg(0X2f, ((afe_reset<<4)| init_wait_delay));\r
+               hx3695_write_reg(0X30, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+    hx3695_write_reg(0X72, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+\r
+\r
+    hx3695_write_reg(0X31, (led_on_time<<4| 0x00));\r
+               hx3695_write_reg(0X33, 0x83);// Öжϼ«ÐÔ¼°¿í¶ÈÅäÖã»\r
+               hx3695_write_reg(0X34, 0x00);// ÖжÏÌØÊâÅäÖã»\r
+               hx3695_write_reg(0X36, 0x00);// phase data ready ±êÖ¾ÉèÖã»\r
+               hx3695_write_reg(0X38, 0x00);\r
+               \r
+    hx3695_write_reg(0X3a, (phase1_inner_avg | (phase2_inner_avg<<4)));  \r
+    hx3695_write_reg(0X3b, (phase3_inner_avg | (phase4_inner_avg<<4)));  \r
+    hx3695_write_reg(0X3c, (phase5_inner_avg | (phase6_inner_avg<<4)));        \r
+    hx3695_write_reg(0X3d, (phase7_inner_avg | (phase8_inner_avg<<4)));        \r
+    hx3695_write_reg(0X3e, adc_rst_post_num<<6 | samp_delay_leden_num<<4 | samp_copy_avg); \r
+    hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+    hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+               \r
+               hx3695_write_reg(0X43, phase1_mux_sel);  \r
+               hx3695_write_reg(0X44, phase1_tia_cap<<4|phase1_tia_res); \r
+               hx3695_write_reg(0X45, phase1_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase1_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase1_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase1_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49, phase1_ad_inr_ctrl<<4|phase1_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase1_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase1_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase1_dsp_mov_avg_num | phase1_dsp_iir_lp_coeff<<4);\r
+\r
+       \r
+    hx3695_write_reg(0X43, phase2_mux_sel);  \r
+               hx3695_write_reg(0X44, phase2_tia_cap<<4|phase2_tia_res); \r
+               hx3695_write_reg(0X45, phase2_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase2_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase2_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase2_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase2_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase2_ad_inr_ctrl<<4|phase2_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase2_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase2_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase2_dsp_mov_avg_num | phase2_dsp_iir_lp_coeff<<4);\r
+               \r
+//phase3 sel\r
+\r
+    hx3695_write_reg(0X43, phase3_mux_sel);  \r
+               hx3695_write_reg(0X44, phase3_tia_cap<<4|phase3_tia_res); \r
+               hx3695_write_reg(0X45, phase3_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase3_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase3_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase3_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase3_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase3_ad_inr_ctrl<<4|phase3_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase3_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase3_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase3_dsp_mov_avg_num | phase3_dsp_iir_lp_coeff<<4);\r
+               \r
+//phase4 sel\r
+\r
+    hx3695_write_reg(0X43, phase4_mux_sel);  \r
+               hx3695_write_reg(0X44, phase4_tia_cap<<4|phase4_tia_res); \r
+               hx3695_write_reg(0X45, phase4_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase4_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase4_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase4_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase4_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase4_ad_inr_ctrl<<4|phase4_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase4_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase4_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase4_dsp_mov_avg_num | phase4_dsp_iir_lp_coeff<<4);\r
+\r
+               hx3695_write_reg(0X43, phase5_mux_sel);  \r
+               hx3695_write_reg(0X44, phase5_tia_cap<<4|phase5_tia_res); \r
+               hx3695_write_reg(0X45, phase5_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase5_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase5_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase5_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase5_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase5_ad_inr_ctrl<<4|phase5_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase5_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase5_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase5_dsp_mov_avg_num | phase5_dsp_iir_lp_coeff<<4);\r
+               \r
+               \r
+         hx3695_write_reg(0X43, phase6_mux_sel);  \r
+               hx3695_write_reg(0X44, phase6_tia_cap<<4|phase6_tia_res); \r
+               hx3695_write_reg(0X45, phase6_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase6_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase6_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase6_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase6_ad_inr_ctrl<<4|phase6_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase6_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase6_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase6_dsp_mov_avg_num | phase6_dsp_iir_lp_coeff<<4);\r
+               \r
+       \r
+         hx3695_write_reg(0X43, phase7_mux_sel);  \r
+               hx3695_write_reg(0X44, phase7_tia_cap<<4|phase7_tia_res); \r
+               hx3695_write_reg(0X45, phase7_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase7_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase7_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase7_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase7_ad_inr_ctrl<<4|phase7_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase7_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase7_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase7_dsp_mov_avg_num | phase7_dsp_iir_lp_coeff<<4);\r
+               \r
+       \r
+         hx3695_write_reg(0X43, phase8_mux_sel);  \r
+               hx3695_write_reg(0X44, phase8_tia_cap<<4|phase8_tia_res); \r
+               hx3695_write_reg(0X45, phase8_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase8_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase8_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase8_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase8_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phas8_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase8_ad_inr_ctrl<<4|phase8_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase8_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase8_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase8_dsp_mov_avg_num | phase8_dsp_iir_lp_coeff<<4);\r
+               \r
+\r
+// analog circuit cfg \r
+    hx3695_write_reg(0X60, 0x14);      //\r
+               hx3695_write_reg(0X61, 0xf0);   \r
+               hx3695_write_reg(0X62, 0x22); \r
+               hx3695_write_reg(0X63, 0x15); \r
+                                                                                                                                                                                                                               \r
+               hx3695_write_reg(0X64, 0x08);   \r
+               hx3695_write_reg(0X65, 0x88); //bug\r
+               \r
+               hx3695_write_reg(0X66, 0x30);   // bits<3>=adc selftest en     0x30\r
+               hx3695_write_reg(0X67, 0x23);   \r
+               hx3695_write_reg(0X68, 0x46);   \r
+               hx3695_write_reg(0X69, 0x42);   \r
+               \r
+               hx3695_write_reg(0X39, 0xff);   // ofset idac1 phase enable cfg\r
+               hx3695_write_reg(0x73, 0xff);    //led_offset_idac phase enable\r
+               \r
+    hx3695_write_reg(0X6a, 0X0f);      \r
+               hx3695_write_reg(0X6b, 0X22);   \r
+               hx3695_write_reg(0X6c, 0X00);   \r
+               hx3695_write_reg(0X6d, 0X37);   \r
+               hx3695_write_reg(0X6e, 0X82);   \r
+               hx3695_write_reg(0X6f, 0X08);\r
+/////////FIFO and adc conversion ready config////////\r
+/////////FIFO and adc conversion ready config////////\r
+#if defined(PPG_INT_MODE)\r
+               hx3695_write_reg(0X1b, 0x90);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble\r
+                hx3695_write_reg(0X33, 0x83);   // int width                                                                                                                                           \r
+     hx3695_write_reg(0X21, 0x00);   // fifo int sel,00=FIFO INT config clear\r
+                hx3695_write_reg(0X38, 0x08);   // int sel,00=close almost full int,04=enable almost full int\r
+#elif defined(INT_MODE)             //(FIFO_ALL_MOST_FULL)\r
+                hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble\r
+                hx3695_write_reg(0X1c, (fifo_watermark&0xff));   //fifo_watermark\r
+                hx3695_write_reg(0X1d, fifo_watermark<<8);       //bit<0>=fifo_watermark[8]  \r
+                hx3695_write_reg(0X33, 0x83);   // int width                                                                                                                                           \r
+     hx3695_write_reg(0X38, 0x04);   // int sel,00=close almost full int,04=enable almost full int\r
+\r
+#else\r
+               hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble     \r
+     hx3695_write_reg(0X36, 0x00);                       //intrupt                                                                                                                                     \r
+                                                                                                                                               \r
+     hx3695_write_reg(0X38, 0x00);   // int sel,00=close almost full int,01= prf int  04=enable almost full int\r
+\r
+#endif\r
+\r
+               \r
+    hx3695_write_reg(0X26,(phase1_enable<<3)|(phase1_adc_osr)|(phase2_enable<<7)|(phase2_adc_osr<<4) ); \r
+    hx3695_write_reg(0X27,(phase3_enable<<3)|(phase3_adc_osr)|(phase4_enable<<7)|(phase4_adc_osr<<4) );  \r
+    hx3695_write_reg(0X28,(phase5_enable<<3)|(phase5_adc_osr)|(phase6_enable<<7)|(phase6_adc_osr<<4) );\r
+    hx3695_write_reg(0X29,(phase7_enable<<3)|(phase7_adc_osr)|(phase8_enable<<7)|(phase8_adc_osr<<4) );                \r
+\r
+    hx3695_write_reg(0X5c, 0x02);//soft reset\r
+    hx3695_delay_ms(5);  \r
+    hx3695_write_reg(0X5c, 0x00);//release\r
+//       uint8_t fifo_data_temp[3] = {0};\r
+//    hx3695_brust_read_reg(0x22, fifo_data_temp, 3); \r
+    read_fifo_first_flg = 1;\r
+    return ;\r
+}\r
+#endif\r
+\r
+// ³õʼ»¯µ÷ÓÃÈë¿Úº¯Êý\r
+bool hx3695_init(WORK_MODE_T mode)\r
+{\r
+    work_mode_flag = mode;\r
+    hx3695_data_reset();\r
+    hx3695_vin_check(3800);\r
+    switch (work_mode_flag)\r
+    {\r
+    case HRS_MODE:\r
+#ifdef HRS_ALG_LIB\r
+                               tyhx_hrs_set_living(1, 15, 30);\r
+        if(hx3695_hrs_enable()== SENSOR_OP_FAILED)\r
+        {\r
+            return false;\r
+        }\r
+#endif\r
+        break;\r
+\r
+    case LIVING_MODE:\r
+#ifdef CHECK_LIVING_LIB\r
+        if(hx3695_hrs_enable()== SENSOR_OP_FAILED)\r
+        {\r
+            return false;\r
+        }\r
+#endif\r
+        break;\r
+\r
+    case SPO2_MODE:\r
+#ifdef SPO2_DATA_CALI\r
+//        hx3695_spo2_data_cali_init();\r
+#endif\r
+\r
+#ifdef SPO2_ALG_LIB\r
+        tyhx_spo2_para_usuallyadjust(SPO2_LOW_XCORR_THRE,SPO2_LOW_SNR_THRE,COUNT_BLOCK_NUM,SPO2_BASE_LINE_INIT,SPO2_SLOPE,SPO2_GSEN_POW_THRE);\r
+        tyhx_spo2_para_barelychange(MEAN_NUM,SOP2_DEGLITCH_THRE,SPO2_REMOVE_JUMP_THRE, \\r
+                                    SPO2_LOW_CLIP_END_TIME,SPO2_LOW_CLIP_DN,SPO2_NORMAL_CLIP_DN, \\r
+                                    IR_AC_TOUCH_THRE,IR_FFT_POW_THRE,SPO2_CALI,SLOPE_PARA_MAX,SLOPE_PARA_MIN);\r
+                               tyhx_spo2_set_living(1, 15, 30);\r
+        if(hx3695_spo2_enable()== SENSOR_OP_FAILED)\r
+        {\r
+            return false;\r
+        }\r
+#endif\r
+        break;\r
+\r
+    case HRSPO2_MODE:\r
+#if defined(HRS_ALG_LIB) && defined (SPO2_ALG_LIB)\r
+        tyhx_spo2_para_usuallyadjust(SPO2_LOW_XCORR_THRE,SPO2_LOW_SNR_THRE,COUNT_BLOCK_NUM,SPO2_BASE_LINE_INIT,SPO2_SLOPE,SPO2_GSEN_POW_THRE);\r
+        tyhx_spo2_para_barelychange(MEAN_NUM,SOP2_DEGLITCH_THRE,SPO2_REMOVE_JUMP_THRE, \\r
+                                    SPO2_LOW_CLIP_END_TIME,SPO2_LOW_CLIP_DN,SPO2_NORMAL_CLIP_DN, \\r
+                                    IR_AC_TOUCH_THRE,IR_FFT_POW_THRE,SPO2_CALI,SLOPE_PARA_MAX,SLOPE_PARA_MIN);\r
+        if(hx3695_spo2_enable()== SENSOR_OP_FAILED)\r
+        {\r
+            return false;\r
+        }\r
+#endif\r
+\r
+    case HRV_MODE:\r
+#ifdef HRV_ALG_LIB\r
+        if(hx3695_hrv_enable()== SENSOR_OP_FAILED)\r
+        {\r
+            return false;\r
+        }\r
+#endif\r
+        break;\r
+\r
+    case WEAR_MODE:\r
+#ifdef CHECK_TOUCH_LIB\r
+        if(hx3695_check_touch_enable()== SENSOR_OP_FAILED)\r
+        {\r
+            return false;\r
+        }\r
+#endif\r
+        break;\r
+\r
+    case FT_LEAK_LIGHT_MODE:\r
+        if (!hx3695_chip_check())\r
+        {\r
+            AGC_LOG("hx3695 check id failed!\r\n");\r
+            return false;\r
+        }\r
+        hx3695_factroy_test(LEAK_LIGHT_TEST);\r
+        return true;\r
+\r
+        break;\r
+\r
+    case FT_GRAY_CARD_MODE:\r
+        if (!hx3695_chip_check())\r
+        {\r
+            AGC_LOG("hx3695 check id failed!\r\n");\r
+            return false;\r
+        }\r
+        hx3695_factroy_test(GRAY_CARD_TEST);\r
+        break;\r
+\r
+    case FT_INT_TEST_MODE:\r
+        hx3695_factroy_test(FT_INT_TEST);\r
+        break;\r
+\r
+    case FT_SINGLE_CHECK_MODE:\r
+        hx3695_factroy_test(SINGLE_CHECK_TEST);\r
+        break;\r
+\r
+    case FT_LED_OFF_MODE:\r
+        hx3695_factroy_test(LED_OFF_TEST);\r
+        break;\r
+\r
+    case FT_WEAR_MODE:\r
+        hx3695_factroy_test(WEAR_MODE_TEST);\r
+        break;\r
+\r
+    case LAB_TEST_MODE:\r
+#ifdef LAB_TEST\r
+        if(hx3695_lab_test_enable()== SENSOR_OP_FAILED)\r
+        {\r
+            return false;\r
+        }\r
+#endif\r
+        break;\r
+\r
+    default:\r
+        break;\r
+    }\r
+    return true;\r
+}\r
+\r
+void hx3695_agc_Int_handle(void)\r
+{\r
+    switch (work_mode_flag)\r
+    {\r
+    case HRS_MODE:\r
+#ifdef HRS_ALG_LIB\r
+        PPG_hrs_agc();\r
+#endif\r
+        break;\r
+\r
+    case LIVING_MODE:\r
+#ifdef HRS_ALG_LIB\r
+        PPG_hrs_agc();\r
+#endif\r
+        break;\r
+\r
+    case HRV_MODE:\r
+#ifdef HRV_ALG_LIB\r
+        PPG_hrv_agc();\r
+#endif\r
+        break;\r
+\r
+    case SPO2_MODE:\r
+#ifdef SPO2_ALG_LIB\r
+        PPG_spo2_agc();\r
+#endif\r
+        break;\r
+\r
+    case HRSPO2_MODE:\r
+#if defined(HRS_ALG_LIB) && defined (SPO2_ALG_LIB)\r
+        PPG_spo2_agc();\r
+#endif\r
+\r
+    case LAB_TEST_MODE:\r
+#ifdef LAB_TEST\r
+        hx3695_lab_test_Int_handle();\r
+#endif\r
+\r
+    default:\r
+        break;\r
+    }\r
+}\r
+\r
+void agc_timeout_handler(void * p_context)\r
+{\r
+    hx3695_agc_Int_handle();\r
+\r
+#if defined(GSEN_40MS_TIMMER)\r
+    hx3695_gesensor_Int_handle();\r
+#endif\r
+}\r
+\r
+void heart_rate_meas_timeout_handler(void * p_context)\r
+{\r
+    switch(work_mode_flag)\r
+    {\r
+    case HRS_MODE:\r
+#ifdef HRS_ALG_LIB\r
+        hx3695_hrs_ppg_Int_handle();\r
+#endif\r
+        break;\r
+\r
+    case HRV_MODE:\r
+#ifdef HRV_ALG_LIB\r
+        hx3695_hrv_ppg_Int_handle();\r
+#endif\r
+        break;\r
+\r
+    case SPO2_MODE:\r
+#ifdef SPO2_ALG_LIB\r
+        hx3695_spo2_ppg_Int_handle();\r
+#endif\r
+        break;\r
+\r
+    case WEAR_MODE:\r
+#ifdef CHECK_TOUCH_LIB\r
+        hx3695_wear_ppg_Int_handle();\r
+#endif\r
+        break;\r
+\r
+    case LIVING_MODE:\r
+#ifdef CHECK_LIVING_LIB\r
+        hx3695_living_Int_handle();\r
+#endif\r
+        break;\r
+\r
+    case HRSPO2_MODE:\r
+#if defined(HRS_ALG_LIB) && defined (SPO2_ALG_LIB)\r
+        hx3695_hrspo2_ppg_Int_handle();\r
+#endif\r
+\r
+    default:\r
+        break;\r
+    }\r
+}\r
+\r
+void hx3695_ppg_Int_handle(void)\r
+{\r
+    hx3695_agc_Int_handle();\r
+#if defined(INT_MODE)\r
+    switch(work_mode_flag)\r
+    {\r
+    case HRS_MODE:\r
+#ifdef HRS_ALG_LIB\r
+        hx3695_hrs_ppg_Int_handle();\r
+#endif\r
+        break;\r
+\r
+    case SPO2_MODE:\r
+#ifdef SPO2_ALG_LIB\r
+        hx3695_spo2_ppg_Int_handle();\r
+#endif\r
+        break;\r
+\r
+    case HRV_MODE:\r
+#ifdef HRV_ALG_LIB\r
+        hx3695_hrv_ppg_Int_handle();\r
+#endif\r
+        break;\r
+\r
+    case WEAR_MODE:\r
+#ifdef CHECK_TOUCH_LIB\r
+        hx3695_wear_ppg_Int_handle();\r
+#endif\r
+        break;\r
+\r
+    case LAB_TEST_MODE:\r
+#ifdef LAB_TEST\r
+        hx3695_lab_test_Int_handle();\r
+#endif\r
+\r
+    default:\r
+        break;\r
+    }\r
+#endif\r
+}\r
+\r
+\r
+\r
+#ifdef HRS_ALG_LIB\r
+/*TYHX ÐÄÂÊģʽÏ ¶ÁÈ¡PPG£¬ Ä¬ÈÏ320ms*/\r
+hrs_sensor_data_t   hrs_s_dat;\r
+//hx3695_results_t    alg_results_pre;\r
+\r
+void hx3695_hrs_ppg_Int_handle(void)\r
+{\r
+    uint8_t     ii=0;\r
+    hrs_results_t   alg_results = {MSG_HRS_ALG_NOT_OPEN,0,0,0,0};\r
+    hrs_wear_msg_code_t     hrs_wear_status = MSG_HRS_NO_WEAR;\r
+    int32_t     *PPG_buf = &(hrs_s_dat.green_data[0]);\r
+    int32_t    *ir_buf = &(hrs_s_dat.ir_data[0]);\r
+    uint8_t    *count = &(hrs_s_dat.count);\r
+    //int32_t  *s_buf = &(ppg_s_data.s_buf[0]);\r
+    int16_t    gsen_fifo_x_send[32]= {0};\r
+    int16_t    gsen_fifo_y_send[32]= {0};\r
+    int16_t    gsen_fifo_z_send[32]= {0};\r
+               \r
+                       HRS_CAL_SET_T cal;\r
+        cal = get_hrs_agc_status();\r
+\r
+#ifdef HR_VECTOR\r
+    for(ii=0; ii<8; ii++)\r
+    {\r
+        PPG_buf_vec[ii] = hrm_input_data[vec_send_cnt+ii];\r
+        gsen_fifo_x_send[ii] = gsen_input_data_x[vec_send_cnt+ii];\r
+        gsen_fifo_y_send[ii] = gsen_input_data_y[vec_send_cnt+ii];\r
+        gsen_fifo_z_send[ii] = gsen_input_data_z[vec_send_cnt+ii];\r
+    }\r
+    vec_send_cnt = vec_send_cnt+8;\r
+    *count = 8;\r
+    tyhx_hrs_alg_send_data(PPG_buf_vec,*count, gsen_fifo_x_send, gsen_fifo_y_send, gsen_fifo_z_send);\r
+\r
+#else\r
+    if(hx3695_hrs_read(&hrs_s_dat) == 0)\r
+    {\r
+        return;\r
+    }\r
+               \r
+#ifndef GSEN_40MS_TIMMER\r
+    readFifoByHrsModule();\r
+#endif\r
+//     DEBUG_PRINTF("\r\nsend  jlink cnt=%d\r\n",*count);              \r
+               \r
+    for(ii=0; ii<*count; ii++)\r
+    {\r
+        gsen_fifo_x_send[ii] = gsen_fifo_x[32-*count+ii];\r
+        gsen_fifo_y_send[ii] = gsen_fifo_y[32-*count+ii];\r
+        gsen_fifo_z_send[ii] = gsen_fifo_z[32-*count+ii];\r
+\r
+//                     DEBUG_PRINTF("gr,ir,gsen:%d/%d %d %d %d %d %d %d\r\n" ,1+ii,*count,PPG_buf[ii],ir_buf[0],gsen_fifo_x[ii],gsen_fifo_y[ii],gsen_fifo_z[ii],ppg_s_data.green_cur);\r
+    }\r
+\r
+    hrs_wear_status = hx3695_hrs_get_wear_status();\r
+    if(hrs_wear_status == MSG_HRS_WEAR)\r
+    {\r
+        tyhx_hrs_alg_send_data(PPG_buf, *count, gsen_fifo_x_send, gsen_fifo_y_send, gsen_fifo_z_send, cal.Group1_Ledidac);\r
+    }\r
+#endif\r
+\r
+    alg_results = tyhx_hrs_alg_get_results();\r
+    hrsresult.lastesthrs = alg_results.hr_result;\r
+               hrsresult.hr_living =  alg_results.living_status;\r
+               hrsresult.hr_living_qu = alg_results.hr_result_qual;\r
+         hrsresult.hr_living_std = alg_results.hr_result_std;\r
+               \r
+               \r
+               \r
+\r
+    DEBUG_PRINTF("data_cnt: %d,  hr_result:%d \r\n",alg_results.data_cnt, alg_results.hr_result);\r
+#ifdef BP_CUSTDOWN_ALG_LIB\r
+    bp_results_t    bp_alg_results;\r
+    bp_alg_results = tyhx_alg_get_bp_results();\r
+#endif\r
+\r
+////////////////////////////////////////BLE+DISPLAY/////////////////////////////////\r
+\r
+\r
+#ifdef HRS_BLE_APP\r
+    {\r
+        rawdata_vector_t rawdata;\r
+        for(ii=0; ii<*count; ii++)\r
+        {\r
+            rawdata.vector_flag = HRS_VECTOR_FLAG;\r
+            rawdata.data_cnt = alg_results.data_cnt-*count+ii;\r
+            rawdata.hr_result = alg_results.hr_result;\r
+            rawdata.red_raw_data = PPG_buf[ii];\r
+            rawdata.ir_raw_data = ir_buf[ii];\r
+            rawdata.gsensor_x = gsen_fifo_x_send[ii];\r
+            rawdata.gsensor_y = gsen_fifo_y_send[ii];\r
+            rawdata.gsensor_z = gsen_fifo_z_send[ii];\r
+            rawdata.red_cur = cal.Group1_Cur;\r
+            rawdata.ir_cur = cal.Group1_Ledidac;\r
+            \r
+            ble_rawdata_vector_push(rawdata);\r
+        }\r
+    }\r
+    ble_rawdata_send_handler();\r
+#endif\r
+\r
+////////////////////////////////////////////////////////////////////////////////////\r
+}\r
+#endif\r
+\r
+#ifdef CHECK_LIVING_LIB\r
+hrs_sensor_data_t  hrs_s_dat;  \r
+\r
+void hx3695_living_Int_handle(void)\r
+{\r
+    uint8_t     ii=0;\r
+    hx3695_living_results_t     living_alg_results = {MSG_LIVING_NO_WEAR,0,0,0};\r
+    int32_t     *PPG_buf = &(hrs_s_dat.green_data[0]);\r
+    int32_t     *ir_buf = &(hrs_s_dat.ir_data[0]);\r
+    uint8_t     *count = &(hrs_s_dat.count);\r
+    hrs_wear_msg_code_t     hrs_wear_status = MSG_HRS_NO_WEAR;\r
+    int16_t    gsen_fifo_x_send[32]= {0};\r
+    int16_t    gsen_fifo_y_send[32]= {0};\r
+    int16_t    gsen_fifo_z_send[32]= {0};\r
+\r
+    if(hx3695_hrs_read(&hrs_s_dat) == 0)\r
+    {\r
+        return;\r
+    }\r
+               \r
+#ifndef GSEN_40MS_TIMMER\r
+    readFifoByHrsModule();\r
+#endif\r
+       DEBUG_PRINTF("\r\nsend  jlink cnt=%d\r\n",*count);      \r
+               \r
+               \r
+    for(ii=0; ii<*count; ii++)\r
+    {\r
+        gsen_fifo_x_send[ii] = gsen_fifo_x[32-*count+ii];\r
+        gsen_fifo_y_send[ii] = gsen_fifo_y[32-*count+ii];\r
+        gsen_fifo_z_send[ii] = gsen_fifo_z[32-*count+ii];\r
+\r
+                       DEBUG_PRINTF("ger:%d/%d %d %d %d %d %d %d\r\n" ,1+ii,*count,PPG_buf[ii],ir_buf[0],gsen_fifo_x[ii],gsen_fifo_y[ii],gsen_fifo_z[ii],ppg_s_data.green_cur);\r
+    }\r
+    hrs_wear_status = hx3695_hrs_get_wear_status();\r
+    if(hrs_wear_status == MSG_HRS_WEAR)\r
+    {\r
+        hx3695_living_send_data(PPG_buf, *count, gsen_fifo_x_send, gsen_fifo_y_send, gsen_fifo_z_send);\r
+    }\r
+    living_alg_results = hx3695_living_get_results();\r
+    DEBUG_PRINTF("res:%d %d %d %d\r\n",living_alg_results.data_cnt,living_alg_results.motion_status,living_alg_results.signal_quality,hrs_wear_status);\r
+}\r
+#endif\r
+\r
+\r
+#ifdef SPO2_ALG_LIB\r
+\r
+#ifdef SPO2_DATA_CALI\r
+void hx3695_spo2_data_cali_init(void)\r
+{\r
+    uint8_t ii;\r
+    for(ii=0; ii<4; ii++)\r
+    {\r
+        red_data_fifo[ii] = 0;\r
+        ir_data_fifo[ii] = 0;\r
+    }\r
+    red_dc_temp = 0;\r
+    ir_dc_temp = 0;\r
+    red_data_pre = 0;\r
+    ir_data_pre = 0;\r
+    red_jump_delta = 0;\r
+    ir_jump_delta = 0;\r
+    cali_data_cnt = 0;\r
+}\r
+\r
+int32_t hx3695_red_data_cali(int32_t red_new_raw_data)\r
+{\r
+    uint8_t ii;\r
+    int32_t red_data_final;\r
+    int32_t red_data_cali;\r
+    spo2_wear_msg_code_t touch_status;\r
+    touch_status = hx3695_spo2_get_wear_status();\r
+    if(touch_status == MSG_SPO2_NO_WEAR)\r
+    {\r
+        cali_data_cnt = 0;\r
+        red_data_cali = red_new_raw_data;\r
+        for(ii=0; ii<4; ii++)\r
+        {\r
+            red_data_fifo[ii] = 0;\r
+        }\r
+        red_dc_temp = 0;\r
+    }\r
+    else\r
+    {\r
+        for(ii=3; ii>0; ii--)\r
+        {\r
+            red_data_fifo[ii] = red_data_fifo[ii-1];\r
+        }\r
+        red_data_fifo[0] = red_new_raw_data;\r
+        if(cali_data_cnt>=25)\r
+        {\r
+            if ((((red_data_fifo[1] - red_data_fifo[2]) > SOP2_DEGLITCH_THRE) && ((red_data_fifo[1] - red_new_raw_data) > SOP2_DEGLITCH_THRE)) || \\r
+                    (((red_data_fifo[1] - red_data_fifo[2]) < -SOP2_DEGLITCH_THRE) && ((red_data_fifo[1] - red_new_raw_data) < -SOP2_DEGLITCH_THRE)))\r
+            {\r
+                red_new_raw_data = red_data_fifo[2];\r
+                red_data_fifo[1] = red_data_fifo[2];\r
+            }\r
+            else\r
+            {\r
+                red_new_raw_data = red_data_fifo[1];\r
+            }\r
+            if ((abs((red_new_raw_data - red_jump_delta) - red_data_pre) > SPO2_REMOVE_JUMP_THRE))\r
+            {\r
+                red_jump_delta = red_new_raw_data - red_data_pre;\r
+            }\r
+            red_data_cali = red_new_raw_data - red_jump_delta;\r
+            red_data_pre = red_data_cali;\r
+        }\r
+        else\r
+        {\r
+            red_data_cali = red_data_fifo[1];\r
+            red_data_pre = red_data_fifo[1];\r
+        }\r
+    }\r
+    if(cali_data_cnt<=30)\r
+    {\r
+        red_dc_temp = red_data_cali;\r
+        red_data_final = red_new_raw_data;\r
+    }\r
+    else\r
+    {\r
+        //red_dc_temp = (red_dc_temp*31 + red_data_cali)>>5;\r
+        red_dc_temp = 0;\r
+        red_data_final = red_data_cali - red_dc_temp + 2608*50*hx3695_spo2_agc_red_idac;\r
+    }\r
+    //DEBUG_PRINTF("%d %d %d %d %d %d\r\n", cali_data_cnt, red_new_raw_data, red_data_final, red_data_cali, red_dc_temp, hx3695_spo2_agc_red_idac);\r
+    return red_data_final;\r
+}\r
+int32_t hx3695_ir_data_cali(int32_t ir_new_raw_data)\r
+{\r
+    uint8_t ii;\r
+    int32_t ir_data_final;\r
+    int32_t ir_data_cali;\r
+    spo2_wear_msg_code_t touch_status;\r
+    touch_status = hx3695_spo2_get_wear_status();\r
+    if(touch_status == MSG_SPO2_NO_WEAR)\r
+    {\r
+        cali_data_cnt = 0;\r
+        ir_data_cali = ir_new_raw_data;\r
+        for(ii=0; ii<4; ii++)\r
+        {\r
+            ir_data_fifo[ii] = 0;\r
+        }\r
+        ir_dc_temp = 0;\r
+    }\r
+    else\r
+    {\r
+        for(ii=3; ii>0; ii--)\r
+        {\r
+            ir_data_fifo[ii] = ir_data_fifo[ii-1];\r
+        }\r
+        ir_data_fifo[0] = ir_new_raw_data;\r
+        cali_data_cnt++;\r
+        if(cali_data_cnt>=25)\r
+        {\r
+            if ((((ir_data_fifo[1] - ir_data_fifo[2]) > SOP2_DEGLITCH_THRE) && ((ir_data_fifo[1] - ir_new_raw_data) > SOP2_DEGLITCH_THRE)) || \\r
+                    (((ir_data_fifo[1] - ir_data_fifo[2]) < -SOP2_DEGLITCH_THRE) && ((ir_data_fifo[1] - ir_new_raw_data) < -SOP2_DEGLITCH_THRE)))\r
+            {\r
+                ir_new_raw_data = ir_data_fifo[2];\r
+                ir_data_fifo[1] = ir_data_fifo[2];\r
+            }\r
+            else\r
+            {\r
+                ir_new_raw_data = ir_data_fifo[1];\r
+            }\r
+            if ((abs((ir_new_raw_data - ir_jump_delta) - ir_data_pre) > SPO2_REMOVE_JUMP_THRE))\r
+            {\r
+                ir_jump_delta = ir_new_raw_data - ir_data_pre;\r
+            }\r
+            ir_data_cali = ir_new_raw_data - ir_jump_delta;\r
+            ir_data_pre = ir_data_cali;\r
+        }\r
+        else\r
+        {\r
+            ir_data_cali = ir_data_fifo[1];\r
+            ir_data_pre = ir_data_fifo[1];\r
+        }\r
+    }\r
+    if(cali_data_cnt<=30)\r
+    {\r
+        ir_dc_temp = ir_data_cali;\r
+        ir_data_final = ir_new_raw_data;\r
+    }\r
+    else\r
+    {\r
+        //ir_dc_temp = (ir_dc_temp*31 + ir_data_cali)>>5;\r
+        ir_dc_temp = 0;\r
+        ir_data_final = ir_data_cali - ir_dc_temp + 2608*50*hx3695_spo2_agc_ir_idac;\r
+    }\r
+    //DEBUG_PRINTF("%d %d %d %d %d %d\r\n", cali_data_cnt, ir_new_raw_data, ir_data_final, ir_data_cali, ir_dc_temp, hx3695_spo2_agc_ir_idac);\r
+    return ir_data_final;\r
+}\r
+#endif //SPO2_DATA_CALI\r
+\r
+//#ifdef SPO2_ALG_LIB\r
+spo2_sensor_data_t spo2_s_dat;\r
+\r
+/*TYHX ÑªÑõģʽÏ ¶ÁÈ¡PPG£¬ Ä¬ÈÏ320ms*/\r
+void hx3695_spo2_ppg_Int_handle(void)\r
+{\r
+    uint8_t     ii=0;\r
+    spo2_results_t spo2_alg_results = {MSG_SPO2_ALG_NOT_OPEN,0,0,0,0,0,0,1,0,0};\r
+    spo2_wear_msg_code_t spo2_wear_status = MSG_SPO2_NO_WEAR;\r
+    SPO2_CAL_SET_T cal = get_spo2_agc_status();\r
+    int32_t     *red_buf = &(spo2_s_dat.red_data[0]);\r
+    int32_t     *ir_buf = &(spo2_s_dat.ir_data1[0]);\r
+    int32_t     *green_buf =  &(spo2_s_dat.green_data[0]);\r
+    uint8_t     *count = &(spo2_s_dat.count);\r
+    int16_t    gsen_fifo_x_send[32]= {0};\r
+    int16_t    gsen_fifo_y_send[32]= {0};\r
+    int16_t    gsen_fifo_z_send[32]= {0};\r
+#ifdef SPO2_DATA_CALI\r
+    int32_t red_data_cali, ir_data_cali;\r
+#endif\r
+\r
+#ifdef SPO2_VECTOR\r
+    for(ii=0; ii<8; ii++)\r
+    {\r
+        red_buf_vec[ii] = vec_red_data[spo2_send_cnt+ii];\r
+        ir_buf_vec[ii] = vec_ir_data[spo2_send_cnt+ii];\r
+        green_buf_vec[ii] = vec_green_data[spo2_send_cnt+ii];\r
+    }\r
+    spo2_send_cnt = spo2_send_cnt+8;\r
+    *count = 8;\r
+    tyhx_spo2_alg_send_data(red_buf, ir_buf, green_buf, cal.R_LEDDAC, cal.IR_LEDDAC1, cal.R_LEDDAC, gsen_fifo_x_send, gsen_fifo_y_send, gsen_fifo_z_send, *count);\r
+\r
+#else\r
+    if(hx3695_spo2_read(&spo2_s_dat) == 0)\r
+    {\r
+        return;\r
+    }\r
+               \r
+               \r
+#ifndef GSEN_40MS_TIMMER\r
+    readFifoByHrsModule();\r
+#endif\r
+        DEBUG_PRINTF("\r\n send1  jlink cnt=%d\r\n",*count);   \r
+               \r
+    for(ii=0; ii<*count; ii++)\r
+    {\r
+        gsen_fifo_x_send[ii] = gsen_fifo_x[32-*count+ii];\r
+        gsen_fifo_y_send[ii] = gsen_fifo_y[32-*count+ii];\r
+        gsen_fifo_z_send[ii] = gsen_fifo_z[32-*count+ii];\r
+        //DEBUG_PRINTF("%d/%d %d %d %d %d %d %d\r\n" ,1+ii,*count,red_buf[ii],ir_buf[ii],green_buf[ii],gsen_fifo_x[ii],gsen_fifo_y[ii],gsen_fifo_z[ii]);\r
+\r
+    }\r
+    //DEBUG_PRINTF("%d %d %d %d %d %d\r\n", cal.R_LED, cal.IR_LED, cal.G_LED, cal.R_LEDDAC, cal.IR_LEDDAC, cal.G_LEDDAC);\r
+    spo2_wear_status = hx3695_spo2_get_wear_status();\r
+    if(spo2_wear_status == MSG_SPO2_WEAR)\r
+    {\r
+        tyhx_spo2_alg_send_data(red_buf, ir_buf, green_buf, cal.R_LEDDAC, cal.IR_LEDDAC1, cal.G_LEDDAC, gsen_fifo_x_send, gsen_fifo_y_send, gsen_fifo_z_send, *count);\r
+    }\r
+#endif\r
+\r
+    spo2_alg_results = tyhx_spo2_alg_get_results();\r
+//------------------------adjust-------------------\r
+    //DEBUG_PRINTF("block_cnt: %d, data_cnt:%d, hr_result:%d,ir_quality:%d,motion:%d,poor_signal:%d,reliable_score_result:%d,screen_up:%d,spo2_result:%d\r\n",spo2_alg_results.block_cnt,spo2_alg_results.data_cnt,spo2_alg_results.hr_result,spo2_alg_results.ir_quality,spo2_alg_results.motion,spo2_alg_results.poor_signal,spo2_alg_results.reliable_score_result,spo2_alg_results.screen_up,spo2_alg_results.spo2_result);\r
+\r
+    hrsresult.lastestspo2 = spo2_alg_results.spo2_result;\r
+\r
+\r
+/////////////////////////////////////////BLE+DISPLAY//////////////////////////////////////////\r
+\r
+\r
+#ifdef HRS_BLE_APP\r
+    {\r
+        rawdata_vector_t rawdata;\r
+        SPO2_CAL_SET_T cal= get_spo2_agc_status();\r
+        for(ii=0; ii<*count; ii++)\r
+        {\r
+#ifdef SPO2_DATA_CALI\r
+            ir_data_cali = hx3695_ir_data_cali(ir_buf[ii]);\r
+            red_data_cali = hx3695_red_data_cali(red_buf[ii]);\r
+            rawdata.red_raw_data = red_data_cali>>2;\r
+            rawdata.ir_raw_data = ir_data_cali>>2;\r
+#else\r
+            rawdata.red_raw_data = red_buf[ii];\r
+            rawdata.ir_raw_data = ir_buf[ii];\r
+#endif\r
+            rawdata.vector_flag = SPO2_VECTOR_FLAG;\r
+            rawdata.data_cnt = cal.G_LEDDAC;\r
+            rawdata.hr_result = spo2_alg_results.spo2_result;\r
+            rawdata.gsensor_x = (int16_t)(green_buf[ii]>>5);\r
+            rawdata.gsensor_y = cal.R_LEDDAC;\r
+            rawdata.gsensor_z = cal.IR_LEDDAC1;\r
+            rawdata.red_cur = cal.R_LED;\r
+            rawdata.ir_cur = cal.IR_LED1;\r
+            ble_rawdata_vector_push(rawdata);\r
+        }\r
+               ble_rawdata_send_handler();\r
+    }\r
+#endif\r
+\r
+/////////////////////////////////////////////////////////////////////////////////////////////////\r
+}\r
+#endif //SPO2_ALG_LIB\r
+\r
+\r
+\r
+#if defined(HRS_ALG_LIB) && defined (SPO2_ALG_LIB)\r
+spo2_sensor_data_t  hrspo2_s_data;\r
+\r
+void hx3695_hrspo2_ppg_Int_handle(void)\r
+{\r
+    uint8_t     ii=0;\r
+    spo2_results_t  spo2_alg_results = {MSG_SPO2_ALG_NOT_OPEN,0,0,0,0,0,0};\r
+    hrs_results_t   alg_results = {MSG_HRS_ALG_NOT_OPEN,0,0,0,0};\r
+    spo2_wear_msg_code_t spo2_wear_status = MSG_SPO2_NO_WEAR;\r
+    SPO2_CAL_SET_T cal = get_spo2_agc_status();\r
+    int32_t *red_buf = &(hrspo2_s_data.red_data[0]);\r
+    int32_t *ir_buf = &(hrspo2_s_data.ir_data1[0]);\r
+    int32_t *green_buf = &(hrspo2_s_data.red_data[0]);       // &(hrspo2_s_data.green_data[0]);\r
+    uint8_t *count = &(ppg_s_data.count);\r
+    int16_t gsen_fifo_x_send[32]= {0};\r
+    int16_t gsen_fifo_y_send[32]= {0};\r
+    int16_t gsen_fifo_z_send[32]= {0};\r
+#ifdef SPO2_DATA_CALI\r
+    int32_t red_data_cali, ir_data_cali;\r
+#endif\r
+\r
+    if(hx3695_spo2_read(&hrspo2_s_data) == NULL)\r
+    {\r
+        return;\r
+    }\r
+               \r
+#ifndef GSEN_40MS_TIMMER\r
+    readFifoByHrsModule();\r
+#endif\r
+       DEBUG_PRINTF("\r\nsend  jlink cnt=%d\r\n",*count);              \r
+               \r
+               \r
+    for(ii=0; ii<*count; ii++)\r
+    {\r
+        gsen_fifo_x_send[ii] = gsen_fifo_x[32-*count+ii];\r
+        gsen_fifo_y_send[ii] = gsen_fifo_y[32-*count+ii];\r
+        gsen_fifo_z_send[ii] = gsen_fifo_z[32-*count+ii];\r
+\r
+    }\r
+    spo2_wear_status = hx3695_spo2_get_wear_status();\r
+    if(spo2_wear_status == MSG_SPO2_WEAR)\r
+    {\r
+        tyhx_spo2_alg_send_data(red_buf, ir_buf, green_buf, cal.R_LEDDAC, cal.IR_LEDDAC1, cal.R_LEDDAC, gsen_fifo_x_send, gsen_fifo_y_send, gsen_fifo_z_send, *count);\r
+        //tyhx_hrs_alg_send_data(green_buf,*count, gsen_fifo_x_send, gsen_fifo_y_send, gsen_fifo_z_send);\r
+        //DEBUG_PRINTF("%d/%d %d %d %d %d %d %d\r\n" ,1+ii,*count,red_buf[ii],ir_buf[ii],green_buf[ii],gsen_fifo_x[ii],gsen_fifo_y[ii],gsen_fifo_z[ii]);\r
+    }\r
+    //DEBUG_PRINTF("%d %d %d %d %d %d\r\n", cal.R_LED, cal.IR_LED, cal.G_LED, cal.R_LEDDAC, cal.IR_LEDDAC, cal.G_LEDDAC);\r
+\r
+    spo2_alg_results = tyhx_spo2_alg_get_results();\r
+    alg_results = tyhx_hrs_alg_get_results();\r
+    //DEBUG_PRINTF("spo2_wear_status: %d, hr_result:%d, spo2_result:%d\r\n" ,spo2_wear_status, spo2_alg_results.hr_result,spo2_alg_results.spo2_result);\r
+\r
+/////////////////////////////////////////BLE+DISPLAY//////////////////////////////////////////\r
+\r
+#ifdef HRS_BLE_APP\r
+    {\r
+        rawdata_vector_t rawdata;\r
+        SPO2_CAL_SET_T cal= get_spo2_agc_status();\r
+        for(ii=0; ii<*count; ii++)\r
+        {\r
+#ifdef SPO2_DATA_CALI\r
+            ir_data_cali = hx3695_ir_data_cali(ir_buf[ii]);\r
+            red_data_cali = hx3695_red_data_cali(red_buf[ii]);\r
+            rawdata.red_raw_data = red_data_cali>>2;\r
+            rawdata.ir_raw_data = ir_data_cali>>2;\r
+#else\r
+            rawdata.red_raw_data = red_buf[ii];\r
+            rawdata.ir_raw_data = ir_buf[ii];\r
+#endif\r
+            rawdata.vector_flag = SPO2_VECTOR_FLAG;\r
+            rawdata.data_cnt = cal.G_LEDDAC;\r
+            rawdata.hr_result = spo2_alg_results.spo2_result;\r
+            rawdata.gsensor_x = (int16_t)(green_buf[ii]>>5);\r
+            rawdata.gsensor_y = cal.R_LEDDAC;\r
+            rawdata.gsensor_z = cal.IR_LEDDAC1;\r
+            rawdata.red_cur = cal.R_LED;\r
+            rawdata.ir_cur = cal.IR_LED1;\r
+            ble_rawdata_vector_push(rawdata);\r
+        }\r
+               ble_rawdata_send_handler();\r
+    }\r
+#endif\r
+\r
+/////////////////////////////////////////////////////////////////////////////////////////////////\r
+}\r
+#endif //defined(HRS_ALG_LIB) && defined (SPO2_ALG_LIB)\r
+\r
+#ifdef HRV_ALG_LIB\r
+hrv_sensor_data_t   hrv_s_dat;\r
+void hx3695_hrv_ppg_Int_handle(void)\r
+{\r
+    uint8_t        ii=0;\r
+    hrv_results_t hrv_alg_results= {MSG_HRV_ALG_NOT_OPEN,0,0,0,0,0,1,0,0};\r
+    int32_t *PPG_buf = &(hrv_s_dat.green_data[0]);\r
+    int32_t *ir_buf = &(hrv_s_dat.ir_data[0]);\r
+    uint8_t *count = &(hrv_s_dat.count);\r
+    hrv_wear_msg_code_t hrv_wear_status = MSG_HRV_NO_WEAR;\r
+    int16_t gsen_fifo_x_send[64]= {0};\r
+    int16_t gsen_fifo_y_send[64]= {0};\r
+    int16_t gsen_fifo_z_send[64]= {0};\r
+\r
+    // DEBUG_PRINTF("1111 \r\n" );\r
+#ifdef HRV_TESTVEC\r
+    int32_t hrm_raw_data;\r
+    hrm_raw_data = vec_data[vec_data_cnt];\r
+    vec_data_cnt++;\r
+    alg_hrv_results = hx3695_hrv_alg_send_data(hrm_raw_data, 0, 0);\r
+#else\r
+    if(hx3695_hrv_read(&hrv_s_dat) == 0)\r
+    {\r
+        TYHX_LOG("read ppg_s data invalid\r\n");\r
+        return;\r
+    }\r
+               \r
+#ifndef GSEN_40MS_TIMMER\r
+    readFifoByHrsModule();\r
+#endif\r
+       DEBUG_PRINTF("\r\nsend  jlink cnt=%d\r\n",*count);                              \r
+       \r
+    for(ii=0; ii<*count; ii++)\r
+    {\r
+        gsen_fifo_x_send[ii] = gsen_fifo_x[32-8+ii%8];\r
+        gsen_fifo_y_send[ii] = gsen_fifo_y[32-8+ii%8];\r
+        gsen_fifo_z_send[ii] = gsen_fifo_z[32-8+ii%8];\r
+        //  DEBUG_PRINTF("%d/%d %d %d %d %d %d \r\n" ,1+ii,*count,PPG_buf[ii],ir_buf[0],gsen_fifo_x_send[ii] ,gsen_fifo_y_send[ii] ,gsen_fifo_z_send[ii] );\r
+\r
+    }\r
+    hrv_wear_status = hx3695_hrv_get_wear_status();\r
+//    DEBUG_PRINTF("wear:%d \r\n" ,hrv_wear_status);\r
+    if(hrv_wear_status==MSG_HRS_WEAR)\r
+    {\r
+        hrv_alg_results = tyhx_hrv_alg_send_bufdata(PPG_buf, *count, gsen_fifo_x_send, gsen_fifo_y_send, gsen_fifo_z_send);\r
+        hrsresult.lastesthrv = hrv_alg_results.hrv_result;\r
+        TYHX_LOG("get the hrv = %d\r\n",hrv_alg_results.hrv_result);\r
+    }\r
+    //--------------adjust----------------\r
+//     hrv_alg_results.motion,hrv_alg_results.screen_up;\r
+    //DEBUG_PRINTF("data_cnt:%d hrv_result:%d motion:%d p_m:%d screen_up:%d signal_quality:%d \r\n", hrv_alg_results.data_cnt,hrv_alg_results.hrv_result,hrv_alg_results.motion,hrv_alg_results.p_m,hrv_alg_results.screen_up,hrv_alg_results.signal_quality);\r
+#endif\r
+\r
+/////////////////////////////////////////BLE+DISPLAY//////////////////////////////////////////\r
+\r
+\r
+#ifdef HRS_BLE_APP\r
+    {\r
+        rawdata_vector_t rawdata;\r
+        HRS_CAL_SET_T cal= get_hrs_agc_status();\r
+        for(ii=0; ii<*count; ii++)\r
+        {\r
+            rawdata.vector_flag = HRS_VECTOR_FLAG;\r
+            rawdata.data_cnt = 0;\r
+            rawdata.hr_result = hrv_alg_results.hrv_result;\r
+            rawdata.red_raw_data = PPG_buf[ii];\r
+            rawdata.ir_raw_data = 0;\r
+            rawdata.gsensor_x = gsen_fifo_x_send[ii];\r
+            rawdata.gsensor_y = gsen_fifo_y_send[ii];\r
+            rawdata.gsensor_z = gsen_fifo_z_send[ii];\r
+            rawdata.red_cur = cal.Group1_Cur;\r
+            rawdata.ir_cur = 0;\r
+            ble_rawdata_vector_push(rawdata);\r
+        }\r
+    }\r
+\r
+    ble_rawdata_send_handler();\r
+#endif\r
+\r
+//////////////////////////////////////////////////////////////////////////////////////////////\r
+}\r
+#endif\r
+\r
+#ifdef CHECK_TOUCH_LIB\r
+void hx3695_wear_ppg_Int_handle(void)\r
+{\r
+    uint8_t *count = &(ppg_s_data.count);\r
+    int32_t *ir_buf = &(ppg_s_data.ir_data[0]);\r
+    hx3695_wear_msg_code_t hx3695_wear_status;\r
+       \r
+    hx3695_check_touch_read(&ppg_s_data);\r
+    hx3695_wear_status = hx3695_check_touch_send_data(ir_buf,*count);\r
+    hrsresult.wearstatus = hx3695_wear_status;\r
+//    for(int i=0;i<*count;i++)\r
+//    {\r
+//        DEBUG_PRINTF("%d,%d,%d,%d,%d,%d\r\n",1+i,*count,ir_buf[i],ppg_s_data.s_buf[i*2],ppg_s_data.s_buf[i*2+1],hx3695_wear_status);\r
+//    }\r
+}\r
+#endif\r
+\r
+#ifdef LAB_TEST\r
+void hx3695_lab_test_Int_handle(void)\r
+{\r
+    NOISE_PS_T ps_noise;\r
+    ps_noise = hx3695_lab_test_read_packet();\r
+    DEBUG_PRINTF("%d %d %d %d\r\n", ps_noise.p1_noise, ps_noise.p2_noise, ps_noise.p3_noise, ps_noise.p4_noise);\r
+}\r
+#endif\r
+\r
+\r
+#endif  //CHIP_HX3695\r
diff --git a/code/sdk/drivers/peripheral/ppg/hx3695/hx3695.h b/code/sdk/drivers/peripheral/ppg/hx3695/hx3695.h
new file mode 100644 (file)
index 0000000..a2ac8ce
--- /dev/null
@@ -0,0 +1,292 @@
+#ifndef _hx3695_H_\r
+#define _hx3695_H_\r
+#include <stdint.h>\r
+#include <stdbool.h>\r
+\r
+/********************* alg_swi *********************\r
+HRS_ALG_LIB   ÐÄÂʹ¦ÄÜ\r
+SPO2_ALG_LIB  ÑªÑõ¹¦ÄÜ\r
+HRV_ALG_LIB   HRV¹¦ÄÜ\r
+CHECK_TOUCH_LIB   ´¿Åå´÷¹¦ÄÜ£¨·ÇÐÄÂÊѪÑõģʽ£©\r
+CHECK_LIVING_LIB  ´¿ÎïÌåʶ±ð¹¦ÄÜ£¨·ÇÐÄÂÊѪÑõģʽ£©\r
+BP_CUSTDOWN_ALG_LIB  ÑªÑ¹¹¦ÄÜ\r
+\r
+TIMMER_MODE  ¶¨Ê±Æ÷ģʽ£¬ ¶ÁPPGÊý¾Ý£¬ Ä¬ÈϲÉÓö¨Ê±Æ÷ģʽ\r
+INT_MODE     ÖжÏģʽ£¬¶ÁPPGÊý¾Ý\r
+\r
+DEMO_MI      demoÏà¹ØÅäÖ㬠¿Í»§¹Ø±Õ£¬ ÔÚÏÂÃæelseÀï½øÐÐÅäÖÃ\r
+HRS_BLE_APP  DEMOÀ¶ÑÀ¿ØÖƺ꣬ ¿Í»§¹Ø±Õ\r
+SPO2_DATA_CALI   ÑªÑõDC²¹³¥Ä£Ê½£¬ ¿Í»§¹Ø±Õ\r
+HRS_DEBUG    µ÷ÊԺ꣬ ¸ù¾Ýƽ̨¶¨Òå´òÓ¡º¯Êý\r
+AGC_DEBUG    µ÷ÊԺ꣬ ¸ù¾Ýƽ̨¶¨Òå´òÓ¡º¯Êý\r
+GSEN_40MS_TIMMER   DEMOµ÷ÊÔʹÓ㬠¿Í»§¹Ø±Õ\r
+NEW_GSEN_SCHME     DEMOµ÷ÊÔʹÓ㬠¿Í»§¹Ø±Õ\r
+*/\r
+#define HRS_ALG_LIB   \r
+#define SPO2_ALG_LIB\r
+#define HRV_ALG_LIB\r
+//#define CHECK_TOUCH_LIB\r
+//#define CHECK_LIVING_LIB\r
+#define BP_CUSTDOWN_ALG_LIB\r
+\r
+//**************** read_data_mode ******************//\r
+#define TIMMER_MODE           //timmer read fifo\r
+//#define INT_MODE                             //fifo_all_most_full\r
+\r
+//****************** gsen_cgf *********************//\r
+//#define GSEN_40MS_TIMMER\r
+//#define NEW_GSEN_SCHME\r
+\r
+//****************** other_cgf ********************//\r
+#define DEMO_COMMON\r
+//#define HRS_BLE_APP\r
+//#define SPO2_DATA_CALI\r
+\r
+//***************** vecter_swi ********************//\r
+//#define SPO2_VECTOR\r
+//#define HR_VECTOR\r
+//#define HRV_TESTVEC\r
+\r
+//**************** lab_test_mode ******************//\r
+//#define LAB_TEST             \r
+//#define LAB_TEST_AGC                                                 \r
+\r
+//****************** print_swi ********************//\r
+//#define HRS_DEBUG\r
+//#define AGC_DEBUG\r
+\r
+//**************************************************//\r
+\r
+#ifdef AGC_DEBUG\r
+#define  AGC_LOG(...)     SEGGER_RTT_printf(0,__VA_ARGS__)\r
+#else\r
+#define         AGC_LOG(...)\r
+#endif\r
+\r
+#ifdef HRS_DEBUG\r
+#define  DEBUG_PRINTF(...)     SEGGER_RTT_printf(0,__VA_ARGS__)\r
+#else\r
+#define         DEBUG_PRINTF(...)\r
+#endif\r
+\r
+\r
+#if defined(DEMO_COMMON)\r
+       #define HRS4100_IIC_CLK  30\r
+       #define HRS4100_IIC_SDA  0   \r
+       #define LIS3DH_IIC_CLK   18\r
+       #define LIS3DH_IIC_SDA   16\r
+       #define EXT_INT_PIN      1\r
+       #define GREEN_LED_SLE    0x10\r
+       #define RED_LED_SLE      0x20\r
+       #define IR_LED_SLE       0x40\r
+       #define RED_AGC_OFFSET   64   //32\r
+       #define IR_AGC_OFFSET    64   //32\r
+       #define GREEN_AGC_OFFSET 4   //10\r
+       #define HR_GREEN_AGC_OFFSET 20\r
+       #define HR_GREEN1_AGC_OFFSET 24\r
+       #define HR_GREEN2_AGC_OFFSET 24\r
+       #define HR_GREEN3_AGC_OFFSET 24\r
+       \r
+       \r
+       \r
+       #define BIG_SCREEN\r
+       \r
+#elif defined(DEMO_MI)\r
+       #define HRS4100_IIC_CLK  30\r
+       #define HRS4100_IIC_SDA  0   \r
+       #define LIS3DH_IIC_CLK   18\r
+       #define LIS3DH_IIC_SDA   16\r
+       #define EXT_INT_PIN      1\r
+       #define GREEN_LED_SLE    1\r
+       #define RED_LED_SLE      2\r
+       #define IR_LED_SLE       4\r
+       #define RED_AGC_OFFSET   50\r
+       #define IR_AGC_OFFSET    50\r
+       #define GREEN_AGC_OFFSET 4\r
+       #define HR_GREEN_AGC_OFFSET 4\r
+       #define BIG_SCREEN\r
+       \r
+#elif defined(DEMO_NEW)\r
+       #define HRS4100_IIC_CLK  30\r
+       #define HRS4100_IIC_SDA  0   \r
+       #define LIS3DH_IIC_CLK   18\r
+       #define LIS3DH_IIC_SDA   16\r
+       #define EXT_INT_PIN      1\r
+       #define GREEN_LED_SLE    1\r
+       #define RED_LED_SLE      2\r
+       #define IR_LED_SLE       4\r
+       #define RED_AGC_OFFSET   75\r
+       #define IR_AGC_OFFSET    75\r
+       #define GREEN_AGC_OFFSET 4\r
+       #define HR_GREEN_AGC_OFFSET 8\r
+       #define BIG_SCREEN\r
+  \r
+#elif defined(EVB)\r
+       #define HRS4100_IIC_CLK  9\r
+       #define HRS4100_IIC_SDA  10  \r
+       #define LIS3DH_IIC_CLK   13\r
+       #define LIS3DH_IIC_SDA   14\r
+       #define EXT_INT_PIN      11\r
+       #define GREEN_LED_SLE    1\r
+       #define RED_LED_SLE      2\r
+       #define IR_LED_SLE       4\r
+       #define RED_AGC_OFFSET   64\r
+       #define IR_AGC_OFFSET    64\r
+       #define GREEN_AGC_OFFSET 8\r
+       #define HR_GREEN_AGC_OFFSET 10\r
+    \r
+#else\r
+       #define GREEN_LED_SLE    1\r
+       #define RED_LED_SLE      4\r
+       #define IR_LED_SLE       2\r
+       #define RED_AGC_OFFSET   64\r
+       #define IR_AGC_OFFSET    64\r
+       #define GREEN_AGC_OFFSET 8\r
+    \r
+#endif\r
+\r
+typedef enum {    \r
+       PPG_INIT, \r
+       PPG_OFF, \r
+       PPG_LED_OFF,\r
+       CAL_INIT,\r
+       CAL_OFF,\r
+       RECAL_INIT    \r
+} hx3695_mode_t;\r
+\r
+typedef enum {    \r
+       SENSOR_OK, \r
+       SENSOR_OP_FAILED,   \r
+} SENSOR_ERROR_T;\r
+\r
+\r
+typedef enum {    \r
+       DATA_TYPE_PPG, \r
+       DATA_TYPE_GSEN,   \r
+} SENSOR_TYPE_T;\r
+\r
+typedef enum {    \r
+       HRS_MODE, \r
+       SPO2_MODE,\r
+       HRSPO2_MODE,\r
+       WEAR_MODE,\r
+       HRV_MODE,\r
+       LIVING_MODE,\r
+       LAB_TEST_MODE,\r
+       FT_LEAK_LIGHT_MODE,\r
+       FT_GRAY_CARD_MODE,\r
+       FT_INT_TEST_MODE,\r
+       FT_SINGLE_CHECK_MODE,\r
+  FT_LED_OFF_MODE,\r
+  FT_WEAR_MODE,\r
+  NULL_MODE,\r
+} WORK_MODE_T;\r
+\r
+\r
+//typedef struct {\r
+//     uint8_t count;\r
+//     int32_t green_data[64];\r
+//     int32_t ir_data[64];\r
+//     int32_t s_buf[64]; \r
+//     uint32_t als;\r
+//     uint32_t agc_green;\r
+//} hrs_sensor_data_t;\r
+\r
+\r
+typedef struct {\r
+       uint8_t count;\r
+       int32_t red_data[64];\r
+       int32_t green_data[64];\r
+       int32_t ir_data[64];  \r
+       int32_t s_buf[64];\r
+       uint8_t green_cur;\r
+       uint8_t red_cur; \r
+       uint8_t ir_cur;\r
+       uint8_t green_offset;\r
+       uint8_t red_offset; \r
+       uint8_t ir_offset;     \r
+}ppg_sensor_data_t;\r
+\r
+typedef enum {\r
+  MSG_LIVING_INIT,\r
+       MSG_LIVING_NO_WEAR,\r
+       MSG_LIVING_WEAR\r
+} hx3695_living_wear_msg_code_t;\r
+\r
+typedef enum {\r
+       MSG_NO_WEAR,\r
+       MSG_WEAR\r
+} hx3695_wear_msg_code_t;\r
+\r
+typedef struct {\r
+       hx3695_living_wear_msg_code_t  wear_status;\r
+       uint32_t           data_cnt;\r
+       uint8_t            signal_quality;\r
+       uint8_t            motion_status;\r
+} hx3695_living_results_t;\r
+\r
+typedef struct {\r
+  int32_t p1_noise; \r
+       int32_t p2_noise; \r
+       int32_t p3_noise;\r
+       int32_t p4_noise;\r
+}NOISE_PS_T;\r
+\r
+\r
+extern uint8_t alg_ram[11*1024];\r
+//extern uint8_t alg_ram[10];\r
+\r
+void hx3695_delay_us(uint32_t us);\r
+void hx3695_delay_ms(uint32_t ms);\r
+bool hx3695_write_reg(uint8_t addr, uint8_t data); \r
+uint8_t hx3695_read_reg(uint8_t addr); \r
+bool hx3695_brust_read_reg(uint8_t addr , uint8_t *buf, uint8_t length);\r
+bool hx3695_chip_check(void);\r
+uint8_t hx3695_read_fifo_size(void);\r
+uint16_t hx3695_read_fifo_data(int32_t *s_buf, uint8_t size, uint8_t phase_num);\r
+void hx3695_ppg_off(void);\r
+void hx3695_ppg_on(void);  \r
+void hx3695_320ms_timer_cfg(bool en);\r
+void hx3695_40ms_timer_cfg(bool en);\r
+void hx3695_gpioint_cfg(bool en);\r
+bool hx3695_init(WORK_MODE_T mode);\r
+void hx3695_agc_Int_handle(void); \r
+void hx3695_gesensor_Int_handle(void);\r
+void hx3695_spo2_ppg_init(void);\r
+void hx3695_spo2_data_cali_init(void);\r
+void hx3695_spo2_ppg_Int_handle(void);\r
+void hx3695_check_touch_init(void);\r
+void hx3695_wear_ppg_Int_handle(void);\r
+void hx3695_hrs_ppg_init(void);\r
+void hx3695_hrs_ppg_Int_handle(void);\r
+void hx3695_hrv_ppg_init(void);\r
+void hx3695_hrv_ppg_Int_handle(void);\r
+void hx3695_living_Int_handle(void);\r
+void hx3695_hrspo2_ppg_Int_handle(void);\r
+\r
+void hx3695_ppg_Int_handle(void);\r
+uint32_t hx3695_timers_start(void);\r
+uint32_t hx3695_timers_stop(void);\r
+uint32_t hx3695_gpioint_init(void);\r
+\r
+uint32_t hx3695_gpioint_enable(void);\r
+uint32_t hx3695_gpioint_disable(void);\r
+uint32_t gsen_read_timers_start(void);\r
+uint32_t gsen_read_timers_stop(void);\r
+\r
+void hx3695_vin_check(uint16_t led_vin);\r
+\r
+#ifdef LAB_TEST\r
+void hx3695_lab_test_init(void);\r
+void hx3695_test_alg_cfg(void);\r
+SENSOR_ERROR_T hx3695_lab_test_enable(void);\r
+void hx3695_lab_test_Int_handle(void);\r
+NOISE_PS_T hx3695_lab_test_read_packet(void);\r
+#endif\r
+\r
+bool hx3695_living_send_data(int32_t *new_raw_data, uint8_t dat_len, int16_t *gsen_data_x, int16_t *gsen_data_y, int16_t *gsen_data_z);\r
+hx3695_living_results_t hx3695_living_get_results(void);\r
+void agc_timeout_handler(void * p_context);\r
+void heart_rate_meas_timeout_handler(void * p_context);\r
+\r
+#endif\r
diff --git a/code/sdk/drivers/peripheral/ppg/hx3695/hx3695_check_touch.c b/code/sdk/drivers/peripheral/ppg/hx3695/hx3695_check_touch.c
new file mode 100644 (file)
index 0000000..ea1817a
--- /dev/null
@@ -0,0 +1,207 @@
+#include <stdio.h>\r
+#include <stdbool.h>\r
+#include <stdint.h>\r
+#include <stdlib.h>\r
+#include <math.h>\r
+\r
+\r
+#include "tyhx_hrs_custom.h"\r
+#include "hx3695.h"\r
+#include "hx3695_check_touch.h"\r
+\r
+\r
+\r
+hx3695_wear_msg_code_t hx3695_wear_status = MSG_NO_WEAR;\r
+hx3695_wear_msg_code_t hx3695_wear_status_pre = MSG_NO_WEAR;\r
+extern uint8_t hrs_phase_num;\r
+extern const int32_t check_mode_unwear_thre;\r
+extern const int32_t check_mode_wear_thre;\r
+static uint8_t notouch_cnt = 0;\r
+static uint8_t touch_cnt = 0;\r
+\r
+#ifdef CHECK_TOUCH_LIB\r
+\r
+\r
+SENSOR_ERROR_T hx3695_check_touch_enable(void)\r
+{\r
+    if (!hx3695_chip_check())\r
+    {\r
+        AGC_LOG("hx3695 check id failed!\r\n");\r
+        return SENSOR_OP_FAILED;\r
+    }\r
+\r
+    AGC_LOG("hx3695 check id success!\r\n");\r
+\r
+    hx3695_check_touch_init();\r
+               hx3695_delay_ms(100);   \r
+//        uint16_t i,reg_value ;\r
+//             for(i = 0;i < 0x7f; i++)\r
+//             {\r
+//                      reg_value = hx3695_read_reg(i);\r
+//             AGC_LOG("Reg_value: %x, 0x%x \r\n",i,reg_value);\r
+//             \r
+//              hx3695_delay_ms(5);\r
+//             }\r
+                       \r
+               \r
+//             AGC_LOG("hx3695 here!\r\n");\r
+               hx3695_delay_ms(100);   \r
+                       \r
+    hx3695_320ms_timer_cfg(true);\r
+\r
+    return SENSOR_OK;\r
+}\r
+\r
+//uint8_t hx3695_check_touch_read_fifo(int32_t *ir_buf)\r
+//{\r
+//    uint8_t data_flg = 127;\r
+//    int32_t data;\r
+//    uint8_t databuf[3];\r
+//    uint8_t ii=0;\r
+//    uint8_t data_size=0;\r
+//    uint8_t count=0;\r
+//    int32_t buf[64];\r
+\r
+//    data_size = hx3695_read_fifo_size();\r
+//    count = data_size>>1;\r
+//    data_size = count*2;\r
+\r
+//    for(ii=0; ii<data_size; ii++)\r
+//    {\r
+//        hx3695_write_reg(0x17, 0x00); // write any walue to 0x17 will update a new data\r
+//        hx3695_delay_us(100);\r
+//        hx3695_brust_read_reg(0x15, databuf, 3);\r
+//        data_flg = databuf[2]>>5;\r
+//        data = (int32_t)(databuf[0]|(databuf[1]<<8)|((databuf[2]&0x1f)<<16));\r
+\r
+//        if(ii==0)\r
+//        {\r
+//            if(data_flg ==3)\r
+//            {\r
+//                ii=3;\r
+//                buf[0] = 0;\r
+//                buf[1] = 0;\r
+//                buf[2] = 0;\r
+//            }\r
+//            if(data_flg ==2)\r
+//            {\r
+//                ii=2;\r
+//                buf[0] = 0;\r
+//                buf[1] = 0;\r
+//            }\r
+//            if(data_flg ==1)\r
+//            {\r
+//                ii=1;\r
+//                buf[0] = 0;\r
+//            }\r
+//        }\r
+\r
+//        if(data_flg == 0)\r
+//        {\r
+//            buf[ii]= data;\r
+//        }\r
+//        else if(data_flg == 1)\r
+//        {\r
+//            buf[ii]= data;\r
+//        }\r
+//        else if(data_flg == 2)\r
+//        {\r
+//            buf[ii]= data;\r
+//        }\r
+//        else if(data_flg == 3)\r
+//        {\r
+//            buf[ii]= data;\r
+//        }\r
+//    }\r
+//    for (ii=0; ii<count; ii++)\r
+//    {\r
+//        //DEBUG_PRINTF(0,"%d %d %d\r\n" ,buf[ii*2],buf[ii*2+1],hx3695_read_reg(0x2c));\r
+//        if(buf[ii*2]>buf[ii*2+1])\r
+//        {\r
+//            ir_buf[ii] = buf[ii*2] - buf[ii*2+1];\r
+//        }\r
+//        else\r
+//        {\r
+//            ir_buf[ii] = 0;\r
+//        }\r
+//    }\r
+//    return count;\r
+//}\r
+\r
+\r
+uint8_t hx3695_check_touch_read(ppg_sensor_data_t *s_dat)\r
+{\r
+    uint8_t i=0;\r
+    uint8_t size = 0;\r
+    uint8_t fifo_out_size = 0;\r
+         int32_t *green_data = &(s_dat->green_data[0]);\r
+    int32_t *ir_buf =  &(s_dat->ir_data[0]);\r
+    int32_t *s_buf =  &(s_dat->s_buf[0]);\r
+\r
+//    size = hx3695_read_fifo_size();\r
+//        \r
+//    if(size<2)\r
+//    {\r
+//        return 0;\r
+//    }\r
+\r
+//    if (size && size <= 256)\r
+//    {\r
+        fifo_out_size = hx3695_read_fifo_data(s_buf,hrs_phase_num,2);\r
+        s_dat->count = fifo_out_size;\r
+        for (i=0; i<fifo_out_size; i++)\r
+        {   \r
+                                         green_data[i] = (s_buf[i*3]);\r
+            ir_buf[i] = (s_buf[i*3+2] );\r
+                                       TYHX_LOG("touch_green:%d/%d %d,  touch_ir: %d \r\n" ,1+i,fifo_out_size,green_data[i],s_buf[i*3+2]);\r
+        }\r
+//    }\r
+    return size;\r
+}\r
+\r
+hx3695_wear_msg_code_t hx3695_check_touch_send_data(int32_t *ir_data, uint8_t count)\r
+{\r
+    uint8_t ii;\r
+    hx3695_wear_msg_code_t wear_status;\r
+    if(count==0)\r
+    {\r
+        return wear_status;\r
+    }\r
+    for(ii=0; ii<count; ii++)\r
+    {\r
+        wear_status = check_touch_alg(ir_data[ii]);\r
+    }\r
+    return wear_status;\r
+}\r
+\r
+hx3695_wear_msg_code_t check_touch_alg(int32_t ir_data)\r
+{\r
+    if(ir_data>check_mode_wear_thre)\r
+    {\r
+        notouch_cnt = 0;\r
+        if(touch_cnt>=2)\r
+        {\r
+            hx3695_wear_status = MSG_WEAR;\r
+            touch_cnt=0;\r
+        }\r
+        else\r
+        {\r
+            touch_cnt++;\r
+        }\r
+    }\r
+    else if(ir_data<check_mode_unwear_thre)\r
+    {\r
+        touch_cnt = 0;\r
+        if(notouch_cnt>=2)\r
+        {\r
+            hx3695_wear_status = MSG_NO_WEAR;\r
+            notouch_cnt=0;\r
+        }\r
+        else\r
+        {\r
+            notouch_cnt++;\r
+        }\r
+    }\r
+    return hx3695_wear_status;\r
+}\r
+#endif\r
diff --git a/code/sdk/drivers/peripheral/ppg/hx3695/hx3695_check_touch.h b/code/sdk/drivers/peripheral/ppg/hx3695/hx3695_check_touch.h
new file mode 100644 (file)
index 0000000..e4a19c5
--- /dev/null
@@ -0,0 +1,17 @@
+#ifndef _HX3695_CHECK_TOUCH_H_\r
+#define _HX3695_CHECK_TOUCH_H_\r
+\r
+#include <stdint.h>\r
+#include <stdbool.h>\r
+#include "hx3695.h"\r
+#include "hx3695.h"\r
+#include "hx3695_hrv_agc.h"\r
+\r
+\r
+hx3695_wear_msg_code_t  check_touch_alg(int32_t ir_data);\r
+SENSOR_ERROR_T hx3695_check_touch_enable(void);\r
+uint8_t hx3695_check_touch_read(ppg_sensor_data_t *s_dat);\r
+hx3695_wear_msg_code_t hx3695_check_touch_send_data(int32_t *ir_data, uint8_t count);\r
+hx3695_wear_msg_code_t check_touch_alg(int32_t ir_data);\r
+\r
+#endif\r
diff --git a/code/sdk/drivers/peripheral/ppg/hx3695/hx3695_factory_test.c b/code/sdk/drivers/peripheral/ppg/hx3695/hx3695_factory_test.c
new file mode 100644 (file)
index 0000000..4ab6f2f
--- /dev/null
@@ -0,0 +1,2917 @@
+#include <stdio.h>\r
+#include <stdbool.h>\r
+#include <stdint.h>\r
+#include <stdlib.h>\r
+#include <math.h>\r
+\r
+#include "tyhx_hrs_custom.h"\r
+#include "hx3695.h"\r
+#include "hx3695_factory_test.h"\r
+\r
+\r
+void hx3695_factory_wear_mode_config(void)\r
+{\r
+  uint16_t sample_rate = 10;                  /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+    uint32_t prf_clk_num = 32000/sample_rate;   /*period in clk num, num = Fclk/fs */\r
+         \r
+    uint8_t adc_rst_post_num=0;       /* 00=16,01=32,10=64,11=128*/      \r
+         uint8_t samp_delay_leden_num = 0; /* 00=8,01=16,10=32,11=64*/ \r
+    uint8_t samp_copy_avg = 0;        /* 0=1, 1=2, 2=4 ,3=8, 4=16*/\r
+    uint8_t data_avg_num = 0;         /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+         uint8_t phase7_8_internal = 0;    /* phase7 and phase8 prf internal cfg */\r
+               \r
+    uint8_t phase1_enable = 1;     /*phase1_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase2_enable = 1;     /*phase2_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase3_enable = 0;     /*phase3_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase4_enable = 0;     /*phase4_enable  , 1 mean enable ; 0 mean disable */\r
+    uint8_t phase5_enable = 0;     /*phase5_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase6_enable = 0;     /*phase6_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase7_enable = 0;     /*phase7_enable  , 1 mean enable ; 0 mean disable */        \r
+         uint8_t phase8_enable = 0;     /*phase8_enable  , 1 mean enable ; 0 mean disable */ \r
+\r
+    uint8_t phase1_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase2_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase3_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase4_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase5_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+         uint8_t phase6_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase7_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase8_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+                        \r
+         uint8_t phase1_mux_sel = 0;    /* sel phase1*/\r
+               uint8_t phase2_mux_sel = 1;    /* sel phase2*/\r
+               uint8_t phase3_mux_sel = 2;    /* sel phase3*/\r
+               uint8_t phase4_mux_sel = 3;    /* sel phase4*/\r
+               uint8_t phase5_mux_sel = 4;    /* sel phase5*/\r
+               uint8_t phase6_mux_sel = 5;    /* sel phase6*/\r
+               uint8_t phase7_mux_sel = 6;    /* sel phase7*/\r
+               uint8_t phase8_mux_sel = 7;    /* sel phase8*/\r
+       \r
+\r
+         uint8_t phase1_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase1_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase1_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase1_led_drv1_cha_sel = 0x10;     /* 1 = ldr1  NG; 2 = ldr2   GR; 4 = ldr3  IR; 8 = ldr4 RED; */\r
+    uint8_t phase1_led_drv2_cha_sel = 0;    /*ldr5:0x20  ldr6: 0x40 red    ldr8 0x80  ir      */\r
+               uint8_t phase1_pd_sel = 0x0c;          /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase1_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase1_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase1_ldr1_cur = 64;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase1_ldr2_cur = 0;\r
+//             uint8_t phase1_of_idac1_cur = 0;\r
+//    uint8_t phase1_of_idac2_cur = 0;\r
+    uint8_t phase1_ad_inr_ctrl = 3;\r
+    uint8_t phase1_ad_of_idac_ctrl = 0;\r
+//    uint8_t afe_offset  =  0;\r
+    uint8_t phase1_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase1_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase1_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+\r
+\r
+         uint8_t phase2_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase2_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase2_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase2_led_drv1_cha_sel = 0;   //GREEN_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase2_led_drv2_cha_sel = 0;\r
+               uint8_t phase2_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase2_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase2_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase2_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase2_ldr2_cur = 0;\r
+//             uint8_t phase2_of_idac1_cur = 0;\r
+//    uint8_t phase2_of_idac2_cur = 0;\r
+    uint8_t phase2_ad_inr_ctrl = 3;\r
+    uint8_t phase2_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase2_afe_offset  =  0;\r
+    uint8_t phase2_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase2_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase2_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+               \r
+    uint8_t phase3_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase3_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase3_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase3_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase3_led_drv2_cha_sel = 0;\r
+               uint8_t phase3_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase3_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase3_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase3_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase3_ldr2_cur = 0;\r
+//             uint8_t phase3_of_idac1_cur = 0;\r
+//    uint8_t phase3_of_idac2_cur = 0;\r
+    uint8_t phase3_ad_inr_ctrl = 3;\r
+    uint8_t phase3_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase3_afe_offset  =  0;\r
+    uint8_t phase3_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase3_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase3_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+               \r
+    uint8_t phase4_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase4_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase4_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase4_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase4_led_drv2_cha_sel = 0;\r
+               uint8_t phase4_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase4_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase4_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase4_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase4_ldr2_cur = 0;\r
+//             uint8_t phase4_of_idac1_cur = 0;\r
+//    uint8_t phase4_of_idac2_cur = 0;\r
+    uint8_t phase4_ad_inr_ctrl = 3;\r
+    uint8_t phase4_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase4_afe_offset  =  0;\r
+    uint8_t phase4_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase4_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase4_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase5_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase5_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase5_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase5_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase5_led_drv2_cha_sel = 0;\r
+               uint8_t phase5_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase5_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase5_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase5_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase5_ldr2_cur = 0;\r
+//             uint8_t phase5_of_idac1_cur = 0;\r
+//    uint8_t phase5_of_idac2_cur = 0;\r
+    uint8_t phase5_ad_inr_ctrl = 3;\r
+    uint8_t phase5_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase5_afe_offset  =  0;\r
+    uint8_t phase5_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase5_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase5_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase6_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase6_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase6_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase6_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase6_led_drv2_cha_sel = 0;\r
+               uint8_t phase6_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase6_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase6_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase6_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase6_ldr2_cur = 0;\r
+//             uint8_t phase6_of_idac1_cur = 0;\r
+//    uint8_t phase6_of_idac2_cur = 0;\r
+    uint8_t phase6_ad_inr_ctrl = 3;\r
+    uint8_t phase6_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase6_afe_offset  =  0;\r
+    uint8_t phase6_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase6_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase6_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase7_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase7_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase7_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase7_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase7_led_drv2_cha_sel = 0;\r
+               uint8_t phase7_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase7_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase7_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase7_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase7_ldr2_cur = 0;\r
+//             uint8_t phase7_of_idac1_cur = 0;\r
+//    uint8_t phase7_of_idac2_cur = 0;\r
+    uint8_t phase7_ad_inr_ctrl = 3;\r
+    uint8_t phase7_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase7_afe_offset  =  0;\r
+    uint8_t phase7_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase7_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase7_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase8_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase8_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase8_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase8_led_drv1_cha_sel = 0;   //IR_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase8_led_drv2_cha_sel = 0;\r
+               uint8_t phase8_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase8_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase8_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase8_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase8_ldr2_cur = 0;\r
+//             uint8_t phase8_of_idac1_cur = 0;\r
+//    uint8_t phase8_of_idac2_cur = 0;\r
+    uint8_t phase8_ad_inr_ctrl = 3;\r
+    uint8_t phase8_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase8_afe_offset  =  0;\r
+    uint8_t phase8_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase8_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase8_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t init_wait_delay = 5 ; /* 0 = 31clk ; 1 = 64clk ; 2 = 127clk ; 3 = 255clk(d) ;\r
+                                     4 = 511clk; 5 = 1023clk; 6 = 2047; 7 = 4095clk */         \r
+                                                                                                                                                \r
+    uint8_t afe_reset = 3;        /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d) ;\r
+                                     4 = 255clk; 5 = 511clk; 6 = 1024; 7 = 2047clk */\r
+                                                                                                                                                \r
+               uint8_t afe_rst_cnvt = 1;               /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d)*/\r
+    \r
+    uint8_t led_en_idac_pre    = 2;    /* 0 = 8clk ; 1 = 16clk ; 2 = 32clk ; 3 = 64clk(d)*/ \r
+               \r
+               uint8_t led_en_idac     =       1;        /* 0 = 4clk ; 1 = 8clk ; 2 = 16clk ; 3 = 32clk(d)*/ \r
+                                                                                                                                                \r
+    uint8_t led_on_time = 2;      /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+                                     4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+                                                                                                                                                \r
+    hx3695_delay_ms(10);               \r
+               \r
+    hx3695_write_reg(0X2a, (uint8_t)prf_clk_num);    // prf bit<7:0>6\r
+    hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+    hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>      \r
+                  \r
+    hx3695_write_reg(0X25, (afe_rst_cnvt<<4| led_en_idac_pre<<2|led_en_idac)); \r
+               hx3695_write_reg(0X2d, phase7_8_internal); \r
+               hx3695_write_reg(0X2e, 0x33);// gpio ctrl \r
+    hx3695_write_reg(0X2f, ((afe_reset<<4)| init_wait_delay));\r
+               hx3695_write_reg(0X30, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+    hx3695_write_reg(0X72, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+\r
+\r
+    hx3695_write_reg(0X31, (led_on_time<<4| 0x00));\r
+               hx3695_write_reg(0X33, 0x83);// Öжϼ«ÐÔ¼°¿í¶ÈÅäÖã»\r
+               hx3695_write_reg(0X34, 0x00);// ÖжÏÌØÊâÅäÖã»\r
+               hx3695_write_reg(0X36, 0x00);// phase data ready ±êÖ¾ÉèÖã»\r
+               hx3695_write_reg(0X38, 0x00);\r
+               \r
+    hx3695_write_reg(0X3a, (phase1_inner_avg | (phase2_inner_avg<<4)));  \r
+    hx3695_write_reg(0X3b, (phase3_inner_avg | (phase4_inner_avg<<4)));  \r
+    hx3695_write_reg(0X3c, (phase5_inner_avg | (phase6_inner_avg<<4)));        \r
+    hx3695_write_reg(0X3d, (phase7_inner_avg | (phase8_inner_avg<<4)));        \r
+    hx3695_write_reg(0X3e, adc_rst_post_num<<6 | samp_delay_leden_num<<4 | samp_copy_avg); \r
+    hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+    hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+               \r
+               hx3695_write_reg(0X43, phase1_mux_sel);  \r
+               hx3695_write_reg(0X44, phase1_tia_cap<<4|phase1_tia_res); \r
+               hx3695_write_reg(0X45, phase1_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase1_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase1_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase1_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+\r
+    hx3695_write_reg(0X49, phase1_ad_inr_ctrl<<4|phase1_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase1_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase1_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase1_dsp_mov_avg_num | phase1_dsp_iir_lp_coeff<<4);\r
+\r
+//    hx3695_write_reg(0X4e, thred_value);\r
+//    hx3695_write_reg(0X4f, thred_value>>5);\r
+               \r
+    hx3695_write_reg(0X43, phase2_mux_sel);  \r
+               hx3695_write_reg(0X44, phase2_tia_cap<<4|phase2_tia_res); \r
+               hx3695_write_reg(0X45, phase2_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase2_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase2_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase2_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase2_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase2_ad_inr_ctrl<<4|phase2_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase2_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase2_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase2_dsp_mov_avg_num | phase2_dsp_iir_lp_coeff<<4);\r
+               \r
+//phase3 sel\r
+\r
+    hx3695_write_reg(0X43, phase3_mux_sel);  \r
+               hx3695_write_reg(0X44, phase3_tia_cap<<4|phase3_tia_res); \r
+               hx3695_write_reg(0X45, phase3_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase3_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase3_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase3_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase3_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase3_ad_inr_ctrl<<4|phase3_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase3_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase3_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase3_dsp_mov_avg_num | phase3_dsp_iir_lp_coeff<<4);\r
+               \r
+//phase4 sel\r
+\r
+    hx3695_write_reg(0X43, phase4_mux_sel);  \r
+               hx3695_write_reg(0X44, phase4_tia_cap<<4|phase4_tia_res); \r
+               hx3695_write_reg(0X45, phase4_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase4_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase4_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase4_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase4_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase4_ad_inr_ctrl<<4|phase4_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase4_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase4_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase4_dsp_mov_avg_num | phase4_dsp_iir_lp_coeff<<4);\r
+\r
+               hx3695_write_reg(0X43, phase5_mux_sel);  \r
+               hx3695_write_reg(0X44, phase5_tia_cap<<4|phase5_tia_res); \r
+               hx3695_write_reg(0X45, phase5_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase5_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase5_pd_sel));    //<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase5_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase5_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase5_ad_inr_ctrl<<4|phase5_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase5_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase5_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase5_dsp_mov_avg_num | phase5_dsp_iir_lp_coeff<<4);\r
+               \r
+               \r
+         hx3695_write_reg(0X43, phase6_mux_sel);  \r
+               hx3695_write_reg(0X44, phase6_tia_cap<<4|phase6_tia_res); \r
+               hx3695_write_reg(0X45, phase6_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase6_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase6_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase6_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase6_ad_inr_ctrl<<4|phase6_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase6_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase6_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase6_dsp_mov_avg_num | phase6_dsp_iir_lp_coeff<<4);\r
+               \r
+       \r
+         hx3695_write_reg(0X43, phase7_mux_sel);  \r
+               hx3695_write_reg(0X44, phase7_tia_cap<<4|phase7_tia_res); \r
+               hx3695_write_reg(0X45, phase7_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase7_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase7_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase7_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase7_ad_inr_ctrl<<4|phase7_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase7_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase7_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase7_dsp_mov_avg_num | phase7_dsp_iir_lp_coeff<<4);\r
+               \r
+       \r
+         hx3695_write_reg(0X43, phase8_mux_sel);  \r
+               hx3695_write_reg(0X44, phase8_tia_cap<<4|phase8_tia_res); \r
+               hx3695_write_reg(0X45, phase8_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase8_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase8_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase8_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase8_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phas8_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase8_ad_inr_ctrl<<4|phase8_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase8_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase8_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase8_dsp_mov_avg_num | phase8_dsp_iir_lp_coeff<<4);\r
+               \r
+\r
+// analog circuit cfg \r
+    hx3695_write_reg(0X60, 0x14);      //\r
+               hx3695_write_reg(0X61, 0xf0);   \r
+               hx3695_write_reg(0X62, 0x22); \r
+               hx3695_write_reg(0X63, 0x15); \r
+                                                                                                                                                                                                                               \r
+               hx3695_write_reg(0X64, 0x08);   \r
+               hx3695_write_reg(0X65, 0x88); //bug\r
+               \r
+               hx3695_write_reg(0X66, 0x30);   // bits<3>=adc selftest en     0x30\r
+               hx3695_write_reg(0X67, 0x23);   \r
+               hx3695_write_reg(0X68, 0x46);   \r
+               hx3695_write_reg(0X69, 0x42);   \r
+               \r
+               hx3695_write_reg(0X39, 0xff);   // ofset idac1 phase enable cfg\r
+               hx3695_write_reg(0x73, 0xff);    //led_offset_idac phase enable\r
+               \r
+    hx3695_write_reg(0X6a, 0X0f);      \r
+               hx3695_write_reg(0X6b, 0X22);   \r
+               hx3695_write_reg(0X6c, 0X00);   \r
+               hx3695_write_reg(0X6d, 0X37);   \r
+               hx3695_write_reg(0X6e, 0X82);   \r
+               hx3695_write_reg(0X6f, 0X08);\r
+/////////FIFO and adc conversion ready config////////\r
+/////////FIFO and adc conversion ready config////////\r
+#if defined(PPG_INT_MODE)\r
+               hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble\r
+                hx3695_write_reg(0X33, 0x83);   // int width                                                                                                                                           \r
+     hx3695_write_reg(0X21, 0x00);   // fifo int sel,00=FIFO INT config clear\r
+                hx3695_write_reg(0X38, 0x01);   // int sel,00=close almost full int,04=enable almost full int\r
+#elif defined(INT_MODE)               //FIFO_ALL_MOST_FULL)\r
+                hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble\r
+                hx3695_write_reg(0X1c, (fifo_watermark&0xff));   //fifo_watermark\r
+                hx3695_write_reg(0X1d, fifo_watermark<<8);       //bit<0>=fifo_watermark[8]  \r
+                hx3695_write_reg(0X33, 0x83);   // int width   \r
+                hx3695_write_reg(0X21, 0x00);   // fifo int sel,00=FIFO INT config clear\r
+     hx3695_write_reg(0X38, 0x04);   // int sel,00=close almost full int,04=enable almost full int\r
+\r
+#else\r
+                hx3695_write_reg(0X1b, 0x92);    // bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble                                                                             \r
+     hx3695_write_reg(0X38, 0x01);   // int sel,00=close almost full int,04=enable almost full int\r
+     \r
+#endif\r
+\r
+               \r
+    hx3695_write_reg(0X26,(phase1_enable<<3)|(phase1_adc_osr)|(phase2_enable<<7)|(phase2_adc_osr<<4) ); \r
+    hx3695_write_reg(0X27,(phase3_enable<<3)|(phase3_adc_osr)|(phase4_enable<<7)|(phase4_adc_osr<<4) );  \r
+    hx3695_write_reg(0X28,(phase5_enable<<3)|(phase5_adc_osr)|(phase6_enable<<7)|(phase6_adc_osr<<4) );\r
+    hx3695_write_reg(0X29,(phase7_enable<<3)|(phase7_adc_osr)|(phase8_enable<<7)|(phase8_adc_osr<<4) );                \r
+\r
+//    hx3695_write_reg(0X5c, 0x02);//soft reset\r
+    hx3695_delay_ms(5);  \r
+    hx3695_write_reg(0X5c, 0x00);//release\r
+//    read_fifo_first_flg = 1;\r
+    return ;\r
+       \r
+       \r
+       \r
+}\r
+\r
+void hx3695_factory_ft_card_test_config(void)//»Ò¿¨15mm¸ß¶È²âÊÔÅäÖÃ\r
+{\r
+         uint16_t sample_rate = 25;                  /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+    uint32_t prf_clk_num = 32000/sample_rate;   /*period in clk num, num = Fclk/fs */\r
+         \r
+//       uint16_t fifo_watermark= 250 ;\r
+    uint8_t adc_rst_post_num= 0;       /* 00=16,01=32,10=64,11=128*/      \r
+         uint8_t samp_delay_leden_num = 0; /* 00=8,01=16,10=32,11=64*/ \r
+    uint8_t samp_copy_avg = 0;        /* 0=1, 1=2, 2=4 ,3=8, 4=16*/\r
+    uint8_t data_avg_num = 0;         /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+         uint8_t phase7_8_internal = 0;   //0x18;    /* phase7 and phase8 prf internal cfg */\r
+       \r
+//       uint16_t  thred_value = 32500;\r
+       \r
+    uint8_t phase1_enable = 1;     /*phase1_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase2_enable = 1;     /*phase2_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase3_enable = 1;     /*phase3_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase4_enable = 1;     /*phase4_enable  , 1 mean enable ; 0 mean disable */\r
+    uint8_t phase5_enable = 0;     /*phase5_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase6_enable = 0;     /*phase6_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase7_enable = 0;     /*phase7_enable  , 1 mean enable ; 0 mean disable */        \r
+         uint8_t phase8_enable = 0;     /*phase8_enable  , 1 mean enable ; 0 mean disable */ \r
+\r
+    uint8_t phase1_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase2_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase3_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase4_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase5_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+         uint8_t phase6_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase7_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase8_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+                        \r
+         uint8_t phase1_mux_sel = 0;    /* sel phase1*/\r
+               uint8_t phase2_mux_sel = 1;    /* sel phase2*/\r
+               uint8_t phase3_mux_sel = 2;    /* sel phase3*/\r
+               uint8_t phase4_mux_sel = 3;    /* sel phase4*/\r
+               uint8_t phase5_mux_sel = 4;    /* sel phase5*/\r
+               uint8_t phase6_mux_sel = 5;    /* sel phase6*/\r
+               uint8_t phase7_mux_sel = 6;    /* sel phase7*/\r
+               uint8_t phase8_mux_sel = 7;    /* sel phase8*/\r
+       \r
+\r
+         uint8_t phase1_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase1_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase1_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase1_led_drv1_cha_sel = 0;     /* 1 = ldr1  NG; 2 = ldr2   GR; 4 = ldr3  IR; 8 = ldr4 RED; */\r
+    uint8_t phase1_led_drv2_cha_sel = 0;    /*ldr5:0x20  ldr6: 0x40 red    ldr8 0x80  ir      */\r
+               uint8_t phase1_pd_sel = 0x0a;          /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase1_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase1_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase1_ldr1_cur = 32;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase1_ldr2_cur = 0;\r
+//             uint8_t phase1_of_idac1_cur = 0;\r
+//    uint8_t phase1_of_idac2_cur = 0;\r
+    uint8_t phase1_ad_inr_ctrl = 3;\r
+    uint8_t phase1_ad_of_idac_ctrl = 0;\r
+//    uint8_t afe_offset  =  0;\r
+    uint8_t phase1_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase1_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase1_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+\r
+\r
+         uint8_t phase2_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase2_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase2_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase2_led_drv1_cha_sel = GREEN_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase2_led_drv2_cha_sel = 0x00;\r
+               uint8_t phase2_pd_sel = 0x0a;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase2_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase2_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase2_ldr1_cur = 32;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase2_ldr2_cur = 0;\r
+//             uint8_t phase2_of_idac1_cur = 0;\r
+//    uint8_t phase2_of_idac2_cur = 0;\r
+    uint8_t phase2_ad_inr_ctrl = 3;\r
+    uint8_t phase2_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase2_afe_offset  =  0;\r
+    uint8_t phase2_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase2_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase2_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+               \r
+    uint8_t phase3_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase3_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase3_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase3_led_drv1_cha_sel = RED_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase3_led_drv2_cha_sel = 0;\r
+               uint8_t phase3_pd_sel = 0x0a;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase3_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase3_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase3_ldr1_cur = 32;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase3_ldr2_cur = 0;\r
+//             uint8_t phase3_of_idac1_cur = 0;\r
+//    uint8_t phase3_of_idac2_cur = 0;\r
+    uint8_t phase3_ad_inr_ctrl = 3;\r
+    uint8_t phase3_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase3_afe_offset  =  0;\r
+    uint8_t phase3_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase3_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase3_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+               \r
+    uint8_t phase4_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase4_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase4_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase4_led_drv1_cha_sel = IR_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase4_led_drv2_cha_sel = 0;\r
+               uint8_t phase4_pd_sel = 0x0a;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase4_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase4_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase4_ldr1_cur = 32;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase4_ldr2_cur = 0;\r
+//             uint8_t phase4_of_idac1_cur = 0;\r
+//    uint8_t phase4_of_idac2_cur = 0;\r
+    uint8_t phase4_ad_inr_ctrl = 3;\r
+    uint8_t phase4_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase4_afe_offset  =  0;\r
+    uint8_t phase4_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase4_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase4_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase5_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase5_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase5_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase5_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase5_led_drv2_cha_sel = 0;\r
+               uint8_t phase5_pd_sel = 0x0a;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase5_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase5_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase5_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase5_ldr2_cur = 0;\r
+//             uint8_t phase5_of_idac1_cur = 0;\r
+//    uint8_t phase5_of_idac2_cur = 0;\r
+    uint8_t phase5_ad_inr_ctrl = 3;\r
+    uint8_t phase5_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase5_afe_offset  =  0;\r
+    uint8_t phase5_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase5_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase5_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase6_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase6_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase6_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase6_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase6_led_drv2_cha_sel = 0;\r
+               uint8_t phase6_pd_sel = 4;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase6_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase6_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase6_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase6_ldr2_cur = 0;\r
+//             uint8_t phase6_of_idac1_cur = 0;\r
+//    uint8_t phase6_of_idac2_cur = 0;\r
+    uint8_t phase6_ad_inr_ctrl = 3;\r
+    uint8_t phase6_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase6_afe_offset  =  0;\r
+    uint8_t phase6_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase6_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase6_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase7_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase7_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase7_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase7_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase7_led_drv2_cha_sel = 0;\r
+               uint8_t phase7_pd_sel = 0x00;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase7_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase7_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase7_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase7_ldr2_cur = 0;\r
+//             uint8_t phase7_of_idac1_cur = 0;\r
+//    uint8_t phase7_of_idac2_cur = 0;\r
+    uint8_t phase7_ad_inr_ctrl = 3;\r
+    uint8_t phase7_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase7_afe_offset  =  0;\r
+    uint8_t phase7_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase7_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase7_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase8_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase8_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase8_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase8_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase8_led_drv2_cha_sel = 0;\r
+               uint8_t phase8_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase8_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase8_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase8_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase8_ldr2_cur = 0;\r
+//             uint8_t phase8_of_idac1_cur = 0;\r
+//    uint8_t phase8_of_idac2_cur = 0;\r
+    uint8_t phase8_ad_inr_ctrl = 3;\r
+    uint8_t phase8_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase8_afe_offset  =  0;\r
+    uint8_t phase8_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase8_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase8_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t init_wait_delay = 4 ; /* 0 = 31clk ; 1 = 64clk ; 2 = 127clk ; 3 = 255clk(d) ;\r
+                                     4 = 511clk; 5 = 1023clk; 6 = 2047; 7 = 4095clk */         \r
+                                                                                                                                                \r
+    uint8_t afe_reset = 3;        /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d) ;\r
+                                     4 = 255clk; 5 = 511clk; 6 = 1024; 7 = 2047clk */\r
+                                                                                                                                                \r
+               uint8_t afe_rst_cnvt = 1;               /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d)*/\r
+    \r
+    uint8_t led_en_idac_pre    = 2;    /* 0 = 8clk ; 1 = 16clk ; 2 = 32clk ; 3 = 64clk(d)*/ \r
+               \r
+               uint8_t led_en_idac     =       1;        /* 0 = 4clk ; 1 = 8clk ; 2 = 16clk ; 3 = 32clk(d)*/ \r
+                                                                                                                                                \r
+    uint8_t led_on_time = 2;      /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+                                     4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+                                                                                                                                                \r
+    hx3695_delay_ms(10);               \r
+                       \r
+    hx3695_write_reg(0X2a, (uint8_t)prf_clk_num);    // prf bit<7:0>6\r
+    hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+    hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>      \r
+                  \r
+    hx3695_write_reg(0X25, (afe_rst_cnvt<<4| led_en_idac_pre<<2|led_en_idac)); \r
+               hx3695_write_reg(0X2d, phase7_8_internal); \r
+               hx3695_write_reg(0X2e, 0x33);// gpio ctrl \r
+    hx3695_write_reg(0X2f, ((afe_reset<<4)| init_wait_delay));\r
+               hx3695_write_reg(0X30, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+    hx3695_write_reg(0X72, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+\r
+\r
+    hx3695_write_reg(0X31, (led_on_time<<4| 0x00));\r
+               hx3695_write_reg(0X33, 0x83);// Öжϼ«ÐÔ¼°¿í¶ÈÅäÖã»\r
+               hx3695_write_reg(0X34, 0x00);// ÖжÏÌØÊâÅäÖã»\r
+               hx3695_write_reg(0X36, 0x00);// phase data ready ±êÖ¾ÉèÖã»\r
+               hx3695_write_reg(0X38, 0x00);\r
+               \r
+    hx3695_write_reg(0X3a, (phase1_inner_avg | (phase2_inner_avg<<4)));  \r
+    hx3695_write_reg(0X3b, (phase3_inner_avg | (phase4_inner_avg<<4)));  \r
+    hx3695_write_reg(0X3c, (phase5_inner_avg | (phase6_inner_avg<<4)));        \r
+    hx3695_write_reg(0X3d, (phase7_inner_avg | (phase8_inner_avg<<4)));        \r
+    hx3695_write_reg(0X3e, adc_rst_post_num<<6 | samp_delay_leden_num<<4 | samp_copy_avg); \r
+    hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+    hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+               \r
+               hx3695_write_reg(0X43, phase1_mux_sel);  \r
+               hx3695_write_reg(0X44, phase1_tia_cap<<4|phase1_tia_res); \r
+               hx3695_write_reg(0X45, phase1_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase1_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase1_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase1_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49, phase1_ad_inr_ctrl<<4|phase1_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase1_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase1_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase1_dsp_mov_avg_num | phase1_dsp_iir_lp_coeff<<4);\r
+\r
+       \r
+    hx3695_write_reg(0X43, phase2_mux_sel);  \r
+               hx3695_write_reg(0X44, phase2_tia_cap<<4|phase2_tia_res); \r
+               hx3695_write_reg(0X45, phase2_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase2_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase2_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase2_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase2_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase2_ad_inr_ctrl<<4|phase2_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase2_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase2_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase2_dsp_mov_avg_num | phase2_dsp_iir_lp_coeff<<4);\r
+               \r
+//phase3 sel\r
+\r
+    hx3695_write_reg(0X43, phase3_mux_sel);  \r
+               hx3695_write_reg(0X44, phase3_tia_cap<<4|phase3_tia_res); \r
+               hx3695_write_reg(0X45, phase3_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase3_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase3_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase3_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase3_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase3_ad_inr_ctrl<<4|phase3_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase3_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase3_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase3_dsp_mov_avg_num | phase3_dsp_iir_lp_coeff<<4);\r
+               \r
+//phase4 sel\r
+\r
+    hx3695_write_reg(0X43, phase4_mux_sel);  \r
+               hx3695_write_reg(0X44, phase4_tia_cap<<4|phase4_tia_res); \r
+               hx3695_write_reg(0X45, phase4_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase4_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase4_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase4_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase4_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase4_ad_inr_ctrl<<4|phase4_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase4_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase4_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase4_dsp_mov_avg_num | phase4_dsp_iir_lp_coeff<<4);\r
+\r
+               hx3695_write_reg(0X43, phase5_mux_sel);  \r
+               hx3695_write_reg(0X44, phase5_tia_cap<<4|phase5_tia_res); \r
+               hx3695_write_reg(0X45, phase5_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase5_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase5_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase5_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase5_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase5_ad_inr_ctrl<<4|phase5_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase5_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase5_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase5_dsp_mov_avg_num | phase5_dsp_iir_lp_coeff<<4);\r
+               \r
+               \r
+         hx3695_write_reg(0X43, phase6_mux_sel);  \r
+               hx3695_write_reg(0X44, phase6_tia_cap<<4|phase6_tia_res); \r
+               hx3695_write_reg(0X45, phase6_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase6_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase6_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase6_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase6_ad_inr_ctrl<<4|phase6_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase6_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase6_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase6_dsp_mov_avg_num | phase6_dsp_iir_lp_coeff<<4);\r
+               \r
+       \r
+         hx3695_write_reg(0X43, phase7_mux_sel);  \r
+               hx3695_write_reg(0X44, phase7_tia_cap<<4|phase7_tia_res); \r
+               hx3695_write_reg(0X45, phase7_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase7_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase7_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase7_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase7_ad_inr_ctrl<<4|phase7_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase7_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase7_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase7_dsp_mov_avg_num | phase7_dsp_iir_lp_coeff<<4);\r
+               \r
+       \r
+         hx3695_write_reg(0X43, phase8_mux_sel);  \r
+               hx3695_write_reg(0X44, phase8_tia_cap<<4|phase8_tia_res); \r
+               hx3695_write_reg(0X45, phase8_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase8_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase8_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase8_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase8_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phas8_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase8_ad_inr_ctrl<<4|phase8_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase8_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase8_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase8_dsp_mov_avg_num | phase8_dsp_iir_lp_coeff<<4);\r
+               \r
+\r
+// analog circuit cfg \r
+    hx3695_write_reg(0X60, 0x14);      //\r
+               hx3695_write_reg(0X61, 0xf0);   \r
+               hx3695_write_reg(0X62, 0x22); \r
+               hx3695_write_reg(0X63, 0x15); \r
+                                                                                                                                                                                                                               \r
+               hx3695_write_reg(0X64, 0x08);   \r
+               hx3695_write_reg(0X65, 0x88); //bug\r
+               \r
+               hx3695_write_reg(0X66, 0x30);   // bits<3>=adc selftest en     0x30\r
+               hx3695_write_reg(0X67, 0x23);   \r
+               hx3695_write_reg(0X68, 0x46);   \r
+               hx3695_write_reg(0X69, 0x42);   \r
+               \r
+               hx3695_write_reg(0X39, 0xff);   // ofset idac1 phase enable cfg\r
+               hx3695_write_reg(0x73, 0xff);    //led_offset_idac phase enable\r
+               \r
+    hx3695_write_reg(0X6a, 0X0f);      \r
+               hx3695_write_reg(0X6b, 0X22);   \r
+               hx3695_write_reg(0X6c, 0X00);   \r
+               hx3695_write_reg(0X6d, 0X37);   \r
+               hx3695_write_reg(0X6e, 0X82);   \r
+               hx3695_write_reg(0X6f, 0X08);\r
+/////////FIFO and adc conversion ready config////////\r
+/////////FIFO and adc conversion ready config////////\r
+#if defined(PPG_INT_MODE)\r
+               hx3695_write_reg(0X1b, 0x00);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble\r
+                hx3695_write_reg(0X33, 0x83);   // int width                                                                                                                                           \r
+     hx3695_write_reg(0X21, 0x00);   // fifo int sel,00=FIFO INT config clear\r
+                hx3695_write_reg(0X38, 0x08);   // int sel,00=close almost full int,04=enable almost full int\r
+#elif defined(INT_MODE)             //(FIFO_ALL_MOST_FULL)\r
+                hx3695_write_reg(0X1b, 0x90);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble\r
+                hx3695_write_reg(0X1c, (fifo_watermark&0xff));   //fifo_watermark\r
+                hx3695_write_reg(0X1d, fifo_watermark<<8);       //bit<0>=fifo_watermark[8]  \r
+                hx3695_write_reg(0X33, 0x83);   // int width                                                                                                                                           \r
+     hx3695_write_reg(0X38, 0x04);   // int sel,00=close almost full int,04=enable almost full int\r
+\r
+#else\r
+               hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble     \r
+     hx3695_write_reg(0X36, 0x00);                       //intrupt                                                                                                                                     \r
+                                                                                                                                               \r
+     hx3695_write_reg(0X38, 0x00);   // int sel,00=close almost full int,01= prf int  04=enable almost full int\r
+\r
+#endif\r
+\r
+               \r
+    hx3695_write_reg(0X26,(phase1_enable<<3)|(phase1_adc_osr)|(phase2_enable<<7)|(phase2_adc_osr<<4) ); \r
+    hx3695_write_reg(0X27,(phase3_enable<<3)|(phase3_adc_osr)|(phase4_enable<<7)|(phase4_adc_osr<<4) );  \r
+    hx3695_write_reg(0X28,(phase5_enable<<3)|(phase5_adc_osr)|(phase6_enable<<7)|(phase6_adc_osr<<4) );\r
+    hx3695_write_reg(0X29,(phase7_enable<<3)|(phase7_adc_osr)|(phase8_enable<<7)|(phase8_adc_osr<<4) );                \r
+\r
+//    hx3695_write_reg(0X5c, 0x02);//soft reset\r
+    hx3695_delay_ms(5);  \r
+    hx3695_write_reg(0X5c, 0x00);//release\r
+\r
+    return ;   \r
+}\r
+\r
+void hx3695_factory_ft_single_check_config(void)//»Ò¿¨10mm¸ß¶È²âÊÔÅäÖÃ\r
+{\r
+\r
+       uint16_t sample_rate = 200;                  /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+    uint32_t prf_clk_num = 32000/sample_rate;   /*period in clk num, num = Fclk/fs */\r
+         \r
+    uint8_t adc_rst_post_num=0;       /* 00=16,01=32,10=64,11=128*/      \r
+         uint8_t samp_delay_leden_num = 0; /* 00=8,01=16,10=32,11=64*/ \r
+    uint8_t samp_copy_avg = 0;        /* 0=1, 1=2, 2=4 ,3=8, 4=16*/\r
+    uint8_t data_avg_num = 0;         /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+         uint8_t phase7_8_internal = 0;    /* phase7 and phase8 prf internal cfg */\r
+               \r
+    uint8_t phase1_enable = 1;     /*phase1_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase2_enable = 1;     /*phase2_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase3_enable = 1;     /*phase3_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase4_enable = 1;     /*phase4_enable  , 1 mean enable ; 0 mean disable */\r
+    uint8_t phase5_enable = 0;     /*phase5_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase6_enable = 0;     /*phase6_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase7_enable = 0;     /*phase7_enable  , 1 mean enable ; 0 mean disable */        \r
+         uint8_t phase8_enable = 0;     /*phase8_enable  , 1 mean enable ; 0 mean disable */ \r
+\r
+    uint8_t phase1_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase2_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase3_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase4_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase5_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+         uint8_t phase6_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase7_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase8_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+                        \r
+         uint8_t phase1_mux_sel = 0;    /* sel phase1*/\r
+               uint8_t phase2_mux_sel = 1;    /* sel phase2*/\r
+               uint8_t phase3_mux_sel = 2;    /* sel phase3*/\r
+               uint8_t phase4_mux_sel = 3;    /* sel phase4*/\r
+               uint8_t phase5_mux_sel = 4;    /* sel phase5*/\r
+               uint8_t phase6_mux_sel = 5;    /* sel phase6*/\r
+               uint8_t phase7_mux_sel = 6;    /* sel phase7*/\r
+               uint8_t phase8_mux_sel = 7;    /* sel phase8*/\r
+       \r
+\r
+         uint8_t phase1_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase1_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase1_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase1_led_drv1_cha_sel = 0;     /* 1 = ldr1  NG; 2 = ldr2   GR; 4 = ldr3  IR; 8 = ldr4 RED; */\r
+    uint8_t phase1_led_drv2_cha_sel = 0;    /*ldr5:0x20  ldr6: 0x40 red    ldr8 0x80  ir      */\r
+               uint8_t phase1_pd_sel = 0x0c;          /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase1_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase1_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase1_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase1_ldr2_cur = 0;\r
+//             uint8_t phase1_of_idac1_cur = 0;\r
+//    uint8_t phase1_of_idac2_cur = 0;\r
+    uint8_t phase1_ad_inr_ctrl = 3;\r
+    uint8_t phase1_ad_of_idac_ctrl = 0;\r
+//    uint8_t afe_offset  =  0;\r
+    uint8_t phase1_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase1_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase1_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+\r
+\r
+         uint8_t phase2_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase2_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase2_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase2_led_drv1_cha_sel = GREEN_LED_SLE;   //GREEN_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase2_led_drv2_cha_sel = 0x00;\r
+               uint8_t phase2_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase2_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase2_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase2_ldr1_cur = 16;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase2_ldr2_cur = 0;\r
+//             uint8_t phase2_of_idac1_cur = 0;\r
+//    uint8_t phase2_of_idac2_cur = 0;\r
+    uint8_t phase2_ad_inr_ctrl = 3;\r
+    uint8_t phase2_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase2_afe_offset  =  0;\r
+    uint8_t phase2_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase2_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase2_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+               \r
+    uint8_t phase3_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase3_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase3_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase3_led_drv1_cha_sel = RED_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase3_led_drv2_cha_sel = 0;\r
+               uint8_t phase3_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase3_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase3_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase3_ldr1_cur = 16;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase3_ldr2_cur = 0;\r
+//             uint8_t phase3_of_idac1_cur = 0;\r
+//    uint8_t phase3_of_idac2_cur = 0;\r
+    uint8_t phase3_ad_inr_ctrl = 3;\r
+    uint8_t phase3_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase3_afe_offset  =  0;\r
+    uint8_t phase3_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase3_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase3_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+               \r
+    uint8_t phase4_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase4_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase4_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase4_led_drv1_cha_sel = IR_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase4_led_drv2_cha_sel = 0;\r
+               uint8_t phase4_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase4_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase4_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase4_ldr1_cur = 16;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase4_ldr2_cur = 0;\r
+//             uint8_t phase4_of_idac1_cur = 0;\r
+//    uint8_t phase4_of_idac2_cur = 0;\r
+    uint8_t phase4_ad_inr_ctrl = 3;\r
+    uint8_t phase4_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase4_afe_offset  =  0;\r
+    uint8_t phase4_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase4_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase4_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase5_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase5_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase5_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase5_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase5_led_drv2_cha_sel = 0;\r
+               uint8_t phase5_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase5_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase5_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase5_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase5_ldr2_cur = 0;\r
+//             uint8_t phase5_of_idac1_cur = 0;\r
+//    uint8_t phase5_of_idac2_cur = 0;\r
+    uint8_t phase5_ad_inr_ctrl = 3;\r
+    uint8_t phase5_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase5_afe_offset  =  0;\r
+    uint8_t phase5_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase5_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase5_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase6_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase6_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase6_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase6_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase6_led_drv2_cha_sel = 0;\r
+               uint8_t phase6_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase6_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase6_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase6_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase6_ldr2_cur = 0;\r
+//             uint8_t phase6_of_idac1_cur = 0;\r
+//    uint8_t phase6_of_idac2_cur = 0;\r
+    uint8_t phase6_ad_inr_ctrl = 3;\r
+    uint8_t phase6_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase6_afe_offset  =  0;\r
+    uint8_t phase6_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase6_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase6_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase7_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase7_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase7_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase7_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase7_led_drv2_cha_sel = 0;\r
+               uint8_t phase7_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase7_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase7_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase7_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase7_ldr2_cur = 0;\r
+//             uint8_t phase7_of_idac1_cur = 0;\r
+//    uint8_t phase7_of_idac2_cur = 0;\r
+    uint8_t phase7_ad_inr_ctrl = 3;\r
+    uint8_t phase7_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase7_afe_offset  =  0;\r
+    uint8_t phase7_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase7_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase7_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase8_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase8_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase8_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase8_led_drv1_cha_sel = 0;   //IR_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase8_led_drv2_cha_sel = 0;\r
+               uint8_t phase8_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase8_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase8_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase8_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase8_ldr2_cur = 0;\r
+//             uint8_t phase8_of_idac1_cur = 0;\r
+//    uint8_t phase8_of_idac2_cur = 0;\r
+    uint8_t phase8_ad_inr_ctrl = 3;\r
+    uint8_t phase8_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase8_afe_offset  =  0;\r
+    uint8_t phase8_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase8_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase8_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t init_wait_delay = 5 ; /* 0 = 31clk ; 1 = 64clk ; 2 = 127clk ; 3 = 255clk(d) ;\r
+                                     4 = 511clk; 5 = 1023clk; 6 = 2047; 7 = 4095clk */         \r
+                                                                                                                                                \r
+    uint8_t afe_reset = 3;        /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d) ;\r
+                                     4 = 255clk; 5 = 511clk; 6 = 1024; 7 = 2047clk */\r
+                                                                                                                                                \r
+               uint8_t afe_rst_cnvt = 1;               /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d)*/\r
+    \r
+    uint8_t led_en_idac_pre    = 2;    /* 0 = 8clk ; 1 = 16clk ; 2 = 32clk ; 3 = 64clk(d)*/ \r
+               \r
+               uint8_t led_en_idac     =       1;        /* 0 = 4clk ; 1 = 8clk ; 2 = 16clk ; 3 = 32clk(d)*/ \r
+                                                                                                                                                \r
+    uint8_t led_on_time = 2;      /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+                                     4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+                                                                                                                                                \r
+    hx3695_delay_ms(10);               \r
+               \r
+    hx3695_write_reg(0X2a, (uint8_t)prf_clk_num);    // prf bit<7:0>6\r
+    hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+    hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>      \r
+                  \r
+    hx3695_write_reg(0X25, (afe_rst_cnvt<<4| led_en_idac_pre<<2|led_en_idac)); \r
+               hx3695_write_reg(0X2d, phase7_8_internal); \r
+               hx3695_write_reg(0X2e, 0x33);// gpio ctrl \r
+    hx3695_write_reg(0X2f, ((afe_reset<<4)| init_wait_delay));\r
+               hx3695_write_reg(0X30, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+    hx3695_write_reg(0X72, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+\r
+\r
+    hx3695_write_reg(0X31, (led_on_time<<4| 0x00));\r
+               hx3695_write_reg(0X33, 0x83);// Öжϼ«ÐÔ¼°¿í¶ÈÅäÖã»\r
+               hx3695_write_reg(0X34, 0x00);// ÖжÏÌØÊâÅäÖã»\r
+               hx3695_write_reg(0X36, 0x00);// phase data ready ±êÖ¾ÉèÖã»\r
+               hx3695_write_reg(0X38, 0x00);\r
+               \r
+    hx3695_write_reg(0X3a, (phase1_inner_avg | (phase2_inner_avg<<4)));  \r
+    hx3695_write_reg(0X3b, (phase3_inner_avg | (phase4_inner_avg<<4)));  \r
+    hx3695_write_reg(0X3c, (phase5_inner_avg | (phase6_inner_avg<<4)));        \r
+    hx3695_write_reg(0X3d, (phase7_inner_avg | (phase8_inner_avg<<4)));        \r
+    hx3695_write_reg(0X3e, adc_rst_post_num<<6 | samp_delay_leden_num<<4 | samp_copy_avg); \r
+    hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+    hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+               \r
+               hx3695_write_reg(0X43, phase1_mux_sel);  \r
+               hx3695_write_reg(0X44, phase1_tia_cap<<4|phase1_tia_res); \r
+               hx3695_write_reg(0X45, phase1_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase1_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase1_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase1_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+\r
+    hx3695_write_reg(0X49, phase1_ad_inr_ctrl<<4|phase1_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase1_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase1_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase1_dsp_mov_avg_num | phase1_dsp_iir_lp_coeff<<4);\r
+\r
+//    hx3695_write_reg(0X4e, thred_value);\r
+//    hx3695_write_reg(0X4f, thred_value>>5);\r
+               \r
+    hx3695_write_reg(0X43, phase2_mux_sel);  \r
+               hx3695_write_reg(0X44, phase2_tia_cap<<4|phase2_tia_res); \r
+               hx3695_write_reg(0X45, phase2_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase2_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase2_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase2_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase2_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase2_ad_inr_ctrl<<4|phase2_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase2_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase2_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase2_dsp_mov_avg_num | phase2_dsp_iir_lp_coeff<<4);\r
+               \r
+//phase3 sel\r
+\r
+    hx3695_write_reg(0X43, phase3_mux_sel);  \r
+               hx3695_write_reg(0X44, phase3_tia_cap<<4|phase3_tia_res); \r
+               hx3695_write_reg(0X45, phase3_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase3_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase3_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase3_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase3_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase3_ad_inr_ctrl<<4|phase3_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase3_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase3_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase3_dsp_mov_avg_num | phase3_dsp_iir_lp_coeff<<4);\r
+               \r
+//phase4 sel\r
+\r
+    hx3695_write_reg(0X43, phase4_mux_sel);  \r
+               hx3695_write_reg(0X44, phase4_tia_cap<<4|phase4_tia_res); \r
+               hx3695_write_reg(0X45, phase4_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase4_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase4_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase4_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase4_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase4_ad_inr_ctrl<<4|phase4_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase4_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase4_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase4_dsp_mov_avg_num | phase4_dsp_iir_lp_coeff<<4);\r
+\r
+               hx3695_write_reg(0X43, phase5_mux_sel);  \r
+               hx3695_write_reg(0X44, phase5_tia_cap<<4|phase5_tia_res); \r
+               hx3695_write_reg(0X45, phase5_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase5_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase5_pd_sel));    //<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase5_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase5_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase5_ad_inr_ctrl<<4|phase5_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase5_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase5_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase5_dsp_mov_avg_num | phase5_dsp_iir_lp_coeff<<4);\r
+               \r
+               \r
+         hx3695_write_reg(0X43, phase6_mux_sel);  \r
+               hx3695_write_reg(0X44, phase6_tia_cap<<4|phase6_tia_res); \r
+               hx3695_write_reg(0X45, phase6_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase6_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase6_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase6_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase6_ad_inr_ctrl<<4|phase6_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase6_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase6_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase6_dsp_mov_avg_num | phase6_dsp_iir_lp_coeff<<4);\r
+               \r
+       \r
+         hx3695_write_reg(0X43, phase7_mux_sel);  \r
+               hx3695_write_reg(0X44, phase7_tia_cap<<4|phase7_tia_res); \r
+               hx3695_write_reg(0X45, phase7_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase7_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase7_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase7_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase7_ad_inr_ctrl<<4|phase7_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase7_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase7_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase7_dsp_mov_avg_num | phase7_dsp_iir_lp_coeff<<4);\r
+               \r
+       \r
+         hx3695_write_reg(0X43, phase8_mux_sel);  \r
+               hx3695_write_reg(0X44, phase8_tia_cap<<4|phase8_tia_res); \r
+               hx3695_write_reg(0X45, phase8_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase8_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase8_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase8_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase8_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phas8_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase8_ad_inr_ctrl<<4|phase8_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase8_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase8_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase8_dsp_mov_avg_num | phase8_dsp_iir_lp_coeff<<4);\r
+               \r
+\r
+// analog circuit cfg \r
+    hx3695_write_reg(0X60, 0x14);      //\r
+               hx3695_write_reg(0X61, 0xf0);   \r
+               hx3695_write_reg(0X62, 0x22); \r
+               hx3695_write_reg(0X63, 0x15); \r
+                                                                                                                                                                                                                               \r
+               hx3695_write_reg(0X64, 0x08);   \r
+               hx3695_write_reg(0X65, 0x88); //bug\r
+               \r
+               hx3695_write_reg(0X66, 0x30);   // bits<3>=adc selftest en     0x30\r
+               hx3695_write_reg(0X67, 0x23);   \r
+               hx3695_write_reg(0X68, 0x46);   \r
+               hx3695_write_reg(0X69, 0x42);   \r
+               \r
+               hx3695_write_reg(0X39, 0xff);   // ofset idac1 phase enable cfg\r
+               hx3695_write_reg(0x73, 0xff);    //led_offset_idac phase enable\r
+               \r
+    hx3695_write_reg(0X6a, 0X0f);      \r
+               hx3695_write_reg(0X6b, 0X22);   \r
+               hx3695_write_reg(0X6c, 0X00);   \r
+               hx3695_write_reg(0X6d, 0X37);   \r
+               hx3695_write_reg(0X6e, 0X82);   \r
+               hx3695_write_reg(0X6f, 0X08);\r
+/////////FIFO and adc conversion ready config////////\r
+/////////FIFO and adc conversion ready config////////\r
+#if defined(PPG_INT_MODE)\r
+               hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble\r
+                hx3695_write_reg(0X33, 0x83);   // int width                                                                                                                                           \r
+     hx3695_write_reg(0X21, 0x00);   // fifo int sel,00=FIFO INT config clear\r
+                hx3695_write_reg(0X38, 0x01);   // int sel,00=close almost full int,04=enable almost full int\r
+#elif defined(INT_MODE)               //FIFO_ALL_MOST_FULL)\r
+                hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble\r
+                hx3695_write_reg(0X1c, (fifo_watermark&0xff));   //fifo_watermark\r
+                hx3695_write_reg(0X1d, fifo_watermark<<8);       //bit<0>=fifo_watermark[8]  \r
+                hx3695_write_reg(0X33, 0x83);   // int width   \r
+                hx3695_write_reg(0X21, 0x00);   // fifo int sel,00=FIFO INT config clear\r
+     hx3695_write_reg(0X38, 0x04);   // int sel,00=close almost full int,04=enable almost full int\r
+\r
+#else\r
+                hx3695_write_reg(0X1b, 0x92);    // bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble                                                                             \r
+     hx3695_write_reg(0X38, 0x01);   // int sel,00=close almost full int,04=enable almost full int\r
+     \r
+#endif\r
+\r
+               \r
+    hx3695_write_reg(0X26,(phase1_enable<<3)|(phase1_adc_osr)|(phase2_enable<<7)|(phase2_adc_osr<<4) ); \r
+    hx3695_write_reg(0X27,(phase3_enable<<3)|(phase3_adc_osr)|(phase4_enable<<7)|(phase4_adc_osr<<4) );  \r
+    hx3695_write_reg(0X28,(phase5_enable<<3)|(phase5_adc_osr)|(phase6_enable<<7)|(phase6_adc_osr<<4) );\r
+    hx3695_write_reg(0X29,(phase7_enable<<3)|(phase7_adc_osr)|(phase8_enable<<7)|(phase8_adc_osr<<4) );                \r
+\r
+//    hx3695_write_reg(0X5c, 0x02);//soft reset\r
+    hx3695_delay_ms(5);  \r
+    hx3695_write_reg(0X5c, 0x00);//release\r
+\r
+    return ;\r
+}\r
+\r
+void hx3695_factory_ft_leak_light_test_config(void)//©¹â²âÊÔÅäÖÃ\r
+{\r
+    uint16_t sample_rate = 25;                  /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+    uint32_t prf_clk_num = 32000/sample_rate;   /*period in clk num, num = Fclk/fs */\r
+         \r
+\r
+    uint8_t adc_rst_post_num= 0;       /* 00=16,01=32,10=64,11=128*/      \r
+         uint8_t samp_delay_leden_num = 0; /* 00=8,01=16,10=32,11=64*/ \r
+    uint8_t samp_copy_avg = 0;        /* 0=1, 1=2, 2=4 ,3=8, 4=16*/\r
+    uint8_t data_avg_num = 0;         /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+         uint8_t phase7_8_internal = 0;   //0x18;    /* phase7 and phase8 prf internal cfg */\r
+       \r
+//       uint16_t  thred_value = 32500;\r
+       \r
+    uint8_t phase1_enable = 1;     /*phase1_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase2_enable = 1;     /*phase2_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase3_enable = 1;     /*phase3_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase4_enable = 1;     /*phase4_enable  , 1 mean enable ; 0 mean disable */\r
+    uint8_t phase5_enable = 0;     /*phase5_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase6_enable = 0;     /*phase6_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase7_enable = 0;     /*phase7_enable  , 1 mean enable ; 0 mean disable */        \r
+         uint8_t phase8_enable = 0;     /*phase8_enable  , 1 mean enable ; 0 mean disable */ \r
+\r
+    uint8_t phase1_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase2_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase3_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase4_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase5_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+         uint8_t phase6_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase7_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase8_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+                        \r
+         uint8_t phase1_mux_sel = 0;    /* sel phase1*/\r
+               uint8_t phase2_mux_sel = 1;    /* sel phase2*/\r
+               uint8_t phase3_mux_sel = 2;    /* sel phase3*/\r
+               uint8_t phase4_mux_sel = 3;    /* sel phase4*/\r
+               uint8_t phase5_mux_sel = 4;    /* sel phase5*/\r
+               uint8_t phase6_mux_sel = 5;    /* sel phase6*/\r
+               uint8_t phase7_mux_sel = 6;    /* sel phase7*/\r
+               uint8_t phase8_mux_sel = 7;    /* sel phase8*/\r
+       \r
+\r
+         uint8_t phase1_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase1_tia_res = 5;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase1_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase1_led_drv1_cha_sel = 0;     /* 1 = ldr1  NG; 2 = ldr2   GR; 4 = ldr3  IR; 8 = ldr4 RED; */\r
+    uint8_t phase1_led_drv2_cha_sel = 0;    /*ldr5:0x20  ldr6: 0x40 red    ldr8 0x80  ir      */\r
+               uint8_t phase1_pd_sel = 0x0c;          /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase1_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase1_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase1_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase1_ldr2_cur = 0;\r
+//             uint8_t phase1_of_idac1_cur = 0;\r
+//    uint8_t phase1_of_idac2_cur = 0;\r
+    uint8_t phase1_ad_inr_ctrl = 3;\r
+    uint8_t phase1_ad_of_idac_ctrl = 0;\r
+//    uint8_t afe_offset  =  0;\r
+    uint8_t phase1_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase1_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase1_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+\r
+\r
+         uint8_t phase2_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase2_tia_res = 5;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase2_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase2_led_drv1_cha_sel = GREEN_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase2_led_drv2_cha_sel = 0x00;\r
+               uint8_t phase2_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase2_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase2_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase2_ldr1_cur = 64;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase2_ldr2_cur = 0;\r
+//             uint8_t phase2_of_idac1_cur = 0;\r
+//    uint8_t phase2_of_idac2_cur = 0;\r
+    uint8_t phase2_ad_inr_ctrl = 3;\r
+    uint8_t phase2_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase2_afe_offset  =  0;\r
+    uint8_t phase2_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase2_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase2_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+               \r
+    uint8_t phase3_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase3_tia_res = 5;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase3_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase3_led_drv1_cha_sel = RED_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase3_led_drv2_cha_sel = 0;\r
+               uint8_t phase3_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase3_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase3_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase3_ldr1_cur = 64;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase3_ldr2_cur = 0;\r
+//             uint8_t phase3_of_idac1_cur = 0;\r
+//    uint8_t phase3_of_idac2_cur = 0;\r
+    uint8_t phase3_ad_inr_ctrl = 3;\r
+    uint8_t phase3_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase3_afe_offset  =  0;\r
+    uint8_t phase3_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase3_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase3_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+               \r
+    uint8_t phase4_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase4_tia_res = 5;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase4_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase4_led_drv1_cha_sel = IR_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase4_led_drv2_cha_sel = 0;\r
+               uint8_t phase4_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase4_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase4_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase4_ldr1_cur = 64;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase4_ldr2_cur = 0;\r
+//             uint8_t phase4_of_idac1_cur = 0;\r
+//    uint8_t phase4_of_idac2_cur = 0;\r
+    uint8_t phase4_ad_inr_ctrl = 3;\r
+    uint8_t phase4_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase4_afe_offset  =  0;\r
+    uint8_t phase4_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase4_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase4_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase5_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase5_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase5_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase5_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase5_led_drv2_cha_sel = 0;\r
+               uint8_t phase5_pd_sel = 4;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase5_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase5_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase5_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase5_ldr2_cur = 0;\r
+//             uint8_t phase5_of_idac1_cur = 0;\r
+//    uint8_t phase5_of_idac2_cur = 0;\r
+    uint8_t phase5_ad_inr_ctrl = 3;\r
+    uint8_t phase5_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase5_afe_offset  =  0;\r
+    uint8_t phase5_led_en = 0;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase5_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase5_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase6_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase6_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase6_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase6_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase6_led_drv2_cha_sel = 0;\r
+               uint8_t phase6_pd_sel = 4;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase6_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase6_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase6_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase6_ldr2_cur = 0;\r
+//             uint8_t phase6_of_idac1_cur = 0;\r
+//    uint8_t phase6_of_idac2_cur = 0;\r
+    uint8_t phase6_ad_inr_ctrl = 3;\r
+    uint8_t phase6_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase6_afe_offset  =  0;\r
+    uint8_t phase6_led_en = 0;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase6_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase6_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase7_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase7_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase7_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase7_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase7_led_drv2_cha_sel = 0;\r
+               uint8_t phase7_pd_sel = 0x00;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase7_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase7_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase7_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase7_ldr2_cur = 0;\r
+//             uint8_t phase7_of_idac1_cur = 0;\r
+//    uint8_t phase7_of_idac2_cur = 0;\r
+    uint8_t phase7_ad_inr_ctrl = 3;\r
+    uint8_t phase7_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase7_afe_offset  =  0;\r
+    uint8_t phase7_led_en = 0;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase7_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase7_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase8_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase8_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase8_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase8_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase8_led_drv2_cha_sel = 0;\r
+               uint8_t phase8_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase8_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase8_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase8_ldr1_cur = 50;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase8_ldr2_cur = 0;\r
+//             uint8_t phase8_of_idac1_cur = 0;\r
+//    uint8_t phase8_of_idac2_cur = 0;\r
+    uint8_t phase8_ad_inr_ctrl = 3;\r
+    uint8_t phase8_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase8_afe_offset  =  0;\r
+    uint8_t phase8_led_en = 0;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase8_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase8_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t init_wait_delay = 4 ; /* 0 = 31clk ; 1 = 64clk ; 2 = 127clk ; 3 = 255clk(d) ;\r
+                                     4 = 511clk; 5 = 1023clk; 6 = 2047; 7 = 4095clk */         \r
+                                                                                                                                                \r
+    uint8_t afe_reset = 3;        /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d) ;\r
+                                     4 = 255clk; 5 = 511clk; 6 = 1024; 7 = 2047clk */\r
+                                                                                                                                                \r
+               uint8_t afe_rst_cnvt = 1;               /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d)*/\r
+    \r
+    uint8_t led_en_idac_pre    = 2;    /* 0 = 8clk ; 1 = 16clk ; 2 = 32clk ; 3 = 64clk(d)*/ \r
+               \r
+               uint8_t led_en_idac     =       1;        /* 0 = 4clk ; 1 = 8clk ; 2 = 16clk ; 3 = 32clk(d)*/ \r
+                                                                                                                                                \r
+    uint8_t led_on_time = 2;      /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+                                     4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+                                                                                                                                                \r
+    hx3695_delay_ms(10);               \r
+                       \r
+    hx3695_write_reg(0X2a, (uint8_t)prf_clk_num);    // prf bit<7:0>6\r
+    hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+    hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>      \r
+                  \r
+    hx3695_write_reg(0X25, (afe_rst_cnvt<<4| led_en_idac_pre<<2|led_en_idac)); \r
+               hx3695_write_reg(0X2d, phase7_8_internal); \r
+               hx3695_write_reg(0X2e, 0x33);// gpio ctrl \r
+    hx3695_write_reg(0X2f, ((afe_reset<<4)| init_wait_delay));\r
+               hx3695_write_reg(0X30, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+    hx3695_write_reg(0X72, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+\r
+\r
+    hx3695_write_reg(0X31, (led_on_time<<4| 0x00));\r
+               hx3695_write_reg(0X33, 0x83);// Öжϼ«ÐÔ¼°¿í¶ÈÅäÖã»\r
+               hx3695_write_reg(0X34, 0x00);// ÖжÏÌØÊâÅäÖã»\r
+               hx3695_write_reg(0X36, 0x00);// phase data ready ±êÖ¾ÉèÖã»\r
+               hx3695_write_reg(0X38, 0x00);\r
+               \r
+    hx3695_write_reg(0X3a, (phase1_inner_avg | (phase2_inner_avg<<4)));  \r
+    hx3695_write_reg(0X3b, (phase3_inner_avg | (phase4_inner_avg<<4)));  \r
+    hx3695_write_reg(0X3c, (phase5_inner_avg | (phase6_inner_avg<<4)));        \r
+    hx3695_write_reg(0X3d, (phase7_inner_avg | (phase8_inner_avg<<4)));        \r
+    hx3695_write_reg(0X3e, adc_rst_post_num<<6 | samp_delay_leden_num<<4 | samp_copy_avg); \r
+    hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+    hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+               \r
+               hx3695_write_reg(0X43, phase1_mux_sel);  \r
+               hx3695_write_reg(0X44, phase1_tia_cap<<4|phase1_tia_res); \r
+               hx3695_write_reg(0X45, phase1_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase1_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase1_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase1_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49, phase1_ad_inr_ctrl<<4|phase1_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase1_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase1_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase1_dsp_mov_avg_num | phase1_dsp_iir_lp_coeff<<4);\r
+\r
+       \r
+    hx3695_write_reg(0X43, phase2_mux_sel);  \r
+               hx3695_write_reg(0X44, phase2_tia_cap<<4|phase2_tia_res); \r
+               hx3695_write_reg(0X45, phase2_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase2_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase2_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase2_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase2_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase2_ad_inr_ctrl<<4|phase2_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase2_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase2_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase2_dsp_mov_avg_num | phase2_dsp_iir_lp_coeff<<4);\r
+               \r
+//phase3 sel\r
+\r
+    hx3695_write_reg(0X43, phase3_mux_sel);  \r
+               hx3695_write_reg(0X44, phase3_tia_cap<<4|phase3_tia_res); \r
+               hx3695_write_reg(0X45, phase3_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase3_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase3_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase3_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase3_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase3_ad_inr_ctrl<<4|phase3_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase3_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase3_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase3_dsp_mov_avg_num | phase3_dsp_iir_lp_coeff<<4);\r
+               \r
+//phase4 sel\r
+\r
+    hx3695_write_reg(0X43, phase4_mux_sel);  \r
+               hx3695_write_reg(0X44, phase4_tia_cap<<4|phase4_tia_res); \r
+               hx3695_write_reg(0X45, phase4_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase4_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase4_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase4_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase4_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase4_ad_inr_ctrl<<4|phase4_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase4_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase4_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase4_dsp_mov_avg_num | phase4_dsp_iir_lp_coeff<<4);\r
+\r
+               hx3695_write_reg(0X43, phase5_mux_sel);  \r
+               hx3695_write_reg(0X44, phase5_tia_cap<<4|phase5_tia_res); \r
+               hx3695_write_reg(0X45, phase5_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase5_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase5_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase5_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase5_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase5_ad_inr_ctrl<<4|phase5_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase5_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase5_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase5_dsp_mov_avg_num | phase5_dsp_iir_lp_coeff<<4);\r
+               \r
+               \r
+         hx3695_write_reg(0X43, phase6_mux_sel);  \r
+               hx3695_write_reg(0X44, phase6_tia_cap<<4|phase6_tia_res); \r
+               hx3695_write_reg(0X45, phase6_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase6_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase6_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase6_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase6_ad_inr_ctrl<<4|phase6_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase6_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase6_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase6_dsp_mov_avg_num | phase6_dsp_iir_lp_coeff<<4);\r
+               \r
+       \r
+         hx3695_write_reg(0X43, phase7_mux_sel);  \r
+               hx3695_write_reg(0X44, phase7_tia_cap<<4|phase7_tia_res); \r
+               hx3695_write_reg(0X45, phase7_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase7_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase7_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase7_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase7_ad_inr_ctrl<<4|phase7_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase7_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase7_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase7_dsp_mov_avg_num | phase7_dsp_iir_lp_coeff<<4);\r
+               \r
+       \r
+         hx3695_write_reg(0X43, phase8_mux_sel);  \r
+               hx3695_write_reg(0X44, phase8_tia_cap<<4|phase8_tia_res); \r
+               hx3695_write_reg(0X45, phase8_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase8_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase8_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase8_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase8_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phas8_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase8_ad_inr_ctrl<<4|phase8_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase8_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase8_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase8_dsp_mov_avg_num | phase8_dsp_iir_lp_coeff<<4);\r
+               \r
+\r
+// analog circuit cfg \r
+    hx3695_write_reg(0X60, 0x14);      //\r
+               hx3695_write_reg(0X61, 0xf0);   \r
+               hx3695_write_reg(0X62, 0x22); \r
+               hx3695_write_reg(0X63, 0x15); \r
+                                                                                                                                                                                                                               \r
+               hx3695_write_reg(0X64, 0x08);   \r
+               hx3695_write_reg(0X65, 0x88); //bug\r
+               \r
+               hx3695_write_reg(0X66, 0x30);   // bits<3>=adc selftest en     0x30\r
+               hx3695_write_reg(0X67, 0x23);   \r
+               hx3695_write_reg(0X68, 0x46);   \r
+               hx3695_write_reg(0X69, 0x42);   \r
+               \r
+               hx3695_write_reg(0X39, 0xff);   // ofset idac1 phase enable cfg\r
+               hx3695_write_reg(0x73, 0xff);    //led_offset_idac phase enable\r
+               \r
+    hx3695_write_reg(0X6a, 0X0f);      \r
+               hx3695_write_reg(0X6b, 0X22);   \r
+               hx3695_write_reg(0X6c, 0X00);   \r
+               hx3695_write_reg(0X6d, 0X37);   \r
+               hx3695_write_reg(0X6e, 0X82);   \r
+               hx3695_write_reg(0X6f, 0X08);\r
+/////////FIFO and adc conversion ready config////////\r
+/////////FIFO and adc conversion ready config////////\r
+#if defined(PPG_INT_MODE)\r
+               hx3695_write_reg(0X1b, 0x00);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble\r
+                hx3695_write_reg(0X33, 0x83);   // int width                                                                                                                                           \r
+     hx3695_write_reg(0X21, 0x00);   // fifo int sel,00=FIFO INT config clear\r
+                hx3695_write_reg(0X38, 0x08);   // int sel,00=close almost full int,04=enable almost full int\r
+#elif defined(INT_MODE)             //(FIFO_ALL_MOST_FULL)\r
+                hx3695_write_reg(0X1b, 0x90);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble\r
+                hx3695_write_reg(0X1c, (fifo_watermark&0xff));   //fifo_watermark\r
+                hx3695_write_reg(0X1d, fifo_watermark<<8);       //bit<0>=fifo_watermark[8]  \r
+                hx3695_write_reg(0X33, 0x83);   // int width                                                                                                                                           \r
+     hx3695_write_reg(0X38, 0x04);   // int sel,00=close almost full int,04=enable almost full int\r
+\r
+#else\r
+               hx3695_write_reg(0X1b, 0x90);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble     \r
+     hx3695_write_reg(0X36, 0x00);                       //intrupt                                                                                                                                     \r
+                                                                                                                                               \r
+     hx3695_write_reg(0X38, 0x00);   // int sel,00=close almost full int,01= prf int  04=enable almost full int\r
+\r
+#endif\r
+\r
+               \r
+    hx3695_write_reg(0X26,(phase1_enable<<3)|(phase1_adc_osr)|(phase2_enable<<7)|(phase2_adc_osr<<4) ); \r
+    hx3695_write_reg(0X27,(phase3_enable<<3)|(phase3_adc_osr)|(phase4_enable<<7)|(phase4_adc_osr<<4) );  \r
+    hx3695_write_reg(0X28,(phase5_enable<<3)|(phase5_adc_osr)|(phase6_enable<<7)|(phase6_adc_osr<<4) );\r
+    hx3695_write_reg(0X29,(phase7_enable<<3)|(phase7_adc_osr)|(phase8_enable<<7)|(phase8_adc_osr<<4) );                \r
+\r
+//    hx3695_write_reg(0X5c, 0x02);//soft reset\r
+    hx3695_delay_ms(5);  \r
+    hx3695_write_reg(0X5c, 0x00);//release\r
+\r
+    return ;\r
+}\r
+\r
+void hx3695_factory_led_off_config(void)\r
+{\r
+    uint16_t sample_rate = 25;                  /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+    uint32_t prf_clk_num = 32000/sample_rate;   /*period in clk num, num = Fclk/fs */\r
+\r
+    uint8_t adc_rst_post_num=0;       /* 00=16,01=32,10=64,11=128*/      \r
+         uint8_t samp_delay_leden_num = 0; /* 00=8,01=16,10=32,11=64*/ \r
+    uint8_t samp_copy_avg = 0;        /* 0=1, 1=2, 2=4 ,3=8, 4=16*/\r
+    uint8_t data_avg_num = 0;         /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+         uint8_t phase7_8_internal = 0;    /* phase7 and phase8 prf internal cfg */\r
+               \r
+    uint8_t phase1_enable = 1;     /*phase1_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase2_enable = 1;     /*phase2_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase3_enable = 1;     /*phase3_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase4_enable = 1;     /*phase4_enable  , 1 mean enable ; 0 mean disable */\r
+    uint8_t phase5_enable = 0;     /*phase5_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase6_enable = 0;     /*phase6_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase7_enable = 0;     /*phase7_enable  , 1 mean enable ; 0 mean disable */        \r
+         uint8_t phase8_enable = 0;     /*phase8_enable  , 1 mean enable ; 0 mean disable */ \r
+\r
+    uint8_t phase1_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase2_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase3_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase4_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase5_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+         uint8_t phase6_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase7_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase8_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+                        \r
+         uint8_t phase1_mux_sel = 0;    /* sel phase1*/\r
+               uint8_t phase2_mux_sel = 1;    /* sel phase2*/\r
+               uint8_t phase3_mux_sel = 2;    /* sel phase3*/\r
+               uint8_t phase4_mux_sel = 3;    /* sel phase4*/\r
+               uint8_t phase5_mux_sel = 4;    /* sel phase5*/\r
+               uint8_t phase6_mux_sel = 5;    /* sel phase6*/\r
+               uint8_t phase7_mux_sel = 6;    /* sel phase7*/\r
+               uint8_t phase8_mux_sel = 7;    /* sel phase8*/\r
+       \r
+\r
+         uint8_t phase1_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase1_tia_res = 5;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase1_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase1_led_drv1_cha_sel = 0;     /* 1 = ldr1  NG; 2 = ldr2   GR; 4 = ldr3  IR; 8 = ldr4 RED; */\r
+    uint8_t phase1_led_drv2_cha_sel = 0;    /*ldr5:0x20  ldr6: 0x40 red    ldr8 0x80  ir      */\r
+               uint8_t phase1_pd_sel = 0x0c;          /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase1_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase1_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase1_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase1_ldr2_cur = 0;\r
+//             uint8_t phase1_of_idac1_cur = 0;\r
+//    uint8_t phase1_of_idac2_cur = 0;\r
+    uint8_t phase1_ad_inr_ctrl = 3;\r
+    uint8_t phase1_ad_of_idac_ctrl = 0;\r
+//    uint8_t afe_offset  =  0;\r
+    uint8_t phase1_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase1_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase1_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+\r
+\r
+         uint8_t phase2_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase2_tia_res = 5;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase2_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase2_led_drv1_cha_sel = GREEN_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase2_led_drv2_cha_sel = 0;\r
+               uint8_t phase2_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase2_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase2_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase2_ldr1_cur = 15;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase2_ldr2_cur = 0;\r
+//             uint8_t phase2_of_idac1_cur = 0;\r
+//    uint8_t phase2_of_idac2_cur = 0;\r
+    uint8_t phase2_ad_inr_ctrl = 3;\r
+    uint8_t phase2_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase2_afe_offset  =  0;\r
+    uint8_t phase2_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase2_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase2_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+               \r
+    uint8_t phase3_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase3_tia_res = 5;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase3_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase3_led_drv1_cha_sel = RED_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase3_led_drv2_cha_sel = 0;\r
+               uint8_t phase3_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase3_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase3_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase3_ldr1_cur = 15;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase3_ldr2_cur = 0;\r
+//             uint8_t phase3_of_idac1_cur = 0;\r
+//    uint8_t phase3_of_idac2_cur = 0;\r
+    uint8_t phase3_ad_inr_ctrl = 3;\r
+    uint8_t phase3_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase3_afe_offset  =  0;\r
+    uint8_t phase3_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase3_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase3_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+               \r
+    uint8_t phase4_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase4_tia_res = 5;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase4_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase4_led_drv1_cha_sel = IR_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase4_led_drv2_cha_sel = 0;\r
+               uint8_t phase4_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase4_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase4_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase4_ldr1_cur = 15;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase4_ldr2_cur = 0;\r
+//             uint8_t phase4_of_idac1_cur = 0;\r
+//    uint8_t phase4_of_idac2_cur = 0;\r
+    uint8_t phase4_ad_inr_ctrl = 3;\r
+    uint8_t phase4_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase4_afe_offset  =  0;\r
+    uint8_t phase4_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase4_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase4_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase5_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase5_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase5_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase5_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase5_led_drv2_cha_sel = 0;\r
+               uint8_t phase5_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase5_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase5_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase5_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase5_ldr2_cur = 0;\r
+//             uint8_t phase5_of_idac1_cur = 0;\r
+//    uint8_t phase5_of_idac2_cur = 0;\r
+    uint8_t phase5_ad_inr_ctrl = 3;\r
+    uint8_t phase5_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase5_afe_offset  =  0;\r
+    uint8_t phase5_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase5_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase5_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase6_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase6_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase6_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase6_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase6_led_drv2_cha_sel = 0;\r
+               uint8_t phase6_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase6_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase6_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase6_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase6_ldr2_cur = 0;\r
+//             uint8_t phase6_of_idac1_cur = 0;\r
+//    uint8_t phase6_of_idac2_cur = 0;\r
+    uint8_t phase6_ad_inr_ctrl = 3;\r
+    uint8_t phase6_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase6_afe_offset  =  0;\r
+    uint8_t phase6_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase6_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase6_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase7_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase7_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase7_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase7_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase7_led_drv2_cha_sel = 0;\r
+               uint8_t phase7_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase7_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase7_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase7_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase7_ldr2_cur = 0;\r
+//             uint8_t phase7_of_idac1_cur = 0;\r
+//    uint8_t phase7_of_idac2_cur = 0;\r
+    uint8_t phase7_ad_inr_ctrl = 3;\r
+    uint8_t phase7_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase7_afe_offset  =  0;\r
+    uint8_t phase7_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase7_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase7_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase8_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase8_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase8_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase8_led_drv1_cha_sel = 0;   //IR_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase8_led_drv2_cha_sel = 0;\r
+               uint8_t phase8_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase8_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase8_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase8_ldr1_cur = 20;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase8_ldr2_cur = 0;\r
+//             uint8_t phase8_of_idac1_cur = 0;\r
+//    uint8_t phase8_of_idac2_cur = 0;\r
+    uint8_t phase8_ad_inr_ctrl = 3;\r
+    uint8_t phase8_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase8_afe_offset  =  0;\r
+    uint8_t phase8_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase8_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase8_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t init_wait_delay = 5 ; /* 0 = 31clk ; 1 = 64clk ; 2 = 127clk ; 3 = 255clk(d) ;\r
+                                     4 = 511clk; 5 = 1023clk; 6 = 2047; 7 = 4095clk */         \r
+                                                                                                                                                \r
+    uint8_t afe_reset = 3;        /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d) ;\r
+                                     4 = 255clk; 5 = 511clk; 6 = 1024; 7 = 2047clk */\r
+                                                                                                                                                \r
+               uint8_t afe_rst_cnvt = 1;               /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d)*/\r
+    \r
+    uint8_t led_en_idac_pre    = 2;    /* 0 = 8clk ; 1 = 16clk ; 2 = 32clk ; 3 = 64clk(d)*/ \r
+               \r
+               uint8_t led_en_idac     =       1;        /* 0 = 4clk ; 1 = 8clk ; 2 = 16clk ; 3 = 32clk(d)*/ \r
+                                                                                                                                                \r
+    uint8_t led_on_time = 2;      /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+                                     4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+                                                                                                                                                \r
+    hx3695_delay_ms(10);               \r
+               \r
+    hx3695_write_reg(0X2a, (uint8_t)prf_clk_num);    // prf bit<7:0>6\r
+    hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+    hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>      \r
+                  \r
+    hx3695_write_reg(0X25, (afe_rst_cnvt<<4| led_en_idac_pre<<2|led_en_idac)); \r
+               hx3695_write_reg(0X2d, phase7_8_internal); \r
+               hx3695_write_reg(0X2e, 0x33);// gpio ctrl \r
+    hx3695_write_reg(0X2f, ((afe_reset<<4)| init_wait_delay));\r
+               hx3695_write_reg(0X30, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+    hx3695_write_reg(0X72, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+\r
+\r
+    hx3695_write_reg(0X31, (led_on_time<<4| 0x00));\r
+               hx3695_write_reg(0X33, 0x83);// Öжϼ«ÐÔ¼°¿í¶ÈÅäÖã»\r
+               hx3695_write_reg(0X34, 0x00);// ÖжÏÌØÊâÅäÖã»\r
+               hx3695_write_reg(0X36, 0x00);// phase data ready ±êÖ¾ÉèÖã»\r
+               hx3695_write_reg(0X38, 0x00);\r
+               \r
+    hx3695_write_reg(0X3a, (phase1_inner_avg | (phase2_inner_avg<<4)));  \r
+    hx3695_write_reg(0X3b, (phase3_inner_avg | (phase4_inner_avg<<4)));  \r
+    hx3695_write_reg(0X3c, (phase5_inner_avg | (phase6_inner_avg<<4)));        \r
+    hx3695_write_reg(0X3d, (phase7_inner_avg | (phase8_inner_avg<<4)));        \r
+    hx3695_write_reg(0X3e, adc_rst_post_num<<6 | samp_delay_leden_num<<4 | samp_copy_avg); \r
+    hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+    hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+               \r
+               hx3695_write_reg(0X43, phase1_mux_sel);  \r
+               hx3695_write_reg(0X44, phase1_tia_cap<<4|phase1_tia_res); \r
+               hx3695_write_reg(0X45, phase1_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase1_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase1_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase1_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+\r
+    hx3695_write_reg(0X49, phase1_ad_inr_ctrl<<4|phase1_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase1_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase1_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase1_dsp_mov_avg_num | phase1_dsp_iir_lp_coeff<<4);\r
+\r
+//    hx3695_write_reg(0X4e, thred_value);\r
+//    hx3695_write_reg(0X4f, thred_value>>5);\r
+               \r
+    hx3695_write_reg(0X43, phase2_mux_sel);  \r
+               hx3695_write_reg(0X44, phase2_tia_cap<<4|phase2_tia_res); \r
+               hx3695_write_reg(0X45, phase2_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase2_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase2_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase2_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase2_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase2_ad_inr_ctrl<<4|phase2_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase2_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase2_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase2_dsp_mov_avg_num | phase2_dsp_iir_lp_coeff<<4);\r
+               \r
+//phase3 sel\r
+\r
+    hx3695_write_reg(0X43, phase3_mux_sel);  \r
+               hx3695_write_reg(0X44, phase3_tia_cap<<4|phase3_tia_res); \r
+               hx3695_write_reg(0X45, phase3_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase3_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase3_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase3_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase3_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase3_ad_inr_ctrl<<4|phase3_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase3_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase3_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase3_dsp_mov_avg_num | phase3_dsp_iir_lp_coeff<<4);\r
+               \r
+//phase4 sel\r
+\r
+    hx3695_write_reg(0X43, phase4_mux_sel);  \r
+               hx3695_write_reg(0X44, phase4_tia_cap<<4|phase4_tia_res); \r
+               hx3695_write_reg(0X45, phase4_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase4_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase4_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase4_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase4_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase4_ad_inr_ctrl<<4|phase4_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase4_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase4_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase4_dsp_mov_avg_num | phase4_dsp_iir_lp_coeff<<4);\r
+\r
+               hx3695_write_reg(0X43, phase5_mux_sel);  \r
+               hx3695_write_reg(0X44, phase5_tia_cap<<4|phase5_tia_res); \r
+               hx3695_write_reg(0X45, phase5_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase5_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase5_pd_sel));    //<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase5_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase5_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase5_ad_inr_ctrl<<4|phase5_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase5_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase5_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase5_dsp_mov_avg_num | phase5_dsp_iir_lp_coeff<<4);\r
+               \r
+               \r
+         hx3695_write_reg(0X43, phase6_mux_sel);  \r
+               hx3695_write_reg(0X44, phase6_tia_cap<<4|phase6_tia_res); \r
+               hx3695_write_reg(0X45, phase6_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase6_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase6_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase6_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase6_ad_inr_ctrl<<4|phase6_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase6_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase6_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase6_dsp_mov_avg_num | phase6_dsp_iir_lp_coeff<<4);\r
+               \r
+       \r
+         hx3695_write_reg(0X43, phase7_mux_sel);  \r
+               hx3695_write_reg(0X44, phase7_tia_cap<<4|phase7_tia_res); \r
+               hx3695_write_reg(0X45, phase7_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase7_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase7_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase7_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase7_ad_inr_ctrl<<4|phase7_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase7_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase7_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase7_dsp_mov_avg_num | phase7_dsp_iir_lp_coeff<<4);\r
+               \r
+       \r
+         hx3695_write_reg(0X43, phase8_mux_sel);  \r
+               hx3695_write_reg(0X44, phase8_tia_cap<<4|phase8_tia_res); \r
+               hx3695_write_reg(0X45, phase8_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase8_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase8_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase8_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase8_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phas8_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase8_ad_inr_ctrl<<4|phase8_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase8_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase8_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase8_dsp_mov_avg_num | phase8_dsp_iir_lp_coeff<<4);\r
+               \r
+\r
+// analog circuit cfg \r
+    hx3695_write_reg(0X60, 0x14);      //\r
+               hx3695_write_reg(0X61, 0xf0);   \r
+               hx3695_write_reg(0X62, 0x22); \r
+               hx3695_write_reg(0X63, 0x15); \r
+                                                                                                                                                                                                                               \r
+               hx3695_write_reg(0X64, 0x08);   \r
+               hx3695_write_reg(0X65, 0x88); //bug\r
+               \r
+               hx3695_write_reg(0X66, 0x30);   // bits<3>=adc selftest en     0x30\r
+               hx3695_write_reg(0X67, 0x23);   \r
+               hx3695_write_reg(0X68, 0x46);   \r
+               hx3695_write_reg(0X69, 0x42);   \r
+               \r
+               hx3695_write_reg(0X39, 0xff);   // ofset idac1 phase enable cfg\r
+               hx3695_write_reg(0x73, 0xff);    //led_offset_idac phase enable\r
+               \r
+    hx3695_write_reg(0X6a, 0X0f);      \r
+               hx3695_write_reg(0X6b, 0X22);   \r
+               hx3695_write_reg(0X6c, 0X00);   \r
+               hx3695_write_reg(0X6d, 0X37);   \r
+               hx3695_write_reg(0X6e, 0X82);   \r
+               hx3695_write_reg(0X6f, 0X08);\r
+/////////FIFO and adc conversion ready config////////\r
+/////////FIFO and adc conversion ready config////////\r
+#if defined(PPG_INT_MODE)\r
+               hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble\r
+                hx3695_write_reg(0X33, 0x83);   // int width                                                                                                                                           \r
+     hx3695_write_reg(0X21, 0x00);   // fifo int sel,00=FIFO INT config clear\r
+                hx3695_write_reg(0X38, 0x01);   // int sel,00=close almost full int,04=enable almost full int\r
+#elif defined(INT_MODE)               //FIFO_ALL_MOST_FULL)\r
+                hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble\r
+                hx3695_write_reg(0X1c, (fifo_watermark&0xff));   //fifo_watermark\r
+                hx3695_write_reg(0X1d, fifo_watermark<<8);       //bit<0>=fifo_watermark[8]  \r
+                hx3695_write_reg(0X33, 0x83);   // int width   \r
+                hx3695_write_reg(0X21, 0x00);   // fifo int sel,00=FIFO INT config clear\r
+     hx3695_write_reg(0X38, 0x04);   // int sel,00=close almost full int,04=enable almost full int\r
+\r
+#else\r
+                hx3695_write_reg(0X1b, 0x92);    // bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble                                                                             \r
+     hx3695_write_reg(0X38, 0x01);   // int sel,00=close almost full int,04=enable almost full int\r
+     \r
+#endif\r
+\r
+               \r
+    hx3695_write_reg(0X26,(phase1_enable<<3)|(phase1_adc_osr)|(phase2_enable<<7)|(phase2_adc_osr<<4) ); \r
+    hx3695_write_reg(0X27,(phase3_enable<<3)|(phase3_adc_osr)|(phase4_enable<<7)|(phase4_adc_osr<<4) );  \r
+    hx3695_write_reg(0X28,(phase5_enable<<3)|(phase5_adc_osr)|(phase6_enable<<7)|(phase6_adc_osr<<4) );\r
+    hx3695_write_reg(0X29,(phase7_enable<<3)|(phase7_adc_osr)|(phase8_enable<<7)|(phase8_adc_osr<<4) );                \r
+\r
+//    hx3695_write_reg(0X5c, 0x02);//soft reset\r
+    hx3695_delay_ms(5);  \r
+    hx3695_write_reg(0X5c, 0x00);//release\r
+//    read_fifo_first_flg = 1;\r
+    return ;\r
+}\r
+\r
+void hx3695_factory_ft_int_test_config(void)//ÖжϲâÊÔÅäÖÃ\r
+{\r
+           uint16_t sample_rate = 25;                  /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+    uint32_t prf_clk_num = 32000/sample_rate;   /*period in clk num, num = Fclk/fs */\r
+\r
+    uint8_t adc_rst_post_num=0;       /* 00=16,01=32,10=64,11=128*/      \r
+         uint8_t samp_delay_leden_num = 0; /* 00=8,01=16,10=32,11=64*/ \r
+    uint8_t samp_copy_avg = 0;        /* 0=1, 1=2, 2=4 ,3=8, 4=16*/\r
+    uint8_t data_avg_num = 0;         /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+         uint8_t phase7_8_internal = 0;    /* phase7 and phase8 prf internal cfg */\r
+               \r
+    uint8_t phase1_enable = 1;     /*phase1_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase2_enable = 1;     /*phase2_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase3_enable = 1;     /*phase3_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase4_enable = 1;     /*phase4_enable  , 1 mean enable ; 0 mean disable */\r
+    uint8_t phase5_enable = 0;     /*phase5_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase6_enable = 0;     /*phase6_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase7_enable = 0;     /*phase7_enable  , 1 mean enable ; 0 mean disable */        \r
+         uint8_t phase8_enable = 0;     /*phase8_enable  , 1 mean enable ; 0 mean disable */ \r
+\r
+    uint8_t phase1_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase2_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase3_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase4_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase5_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+         uint8_t phase6_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase7_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+               uint8_t phase8_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+                        \r
+         uint8_t phase1_mux_sel = 0;    /* sel phase1*/\r
+               uint8_t phase2_mux_sel = 1;    /* sel phase2*/\r
+               uint8_t phase3_mux_sel = 2;    /* sel phase3*/\r
+               uint8_t phase4_mux_sel = 3;    /* sel phase4*/\r
+               uint8_t phase5_mux_sel = 4;    /* sel phase5*/\r
+               uint8_t phase6_mux_sel = 5;    /* sel phase6*/\r
+               uint8_t phase7_mux_sel = 6;    /* sel phase7*/\r
+               uint8_t phase8_mux_sel = 7;    /* sel phase8*/\r
+       \r
+\r
+         uint8_t phase1_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase1_tia_res = 3;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase1_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase1_led_drv1_cha_sel = 0;     /* 1 = ldr1  NG; 2 = ldr2   GR; 4 = ldr3  IR; 8 = ldr4 RED; */\r
+    uint8_t phase1_led_drv2_cha_sel = 0;    /*ldr5:0x20  ldr6: 0x40 red    ldr8 0x80  ir      */\r
+               uint8_t phase1_pd_sel = 0x0c;          /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase1_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase1_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase1_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase1_ldr2_cur = 0;\r
+//             uint8_t phase1_of_idac1_cur = 0;\r
+//    uint8_t phase1_of_idac2_cur = 0;\r
+    uint8_t phase1_ad_inr_ctrl = 3;\r
+    uint8_t phase1_ad_of_idac_ctrl = 0;\r
+//    uint8_t afe_offset  =  0;\r
+    uint8_t phase1_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase1_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase1_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+\r
+\r
+         uint8_t phase2_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase2_tia_res = 3;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase2_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase2_led_drv1_cha_sel = GREEN_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase2_led_drv2_cha_sel = 0;\r
+               uint8_t phase2_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase2_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase2_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase2_ldr1_cur = 15;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase2_ldr2_cur = 0;\r
+//             uint8_t phase2_of_idac1_cur = 0;\r
+//    uint8_t phase2_of_idac2_cur = 0;\r
+    uint8_t phase2_ad_inr_ctrl = 3;\r
+    uint8_t phase2_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase2_afe_offset  =  0;\r
+    uint8_t phase2_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase2_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase2_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+               \r
+    uint8_t phase3_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase3_tia_res = 3;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase3_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase3_led_drv1_cha_sel = RED_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase3_led_drv2_cha_sel = 0;\r
+               uint8_t phase3_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase3_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase3_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase3_ldr1_cur = 15;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase3_ldr2_cur = 0;\r
+//             uint8_t phase3_of_idac1_cur = 0;\r
+//    uint8_t phase3_of_idac2_cur = 0;\r
+    uint8_t phase3_ad_inr_ctrl = 3;\r
+    uint8_t phase3_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase3_afe_offset  =  0;\r
+    uint8_t phase3_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase3_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase3_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+               \r
+    uint8_t phase4_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase4_tia_res = 3;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase4_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase4_led_drv1_cha_sel = IR_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase4_led_drv2_cha_sel = 0;\r
+               uint8_t phase4_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+    uint8_t phase4_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase4_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase4_ldr1_cur = 15;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase4_ldr2_cur = 0;\r
+//             uint8_t phase4_of_idac1_cur = 0;\r
+//    uint8_t phase4_of_idac2_cur = 0;\r
+    uint8_t phase4_ad_inr_ctrl = 3;\r
+    uint8_t phase4_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase4_afe_offset  =  0;\r
+    uint8_t phase4_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase4_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase4_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase5_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase5_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase5_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase5_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase5_led_drv2_cha_sel = 0;\r
+               uint8_t phase5_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase5_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase5_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase5_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase5_ldr2_cur = 0;\r
+//             uint8_t phase5_of_idac1_cur = 0;\r
+//    uint8_t phase5_of_idac2_cur = 0;\r
+    uint8_t phase5_ad_inr_ctrl = 3;\r
+    uint8_t phase5_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase5_afe_offset  =  0;\r
+    uint8_t phase5_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase5_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase5_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase6_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase6_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase6_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase6_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase6_led_drv2_cha_sel = 0;\r
+               uint8_t phase6_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase6_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase6_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase6_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase6_ldr2_cur = 0;\r
+//             uint8_t phase6_of_idac1_cur = 0;\r
+//    uint8_t phase6_of_idac2_cur = 0;\r
+    uint8_t phase6_ad_inr_ctrl = 3;\r
+    uint8_t phase6_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase6_afe_offset  =  0;\r
+    uint8_t phase6_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase6_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase6_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase7_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase7_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase7_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase7_led_drv1_cha_sel = 0;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase7_led_drv2_cha_sel = 0;\r
+               uint8_t phase7_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase7_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase7_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase7_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase7_ldr2_cur = 0;\r
+//             uint8_t phase7_of_idac1_cur = 0;\r
+//    uint8_t phase7_of_idac2_cur = 0;\r
+    uint8_t phase7_ad_inr_ctrl = 3;\r
+    uint8_t phase7_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase7_afe_offset  =  0;\r
+    uint8_t phase7_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase7_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase7_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t phase8_inner_avg = 0;   /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+    uint8_t phase8_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase8_tia_cap = 4;     /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+    uint8_t phase8_led_drv1_cha_sel = 0;   //IR_LED_SLE;     /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+    uint8_t phase8_led_drv2_cha_sel = 0;\r
+               uint8_t phase8_pd_sel = 0x0c;      /* 1 = pd1; 2 = pd2; */\r
+    uint8_t phase8_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+               uint8_t phase8_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+    uint8_t phase8_ldr1_cur = 0;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+               uint8_t phase8_ldr2_cur = 0;\r
+//             uint8_t phase8_of_idac1_cur = 0;\r
+//    uint8_t phase8_of_idac2_cur = 0;\r
+    uint8_t phase8_ad_inr_ctrl = 3;\r
+    uint8_t phase8_ad_of_idac_ctrl = 0;\r
+//    uint8_t phase8_afe_offset  =  0;\r
+    uint8_t phase8_led_en = 1;      /* phase1 led enable*/\r
+               \r
+               uint8_t phase8_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+    uint8_t phase8_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+    uint8_t init_wait_delay = 5 ; /* 0 = 31clk ; 1 = 64clk ; 2 = 127clk ; 3 = 255clk(d) ;\r
+                                     4 = 511clk; 5 = 1023clk; 6 = 2047; 7 = 4095clk */         \r
+                                                                                                                                                \r
+    uint8_t afe_reset = 3;        /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d) ;\r
+                                     4 = 255clk; 5 = 511clk; 6 = 1024; 7 = 2047clk */\r
+                                                                                                                                                \r
+               uint8_t afe_rst_cnvt = 1;               /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d)*/\r
+    \r
+    uint8_t led_en_idac_pre    = 2;    /* 0 = 8clk ; 1 = 16clk ; 2 = 32clk ; 3 = 64clk(d)*/ \r
+               \r
+               uint8_t led_en_idac     =       1;        /* 0 = 4clk ; 1 = 8clk ; 2 = 16clk ; 3 = 32clk(d)*/ \r
+                                                                                                                                                \r
+    uint8_t led_on_time = 2;      /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+                                     4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+                                                                                                                                                \r
+    hx3695_delay_ms(10);               \r
+               \r
+    hx3695_write_reg(0X2a, (uint8_t)prf_clk_num);    // prf bit<7:0>6\r
+    hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+    hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>      \r
+                  \r
+    hx3695_write_reg(0X25, (afe_rst_cnvt<<4| led_en_idac_pre<<2|led_en_idac)); \r
+               hx3695_write_reg(0X2d, phase7_8_internal); \r
+               hx3695_write_reg(0X2e, 0x33);// gpio ctrl \r
+    hx3695_write_reg(0X2f, ((afe_reset<<4)| init_wait_delay));\r
+               hx3695_write_reg(0X30, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+    hx3695_write_reg(0X72, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+\r
+\r
+    hx3695_write_reg(0X31, (led_on_time<<4| 0x00));\r
+               hx3695_write_reg(0X33, 0x83);// Öжϼ«ÐÔ¼°¿í¶ÈÅäÖã»\r
+               hx3695_write_reg(0X34, 0x00);// ÖжÏÌØÊâÅäÖã»\r
+               hx3695_write_reg(0X36, 0x00);// phase data ready ±êÖ¾ÉèÖã»\r
+               hx3695_write_reg(0X38, 0x00);\r
+               \r
+    hx3695_write_reg(0X3a, (phase1_inner_avg | (phase2_inner_avg<<4)));  \r
+    hx3695_write_reg(0X3b, (phase3_inner_avg | (phase4_inner_avg<<4)));  \r
+    hx3695_write_reg(0X3c, (phase5_inner_avg | (phase6_inner_avg<<4)));        \r
+    hx3695_write_reg(0X3d, (phase7_inner_avg | (phase8_inner_avg<<4)));        \r
+    hx3695_write_reg(0X3e, adc_rst_post_num<<6 | samp_delay_leden_num<<4 | samp_copy_avg); \r
+    hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+    hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+               \r
+               hx3695_write_reg(0X43, phase1_mux_sel);  \r
+               hx3695_write_reg(0X44, phase1_tia_cap<<4|phase1_tia_res); \r
+               hx3695_write_reg(0X45, phase1_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase1_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase1_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase1_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+\r
+    hx3695_write_reg(0X49, phase1_ad_inr_ctrl<<4|phase1_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase1_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase1_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase1_dsp_mov_avg_num | phase1_dsp_iir_lp_coeff<<4);\r
+\r
+//    hx3695_write_reg(0X4e, thred_value);\r
+//    hx3695_write_reg(0X4f, thred_value>>5);\r
+               \r
+    hx3695_write_reg(0X43, phase2_mux_sel);  \r
+               hx3695_write_reg(0X44, phase2_tia_cap<<4|phase2_tia_res); \r
+               hx3695_write_reg(0X45, phase2_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase2_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase2_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase2_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase2_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase2_ad_inr_ctrl<<4|phase2_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase2_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase2_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase2_dsp_mov_avg_num | phase2_dsp_iir_lp_coeff<<4);\r
+               \r
+//phase3 sel\r
+\r
+    hx3695_write_reg(0X43, phase3_mux_sel);  \r
+               hx3695_write_reg(0X44, phase3_tia_cap<<4|phase3_tia_res); \r
+               hx3695_write_reg(0X45, phase3_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase3_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase3_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase3_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase3_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase3_ad_inr_ctrl<<4|phase3_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase3_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase3_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase3_dsp_mov_avg_num | phase3_dsp_iir_lp_coeff<<4);\r
+               \r
+//phase4 sel\r
+\r
+    hx3695_write_reg(0X43, phase4_mux_sel);  \r
+               hx3695_write_reg(0X44, phase4_tia_cap<<4|phase4_tia_res); \r
+               hx3695_write_reg(0X45, phase4_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase4_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase4_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase4_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase4_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase4_ad_inr_ctrl<<4|phase4_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase4_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase4_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase4_dsp_mov_avg_num | phase4_dsp_iir_lp_coeff<<4);\r
+\r
+               hx3695_write_reg(0X43, phase5_mux_sel);  \r
+               hx3695_write_reg(0X44, phase5_tia_cap<<4|phase5_tia_res); \r
+               hx3695_write_reg(0X45, phase5_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase5_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase5_pd_sel));    //<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase5_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase5_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase5_ad_inr_ctrl<<4|phase5_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase5_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase5_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase5_dsp_mov_avg_num | phase5_dsp_iir_lp_coeff<<4);\r
+               \r
+               \r
+         hx3695_write_reg(0X43, phase6_mux_sel);  \r
+               hx3695_write_reg(0X44, phase6_tia_cap<<4|phase6_tia_res); \r
+               hx3695_write_reg(0X45, phase6_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase6_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase6_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase6_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase6_ad_inr_ctrl<<4|phase6_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase6_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase6_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase6_dsp_mov_avg_num | phase6_dsp_iir_lp_coeff<<4);\r
+               \r
+       \r
+         hx3695_write_reg(0X43, phase7_mux_sel);  \r
+               hx3695_write_reg(0X44, phase7_tia_cap<<4|phase7_tia_res); \r
+               hx3695_write_reg(0X45, phase7_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase7_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase7_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase7_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase7_ad_inr_ctrl<<4|phase7_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase7_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase7_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase7_dsp_mov_avg_num | phase7_dsp_iir_lp_coeff<<4);\r
+               \r
+       \r
+         hx3695_write_reg(0X43, phase8_mux_sel);  \r
+               hx3695_write_reg(0X44, phase8_tia_cap<<4|phase8_tia_res); \r
+               hx3695_write_reg(0X45, phase8_ldr1_cur);    //LED_DRV1_CUR\r
+               hx3695_write_reg(0x70, phase8_ldr2_cur);   //ps8--ps1  led_drv2_cur\r
+               hx3695_write_reg(0X46, (phase8_pd_sel<<4 | 0x00));\r
+               hx3695_write_reg(0X47, phase8_als_offset_idac);\r
+               hx3695_write_reg(0X48, phase8_led_offset_idac);\r
+//             hx3695_write_reg(0X48, phas8_led_offset_idac);\r
+    hx3695_write_reg(0X49,  phase8_ad_inr_ctrl<<4|phase8_ad_of_idac_ctrl); \r
+               hx3695_write_reg(0X4a, phase8_led_drv1_cha_sel);\r
+               hx3695_write_reg(0X4b, phase8_led_drv2_cha_sel);\r
+               hx3695_write_reg(0X71, phase8_dsp_mov_avg_num | phase8_dsp_iir_lp_coeff<<4);\r
+               \r
+\r
+// analog circuit cfg \r
+    hx3695_write_reg(0X60, 0x14);      //\r
+               hx3695_write_reg(0X61, 0xf0);   \r
+               hx3695_write_reg(0X62, 0x22); \r
+               hx3695_write_reg(0X63, 0x15); \r
+                                                                                                                                                                                                                               \r
+               hx3695_write_reg(0X64, 0x08);   \r
+               hx3695_write_reg(0X65, 0x88); //bug\r
+               \r
+               hx3695_write_reg(0X66, 0x30);   // bits<3>=adc selftest en     0x30\r
+               hx3695_write_reg(0X67, 0x23);   \r
+               hx3695_write_reg(0X68, 0x46);   \r
+               hx3695_write_reg(0X69, 0x42);   \r
+               \r
+               hx3695_write_reg(0X39, 0xff);   // ofset idac1 phase enable cfg\r
+               hx3695_write_reg(0x73, 0xff);    //led_offset_idac phase enable\r
+               \r
+    hx3695_write_reg(0X6a, 0X0f);      \r
+               hx3695_write_reg(0X6b, 0X22);   \r
+               hx3695_write_reg(0X6c, 0X00);   \r
+               hx3695_write_reg(0X6d, 0X37);   \r
+               hx3695_write_reg(0X6e, 0X82);   \r
+               hx3695_write_reg(0X6f, 0X08);\r
+/////////FIFO and adc conversion ready config////////\r
+/////////FIFO and adc conversion ready config////////\r
+#if defined(PPG_INT_MODE)\r
+               hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble\r
+                hx3695_write_reg(0X33, 0x83);   // int width                                                                                                                                           \r
+     hx3695_write_reg(0X21, 0x00);   // fifo int sel,00=FIFO INT config clear\r
+                hx3695_write_reg(0X38, 0x01);   // int sel,00=close almost full int,04=enable almost full int\r
+#elif defined(INT_MODE)               //FIFO_ALL_MOST_FULL)\r
+                hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble\r
+                hx3695_write_reg(0X1c, (fifo_watermark&0xff));   //fifo_watermark\r
+                hx3695_write_reg(0X1d, fifo_watermark<<8);       //bit<0>=fifo_watermark[8]  \r
+                hx3695_write_reg(0X33, 0x83);   // int width   \r
+                hx3695_write_reg(0X21, 0x00);   // fifo int sel,00=FIFO INT config clear\r
+     hx3695_write_reg(0X38, 0x04);   // int sel,00=close almost full int,04=enable almost full int\r
+\r
+#else\r
+                hx3695_write_reg(0X1b, 0x92);    // bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble                                                                             \r
+     hx3695_write_reg(0X38, 0x01);   // int sel,00=close almost full int,04=enable almost full int\r
+     \r
+#endif\r
+\r
+               \r
+    hx3695_write_reg(0X26,(phase1_enable<<3)|(phase1_adc_osr)|(phase2_enable<<7)|(phase2_adc_osr<<4) ); \r
+    hx3695_write_reg(0X27,(phase3_enable<<3)|(phase3_adc_osr)|(phase4_enable<<7)|(phase4_adc_osr<<4) );  \r
+    hx3695_write_reg(0X28,(phase5_enable<<3)|(phase5_adc_osr)|(phase6_enable<<7)|(phase6_adc_osr<<4) );\r
+    hx3695_write_reg(0X29,(phase7_enable<<3)|(phase7_adc_osr)|(phase8_enable<<7)|(phase8_adc_osr<<4) );                \r
+\r
+//    hx3695_write_reg(0X5c, 0x02);//soft reset\r
+    hx3695_delay_ms(5);  \r
+    hx3695_write_reg(0X5c, 0x00);//release\r
+\r
+       \r
+}\r
+\r
+bool hx3695_factory_test_read(int32_t *phase_data)\r
+{\r
+    uint8_t  databuf[12] = {0};\r
+    int32_t P1 = 0, P2 = 0,P3 = 0,P4 = 0;\r
+    hx3695_brust_read_reg(0x03, databuf, 12);\r
+    P1 = ((databuf[0])|(databuf[1]<<8)|(databuf[2]<<16));\r
+    P2 = ((databuf[3])|(databuf[4]<<8)|(databuf[5]<<16));\r
+    P3 = ((databuf[6])|(databuf[7]<<8)|(databuf[8]<<16));\r
+    P4 = ((databuf[9])|(databuf[10]<<8)|(databuf[11]<<16));\r
+\r
+    phase_data[0] = P1 ;\r
+    phase_data[1] = P2 ;\r
+    phase_data[2] = P3 ;\r
+    phase_data[3] = P4 ;\r
+\r
+    DEBUG_PRINTF("p1,p2,p3,p4 %d %d %d %d\r\n", P1, P2, P3, P4);\r
+    return true;\r
+}\r
+\r
+int32_t hx3695_sort_cal(int32_t *data)\r
+{\r
+    uint8_t ii,jj;\r
+    int32_t data_temp = 0;\r
+    int32_t data_final = 0;\r
+    for(ii=0; ii<3; ii++)\r
+    {\r
+        for(jj=0; jj<3-ii; jj++)\r
+        {\r
+            if(data[jj]>=data[jj+1])\r
+            {\r
+                data_temp = data[jj];\r
+                data[jj] = data[jj+1];\r
+                data[jj+1] = data_temp;\r
+            }\r
+        }\r
+    }\r
+    data_final = (data[1]+data[2])>>1;\r
+    return data_final;\r
+}\r
+\r
+\r
+bool hx3695_chip_check_id(void)\r
+{\r
+    uint8_t i = 0;\r
+    uint8_t chip_id =0;\r
+    for(i=0; i<10; i++)\r
+    {\r
+        chip_id = hx3695_read_reg(0x00);\r
+        TYHX_LOG("chip id = 0x%x\r\n",chip_id);\r
+        if (chip_id == 0x65)\r
+        {\r
+            return true;\r
+        }\r
+    }\r
+    return false;\r
+}\r
+\r
+FT_RESULTS_t hx3695_factory_led_off_get_result(void)\r
+{\r
+    uint8_t ii = 0;\r
+    int32_t phase_data[4] = {0,0,0,0};\r
+    int32_t phase1_data[4] = {0,0,0,0};\r
+    int32_t phase2_data[4] = {0,0,0,0};\r
+    int32_t phase3_data[4] = {0,0,0,0};\r
+    int32_t phase4_data[4] = {0,0,0,0};\r
+    int32_t gr_buffer[4] = {0,0,0,0};\r
+    int32_t red_buffer[4] = {0,0,0,0};\r
+    int32_t ir_buffer[4] = {0,0,0,0};\r
+    FT_RESULTS_t ft_result = {0,0,0,0,0,0,0,0,0,0,0,0};\r
+\r
+    for(ii=0; ii<4; ii++)\r
+    {\r
+        hx3695_delay_ms(40);\r
+        hx3695_factory_test_read(phase_data);\r
+        gr_buffer[ii] = phase_data[1] - phase_data[0];\r
+        red_buffer[ii] = phase_data[2] - phase_data[0];\r
+        ir_buffer[ii] = phase_data[3] - phase_data[0];\r
+        phase1_data[ii] = phase_data[0];\r
+        phase2_data[ii] = phase_data[1];\r
+        phase3_data[ii] = phase_data[2];\r
+        phase4_data[ii] = phase_data[3];\r
+    }\r
+    ft_result.phase1_data_avg = hx3695_sort_cal(phase1_data);\r
+    ft_result.phase2_data_avg = hx3695_sort_cal(phase2_data);\r
+    ft_result.phase3_data_avg = hx3695_sort_cal(phase3_data);\r
+    ft_result.phase4_data_avg = hx3695_sort_cal(phase4_data);\r
+    ft_result.gr_ps_dif = hx3695_sort_cal(gr_buffer);\r
+    ft_result.red_ps_dif = hx3695_sort_cal(red_buffer);\r
+    ft_result.ir_ps_dif = hx3695_sort_cal(ir_buffer);\r
+\r
+    return ft_result;\r
+}\r
+\r
+FT_RESULTS_t hx3695_factory_wear_mode_get_result(void)\r
+{\r
+    uint8_t ii = 0;\r
+    int32_t phase_data[4] = {0,0,0,0};\r
+    int32_t data_buffer[4] = {0,0,0,0};\r
+    FT_RESULTS_t ft_result = {0,0,0,0,0,0,0,0,0,0,0,0};\r
+\r
+    for(ii=0; ii<4; ii++)\r
+    {\r
+        hx3695_delay_ms(110);\r
+        hx3695_factory_test_read(phase_data);\r
+        data_buffer[ii] = phase_data[0] - phase_data[1];\r
+    }\r
+    ft_result.gr_data_final = hx3695_sort_cal(data_buffer);\r
+    if(data_buffer[0]==data_buffer[1] && data_buffer[0]==data_buffer[2] && data_buffer[0]==data_buffer[3])\r
+    {\r
+        ft_result.gr_data_final = 0;\r
+    }\r
+\r
+    return ft_result;\r
+}\r
+\r
+FT_RESULTS_t hx3695_factory_ft_leak_light_test_get_result(void)\r
+{\r
+    uint8_t ii = 0;\r
+    int32_t phase_data[4] = {0,0,0,0};\r
+    int32_t gr_buffer[4] = {0,0,0,0};\r
+    int32_t red_buffer[4] = {0,0,0,0};\r
+    int32_t ir_buffer[4] = {0,0,0,0};\r
+    int32_t gr_data_ledoff = 0;\r
+    int32_t red_data_ledoff = 0;\r
+    int32_t ir_data_ledoff = 0;\r
+    int32_t gr_data_ledon = 0;\r
+    int32_t red_data_ledon = 0;\r
+    int32_t ir_data_ledon = 0;\r
+    FT_RESULTS_t ft_result = {0,0,0,0,0,0,0,0,0,0,0,0};\r
+\r
+    for(ii=0; ii<4; ii++)\r
+    {\r
+        hx3695_delay_ms(40);\r
+        hx3695_factory_test_read(phase_data);\r
+        gr_buffer[ii]  = phase_data[1] - phase_data[0];\r
+        red_buffer[ii] = phase_data[2] - phase_data[0];\r
+        ir_buffer[ii]  = phase_data[3] - phase_data[0];\r
+    }\r
+    gr_data_ledon = hx3695_sort_cal(gr_buffer);\r
+    red_data_ledon = hx3695_sort_cal(red_buffer);\r
+    ir_data_ledon = hx3695_sort_cal(ir_buffer);\r
+\r
+    hx3695_write_reg(0x30, 0x00);\r
+               hx3695_write_reg(0x72, 0x00);\r
+    hx3695_delay_ms(100);\r
+\r
+    for(ii=0; ii<4; ii++)\r
+    {\r
+        hx3695_delay_ms(40);\r
+        hx3695_factory_test_read(phase_data);\r
+        gr_buffer[ii] = phase_data[1] - phase_data[0];\r
+        red_buffer[ii] = phase_data[2] - phase_data[0];\r
+        ir_buffer[ii] = phase_data[3] - phase_data[0];\r
+    }\r
+    gr_data_ledoff = hx3695_sort_cal(gr_buffer);\r
+    red_data_ledoff = hx3695_sort_cal(red_buffer);\r
+    ir_data_ledoff = hx3695_sort_cal(ir_buffer);\r
+\r
+    ft_result.gr_ps_dif = gr_data_ledoff;\r
+    ft_result.red_ps_dif = red_data_ledoff;\r
+    ft_result.ir_ps_dif = ir_data_ledoff;\r
+    ft_result.gr_data_final = gr_data_ledon - gr_data_ledoff;\r
+    ft_result.red_data_final = red_data_ledon - red_data_ledoff;\r
+    ft_result.ir_data_final = ir_data_ledon - ir_data_ledoff;\r
+    if(ft_result.gr_data_final<0)\r
+    {\r
+        ft_result.gr_data_final = 0;\r
+    }\r
+    if(ft_result.red_data_final<0)\r
+    {\r
+        ft_result.red_data_final = 0;\r
+    }\r
+    if(ft_result.ir_data_final<0)\r
+    {\r
+        ft_result.ir_data_final = 0;\r
+    }\r
+    //TYHX_LOG("leaking result=%d\r\n",ft_result.gr_data_final );\r
+    //hrsresult.leak_green =ft_result.gr_data_final;\r
+\r
+\r
+\r
+    return ft_result;\r
+}\r
+\r
+FT_RESULTS_t hx3695_factory_ft_card_test_get_result(void)\r
+{\r
+    uint8_t ii = 0;\r
+    int32_t phase_data[4] = {0,0,0,0};\r
+    int32_t gr_buffer[4] = {0,0,0,0};\r
+    int32_t red_buffer[4] = {0,0,0,0};\r
+    int32_t ir_buffer[4] = {0,0,0,0};\r
+    FT_RESULTS_t ft_result = {0,0,0,0,0,0,0,0,0,0,0,0};\r
+\r
+    for(ii=0; ii<4; ii++)\r
+    {\r
+        hx3695_delay_ms(40);\r
+        hx3695_factory_test_read(phase_data);\r
+        gr_buffer[ii] =  phase_data[1] - phase_data[0];\r
+        red_buffer[ii] = phase_data[2] - phase_data[0];\r
+        ir_buffer[ii] =  phase_data[3] - phase_data[0];\r
+    }\r
+    ft_result.gr_data_final = hx3695_sort_cal(gr_buffer);\r
+    ft_result.red_data_final = hx3695_sort_cal(red_buffer);\r
+    ft_result.ir_data_final = hx3695_sort_cal(ir_buffer);\r
+    DEBUG_PRINTF("ft card,g%d,r%d,ir%d\r\n",ft_result.gr_data_final,ft_result.red_data_final,ft_result.ir_data_final );\r
+\r
+    if(gr_buffer[0] == gr_buffer[1] && gr_buffer[0] == gr_buffer[2] && gr_buffer[0] == gr_buffer[3])\r
+    {\r
+        ft_result.gr_data_final = 0;\r
+        ft_result.red_data_final = 0;\r
+        ft_result.ir_data_final = 0;\r
+    }\r
+    if(ft_result.gr_data_final < 0)\r
+    {\r
+        ft_result.gr_data_final = 0;\r
+    }\r
+    if(ft_result.red_data_final < 0)\r
+    {\r
+        ft_result.red_data_final = 0;\r
+    }\r
+    if(ft_result.ir_data_final < 0)\r
+    {\r
+        ft_result.ir_data_final = 0;\r
+    }\r
+\r
+    return ft_result;\r
+}\r
+\r
+FT_RESULTS_t hx3695_factory_ft_single_check_get_result(void)\r
+{\r
+    uint8_t ii = 0;\r
+    int32_t phase_data[4] = {0,0,0,0};\r
+    int32_t gr_buffer[4] = {0,0,0,0};\r
+    int32_t red_buffer[4] = {0,0,0,0};\r
+    int32_t ir_buffer[4] = {0,0,0,0};\r
+    FT_RESULTS_t ft_result = {0,0,0,0,0,0,0,0,0,0,0,0};\r
+\r
+    for(ii=0; ii<4; ii++)\r
+    {\r
+        hx3695_delay_ms(12);\r
+        hx3695_factory_test_read(phase_data);\r
+        gr_buffer[ii] = phase_data[1] - phase_data[0];\r
+        red_buffer[ii] = phase_data[2] - phase_data[0];\r
+        ir_buffer[ii] = phase_data[3] - phase_data[0];\r
+    }\r
+    ft_result.gr_data_final = hx3695_sort_cal(gr_buffer);\r
+    ft_result.red_data_final = hx3695_sort_cal(red_buffer);\r
+    ft_result.ir_data_final = hx3695_sort_cal(ir_buffer);\r
+\r
+    hx3695_write_reg(0x33, 0xff);\r
+    hx3695_delay_ms(10);\r
+\r
+    for(ii=0; ii<4; ii++)\r
+    {\r
+        hx3695_delay_ms(12);\r
+        hx3695_factory_test_read(phase_data);\r
+        gr_buffer[ii] = phase_data[1] - phase_data[0];\r
+        red_buffer[ii] = phase_data[2] - phase_data[0];\r
+        ir_buffer[ii] = phase_data[3] - phase_data[0];\r
+    }\r
+    ft_result.gr_data_high = hx3695_sort_cal(gr_buffer);\r
+\r
+    if(gr_buffer[0] == gr_buffer[1] && gr_buffer[0] == gr_buffer[2] && gr_buffer[0] == gr_buffer[3])\r
+    {\r
+        ft_result.gr_data_final = 0;\r
+        ft_result.red_data_final = 0;\r
+        ft_result.ir_data_final = 0;\r
+    }\r
+    if(ft_result.gr_data_final < 0)\r
+    {\r
+        ft_result.gr_data_final = 0;\r
+    }\r
+    if(ft_result.red_data_final < 0)\r
+    {\r
+        ft_result.red_data_final = 0;\r
+    }\r
+    if(ft_result.ir_data_final < 0)\r
+    {\r
+        ft_result.ir_data_final = 0;\r
+    }\r
+    if(ft_result.gr_data_final > 0)\r
+    {\r
+        ft_result.single_gr_led_judge = ft_result.gr_data_high*100/ft_result.gr_data_final;\r
+    }\r
+\r
+    return ft_result;\r
+}\r
+\r
+FT_RESULTS_t hx3695_factroy_test(TEST_MODE_t  test_mode)\r
+{\r
+    FT_RESULTS_t ft_result = {0,0,0,0,0,0,0,0,0,0,0,0};\r
+\r
+    //if (hx3695_chip_check_id() == false)\r
+    {\r
+        //   return ft_result;\r
+    }\r
+    switch(test_mode)\r
+    {\r
+    case LED_OFF_TEST:\r
+        hx3695_factory_led_off_config();\r
+        hx3695_delay_ms(50);\r
+        ft_result = hx3695_factory_led_off_get_result();\r
+        break;\r
+    case WEAR_MODE_TEST:\r
+        hx3695_factory_wear_mode_config();\r
+        hx3695_delay_ms(50);\r
+        ft_result = hx3695_factory_wear_mode_get_result();\r
+        break;\r
+    case LEAK_LIGHT_TEST:\r
+        hx3695_factory_ft_leak_light_test_config();\r
+        hx3695_delay_ms(50);\r
+        ft_result = hx3695_factory_ft_leak_light_test_get_result();\r
+        hrsresult.leak_green = ft_result.gr_data_final;\r
+        hrsresult.leak_red = ft_result.red_data_final;\r
+        hrsresult.leak_ir = ft_result.ir_data_final;\r
+        TYHX_LOG("leak g=%d\r\n",hrsresult.leak_green);\r
+        break;\r
+    case GRAY_CARD_TEST:\r
+        hx3695_factory_ft_card_test_config();\r
+        hx3695_delay_ms(50);\r
+        ft_result = hx3695_factory_ft_card_test_get_result();\r
+        hrsresult.card_green = ft_result.gr_data_final;\r
+        hrsresult.card_red = ft_result.red_data_final;\r
+        hrsresult.card_ir = ft_result.ir_data_final;\r
+        break;\r
+    case FT_INT_TEST:\r
+        hx3695_factory_ft_int_test_config();\r
+        break;\r
+    case SINGLE_CHECK_TEST:\r
+        hx3695_factory_ft_single_check_config();\r
+        hx3695_delay_ms(50);\r
+        ft_result = hx3695_factory_ft_single_check_get_result();\r
+        break;\r
+    default:\r
+        break;\r
+    }\r
+\r
+    //hx3695_ppg_off();\r
+    DEBUG_PRINTF("%d %d %d %d %d %d %d %d %d %d %d %d\r\n", ft_result.phase1_data_avg, ft_result.phase2_data_avg, ft_result.phase3_data_avg, ft_result.phase4_data_avg, \\r
+                 ft_result.gr_ps_dif, ft_result.red_ps_dif, ft_result.ir_ps_dif, ft_result.gr_data_final, ft_result.red_data_final, ft_result.ir_data_final, ft_result.gr_data_high, \\r
+                 ft_result.single_gr_led_judge);\r
+\r
+    return ft_result;\r
+}\r
diff --git a/code/sdk/drivers/peripheral/ppg/hx3695/hx3695_factory_test.h b/code/sdk/drivers/peripheral/ppg/hx3695/hx3695_factory_test.h
new file mode 100644 (file)
index 0000000..7abd190
--- /dev/null
@@ -0,0 +1,46 @@
+#ifndef _HX3695_FACTORY_TEST_H_\r
+#define _HX3695_FACTORY_TEST_H_\r
+\r
+#include <stdint.h>\r
+#include <stdbool.h>\r
+\r
+typedef enum {\r
+       LEAK_LIGHT_TEST = 1,\r
+       GRAY_CARD_TEST = 2,\r
+       FT_INT_TEST = 3,\r
+       SINGLE_CHECK_TEST = 4,\r
+    LED_OFF_TEST = 5,\r
+    WEAR_MODE_TEST = 6\r
+} TEST_MODE_t;\r
+\r
+typedef struct { \r
+    int32_t phase1_data_avg;\r
+    int32_t phase2_data_avg;\r
+    int32_t phase3_data_avg;\r
+    int32_t phase4_data_avg;\r
+    int32_t gr_ps_dif;\r
+    int32_t red_ps_dif;\r
+    int32_t ir_ps_dif;\r
+    int32_t gr_data_final;\r
+    int32_t red_data_final;\r
+    int32_t ir_data_final;\r
+    int32_t gr_data_high;\r
+    int32_t single_gr_led_judge;\r
+} FT_RESULTS_t;\r
+\r
+void hx3695_factory_ft_leak_light_test_config(void);\r
+void hx3695_factory_ft_card_test_config(void);\r
+void hx3695_factory_ft_int_test_config(void);\r
+\r
+bool hx3695_factory_test_read(int32_t *phase_data);\r
+FT_RESULTS_t hx3695_factroy_test(TEST_MODE_t  test_mode);\r
+\r
+void hx3695_lab_test(uint32_t  test_mode);\r
+void hx3695_lab_test_read(void);\r
+\r
+\r
+#endif // _HX3695_FACTORY_TEST_H_\r
+\r
+\r
+\r
+\r
diff --git a/code/sdk/drivers/peripheral/ppg/hx3695/hx3695_hrs_agc.c b/code/sdk/drivers/peripheral/ppg/hx3695/hx3695_hrs_agc.c
new file mode 100644 (file)
index 0000000..cc4b817
--- /dev/null
@@ -0,0 +1,971 @@
+\r
+#include <stdio.h>\r
+#include <stdbool.h>\r
+#include <stdint.h>\r
+#include <stdlib.h>\r
+#include <math.h>\r
+\r
+#include "tyhx_hrs_custom.h"\r
+\r
+#include "hx3695.h"\r
+#include "hx3695_hrs_agc.h"\r
+#include "tyhx_hrs_alg.h"\r
+\r
+\r
+#ifdef HRS_ALG_LIB\r
+extern const uint8_t  hx3695_hrs_agc_idac;\r
+extern uint8_t  hx3695_hrs_g1_agc_idac;\r
+extern uint8_t  hx3695_hrs_g2_agc_idac;\r
+extern uint8_t  hx3695_hrs_g3_agc_idac;\r
+\r
+extern const uint8_t  green_led_max_init;\r
+extern uint8_t low_vbat_flag;\r
+extern uint8_t hrs_phase_num;\r
+extern uint8_t read_fifo_first_flg;\r
+\r
+\r
+//HRS_INFRARED_THRES\r
+extern const int32_t  hrs_ir_unwear_thres;\r
+extern const int32_t  hrs_ir_wear_thres;\r
+\r
+static uint8_t s_ppg_state = 0;\r
+static uint8_t hrs_cal_state = 0;\r
+\r
+static int32_t s_buf[64] = {0}; \r
+static int32_t agc_buf[8] = {0};\r
+static uint8_t fifo_data_temp[3] = {0};\r
+\r
+static uint8_t cal_delay = CAL_DELAY_COUNT;\r
+static HRS_CAL_SET_T  calReg_Hrs;;\r
+//\r
+static hrs_wear_msg_code_t hrs_wear_status = MSG_HRS_NO_WEAR;\r
+static hrs_wear_msg_code_t hrs_wear_status_pre = MSG_HRS_NO_WEAR;\r
+\r
+static uint8_t no_touch_cnt = 0;\r
+\r
+void Init_hrs_PPG_Calibration_Routine(HRS_CAL_SET_T *calR)\r
+{\r
+    calR->flag = CAL_FLG_LED_DR|CAL_FLG_LED_DAC|CAL_FLG_AMB_DAC|CAL_FLG_RF;\r
+    calR->Group1_Ledidac = 0;  /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+         calR->Group2_Ledidac = 0;\r
+//       calR->Group3_Ledidac = 0;\r
+\r
+         calR->Group1_AMBDAC = 0;   /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+    calR->Group2_AMBDAC = 0;\r
+//    calR->Group3_AMBDAC = 0;  \r
+\r
+       \r
+         calR->Group1_RF = 0;  /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+         calR->Group2_RF = 0;\r
+//       calR->Group3_RF = 0;\r
+\r
+         calR->Group1_Cur = HRS_CAL_INIT_LED;\r
+         calR->Group2_Cur = HRS_CAL_INIT_LED;\r
+//       calR->Group3_Cur = HRS_CAL_INIT_LED;\r
+       \r
+       \r
+    calR->state = hrsCalStart;\r
+    calR->int_cnt = 0;\r
+    calR->cur255_cnt =0;\r
+    if(low_vbat_flag==1)\r
+    {\r
+//        calR->led_max_cur = 128;\r
+                         calR->Group1_max_cur = 128;\r
+                         calR->Group2_max_cur = 128;\r
+//                       calR->Group3_max_cur = 128;\r
+    }\r
+    else\r
+    {\r
+      calR->Group1_max_cur =  green_led_max_init; \r
+                       calR->Group2_max_cur =  green_led_max_init; \r
+//                     calR->Group3_max_cur =  green_led_max_init; \r
+                       \r
+    }\r
+}\r
+\r
+void Restart_hrs_PPG_Calibration_Routine(HRS_CAL_SET_T *calR)\r
+{\r
+    calR->flag = CAL_FLG_LED_DAC;\r
+    calR->state = hrsCalLed;\r
+    calR->int_cnt = 0;\r
+}\r
+\r
+hrs_wear_msg_code_t hx3695_hrs_wear_mode_check(WORK_MODE_T mode, int32_t infrared_data)\r
+{\r
+     if(infrared_data > hrs_ir_wear_thres)\r
+    {\r
+        if(no_touch_cnt < NO_TOUCH_CHECK_NUM)\r
+        {\r
+            no_touch_cnt++; \r
+        }  \r
+        if(no_touch_cnt >= NO_TOUCH_CHECK_NUM)  \r
+        {\r
+            hrs_wear_status = MSG_HRS_WEAR;\r
+        }   \r
+    }\r
+    else if(infrared_data < hrs_ir_unwear_thres)\r
+    {\r
+        if(no_touch_cnt>0)\r
+        {\r
+            no_touch_cnt--;\r
+        }\r
+        if(no_touch_cnt == 0)\r
+        {\r
+            hrs_wear_status = MSG_HRS_NO_WEAR;                \r
+        }      \r
+    }   \r
+//   SEGGER_RTT_printf(0,"hrs ir_data: %d, hrs_wear_status_pre=%d, hrs_wear_status=%d\r\n",\\r
+                          infrared_data,hrs_wear_status_pre,hrs_wear_status);\r
+    if(mode == WEAR_MODE)\r
+    {\r
+        return hrs_wear_status;\r
+    }\r
+    if(hrs_wear_status_pre != hrs_wear_status)\r
+    {\r
+        hrs_wear_status_pre = hrs_wear_status;\r
+        if(hrs_wear_status_pre == MSG_HRS_NO_WEAR)\r
+        {\r
+                                         SEGGER_RTT_printf(0,"run here_low_pow!! \r\n");\r
+            hx3695_hrs_low_power();\r
+                                       \r
+                                               \r
+        }\r
+        else if(hrs_wear_status_pre == MSG_HRS_WEAR)\r
+        {\r
+            tyhx_hrs_alg_open_deep();\r
+            hx3695_hrs_set_mode(PPG_INIT);\r
+            hx3695_hrs_set_mode(CAL_INIT);\r
+        }  \r
+    }    \r
+    return hrs_wear_status;\r
+}\r
+\r
+\r
+\r
+\r
+//void PPG_hrs_Calibration_Routine(HRS_CAL_SET_T *calR, int32_t g1_led,int32_t g2_led,int32_t g3_led, int32_t g1_amb, int32_t g2_amb,int32_t g3_amb)\r
+void PPG_hrs_Calibration_Routine(HRS_CAL_SET_T *calR, int32_t g1_led,int32_t g2_led, int32_t g1_amb, int32_t g2_amb)\r
+\r
+{\r
+        switch(calR->state)\r
+      {\r
+                               case hrsCalStart:\r
+                                         calR->state = hrsCalStart1;\r
+            break;\r
+                               \r
+        case hrsCalStart1:\r
+                                               if(g1_amb>525000)\r
+                                               {\r
+                                                       calR->Group1_AMBDAC = (g1_amb-525000)/1300;\r
+                                               }\r
+                                               else\r
+                                               {\r
+                                                       calR->Group1_AMBDAC = 0;\r
+                                               }\r
+                                               \r
+                                               if(g2_amb > 525000)\r
+                                               {\r
+                                                       calR->Group2_AMBDAC = (g2_amb - 525000)/1300;\r
+                                               }\r
+                                               else\r
+                                               {\r
+                                                       calR->Group2_AMBDAC = 0;\r
+                                               }\r
+//                                      if(g3_amb>525000)\r
+//                                             {\r
+//                                                     calR->Group3_AMBDAC = (g3_amb-525000)/1300;\r
+//                                             }\r
+//                                             else\r
+//                                             {\r
+//                                                     calR->Group3_AMBDAC = 0;\r
+//                                             }\r
+                                                                                               \r
+            if(g1_led > g1_amb+256)\r
+            {             \r
+              calR->Group1_step = (g1_led - g1_amb)/(HRS_CAL_INIT_LED);\r
+              calR->Group1_Cur = 1300*(hx3695_hrs_g1_agc_idac + calR->Group1_AMBDAC)/(calR->Group1_step);\r
+                                                       AGC_LOG("AGC1: calR->Group1_Cur = %d,\r\n",calR->Group1_Cur);\r
+\r
+              if(calR->Group1_Cur > calR->Group1_max_cur)\r
+              {\r
+                calR->Group1_Cur = calR->Group1_max_cur;\r
+              }\r
+              if(calR->Group1_Cur != calR->Group1_max_cur)\r
+              {\r
+                calR->Group1_Ledidac = (hx3695_hrs_g1_agc_idac*3)>>2;\r
+              }\r
+              else\r
+              {\r
+                calR->Group1_Ledidac = hx3695_hrs_g1_agc_idac>>1;\r
+              }\r
+           }\r
+                                                       \r
+           if(g2_led > g2_amb+256)\r
+            {             \r
+              calR->Group2_step = (g2_led - g2_amb)/(HRS_CAL_INIT_LED);\r
+              calR->Group2_Cur = 1300*(hx3695_hrs_g2_agc_idac + calR->Group2_AMBDAC)/(calR->Group2_step);\r
+                                                       AGC_LOG("AGC2: calR->Group2_Cur = %d,\r\n",calR->Group2_Cur);\r
+\r
+              if(calR->Group2_Cur > calR->Group2_max_cur)\r
+              {\r
+                calR->Group2_Cur = calR->Group2_max_cur;\r
+              }\r
+              if(calR->Group2_Cur != calR->Group2_max_cur)\r
+              {\r
+                calR->Group2_Ledidac = (hx3695_hrs_g2_agc_idac*3)>>2;\r
+              }\r
+              else\r
+              {\r
+                calR->Group2_Ledidac = hx3695_hrs_g2_agc_idac>>1;\r
+              }\r
+                                         }\r
+                                               \r
+\r
+//            if(g3_led > g3_amb+256)\r
+//            {             \r
+//              calR->Group3_step = (g3_led - g3_amb)/(HRS_CAL_INIT_LED);\r
+//              calR->Group3_Cur = 1300*(hx3695_hrs_g3_agc_idac + calR->Group3_AMBDAC)/(calR->Group3_step);\r
+//                                                     AGC_LOG("AGC3: calR->Group3_Cur = %d,\r\n",calR->Group3_Cur);\r
+\r
+//              if(calR->Group3_Cur > calR->Group3_max_cur)\r
+//              {\r
+//                calR->Group3_Cur = calR->Group3_max_cur;\r
+//              }\r
+//              if(calR->Group3_Cur != calR->Group3_max_cur)\r
+//              {\r
+//                calR->Group3_Ledidac = (hx3695_hrs_g3_agc_idac*3)>>2;\r
+//              }\r
+//              else\r
+//              {\r
+//                calR->Group3_Ledidac = hx3695_hrs_g3_agc_idac>>1;\r
+//              }\r
+//                                             }       \r
+                                                                                       \r
+                                                       calR->Group1_RF = 5;\r
+                                                       calR->Group2_RF = 5;\r
+//              calR->Group3_RF = 6;\r
+                                                                                                                                                                       \r
+              calR->flag = CAL_FLG_LED_DR|CAL_FLG_LED_DAC|CAL_FLG_AMB_DAC|CAL_FLG_RF;           \r
+              calR->state = hrsCalLed;\r
+                      \r
+            break;\r
+                                               \r
+        case hrsCalLed: \r
+                                       \r
+            if(g1_led>900000 && calR->Group1_Ledidac<= 55)\r
+            {\r
+              calR->Group1_Ledidac = calR->Group1_Ledidac + 6;\r
+            }                                  \r
+                                        if(g2_led>900000 && calR->Group2_Ledidac<= 55)\r
+            {\r
+              calR->Group2_Ledidac = calR->Group2_Ledidac + 6;  \r
+            }                                          \r
+//                                      if(g3_led>900000 && calR->Group3_Ledidac<= 55)\r
+//            {\r
+//              calR->Group3_Ledidac = calR->Group3_Ledidac + 6;\r
+//            }\r
+                                               \r
+                                               if(g1_led < 900000 && g2_led < 900000)\r
+                                               {\r
+                                                       calR->state = hrsCalLed2;\r
+                                               }\r
+                                               else if(calR->Group1_Ledidac >120 || calR->Group2_Ledidac > 120)\r
+                                               {\r
+                                                 calR->state = hrsCalLed3;  \r
+                                               }\r
+                                               else\r
+                                               {\r
+                                                       calR->state = hrsCalLed;\r
+                                               }\r
+                                        calR->flag = CAL_FLG_LED_DAC;\r
+            break;     \r
+                                               \r
+                               case hrsCalLed2:\r
+                                       \r
+                                   if(g1_led>650000 && calR->Group1_Ledidac<=120)\r
+            {\r
+              calR->Group1_Ledidac = calR->Group1_Ledidac + 3;\r
+            }\r
+            else if(g1_led < 400000 && calR->Group1_Ledidac >= 3)\r
+            {\r
+              calR->Group1_Ledidac = calR->Group1_Ledidac - 3;\r
+            }\r
+                                               else if(g1_led < 400000 && calR->Group1_Ledidac>0)\r
+                                               {\r
+                                                       calR->Group1_Ledidac = calR->Group1_Ledidac - 1;\r
+             \r
+                                               }       \r
+                                               \r
+                                       if(g2_led>650000 && calR->Group2_Ledidac<=120)\r
+            {\r
+              calR->Group2_Ledidac = calR->Group2_Ledidac + 3;\r
+              \r
+            }\r
+            if(g2_led<400000 && calR->Group2_Ledidac >= 3)\r
+            {\r
+              calR->Group2_Ledidac = calR->Group2_Ledidac - 3;\r
+             \r
+            }\r
+                                        if(g2_led < 400000 && calR->Group2_Ledidac>0)\r
+                                               {\r
+                                                       calR->Group2_Ledidac = calR->Group2_Ledidac - 1;\r
+                                               }\r
+                                       \r
+                                               \r
+//                                             if(g3_led>750000 && calR->Group3_Ledidac<=120)\r
+//            {\r
+//              calR->Group3_Ledidac = calR->Group3_Ledidac + 3;\r
+//            }                                        \r
+//           if(g3_led<350000 && calR->Group3_Ledidac >= 3)\r
+//            {\r
+//              calR->Group3_Ledidac = calR->Group3_Ledidac - 3;\r
+//            }\r
+//                                             if(g3_led < 350000 && calR->Group3_Ledidac>0)\r
+//                                             {\r
+//                                                     calR->Group3_Ledidac = calR->Group3_Ledidac - 1;\r
+//                                             }       \r
+                                                           \r
+                                               \r
+//                                             if(g1_led<750000 && g1_led>350000 && g2_led<750000 && g2_led>350000 && g3_led<750000 && g3_led>350000)\r
+                                               if(g1_led<650000 && g1_led>400000 && g2_led<650000 && g2_led>400000 )\r
+            {\r
+              calR->state = hrsCalFinish;\r
+            }\r
+//            else if(calR->Group1_Ledidac >= 120 || calR->Group2_Ledidac >= 120 || calR->Group3_Ledidac >= 120)\r
+                                               else if(calR->Group1_Ledidac >= 120 || calR->Group2_Ledidac >= 120)\r
+\r
+            {\r
+              calR->state = hrsCalLed3;\r
+            }\r
+            else\r
+            {\r
+              calR->state = hrsCalLed2;               \r
+            }               \r
+            calR->flag = CAL_FLG_LED_DAC;\r
+            break;\r
+                                               \r
+                               case hrsCalLed3:   \r
+            if(calR->Group1_Ledidac >=120)\r
+            {\r
+              calR->Group1_Cur = (calR->Group1_Cur*3)>>2;\r
+            }\r
+            if(calR->Group2_Ledidac>=120)\r
+            {\r
+              calR->Group2_Cur = (calR->Group2_Cur*3)>>2;\r
+            }\r
+//                                             if(calR->Group3_Ledidac>=120)\r
+//            {\r
+//              calR->Group3_Cur = (calR->Group3_Cur*3)>>2;\r
+//            }\r
+            calR->flag = CAL_FLG_LED_DR;\r
+            calR->state = hrsCalLed; \r
+            break; \r
+                                               \r
+        case hrsCalRfEnd:\r
+            calR->state = hrsCalFinish;\r
+            calR->flag = 0;\r
+            break;\r
+                               \r
+        default:\r
+            break;       \r
+    }\r
+    AGC_LOG("AGC111: led_drv=%d,ledDac=%d,ambDac=%d,ledstep=%d,rf=%d,state = %d\r\n",\\r
+            calR->Group1_Cur, calR->Group1_Ledidac, calR->Group1_AMBDAC,calR->Group1_step,calR->Group1_RF,calR->state);\r
+               AGC_LOG("AGC222: led_drv=%d,ledDac=%d,ambDac=%d,ledstep=%d,rf=%d,state = %d\r\n",\\r
+            calR->Group2_Cur, calR->Group2_Ledidac, calR->Group2_AMBDAC,calR->Group2_step,calR->Group2_RF,calR->state);\r
+//       AGC_LOG("AGC333: led_drv=%d,ledDac=%d,ambDac=%d,ledstep=%d,rf=%d,state = %d\r\n",\\r
+//            calR->Group3_Cur, calR->Group3_Ledidac, calR->Group3_AMBDAC,calR->Group3_step,calR->Group3_RF,calR->state);\r
+}\r
+\r
+\r
+HRS_CAL_SET_T   PPG_hrs_agc( )\r
+{\r
+    int32_t g1_led_val, g2_led_val, g1_amb_val, g2_amb_val;\r
+    \r
+    //AGC_LOG("agc  in\r\n");\r
+    calReg_Hrs.work = false;\r
+    if (!hrs_cal_state) \r
+    {\r
+//                     AGC_LOG("s_cal_state1: %d \r\n", hrs_cal_state);\r
+        return  calReg_Hrs;\r
+    } \r
+    //AGC_LOG("agc  in\r\n");\r
+               #ifdef INT_MODE    \r
+    calReg_Hrs.int_cnt ++;\r
+    if(calReg_Hrs.int_cnt < 8)\r
+    {\r
+         return calReg_Hrs; \r
+    }\r
+    calReg_Hrs.int_cnt = 0;\r
+               hx3695_gpioint_cfg(false);\r
+               #endif   \r
+    calReg_Hrs.work = true;  \r
+               \r
+               read_hrs_data_packet(agc_buf);  \r
+               TYHX_LOG("phase_0x03  %d,%d,%d,%d,%d,%d,%d,%d \r\n",\r
+    agc_buf[0], agc_buf[1], agc_buf[2], agc_buf[3],agc_buf[4], agc_buf[5],agc_buf[6], agc_buf[7]);\r
+    \r
+               g1_led_val = agc_buf[1];\r
+    g1_amb_val = (agc_buf[0] + agc_buf[2])/2 ;\r
+               \r
+               g2_led_val = agc_buf[4];\r
+    g2_amb_val = (agc_buf[3] + agc_buf[5])/2 ;\r
+    \r
+    TYHX_LOG("cal dat g1=%d,g2=%d, a1=%d,a2=%d \r\n",\r
+                g1_led_val, g1_amb_val, g2_led_val, g2_amb_val );\r
+               \r
+    PPG_hrs_Calibration_Routine(&calReg_Hrs, g1_led_val, g2_led_val, g1_amb_val, g2_amb_val );\r
+    \r
+    if (calReg_Hrs.state == hrsCalFinish) \r
+               {\r
+        hx3695_hrs_set_mode(CAL_OFF);\r
+//                       AGC_LOG("hrs_state = %d \r\n",calReg_Hrs.state);\r
+                               #if defined(TIMMER_MODE)\r
+                               #else\r
+                               hx3695_gpioint_cfg(true);\r
+                               #endif\r
+    } \r
+               else\r
+               {\r
+        hx3695_hrs_updata_reg();\r
+//                       AGC_LOG("hrs_state1 = %d \r\n",calReg_Hrs.state);\r
+                               #if defined(INT_MODE)\r
+                               hx3695_gpioint_cfg(true);\r
+                               #endif \r
+    }\r
+    return  calReg_Hrs;\r
+}\r
+\r
+void hx3695_hrs_cal_init(void)\r
+{\r
+    uint16_t sample_rate = 200;     //200                  /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+    uint32_t prf_clk_num = 32000/sample_rate;        /*period in clk num, num = Fclk/fs */\r
+               uint8_t data_avg_num = 0;\r
+    hx3695_write_reg(0X2a, (uint8_t)prf_clk_num);    // prf bit<7:0>\r
+    hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+    hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>\r
+               hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+    hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+       \r
+    hx3695_write_reg(0x1b,0x92); //FIFO bypass mode enable  old 0x10\r
+    hx3695_write_reg(0x36,0x08); // phase4 convertion ready enable\r
+       \r
+               #if defined(INT_MODE)\r
+//       hx3695_write_reg(0x36,0x88); //phase8 phase4 convertion ready enable\r
+               hx3695_write_reg(0x38,0x01);\r
+               #endif\r
+  \r
+    hx3695_write_reg(0x5c,0x0a); //Chip reset\r
+    hx3695_delay_ms(5);             //Delay for reset time\r
+    hx3695_write_reg(0x5c,0x08); //Chip state machine work normal\r
+         hx3695_delay_ms(10);             //Delay for reset time\r
+}\r
+\r
+void hx3695_hrs_cal_off(void)\r
+{\r
+    uint16_t sample_rate = 25;                       /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+    uint32_t prf_clk_num = 32000/sample_rate;        /*period in clk num, num = Fclk/fs */\r
+               uint8_t  data_avg_num = 0;\r
+    hx3695_write_reg(0X2a, (uint8_t)prf_clk_num);    // prf bit<7:0>\r
+    hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+    hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>\r
+               \r
+         hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+    hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+ \r
+               #if defined(INT_MODE) \r
+               hx3695_write_reg(0x1b,0x92); //FIFO mode enable\r
+    hx3695_write_reg(0x36,0x00); //phase convertion ready disable\r
+    hx3695_write_reg(0x38,0x04); \r
+               #endif\r
+     hx3695_write_reg(0x1b, 0x92);\r
+    hx3695_write_reg(0x5c,0x0a); //Chip reset\r
+    hx3695_delay_ms(5);             //Delay for reset time\r
+    hx3695_write_reg(0x1b, 0x92);\r
+\r
+    hx3695_write_reg(0x5c,0x08); //Chip state machine work normal\r
+               hx3695_delay_ms(5);\r
+               read_fifo_first_flg = 1;\r
+//             SEGGER_RTT_printf(0,"caloff_fifo:  %d\r\n", (fifo_data_temp[0]|(fifo_data_temp[1]<<8)|(fifo_data_temp[2]<<16)));\r
+}\r
+\r
+void read_hrs_data_packet(int32_t *s_buf)\r
+{\r
+  uint8_t  databuf1[6] = {0};\r
+               uint8_t  databuf2[6] = {0};\r
+    uint8_t  databuf3[6] = {0};\r
+               uint8_t  databuf4[6] = {0};\r
+\r
+    hx3695_brust_read_reg(0x03, databuf1, 6); \r
+               hx3695_delay_ms(5);\r
+    hx3695_brust_read_reg(0x09, databuf2, 6);          \r
+    hx3695_brust_read_reg(0x0f, databuf3, 6); \r
+    hx3695_brust_read_reg(0x15, databuf4, 6);\r
+               \r
+    s_buf[0] = ((databuf1[0])|(databuf1[1]<<8)|(databuf1[2]<<16)); \r
+               s_buf[1] = ((databuf1[3])|(databuf1[4]<<8)|(databuf1[5]<<16)); \r
+               s_buf[2] = ((databuf2[0])|(databuf2[1]<<8)|(databuf2[2]<<16));  \r
+    s_buf[3] = ((databuf2[3])|(databuf2[4]<<8)|(databuf2[5]<<16));\r
+    s_buf[4] = ((databuf3[0])|(databuf3[1]<<8)|(databuf3[2]<<16)); \r
+               s_buf[5] = ((databuf3[3])|(databuf3[4]<<8)|(databuf3[5]<<16)); \r
+               s_buf[6] = ((databuf4[0])|(databuf4[1]<<8)|(databuf4[2]<<16));  \r
+    s_buf[7] = ((databuf4[3])|(databuf4[4]<<8)|(databuf4[5]<<16));\r
+               \r
+//             SEGGER_RTT_printf(0,"phase7_data:  %d, phase8_data:  %d\r\n", s_buf[6],s_buf[7]);\r
+               \r
+}\r
+\r
+void read_hrs_ir_packet(int32_t *buf)\r
+{\r
+    uint8_t dataBuf[6];\r
+\r
+    hx3695_brust_read_reg(0x06, dataBuf, 6);\r
+\r
+    for (uint8_t i=0; i<2; i++)\r
+    {\r
+        buf[i] = (int32_t)(dataBuf[3*i]|(dataBuf[3*i+1]<<8)|(dataBuf[3*i+2]<<16));\r
+    }\r
+}\r
+\r
+void hx3695_hrs_read_data_packet(int32_t *buf)\r
+{\r
+    uint8_t  databuf1[6] = {0};\r
+    uint8_t  databuf2[6] = {0};\r
+    uint32_t P1 = 0,P2 = 0,P3 = 0,P4 =0 ;\r
+\r
+    hx3695_brust_read_reg(0x03, databuf1, 6);\r
+    hx3695_brust_read_reg(0x09, databuf2, 6);\r
+\r
+    P1 = ((databuf1[0])|(databuf1[1]<<8)|(databuf1[2]<<16));\r
+    P2 = ((databuf1[3])|(databuf1[4]<<8)|(databuf1[5]<<16));\r
+    P3 = ((databuf2[0])|(databuf2[1]<<8)|(databuf2[2]<<16));\r
+    P4 = ((databuf2[3])|(databuf2[4]<<8)|(databuf2[5]<<16));\r
+\r
+    buf[0] = P1;\r
+    buf[1] = P2;\r
+    buf[2] = P3;\r
+    buf[3] = P4;\r
+               \r
+//             TYHX_LOG("tyhx_here ! \r\n");\r
+               \r
+//             SEGGER_RTT_printf(0,"P1~P4: %x,   %x    %x,   %x  \r\n", P1,P2,P3,P4);          \r
+               \r
+}\r
+\r
+void hx3695_hrs_low_power(void)\r
+{\r
+    uint16_t sample_rate = 25;                       /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+    uint8_t data_avg_num = 0;         /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+    uint32_t prf_clk_num = 32000/sample_rate;        /*period in clk num, num = Fclk/fs */\r
+    \r
+    uint8_t phase2_offset_idac = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+         uint8_t phase5_offset_idac = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+    uint8_t phase2_ldr_cur = 0; \r
+         uint8_t phase5_ldr_cur = 0;\r
+       \r
+         uint8_t phase1_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase2_tia_res = 0; \r
+    uint8_t phase3_tia_res = 0;\r
+       \r
+               uint8_t phase4_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+               uint8_t phase5_tia_res = 0; \r
+    uint8_t phase6_tia_res = 0;\r
+       \r
+    uint8_t phase1_led_en = 1;\r
+    uint8_t phase2_led_en = 1;\r
+    uint8_t phase3_led_en = 1;\r
+    uint8_t phase4_led_en = 1;\r
+         uint8_t phase5_led_en = 1;\r
+    uint8_t phase6_led_en = 1;\r
+    uint8_t phase7_led_en = 1;\r
+    uint8_t phase8_led_en = 1;\r
+       \r
+               uint8_t phase1_mux_sel = 0; \r
+               uint8_t phase2_mux_sel = 1;    \r
+               uint8_t phase3_mux_sel = 2;    \r
+               uint8_t phase4_mux_sel = 3; \r
+               uint8_t phase5_mux_sel = 4;    \r
+               uint8_t phase6_mux_sel = 5;    \r
+               uint8_t phase7_mux_sel = 6; \r
+               uint8_t phase8_mux_sel = 7;       \r
+    \r
+    uint8_t phase8_ldr_cur = 25;     /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+    \r
+    uint8_t led_on_time = 1;      /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+                                     4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+    \r
+    hx3695_write_reg(0X2a, (uint8_t)prf_clk_num);    // prf bit<7:0>\r
+    hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+    hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>\r
+\r
+    hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+    hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+ \r
+               hx3695_write_reg(0X43, phase1_mux_sel);  \r
+               hx3695_write_reg(0X44, (0x40 | phase1_tia_res));\r
+               hx3695_write_reg(0X43, phase2_mux_sel);  \r
+               hx3695_write_reg(0X44, (0x40 | phase2_tia_res));\r
+               hx3695_write_reg(0X43, phase3_mux_sel);  \r
+               hx3695_write_reg(0X44, (0x40 | phase3_tia_res));\r
+               \r
+               hx3695_write_reg(0X43, phase4_mux_sel);  \r
+               hx3695_write_reg(0X44, (0x40 | phase1_tia_res));\r
+               hx3695_write_reg(0X43, phase5_mux_sel);  \r
+               hx3695_write_reg(0X44, (0x40 | phase2_tia_res));\r
+               hx3695_write_reg(0X43, phase6_mux_sel);  \r
+               hx3695_write_reg(0X44, (0x40 | phase3_tia_res));\r
+\r
+               hx3695_write_reg(0X43, phase2_mux_sel);  \r
+    hx3695_write_reg(0X47, phase2_offset_idac);\r
+    hx3695_write_reg(0X45, phase2_ldr_cur); \r
+//    hx3695_write_reg(0X70, phase2_ldr_cur); \r
+\r
+               hx3695_write_reg(0X43, phase5_mux_sel);  \r
+    hx3695_write_reg(0X47, phase5_offset_idac);\r
+    hx3695_write_reg(0X45, phase5_ldr_cur); \r
+               \r
+               hx3695_write_reg(0X43, phase8_mux_sel);\r
+               hx3695_write_reg(0X46, 0XC0);\r
+    hx3695_write_reg(0X45, phase8_ldr_cur);    \r
+               \r
+    hx3695_write_reg(0X31, led_on_time<<4|(hx3695_read_reg(0X31)&0x0f));\r
+               hx3695_write_reg(0X30, phase8_led_en<<7 | phase7_led_en<<6 | phase6_led_en<<5 | phase5_led_en<<4 | phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en);\r
+               \r
+               //hx3695_write_reg(0X69, 0xa2); //bit<0>: rc_comb_en bits<1>=rc_rbp_en bits<7>= vcom_clamp_en bits<6:4>= LED_vdesl\r
+    \r
+  #ifdef INT_MODE\r
+               \r
+    hx3695_write_reg(0x1b,0x92); //FIFO bypass mode enable\r
+//    hx3695_write_reg(0x36,0x00); //phase3 convertion ready disable\r
+//             hx3695_write_reg(0X33, 0x83);   // int width    \r
+//             hx3695_write_reg(0X21,0x04);   // fifo almostfull cfg ,max=0x40;\r
+               hx3695_write_reg(0X38,0x04);   // fifo almostfull cfg ,max=0x40;\r
+  #else\r
+    hx3695_write_reg(0x1b,0x92); //FIFO bypass mode enable\r
+    hx3695_write_reg(0x36,0x00); //phase3 convertion ready disable\r
+  #endif\r
+    hx3695_write_reg(0x5c,0x0a); //Chip reset\r
+    hx3695_delay_ms(5);             //Delay for reset time\r
+    hx3695_write_reg(0x5c,0x00); //Chip state machine work normal\r
+               hx3695_delay_ms(5);\r
+    calReg_Hrs.Group1_Cur = 0;\r
+               calReg_Hrs.Group2_Cur = 0;\r
+               calReg_Hrs.Group3_Cur = 0;\r
+\r
+    TYHX_LOG(" chip3 go to low power mode  \r\n" );  \r
+\r
+}\r
+\r
+void hx3695_hrs_updata_reg(void)\r
+{\r
+   uint8_t phase1_mux_sel = 0;\r
+        uint8_t phase2_mux_sel = 1;\r
+   uint8_t phase3_mux_sel = 2;\r
+        uint8_t phase4_mux_sel = 3;\r
+        uint8_t phase5_mux_sel = 4;\r
+   uint8_t phase6_mux_sel = 5;\r
+        uint8_t phase7_mux_sel = 6;\r
+   uint8_t phase8_mux_sel = 7;\r
+\r
+         \r
+    if (calReg_Hrs.flag & CAL_FLG_LED_DR) \r
+    {\r
+                         hx3695_write_reg(0X43, phase2_mux_sel);\r
+             hx3695_write_reg(0X45, calReg_Hrs.Group1_Cur);     // phase1 led driver config\r
+//                       hx3695_write_reg(0X70, calReg_Hrs.LED);\r
+//                       AGC_LOG(" phase2_led_cur_0x45 = %d  \r\n",hx3695_read_reg(0x45) ); \r
+//                       hx3695_write_reg(0X43, phase4_mux_sel);\r
+//           hx3695_write_reg(0X45, calReg_Hrs.Group2_Cur);     // phase1 led driver config\r
+//                     \r
+                               hx3695_write_reg(0X43, phase5_mux_sel);\r
+             hx3695_write_reg(0X45, calReg_Hrs.Group2_Cur);     // phase1 led driver config\r
+                         AGC_LOG(" phase2_led_cur_0x45 = %d  \r\n",hx3695_read_reg(0x45) );\r
+    }\r
+    \r
+    if (calReg_Hrs.flag & CAL_FLG_LED_DAC) \r
+    {\r
+                         hx3695_write_reg(0X43, phase2_mux_sel);\r
+                         hx3695_write_reg(0X48, calReg_Hrs.Group1_Ledidac);\r
+//                       AGC_LOG(" Phase2_LEDDAC_0x47 = %d  \r\n",hx3695_read_reg(0x47) ); \r
+//                             hx3695_write_reg(0X43, phase4_mux_sel);\r
+//                       hx3695_write_reg(0X48, calReg_Hrs.Group2_Ledidac);\r
+                       \r
+                               hx3695_write_reg(0X43, phase5_mux_sel);\r
+                         hx3695_write_reg(0X48, calReg_Hrs.Group2_Ledidac);\r
+    }\r
+    \r
+    if (calReg_Hrs.flag & CAL_FLG_AMB_DAC) \r
+    {\r
+                         hx3695_write_reg(0X43, phase1_mux_sel);\r
+        hx3695_write_reg(0X48, calReg_Hrs.Group1_AMBDAC);  // phase1 offset idac cfg\r
+//                       AGC_LOG(" PHASE1_AMBDAC_0x47 = %d  \r\n",hx3695_read_reg(0x47) ); \r
+                               hx3695_write_reg(0X43, phase3_mux_sel);\r
+        hx3695_write_reg(0X48, calReg_Hrs.Group1_AMBDAC);  // phase3 offset idac cfg\r
+//                       AGC_LOG(" PHASE3_AMBDAC_0x47 = %d  \r\n",hx3695_read_reg(0x47) ); \r
+                               hx3695_write_reg(0X43, phase4_mux_sel);\r
+        hx3695_write_reg(0X48, calReg_Hrs.Group2_AMBDAC);  // phase5 offset idac cfg\r
+                               \r
+                         hx3695_write_reg(0X43, phase6_mux_sel);\r
+        hx3695_write_reg(0X48, calReg_Hrs.Group2_AMBDAC);  // phase5 offset idac cfg\r
+    }\r
+    \r
+    if (calReg_Hrs.flag & CAL_FLG_RF) \r
+    {   \r
+                         hx3695_write_reg(0X43, phase1_mux_sel);  \r
+                   hx3695_write_reg(0X44, (0x40 | calReg_Hrs.Group1_RF));\r
+//                       AGC_LOG(" PHASE1_RF_0x44 = %d  \r\n",(hx3695_read_reg(0x44)&0x0f) ); \r
+        hx3695_write_reg(0X43, phase2_mux_sel);  \r
+                   hx3695_write_reg(0X44, (0x40 | calReg_Hrs.Group1_RF));\r
+//                        AGC_LOG(" PHASE2_RF_0x44 = %d  \r\n",(hx3695_read_reg(0x44)&0x0f) ); \r
+                         hx3695_write_reg(0X43, phase3_mux_sel);  \r
+                   hx3695_write_reg(0X44, (0x40 | calReg_Hrs.Group1_RF));\r
+//                       AGC_LOG(" PHASE3_RF_0x44 = %d  \r\n",(hx3695_read_reg(0x44)&0x0f) ); \r
+                       \r
+                         hx3695_write_reg(0X43, phase4_mux_sel);  \r
+                   hx3695_write_reg(0X44, (0x40 | calReg_Hrs.Group2_RF));\r
+                       \r
+                               hx3695_write_reg(0X43, phase5_mux_sel);  \r
+                   hx3695_write_reg(0X44, (0x40 | calReg_Hrs.Group2_RF));\r
+                       \r
+                               hx3695_write_reg(0X43, phase6_mux_sel);  \r
+                   hx3695_write_reg(0X44, (0x40 | calReg_Hrs.Group2_RF));\r
+    }\r
+}\r
+\r
+void hx3695_hrs_set_mode(uint8_t mode_cmd)\r
+{\r
+    switch (mode_cmd)\r
+    {\r
+    case PPG_INIT:\r
+        hx3695_hrs_ppg_init();\r
+#if defined(TIMMER_MODE)\r
+        hx3695_320ms_timer_cfg(true);\r
+#if defined(GSEN_40MS_TIMMER)\r
+        hx3695_40ms_timer_cfg(true);\r
+  #endif\r
+#else\r
+        hx3695_gpioint_cfg(true);\r
+#endif\r
+        s_ppg_state = 1;\r
+        AGC_LOG("ppg init mode\r\n");\r
+        break;\r
+\r
+    case PPG_OFF:\r
+        hx3695_ppg_off();\r
+        s_ppg_state = 0;\r
+        AGC_LOG("ppg off mode\r\n");\r
+        break;\r
+\r
+    case PPG_LED_OFF:\r
+        hx3695_hrs_low_power();\r
+        s_ppg_state = 0;\r
+        AGC_LOG("ppg led off mode\r\n");\r
+        break;\r
+\r
+    case CAL_INIT:\r
+        Init_hrs_PPG_Calibration_Routine(&calReg_Hrs);\r
+        hx3695_hrs_cal_init();\r
+        hx3695_hrs_updata_reg();\r
+   #if defined(TIMMER_MODE)\r
+   #if defined(GSEN_40MS_TIMMER)\r
+   #else\r
+        hx3695_40ms_timer_cfg(true);\r
+    #endif\r
+   #endif\r
+        hrs_cal_state = 1;\r
+        AGC_LOG("cal init mode\r\n");\r
+        break;\r
+\r
+    case RECAL_INIT:\r
+        Restart_hrs_PPG_Calibration_Routine(&calReg_Hrs);\r
+        hx3695_hrs_cal_init();\r
+        hx3695_hrs_updata_reg();\r
+#if defined(TIMMER_MODE)\r
+#if defined(GSEN_40MS_TIMMER)\r
+#else\r
+        hx3695_40ms_timer_cfg(true);\r
+#endif\r
+#endif\r
+        hrs_cal_state = 1;\r
+        AGC_LOG("Recal init mode\r\n");\r
+        break;\r
+\r
+    case CAL_OFF:\r
+#if defined(TIMMER_MODE)\r
+#if defined(GSEN_40MS_TIMMER)\r
+#else\r
+        hx3695_40ms_timer_cfg(false);\r
+#endif\r
+#endif\r
+        hx3695_hrs_cal_off();\r
+        hrs_cal_state = 0;\r
+        AGC_LOG("cal off mode\r\n");\r
+        break;\r
+\r
+    default:\r
+        break;\r
+    }\r
+}\r
+\r
+SENSOR_ERROR_T hx3695_hrs_enable(void)\r
+{\r
+    if (!hx3695_chip_check())\r
+    {\r
+        AGC_LOG("hx3695 check id failed!\r\n");\r
+        return SENSOR_OP_FAILED;\r
+    }\r
+\r
+    AGC_LOG("hx3695 check id success!\r\n");\r
+\r
+    if (s_ppg_state)\r
+    {\r
+        AGC_LOG("ppg already on!\r\n");\r
+        return SENSOR_OP_FAILED;\r
+    }\r
+    if(!tyhx_hrs_alg_open())\r
+    {\r
+        AGC_LOG("hrs alg open fail,or dynamic ram not enough!\r\n");\r
+    }\r
+\r
+    hrs_wear_status = MSG_HRS_NO_WEAR;\r
+    hrs_wear_status_pre = MSG_HRS_NO_WEAR;\r
+\r
+    hx3695_hrs_set_mode(PPG_INIT);\r
+\r
+    AGC_LOG("hx3695 enable!\r\n");\r
+\r
+    return SENSOR_OK;\r
+}\r
+\r
+void hx3695_hrs_disable(void)\r
+{\r
+#if defined(TIMMER_MODE)\r
+    hx3695_320ms_timer_cfg(false);\r
+    hx3695_40ms_timer_cfg(false);\r
+#elif defined(INT_MODE)\r
+    hx3695_gpioint_cfg(false);\r
+#endif\r
+    hx3695_hrs_set_mode(PPG_OFF);\r
+    s_ppg_state = 0;\r
+    hrs_cal_state = 0;\r
+    tyhx_hrs_alg_close();\r
+    AGC_LOG("hx3695 disable!\r\n");\r
+}\r
+\r
+void hx3695_hrs_data_reset(void)\r
+{\r
+    s_ppg_state = 0;\r
+    hrs_cal_state = 0;\r
+    tyhx_hrs_alg_close();\r
+}\r
+\r
+hrs_wear_msg_code_t hx3695_hrs_get_wear_status(void)\r
+{\r
+    return  hrs_wear_status;\r
+}\r
+\r
+HRS_CAL_SET_T get_hrs_agc_status(void)\r
+{\r
+    HRS_CAL_SET_T cal;\r
+//    cal.flag     =  calReg_Hrs.flag;\r
+//    cal.int_cnt  =  calReg_Hrs.int_cnt;\r
+//    cal.cur255_cnt = calReg_Hrs.cur255_cnt;\r
+//     \r
+//    cal.led_idac =  calReg_Hrs.led_idac;\r
+//     \r
+//    cal.Group1_Ledidac = calReg_Hrs.Group1_Ledidac;\r
+//     \r
+//    cal.LEDDAC   =  calReg_Hrs.LEDDAC;\r
+//    cal.AMBDAC   =  calReg_Hrs.AMBDAC;\r
+//    cal.RF       =  calReg_Hrs.RF;\r
+//    cal.led_step =  calReg_Hrs.led_step;\r
+//    cal.state    =  calReg_Hrs.state;\r
+//    cal.led_max_cur = calReg_Hrs.led_max_cur;\r
+//    cal.work     =  calReg_Hrs.work;\r
+           cal = calReg_Hrs;\r
+      return cal;\r
+}\r
+\r
+uint8_t hx3695_hrs_read(hrs_sensor_data_t * s_dat)\r
+{\r
+    int32_t PPG_src_data, PPG_src_data2;\r
+    int32_t Ir_src_data;\r
+    bool recal = false;\r
+    uint8_t size = 0;\r
+         uint16_t  data_count = 0;\r
+    uint8_t size_byte = 0;\r
+    int32_t *PPG_buf =  &(s_dat->green_data[0]);\r
+    int32_t *ir_buf  =  &(s_dat->ir_data[0]);  \r
+    int32_t *s_buf   =  &(s_dat->s_buf[0]);   \r
+   \r
+               int32_t ps_data[8] =  {0};\r
+               int32_t ps_green_data = 0;\r
+               s_dat->agc_green =  calReg_Hrs.Group1_Cur;\r
+\r
+    if (!s_ppg_state || hrs_cal_state) \r
+    {\r
+//                     TYHX_LOG("ppg_state: %d ,hrs_cal_state:  %d\r\n",s_ppg_state,hrs_cal_state);\r
+        return 0;\r
+    }  \r
+//    TYHX_LOG("ppg_state: %d ,hrs_cal_state:  %d\r\n",s_ppg_state,hrs_cal_state);             \r
+                   data_count = hx3695_read_fifo_data(s_buf,hrs_phase_num,1); \r
+                   //SEGGER_RTT_printf(0,"ppg data size: %d %d\r\n", data_count,hrs_phase_num);\r
+//                             SEGGER_RTT_printf(0,"af_hx3695_read_fifo_data:::%d %d %d\r\n", hx3695_read_reg(0X2a),hx3695_read_reg(0X2b),hx3695_read_reg(0X2c));\r
+        s_dat->count =  data_count; \r
+\r
+                   read_hrs_data_packet(ps_data);\r
+        for (uint8_t i=0; i<data_count; i++) \r
+        {\r
+//            PPG_src_data =  ps_data[1] - ps_data[0];     //   s_buf[i*3];\r
+            Ir_src_data  =    ps_data[7] - ps_data[6];   //s_buf[i*3+2]; \r
+            PPG_src_data =    s_buf[i*3];\r
+                                         PPG_src_data2 =   s_buf[i*3+1];\r
+//            Ir_src_data  =    s_buf[i*4+3];          \r
+\r
+            PPG_buf[i] = PPG_src_data * 2;\r
+            ir_buf[i] = PPG_src_data2 * 2;        //Ir_src_data;\r
+//                                     SEGGER_RTT_printf(0,"PPG_data:  %d , PPG_src_data2: %d\r\n", PPG_src_data,PPG_src_data2);\r
+            hx3695_hrs_wear_mode_check(HRS_MODE,Ir_src_data); \r
+//           SEGGER_RTT_printf(0,"hx3690_hrs_wear_mode_check:::%d %d %d\r\n", hx3695_read_reg(0X2a),hx3695_read_reg(0X2b),hx3695_read_reg(0X2c));\r
+//                                     SEGGER_RTT_printf(0,"fifo:%d/%d %d %d, fifo_data: %d %d %d %d\r\n" ,1+i,data_count,   \\r
+            PPG_buf[i],ir_buf[i],s_buf[i*3],s_buf[i*3+1],s_buf[i*3+2],calReg_Hrs.LED);         \r
+        }\r
+                               ps_green_data = ps_data[1];   //  -  ((ps_data[2]+ps_data[0])>>1);\r
+//                             SEGGER_RTT_printf(0,"ps_green_data: %d  PS8: %d, PS7:  %d\r\n", ps_green_data,ps_data[7],ps_data[6]);\r
+                               if (ps_green_data<300000 || ps_green_data>800000)            \r
+                               {\r
+                                               recal = true;\r
+                                        \r
+                                               if(hrs_wear_status==MSG_HRS_NO_WEAR)\r
+                                               {\r
+                                                                recal = false;\r
+                                               }                \r
+                               }\r
+        if (recal) \r
+                               //if (0)\r
+        {\r
+            cal_delay--;\r
+\r
+            if (cal_delay <= 0) \r
+            {\r
+                cal_delay = CAL_DELAY_COUNT;\r
+                hx3695_hrs_set_mode(RECAL_INIT);\r
+                AGC_LOG("========>>>>LED_IDAC = %d   %d   %d\r\n",calReg_Hrs.Group1_Ledidac,calReg_Hrs.Group2_Ledidac,calReg_Hrs.Group3_Ledidac);\r
+            }\r
+        }\r
+        else                       \r
+        {\r
+            cal_delay = CAL_DELAY_COUNT;\r
+        }\r
+//    }    \r
+    return 1;\r
+}\r
+\r
+\r
+#endif\r
diff --git a/code/sdk/drivers/peripheral/ppg/hx3695/hx3695_hrs_agc.h b/code/sdk/drivers/peripheral/ppg/hx3695/hx3695_hrs_agc.h
new file mode 100644 (file)
index 0000000..3d77689
--- /dev/null
@@ -0,0 +1,115 @@
+#ifndef _hx3695_hrs_agc_H_\r
+#define _hx3695_hrs_agc_H_\r
+#include <stdint.h>\r
+#include <stdbool.h>\r
+#include "hx3695.h"\r
+\r
+#define CAL_FLG_LED_DR     0x01\r
+#define CAL_FLG_LED_DAC    0x02 \r
+#define CAL_FLG_AMB_DAC    0x04\r
+#define CAL_FLG_RF         0x08\r
+\r
+#define HRS_CAL_INIT_LED   128\r
+#define NO_TOUCH_CHECK_NUM 2 \r
+#define CAL_DELAY_COUNT    2\r
+\r
+typedef enum {\r
+       MSG_HRS_NO_WEAR,\r
+       MSG_HRS_WEAR\r
+} hrs_wear_msg_code_t;\r
+\r
+typedef struct {\r
+       uint8_t count;\r
+       int32_t green_data[64];\r
+       int32_t ir_data[64];\r
+       int32_t s_buf[64]; \r
+       uint32_t als;\r
+       uint32_t agc_green;\r
+} hrs_sensor_data_t;\r
+\r
+\r
+//typedef struct {\r
+//     SENSOR_TYPE_T type;\r
+//     uint8_t count;\r
+//     int32_t ppg_data[64];\r
+//     int32_t ir_data[64];\r
+//     int32_t s_buf[64]; \r
+//     uint32_t als;\r
+//     uint32_t agc_green;\r
+//}hrs_sensor_data_t;\r
+\r
+//typedef enum {    \r
+//    hrsCalStart, \r
+//    hrsCalLedCur,\r
+//    hrsCalLed,\r
+//    hrsCalLed2,\r
+//    hrsCalLed3,\r
+//    hrsCalFinish, \r
+//} HRS_STATE_T;\r
+\r
+\r
+typedef enum {    \r
+    hrsCalStart, \r
+               hrsCalStart1,\r
+    hrsCalLed,\r
+    hrsCalLed2,\r
+    hrsCalLed3,\r
+    hrsCalRf,\r
+    hrsCalRfEnd,\r
+    hrsCalFinish, \r
+}HRS_STATE_T;\r
+\r
+typedef struct {\r
+       uint8_t flag;\r
+       bool work;\r
+       uint8_t int_cnt;\r
+       uint8_t cur255_cnt;\r
+       uint8_t Group1_Ledidac;   //led_idac\r
+  uint8_t Group2_Ledidac; \r
+  uint8_t Group3_Ledidac;      \r
+       uint16_t Group1_Cur;   //LED; \r
+       uint16_t Group2_Cur;   //LED;\r
+       uint16_t Group3_Cur;   //LED;\r
+//     uint8_t LEDDAC; \r
+       uint8_t Group1_AMBDAC; \r
+  uint8_t Group2_AMBDAC;\r
+  uint8_t Group3_AMBDAC;       \r
+       uint8_t Group1_RF;\r
+  uint8_t Group2_RF;\r
+  uint8_t Group3_RF;   \r
+       uint32_t Group1_step;\r
+       uint32_t Group2_step;\r
+       uint32_t Group3_step;\r
+       uint8_t state;\r
+       uint8_t Group1_max_cur;\r
+       uint8_t Group2_max_cur;\r
+       uint8_t Group3_max_cur;\r
+} HRS_CAL_SET_T;\r
+\r
+HRS_CAL_SET_T PPG_hrs_agc( );\r
+void Init_hrs_PPG_Calibration_Routine(HRS_CAL_SET_T *calR); \r
+void Restart_hrs_PPG_Calibration_Routine(HRS_CAL_SET_T *calR);\r
+//void PPG_hrs_Calibration_Routine(HRS_CAL_SET_T *calR, int32_t g1_led,int32_t g2_led,int32_t g3_led, int32_t g1_amb, int32_t g2_amb,int32_t g3_amb);\r
+void PPG_hrs_Calibration_Routine(HRS_CAL_SET_T *calR, int32_t g1_led,int32_t g2_led, int32_t g1_amb, int32_t g2_amb);\r
+\r
+void hx3695_hrs_cal_init(void);\r
+void hx3695_hrs_cal_off(void);\r
+uint8_t hx3695_read_fifo_size(void);\r
+void read_hrs_data_packet(int32_t *buf);\r
+void read_hrs_ir_packet(int32_t *buf);\r
+void hx3695_hrs_read_data_packet(int32_t *buf); \r
+void hx3695_hrs_low_power(void);\r
+void hx3695_hrs_normal_power(void);\r
+void hx3695_hrs_updata_reg(void);\r
+void hx3695_hrs_set_mode(uint8_t mode_cmd);\r
+SENSOR_ERROR_T hx3695_hrs_enable(void);\r
+void hx3695_hrs_disable(void);\r
+hrs_wear_msg_code_t hx3695_hrs_get_wear_status(void);\r
+uint8_t hx3695_hrs_read(hrs_sensor_data_t *s_dat);\r
+bool hx3695_hrs_init(void);  \r
+hrs_wear_msg_code_t hx3695_hrs_wear_mode_check(WORK_MODE_T mode, int32_t infrared_data);\r
+\r
+HRS_CAL_SET_T get_hrs_agc_status(void);\r
+void hx3695_hrs_data_reset(void);\r
+\r
+#endif\r
diff --git a/code/sdk/drivers/peripheral/ppg/hx3695/hx3695_hrv_agc.c b/code/sdk/drivers/peripheral/ppg/hx3695/hx3695_hrv_agc.c
new file mode 100644 (file)
index 0000000..2147396
--- /dev/null
@@ -0,0 +1,784 @@
+#include <stdio.h>\r
+#include <stdbool.h>\r
+#include <stdint.h>\r
+#include <stdlib.h>\r
+#include <math.h>\r
+\r
+#include "tyhx_hrs_custom.h"\r
+#include "hx3695.h"\r
+#include "hx3695_hrv_agc.h"\r
+#include "tyhx_hrv_alg.h"\r
+\r
+\r
+#ifdef HRV_ALG_LIB\r
+\r
+extern const uint8_t  hx3695_hrs_agc_idac;\r
+extern const uint8_t  green_led_max_init;\r
+extern uint8_t low_vbat_flag;\r
+extern uint8_t hrv_phase_num;\r
+extern uint8_t read_fifo_first_flg;\r
+\r
+//hrv_INFRARED_THRES\r
+extern const int32_t  hrv_ir_unwear_thres;\r
+extern const int32_t  hrv_ir_wear_thres;\r
+\r
+static uint8_t s_ppg_state = 0;\r
+static uint8_t s_cal_state = 0;\r
+static int32_t agc_buf[4] = {0};\r
+\r
+static uint8_t cal_delay = HRV_CAL_DELAY_COUNT;\r
+static HRV_CAL_SET_T  calReg;\r
+//\r
+static hrv_wear_msg_code_t hrv_wear_status = MSG_HRV_NO_WEAR;\r
+static hrv_wear_msg_code_t hrv_wear_status_pre = MSG_HRV_NO_WEAR;\r
+\r
+static uint8_t no_touch_cnt = 0;\r
+\r
+hrv_wear_msg_code_t hx3695_hrv_wear_mode_check(int32_t infrared_data)\r
+{\r
+    if(infrared_data > hrv_ir_wear_thres)\r
+    {\r
+        if(no_touch_cnt < NO_TOUCH_CHECK_NUM)\r
+        {\r
+            no_touch_cnt++;\r
+        }\r
+        if(no_touch_cnt >= NO_TOUCH_CHECK_NUM)\r
+        {\r
+            hrv_wear_status = MSG_HRV_WEAR;\r
+        }\r
+    }\r
+    else if(infrared_data < hrv_ir_unwear_thres)\r
+    {\r
+        if(no_touch_cnt>0)\r
+        {\r
+            no_touch_cnt--;\r
+        }\r
+        if(no_touch_cnt == 0)\r
+        {\r
+            hrv_wear_status = MSG_HRV_NO_WEAR;\r
+        }\r
+    }\r
+\r
+    if(hrv_wear_status_pre != hrv_wear_status)\r
+    {\r
+        hrv_wear_status_pre = hrv_wear_status;\r
+        if(hrv_wear_status_pre == MSG_HRV_NO_WEAR)\r
+        {\r
+            hx3695_hrv_low_power();\r
+        }\r
+        else if(hrv_wear_status_pre == MSG_HRV_WEAR)\r
+        {\r
+            tyhx_hrv_alg_open_deep();\r
+            hx3695_hrv_set_mode(PPG_INIT);\r
+            hx3695_hrv_set_mode(CAL_INIT);\r
+        }\r
+    }\r
+\r
+    return hrv_wear_status;\r
+}\r
+\r
+void Init_hrv_PPG_Calibration_Routine(HRV_CAL_SET_T *calR,uint8_t led)\r
+{\r
+    calR->flag = CAL_FLG_LED_DR|CAL_FLG_LED_DAC|CAL_FLG_AMB_DAC|CAL_FLG_RF;\r
+\r
+    calR->LEDDAC = 0;   /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+    calR->AMBDAC = 0;   /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+    calR->RF = 0;       /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+    calR->LED = HRV_CAL_INIT_LED;\r
+    calR->state = hrvCalStart;\r
+    calR->int_cnt = 0;\r
+    calR->cur255_cnt =0;\r
+    if(low_vbat_flag==1)\r
+    {\r
+        calR->led_max_cur = 128;\r
+    }\r
+    else\r
+    {\r
+        calR->led_max_cur = green_led_max_init;\r
+    }\r
+}\r
+\r
+void Restart_hrv_PPG_Calibration_Routine(HRV_CAL_SET_T *calR)\r
+{\r
+    calR->flag = CAL_FLG_LED_DR|CAL_FLG_LED_DAC|CAL_FLG_AMB_DAC|CAL_FLG_RF;\r
+    calR->state = hrvCalLed;\r
+    calR->int_cnt = 0;\r
+}\r
+\r
+void PPG_hrv_Calibration_Routine(HRV_CAL_SET_T *calR, int32_t led, int32_t amb)\r
+{\r
+    switch(calR->state)\r
+    {\r
+    case hrvCalStart:\r
+        calR->state = hrvLedCur;\r
+        break;\r
+\r
+    case hrvLedCur:\r
+        if(amb>525000)\r
+        {\r
+            calR->AMBDAC = (amb-525000)/1300;\r
+        }\r
+        else\r
+        {\r
+            calR->AMBDAC = 0;\r
+        }\r
+        if(led>amb+256)\r
+        {\r
+            calR->led_step = (led-amb)/HRV_CAL_INIT_LED;\r
+            calR->LED = 1300*(hx3695_hrs_agc_idac+calR->AMBDAC)/calR->led_step;\r
+            if(calR->LED > calR->led_max_cur)\r
+            {\r
+                calR->LED = calR->led_max_cur;\r
+            }\r
+            else if(calR->LED < 15)\r
+            {\r
+                calR->LED = 15;\r
+            }\r
+            if(calR->LED != calR->led_max_cur)\r
+            {\r
+                calR->LEDDAC = (hx3695_hrs_agc_idac*3)>>2;\r
+            }\r
+            else\r
+            {\r
+                calR->LEDDAC = hx3695_hrs_agc_idac>>1;\r
+            }\r
+            calR->RF = 5;\r
+            calR->flag = CAL_FLG_LED_DR|CAL_FLG_LED_DAC|CAL_FLG_AMB_DAC|CAL_FLG_RF;\r
+            calR->state = hrvCalLed;\r
+        }\r
+        else\r
+        {\r
+            calR->state = hrvCalFinish;\r
+        }\r
+        break;\r
+\r
+    case hrvCalLed:\r
+        if(led>800000 && calR->LEDDAC<=120)\r
+        {\r
+            calR->LEDDAC = calR->LEDDAC + 2;\r
+            calR->state = hrvCalLed;\r
+        }\r
+        else if(led<350000 && calR->LEDDAC>=2)\r
+        {\r
+            calR->LEDDAC = calR->LEDDAC - 2;\r
+            calR->state = hrvCalLed;\r
+        }\r
+        else if(led<350000 && calR->LEDDAC>0)\r
+        {\r
+            calR->LEDDAC = calR->LEDDAC - 1;\r
+            calR->state = hrvCalLed;\r
+        }\r
+        else\r
+        {\r
+            calR->state = hrvCalLed2;\r
+        }\r
+        calR->flag = CAL_FLG_LED_DAC;\r
+        break;\r
+\r
+    case hrvCalLed2:\r
+        if(led+calR->LEDDAC*26000 < (amb+calR->AMBDAC*26000)+((26000*hx3695_hrs_agc_idac*3)>>2) && calR->LED < calR->led_max_cur)\r
+        {\r
+            calR->LED = calR->led_max_cur;\r
+            calR->state = hrvCalLed;\r
+            calR->flag = CAL_FLG_LED_DR;\r
+        }\r
+        else\r
+        {\r
+            calR->state = hrvCalFinish;\r
+            calR->flag = 0;\r
+        }\r
+        break;\r
+\r
+    default:\r
+        break;\r
+\r
+    }\r
+    AGC_LOG("AGC: led_drv=%d,ledDac=%d,ambDac=%d,ledstep=%d,rf=%d,\r\n",\\r
+            calR->LED, calR->LEDDAC, calR->AMBDAC,calR->led_step,calR->RF);\r
+}\r
+\r
+HRV_CAL_SET_T PPG_hrv_agc(void)\r
+{\r
+    int32_t led_val, amb_val;\r
+    calReg.work = false;\r
+    if (!s_cal_state)\r
+    {\r
+        return  calReg;\r
+    }\r
+\r
+#ifdef INT_MODE\r
+    calReg.int_cnt ++;\r
+    if(calReg.int_cnt < 8)\r
+    {\r
+        return calReg;\r
+    }\r
+    calReg.int_cnt = 0;\r
+    hx3695_gpioint_cfg(false);\r
+#endif\r
+\r
+    calReg.work = true;\r
+               \r
+    hx3695_hrv_read_data_packet(agc_buf);\r
+               \r
+    led_val = agc_buf[0];\r
+    amb_val = agc_buf[1];\r
+\r
+    AGC_LOG("cal dat ch1=%d,ch2=%d,led_val=%d,amb_val=%d \r\n",\\r
+            agc_buf[0], agc_buf[1], led_val, amb_val);\r
+\r
+    PPG_hrv_Calibration_Routine(&calReg, led_val, amb_val);\r
+\r
+    if (calReg.state == hrvCalFinish)\r
+    {\r
+        hx3695_hrv_set_mode(CAL_OFF);\r
+#if defined(TIMMER_MODE)\r
+#else\r
+        hx3695_gpioint_cfg(true);\r
+#endif\r
+    }\r
+    else\r
+    {\r
+        hx3695_hrv_updata_reg();\r
+#if defined(INT_MODE)\r
+        hx3695_gpioint_cfg(true);\r
+#endif\r
+    }\r
+    return  calReg;\r
+}\r
+\r
+void hx3695_hrv_cal_init(void) // 20200615 ericy afe cali online\r
+{\r
+uint16_t sample_rate = 200;                       /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+         uint8_t data_avg_num = 0;         /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+    uint32_t prf_clk_num = 32000/sample_rate;        /*period in clk num, num = Fclk/fs */\r
+    hx3695_write_reg(0X2a, (uint8_t)prf_clk_num);    // prf bit<7:0>\r
+    hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+    hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>\r
+//    AGC_LOG("prf_clk_num =%d %d %d\r\n", hx3695_read_reg(0X2a), hx3695_read_reg(0X2b), hx3695_read_reg(0X2c));\r
+    hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+    hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );   \r
+  \r
+         hx3695_write_reg(0x1b,0x90); //FIFO mode enable\r
+    hx3695_write_reg(0x36,0x00); //phase3 convertion ready disable     \r
+       \r
+               #if defined(INT_MODE)\r
+         hx3695_write_reg(0X33, 0x83);   // int width  \r
+    hx3695_write_reg(0x38,0x04); \r
+               #endif\r
+    hx3695_write_reg(0x1b, 0x90);\r
+    hx3695_write_reg(0x5c,0x0a); //Chip reset\r
+    hx3695_delay_ms(5);             //Delay for reset time\r
+    hx3695_write_reg(0x5c,0x08); //Chip state machine work normal\r
+               hx3695_delay_ms(5);\r
+//             hx3695_brust_read_reg(0x22, fifo_data_buf, 3);\r
+    read_fifo_first_flg = 1;\r
+//             AGC_LOG("herehere %d,%d,%d \r\n",hx3695_read_reg(0X2a),hx3695_read_reg(0X2b),hx3695_read_reg(0X2c));\r
+}\r
+\r
+void hx3695_hrv_cal_off(void) // 20200615 ericy afe cali offline\r
+{\r
+    uint16_t sample_rate = 125;                       /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+         uint8_t data_avg_num = 0;         /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+    uint32_t prf_clk_num = 32000/sample_rate;        /*period in clk num, num = Fclk/fs */\r
+    hx3695_write_reg(0X2a, (uint8_t)prf_clk_num);    // prf bit<7:0>\r
+    hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+    hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>\r
+//    AGC_LOG("prf_clk_num =%d %d %d\r\n", hx3695_read_reg(0X2a), hx3695_read_reg(0X2b), hx3695_read_reg(0X2c));\r
+    hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+    hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );   \r
+  \r
+         hx3695_write_reg(0x1b,0x90); //FIFO mode enable\r
+    hx3695_write_reg(0x36,0x00); //phase3 convertion ready disable     \r
+       \r
+               #if defined(INT_MODE)\r
+         hx3695_write_reg(0X33, 0x83);   // int width  \r
+    hx3695_write_reg(0x38,0x04); \r
+               #endif\r
+  \r
+    hx3695_write_reg(0x5c,0x0a); //Chip reset\r
+    hx3695_delay_ms(5);             //Delay for reset time\r
+//    hx3695_write_reg(0x1b, 0x10);\r
+//    hx3695_delay(5);\r
+    hx3695_write_reg(0x1b, 0x90);\r
+    hx3695_write_reg(0x5c,0x08); //Chip state machine work normal\r
+               hx3695_delay_ms(5);\r
+//             hx3695_brust_read_reg(0x22, fifo_data_buf, 3);\r
+    read_fifo_first_flg = 1;\r
+//             AGC_LOG("herehere %d,%d,%d \r\n",hx3695_read_reg(0X2a),hx3695_read_reg(0X2b),hx3695_read_reg(0X2c));\r
+}\r
+\r
+void read_hrv_data_packet(int32_t *buf)\r
+{\r
+    uint8_t dataBuf[6];\r
+\r
+    hx3695_brust_read_reg(0x03, dataBuf, 3);\r
+    hx3695_brust_read_reg(0x0c, dataBuf+3, 3);\r
+\r
+    for (uint8_t i=0; i<2; i++)\r
+    {\r
+        buf[i] = (int32_t)(dataBuf[3*i]|(dataBuf[3*i+1]<<8)|(dataBuf[3*i+2]<<16));\r
+    }\r
+}\r
+\r
+void read_hrv_ir_packet(int32_t *buf)\r
+{\r
+    uint8_t dataBuf[6];\r
+\r
+    hx3695_brust_read_reg(0x06, dataBuf, 6);\r
+\r
+    for (uint8_t i=0; i<2; i++)\r
+    {\r
+        buf[i] = (int32_t)(dataBuf[3*i]|(dataBuf[3*i+1]<<8)|(dataBuf[3*i+2]<<16));\r
+    }\r
+}\r
+\r
+void hx3695_hrv_read_data_packet(int32_t *buf)\r
+{\r
+    uint8_t  databuf1[6] = {0};\r
+    uint8_t  databuf2[6] = {0};\r
+    uint32_t P1 = 0,P2 = 0,P3 = 0,P4 =0 ;\r
+\r
+    hx3695_brust_read_reg(0x03, databuf1, 6);\r
+    hx3695_brust_read_reg(0x09, databuf2, 6);\r
+\r
+    P1 = ((databuf1[0])|(databuf1[1]<<8)|(databuf1[2]<<16));\r
+    P2 = ((databuf1[3])|(databuf1[4]<<8)|(databuf1[5]<<16));\r
+    P3 = ((databuf2[0])|(databuf2[1]<<8)|(databuf2[2]<<16));\r
+    P4 = ((databuf2[3])|(databuf2[4]<<8)|(databuf2[5]<<16));\r
+\r
+    buf[0] = P1;\r
+    buf[1] = P2;\r
+    buf[2] = P3;\r
+    buf[3] = P4;\r
+               \r
+               AGC_LOG("Reg_data_0x03 %d,%d,%d,%d\r\n",P1,P2,P3,P4);\r
+}\r
+\r
+void hx3695_hrv_low_power(void)\r
+{\r
+    uint16_t sample_rate = 10;                       /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+    uint32_t prf_clk_num = 32000/sample_rate;       /*period in clk num, num = Fclk/fs */\r
+\r
+         uint8_t data_avg_num = 0;                       /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+    uint8_t phase1_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+    uint8_t phase1_led_idac = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+    uint8_t phase1_ldr_cur = 0;\r
+       \r
+         uint8_t phase1_enable = 1;     /*phase1_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase2_enable = 1;     /*phase2_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase3_enable = 1;     /*phase3_enable  , 1 mean enable ; 0 mean disable */ \r
+    uint8_t phase4_enable = 1;     /*phase4_enable  , 1 mean enable ; 0 mean disable */\r
+       \r
+         uint8_t phase1_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase2_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase3_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+    uint8_t phase4_adc_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+       \r
+               uint8_t phase1_mux_sel = 0;    /* sel phase1*/\r
+               uint8_t phase2_mux_sel = 1;    /* sel phase2*/\r
+               uint8_t phase3_mux_sel = 2;    /* sel phase3*/\r
+               uint8_t phase4_mux_sel = 3;    /* sel phase4*/\r
+       \r
+       \r
+    uint8_t phase1_led_en = 0;\r
+    uint8_t phase2_led_en = 0;\r
+    uint8_t phase3_led_en = 1;\r
+    uint8_t phase4_led_en = 0;\r
+\r
+    uint8_t phase3_tia_res = 0;\r
+    uint8_t phase4_tia_res = 0;\r
+\r
+    uint8_t phase3_ldr_cur = 15;  /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+\r
+    uint8_t led_on_time = 1;      /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+                                     4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+\r
+    hx3695_write_reg(0X2a, (uint8_t)prf_clk_num);    // prf bit<7:0>\r
+    hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+    hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>\r
+               \r
+    hx3695_write_reg(0X3a, data_avg_num<<4 | data_avg_num );\r
+    hx3695_write_reg(0X3b, data_avg_num<<4 | data_avg_num );\r
+               \r
+               \r
+               \r
+               hx3695_write_reg(0X30, (phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+//    hx3695_write_reg(0X72, (|phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+\r
+       hx3695_write_reg(0X31, (led_on_time<<4| 0x00));\r
+\r
+    \r
+         hx3695_write_reg(0X43, phase3_mux_sel);\r
+               hx3695_write_reg(0X44, (0x04<<4 | phase3_tia_res));\r
+               hx3695_write_reg(0X45, phase3_ldr_cur);    //cur\r
+               \r
+               \r
+               hx3695_write_reg(0X43, phase4_mux_sel);\r
+               hx3695_write_reg(0X44, (0x04<<4 | phase4_tia_res));\r
+\r
+    hx3695_write_reg(0X43, phase1_mux_sel);\r
+    hx3695_write_reg(0X44, (0x04<<4 | phase4_tia_res));\r
+    hx3695_write_reg(0X48, phase1_led_idac);\r
+    hx3695_write_reg(0X45, phase1_ldr_cur);\r
+\r
+        \r
+               hx3695_write_reg(0X26,(phase1_enable<<3)|(phase1_adc_osr)|(phase2_enable<<7)|(phase2_adc_osr<<4) ); \r
+    hx3695_write_reg(0X27,(phase3_enable<<3)|(phase3_adc_osr)|(phase4_enable<<7)|(phase4_adc_osr<<4) ); \r
+\r
+#ifdef INT_MODE\r
+               hx3695_write_reg(0X1b, 0x90);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble\r
+                hx3695_write_reg(0X33, 0x83);   // int width                                                                                                                                           \r
+//     hx3695_write_reg(0X21, 0x00);   // fifo int sel,00=FIFO INT config clear\r
+                hx3695_write_reg(0X38, 0x081);   // int sel,00=close almost full int,04=enable almost full int\r
+#else\r
+                hx3695_write_reg(0X1b, 0x90);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+                                        0011=p4;0100=p5;0101=p6;0110=p7;\\r
+                                        bits<7> fifo enble     \r
+     hx3695_write_reg(0X36, 0x00);                                                                                                                                                             \r
+                                                                                                                                               \r
+     hx3695_write_reg(0X38, 0x00);   // int sel,00=close almost full int,01= prf int  04=enable almost full int\r
+#endif\r
+\r
+    hx3695_write_reg(0x5c,0x02); //Chip reset\r
+    hx3695_delay_ms(5);          //Delay for reset time\r
+    hx3695_write_reg(0x5c,0x00); //Chip state machine work normal\r
+    hx3695_delay_ms(5);\r
+\r
+    calReg.LED =  phase1_ldr_cur;\r
+    AGC_LOG(" chip go to low power mode  \r\n" );\r
+}\r
+\r
+void hx3695_hrv_updata_reg(void)\r
+{ \r
+         uint8_t phase1_mux_sel = 0;\r
+         uint8_t phase2_mux_sel = 1;\r
+               uint8_t phase3_mux_sel = 2;\r
+         uint8_t phase4_mux_sel = 3;\r
+    if (calReg.flag & CAL_FLG_LED_DR) \r
+    {\r
+                       //AGC_LOG("CAL_FLG_LED_DR\r\n");\r
+                         hx3695_write_reg(0X43, phase1_mux_sel); \r
+                               hx3695_write_reg(0X45, calReg.LED);\r
+       \r
+//                             hx3695_write_reg(0X43, phase3_mux_sel); \r
+//                             hx3695_write_reg(0X45, calReg.R_LED);\r
+//                       hx3695_write_reg(0X43, phase4_mux_sel); \r
+//                             hx3695_write_reg(0X45, calReg.IR_LED);                  \r
+    }\r
+    \r
+    if (calReg.flag & CAL_FLG_LED_DAC) \r
+    {\r
+                       //AGC_LOG("CAL_FLG_LED_DAC\r\n");\r
+                         hx3695_write_reg(0X43, phase1_mux_sel);\r
+                               hx3695_write_reg(0X48, calReg.LEDDAC);\r
+//                       hx3695_write_reg(0X43, phase3_mux_sel);\r
+//                             hx3695_write_reg(0X48, calReg.R_LEDDAC);\r
+//                       hx3695_write_reg(0X43, phase4_mux_sel);\r
+//                             hx3695_write_reg(0X48, calReg.IR_LEDDAC);\r
+     // AGC_LOG("IR_LEDDAC:%d \r\n",hx3695_read_reg(0X47));\r
+\r
+    }\r
+    \r
+    if (calReg.flag & CAL_FLG_AMB_DAC) \r
+    {\r
+                       //AGC_LOG("CAL_FLG_AMB_DAC\r\n");\r
+                         hx3695_write_reg(0X43, phase2_mux_sel);\r
+        hx3695_write_reg(0X48, calReg.AMBDAC);  // phase2 offset idac cfg\r
+\r
+    }\r
+    \r
+    if (calReg.flag & CAL_FLG_RF) \r
+    {\r
+                       //AGC_LOG("CAL_FLG_RF\r\n");\r
+                               hx3695_write_reg(0X43, phase1_mux_sel);  \r
+                         hx3695_write_reg(0X44, (0x40 | calReg.RF));\r
+                       //AGC_LOG("RF:%x \r\n",hx3695_read_reg(0X44));\r
+//                             hx3695_write_reg(0X44, (hx3695_read_reg(0X44)| 0x07)&(calReg.R_RF|0xff));       \r
+                               hx3695_write_reg(0X43, phase2_mux_sel);  \r
+                         hx3695_write_reg(0X44, (0x40 | calReg.RF));\r
+                       //AGC_LOG("RF:%x \r\n",hx3695_read_reg(0X44));                  \r
+    }\r
+\r
+}\r
+\r
+void hx3695_hrv_set_mode(uint8_t mode_cmd)\r
+{\r
+    switch (mode_cmd)\r
+    {\r
+    case PPG_INIT:\r
+        hx3695_hrv_ppg_init();\r
+#if defined(TIMMER_MODE)\r
+        hx3695_320ms_timer_cfg(true);\r
+#if defined(GSEN_40MS_TIMMER)\r
+        hx3695_40ms_timer_cfg(true);\r
+#endif\r
+#else\r
+        hx3695_gpioint_cfg(true);\r
+#endif\r
+        s_ppg_state = 1;\r
+\r
+        AGC_LOG("ppg init mode\r\n");\r
+        break;\r
+\r
+    case PPG_OFF:\r
+        hx3695_ppg_off();\r
+        s_ppg_state = 0;\r
+        AGC_LOG("ppg off mode\r\n");\r
+        break;\r
+\r
+    case PPG_LED_OFF:\r
+        hx3695_hrv_low_power();\r
+        s_ppg_state = 0;\r
+        AGC_LOG("ppg led off mode\r\n");\r
+        break;\r
+\r
+    case CAL_INIT:\r
+        Init_hrv_PPG_Calibration_Routine(&calReg, 64);\r
+        hx3695_hrv_cal_init();\r
+        hx3695_hrv_updata_reg();\r
+#if defined(TIMMER_MODE)\r
+#if defined(GSEN_40MS_TIMMER)\r
+#else\r
+        hx3695_40ms_timer_cfg(true);\r
+#endif\r
+#endif\r
+        s_cal_state = 1;\r
+        AGC_LOG("cal init mode\r\n");\r
+        break;\r
+\r
+    case RECAL_INIT:\r
+        Restart_hrv_PPG_Calibration_Routine(&calReg);\r
+        hx3695_hrv_cal_init();\r
+        hx3695_hrv_updata_reg();\r
+#if defined(TIMMER_MODE)\r
+#if defined(GSEN_40MS_TIMMER)\r
+#else\r
+        hx3695_40ms_timer_cfg(true);\r
+#endif\r
+#endif\r
+        s_cal_state = 1;\r
+        AGC_LOG("Recal init mode\r\n");\r
+        break;\r
+\r
+    case CAL_OFF:\r
+#if defined(TIMMER_MODE)\r
+#if defined(GSEN_40MS_TIMMER)\r
+#else\r
+        hx3695_40ms_timer_cfg(false);\r
+#endif\r
+#endif\r
+        hx3695_hrv_cal_off();\r
+        s_cal_state = 0;\r
+        AGC_LOG("cal off mode\r\n");\r
+        break;\r
+\r
+    default:\r
+        break;\r
+    }\r
+}\r
+\r
+SENSOR_ERROR_T hx3695_hrv_enable(void)\r
+{\r
+    if (!hx3695_chip_check())\r
+    {\r
+        AGC_LOG("hx3695 check id failed!\r\n");\r
+        return SENSOR_OP_FAILED;\r
+    }\r
+\r
+    AGC_LOG("hx3695 check id success!\r\n");\r
+\r
+    if (s_ppg_state)\r
+    {\r
+        AGC_LOG("ppg already on!\r\n");\r
+        return SENSOR_OP_FAILED;\r
+    }\r
+    if(!tyhx_hrv_alg_open())\r
+    {\r
+        AGC_LOG("hrv alg open fail,or dynamic ram not enough!\r\n");\r
+    }\r
+\r
+    hrv_wear_status = MSG_HRV_NO_WEAR;\r
+    hrv_wear_status_pre = MSG_HRV_NO_WEAR;\r
+\r
+    hx3695_hrv_set_mode(PPG_INIT);\r
+\r
+    AGC_LOG("hx3695 enable!\r\n");\r
+\r
+    return SENSOR_OK;\r
+}\r
+\r
+\r
+void hx3695_hrv_disable(void)\r
+{\r
+    hx3695_320ms_timer_cfg(false);\r
+    hx3695_40ms_timer_cfg(false);\r
+\r
+    hx3695_hrv_set_mode(CAL_OFF);\r
+    hx3695_hrv_set_mode(PPG_OFF);\r
+    tyhx_hrv_alg_close();\r
+\r
+    AGC_LOG("hx3695 disable!\r\n");\r
+}\r
+\r
+void hx3695_hrv_data_reset(void)\r
+{\r
+    s_ppg_state = 0;\r
+    s_cal_state = 0;\r
+    tyhx_hrv_alg_close();\r
+}\r
+\r
+hrv_wear_msg_code_t hx3695_hrv_get_wear_status(void)\r
+{\r
+    return  hrv_wear_status;\r
+}\r
+\r
+hrv_wear_msg_code_t hx3695_hrv_get_wear_status_pre(void)\r
+{\r
+    return  hrv_wear_status_pre;\r
+}\r
+\r
+HRV_CAL_SET_T get_hrv_agc_status(void)\r
+{\r
+    HRV_CAL_SET_T cal;\r
+\r
+    cal.flag =     calReg.flag;\r
+    cal.int_cnt =  calReg.int_cnt;\r
+    cal.LED=       calReg.LED;     // phasex led driver config\r
+    cal.LEDDAC=    calReg.LEDDAC;  // phasex led offset idac cfg\r
+    cal.AMBDAC=    calReg.AMBDAC;  // phasex offset idac cfg\r
+    cal.RF=        calReg.RF;      // phasex tia feed back resister cfg\r
+    cal.led_step=  calReg.led_step;\r
+    cal.state=     calReg.state;\r
+\r
+    return cal;\r
+}\r
+\r
+//void hx3695_hrv_read_fifo_data(uint8_t read_fifo_size,int32_t *buf)\r
+//{\r
+//    uint8_t data_flg = 127;\r
+//    int32_t data;\r
+//    uint8_t databuf[3];\r
+//    uint8_t ii=0;\r
+//    for(ii=0; ii<read_fifo_size; ii++)\r
+//    {\r
+////        hx3695_write_reg(0x17, 0x00); // write any walue to 0x17 will update a new data\r
+////        hx3695_delay_us(100);\r
+//        hx3695_brust_read_reg(0x22, databuf, 3);\r
+//        data_flg = databuf[2]>>5;\r
+//        data = (int32_t)(databuf[0]|(databuf[1]<<8)|((databuf[2]&0x1f)<<16));\r
+\r
+//        if(ii==0)\r
+//        {\r
+//            if(data_flg ==3)\r
+//            {\r
+//                ii=3;\r
+//                buf[0] = 0;\r
+//                buf[1] = 0;\r
+//                buf[2] = 0;\r
+//            }\r
+//            if(data_flg ==2)\r
+//            {\r
+//                ii=2;\r
+//                buf[0] = 0;\r
+//                buf[1] = 0;\r
+//            }\r
+//            if(data_flg ==1)\r
+//            {\r
+//                ii=1;\r
+//                buf[0] = 0;\r
+//            }\r
+//        }\r
+\r
+//        if(data_flg == 0)\r
+//        {\r
+//            buf[ii]= data;\r
+//        }\r
+//        else if(data_flg == 1)\r
+//        {\r
+//            buf[ii]= data;\r
+//        }\r
+//        else if(data_flg == 2)\r
+//        {\r
+//            buf[ii]= data;\r
+//        }\r
+//        else if(data_flg == 3)\r
+//        {\r
+//            buf[ii]= data;\r
+//        }\r
+//    }\r
+//}\r
+\r
+uint8_t hx3695_hrv_read(hrv_sensor_data_t *s_dat)\r
+{\r
+    uint8_t i = 0;\r
+    int32_t PPG_src_data = 0;\r
+    int32_t Ir_src_data = 0;\r
+    bool recal = false;\r
+    uint8_t size = 0;\r
+    uint8_t fifo_out_size = 0;\r
+    int32_t *PPG_buf =  &(s_dat->green_data[0]);\r
+    int32_t *ir_buf =  &(s_dat->ir_data[0]);\r
+    int32_t *s_buf =  &(s_dat->s_buf[0]);\r
+    s_dat->green_cur =  calReg.LED;\r
+    int32_t ps_data[4];\r
+\r
+    if (!s_ppg_state || s_cal_state)\r
+    {\r
+       DEBUG_PRINTF("ppg state = %d, cal_state = %d\r\n",s_ppg_state,s_cal_state);\r
+        return 0;\r
+    }\r
+//    size = hx3695_read_fifo_size();\r
+//       DEBUG_PRINTF("size = %d\r\n",size);\r
+\r
+//    if(size<1)\r
+//    {\r
+//        return 0;\r
+//    }\r
+\r
+    hx3695_hrv_read_data_packet(ps_data);\r
+    Ir_src_data = ps_data[2]-ps_data[3];\r
+         DEBUG_PRINTF("%d %d \r\n" ,ps_data[2],ps_data[3]);\r
+    ir_buf[0] = Ir_src_data;\r
+       //DEBUG_PRINTF("111: %d \r\n" ,ir_buf[0] );\r
+    hx3695_hrv_wear_mode_check(Ir_src_data);\r
+\r
+//    if ((size) && (size <= 64))\r
+//    {\r
+        fifo_out_size = hx3695_read_fifo_data(s_buf,hrv_phase_num,1);\r
+        s_dat->count = fifo_out_size;\r
+        for (i=0; i<fifo_out_size; i++)\r
+        {\r
+            PPG_src_data = s_buf[i];\r
+            if (s_buf[i]<350000 || s_buf[i]>750000)\r
+            {\r
+                recal = true;\r
+\r
+                if(hrv_wear_status==MSG_HRV_NO_WEAR)\r
+                {\r
+                    recal = false;\r
+                }\r
+            }\r
+            PPG_buf[i] = PPG_src_data;\r
+            //AGC_LOG("%d/%d %d %d %d\r\n" ,1+i,size, s_buf[i],calReg.LED,recal);\r
+        }\r
+\r
+        if (recal)\r
+        {\r
+            cal_delay--;\r
+            if (cal_delay <= 0)\r
+            {\r
+                cal_delay = HRV_CAL_DELAY_COUNT;\r
+                hx3695_hrv_set_mode(RECAL_INIT);\r
+            }\r
+        }\r
+        else\r
+        {\r
+            cal_delay = HRV_CAL_DELAY_COUNT;\r
+        }\r
+//    }\r
+    return 1;\r
+}\r
+\r
+#endif\r
diff --git a/code/sdk/drivers/peripheral/ppg/hx3695/hx3695_hrv_agc.h b/code/sdk/drivers/peripheral/ppg/hx3695/hx3695_hrv_agc.h
new file mode 100644 (file)
index 0000000..3804a5b
--- /dev/null
@@ -0,0 +1,84 @@
+#ifndef _hx3695_hrv_agc_H_\r
+#define _hx3695_hrv_agc_H_\r
+//#endif\r
+\r
+#include <stdint.h>\r
+#include <stdbool.h>\r
+#include "hx3695.h"\r
+#define HRV_CAL_DELAY_COUNT 2\r
+\r
+#define CAL_FLG_LED_DR     0x01\r
+#define CAL_FLG_LED_DAC    0x02 \r
+#define CAL_FLG_AMB_DAC    0x04\r
+#define CAL_FLG_RF         0x08\r
+\r
+#define HRV_CAL_INIT_LED 128\r
+#define HRV_OFFSET_IDAC 64\r
+\r
+#define NO_TOUCH_CHECK_NUM 2\r
+\r
+#ifdef HRV_ALG_LIB\r
+typedef enum {       \r
+    hrvCalStart, \r
+         hrvLedCur,\r
+    hrvCalLed,\r
+    hrvCalLed2,\r
+    hrvCalLed3,\r
+    hrvCalFinish, \r
+}HRV_STATE_T;\r
+\r
+typedef struct {\r
+       uint8_t count;\r
+       uint8_t green_cur;\r
+       int32_t green_data[64];\r
+       int32_t ir_data[64];\r
+       int32_t s_buf[64]; \r
+       uint32_t als;\r
+       uint32_t agc_green;\r
+}hrv_sensor_data_t;\r
+\r
+typedef struct {\r
+       uint8_t flag;\r
+       bool work;\r
+       uint8_t int_cnt;\r
+       uint8_t cur255_cnt;\r
+       uint8_t led_idac; \r
+       uint16_t LED;     \r
+       uint8_t LEDDAC;  \r
+       uint8_t AMBDAC;  \r
+       uint8_t RF;     \r
+       uint32_t led_step;\r
+       uint8_t state;\r
+       uint8_t led_max_cur;\r
+} HRV_CAL_SET_T;\r
+\r
+typedef enum {\r
+       MSG_HRV_NO_WEAR,\r
+       MSG_HRV_WEAR\r
+} hrv_wear_msg_code_t;\r
+\r
+void Init_hrv_PPG_Calibration_Routine(HRV_CAL_SET_T *calR,uint8_t led);\r
+void Restart_hrv_PPG_Calibration_Routine(HRV_CAL_SET_T *calR);\r
+void PPG_hrv_Calibration_Routine(HRV_CAL_SET_T *calR, int32_t led, int32_t amb);\r
+\r
+void hx3695_hrv_cal_init(void);\r
+void hx3695_hrv_cal_off(void);\r
+uint8_t hx3695_read_fifo_size(void);\r
+void read_hrv_data_packet(int32_t *buf);\r
+void read_hrv_ir_packet(int32_t *buf);\r
+void hx3695_hrv_read_data_packet(int32_t *buf);\r
+\r
+void hx3695_hrv_low_power(void);\r
+void hx3695_hrv_updata_reg(void);\r
+void hx3695_hrv_set_mode(uint8_t mode_cmd);\r
+SENSOR_ERROR_T hx3695_hrv_enable(void);\r
+void hx3695_hrv_disable(void);\r
+hrv_wear_msg_code_t hx3695_hrv_get_wear_status(void);\r
+uint8_t hx3695_hrv_read(hrv_sensor_data_t * s_dat);\r
+bool hx3695_hrv_init(void);\r
+HRV_CAL_SET_T PPG_hrv_agc(void);\r
+hrv_wear_msg_code_t hx3695_hrv_wear_mode_check(int32_t infrared_data);\r
+HRV_CAL_SET_T get_hrv_agc_status(void);\r
+void hx3695_hrv_data_reset(void);\r
+#endif\r
+#endif\r
diff --git a/code/sdk/drivers/peripheral/ppg/hx3695/hx3695_spo2_agc.c b/code/sdk/drivers/peripheral/ppg/hx3695/hx3695_spo2_agc.c
new file mode 100644 (file)
index 0000000..70776a5
--- /dev/null
@@ -0,0 +1,1126 @@
+#include <stdio.h>\r
+#include <stdbool.h>\r
+#include <stdint.h>\r
+#include <stdlib.h>\r
+#include <math.h>\r
+\r
+#include "hx3695.h"\r
+#include "hx3695_spo2_agc.h"\r
+#include "tyhx_spo2_alg.h"\r
+#include "tyhx_hrs_alg.h"\r
+\r
+\r
+#include "tyhx_hrs_custom.h"\r
+\r
+\r
+\r
+#ifdef SPO2_ALG_LIB\r
+\r
+extern const uint8_t  hx3695_spo2_agc_red_idac;  // 6,7,8...\r
+extern const uint8_t  hx3695_spo2_agc_ir_idac;  // 6,7,8...\r
+extern const uint8_t  hx3695_spo2_agc_green_idac;  // 6,7,8...\r
+extern const uint8_t  green_led_max_init;\r
+extern const uint8_t  red_led_max_init;\r
+extern const uint8_t  ir_led_max_init;\r
+extern uint8_t low_vbat_flag;\r
+extern uint8_t spo2_phase_num;\r
+\r
+//SPO2_INFRARED_THRES\r
+extern const int32_t  spo2_ir_unwear_thres;\r
+extern const int32_t  spo2_ir_wear_thres;\r
+extern const uint8_t  spo2_ir_wear_offset;\r
+extern uint8_t  read_fifo_first_flg;\r
+\r
+static uint8_t s_ppg_state = 0;\r
+static uint8_t s_cal_state = 0;\r
+static int32_t agc_buf[8] = {0};\r
+\r
+static uint8_t cal_delay = SPO2_CAL_DELAY_COUNT;\r
+static SPO2_CAL_SET_T  calReg_SPO2;\r
+\r
+static spo2_wear_msg_code_t spo2_wear_status = MSG_SPO2_NO_WEAR;\r
+static spo2_wear_msg_code_t spo2_wear_status_pre = MSG_SPO2_NO_WEAR;\r
+\r
+void Init_Spo2_PPG_Calibration_Routine(SPO2_CAL_SET_T *calR,uint8_t led)\r
+{\r
+    calR->flag = CAL_FLG_LED_DR|CAL_FLG_LED_DAC|CAL_FLG_AMB_DAC|CAL_FLG_RF;\r
+    calR->G_LEDDAC = 0;   /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+    calR->R_LEDDAC = 0;   /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+    calR->IR_LEDDAC1 = 0;   /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+    calR->AMBDAC = 0;   /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+         calR->RED_AMBDAC = 0;   /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+         calR->IR_AMBDAC1 = 0;   /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+       \r
+    calR->G_RF = 0;       /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+    calR->R_RF = 0;       /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+    calR->IR_RF1 = 0;       /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+    calR->G_LED = SPO2_CAL_INIT_LED_GREEN;\r
+    calR->R_LED = SPO2_CAL_INIT_LED_RED;\r
+    calR->IR_LED1 = SPO2_CAL_INIT_LED_IR;\r
+    calR->state = sCalStart;\r
+    calR->int_cnt = 0;\r
+    calR->cur255_cnt =0;\r
+    if(low_vbat_flag == 1)\r
+    {\r
+        calR->green_idac = (hx3695_spo2_agc_green_idac)>>1;\r
+        calR->red_idac = (hx3695_spo2_agc_red_idac*3)>>2;\r
+        calR->ir_idac1 = (hx3695_spo2_agc_ir_idac*3)>>2;\r
+        calR->green_max_cur = (green_led_max_init)>>1;\r
+        calR->red_max_cur = (red_led_max_init*3)>>2;\r
+        calR->ir_max_cur = (ir_led_max_init*3)>>2;\r
+    }\r
+    else\r
+    {\r
+        calR->green_idac = hx3695_spo2_agc_green_idac;\r
+        calR->red_idac = hx3695_spo2_agc_red_idac;\r
+        calR->ir_idac1 = hx3695_spo2_agc_ir_idac;\r
+        calR->green_max_cur = green_led_max_init;\r
+        calR->red_max_cur = red_led_max_init;\r
+        calR->ir_max_cur = ir_led_max_init;\r
+    }\r
+               \r
+}\r
+\r
+void Restart_Spo2_PPG_Calibration_Routine(SPO2_CAL_SET_T *calR)\r
+{\r
+    calR->flag = CAL_FLG_LED_DAC;\r
+    calR->state = sCalLed;\r
+    calR->int_cnt = 0;\r
+}\r
+\r
+bool hx3695_spo2_check_unwear(int32_t infrared_data)\r
+{\r
+    if( infrared_data < spo2_ir_unwear_thres)\r
+    {\r
+        spo2_wear_status = MSG_SPO2_NO_WEAR;\r
+        if(spo2_wear_status_pre != MSG_SPO2_NO_WEAR)\r
+        {\r
+            spo2_wear_status_pre = MSG_SPO2_NO_WEAR;\r
+            hx3695_spo2_low_power();\r
+            return true;\r
+        }\r
+    }\r
+    return false;\r
+}\r
+\r
+bool hx3695_spo2_check_wear(int32_t infrared_data)\r
+{\r
+    if(infrared_data > spo2_ir_wear_thres)\r
+    {\r
+        spo2_wear_status = MSG_SPO2_WEAR;\r
+        if(spo2_wear_status_pre != MSG_SPO2_WEAR)\r
+        {\r
+            spo2_wear_status_pre = MSG_SPO2_WEAR;\r
+            tyhx_spo2_alg_open_deep();\r
+            hx3695_spo2_set_mode(PPG_INIT);\r
+            hx3695_spo2_set_mode(CAL_INIT);\r
+//                                             DEBUG_PRINTF("check_wear\r\n");\r
+            return true;\r
+        }\r
+    }\r
+    return false;\r
+}\r
+\r
+\r
+//void PPG_Spo2_Calibration_Routine(SPO2_CAL_SET_T *calR, int32_t g_led, int32_t r_led, int32_t amb, int32_t ir_led)\r
+void PPG_Spo2_Calibration_Routine(SPO2_CAL_SET_T *calRS, int32_t g_led, int32_t r_led, int32_t ir_led1, int32_t g_amb, int32_t red_amb, int32_t ir_amb1)\r
+\r
+{\r
+   int32_t g_led_temp = 0, r_led_temp = 0, ir_led_temp1 = 0,ir_led_temp2 = 0;\r
+\r
+    switch(calRS->state)\r
+    {\r
+                               case sCalStart: \r
+                                         calRS->state = sCalStart1;\r
+                                               break;\r
+                               \r
+        case sCalStart1:  \r
+            if(spo2_wear_status == MSG_SPO2_NO_WEAR)\r
+            {\r
+                calRS->state = sCalFinish;\r
+                break;\r
+            } \r
+                                               \r
+                                               if(g_amb>525000)\r
+                                               {\r
+                                                       calRS->GREEN_AMBDAC = (g_amb - 525000)/1100;\r
+                                               }\r
+                                               else\r
+                                               {\r
+                                                       calRS->GREEN_AMBDAC = 0;\r
+                                               }\r
+\r
+\r
+                                               \r
+            if(red_amb>525000)\r
+                                               {\r
+                                                       calRS->RED_AMBDAC = (red_amb - 525000)/1100;\r
+                                               }\r
+                                               else\r
+                                               {\r
+                                                       calRS->RED_AMBDAC = 0;\r
+                                               }\r
+                                               \r
+                                               if(ir_amb1>525000)\r
+                                               {\r
+                                                       calRS->IR_AMBDAC1 = (ir_amb1 - 525000)/1300;\r
+                                               }\r
+                                               else\r
+                                               {\r
+                                                       calRS->IR_AMBDAC1 = 0;\r
+                                               }\r
+                                                                                               \r
+                                               \r
+                                                                                               \r
+            if(r_led> (red_amb+256))\r
+            {\r
+                calRS->R_led_step = (r_led - red_amb)/SPO2_CAL_INIT_LED_RED*3/4; //64\r
+                                                               r_led_temp = 1100*(hx3695_spo2_agc_red_idac+calRS->RED_AMBDAC)/calRS->R_led_step;\r
+                                                               \r
+                                                         if(r_led_temp>calRS->red_max_cur)\r
+                                                               {\r
+                                                                       r_led_temp = calRS->red_max_cur;\r
+                                                               }\r
+                                                               calRS->R_LED = r_led_temp;\r
+                                                               if(calRS->R_LED != calRS->red_max_cur)\r
+                                                               {\r
+                                                                       calRS->R_LEDDAC = (hx3695_spo2_agc_red_idac*3)>>2;\r
+                                                               }\r
+                                                               else\r
+                                                               {\r
+                                                                       calRS->R_LEDDAC = hx3695_spo2_agc_red_idac>>1;\r
+                                                               }\r
+            } \r
+            if(ir_led1>(ir_amb1+256))\r
+            {\r
+                calRS->IR_led_step1 = (ir_led1 - ir_amb1)/SPO2_CAL_INIT_LED_IR;     //32\r
+                                                               ir_led_temp1 = 1300*(hx3695_spo2_agc_ir_idac + calRS->IR_AMBDAC1)/calRS->IR_led_step1;\r
+                                                               \r
+                                                         if(ir_led_temp1>calRS->ir_max_cur)\r
+                                                               {\r
+                                                                       ir_led_temp1 = calRS->ir_max_cur;\r
+                                                               }\r
+                                                               calRS->IR_LED1 = ir_led_temp1;\r
+                                                               if(calRS->IR_LED1 != calRS->ir_max_cur)\r
+                                                               {\r
+                                                                       calRS->IR_LEDDAC1 = (hx3695_spo2_agc_ir_idac*3)>>2;\r
+                                                               }\r
+                                                               else\r
+                                                               {\r
+                                                                       calRS->IR_LEDDAC1 = hx3695_spo2_agc_ir_idac>>1;\r
+                                                               }\r
+                                                               TYHX_LOG("calRS->R_IR_LED1: %d  %d\r\n",calRS->R_LED,calRS->IR_LED1);\r
+\r
+            }  \r
+            if(g_led >g_amb + 256)\r
+            {\r
+                calRS->G_led_step = (g_led-g_amb)/(SPO2_CAL_INIT_LED_GREEN); \r
+                                                               g_led_temp = 1300*(hx3695_spo2_agc_green_idac+calRS->GREEN_AMBDAC)/calRS->G_led_step;\r
+                                                               if(g_led_temp>calRS->green_max_cur)            \r
+                                                               {\r
+                                                                       g_led_temp = calRS->green_max_cur;\r
+                                                               }\r
+                                                               calRS->G_LED = g_led_temp;\r
+                                                               if(calRS->G_LED != calRS->green_max_cur)\r
+                                                               {\r
+                                                                       calRS->G_LEDDAC = (hx3695_spo2_agc_green_idac*3)>>2;\r
+                                                               }\r
+                                                               else\r
+                                                               {\r
+                                                                       calRS->G_LEDDAC = hx3695_spo2_agc_green_idac>>1;\r
+                                                               }\r
+            }          \r
+                                               calRS->G_RF = 6;\r
+                                               calRS->R_RF = 6;\r
+                                               calRS->IR_RF1 = 6;\r
+                                               calRS->flag = CAL_FLG_LED_DR|CAL_FLG_LED_DAC|CAL_FLG_AMB_DAC|CAL_FLG_RF;                                                \r
+            calRS->state = sCalLed;\r
+            break;\r
+                                               \r
+        case sCalLed:   \r
+            if(r_led>900000 && calRS->R_LEDDAC < 120)   //110\r
+            {\r
+               calRS->R_LEDDAC = calRS->R_LEDDAC+6;                                \r
+            }\r
+\r
+            if(ir_led1>900000 && calRS->IR_LEDDAC1 < 120)  //110\r
+            {\r
+               calRS->IR_LEDDAC1 = calRS->IR_LEDDAC1+6;                                \r
+            }\r
+                                               \r
+                                               if(g_led>900000 && calRS->G_LEDDAC < 110)     //110\r
+            {\r
+               calRS->G_LEDDAC = calRS->G_LEDDAC+6;                                \r
+            }\r
+\r
+            if(ir_led1 <= 900000 && r_led <= 900000 && g_led<=900000)\r
+            {\r
+              calRS->state = sCalLed2;\r
+            }\r
+            else if(calRS->R_LEDDAC>=120 || calRS->IR_LEDDAC1 >= 120 || calRS->G_LEDDAC >= 120)\r
+            {\r
+              calRS->state = sCalLed3;                \r
+            }    \r
+            else\r
+            {\r
+              calRS->state = sCalLed;\r
+            }  \r
+            calRS->flag = CAL_FLG_LED_DAC;\r
+            break;\r
+                                               \r
+        case sCalLed2:   \r
+            if(r_led > 650000 && calRS->R_LEDDAC < 120)\r
+            {\r
+               calRS->R_LEDDAC = calRS->R_LEDDAC+3;                                \r
+            }\r
+            else if(r_led <400000 && calRS->R_LEDDAC >= 3)\r
+            {\r
+               calRS->R_LEDDAC = calRS->R_LEDDAC-3;                                \r
+            }\r
+                                               else if(r_led<400000 && calRS->R_LEDDAC > 0)\r
+            {\r
+               calRS->R_LEDDAC = calRS->R_LEDDAC-1;                                \r
+            }\r
+                                               \r
+            if(ir_led1>650000 && calRS->IR_LEDDAC1 < 120)\r
+            {\r
+               calRS->IR_LEDDAC1 = calRS->IR_LEDDAC1+3;                                \r
+            }\r
+            else if(ir_led1<400000 && calRS->IR_LEDDAC1 >= 3)\r
+            {\r
+               calRS->IR_LEDDAC1 = calRS->IR_LEDDAC1-3;                                \r
+            }\r
+                                               else if(ir_led1 <400000 && calRS->IR_LEDDAC1 > 0)\r
+            {\r
+               calRS->IR_LEDDAC1 = calRS->IR_LEDDAC1 -1;                                \r
+            }\r
+                                               \r
+                                               if(g_led>650000 && calRS->G_LEDDAC < 120)\r
+            {\r
+               calRS->G_LEDDAC = calRS->G_LEDDAC+3;                                \r
+            }\r
+            else if(g_led<400000 && calRS->G_LEDDAC >= 3)\r
+            {\r
+               calRS->G_LEDDAC = calRS->G_LEDDAC-3;                                \r
+            }\r
+                                               else if(g_led<400000 && calRS->G_LEDDAC > 0)\r
+            {\r
+               calRS->G_LEDDAC = calRS->G_LEDDAC-1;                                \r
+            }\r
+                                               \r
+            if(ir_led1 <650000 && ir_led1 > 400000 && r_led<650000 && r_led>400000 && g_led<650000 && g_led>400000)\r
+//                                       if(ir_led1 <750000 && ir_led1 > 500000 && r_led<750000 && r_led>500000 )      \r
+            {\r
+              calRS->state = sCalFinish;\r
+            }\r
+//            else if(calR->R_LEDDAC >= 120 || calR->IR_LEDDAC1 >= 120 || calR->G_LEDDAC >= 120)\r
+                                               else if(calRS->R_LEDDAC >= 120 || calRS->IR_LEDDAC1 >= 120 )\r
+            {\r
+              calRS->state = sCalLed3;\r
+            }\r
+            else\r
+            {\r
+              calRS->state = sCalLed2;               \r
+            }               \r
+            calRS->flag = CAL_FLG_LED_DAC;\r
+            break;\r
+                                               \r
+        case sCalLed3:   \r
+            if(calRS->R_LEDDAC>=120)\r
+            {\r
+              calRS->R_LED = (calRS->R_LED*3)>>2;\r
+            }\r
+            if(calRS->IR_LEDDAC1>=120)\r
+            {\r
+              calRS->IR_LED1 = (calRS->IR_LED1*3)>>2;\r
+            }\r
+//                                             if(calR->G_LEDDAC>=120)\r
+//            {\r
+//              calR->G_LED = (calR->G_LED*3)>>2;\r
+//            }\r
+            calRS->flag = CAL_FLG_LED_DR;\r
+            calRS->state = sCalLed; \r
+            break;    \r
+                                               \r
+        case sCalRfEnd:\r
+            calRS->state = sCalFinish;\r
+            break;\r
+                               \r
+        default: \r
+            break;\r
+        \r
+    }\r
+//    AGC_LOG("AGC: R_cur=%d,G_cur=%d,Ir_cur=%d,ambDac=%d,R_Dac=%d,G_Dac=%d,Ir_Dac=%d,R_step=%d,G_step=%d,Ir_step=%d,state=%d\r\n",\\r
+//            calR->R_LED,calR->G_LED,calR->IR_LED,calR->AMBDAC,calR->R_LEDDAC,calR->G_LEDDAC,calR->IR_LEDDAC,\\r
+//            calR->R_led_step,calR->G_led_step,calR->IR_led_step,calR->state); \r
+               \r
+               TYHX_LOG("AGC:R_cur=%d, Ir_cur=%d,R_ambDac=%d, IR_ambDac=%d, R_Dac=%d,Ir_Dac=%d,R_step=%d,Ir_step=%d,state=%d \r\n",\\r
+            calRS->R_LED,calRS->IR_LED1,calRS->RED_AMBDAC, calRS->IR_AMBDAC1, calRS->R_LEDDAC,calRS->IR_LEDDAC1,\\r
+            calRS->R_led_step,calRS->IR_led_step1,calRS->state);\r
+}\r
+\r
+SPO2_CAL_SET_T PPG_spo2_agc(void)\r
+{\r
+    int32_t green_amb_val, green_led_val, red_led_val, red_amb_val;\r
+    int32_t ir_led_val1, ir_amb_val1, ir_led_val2,  ir_amb_val2;\r
+\r
+    calReg_SPO2.work = false;\r
+\r
+    if (!s_cal_state)\r
+    {\r
+        return calReg_SPO2;\r
+    }\r
+\r
+#ifdef INT_MODE\r
+    calReg_SPO2.int_cnt ++;\r
+    if(calReg_SPO2.int_cnt < 8)\r
+    {\r
+        return calReg_SPO2;\r
+    }\r
+    calReg_SPO2.int_cnt = 0;\r
+    hx3695_gpioint_cfg(false);\r
+#endif\r
+    calReg_SPO2.work = true;\r
+               \r
+               hx3695_spo2_read_data(agc_buf);\r
+               \r
+    green_amb_val = (agc_buf[0]);    // + agc_buf[2])>>1;\r
+               green_led_val = agc_buf[1];\r
+               red_amb_val = (agc_buf[2]);    // + agc_buf[2])>>1;\r
+    red_led_val =  agc_buf[3];\r
+               ir_amb_val1 = (agc_buf[4]);    // + agc_buf[5])>>1;\r
+    ir_led_val1 = agc_buf[5];\r
+               \r
+//             ir_amb_val2 = agc_buf[6];\r
+//    ir_led_val2 = agc_buf[7];\r
+    TYHX_LOG("cal_ch= %d,%d, %d,%d,  %d,%d \r\n", green_amb_val,green_led_val, red_amb_val, red_led_val, ir_amb_val1, ir_led_val1);\r
+               \r
+    PPG_Spo2_Calibration_Routine(&calReg_SPO2, green_led_val,red_led_val, ir_led_val1, green_amb_val, red_amb_val, ir_amb_val1 );\r
+\r
+    if (calReg_SPO2.state == sCalFinish)\r
+    {\r
+        hx3695_spo2_set_mode(CAL_OFF);\r
+        if(spo2_wear_status == MSG_SPO2_NO_WEAR)\r
+        {\r
+            hx3695_spo2_low_power();\r
+                                       \r
+        }\r
+        #if defined(TIMMER_MODE)\r
+\r
+                               #else\r
+        hx3695_gpioint_cfg(true);\r
+        #endif\r
+    }\r
+    else\r
+    {\r
+        hx3695_spo2_updata_reg();\r
+#if defined(INT_MODE)\r
+        hx3695_gpioint_cfg(true);\r
+#endif\r
+    }\r
+//             TYHX_LOG("calReg_spo2.R_LED  %d, ir_led  %d \r\n",calReg_SPO2.R_LED,calReg_SPO2.IR_LED1);\r
+    return   calReg_SPO2;\r
+}\r
+\r
+\r
+void hx3695_spo2_cal_init(void)\r
+{\r
+   uint16_t sample_rate = 200;                      /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+    uint32_t prf_clk_num = 32000/sample_rate;        /*period in clk num, num = Fclk/fs */\r
+    uint8_t data_avg_num = 0;         /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+       \r
+    hx3695_write_reg(0X2a, (uint8_t)prf_clk_num);    // prf bit<7:0>\r
+    hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+    hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>\r
+       \r
+               hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+    hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );        \r
+       \r
+       \r
+    hx3695_write_reg(0x1b,0x91); //FIFO bypass mode enable  old 0x10\r
+    hx3695_write_reg(0x36,0x08); // phase4 convertion ready enable\r
+       \r
+               #if defined(INT_MODE)\r
+//       hx3695_write_reg(0x36,0x88); //phase8 phase4 convertion ready enable\r
+               hx3695_write_reg(0x38,0x01);\r
+               #endif\r
+    hx3695_write_reg(0x1b,0x91);\r
+                hx3695_delay_ms(5);\r
+    hx3695_write_reg(0x5c,0x02); //Chip reset\r
+    hx3695_delay_ms(5);             //Delay for reset time\r
+    hx3695_write_reg(0x5c,0x00); //Chip state machine work normal\r
+         hx3695_delay_ms(10);             //Delay for reset time\r
+               \r
+               \r
+}\r
+\r
+\r
+\r
+void hx3695_spo2_cal_off(void)\r
+{\r
+    uint16_t sample_rate = 25;                       /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+         uint8_t data_avg_num = 0;         /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+    uint32_t prf_clk_num = 32000/sample_rate;        /*period in clk num, num = Fclk/fs */\r
+    hx3695_write_reg(0X2a, (uint8_t)prf_clk_num);    // prf bit<7:0>\r
+    hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+    hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>\r
+//    AGC_LOG("prf_clk_num =%d %d %d\r\n", hx3695_read_reg(0X2a), hx3695_read_reg(0X2b), hx3695_read_reg(0X2c));\r
+    hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+    hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+               hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );                \r
+  \r
+         hx3695_write_reg(0x1b,0x91); //FIFO mode enable\r
+    hx3695_write_reg(0x36,0x00); //phase3 convertion ready disable     \r
+       \r
+               #if defined(INT_MODE)\r
+         hx3695_write_reg(0X33, 0x83);   // int width  \r
+    hx3695_write_reg(0x38,0x04); \r
+               #endif\r
+  \r
+    hx3695_write_reg(0x5c,0x02); //Chip reset\r
+    hx3695_delay_ms(5);             //Delay for reset time\r
+    hx3695_write_reg(0x1b, 0x91);\r
+    hx3695_write_reg(0x5c,0x00); //Chip state machine work normal\r
+               hx3695_delay_ms(5);\r
+//             hx3695_brust_read_reg(0x22, fifo_data_buf, 3);\r
+    read_fifo_first_flg = 1;\r
+//             AGC_LOG("herehere %d,%d,%d \r\n",hx3695_read_reg(0X2a),hx3695_read_reg(0X2b),hx3695_read_reg(0X2c));\r
+}\r
+\r
+void hx3695_spo2_read_data(int32_t *s_buf)\r
+{\r
+    uint8_t  databuf1[6] = {0};\r
+               uint8_t  databuf2[6] = {0};\r
+    uint8_t  databuf3[6] = {0};\r
+               uint8_t  databuf4[6] = {0};\r
+               \r
+    hx3695_brust_read_reg(0x03, databuf1, 6);\r
+               \r
+    hx3695_brust_read_reg(0x09, databuf2, 6); \r
+    hx3695_delay_ms(5);                \r
+    hx3695_brust_read_reg(0x0f, databuf3, 6); \r
+    hx3695_brust_read_reg(0x15, databuf4, 6);\r
+               hx3695_delay_ms(5);\r
+               \r
+    s_buf[0] = ((databuf1[0])|(databuf1[1]<<8)|(databuf1[2]<<16)); \r
+               s_buf[1] = ((databuf1[3])|(databuf1[4]<<8)|(databuf1[5]<<16)); \r
+               s_buf[2] = ((databuf2[0])|(databuf2[1]<<8)|(databuf2[2]<<16));  \r
+    s_buf[3] = ((databuf2[3])|(databuf2[4]<<8)|(databuf2[5]<<16));\r
+    s_buf[4] = ((databuf3[0])|(databuf3[1]<<8)|(databuf3[2]<<16)); \r
+               s_buf[5] = ((databuf3[3])|(databuf3[4]<<8)|(databuf3[5]<<16)); \r
+               s_buf[6] = ((databuf4[0])|(databuf4[1]<<8)|(databuf4[2]<<16));  \r
+    s_buf[7] = ((databuf4[3])|(databuf4[4]<<8)|(databuf4[5]<<16));\r
+               hx3695_delay_ms(5);\r
+               \r
+//             return 1;\r
+}\r
+\r
+\r
+\r
+\r
+void hx3695_spo2_low_power(void)\r
+{\r
+    uint16_t sample_rate = 25;                  /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+    uint8_t data_avg_num = 0;                                    /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+    uint32_t prf_clk_num = 32000/sample_rate;         /*period in clk num, num = Fclk/fs */\r
+\r
+    uint8_t phase1_led_en = 1;\r
+    uint8_t phase2_led_en = 1;\r
+    uint8_t phase3_led_en = 1;\r
+    uint8_t phase4_led_en = 1;\r
+         uint8_t phase5_led_en = 1;\r
+    uint8_t phase6_led_en = 1;\r
+    uint8_t phase7_led_en = 1;\r
+    uint8_t phase8_led_en = 1;\r
+\r
+    uint8_t phase1_offset_idac = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+    uint8_t phase2_offset_idac = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+    uint8_t phase3_offset_idac = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+    uint8_t phase4_offset_idac = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+         uint8_t phase5_offset_idac = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+    uint8_t phase6_offset_idac = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+    uint8_t phase7_offset_idac = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+    uint8_t phase8_offset_idac = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+\r
+    uint8_t phase1_ldr_cur = 0;\r
+    uint8_t phase2_ldr_cur = 0;\r
+    uint8_t phase3_ldr_cur = 0;\r
+    uint8_t phase4_ldr_cur = 0;\r
+               uint8_t phase5_ldr_cur = 0;\r
+         uint8_t phase6_ldr_cur = 0;\r
+    uint8_t phase7_ldr_cur = 0;\r
+    uint8_t phase8_ldr_cur = 32;\r
+\r
+\r
+    uint8_t phase1_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+    uint8_t phase2_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+    uint8_t phase3_tia_res = 0;\r
+    uint8_t phase4_tia_res = 0;\r
+               uint8_t phase5_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+    uint8_t phase6_tia_res = 0;     /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+    uint8_t phase7_tia_res = 0;\r
+    uint8_t phase8_tia_res = 0;\r
+               \r
+               uint8_t phase1_mux_sel = 0; \r
+               uint8_t phase2_mux_sel = 1;\r
+               uint8_t phase3_mux_sel = 2;    /* sel phase3*/\r
+               uint8_t phase4_mux_sel = 3;    /* sel phase4*/\r
+               uint8_t phase5_mux_sel = 4; \r
+               uint8_t phase6_mux_sel = 5;\r
+               uint8_t phase7_mux_sel = 6;    /* sel phase7*/\r
+               uint8_t phase8_mux_sel = 7;    /* sel phase8*/\r
+\r
+    uint8_t led_on_time = 2;        /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+                                       4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+//     hx3695_write_reg(0X6a, 0X0f);   //rest int\r
+    hx3695_delay_ms(10);\r
+    hx3695_write_reg(0X2a, (uint8_t)prf_clk_num);    // prf bit<7:0>\r
+    hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+    hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>\r
+//    hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+//    hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );         \r
+               \r
+               hx3695_write_reg(0X43, phase1_mux_sel);  \r
+               hx3695_write_reg(0X44, (0x40 | phase1_tia_res));\r
+    hx3695_write_reg(0X45, phase1_ldr_cur);\r
+//             hx3695_write_reg(0X70, phase1_ldr2_cur);\r
+               hx3695_write_reg(0X48, phase1_offset_idac);\r
+               \r
+               hx3695_write_reg(0X43, phase2_mux_sel);  \r
+               hx3695_write_reg(0X44, (0x40 | phase2_tia_res));\r
+    hx3695_write_reg(0X45, phase2_ldr_cur);\r
+               hx3695_write_reg(0X48, phase2_offset_idac);\r
+               \r
+               hx3695_write_reg(0X43, phase3_mux_sel);  \r
+               hx3695_write_reg(0X44, (0x40 | phase3_tia_res));\r
+               hx3695_write_reg(0X45, phase3_ldr_cur);\r
+               hx3695_write_reg(0X48, phase3_offset_idac);\r
+               \r
+               hx3695_write_reg(0X43, phase4_mux_sel);  \r
+               hx3695_write_reg(0X44, (0x40 | phase4_tia_res));\r
+    hx3695_write_reg(0X45, phase4_ldr_cur);\r
+               hx3695_write_reg(0X48, phase4_offset_idac);\r
+               \r
+    hx3695_write_reg(0X43, phase5_mux_sel);  \r
+               hx3695_write_reg(0X44, (0x40 | phase4_tia_res));\r
+    hx3695_write_reg(0X45, phase5_ldr_cur);\r
+               hx3695_write_reg(0X48, phase5_offset_idac);\r
+               \r
+                               hx3695_write_reg(0X43, phase6_mux_sel);  \r
+               hx3695_write_reg(0X44, (0x40 | phase6_tia_res));\r
+    hx3695_write_reg(0X45, phase6_ldr_cur);\r
+               hx3695_write_reg(0X48, phase6_offset_idac);\r
+               \r
+               hx3695_write_reg(0X43, phase7_mux_sel);  \r
+               hx3695_write_reg(0X44, (0x40 | phase7_tia_res));\r
+    hx3695_write_reg(0X45, phase7_ldr_cur);\r
+               hx3695_write_reg(0X48, phase7_offset_idac);\r
+               \r
+               hx3695_write_reg(0X43, phase8_mux_sel);  \r
+               hx3695_write_reg(0X44, (0x40 | phase8_tia_res));\r
+    hx3695_write_reg(0X45, phase8_ldr_cur);\r
+               hx3695_write_reg(0X48, phase8_offset_idac);\r
+\r
+\r
+\r
+    hx3695_write_reg(0X30,  phase8_led_en<<7 | phase7_led_en<<6 | phase6_led_en<<5 | phase5_led_en<<4 | phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en);\r
+    hx3695_write_reg(0X72,  phase8_led_en<<7 | phase7_led_en<<6 | phase6_led_en<<5 | phase5_led_en<<4 | phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en);\r
+               hx3695_write_reg(0X31, led_on_time<<4 | (0x0f&hx3695_read_reg(0X31)));\r
+\r
+    hx3695_write_reg(0X6a, 0X0f);\r
+\r
+               \r
+               #ifdef INT_MODE\r
+               hx3695_write_reg(0X1c,0x14);   // fifo almostfull cfg ,max=0x40;\r
+    hx3695_write_reg(0x1b,0x91); //FIFO bypass mode enable\r
+    hx3695_write_reg(0x36,0x00); //phase3 convertion ready disable\r
+\r
+               #else\r
+    hx3695_write_reg(0x1b,0x91); //FIFO bypass mode enable\r
+    hx3695_write_reg(0x36,0x00); //phase3 convertion ready disable\r
+\r
+               #endif\r
+               \r
+    hx3695_write_reg(0x5c,0x02); //Chip reset\r
+    hx3695_delay_ms(5);             //Delay for reset time\r
+//    hx3695_write_reg(0x1b, 0x10);\r
+//    hx3695_delay_ms(5);\r
+//    hx3695_write_reg(0x1b, 0x90);\r
+    hx3695_write_reg(0x5c,0x00); //Chip state machine work normal\r
+\r
+               hx3695_delay_ms(5);\r
+   \r
+               calReg_SPO2.G_LED = phase2_ldr_cur;\r
+               calReg_SPO2.G_LEDDAC = phase2_offset_idac;\r
+    calReg_SPO2.R_LED =  phase4_ldr_cur;\r
+               calReg_SPO2.R_LEDDAC = phase4_offset_idac;\r
+               \r
+    calReg_SPO2.IR_LED1 =  phase6_ldr_cur;\r
+               calReg_SPO2.IR_LEDDAC1 = phase6_offset_idac;    \r
+//    hx3695_brust_read_reg(0x22, fifo_data_buf, 3);\r
+    read_fifo_first_flg = 1;\r
+    AGC_LOG(" chip1 go to low power mode  \r\n" );  \r
+}\r
+\r
+\r
+\r
+void hx3695_spo2_updata_reg(void)\r
+{\r
+    uint8_t phase1_mux_sel = 0;\r
+         uint8_t phase2_mux_sel = 1;\r
+               uint8_t phase3_mux_sel = 2;\r
+         uint8_t phase4_mux_sel = 3;\r
+         uint8_t phase5_mux_sel = 4;\r
+         uint8_t phase6_mux_sel = 5;\r
+               uint8_t phase7_mux_sel = 6;\r
+         uint8_t phase8_mux_sel = 7;\r
+    if (calReg_SPO2.flag & CAL_FLG_LED_DR) \r
+    {\r
+                       //AGC_LOG("CAL_FLG_LED_DR\r\n");\r
+                         hx3695_write_reg(0X43, phase2_mux_sel); \r
+                               hx3695_write_reg(0X45, calReg_SPO2.G_LED);\r
+//                       TYHX_LOG("R_LED:%d \r\n",hx3695_read_reg(0X45));\r
+                       \r
+                               hx3695_write_reg(0X43, phase4_mux_sel); \r
+                               hx3695_write_reg(0X45, calReg_SPO2.R_LED);\r
+//                      TYHX_LOG("IR_LED:%d \r\n",hx3695_read_reg(0X45));\r
+                       \r
+                         hx3695_write_reg(0X43, phase6_mux_sel); \r
+                               hx3695_write_reg(0X45, calReg_SPO2.IR_LED1);    \r
+    }\r
+    \r
+    if (calReg_SPO2.flag & CAL_FLG_LED_DAC) \r
+    {\r
+                       //AGC_LOG("CAL_FLG_LED_DAC\r\n");\r
+                         hx3695_write_reg(0X43, phase2_mux_sel);\r
+                               hx3695_write_reg(0X48, calReg_SPO2.G_LEDDAC);\r
+                       \r
+                         hx3695_write_reg(0X43, phase4_mux_sel);\r
+                               hx3695_write_reg(0X48, calReg_SPO2.R_LEDDAC);\r
+                       \r
+                         hx3695_write_reg(0X43, phase6_mux_sel);\r
+                               hx3695_write_reg(0X48, calReg_SPO2.IR_LEDDAC1);\r
+     // AGC_LOG("IR_LEDDAC:%d \r\n",hx3695_read_reg(0X47));\r
+\r
+    }\r
+    \r
+    if (calReg_SPO2.flag & CAL_FLG_AMB_DAC) \r
+    {\r
+                       //AGC_LOG("CAL_FLG_AMB_DAC\r\n");\r
+                         hx3695_write_reg(0X43, phase1_mux_sel);\r
+        hx3695_write_reg(0X48, calReg_SPO2.GREEN_AMBDAC); \r
+     \r
+                         hx3695_write_reg(0X43, phase3_mux_sel);\r
+        hx3695_write_reg(0X48, calReg_SPO2.RED_AMBDAC);        \r
+\r
+               hx3695_write_reg(0X43, phase5_mux_sel);\r
+        hx3695_write_reg(0X48, calReg_SPO2.IR_AMBDAC1); \r
+     \r
+//                       hx3695_write_reg(0X43, phase6_mux_sel);\r
+//        hx3695_write_reg(0X48, calReg_SPO2.IR_AMBDAC1);                      \r
+\r
+    }\r
+    \r
+    if (calReg_SPO2.flag & CAL_FLG_RF) \r
+    {\r
+                       //AGC_LOG("CAL_FLG_RF\r\n");\r
+                               hx3695_write_reg(0X43, phase1_mux_sel);  \r
+                         hx3695_write_reg(0X44, (0x40 | calReg_SPO2.G_RF));\r
+                       //AGC_LOG("RF:%x \r\n",hx3695_read_reg(0X44));\r
+//                             hx3695_write_reg(0X44, (hx3695_read_reg(0X44)| 0x07)&(calReg_SPO2.R_RF|0xff));  \r
+                               hx3695_write_reg(0X43, phase2_mux_sel);  \r
+                         hx3695_write_reg(0X44, (0x40 | calReg_SPO2.G_RF));\r
+                       //AGC_LOG("RF:%x \r\n",hx3695_read_reg(0X44));\r
+//                             hx3695_write_reg(0X44, (hx3695_read_reg(0X44)| 0x07)&(calReg_SPO2.G_RF|0xff));\r
+                               hx3695_write_reg(0X43, phase3_mux_sel);  \r
+                         hx3695_write_reg(0X44, (0x40 | calReg_SPO2.R_RF));\r
+                       //AGC_LOG("RF:%x \r\n",hx3695_read_reg(0X44));\r
+//                             hx3695_write_reg(0X44, (hx3695_read_reg(0X44)| 0x07)&(calReg_SPO2.R_RF|0xff));\r
+                               hx3695_write_reg(0X43, phase4_mux_sel);  \r
+                       hx3695_write_reg(0X44, (0x40 | calReg_SPO2.R_RF));\r
+                       //AGC_LOG("RF:%x \r\n",hx3695_read_reg(0X44));\r
+//                             hx3695_write_reg(0X44, (hx3695_read_reg(0X44)| 0x07)&(calReg_SPO2.IR_RF|0xff));\r
+                       \r
+//                             hx3695_write_reg(0X43, phase3_mux_sel);  \r
+//                     hx3695_write_reg(0X44, (0x40 | calReg_SPO2.R_RF));\r
+//                             hx3695_write_reg(0X43, phase4_mux_sel);  \r
+//                     hx3695_write_reg(0X44, (0x40 | calReg_SPO2.R_RF));\r
+                               \r
+                               hx3695_write_reg(0X43, phase5_mux_sel);  \r
+                       hx3695_write_reg(0X44, (0x40 | calReg_SPO2.IR_RF1));\r
+                               \r
+                               hx3695_write_reg(0X43, phase6_mux_sel);  \r
+                       hx3695_write_reg(0X44, (0x40 | calReg_SPO2.IR_RF1));\r
+                       \r
+    }\r
+               \r
+}\r
+void hx3695_spo2_set_mode(uint8_t mode_cmd)\r
+{\r
+    switch (mode_cmd)\r
+    {\r
+    case PPG_INIT:\r
+        hx3695_spo2_ppg_init();\r
+#if defined(TIMMER_MODE)\r
+        hx3695_320ms_timer_cfg(true);\r
+#if defined(GSEN_40MS_TIMMER)\r
+        hx3695_40ms_timer_cfg(true);\r
+#endif\r
+#else\r
+        hx3695_gpioint_cfg(true);\r
+#endif\r
+        s_ppg_state = 1;\r
+        AGC_LOG("ppg init mode\r\n");\r
+        break;\r
+\r
+    case PPG_OFF:\r
+        hx3695_ppg_off();\r
+        s_ppg_state = 0;\r
+        AGC_LOG("ppg off mode\r\n");\r
+        break;\r
+\r
+    case PPG_LED_OFF:\r
+        hx3695_spo2_low_power();\r
+                  \r
+        s_ppg_state = 0;\r
+        AGC_LOG("ppg led off mode\r\n");\r
+        break;\r
+\r
+    case CAL_INIT:\r
+        Init_Spo2_PPG_Calibration_Routine(&calReg_SPO2,64);\r
+        hx3695_spo2_cal_init();\r
+        hx3695_spo2_updata_reg();\r
+#if defined(TIMMER_MODE)\r
+#if defined(GSEN_40MS_TIMMER)\r
+#else\r
+        hx3695_40ms_timer_cfg(true);\r
+#endif\r
+#endif\r
+        s_cal_state = 1;\r
+        AGC_LOG("cal init mode\r\n");\r
+        break;\r
+\r
+    case RECAL_INIT:\r
+        Restart_Spo2_PPG_Calibration_Routine(&calReg_SPO2);\r
+        hx3695_spo2_cal_init();\r
+        hx3695_spo2_updata_reg();\r
+#if defined(TIMMER_MODE)\r
+#if defined(GSEN_40MS_TIMMER)\r
+#else\r
+        hx3695_40ms_timer_cfg(true);\r
+#endif\r
+#endif\r
+        s_cal_state = 1;\r
+        AGC_LOG("recal init mode\r\n");\r
+        break;\r
+\r
+    case CAL_OFF:\r
+#if defined(TIMMER_MODE)\r
+#if defined(GSEN_40MS_TIMMER)\r
+#else\r
+        hx3695_40ms_timer_cfg(false);\r
+#endif\r
+#endif\r
+        hx3695_spo2_cal_off();\r
+        s_cal_state = 0;\r
+        AGC_LOG("cal off mode\r\n");\r
+        break;\r
+\r
+    default:\r
+        break;\r
+    }\r
+}\r
+\r
+SENSOR_ERROR_T hx3695_spo2_enable(void)\r
+{\r
+    if (!hx3695_chip_check())\r
+    {\r
+        AGC_LOG("hx3695 check id failed!\r\n");\r
+        return SENSOR_OP_FAILED;\r
+    }\r
+\r
+    AGC_LOG("hx3695 check id success!\r\n");\r
+\r
+    if (s_ppg_state)\r
+    {\r
+        AGC_LOG("ppg already on!\r\n");\r
+        return SENSOR_OP_FAILED;\r
+    }\r
+\r
+    if(!tyhx_spo2_alg_open())\r
+    {\r
+        AGC_LOG("spo2 alg open fail,or dynamic ram not enough!\r\n");\r
+        return SENSOR_OP_FAILED;\r
+    }\r
+    spo2_wear_status = MSG_SPO2_NO_WEAR;\r
+    spo2_wear_status_pre = MSG_SPO2_NO_WEAR;\r
+    hx3695_spo2_set_mode(PPG_INIT);\r
+\r
+    AGC_LOG("hx3695 enable!\r\n");\r
+\r
+    return SENSOR_OK;\r
+}\r
+\r
+SENSOR_ERROR_T hx3695_hrspo2_enable(void)\r
+{\r
+    if (!hx3695_chip_check())\r
+    {\r
+        AGC_LOG("hx3695 check id failed!\r\n");\r
+        return SENSOR_OP_FAILED;\r
+    }\r
+\r
+    AGC_LOG("hx3695 check id success!\r\n");\r
+\r
+    if (s_ppg_state)\r
+    {\r
+        AGC_LOG("ppg already on!\r\n");\r
+        return SENSOR_OP_FAILED;\r
+    }\r
+\r
+    if(!tyhx_spo2_alg_open())\r
+    {\r
+        AGC_LOG("spo2 alg open fail,or dynamic ram not enough!\r\n");\r
+        return SENSOR_OP_FAILED;\r
+    }\r
+    if(!tyhx_hrs_alg_open())\r
+    {\r
+        AGC_LOG("spo2 alg open fail,or dynamic ram not enough!\r\n");\r
+        return SENSOR_OP_FAILED;\r
+    }\r
+    spo2_wear_status = MSG_SPO2_NO_WEAR;\r
+    spo2_wear_status_pre = MSG_SPO2_NO_WEAR;\r
+    hx3695_spo2_set_mode(PPG_INIT);\r
+\r
+    AGC_LOG("hx3695 enable!\r\n");\r
+\r
+    return SENSOR_OK;\r
+}\r
+\r
+void hx3695_spo2_disable(void)\r
+{\r
+#if defined(TIMMER_MODE)\r
+    hx3695_320ms_timer_cfg(false);\r
+    hx3695_40ms_timer_cfg(false);\r
+#elif defined(INT_MODE)\r
+    hx3695_gpioint_cfg(false);\r
+#endif\r
+    hx3695_spo2_set_mode(PPG_OFF);\r
+    s_ppg_state = 0;\r
+    s_cal_state = 0;\r
+    tyhx_spo2_alg_close();\r
+\r
+    AGC_LOG("hx3695 disable!\r\n");\r
+}\r
+\r
+void hx3695_spo2_data_reset(void)\r
+{\r
+    s_ppg_state = 0;\r
+    s_cal_state = 0;\r
+    tyhx_spo2_alg_close();\r
+}\r
+\r
+spo2_wear_msg_code_t hx3695_spo2_get_wear_status(void)\r
+{\r
+    return  spo2_wear_status;\r
+}\r
+\r
+SPO2_CAL_SET_T get_spo2_agc_status(void)\r
+{\r
+    SPO2_CAL_SET_T cal;\r
+\r
+//    cal.flag = calReg_SPO2.flag;\r
+//    cal.int_cnt = calReg_SPO2.int_cnt;\r
+//    cal.G_LED = calReg_SPO2.G_LED;\r
+//    cal.R_LED = calReg_SPO2.R_LED;\r
+//    cal.IR_LED1 = calReg_SPO2.IR_LED1;\r
+//    cal.R_LEDDAC = calReg_SPO2.R_LEDDAC;\r
+//    cal.IR_LEDDAC1 = calReg_SPO2.IR_LEDDAC1;\r
+//    cal.G_LEDDAC = calReg_SPO2.G_LEDDAC;\r
+//    cal.AMBDAC = calReg_SPO2.AMBDAC;\r
+//    cal.G_RF = calReg_SPO2.G_RF;\r
+//    cal.R_RF = calReg_SPO2.R_RF;\r
+//    cal.IR_RF1 = calReg_SPO2.IR_RF1;\r
+//    cal.G_led_step = calReg_SPO2.G_led_step;\r
+//    cal.R_led_step = calReg_SPO2.R_led_step;\r
+//    cal.IR_led_step1 = calReg_SPO2.IR_led_step1;\r
+//    cal.state = calReg_SPO2.state;\r
+//    cal.green_idac = calReg_SPO2.green_idac;\r
+//    cal.red_idac = calReg_SPO2.red_idac;\r
+//    cal.ir_idac1 = calReg_SPO2.ir_idac1;\r
+\r
+     cal = calReg_SPO2;\r
+\r
+    return cal;\r
+}\r
+\r
+//void hx3695_spo2_read_fifo_data(uint8_t read_fifo_size,int32_t *buf)\r
+//{\r
+//    uint8_t data_flg = 127;\r
+//    int32_t data;\r
+//    uint8_t databuf[3];\r
+//    uint8_t ii=0;\r
+//    uint8_t data_size_all = 0;\r
+//    data_size_all = hx3695_read_fifo_size();\r
+//    for(ii=0; ii<read_fifo_size; ii++)\r
+//    {\r
+//        hx3695_write_reg(0x17, 0x00); // write any walue to 0x17 will update a new data\r
+//        hx3695_delay_us(100);\r
+\r
+//        databuf[2]=hx3695_read_reg(0x17);\r
+//        databuf[1]=hx3695_read_reg(0x16);\r
+//        databuf[0]=hx3695_read_reg(0x15);\r
+//        data_flg = databuf[2]>>5;\r
+//        data = (int32_t)(databuf[0]|(databuf[1]<<8)|((databuf[2]&0x1f)<<16));\r
+\r
+//        if(ii==0)\r
+//        {\r
+//            if(data_flg ==3)\r
+//            {\r
+//                ii=3;\r
+//                buf[0] = 0;\r
+//                buf[1] = 0;\r
+//                buf[2] = 0;\r
+//            }\r
+//            if(data_flg ==2)\r
+//            {\r
+//                ii=2;\r
+//                buf[0] = 0;\r
+//                buf[1] = 0;\r
+//            }\r
+//            if(data_flg ==1)\r
+//            {\r
+//                ii=1;\r
+//                buf[0] = 0;\r
+//            }\r
+//        }\r
+\r
+//        if(data_flg == 0)\r
+//        {\r
+//            buf[ii]= data;\r
+//        }\r
+//        else if(data_flg == 1)\r
+//        {\r
+//            buf[ii]= data;\r
+//        }\r
+//        else if(data_flg == 2)\r
+//        {\r
+//            buf[ii]= data;\r
+//        }\r
+//        else if(data_flg == 3)\r
+//        {\r
+//            buf[ii]= data;\r
+//        }\r
+//    }\r
+\r
+//    if(data_size_all==64)\r
+//    {\r
+//        hx3695_write_reg(0X13, 0x30);\r
+//        hx3695_delay_ms(5);\r
+//        hx3695_write_reg(0X13, 0x31);\r
+//        hx3695_delay_ms(5);\r
+//    }\r
+//}\r
+\r
+uint8_t hx3695_spo2_read(spo2_sensor_data_t * s_dat)\r
+{\r
+    int32_t Red_src_data;\r
+    int32_t Ir_src_data1, Ir_src_data2;\r
+               int32_t Green_src_data;\r
+         int32_t Ir_wear_value;\r
+    bool recal = false;\r
+    uint8_t size = 0;\r
+    uint8_t size_byte = 0;\r
+               uint8_t i;\r
+    int32_t *red_buf = &(s_dat->red_data[0]);\r
+               int32_t *green_buf = &(s_dat->green_data[0]);\r
+    int32_t *ir_buf1 = &(s_dat->ir_data1[0]); \r
+         int32_t *ir_buf2 = &(s_dat->ir_data2[0]); \r
+    int32_t *s_buf = &(s_dat->s_buf[0]);  \r
+               s_dat->agc_green = calReg_SPO2.G_LED;   \r
+    s_dat->agc_red = calReg_SPO2.R_LED;\r
+    s_dat->agc_ir1 = calReg_SPO2.IR_LED1;\r
+         s_dat->agc_ir2 = calReg_SPO2.IR_LED2;\r
+    uint8_t data_count = 0;\r
+    //AGC_LOG("s_ppg_state: %d,s_cal_state: %d\r\n",s_ppg_state,s_cal_state);\r
+    if (!s_ppg_state || s_cal_state) \r
+    {\r
+        return NULL;\r
+    }    \r
+\r
+                       data_count = hx3695_read_fifo_data(s_buf,spo2_phase_num,1); \r
+                 s_dat->count =  data_count; \r
+\r
+      hx3695_spo2_read_data( agc_buf );\r
+                 Ir_wear_value = agc_buf[7]- agc_buf[6];\r
+                 TYHX_LOG("Ir_wear_value: %d \r\n",Ir_wear_value);\r
+                       for (i=0; i<data_count; i++) \r
+                       {\r
+//                               Red_src_data = s_buf[i*4+2] - s_buf[i*4];\r
+                                 Green_src_data = s_buf[i*4];\r
+                                       Red_src_data = s_buf[i*4+1];      // - s_buf[i*4];\r
+                                       Ir_src_data1 = s_buf[i*4+2];      // - s_buf[i*4];\r
+                                       Ir_src_data2 = s_buf[i*4+3];       // - s_buf[i*4];\r
+\r
+//                                 if((Green_src_data < 400000 ||Green_src_data > 750000)||(   Red_src_data < 400000 || Red_src_data > 750000)\r
+//                                                       ||(Ir_src_data1 < 400000 ||Ir_src_data1 > 750000))    \r
+           if((agc_buf[1] < 300000 ||agc_buf[1] > 750000)||(   agc_buf[3] < 300000 || agc_buf[3] > 750000)\r
+                                                         ||(agc_buf[5] < 300000 ||agc_buf[5] > 750000))\r
+                               \r
+                                       {\r
+                                                       recal = true;               \r
+                                                       if(spo2_wear_status==MSG_SPO2_NO_WEAR)\r
+                                                       {\r
+                                                                        recal = false;\r
+                                                       }\r
+                                       }            \r
+          green_buf[i] = Green_src_data;\r
+                                       red_buf[i] = Red_src_data;\r
+                                       ir_buf1[i] = Ir_src_data1;\r
+                                       ir_buf2[i] = Ir_src_data2;\r
+                                       \r
+                                       //SEGGER_RTT_printf(0,"G_LEDDAC: %d,R_LEDDAC: %d\r\n", calReg_SPO2.R_LEDDAC,cal.R_LEDDAC);\r
+                                       //DEBUG_PRINTF(0,"%d/%d %d %d %d %d %d %d %d %d\r\n" ,1+i,data_count,\\r
+                                       green_buf[i],red_buf[i],ir_buf[i],s_buf[i*4],s_buf[i*4+1],s_buf[i*4+2],s_buf[i*4+3],spo2_wear_status);\r
+\r
+//                                     SEGGER_RTT_printf(0,"fifo_data: %d/%d %d %d %d %d\r\n", i+1,data_count,s_buf[i*4],\\r
+//                     s_buf[i*4+1],s_buf[i*4+2],s_buf[i*4+3]);\r
+\r
+                                       \r
+                                       if(spo2_wear_status==MSG_SPO2_WEAR)\r
+                                       {\r
+                                                       if(hx3695_spo2_check_unwear(Ir_wear_value))    //Ir_src_data2\r
+                                                       {\r
+                                                               return NULL;\r
+                                                       }\r
+                                       }\r
+                                       else\r
+                                       {\r
+                                                       if(hx3695_spo2_check_wear(Ir_wear_value))\r
+                                                       {\r
+                                                               return NULL;\r
+                                                       }\r
+                                       }\r
+                       }\r
+\r
+                       if (recal) \r
+                       //if (0)\r
+                       {\r
+                                       cal_delay--;\r
+                                       if (cal_delay <= 0) \r
+                                       {\r
+                                                       cal_delay = SPO2_CAL_DELAY_COUNT;\r
+                                                       hx3695_spo2_set_mode(RECAL_INIT);\r
+                                       }\r
+                       } \r
+                       else \r
+                       {\r
+                                       cal_delay = SPO2_CAL_DELAY_COUNT;\r
+                       }  \r
+    \r
+    return 1;\r
+}\r
+\r
+#endif\r
diff --git a/code/sdk/drivers/peripheral/ppg/hx3695/hx3695_spo2_agc.h b/code/sdk/drivers/peripheral/ppg/hx3695/hx3695_spo2_agc.h
new file mode 100644 (file)
index 0000000..db07398
--- /dev/null
@@ -0,0 +1,122 @@
+#ifndef _HX3695_SPO2_AGC_H_\r
+#define _HX3695_SPO2_AGC_H_\r
+#include <stdint.h>\r
+#include <stdbool.h>\r
+#include "hx3695.h"\r
+\r
+#define CAL_FLG_LED_DR     0x01\r
+#define CAL_FLG_LED_DAC    0x02 \r
+#define CAL_FLG_AMB_DAC    0x04\r
+#define CAL_FLG_RF         0x08\r
+\r
+#define SPO2_CAL_INIT_LED_RED 32\r
+#define SPO2_CAL_INIT_LED_IR 32\r
+#define SPO2_CAL_INIT_LED_GREEN 64\r
+\r
+#define SPO2_CAL_DELAY_COUNT    8\r
+#define SPO2_NO_TOUCH_CHECK_NUM 2\r
+\r
+\r
+//typedef enum {    \r
+//    sCalStart,\r
+//       sCalLedCur,   \r
+//    sCalLed,\r
+//    sCalLed2,\r
+//    sCalLed3,\r
+//    sCalFinish, \r
+//} SPO2_STATE_T;\r
+\r
+typedef enum {    \r
+   \r
+    sCalStart,\r
+               sCalStart1,     \r
+    sCalLed,\r
+    sCalLed2,\r
+    sCalLed3,\r
+    sCalRf,\r
+    sCalRfEnd,\r
+    sCalFinish, \r
+} SPO2_STATE_T;\r
+\r
+typedef struct {\r
+       uint8_t count;\r
+       int32_t red_data[16];\r
+       int32_t green_data[16];\r
+       int32_t ir_data1[16]; \r
+       int32_t ir_data2[16];\r
+       int32_t s_buf[64];\r
+//     int32_t red_amb_buf[64];\r
+       \r
+       uint8_t agc_green;\r
+       uint8_t agc_red; \r
+       uint8_t agc_ir1;\r
+  uint8_t agc_ir2;   \r
+   \r
+}spo2_sensor_data_t;\r
+\r
+typedef enum {\r
+       MSG_SPO2_NO_WEAR,\r
+       MSG_SPO2_WEAR\r
+} spo2_wear_msg_code_t;\r
+\r
+typedef struct {\r
+       uint8_t flag;\r
+       bool work;\r
+       uint8_t int_cnt;\r
+       uint8_t cur255_cnt;\r
+       uint8_t green_idac;\r
+       uint8_t red_idac;\r
+       uint8_t ir_idac1;\r
+       uint8_t ir_idac2;\r
+       uint16_t G_LED; \r
+       uint16_t R_LED;     \r
+       uint16_t IR_LED1; \r
+  uint16_t IR_LED2;    \r
+       uint8_t G_LEDDAC;\r
+       uint8_t R_LEDDAC;  \r
+       uint8_t IR_LEDDAC1;\r
+  uint8_t IR_LEDDAC2; \r
+       uint8_t  AMBDAC;\r
+       uint8_t GREEN_AMBDAC;\r
+       uint8_t RED_AMBDAC; \r
+  uint8_t IR_AMBDAC1;  \r
+       uint8_t IR_AMBDAC2;\r
+       uint8_t G_RF;\r
+       uint8_t R_RF; \r
+       uint8_t IR_RF1;\r
+       uint8_t IR_RF2;\r
+       uint32_t G_led_step;\r
+       uint32_t R_led_step;\r
+       uint32_t IR_led_step1;\r
+       uint32_t IR_led_step2;\r
+       uint8_t state;\r
+       uint8_t green_max_cur;\r
+       uint8_t red_max_cur;\r
+       uint8_t ir_max_cur;\r
+} SPO2_CAL_SET_T;\r
+\r
+void Init_Spo2_PPG_Calibration_Routine(SPO2_CAL_SET_T *calR,uint8_t led);  \r
+void Restart_spo2_PPG_Calibration_Routine(SPO2_CAL_SET_T *calR);\r
+//void PPG_Spo2_Calibration_Routine(SPO2_CAL_SET_T *calR, int32_t g_led, int32_t r_led, int32_t amb, int32_t ir_led);\r
+//void PPG_Spo2_Calibration_Routine(SPO2_CAL_SET_T *calRS, int32_t r_led, int32_t ir_led1, int32_t red_amb, int32_t ir_amb1);\r
+void PPG_Spo2_Calibration_Routine(SPO2_CAL_SET_T *calRS, int32_t g_led, int32_t r_led, int32_t ir_led1, int32_t g_amb, int32_t red_amb, int32_t ir_amb1);\r
+\r
+void hx3695_spo2_cal_init(void);\r
+void hx3695_spo2_cal_off(void); \r
+void hx3695_spo2_read_data(int32_t *s_buf);\r
+void hx3695_spo2_low_power(void);\r
+void hx3695_spo2_normal_power(void); \r
+void hx3695_spo2_updata_reg(void);\r
+void hx3695_spo2_set_mode(uint8_t mode_cmd);\r
+SENSOR_ERROR_T hx3695_spo2_enable(void);\r
+void hx3695_spo2_disable(void);\r
+spo2_wear_msg_code_t hx3695_spo2_get_wear_status(void);\r
+uint8_t hx3695_spo2_read(spo2_sensor_data_t * s_dat);\r
+bool hx3695_spo2_check_unwear(int32_t infrared_data);\r
+bool hx3695_spo2_check_wear(int32_t infrared_data);\r
+SPO2_CAL_SET_T get_spo2_agc_status(void);\r
+SPO2_CAL_SET_T PPG_spo2_agc(void);\r
+void hx3695_spo2_data_reset(void);\r
+void hx3695_spo2_read_data(int32_t *s_buf);\r
+\r
+#endif\r
diff --git a/code/sdk/drivers/peripheral/ppg/hx3695/tyhx_hrs_alg.h b/code/sdk/drivers/peripheral/ppg/hx3695/tyhx_hrs_alg.h
new file mode 100644 (file)
index 0000000..a293181
--- /dev/null
@@ -0,0 +1,112 @@
+//vesion3.1.35\r
+#ifndef _TYHX_HRS_ALG_H_\r
+#define _TYHX_HRS_ALG_H_\r
+\r
+#include <stdint.h>\r
+\r
+/* portable 8-bit unsigned integer */\r
+typedef unsigned char           uint8_t;\r
+/* portable 8-bit signed integer */\r
+typedef signed char             int8_t;\r
+/* portable 16-bit unsigned integer */\r
+typedef unsigned short int      uint16_t;\r
+/* portable 16-bit signed integer */\r
+typedef signed short int        int16_t;\r
+/* portable 32-bit unsigned integer */\r
+typedef unsigned int            uint32_t;\r
+/* portable 32-bit signed integer */\r
+typedef signed int              int32_t;\r
+\r
+#ifndef bool\r
+#define bool unsigned char\r
+#endif\r
+\r
+#ifndef  true\r
+#define  true  1\r
+#endif\r
+#ifndef  false\r
+#define  false  0\r
+#endif\r
+\r
+#ifdef HRS_ALG_LIB\r
+\r
+typedef enum {\r
+       NORMAL_MODE,\r
+       RIDE_MODE,\r
+       WALK_MODE,\r
+       JUMP_MODE,\r
+       ALLDAY_HR_MODE,\r
+       HIGH_POW_MODE\r
+} hrs_sports_mode_t;\r
+\r
+typedef enum {\r
+       MSG_HRS_ALG_NOT_OPEN,\r
+       MSG_HRS_ALG_OPEN,\r
+       MSG_HRS_READY,\r
+       MSG_HRS_ALG_TIMEOUT\r
+} hrs_alg_msg_code_t;\r
+\r
+typedef enum {\r
+       MSG_LIVING_INITIAL,\r
+       MSG_LIVING_TRUE,\r
+       MSG_LIVING_FAIL\r
+} living_msg_code_t;\r
+\r
+typedef struct {\r
+       hrs_alg_msg_code_t  hrs_alg_status;\r
+    living_msg_code_t   living_status;\r
+       uint32_t            data_cnt;\r
+       uint8_t             hr_result;\r
+       uint16_t            cal_result;\r
+       uint8_t             hr_result_qual;\r
+    uint32_t            hr_result_std;\r
+} hrs_results_t;\r
+\r
+#ifdef BP_CUSTDOWN_ALG_LIB\r
+typedef enum {\r
+       MSG_BP_ALG_NOT_OPEN = 0x01,\r
+       MSG_BP_NO_TOUCH = 0x02,\r
+       MSG_BP_PPG_LEN_TOO_SHORT = 0x03,\r
+       MSG_BP_READY = 0x04,\r
+       MSG_BP_ALG_TIMEOUT = 0x05,\r
+       MSG_BP_SETTLE = 0x06\r
+} bp_msg_code_t;\r
+\r
+typedef struct {\r
+       uint8_t age;\r
+       uint8_t height;\r
+       uint8_t weight;\r
+       uint8_t gender;\r
+       uint8_t ref_sbp;\r
+       uint8_t ref_dbp;\r
+} bp_exinf_t;\r
+\r
+typedef struct {\r
+       bp_msg_code_t   bp_alg_status;\r
+       uint8_t         sbp;\r
+       uint8_t         dbp; \r
+       uint32_t        data_cnt;\r
+       uint8_t         hr_result;\r
+       bool            object_flg;\r
+} bp_results_t;\r
+\r
+void tyhx_bp_set_exinf(uint8_t age, uint8_t height, uint8_t weight, uint8_t gender, uint8_t ref_sbp, uint8_t ref_dbp);\r
+void tyhx_bp_age_fn(uint8_t hr_result, bp_exinf_t body_s);\r
+void tyhx_restart_bp_cal(void);\r
+bp_results_t tyhx_alg_get_bp_results(void);\r
+#endif //BP_CUSTDOWN_ALG_LIB\r
+\r
+bool tyhx_hrs_alg_open(void);\r
+bool tyhx_hrs_alg_open_deep(void);\r
+void tyhx_hrs_alg_close(void);\r
+bool tyhx_hrs_alg_send_data(int32_t *new_raw_data,uint8_t dat_len, int16_t *gsen_data_x, int16_t *gsen_data_y, int16_t *gsen_data_z, uint8_t green_offset);\r
+bool tyhx_hrs_alg(int32_t new_raw_data, int16_t gsen_data_x, int16_t gsen_data_y, int16_t gsen_data_z, uint8_t offset);\r
+bool tyhx_motion_pedometer(int16_t gsen_data_x, int16_t gsen_data_y, int16_t gsen_data_z);\r
+hrs_results_t tyhx_hrs_alg_get_results(void);\r
+void tyhx_hrs_set_alg_para(hrs_sports_mode_t sports_mode, uint16_t static_thre_val, uint8_t gsen_fun_lv_val);\r
+void tyhx_hrs_set_living(uint8_t mode, uint8_t qu_thre, uint8_t st_thre);\r
+#endif //HRS_ALG_LIB\r
+\r
+#endif\r
+\r
+\r
diff --git a/code/sdk/drivers/peripheral/ppg/hx3695/tyhx_hrv_alg.h b/code/sdk/drivers/peripheral/ppg/hx3695/tyhx_hrv_alg.h
new file mode 100644 (file)
index 0000000..4d5cd36
--- /dev/null
@@ -0,0 +1,64 @@
+#ifndef _TYHX_HRV_ALG_H_\r
+#define _TYHX_HRV_ALG_H_\r
+#endif\r
+       \r
+#include <stdint.h>\r
+\r
+/* portable 8-bit unsigned integer */\r
+typedef unsigned char           uint8_t;\r
+/* portable 8-bit signed integer */\r
+typedef signed char             int8_t;\r
+/* portable 16-bit unsigned integer */\r
+typedef unsigned short int      uint16_t;\r
+/* portable 16-bit signed integer */\r
+typedef signed short int        int16_t;\r
+/* portable 32-bit unsigned integer */\r
+typedef unsigned int            uint32_t;\r
+/* portable 32-bit signed integer */\r
+typedef signed int              int32_t;\r
+\r
+#ifndef  bool\r
+#define  bool unsigned char\r
+#endif\r
+#ifndef  true\r
+#define  true  1\r
+#endif\r
+#ifndef  false\r
+#define  false  0\r
+#endif\r
+\r
+#define HRV_GLITCH_THRES     20000 \r
+#define HRV_GSEN_POW_THRE    150\r
+\r
+#ifdef HRV_ALG_LIB\r
+\r
+typedef enum {\r
+    MSG_HRV_ALG_NOT_OPEN,\r
+    MSG_HRV_ALG_OPEN,\r
+    MSG_HRV_READY,\r
+    MSG_HRV_ALG_TIMEOUT,\r
+} hrv_alg_msg_code_t;\r
+\r
+typedef struct {\r
+    hrv_alg_msg_code_t  hrv_alg_status;\r
+    uint32_t    data_cnt;\r
+    uint8_t     hrv_result;\r
+    uint32_t    hrv_peak; \r
+    uint8_t     spirit_pressure;\r
+    uint8_t     p_m;\r
+    uint8_t     screen_up;\r
+    uint8_t     motion;\r
+    uint8_t     signal_quality;\r
+} hrv_results_t;\r
+\r
+\r
+void tyhx_hrv_alg(int32_t new_raw_data);\r
+bool tyhx_hrv_alg_open(void);\r
+bool tyhx_hrv_alg_open_deep(void);\r
+void tyhx_hrv_alg_close(void);\r
+void kfft(double *pr,double *pi,int n,int k,double *fr,double *fi);\r
+\r
+hrv_results_t tyhx_hrv_alg_send_data(int32_t new_raw_data, int32_t green_data_als, int32_t infrared_data);\r
+hrv_results_t tyhx_hrv_alg_send_bufdata(int32_t *new_raw_data, uint8_t count, int16_t *gsen_data_x, int16_t *gsen_data_y, int16_t *gsen_data_z);\r
+#endif //HRV_ALG_LIB\r
+               \r
diff --git a/code/sdk/drivers/peripheral/ppg/hx3695/tyhx_spo2_alg.h b/code/sdk/drivers/peripheral/ppg/hx3695/tyhx_spo2_alg.h
new file mode 100644 (file)
index 0000000..c6a83ee
--- /dev/null
@@ -0,0 +1,164 @@
+#ifndef _SPO2_ALG_H_\r
+#define _SPO2_ALG_H_\r
+#endif\r
+#include <stdint.h>\r
+\r
+//version:3.3.17\r
+\r
+//#include "tyhx_spo2_alg_para.h"\r
+\r
+\r
+/* portable 8-bit unsigned integer */\r
+typedef unsigned char           uint8_t;\r
+/* portable 8-bit signed integer */\r
+typedef signed char             int8_t;\r
+/* portable 16-bit unsigned integer */\r
+typedef unsigned short int      uint16_t;\r
+/* portable 16-bit signed integer */\r
+typedef signed short int        int16_t;\r
+/* portable 32-bit unsigned integer */\r
+typedef unsigned int            uint32_t;\r
+/* portable 32-bit signed integer */\r
+typedef signed int              int32_t;\r
+\r
+#ifndef bool\r
+#define bool unsigned char\r
+#endif\r
+\r
+#ifndef  true\r
+#define  true  1\r
+#endif\r
+#ifndef  false\r
+#define  false  0\r
+#endif\r
+\r
+\r
+#ifdef SPO2_ALG_LIB\r
+\r
+typedef enum {\r
+       MSG_SPO2_ALG_NOT_OPEN,\r
+       MSG_SPO2_ALG_OPEN,\r
+       MSG_SPO2_READY,\r
+       MSG_SPO2_ALG_TIMEOUT,\r
+    MSG_SPO2_END\r
+} spo2_alg_msg_code_t;\r
+\r
+typedef enum {\r
+       MSG_SPO2_LIVING_INITIAL,\r
+       MSG_SPO2_LIVING_TRUE,\r
+       MSG_SPO2_LIVING_FAIL\r
+} spo2_living_code_t;\r
+\r
+typedef enum {\r
+       SPO2_NORMAL_MODE,\r
+       SPO2_ALLDAY_MODE\r
+} spo2_mode_t;\r
+\r
+typedef struct {\r
+    spo2_alg_msg_code_t                spo2_alg_status;\r
+    spo2_living_code_t      spo2_living_status;\r
+    uint32_t           data_cnt;\r
+    uint8_t                    spo2_result;\r
+    uint8_t                    hr_result;\r
+    uint8_t                    block_cnt;\r
+    uint8_t                    ir_quality;\r
+    uint16_t           reliable_score_result;\r
+\r
+    uint8_t                    screen_up;\r
+    uint8_t                    motion;\r
+    uint8_t                    poor_signal;\r
+    \r
+    uint8_t         signal_snr;\r
+    uint32_t        signal_std;\r
+    \r
+} spo2_results_t;\r
+\r
+typedef struct {\r
+    uint8_t                    screen_up;\r
+    uint8_t                    motion;\r
+    uint8_t                    poor_signal;\r
+} spo2_gesture_recognize_t;\r
+\r
+typedef struct {\r
+       uint32_t data_cnt;\r
+       int32_t red_new_raw_data;\r
+       int32_t ir_new_raw_data;\r
+       int32_t green_new_raw_data;\r
+       int32_t ir_iir_data_filter_out;\r
+       int32_t ir_data_smooth;\r
+       int32_t red_iir_data_filter_out;\r
+       int32_t red_data_smooth;\r
+       uint8_t ir_offset_50;\r
+       uint8_t red_offset_50;\r
+       uint8_t green_offset_50;\r
+       int32_t ir_dc;\r
+       int32_t red_dc;\r
+       int32_t green_dc;\r
+       int32_t ir_data_o2_128;\r
+       int32_t red_data_o2_128;\r
+       int32_t green_data_o2_128;\r
+       int16_t red_ir_dc;\r
+       int16_t red_green_dc;\r
+       int16_t ir_green_dc;\r
+       int16_t ir_fft_snr;\r
+       int8_t  motion_status;\r
+       uint8_t xcorr_max;\r
+       int16_t COUNT_IN_judge;\r
+       uint8_t spo2_result;\r
+       uint8_t count_block;\r
+       int32_t SaO2_data_temp;\r
+} spo2_debug_t;\r
+\r
+typedef struct {\r
+         uint8_t       red_offset_idac;\r
+         uint8_t       ir_offset_idac; \r
+         uint8_t       green_offset_idac; \r
+         uint16_t      spo2_start_cnt;\r
+} spo2_agcpara_t;\r
+\r
+typedef struct {\r
+       uint8_t XCORR_MODE;\r
+       uint8_t QUICK_RESULT;\r
+} spo2_switch_t;\r
+\r
+typedef struct {\r
+       uint8_t  SPO2_LOW_XCORR_THRE;\r
+       uint8_t  SPO2_LOW_SNR_THRE;\r
+       uint8_t  COUNT_BLOCK_NUM;\r
+       uint32_t SPO2_BASE_LINE_INIT;\r
+       uint32_t SPO2_SLOPE;\r
+    uint16_t SPO2_GSEN_POW_THRE;\r
+} spo2_usuallyadjust_t;\r
+\r
+typedef struct {\r
+       uint16_t MEAN_NUM;\r
+       int32_t  SOP2_DEGLITCH_THRE;\r
+       int32_t  SPO2_REMOVE_JUMP_THRE;\r
+       uint16_t SPO2_LOW_CLIP_END_TIME;\r
+       uint16_t SPO2_LOW_CLIP_DN;\r
+       uint16_t SPO2_NORMAL_CLIP_DN;\r
+       uint16_t IR_AC_TOUCH_THRE;\r
+       uint16_t IR_FFT_POW_THRE;\r
+       uint8_t  SPO2_CALI;\r
+       uint8_t  SLOPE_PARA_MAX;\r
+       uint8_t  SLOPE_PARA_MIN;\r
+} spo2_barelychange_t;\r
+\r
+void tyhx_spo2_set_switch(uint8_t XCORR_MODE,uint8_t QUICK_RESULT);\r
+void tyhx_spo2_para_usuallyadjust(uint8_t SPO2_LOW_XCORR_THRE,uint8_t SPO2_LOW_SNR_THRE,uint8_t COUNT_BLOCK_NUM,uint32_t SPO2_BASE_LINE_INIT,uint32_t SPO2_SLOPE,uint16_t SPO2_GSEN_POW_THRE);\r
+void tyhx_spo2_para_barelychange(uint16_t MEAN_NUM,int32_t SOP2_DEGLITCH_THRE,int32_t SPO2_REMOVE_JUMP_THRE, \\r
+                                   uint16_t SPO2_LOW_CLIP_END_TIME,uint16_t SPO2_LOW_CLIP_DN,uint16_t SPO2_NORMAL_CLIP_DN, \\r
+                                   uint16_t IR_AC_TOUCH_THRE,uint16_t IR_FFT_POW_THRE,uint8_t SPO2_CALI,uint8_t SLOPE_PARA_MAX,uint8_t SLOPE_PARA_MIN);\r
+\r
+void tyhx_spo2_set_living(uint8_t living_mode, uint8_t qu_thre, uint8_t st_thre);\r
+void tyhx_spo2_set_mode(spo2_mode_t mode);\r
+bool tyhx_spo2_alg_send_data(int32_t *red_new_raw_data,int32_t *ir_new_raw_data,int32_t *green_new_raw_data,uint8_t R_LEDDAC,uint8_t IR_LEDDAC,uint8_t G_LEDDAC, int16_t *gsen_data_x, int16_t *gsen_data_y, int16_t *gsen_data_z, uint8_t dat_len);\r
+void tyhx_spo2_alg(int32_t red_new_raw_data , int32_t ir_new_raw_data, int32_t green_new_raw_data,uint8_t R_LEDDAC,uint8_t IR_LEDDAC,uint8_t G_LEDDAC);\r
+void tyhx_spo2_alg_close(void);\r
+bool tyhx_spo2_alg_open(void);\r
+bool tyhx_spo2_alg_open_deep(void);\r
+spo2_results_t tyhx_spo2_alg_get_results(void);\r
+spo2_debug_t tyhx_spo2_alg_debug_results(void);\r
+\r
+#endif \r
+\r
old mode 100755 (executable)
new mode 100644 (file)
similarity index 98%
rename from code/sdk/drivers/drivers/driver/touch/ft6x46_touch/ft6x46_ctrl.c
rename to code/sdk/drivers/peripheral/touch/ft6x46_touch/ft6x46_ctrl.c
index d52db5b..8fc2aa6
@@ -39,7 +39,7 @@ ext_errno ztw523_register_handle(const ztw523_ctrl_ops *peri_data, touch_callbac
     ext_errno ret;
 
 
-    //tp_err("ztw523_register_handle*****************888888888");
+    //tp_err("ft6x46_register_handle*****************888888888");
     g_ztw523_callback = func;
     /* register int io interrupt handler */
     uapi_gpio_init();
@@ -47,7 +47,7 @@ ext_errno ztw523_register_handle(const ztw523_ctrl_ops *peri_data, touch_callbac
     uapi_gpio_set_dir(ZTW523_INT_GPIO, GPIO_DIRECTION_INPUT);
     ret = uapi_gpio_register_isr_func(ZTW523_INT_GPIO, GPIO_INTERRUPT_FALLING_EDGE, ztw523_gpio_isr_handle);
     if (ret != 0) {
-        tp_err("ztw523 int callback register fail! ret=0x%x", ret);
+        tp_err("ft6x46 int callback register fail! ret=0x%x", ret);
         return ret;
     }
 
@@ -474,7 +474,7 @@ ext_errno ztw523_host_peripheral_init(ztw523_ctrl_attr *attr)
     ext_errno ret;
 
     if (attr == NULL) {
-        tp_err("ztw523 communication interface cfg is empty!");
+        tp_err("ft6x46 communication interface cfg is empty!");
         return EXT_ERR_FAILURE;
     }
     ret = ztw523_ctrl_attr_check(attr);
@@ -507,7 +507,7 @@ ext_errno ztw523_host_peripheral_init(ztw523_ctrl_attr *attr)
 ext_errno ztw523_host_init_sample(void)
 {
     ext_errno ret;
-    PRINT("**********ztw523_host_init_sample**********\r\n");
+    PRINT("**********ft6x46_host_init_sample**********\r\n");
     ret = ztw523_host_peripheral_init(&g_ctrl_attr);
     ret = ztw523_init();
     if (ret != EXT_ERR_SUCCESS) {
diff --git a/code/sdk/middleware/chips/brandy/pm/pm_adapt/pm_lp_stub.c.bak b/code/sdk/middleware/chips/brandy/pm/pm_adapt/pm_lp_stub.c.bak
deleted file mode 100755 (executable)
index 7c5eacf..0000000
+++ /dev/null
@@ -1,681 +0,0 @@
-/*
- * Copyright (c) @CompanyNameMagicTag 2022-2023. All rights reserved.
- * Description: pm lp stub code
- */
-
-#include "chip_io.h"
-#include "platform.h"
-#include "flash.h"
-#include "hal_xip.h"
-#include "touch_screen_def.h"
-#include "lcd_bus.h"
-#include "pmu_ldo.h"
-#include "hal_pmu_ldo.h"
-#include "pm_control.h"
-#include "i2c_porting.h"
-#include "spi_porting.h"
-#include "uart_porting.h"
-#ifdef CFG_DRIVERS_MMC
-#include "soc_mmc.h"
-#endif
-#include "chip_io.h"
-
-#define UART_SUSPEND_REGS_NUM     8
-#define QSPI0_FLASH_D0_PIN        0xA3005000
-#define QSPI0_FLASH_D1_PIN        0xA3005004
-#define QSPI0_FLASH_D2_PIN        0xA3005008
-#define QSPI0_FLASH_D3_PIN        0xA300500C
-#define QSPI0_FLASH_CLK_PIN       0xA3005010
-#define QSPI0_FLASH_CS0_PIN       0xA3005014
-#define PIN_FUNC_QSPI0            0x1
-#define QSPI0_FLASH_D0_PAD        0x5700CE00
-#define QSPI0_FLASH_D1_PAD        0x5700CE04
-#define QSPI0_FLASH_D2_PAD        0x5700CE08
-#define QSPI0_FLASH_D3_PAD        0x5700CE0C
-#define QSPI0_FLASH_CLK_PAD       0x5700CE10
-#define QSPI0_FLASH_CS0_PAD       0x5700CE14
-#define PAD_IE_BIT                0x1
-#define PAD_PE_BIT                0x0
-#define PAD_PS_BIT                0X2
-#define OPI_PSRAM_CE_PAD          0x5700CE5c
-#define QSPI1_NANDFLASH_CS0_PAD   0x5700DA2C
-#define QSPI1_NANDFLASH_CS1_PAD   0x5700DA30
-#define PM_EMMC_CCLK_DIV_REG      0x52000100
-#define PM_SD_HOST_CCLK_DIV_REG   0x52000110
-#define RC_CLK_VALUE              49152000
-#define XO_CLK_VALUE              32000000
-#define XO_DLL2_CLK_VALUE         64000000
-#define PLL_CLK_VALUE             884736000
-#define PM_SDIOM_CLK_REG          0x55000628
-#define PM_EMMC_DIV_REG           0x52000120
-
-static uint32_t g_uart_h0_regs_tmp[UART_SUSPEND_REGS_NUM];
-static uint32_t g_uart_h1_regs_tmp[UART_SUSPEND_REGS_NUM];
-static bool g_display_pwr_on_for_pm = true;
-static uint8_t g_resume_touch_flag = 1;
-
-void set_touch_resume_flag(uint8_t flag)
-{
-    g_resume_touch_flag = flag;
-}
-
-static void mem_retention_config(switch_type_t on)
-{
-    if (on != 0) {
-        // l2m_gmmu
-        writel(0x57004040, 0);
-
-        // l2m_dsp
-        writel(0x57004050, 0);
-
-        // com_mem
-        reg16_clrbit(0x57004074, 0);
-        // xip mem
-        reg16_clrbit(0x57004900, 0);
-        reg16_clrbit(0x57004900, 4);
-    } else {
-        // l2m_gmmu
-        writel(0x57004040, 0xfff);
-
-        // l2m_dsp
-        writel(0x57004050, 0x3ff);
-
-        // com_mem
-        reg16_setbit(0x57004074, 0);
-        // xip mem
-        reg16_setbit(0x57004900, 0);
-        reg16_setbit(0x57004900, 4);
-    }
-}
-
-void pin_of_poweroff_suspend(void)
-{
-    uint32_t base_addr = 0;
-    // egpio
-    for (base_addr = 0x5700ce00; base_addr <= 0x5700ce64; base_addr += 4) {
-        reg16_clrbit(base_addr, 1);
-    }
-    // hgpio
-    for (base_addr = 0x5700d200; base_addr <= 0x5700d23c; base_addr += 4) {
-        reg16_clrbit(base_addr, 1);
-    }
-    // mgpio
-    for (base_addr = 0x5700ca00; base_addr <= 0x5700ca98; base_addr += 4) {
-        if (base_addr == 0x5700ca50 || base_addr == 0x5700ca88) {
-            continue;
-        }
-        reg16_clrbit(base_addr, 1);
-    }
-}
-
-void pin_of_poweroff_resume(void)
-{
-    size_t pin_num;
-    hal_pio_config_t *pio_func = NULL;
-    get_pio_func_config(&pin_num, &pio_func);
-
-    for (pin_t i = S_EGPIO0; i < S_MGPIO38; i++) {
-        if (pio_func[i].ie != HAL_PIO_IE_MAX) {
-            uapi_pin_set_ie(i, (pin_input_enable_t)pio_func[i].ie);
-        }
-    }
-}
-
-void pin_of_poweron_suspend(void)
-{
-    uint32_t base_addr = 0;
-    // agpio l
-    for (base_addr = 0x5700c600; base_addr <= 0x5700c680; base_addr += 4) {
-        if (base_addr == 0x5700c60c || base_addr == 0x5700c610 || base_addr == 0x5700c628) {
-            continue;
-        }
-        reg16_clrbit(base_addr, 1);
-    }
-    // agpio r
-    for (base_addr = 0x5700da00; base_addr <= 0x5700da28; base_addr += 4) {
-        if (base_addr == 0x5700da14) { // S_AGPIO_R5 touch int
-            continue;
-        }
-        reg16_clrbit(base_addr, 1);
-    }
-
-    // ulp gpio
-    for (base_addr = 0x5702c200; base_addr <= 0x5702c210; base_addr += 4) {
-        reg16_clrbit(base_addr, 1);
-    }
-}
-
-static void clk_pll_en_tmp(void)
-{
-    // pll_clk_en
-    writew(0x57008020, 0x1);
-    // select fbdiv_man
-    writew(0x57008620, 0x1);
-    // set pll fbdiv man
-    writew(0x57008610, 0x37);
-    // sel frac man
-    writew(0x57008624, 0x1);
-    // set PLL_FRAC_MAN_H
-    writew(0x57008614, 0x4b);
-    // set PLL_FRAC_MAN_L
-    writew(0x57008618, 0xc6ab);
-    // set POSTDIV
-    writew(0x570082c4, 0xa);
-    // pull pd
-    writew(0x570082C8, 0x0);
-    // readback lock stat: 0x1 is stable
-    while (regw_getbits(0x57008000, 0x2d8, 0, 0x1) != 1) {
-    };
-}
-
-void clk_switch_to_rc(void)
-{
-    // disable GLB_CLKEN
-    writew(0x55000608, 0x0);
-
-    if (reg16_getbit(0x520003e0, 0x6) == 0x0) {
-        // mcu ch1 to xo
-        writew(0x55000610, 0x1);
-        // mcu core switch to ch1
-        reg16_setbit(0x520003e0, 0x6);
-        // mcu ch0 to xo
-        writew(0x5500060c, 0x1);
-    } else {
-        // mcu ch0 to xo
-        writew(0x5500060c, 0x1);
-        // mcu core switch to ch0
-        reg16_clrbit(0x520003e0, 0x6);
-        // mcu ch1 to xo
-        writew(0x55000610, 0x1);
-    }
-
-    // set mcu_bus_div is no div
-    writew(0x55000604, 0x0);
-    writew(0x55000604, 0x3);
-
-    // clk_mcu_perp_ls=clk_rc
-    writew(0x55000614, 0x3);
-    // clk_mcu_perp_uart=clk_rc
-    writew(0x55000618, 0x3);
-    // clk_mcu_perp_spi=clk_rc
-    writew(0x5500061c, 0x1);
-
-    if (reg16_getbit(0x55000af0, 0x0) == 0x1) {
-        // set com bus ch0 to rc
-        writew(0x55000620, 0x1);
-        // com bus switch to ch0
-        reg16_clrbit(0x55000af0, 0x0);
-        // set com bus ch1 to rc
-        writew(0x55000624, 0x1);
-    } else {
-        // set com bus ch1 to rc
-        writew(0x55000624, 0x1);
-        // com bus switch to ch1
-        reg16_setbit(0x55000af0, 0x0);
-        // set com bus ch0 to rc
-        writew(0x55000620, 0x1);
-    }
-
-    // set clk_sdiom=clk_rc
-    writew(0x55000628, 0x1);
-    // clk_mem_bus=clk_rc
-    writew(0x5500062C, 0x1);
-    // clk_xip_opi=clk_rc
-    writew(0x55000630, 0x1);
-    // clk_xip_qspi=clk_rc
-    writew(0x55000634, 0x1);
-    // clk_gpu=clk_rc
-    writew(0x55000638, 0x1);
-
-    if (reg16_getbit(0x55000af0, 0x1) == 0x1) {
-        // set hifi ch0 to rc
-        writew(0x5500063c, 0x1);
-        // hifi switch to ch0
-        reg16_clrbit(0x55000af0, 0x1);
-        // set com bus ch1 to rc
-        writew(0x55000640, 0x1);
-    } else {
-        // set hifi bus ch1 to rc
-        writew(0x55000640, 0x1);
-        // hifi switch to ch1
-        reg16_setbit(0x55000af0, 0x1);
-        // set hifi bus ch0 to rc
-        writew(0x5500063c, 0x1);
-    }
-
-    if (reg16_getbit(0x55000af0, 0x2) == 0x1) {
-        // set codec ch0 to rc
-        writew(0x55000644, 0x1);
-        // codec switch to ch0
-        reg16_clrbit(0x55000af0, 0x2);
-        // set codec ch1 to rc
-        writew(0x55000648, 0x1);
-    } else {
-        // set codec ch1 to rc
-        writew(0x55000648, 0x1);
-        // codec switch to ch1
-        reg16_setbit(0x55000af0, 0x2);
-        // set codec ch0 to rc
-        writew(0x55000644, 0x1);
-    }
-
-    // enable GLB_CLKEN
-    writew(0x55000608, 0x3ffe);
-}
-
-void clocks_switch_case_09v(void)
-{
-    writew(0x55000608, 0x0); // close C_CRG(except clk_mcu_core)
-    writew(0x55000604, 0x0); // mcu_bus div en = 0
-    writew(0x55000604, 0x5); // mcu bus 2 分频 div_en=1
-    if (reg16_getbit(0x520003e0, 0x6) == 0x0) {
-        // mcu ch1 to xo
-        writew(0x55000610, 0x97);
-        // mcu core switch to ch1
-        reg16_setbit(0x520003e0, 0x6);
-        // mcu ch0 to xo
-        writew(0x5500060c, 0x3);
-    } else {
-        // mcu ch0 to xo
-        writew(0x5500060c, 0x97);
-        // mcu core switch to ch0
-        reg16_clrbit(0x520003e0, 0x6);
-        // mcu ch1 to xo
-        writew(0x55000610, 0x3);
-    }
-
-    writew(0x55000614, 0x3); // clk_mcu_perp_ls = clk_xo
-    writew(0x5500061C, 0x97); // clk_mcu_perp_spi=clk_pll/11
-    if (reg16_getbit(0x55000af0, 0x0) == 0x0) {
-        // set combus ch1 to xo
-        writew(0x55000624, 0xf7);
-        // combus switch to ch1
-        reg16_setbit(0x55000af0, 0x0);
-        // set combus ch0 to xo
-        writew(0x55000620, 0x3);
-    } else {
-        // set combus bus ch0 to xo
-        writew(0x55000620, 0xf7);
-        // combus switch to ch0
-        reg16_clrbit(0x55000af0, 0x0);
-        // set combus bus ch0 to xo
-        writew(0x55000624, 0x3);
-    }
-    writew(0x55000628, 0x77); // clk_sdiom=clk_pll/3
-    writew(0x5500062C, 0xB7); // clk_mem_bus=clk_pll/5
-    writew(0x55000630, 0x77); // clk_xip_opi=clk_pll/3
-    writew(0x55000634, 0x97); // clk_xip_qspi=clk_pll/4
-    writew(0x55000638, 0xD7); // clk_gpu=clk_pll/6
-    if (reg16_getbit(0x55000af0, 0x1) == 0x0) {
-        // set hifi ch1 to xo
-        writew(0x55000640, 0x77);
-        // hifi switch to ch1
-        reg16_setbit(0x55000af0, 0x1);
-        // set hifi ch0 to xo
-        writew(0x5500063c, 0x3);
-    } else {
-        // set hifi bus ch0 to xo
-        writew(0x5500063c, 0x77);
-        // hifi switch to ch0
-        reg16_clrbit(0x55000af0, 0x1);
-        // set hifi bus ch0 to xo
-        writew(0x55000640, 0x3);
-    }
-    if (reg16_getbit(0x55000af0, 0x2) == 0x0) {
-        // set codec ch1 to xo
-        writew(0x55000648, 0x497);
-        // codec switch to ch1
-        reg16_setbit(0x55000af0, 0x2);
-        // set codec ch0 to xo
-        writew(0x55000644, 0x3);
-    } else {
-        // set codec bus ch0 to xo
-        writew(0x55000644, 0x497);
-        // codec switch to ch0
-        reg16_clrbit(0x55000af0, 0x2);
-        // set codec bus ch0 to xo
-        writew(0x55000648, 0x3);
-    }
-    writew(0x55000608, 0x3FFE); // open C_CRG clock output
-}
-
-static void clock_gpu_hifi_to_xo_dll2(void)
-{
-    // 动态调频,必须保证两路channel都必须有时钟,要不就出现挂死
-    if (reg16_getbit(0x55000af0, 0x1) == 0x1) {
-        // set hifi ch0 to xo
-        writew(0x5500063c, 0x5);
-        // hifi switch to ch0
-        reg16_clrbit(0x55000af0, 0x1);
-        // set hifi ch1 to xo
-        writew(0x55000640, 0x5);
-    } else {
-        // set hifi bus ch1 to xo
-        writew(0x55000640, 0x5);
-         // hifi switch to ch1
-        reg16_setbit(0x55000af0, 0x1);
-         // set hifi bus ch0 to xo
-        writew(0x5500063c, 0x5);
-    }
-
-    if (reg16_getbit(0x55000af0, 0x2) == 0x1) {
-         // set codec ch0 to xo
-        writew(0x55000644, 0x5);
-         // codec switch to ch0
-        reg16_clrbit(0x55000af0, 0x2);
-         // set codec ch1 to xo
-        writew(0x55000648, 0x5);
-    } else {
-         // set codec ch1 to xo
-        writew(0x55000648, 0x5);
-         // codec switch to ch1
-        reg16_setbit(0x55000af0, 0x2);
-         // set codec ch0 to xo
-        writew(0x55000644, 0x5);
-    }
-}
-
-void clk_switch_to_xo_dll2(void)
-{
-    // disable GLB_CLKEN
-    writew(0x55000608, 0x0);
-    writew(0x520003f0, 0x1); // config to switch the channel of mcu
-    if (reg16_getbit(0x520003e0, 0x6) == 0x0) {
-        // mcu ch1 to xo
-        writew(0x55000610, 0x5);
-        // mcu core switch to ch1
-        reg16_setbit(0x520003e0, 0x6);
-        // mcu ch0 to xo
-        writew(0x5500060c, 0x5);
-    } else {
-        // mcu ch0 to xo
-        writew(0x5500060c, 0x5);
-        // mcu core switch to ch0
-        reg16_clrbit(0x520003e0, 0x6);
-        // mcu ch1 to xo
-        writew(0x55000610, 0x5);
-    }
-
-    // set mcu_bus_div is no div
-    writew(0x55000604, 0x0);
-    writew(0x55000604, 0x3);
-
-    // clk_mcu_perp_ls=clk_xo_dll2
-    writew(0x55000614, 0x3);
-    // clk_mcu_perp_uart=clk_xo_dll2
-    writew(0x55000618, 0x3);
-    // clk_mcu_perp_spi=clk_xo_dll2
-    writew(0x5500061c, 0x5);
-
-    if (reg16_getbit(0x55000af0, 0x0) == 0x0) {
-        // set com bus ch1 to xo(32M)
-        writew(0x55000624, 0x5);
-        // switch com bus ch1
-        reg16_setbit(0x55000af0, 0x0);
-        // set com bus ch0 to xo
-        writew(0x55000620, 0x5);
-    } else {
-        // set com bus ch0 to xo(32M)
-        writew(0x55000620, 0x5);
-        // switch com bus ch1
-        reg16_clrbit(0x55000af0, 0x0);
-        // set com bus ch0 to xo
-        writew(0x55000624, 0x5);
-    }
-
-    // set clk_sdiom=clk_xo  默认就是0
-    writew(0x55000628, 0x5);
-    // clk_mem_bus=clk_xo
-    writew(0x5500062C, 0x5);
-    // clk_xip_opi=clk_xo
-    writew(0x55000630, 0x5);
-    // clk_xip_qspi=clk_xo
-    writew(0x55000634, 0x5);
-    clock_gpu_hifi_to_xo_dll2();
-    // enable GLB_CLKEN
-    writew(0x55000608, 0x3ffe);
-    // tcxo cnt enable, 是否睡眠自己掉电
-    reg16_setbit(0x55000580, 2); // enable tcxo
-}
-
-void uart_h0_suspend_tmp(void)
-{
-    uart_save_reg(UART_BUS_0);
-}
-
-void uart_h0_resume_tmp(void)
-{
-    uart_recovery_reg(UART_BUS_0);
-}
-
-void uart_h1_suspend_tmp(void)
-{
-    uart_save_reg(UART_BUS_1);
-}
-
-void uart_h1_resume_tmp(void)
-{
-    uart_recovery_reg(UART_BUS_1);
-}
-
-void qspi0_suspend_tmp(void)
-{
-    uapi_flash_exit_from_xip_mode(FLASH_1);
-    hal_xip_set_cur_mode((xip_id_t)FLASH_1, XIP_MODE_DISABLE);
-    spi_save_reg(SPI_BUS_3); // QSPI0 for norflash
-    uapi_flash_switch_to_deeppower(FLASH_1);
-    reg16_setbit(QSPI0_FLASH_CS0_PAD, PAD_PE_BIT);
-    reg16_setbit(QSPI0_FLASH_CS0_PAD, PAD_PS_BIT); // make CS to high in deepsleep.
-}
-
-void qspi0_resume_tmp(void)
-{
-    // qspi0 pinmux restore
-    writew(QSPI0_FLASH_D0_PIN, PIN_FUNC_QSPI0);
-    writew(QSPI0_FLASH_D1_PIN, PIN_FUNC_QSPI0);
-    writew(QSPI0_FLASH_D2_PIN, PIN_FUNC_QSPI0);
-    writew(QSPI0_FLASH_D3_PIN, PIN_FUNC_QSPI0);
-    writew(QSPI0_FLASH_CLK_PIN, PIN_FUNC_QSPI0);
-    writew(QSPI0_FLASH_CS0_PIN, PIN_FUNC_QSPI0);
-    reg16_setbit(QSPI0_FLASH_D0_PAD, PAD_IE_BIT);
-    reg16_setbit(QSPI0_FLASH_D1_PAD, PAD_IE_BIT);
-    reg16_setbit(QSPI0_FLASH_D2_PAD, PAD_IE_BIT);
-    reg16_setbit(QSPI0_FLASH_D3_PAD, PAD_IE_BIT);
-    reg16_setbit(QSPI0_FLASH_CLK_PAD, PAD_IE_BIT);
-    reg16_setbit(QSPI0_FLASH_CS0_PAD, PAD_IE_BIT);
-    reg16_clrbit(QSPI0_FLASH_CS0_PAD, PAD_PS_BIT);
-    reg16_clrbit(QSPI0_FLASH_CS0_PAD, PAD_PE_BIT); // make CS to pull none in normal.
-
-    spi_recovery_reg(SPI_BUS_3); // QSPI0 for norflash
-    uapi_flash_resume_from_deeppower(FLASH_1);
-    uapi_flash_switch_to_cache_mode(0);
-    if (readb(FLASH_START) != 0x6f) {
-        PRINT("Enter XIP with value: 0x%x failed\r\n", readw(FLASH_START) == 0x6f);
-    }
-}
-
-void storage_device_suspend(void)
-{
-#ifdef CFG_DRIVERS_NANDFLASH
-    reg16_setbit(QSPI1_NANDFLASH_CS0_PAD, PAD_PS_BIT);
-    reg16_setbit(QSPI1_NANDFLASH_CS0_PAD, PAD_PE_BIT); // make CS1 to high in deepsleep.
-#elif defined (CFG_DRIVERS_MMC)
-    emmc_save_info();
-#endif
-}
-
-void storage_device_resume(void)
-{
-#ifdef CFG_DRIVERS_NANDFLASH
-    nandflash_qspi_resume();
-    reg16_clrbit(QSPI1_NANDFLASH_CS0_PAD, PAD_PS_BIT);
-    reg16_clrbit(QSPI1_NANDFLASH_CS0_PAD, PAD_PE_BIT); // make CS1 to pull none in normal.
-#endif
-}
-
-void opi_psram_suspend_tmp(void)
-{
-#ifdef CONFIG_PSRAM_SUPPORT
-    uapi_psram_exit_xip();
-    uapi_psram_enter_sleep();
-    spi_save_reg(SPI_BUS_6); // QSPI0 for norflash
-    reg16_setbit(OPI_PSRAM_CE_PAD, PAD_PE_BIT);
-    reg16_setbit(OPI_PSRAM_CE_PAD, PAD_PS_BIT); // make CS to high in deepsleep.
-#endif
-}
-
-void opi_psram_resume_tmp(void)
-{
-#ifdef CONFIG_PSRAM_SUPPORT
-    spi_recovery_reg(SPI_BUS_6); // QSPI0 for norflash
-    uapi_psram_exit_sleep();
-    uapi_psram_enter_xip();
-    reg16_clrbit(OPI_PSRAM_CE_PAD, PAD_PS_BIT);
-    reg16_clrbit(OPI_PSRAM_CE_PAD, PAD_PE_BIT); // make CS to pull none in normal.
-#endif
-}
-
-void touch_suspend_tmp(void)
-{
-    touch_peripheral_api *touch_ptr = touch_screen_get_api();
-    ext_errno ret = touch_ptr->touch_sleep();
-    if (ret != EXT_ERR_SUCCESS) { PRINT("touch sleep ret=0x%x", ret); }
-    i2c_save_reg(I2C_BUS_1);
-    uapi_gpio_disable_interrupt(S_AGPIO_R5); // close tp_int gpio interrupt
-}
-
-void touch_resume_tmp(void)
-{
-    uapi_gpio_disable_interrupt(S_AGPIO_R5); // close tp_int gpio interrupt
-    i2c_recovery_reg(I2C_BUS_1);
-    writew(0x5700da14, 0x2);  // open touch int ie(s_agpio_r5)
-#if defined(TPTYPE_TMA525B)
-    tma525b_init();
-    touch_peripheral_api *touch_ptr = (touch_peripheral_api*)touch_screen_get_api();
-    ext_errno ret = touch_ptr->touch_resume();
-    if (ret != EXT_ERR_SUCCESS) { PRINT("touch resume ret=0x%x", ret); }
-#elif defined(TPTYPE_ZTW523)
-    ztw523_resume();
-#elif defined(TPTYPE_FT6X46)
-    ztw523_init();
-#else
-    ztw523_resume();
-#endif
-    uapi_gpio_enable_interrupt(S_AGPIO_R5); // open tp_int gpio interrupt
-}
-
-void touch_suspend_for_i2c(void)
-{
-    i2c_save_reg(I2C_BUS_1);
-}
-
-static void touch_resume_for_i2c(void)
-{
-    i2c_recovery_reg(I2C_BUS_1);
-    writew(0x5700da14, 0x2);  // open touch int ie(s_agpio_r5)
-}
-
-void touch_restart(void)
-{
-    uapi_i2c_deinit(I2C_BUS_1);
-    uapi_i2c_master_init(I2C_BUS_1, 400000, 0); /* 400000: 400KHz */
-    writew(0x5700da14, 0x2);  // open touch int ie(s_agpio_r5)
-#if defined(TPTYPE_TMA525B)
-    tma525b_resume();
-#elif defined(TPTYPE_ZTW523)
-    ztw523_resume();
-#else
-    ztw523_resume();
-#endif
-    uapi_gpio_enable_interrupt(S_AGPIO_R5); // open tp_int gpio interrupt
-}
-
-void dsp_resume_tmp(void)
-{
-    reg16_setbit(0x5700c634, 0x1);
-    reg16_setbit(0x5700c638, 0x1);
-    reg16_setbit(0x5700c63c, 0x1);
-    reg16_setbit(0x5700c640, 0x1);
-    reg16_setbit(0x5700c604, 0x1);  // pdm amic ie enable
-    reg16_setbit(0x5700c608, 0x1);  // pdm dmic ie enable
-#if (defined BRANDY_PRODUCT_EVB4) // i2c pinmux config
-    reg16_setbit(0x5700ca44, 0x1);
-    reg16_setbit(0x5700ca48, 0x1);
-#else
-    reg16_setbit(0x5700ca2c, 0x1);
-    reg16_setbit(0x5700ca30, 0x1);
-#endif
-    pmu1_dsp_l2ram_config(DSP_L2RAM_AREA_SIZE); // set l2ram for dsp
-    reg16_setbit(0x52000020, 0x3); // enable dsp to mcu ipc int0&int1
-}
-
-void display_resume_power_on(void)
-{
-    if (g_display_pwr_on_for_pm == false) {
-        uapi_pm_control(PM_DISPLAY_POWER_UP_AND_RUN);
-        g_display_pwr_on_for_pm = true;
-    }
-}
-
-void display_suspend_power_off(void)
-{
-    g_display_pwr_on_for_pm = false;
-}
-
-void display_suspend_tmp(void)
-{
-    if (g_resume_touch_flag != 0) { touch_suspend_for_i2c(); }
-    int ret = drv_vau_suspend(NULL);
-    if (ret != 0) { PRINT("drv vau suspend ret =%d\n", ret); }
-#ifndef QSPI_DISPLAY
-    ret = drv_dpu_suspend(NULL);
-    if (ret != 0) { PRINT("drv dpu suspend ret =%d\n", ret); }
-#endif
-#ifdef SUPPORT_GPU_GMMU
-    ret = drv_gmmu_suspend(NULL);
-    if (ret != 0) { PRINT("drv_gmmu_suspend ret =%d\n", ret); }
-#endif
-    lcd_bus_api *bus_api = lcd_get_bus_api();
-    ret = bus_api->bus_suspend();
-    if (ret != 0) { PRINT("bus suspend ret =%d\n", ret); }
-#ifndef QSPI_DISPLAY
-    pmu_ldo_power_on(PMU_LDO_AUXLDO3, TURN_OFF);
-    hal_pmu_auxldo_enable_high_resistance(HAL_PMU_AUXLDO3, TURN_ON);
-#endif
-    writew(0x570000c0, 0);  // display logic crg reset
-    writew(0x57004034, 0x100);  // display close power
-}
-
-void display_resume_tmp(void)
-{
-#ifndef QSPI_DISPLAY
-    pmu_ldo_power_on(PMU_LDO_AUXLDO3, TURN_ON);
-#endif
-    display_resume_power_on();
-    writew(0x5700c658, 0x2); // sagpio_l22 open ie
-    lcd_bus_api *bus_api = lcd_get_bus_api();
-    int ret = bus_api->bus_resume();
-    if (ret != 0) { PRINT("bus resume ret =%d\n", ret); }
-#ifndef QSPI_DISPLAY
-    ret = drv_dpu_resume(NULL);
-    if (ret != 0) { PRINT("drv dpu resume ret =%d\n", ret); }
-#endif
-    ret = drv_vau_resume(NULL);
-    if (ret != 0) { PRINT("drv vau resume ret =%d\n", ret); }
-#ifdef SUPPORT_GPU_GMMU
-    ret = drv_gmmu_resume(NULL);
-    if (ret != 0) { PRINT("drv_gmmu_resume ret =%d\n", ret); }
-#endif
-    if (g_resume_touch_flag != 0) { touch_resume_for_i2c(); }
-}
-
-void pm_misc_regs_resume(void)
-{
-#ifdef CFG_DRIVERS_NANDFLASH
-    reg16_clrbit(PM_SD_HOST_CCLK_DIV_REG, 0); // close sd host clock enable.
-    reg16_clrbit(PM_EMMC_CCLK_DIV_REG, 0); // close sd mmc clock enable.
-#endif
-#ifdef CFG_DRIVERS_MMC
-    reg16_clrbit(PM_SD_HOST_CCLK_DIV_REG, 0); // close sd host clock enable.
-#endif
-}
\ No newline at end of file