添加hx3918驱动
authorp15692025051 <846603105@qq.com>
Tue, 8 Aug 2023 03:12:30 +0000 (11:12 +0800)
committerp15692025051 <846603105@qq.com>
Tue, 8 Aug 2023 03:12:30 +0000 (11:12 +0800)
25 files changed:
2.sdk/Helios_SDK/components/HX3918/HX3918.mk [new file with mode: 0644]
2.sdk/Helios_SDK/components/HX3918/HX3918_option.in [new file with mode: 0644]
2.sdk/Helios_SDK/components/HX3918/hx3918.c [new file with mode: 0644]
2.sdk/Helios_SDK/components/HX3918/hx3918.h [new file with mode: 0644]
2.sdk/Helios_SDK/components/HX3918/hx3918_check_touch.c [new file with mode: 0644]
2.sdk/Helios_SDK/components/HX3918/hx3918_check_touch.h [new file with mode: 0644]
2.sdk/Helios_SDK/components/HX3918/hx3918_factory_test.c [new file with mode: 0644]
2.sdk/Helios_SDK/components/HX3918/hx3918_factory_test.h [new file with mode: 0644]
2.sdk/Helios_SDK/components/HX3918/hx3918_hrs_agc.c [new file with mode: 0644]
2.sdk/Helios_SDK/components/HX3918/hx3918_hrs_agc.h [new file with mode: 0644]
2.sdk/Helios_SDK/components/HX3918/hx3918_hrv_agc.c [new file with mode: 0644]
2.sdk/Helios_SDK/components/HX3918/hx3918_hrv_agc.h [new file with mode: 0644]
2.sdk/Helios_SDK/components/HX3918/hx3918_prox.c [new file with mode: 0644]
2.sdk/Helios_SDK/components/HX3918/hx3918_prox.h [new file with mode: 0644]
2.sdk/Helios_SDK/components/HX3918/hx3918_spo2_agc.c [new file with mode: 0644]
2.sdk/Helios_SDK/components/HX3918/hx3918_spo2_agc.h [new file with mode: 0644]
2.sdk/Helios_SDK/components/HX3918/lib/gcc_3918lib_hrs_spo2_20230731_v0.1.a [new file with mode: 0644]
2.sdk/Helios_SDK/components/HX3918/tyhx_hrs_alg.h [new file with mode: 0644]
2.sdk/Helios_SDK/components/HX3918/tyhx_hrv_alg.h [new file with mode: 0644]
2.sdk/Helios_SDK/components/HX3918/tyhx_spo2_alg.h [new file with mode: 0644]
2.sdk/Helios_SDK/services/microPython/lib/lvgl/lv_conf.h
2.sdk/Helios_SDK/services/microPython/lib/lvgl/src/hal/lv_hal_indev.h
2.sdk/Helios_SDK/services/microPython/microPython.mk
2.sdk/Helios_SDK/services/microPython/ports/quectel/core/source/modHsensor.c
2.sdk/Helios_SDK/services/microPython/ports/quectel/core/source/modHsensor_GH3018.c

diff --git a/2.sdk/Helios_SDK/components/HX3918/HX3918.mk b/2.sdk/Helios_SDK/components/HX3918/HX3918.mk
new file mode 100644 (file)
index 0000000..bf9a959
--- /dev/null
@@ -0,0 +1,35 @@
+NAME := HX3918
+
+include config/$(KCONFIG_CONFIG)
+
+GLOBAL_INCS = include
+
+$(NAME)_SRCS += \
+       hx3918.c \
+    hx3918_check_touch.c \
+    hx3918_factory_test.c \
+    hx3918_hrs_agc.c \
+    hx3918_hrv_agc.c \
+    hx3918_prox.c \
+    hx3918_spo2_agc.c 
+
+GLOBAL_INCS += \
+       . \
+
+ifeq ($(CONFIG_HX3918), y)
+
+$(NAME)_ARCHIVES := \
+       lib/gcc_3918lib_hrs_spo2_20230731_v0.1.a 
+
+endif
+
+
+$(NAME)_CFLAGS = \
+       -Wno-error \
+       -Wno-unused-but-set-variable
+       
+
+
+$(NAME)_COMPONENTS = peripheral
+
+
diff --git a/2.sdk/Helios_SDK/components/HX3918/HX3918_option.in b/2.sdk/Helios_SDK/components/HX3918/HX3918_option.in
new file mode 100644 (file)
index 0000000..cf8ad16
--- /dev/null
@@ -0,0 +1,9 @@
+config HX3918 
+    bool "Enable HX3918" 
+    default y 
+help 
+    This is HX3918 support.
+
+
+
+
diff --git a/2.sdk/Helios_SDK/components/HX3918/hx3918.c b/2.sdk/Helios_SDK/components/HX3918/hx3918.c
new file mode 100644 (file)
index 0000000..edf89aa
--- /dev/null
@@ -0,0 +1,1134 @@
+
+#include <stdio.h>
+#include <stdbool.h>
+#include <stdint.h>
+#include <stdlib.h>
+#include <math.h>
+#include "hx3918.h"
+
+#include "helios_gpio.h"
+#include "helios_iic.h"
+#include "helios_lcd.h"
+#include "helios_fs.h"
+#include "helios_pin.h"
+#include "helios_debug.h"
+
+#define HX3918_ADDR 0x44
+#define HX3918_DEBUG  1
+#if HX3918_DEBUG == 1
+#define HX3918_LOG(msg, ...)      custom_log("HX3918", msg, ##__VA_ARGS__)
+#endif
+//#include "tyhx_hrs_custom.h"
+#ifdef SAR_ALG_LIB
+#include "hx3918_prox.h"
+#endif
+
+#ifdef HRS_ALG_LIB
+#include "hx3918_hrs_agc.h"
+#include "tyhx_hrs_alg.h"
+
+#ifdef SPO2_ALG_LIB
+#include "hx3918_spo2_agc.h"
+#include "tyhx_spo2_alg.h"
+#endif
+
+#ifdef HRV_ALG_LIB
+#include "hx3918_hrv_agc.h"
+#include "tyhx_hrv_alg.h"
+#endif
+
+#ifdef CHECK_TOUCH_LIB
+#include "hx3918_check_touch.h"
+#endif
+#include "hx3918_factory_test.h"
+
+
+
+#ifdef SPO2_VECTOR
+#include "spo2_vec.h"
+uint32_t spo2_send_cnt = 0;
+int32_t red_buf_vec[8];
+int32_t ir_buf_vec[8];
+int32_t green_buf_vec[8];
+#endif
+
+#ifdef HR_VECTOR
+#include "hr_vec.h"
+uint32_t hrs_send_cnt = 0;
+int32_t PPG_buf_vec[8];
+#endif
+
+#ifdef HRV_TESTVEC
+#include "hrv_testvec.h"
+#endif
+
+#ifdef GSENSER_DATA
+//#include "lis3dh_drv.h"
+#endif
+tyhx_hrsresult_t hrsresult;
+
+#ifdef GSENSER_DATA
+volatile int16_t gsen_fifo_x[32];  //ppg time 330ms..330/40 = 8.25
+volatile int16_t gsen_fifo_y[32];
+volatile int16_t gsen_fifo_z[32];
+#else
+int16_t gen_dummy[32] = {0};
+#endif
+//SPO2 agc
+const uint8_t  hx3918_spo2_agc_green_idac = GREEN_AGC_OFFSET;
+const uint8_t  hx3918_spo2_agc_red_idac = RED_AGC_OFFSET;
+const uint8_t  hx3918_spo2_agc_ir_idac = IR_AGC_OFFSET;
+//hrs agc
+const uint8_t  hx3918_hrs_agc_idac = HR_GREEN_AGC_OFFSET;
+//hrv agc
+const uint8_t  hx3918_hrv_agc_idac = HR_GREEN_AGC_OFFSET;
+
+const uint8_t  red_led_max_init = 200;
+const uint8_t  ir_led_max_init = 200;
+const uint8_t  green_led_max_init = 150;
+
+uint8_t low_vbat_flag =0;
+//WORK_MODE_T work_mode_flag = HRS_MODE;
+
+const uint16_t static_thre_val = 150;
+const uint8_t  gsen_lv_val = 0;
+
+//HRS_INFRARED_THRES
+const int32_t  hrs_ir_unwear_thres = 3000;
+const int32_t  hrs_ir_wear_thres = 4000;
+//HRV_INFRARED_THRES
+const int32_t  hrv_ir_unwear_thres = 3000;
+const int32_t  hrv_ir_wear_thres = 4000;
+//SPO2_INFRARED_THRES
+const uint8_t  spo2_check_unwear_oft = 10;
+const int32_t  spo2_ir_wear_thres = 2000;
+//CHECK_WEAR_MODE_THRES
+const int32_t  check_mode_unwear_thre = 3000;
+const int32_t  check_mode_wear_thre = 4000;
+//const int32_t  check_mode_sar_thre = 6000;
+
+//const int32_t  sar_unwear_thres = 2000;
+//const int32_t  sar_wear_thres = 3000;
+
+uint8_t alg_ram[11 * 1024] __attribute__((aligned(4)));
+ppg_sensor_data_t ppg_s_dat;
+uint8_t read_fifo_first_flg = 0;
+hrs_sports_mode_t hrs_mode = NORMAL_MODE;
+#endif
+
+//////// spo2 para and switches
+const  uint8_t   COUNT_BLOCK_NUM = 50;            //delay the block of some single good signal after a series of bad signal
+const  uint8_t   SPO2_LOW_XCORR_THRE = 30;        //(64*xcorr)'s square below this threshold, means error signal
+const  uint8_t   SPO2_CALI = 1;                       //spo2_result cali mode
+const  uint8_t   XCORR_MODE = 1;                  //xcorr mode switch
+const  uint8_t   QUICK_RESULT = 1;                //come out the spo2 result quickly ;0 is normal,1 is quick
+const  uint16_t  MEAN_NUM = 32;                  //the length of smooth-average ;the value of MEAN_NUM can be given only 256 and 512
+const  uint8_t   G_SENSOR = 0;                      //if =1, open the gsensor mode
+const  uint8_t   SPO2_GSEN_POW_THRE = 150;         //gsen pow judge move, range:0-200;
+const  uint32_t  SPO2_BASE_LINE_INIT = 135000;    //spo2 baseline init, = 103000 + ratio(a variable quantity,depends on different cases)*SPO2_SLOPE
+const  int32_t   SOP2_DEGLITCH_THRE = 100000;     //remove signal glitch over this threshold
+const  int32_t   SPO2_REMOVE_JUMP_THRE = 100000;  //remove signal jump over this threshold
+const  uint32_t  SPO2_SLOPE = 50000;              //increase this slope, spo2 reduce more
+const  uint16_t  SPO2_LOW_CLIP_END_TIME = 1500;   //low clip mode before this data_cnt, normal clip mode after this
+const  uint16_t  SPO2_LOW_CLIP_DN  = 150;         //spo2 reduce 0.15/s at most in low clip mode
+const  uint16_t  SPO2_NORMAL_CLIP_DN  = 500;      //spo2 reduce 0.5/s at most in normal clip mode
+const  uint8_t   SPO2_LOW_SNR_THRE = 40;          //snr below this threshold, means error signal
+const  uint16_t  IR_AC_TOUCH_THRE = 200;          //AC_min*0.3
+const  uint16_t  IR_FFT_POW_THRE = 200;           //fft_pow_min
+const  uint8_t   SLOPE_PARA_MAX = 30;
+const  uint8_t   SLOPE_PARA_MIN = 3;
+
+WORK_MODE_T work_mode_flag = HRV_MODE;
+void display_refresh(void)
+{
+
+}
+void hx3918_delay_us(uint32_t us)
+{
+#ifdef  TYHX_DEMO
+    nrf_delay_us(us);
+#endif
+    if(us < 1000)
+        us =1000;
+    Helios_msleep(us/1000);
+}
+
+void hx3918_delay(uint32_t ms)
+{
+#ifdef  TYHX_DEMO
+    nrf_delay_ms(ms);
+#endif
+    Helios_msleep(ms);
+}
+
+//Timer interrupt 40ms repeat mode
+void gsen_read_timeout_handler(void * p_context)
+{
+    hx3918_agc_Int_handle();
+#ifdef GSEN_40MS_TIMMER
+    hx3918_gesensor_Int_handle();
+#endif
+
+#ifdef LAB_TEST_INT_MODE
+    if(work_mode_flag == LAB_TEST_MODE)// add ericy 20210127
+    {
+        hx3690l_lab_test_read();
+    }
+#endif
+}
+
+
+bool hx3918_write_reg(uint8_t addr, uint8_t data)
+{
+#ifdef  TYHX_DEMO
+    uint8_t data_buf[2];    
+    data_buf[0] = addr;
+    data_buf[1] = data;
+    twi_pin_switch(1);
+    twi_master_transfer(0x88, data_buf, 2, true);    //write    
+#endif
+    if(HELIOS_I2C_Write(0, HX3918_ADDR, &addr, 1, &data, 1) != 0)
+       {
+               
+               //GH301x_LOG("hal_gh30x_i2c_write:error\r\n");
+       }
+    return true;
+}
+
+uint8_t hx3918_read_reg(uint8_t addr)
+{
+    uint8_t data_buf = 0;  
+#ifdef  TYHX_DEMO
+     twi_pin_switch(1);
+    twi_master_transfer(0x88, &addr, 1, false);      //write
+    twi_master_transfer(0x89, &data_buf, 1, true);//read
+#endif
+    if(HELIOS_I2C_Read(0, HX3918_ADDR, &addr, 1, (void*)&data_buf, 1, 0) != 0)
+       {
+               //GH301x_LOG("hal_gh30x_i2c_read:error\r\n");
+               
+       }
+    return data_buf;
+}
+
+bool hx3918_brust_read_reg(uint8_t addr, uint8_t *buf, uint8_t length)
+{
+#ifdef  TYHX_DEMO
+       twi_pin_switch(1);
+    twi_master_transfer(0x88, &addr, 1, false);      //write
+    twi_master_transfer(0x89, buf, length, true); //read
+#endif
+    if(HELIOS_I2C_Read(0, HX3918_ADDR, &addr, 1, (void*)buf, length, 0) != 0)
+       {
+               //GH301x_LOG("hal_gh30x_i2c_read:error\r\n");
+               
+       }
+    return true;
+}
+int hx3918_ppg_timer = 0;
+char hx3918_ppg_timerout_flag = 0;
+void hx3918_ppg_timerout_cb(void)
+{
+    hx3918_ppg_timerout_flag = 1;
+}
+void hx3918_ppg_timer_cfg(bool en)    //320ms
+{
+    if(en)
+    {
+        if(hx3918_ppg_timer == 0)
+            hx3918_ppg_timer = Helios_Timer_init( (void* )hx3918_ppg_timerout_cb, NULL);
+        Helios_Timer_Start(hx3918_ppg_timer, 320, 1);
+
+    }
+    else
+    {
+        if(hx3918_ppg_timer != 0)
+               {
+                       Helios_Timer_Stop(hx3918_ppg_timer);
+               }
+    }
+
+}
+int hx3918_agc_timer = 0;
+char hx3918_agc_timerout_flag = 0;
+void hx3918_agc_timerout_cb(void)
+{
+    hx3918_agc_timerout_flag = 1;
+}
+/* 40ms void agc_timeout_handler(void * p_context) */
+void hx3918_agc_timer_cfg(bool en)
+{
+    if(en)
+    {
+        if(hx3918_agc_timer == 0)
+            hx3918_agc_timer = Helios_Timer_init( (void* )hx3918_agc_timerout_cb, NULL);
+        Helios_Timer_Start(hx3918_agc_timer, 40, 1);
+    }
+    else
+    {
+        if(hx3918_agc_timer != 0)
+               {
+                       Helios_Timer_Stop(hx3918_agc_timer);
+               }
+    }
+
+}
+#if defined(INT_MODE)
+void hx3918_gpioint_cfg(bool en)
+{
+    if(en)
+    {
+        hx3918_gpioint_enable();
+    }
+    else
+    {
+        hx3918_gpioint_disable();
+    }
+
+}
+#endif
+
+uint8_t hx3918_chip_id = 0;
+bool hx3918_chip_check(void)
+{
+    uint8_t i = 0;
+
+    for(i=0; i<10; i++)
+    {
+        hx3918_write_reg(0x01, 0x00);
+        hx3918_delay(5);
+        hx3918_chip_id = hx3918_read_reg(0x00);
+        if (hx3918_chip_id == 0x27)             
+        {
+            HX3918_LOG("chip id  = 0x%x        check ok \r\n",hx3918_chip_id);
+            return true;
+        }
+    }
+    HX3918_LOG("hx3918_chip_check fail\r\n");
+    return false;
+}
+
+uint8_t hx3918_read_fifo_size(void)
+{
+    uint8_t fifo_num_temp = 0;
+    fifo_num_temp = hx3918_read_reg(0x40)&0x7f;  // ericy 230529
+
+    return fifo_num_temp;
+}
+uint16_t hx3918_read_fifo_data(int32_t *buf, uint8_t phase_num, uint8_t sig)
+{
+    uint8_t data_flg_start = 0;
+    uint8_t data_flg_end = 0;
+    uint8_t databuf[3];
+    uint32_t ii=0;
+    uint16_t data_len = 0;
+    uint16_t fifo_data_length = 0;
+    uint16_t fifo_read_length = 0;
+    uint16_t fifo_read_bytes = 0;
+    uint16_t fifo_out_length = 0;
+    uint16_t fifo_out_count = 0;
+    uint8_t fifo_data_buf[200] = {0};
+
+    data_len = hx3918_read_reg(0x40);// ericy 230529
+    fifo_data_length = data_len;
+    //HX3918_LOG("data_len:   %d\r\n",data_len);
+    if(fifo_data_length<2*phase_num)
+    {
+        return 0;
+    }
+    fifo_read_length = ((fifo_data_length-phase_num)/phase_num)*phase_num;
+    fifo_read_bytes = fifo_read_length*3;
+    if(read_fifo_first_flg == 1)
+    {
+        hx3918_brust_read_reg(0x41, databuf, 3);       // ericy 230529
+        read_fifo_first_flg = 0;
+    }
+    hx3918_brust_read_reg(0x41, fifo_data_buf, fifo_read_bytes);       // ericy 230529
+//             for(ii=0; ii<fifo_read_bytes; ii++)
+//             {
+//                     HX3918_LOG("%d/%d, %d\r\n", ii+1,fifo_read_bytes,fifo_data_buf[ii]);
+//             }
+    for(ii=0; ii<fifo_read_length; ii++)
+    {
+        if(sig==0)
+        {
+            buf[ii] = (int32_t)(fifo_data_buf[ii*3]|(fifo_data_buf[ii*3+1]<<8)|((fifo_data_buf[ii*3+2]&0x1f)<<16));
+        }
+        else
+        {
+            if((fifo_data_buf[ii*3+2]&0x10)!=0)
+            {
+                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;
+            }
+            else
+            {
+                buf[ii] = (int32_t)(fifo_data_buf[ii*3]|(fifo_data_buf[ii*3+1]<<8)|((fifo_data_buf[ii*3+2]&0x1f)<<16));
+            }
+        }
+        //HX3918_LOG("%d/%d, %d %d\r\n", ii+1,fifo_read_length,buf[ii],(fifo_data_buf[ii*3+2]>>5)&0x03);
+    }
+    data_flg_start = (fifo_data_buf[2]>>5)&0x03;
+    data_flg_end = (fifo_data_buf[fifo_read_bytes-1]>>5)&0x03;
+    fifo_out_length = fifo_read_length;
+    if(data_flg_start>0)
+    {
+        fifo_out_length = fifo_read_length-phase_num+data_flg_start;
+        for(ii=0; ii<fifo_out_length; ii++)
+        {
+            buf[ii] = buf[ii+phase_num-data_flg_start];
+        }
+        for(ii=fifo_out_length; ii<fifo_read_length; ii++)
+        {
+            buf[ii] = 0;
+        }
+    }
+    if(data_flg_end<phase_num-1)
+    {
+        for(ii=fifo_out_length; ii<fifo_out_length+phase_num-data_flg_end-1; ii++)
+            hx3918_brust_read_reg(0x41, databuf, 3);// ericy 230529
+        buf[ii] = (int32_t)(databuf[0]|(databuf[1]<<8)|((databuf[2]&0x1f)<<16));
+    }
+//             for(ii=0; ii<fifo_out_length; ii++)
+//             {
+//                     HX3918_LOG("%d/%d, %d\r\n", ii+1,fifo_out_length,buf[ii]);
+//             }
+    fifo_out_length = fifo_out_length+phase_num-data_flg_end-1;
+    fifo_out_count = fifo_out_length/phase_num;
+    if(data_len==64)
+    {
+        uint8_t reg_0x2d = hx3918_read_reg(0x3d);// ericy 230529
+        hx3918_write_reg(0x3d,0x00);// ericy 230529
+        hx3918_delay(5);
+        hx3918_write_reg(0x3d,reg_0x2d);// ericy 230529
+        read_fifo_first_flg = 1;
+    }
+    return fifo_out_count;
+}
+
+void read_data_packet(int32_t *ps_data)  // 3918
+{
+    uint8_t  databuf1[6] = {0};
+    uint8_t  databuf2[6] = {0};
+    hx3918_brust_read_reg(0x02, databuf1, 6);
+    hx3918_brust_read_reg(0x08, databuf2, 6);
+
+    ps_data[0] = ((databuf1[0]) | (databuf1[1] << 8) | (databuf1[2] << 16));
+    ps_data[1] = ((databuf1[3]) | (databuf1[4] << 8) | (databuf1[5] << 16));
+    ps_data[2] = ((databuf2[0]) | (databuf2[1] << 8) | (databuf2[2] << 16));
+    ps_data[3] = ((databuf2[3]) | (databuf2[4] << 8) | (databuf2[5] << 16));
+    HX3918_LOG(" %d %d %d %d \r\n",  ps_data[0], ps_data[1], ps_data[2], ps_data[3]);
+}
+
+
+
+void hx3918_vin_check(uint16_t led_vin)
+{
+    low_vbat_flag = 0;
+    if(led_vin < 3700)
+    {
+        low_vbat_flag = 1;
+    }
+}
+
+void hx3918_ppg_off(void)
+{
+    hx3918_write_reg(0x2a, 0x00);
+    hx3918_write_reg(0x2b, 0x00);
+    hx3918_write_reg(0x16, 0x00);
+    hx3918_write_reg(0x01, 0x01);
+}
+
+void hx3918_ppg_on(void)
+{
+    hx3918_write_reg(0x01, 0x00);
+    hx3918_delay(5);
+}
+
+void hx3918_data_reset(void)
+{
+#if defined(TIMMER_MODE)
+    hx3918_ppg_timer_cfg(false);
+    hx3918_agc_timer_cfg(false);
+#elif defined(INT_MODE)
+    hx3918_gpioint_cfg(false);
+#endif
+#if defined(HRS_ALG_LIB)
+    hx3918_hrs_data_reset();
+#endif
+#if defined(SPO2_ALG_LIB)
+    hx3918_spo2_data_reset();
+#endif
+#if defined(HRV_ALG_LIB)
+    hx3918_hrv_data_reset();
+#endif
+    HX3918_LOG("hx3918 data reset!\r\n");
+}
+
+void Efuse_Mode_Check(void)
+{
+    uint8_t  REG_45_E, REG_46_E, REG_47_E, REG_48_E;
+
+    hx3918_write_reg(0x4b, 0x10);
+    hx3918_write_reg(0x4d, 0x18);
+    hx3918_write_reg(0x4e, 0x40);
+    hx3918_write_reg(0x4C, 0x04);
+    hx3918_write_reg(0x4C, 0x00);
+
+    REG_45_E = hx3918_read_reg(0x45);
+    REG_46_E = hx3918_read_reg(0x46);
+    REG_47_E = hx3918_read_reg(0x47);
+    REG_48_E = hx3918_read_reg(0x48);
+
+    hx3918_write_reg(0X4B,0x20);
+    hx3918_write_reg(0x45,(REG_45_E+4));
+    hx3918_write_reg(0x46,REG_46_E);
+    hx3918_write_reg(0x47,REG_47_E);
+    hx3918_write_reg(0x48,REG_48_E);
+
+    hx3918_write_reg(0X4B,0x00);
+}
+
+bool hx3918_init(WORK_MODE_T mode)
+{
+    work_mode_flag = mode;
+    hx3918_data_reset();
+    hx3918_vin_check(3800);
+    hx3918_ppg_on();
+    Efuse_Mode_Check();
+    switch (work_mode_flag)
+    {
+    case HRS_MODE:
+        tyhx_hrs_set_living(0,0,0); //  qu=15  std=30
+        if(hx3918_hrs_enable()== SENSOR_OP_FAILED)
+        {
+            return false;
+        }
+        break;
+
+    case LIVING_MODE:
+#ifdef CHECK_LIVING_LIB
+        if(hx3918_hrs_enable()== SENSOR_OP_FAILED)
+        {
+            return false;
+        }
+#endif
+        break;
+
+    case SPO2_MODE:
+#ifdef SPO2_DATA_CALI
+        hx3918_spo2_data_cali_init();
+#endif
+#ifdef SPO2_ALG_LIB
+        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);
+        tyhx_spo2_para_barelychange(MEAN_NUM,SOP2_DEGLITCH_THRE,SPO2_REMOVE_JUMP_THRE,SPO2_LOW_CLIP_END_TIME,SPO2_LOW_CLIP_DN, \
+                                    SPO2_NORMAL_CLIP_DN,IR_AC_TOUCH_THRE,IR_FFT_POW_THRE,SPO2_CALI,SLOPE_PARA_MAX,SLOPE_PARA_MIN);
+        if(hx3918_spo2_enable()== SENSOR_OP_FAILED)
+        {
+            return false;
+        }
+#endif
+        break;
+
+    case HRV_MODE:
+#ifdef HRV_ALG_LIB
+        if(hx3918_hrv_enable()== SENSOR_OP_FAILED)
+        {
+            return false;
+        }
+
+        break;
+#endif
+    case WEAR_MODE:
+#ifdef CHECK_TOUCH_LIB
+
+        if(hx3918_check_touch_enable()== SENSOR_OP_FAILED)
+        {
+            return false;
+        }
+#endif
+        break;
+
+    case FT_LEAK_LIGHT_MODE:
+        if (!hx3918_chip_check())
+        {
+            AGC_LOG("hx3918 check id failed!\r\n");
+            return false;
+        }
+        hx3918_factroy_test(LEAK_LIGHT_TEST);
+        break;
+
+    case FT_GRAY_CARD_MODE:
+        hx3918_factroy_test(GRAY_CARD_TEST);
+        break;
+
+    case FT_INT_TEST_MODE:
+        hx3918_factroy_test(FT_INT_TEST);
+//                       hx3918_gpioint_cfg(true);
+        break;
+
+    case LAB_TEST_MODE:
+#ifdef LAB_TEST
+        if(hx3918_lab_test_enable()== SENSOR_OP_FAILED)
+        {
+            return false;
+        }
+#endif
+        break;
+
+    default:
+        break;
+    }
+
+    return true;
+}
+
+void hx3918_agc_Int_handle(void)
+{
+
+    switch (work_mode_flag)
+    {
+    case HRS_MODE:
+    {
+#ifdef HRS_ALG_LIB
+        HRS_CAL_SET_T cal;
+        cal = PPG_hrs_agc();
+        if(cal.work)
+        {
+            //AGC_LOG("AGC: led_drv=%d,ledDac=%d,ambDac=%d,ledstep=%d,rf=%d\r\n", \
+            cal.led_cur, cal.led_idac, cal.amb_idac,cal.led_step,cal.ontime);
+        }
+#endif
+        break;
+    }
+    case LIVING_MODE:
+    {
+#ifdef HRS_ALG_LIB
+        HRS_CAL_SET_T cal;
+        cal = PPG_hrs_agc();
+        if(cal.work)
+        {
+            //HX3918_LOG("AGC: led_drv=%d,ledDac=%d,ambDac=%d,ledstep=%d,rf=%d\r\n", \
+            cal.led_cur, cal.led_idac, cal.amb_idac,cal.led_step,cal.ontime);
+        }
+#endif
+        break;
+    }
+    case HRV_MODE:
+    {
+#ifdef HRV_ALG_LIB
+        HRV_CAL_SET_T cal;
+        cal = PPG_hrv_agc();
+        if(cal.work)
+        {
+            //AGC_LOG("AGC: led_drv=%d,ledDac=%d,ambDac=%d,ledstep=%d,rf=%d\r\n", \
+            cal.led_cur, cal.led_idac, cal.amb_idac,cal.led_step,cal.ontime);
+        }
+#endif
+        break;
+    }
+    case SPO2_MODE:
+    {
+#ifdef SPO2_ALG_LIB
+        SPO2_CAL_SET_T cal;
+        cal = PPG_spo2_agc();
+        if(cal.work)
+        {
+            //AGC_LOG("INT_AGC: Rled_drv=%d,Irled_drv=%d,RledDac=%d,IrledDac=%d,ambDac=%d,Rledstep=%d,Irledstep=%d,Rrf=%d,Irrf=%d,\r\n",\
+            cal.red_cur, cal.ir_cur,cal.red_idac,cal.ir_idac,cal.amb_idac,cal.red_led_step,cal.red_led_step,cal.ontime,cal.state);
+        }
+#endif
+        break;
+    }
+    case LAB_TEST_MODE:
+#ifdef LAB_TEST
+        hx3918_lab_test_Int_handle();
+#endif
+    default:
+        break;
+    }
+}
+void hx3918_gesensor_Int_handle(void)
+{
+    //readFifoByHrsModule();
+#ifdef GSENSER_DATA
+    uint8_t ii = 0;
+    AxesRaw_t gsen_buf;
+    if(work_mode_flag == WEAR_MODE)
+    {
+        return;
+    }
+
+    LIS3DH_GetAccAxesRaw(&gsen_buf);
+
+    for(ii=0; ii<9; ii++)
+    {
+        gsen_fifo_x[ii] = gsen_fifo_x[ii+1];
+        gsen_fifo_y[ii] = gsen_fifo_y[ii+1];
+        gsen_fifo_z[ii] = gsen_fifo_z[ii+1];
+    }
+        gsen_fifo_x[9] = gsen_buf.AXIS_X>>1;
+        gsen_fifo_y[9] = gsen_buf.AXIS_Y>>1;
+        gsen_fifo_z[9] = gsen_buf.AXIS_Z>>1;
+    //SEGGER_RTT_printf(0,"gsen_x=%d gsen_y=%d gsen_z=%d\r\n", \
+    gsen_fifo_x[9],gsen_fifo_y[9],gsen_fifo_z[9]);
+#endif
+}
+
+void agc_timeout_handler(void * p_context)
+{
+#ifdef TIMMER_MODE
+    switch (work_mode_flag)
+    {
+    case HRS_MODE:
+    {
+#ifdef HRS_ALG_LIB
+    HRS_CAL_SET_T cal;
+    cal = PPG_hrs_agc();
+    if(cal.work)
+    {
+        //AGC_LOG("AGC: led_drv=%d,ledDac=%d,ambDac=%d,ledstep=%d,rf=%d\r\n", \
+        cal.led_cur, cal.led_idac, cal.amb_idac,cal.led_step,cal.ontime);
+        }
+#endif
+        break;
+    }
+    case LIVING_MODE:
+    {
+#ifdef HRS_ALG_LIB
+    HRS_CAL_SET_T cal;
+    cal = PPG_hrs_agc();
+    if(cal.work)
+    {
+        //AGC_LOG("AGC: led_drv=%d,ledDac=%d,ambDac=%d,ledstep=%d,rf=%d\r\n", \
+        cal.led_cur, cal.led_idac, cal.amb_idac,cal.led_step,cal.ontime);
+    }
+#endif
+        break;
+    }
+    case HRV_MODE:
+    {
+#ifdef HRV_ALG_LIB
+    HRV_CAL_SET_T cal;
+    cal = PPG_hrv_agc();
+    if(cal.work)
+    {
+        //AGC_LOG("AGC: led_drv=%d,ledDac=%d,ambDac=%d,ledstep=%d,rf=%d\r\n", \
+        cal.led_cur, cal.led_idac, cal.amb_idac,cal.led_step,cal.ontime);
+    }
+#endif
+        break;
+    }
+    case SPO2_MODE:
+    {
+#ifdef SPO2_ALG_LIB
+    SPO2_CAL_SET_T cal;
+    cal = PPG_spo2_agc();
+    if(cal.work)
+    {
+        //AGC_LOG("AGC: Rled_drv=%d,Irled_drv=%d,RledDac=%d,IrledDac=%d,ambDac=%d,Rledstep=%d,Irledstep=%d,Rrf=%d,Irrf=%d,\r\n", \
+        cal.red_cur, cal.ir_cur,cal.red_idac,cal.ir_idac,cal.amb_idac,cal.red_led_step,cal.red_led_step,cal.ontime,cal.state);
+    }
+#endif
+        break;
+    }
+    case LAB_TEST_MODE:
+    {
+#ifdef LAB_TEST
+        hx3918_lab_test_Int_handle();
+#endif
+    }
+    default:
+        break;
+    }
+#endif
+}
+
+//void ppg_timeout_handler(void * p_context)
+void heart_rate_meas_timeout_handler(void * p_context)
+{
+       hx3918_ppg_Int_handle();
+}
+
+void hx3918_ppg_Int_handle(void)
+{
+    #if defined(INT_MODE)
+        hx3918_agc_Int_handle();
+    #endif
+        
+        switch(work_mode_flag)
+        {
+        case HRS_MODE:
+    #ifdef HRS_ALG_LIB
+            hx3918_hrs_ppg_Int_handle();
+    #endif
+            break;
+
+        case SPO2_MODE:
+    #ifdef SPO2_ALG_LIB
+            hx3918_spo2_ppg_Int_handle();
+    #endif
+            break;
+
+        case HRV_MODE:
+    #ifdef HRV_ALG_LIB
+            hx3918_hrv_ppg_Int_handle();
+    #endif
+            break;
+
+        case WEAR_MODE:
+    #ifdef CHECK_TOUCH_LIB
+            hx3918_wear_ppg_Int_handle();
+    #endif
+            break;
+
+        case LAB_TEST_MODE:
+    #ifdef LAB_TEST
+            hx3918_lab_test_Int_handle();
+    #endif
+
+        default:
+            break;
+  }
+
+}
+
+#ifdef HRS_ALG_LIB
+void hx3918_hrs_ppg_Int_handle(void)
+{
+    uint8_t        ii=0;
+    hrs_results_t alg_results = {MSG_HRS_ALG_NOT_OPEN,0,0,0,0};
+    hx3918_hrs_wear_msg_code_t hrs_wear_status = MSG_HRS_INIT;
+    int32_t *PPG_buf = &(ppg_s_dat.green_data[0]);
+    int32_t *ir_buf = &(ppg_s_dat.ir_data[0]);
+    uint8_t *count = &(ppg_s_dat.count);
+    int16_t gsen_fifo_x_send[32]= {0};
+    int16_t gsen_fifo_y_send[32]= {0};
+    int16_t gsen_fifo_z_send[32]= {0};
+    HRS_CAL_SET_T cal= get_hrs_agc_status();
+#ifdef BP_CUSTDOWN_ALG_LIB
+    bp_results_t    bp_alg_results ;
+#endif
+#ifdef HR_VECTOR
+    for(ii=0; ii<8; ii++)
+    {
+        PPG_buf_vec[ii] = hrm_input_data[hrs_send_cnt+ii];
+        gsen_fifo_x[ii] = gsen_input_data_x[hrs_send_cnt+ii];
+        gsen_fifo_y[ii] = gsen_input_data_y[hrs_send_cnt+ii];
+        gsen_fifo_z[ii] = gsen_input_data_z[hrs_send_cnt+ii];
+    }
+    hrs_send_cnt = hrs_send_cnt+8;
+    *count = 8;
+    tyhx_hrs_alg_send_data(PPG_buf_vec,*count, 0, gsen_fifo_x, gsen_fifo_y, gsen_fifo_z);
+#else
+    if(hx3918_hrs_read(&ppg_s_dat) == NULL)
+    {
+        return;
+    }
+#ifndef GSEN_40MS_TIMMER
+    readFifoByHrsModule();
+#endif
+    for(ii=0; ii<*count; ii++)
+    {
+#ifdef GSENSER_DATA
+        gsen_fifo_x_send[ii] = gsen_fifo_x[32-*count+ii];
+        gsen_fifo_y_send[ii] = gsen_fifo_y[32-*count+ii];
+        gsen_fifo_z_send[ii] = gsen_fifo_z[32-*count+ii];
+#endif
+        //HX3918_LOG("%d %d %d %d %d %d\r\n", PPG_buf[ii],ir_buf[ii],gsen_fifo_x[ii],gsen_fifo_y[ii],gsen_fifo_z[ii],hrs_s_dat.agc_green);
+    }
+    hrs_wear_status = hx3918_hrs_get_wear_status();
+       hrsresult.wearstatus = hrs_wear_status;
+    HX3918_result_set_wear_status(hrs_wear_status);
+    
+    if(hrs_wear_status == MSG_HRS_WEAR)
+    {
+        tyhx_hrs_alg_send_data(PPG_buf, *count, gsen_fifo_x_send, gsen_fifo_y_send, gsen_fifo_z_send);
+    }
+#endif
+    alg_results = tyhx_hrs_alg_get_results();
+    hrsresult.lastesthrs = alg_results.hr_result;
+    HX3918_result_set_heart_rate(hrsresult.lastesthrs);
+  // HX3918_LOG("Hr=%d",alg_results.hr_result);
+#ifdef HRS_BLE_APP
+    {
+        rawdata_vector_t rawdata;
+        for(ii=0; ii<*count; ii++)
+        {
+            rawdata.vector_flag = HRS_VECTOR_FLAG;
+            rawdata.data_cnt = alg_results.data_cnt-*count+ii;
+            rawdata.hr_result = alg_results.hr_result;
+            rawdata.red_raw_data = PPG_buf[ii];
+            rawdata.ir_raw_data = gdiff[0];
+            rawdata.gsensor_x = gsen_fifo_x[ii];
+            rawdata.gsensor_y = gsen_fifo_y[ii];
+            rawdata.gsensor_z = gsen_fifo_z[ii];
+            rawdata.red_cur = cal.led_cur;
+            rawdata.ir_cur = alg_results.hrs_alg_status;
+
+            ble_rawdata_vector_push(rawdata);
+        }
+    }
+    ble_rawdata_send_handler();
+#endif
+}
+
+#ifdef CHECK_LIVING_LIB
+void hx3918_living_Int_handle(void)
+{
+
+    uint8_t        ii=0;
+    hx3918_living_results_t living_alg_results = {MSG_LIVING_NO_WEAR,0,0,0};
+
+    int32_t *PPG_buf = &(ppg_s_dat.green_data[0]);
+    uint8_t *count = &(ppg_s_dat.count);
+    hx3918_hrs_wear_msg_code_t     hrs_wear_status = MSG_HRS_NO_WEAR;
+    int16_t    gsen_fifo_x_send[32]= {0};
+    int16_t    gsen_fifo_y_send[32]= {0};
+    int16_t    gsen_fifo_z_send[32]= {0};
+
+    if(hx3918_hrs_read(&ppg_s_dat) == NULL)
+    {
+        return;
+    }
+#ifndef GSEN_40MS_TIMMER
+    readFifoByHrsModule();
+#endif
+    for(ii=0; ii<*count; ii++)
+    {
+        gsen_fifo_x_send[ii] = gsen_fifo_x[32-*count+ii];
+        gsen_fifo_y_send[ii] = gsen_fifo_y[32-*count+ii];
+        gsen_fifo_z_send[ii] = gsen_fifo_z[32-*count+ii];
+        //HX3918_LOG("%d/%d %d %d %d %d %d %d\r\n",1+ii,*count,PPG_buf[ii],ir_buf[ii],gsen_fifo_x[ii],gsen_fisignal_qualityfo_y[ii],gsen_fifo_z[ii],hrs_s_dat.agc_green);
+    }
+
+    living_alg_results = hx3918_living_get_results();
+    //HX3918_LOG("%d %d %d %d\r\n",living_alg_results.data_cnt,living_alg_results.motion_status,living_alg_results.signal_quality,living_alg_results.wear_status);
+
+}
+#endif
+
+
+#ifdef SPO2_ALG_LIB
+void hx3918_spo2_ppg_Int_handle(void)
+{
+    uint8_t        ii=0;
+    spo2_results_t alg_results = {MSG_SPO2_ALG_NOT_OPEN,MSG_SPO2_LIVING_INITIAL,0,0,0,0,0,0,1,0,0,0,0};
+    SPO2_CAL_SET_T cal=get_spo2_agc_status();
+    hx3918_spo2_wear_msg_code_t spo2_wear_status = MSG_SPO2_INIT;
+    int32_t *green_buf = &(ppg_s_dat.green_data[0]);
+    int32_t *red_buf = &(ppg_s_dat.red_data[0]);
+    int32_t *ir_buf = &(ppg_s_dat.ir_data[0]);
+    uint8_t *count = &(ppg_s_dat.count);
+    int16_t gsen_fifo_x_send[32]= {0};
+    int16_t gsen_fifo_y_send[32]= {0};
+    int16_t gsen_fifo_z_send[32]= {0};
+#ifdef SPO2_DATA_CALI
+    int32_t red_data_cali, ir_data_cali;
+#endif
+
+#ifdef SPO2_VECTOR
+    for(ii=0; ii<8; ii++)
+    {
+        red_buf_vec[ii] = vec_red_data[spo2_send_cnt+ii];
+        ir_buf_vec[ii] = vec_ir_data[spo2_send_cnt+ii];
+        green_buf_vec[ii] = vec_green_data[spo2_send_cnt+ii];
+    }
+    spo2_send_cnt = spo2_send_cnt+8;
+    *count = 8;
+    for(ii=0; ii<10; ii++)
+    {
+        gsen_fifo_x[ii] = vec_red_data[spo2_send_cnt1+ii];;
+        gsen_fifo_y[ii] = vec_ir_data[spo2_send_cnt1+ii];;
+        gsen_fifo_z[ii] = vec_green_data[spo2_send_cnt1+ii];;
+    }
+    spo2_send_cnt1 = spo2_send_cnt1+10;
+    hx3918_spo2_alg_send_data(red_buf_vec, ir_buf_vec, green_buf_vec, *count, gsen_fifo_x, gsen_fifo_y, gsen_fifo_z);
+#else
+    if(hx3918_spo2_read(&ppg_s_dat) == NULL)
+    {
+        return;
+    }
+#ifndef GSEN_40MS_TIMMER
+    readFifoByHrsModule();
+#endif
+    for(ii=0; ii<*count; ii++)
+    {
+         HX3918_LOG("%d/%d %d %d %d %d %d %d %d\r\n" ,1+ii,*count,\
+           red_buf[ii],ir_buf[ii],green_buf[ii],cal.red_idac,cal.ir_idac,cal.red_cur,cal.ir_cur);
+    }
+    spo2_wear_status = hx3918_spo2_get_wear_status();    
+       hrsresult.wearstatus = spo2_wear_status;
+    HX3918_result_set_wear_status(spo2_wear_status);
+    if(spo2_wear_status == MSG_SPO2_WEAR)
+    {
+      if(*count){
+        tyhx_spo2_alg_send_data(red_buf, ir_buf, green_buf, cal.red_idac, cal.ir_idac, cal.green_idac, gsen_fifo_x_send, gsen_fifo_y_send, gsen_fifo_z_send, *count);
+        }
+    }
+#endif
+
+       alg_results = tyhx_spo2_alg_get_results();
+       hrsresult.lastestspo2 = alg_results.spo2_result;
+       HX3918_result_set_blood_oxygen(hrsresult.lastestspo2);
+       HX3918_LOG("SPO2=%d\r\n",alg_results.spo2_result);
+
+#ifdef HRS_BLE_APP
+    {
+        rawdata_vector_t rawdata;
+        for(ii=0; ii<*count; ii++)
+        {
+#ifdef SPO2_DATA_CALI
+            ir_data_cali = hx3918_ir_data_cali(ir_buf[ii]);
+            red_data_cali = hx3918_red_data_cali(red_buf[ii]);
+            rawdata.red_raw_data = red_data_cali;
+            rawdata.ir_raw_data = ir_data_cali;
+#else
+            rawdata.red_raw_data = red_buf[ii];
+            rawdata.ir_raw_data = ir_buf[ii];
+#endif
+            rawdata.vector_flag = SPO2_VECTOR_FLAG;
+            //rawdata.data_cnt = alg_results.data_cnt-*count+ii;
+            rawdata.data_cnt = cal.green_idac;
+            rawdata.hr_result = alg_results.spo2_result;
+//            rawdata.gsensor_x = gsen_fifo_x[ii];
+//            rawdata.gsensor_y = gsen_fifo_y[ii];
+//            rawdata.gsensor_z = gsen_fifo_z[ii];
+            rawdata.gsensor_x = green_buf[ii]>>5;
+            rawdata.gsensor_y = cal.red_idac;
+            rawdata.gsensor_z = cal.ir_idac;
+            rawdata.red_cur = cal.red_cur;
+            rawdata.ir_cur = cal.ir_cur;
+            ble_rawdata_vector_push(rawdata);
+        }
+    }
+    ble_rawdata_send_handler();
+#endif
+}
+#endif
+
+#ifdef HRV_ALG_LIB
+hrv_sensor_data_t hrv_s_dat;
+void hx3918_hrv_ppg_Int_handle(void)
+{
+    uint8_t        ii=0;
+    hrv_results_t alg_hrv_results= {MSG_HRV_ALG_NOT_OPEN,0,0,0,0,0};
+    int32_t *PPG_buf = &(hrv_s_dat.ppg_data[0]);
+    uint8_t *count = &(hrv_s_dat.count);
+    hx3918_hrv_wear_msg_code_t wear_mode;
+
+#ifdef HRV_TESTVEC
+    int32_t hrm_raw_data;
+    hrm_raw_data = vec_data[vec_data_cnt];
+    vec_data_cnt++;
+    alg_hrv_results = hx3918_hrv_alg_send_data(hrm_raw_data, 0, 0);
+#else
+    if(hx3918_hrv_read(&hrv_s_dat) == NULL)
+    {
+        return;
+    }
+    for(ii=0; ii<*count; ii++)
+    {
+        //HX3918_LOG("[Hrv_Test]:%d/%d %d\r\n" ,1+ii,*count,PPG_buf[ii]);
+    }
+    wear_mode = hx3918_hrv_get_wear_status();
+    HX3918_result_set_wear_status(wear_mode);
+       //hrsresult.wearstatus = wear_mode;
+    if(wear_mode==MSG_HRV_WEAR)
+    {
+        alg_hrv_results = tyhx_hrv_alg_send_bufdata(PPG_buf, *count, gen_dummy, gen_dummy,gen_dummy);
+        //hrsresult.lastesthrv = alg_hrv_results .hrv_result;
+        HX3918_result_set_hrv(alg_hrv_results.hrv_result);
+        HX3918_LOG("Hrv result:= %d\r\n",alg_hrv_results.hrv_result);
+    }
+#endif
+
+#ifdef HRS_BLE_APP
+    {
+        rawdata_vector_t rawdata;
+
+        HRS_CAL_SET_T cal= get_hrs_agc_status();
+        for(ii=0; ii<*count; ii++)
+        {
+            rawdata.vector_flag = HRS_VECTOR_FLAG;
+            rawdata.data_cnt = 0;
+            rawdata.hr_result = alg_hrv_results.hrv_result;
+            rawdata.red_raw_data = PPG_buf[ii];
+            rawdata.ir_raw_data = 0;
+            rawdata.gsensor_x = gsen_fifo_x[ii];
+            rawdata.gsensor_y = gsen_fifo_y[ii];
+            rawdata.gsensor_z = gsen_fifo_z[ii];
+            rawdata.red_cur = cal.led_cur;
+            rawdata.ir_cur = 0;
+            ble_rawdata_vector_push(rawdata);
+        }
+    }
+    ble_rawdata_send_handler();
+#endif
+}
+#endif
+
+
+#ifdef CHECK_TOUCH_LIB
+void hx3918_wear_ppg_Int_handle(void)
+{
+    uint8_t count = 0;
+    uint8_t ii = 0;
+    hx3918_wear_msg_code_t hx3918_check_mode_status = MSG_NO_WEAR;
+    count = hx3918_check_touch_read(&ppg_s_dat);
+    hx3918_check_mode_status = hx3918_check_touch(ppg_s_dat.s_buf,count);
+    hrsresult.wearstatus = hx3918_check_mode_status;
+    if((count)&&(hrsresult.wearstatus == 0))
+    {
+        //HX3918_LOG("count = %d, ir = %d\r\n",count,ppg_s_dat.s_buf[count-1]);
+        hx3918_auto_cali_backgroud(ppg_s_dat.s_buf[count-1]);
+               
+    }
+       //hx3918_ai_tune_nv(lp[0],bl[0]);
+    //HX3918_LOG("[hx3918_wear_ppg_Int_handle] ir result = %d, final result = %d\r\n",hx3918_check_mode_status,wear_result_by_IRandProx);
+#ifdef HRS_BLE_APP
+    {
+        rawdata_vector_t rawdata;
+        //for(ii=0; ii<*count; ii++)
+        //app_ctrl_test = true;
+        {
+            rawdata.vector_flag = HRS_VECTOR_FLAG;
+            rawdata.data_cnt = 0;
+            rawdata.hr_result = 0;
+            rawdata.red_raw_data = 0;
+            rawdata.ir_raw_data = lp[0];
+            rawdata.gsensor_x = bl[0];
+            rawdata.gsensor_y = gdiff[1];
+            rawdata.gsensor_z = nv_base_data[0];
+            rawdata.red_cur = ai_tune_cnt[0];
+            rawdata.ir_cur = ai_tune_cnt[1];
+
+            ble_rawdata_vector_push(rawdata);
+        }
+    }
+    ble_rawdata_send_handler();
+#endif
+
+}
+#endif
+
+
+void hx3918_lab_test_Int_handle(void)
+{
+#ifdef LAB_TEST
+#if defined(TIMMER_MODE)
+    uint32_t data_buf[4];
+    hx3918_lab_test_read_packet(data_buf);
+    //HX3918_LOG("%d %d %d %d\r\n", data_buf[0], data_buf[1], data_buf[2], data_buf[3]);
+#else
+    uint8_t count = 0;
+    int32_t buf[32];
+    count = hx3918_read_fifo_data(buf, 2, 1);
+    for (uint8_t i=0; i<count; i++)
+    {
+        //HX3918_LOG("%d/%d %d %d\r\n" ,1+i,count,buf[i*2],buf[i*2+1]);
+    }
+#endif
+#endif
+}
+#endif //CHIP_HX3918
+
diff --git a/2.sdk/Helios_SDK/components/HX3918/hx3918.h b/2.sdk/Helios_SDK/components/HX3918/hx3918.h
new file mode 100644 (file)
index 0000000..35fbfed
--- /dev/null
@@ -0,0 +1,350 @@
+#ifndef _hx3918_H_
+#define _hx3918_H_
+#include <stdint.h>
+#include <stdbool.h>
+
+
+//#include "tyhx_mems.h"
+//#define DEBUG_PPG_ONLY     // 只用IR 判断佩带和非佩戴, 靠近感应功能关闭,  但是HX3918_PROX.C要合入编译
+/********************* alg_swi *********************
+HRS_ALG_LIB   心率功能
+SPO2_ALG_LIB  血氧功能
+HRV_ALG_LIB   HRV功能
+CHECK_TOUCH_LIB   纯佩戴功能(非心率血氧模式)
+CHECK_LIVING_LIB  纯物体识别功能(非心率血氧模式)
+BP_CUSTDOWN_ALG_LIB  血压功能
+
+TIMMER_MODE  定时器模式, 读PPG数据, 默认采用定时器模式
+INT_MODE     中断模式,读PPG数据
+
+DEMO_MI      demo相关配置, 客户关闭, 在下面else里进行配置
+HRS_BLE_APP  DEMO蓝牙控制宏, 客户关闭
+SPO2_DATA_CALI   血氧DC补偿模式, 客户关闭
+HRS_DEBUG    调试宏, 根据平台定义打印函数
+AGC_DEBUG    调试宏, 根据平台定义打印函数
+GSEN_40MS_TIMMER   DEMO调试使用, 客户关闭
+NEW_GSEN_SCHME     DEMO调试使用, 客户关闭
+*/
+#define HRS_ALG_LIB
+#define SPO2_ALG_LIB
+//#define HRV_ALG_LIB
+#define CHECK_TOUCH_LIB
+//#define CHECK_LIVING_LIB
+#define BP_CUSTDOWN_ALG_LIB
+
+
+
+//**************** read_data_mode ******************//
+#define TIMMER_MODE           //timmer read fifo
+//#define INT_MODE                                                     //fifo_all_most_full
+//#define TYHX_DEMO           // for ty demo
+//****************** gsen_cgf *********************//
+//#define GSENSER_DATA
+#define GSEN_40MS_TIMMER
+#define NEW_GSEN_SCHME
+
+//****************** other_cgf ********************//
+#define EVB
+//#define TWON3IN1LED
+//#define EVB
+//#define INT_FLOATING
+//#define HRS_BLE_APP
+//#define SPO2_DATA_CALI
+
+//***************** vecter_swi ********************//
+//#define SPO2_VECTOR
+//#define HR_VECTOR
+//#define HRV_TESTVEC
+
+//**************** lab_test_mode ******************//
+//#define LAB_TEST             
+//#define LAB_TEST_AGC                                                 
+
+//****************** print_swi ********************//
+//#define TYHX_LOG
+// #define AGC_DEBUG
+// #define HRS_DEBUG
+
+//**************************************************//
+
+#ifdef TYHX_LOG
+#define  TYHX_LOG(...)     SEGGER_RTT_printf(0,__VA_ARGS__)
+#else
+#define         TYHX_LOG(...)
+#endif
+
+#ifdef AGC_DEBUG
+#define  AGC_LOG(...)     SEGGER_RTT_printf(0,__VA_ARGS__)
+#else
+#define         AGC_LOG(...)
+#endif
+
+#ifdef HRS_DEBUG
+#define  DEBUG_PRINTF(...)     SEGGER_RTT_printf(0,__VA_ARGS__)
+#else
+#define         DEBUG_PRINTF(...)
+#endif
+
+
+//#define ARRAY_SIZE(x) (sizeof(x)/sizeof((x)[0]))
+typedef struct
+{
+    uint16_t      lastesthrs;                          //??????????
+    uint8_t       lastestspo2;                 //????
+    uint8_t       lastesthrv;                  //HRV??
+    uint16_t      wearstatus;
+       uint32_t      living_data_cnt;
+       uint8_t       living_signal_quality;
+       uint8_t       living_motion_status;
+       int32_t           leak_green;
+       int32_t           leak_red;
+       int32_t       leak_ir;
+       int32_t           card_green;
+       int32_t           card_red;
+       int32_t           card_ir;
+       uint8_t       hrv_tired_value;
+       uint8_t       hrv_spirit_pressure;
+       uint8_t       hr_living; 
+    uint32_t      hr_living_qu;
+    uint32_t      hr_living_std;
+       uint8_t       living_status;                //living_status
+} tyhx_hrsresult_t;
+
+#if defined(DEMO_COMMON)
+    #define HRS4100_IIC_CLK  30
+    #define HRS4100_IIC_SDA  0   
+    #define LIS3DH_IIC_CLK   18
+    #define LIS3DH_IIC_SDA   16
+    #define EXT_INT_PIN      1
+    #define GREEN_LED_SLE    1
+    #define RED_LED_SLE      4
+    #define IR_LED_SLE       2
+    #define RED_AGC_OFFSET   12
+    #define IR_AGC_OFFSET    12
+    #define GREEN_AGC_OFFSET    8
+    #define HR_GREEN_AGC_OFFSET 8
+    #define BIG_SCREEN  
+#elif defined(TWON3IN1LED)
+   #define HRS4100_IIC_CLK  30
+    #define HRS4100_IIC_SDA  0   
+    #define LIS3DH_IIC_CLK   18
+    #define LIS3DH_IIC_SDA   16
+    #define EXT_INT_PIN      1
+    #define GREEN_LED_SLE    2
+    #define RED_LED_SLE      4
+    #define IR_LED_SLE       1
+    #define RED_AGC_OFFSET   12
+    #define IR_AGC_OFFSET    12
+    #define GREEN_AGC_OFFSET    8
+    #define HR_GREEN_AGC_OFFSET 8
+    #define BIG_SCREEN  
+#elif defined(DEMO_NEW)
+  #define HRS4100_IIC_CLK  0
+  #define HRS4100_IIC_SDA  30   
+  #define LIS3DH_IIC_CLK   18
+  #define LIS3DH_IIC_SDA   16
+  #define EXT_INT_PIN      1
+  #define GREEN_LED_SLE    1
+  #define RED_LED_SLE      2
+  #define IR_LED_SLE       4
+  #define RED_AGC_OFFSET   50
+  #define IR_AGC_OFFSET    50
+       #define HR_GREEN_AGC_OFFSET 4
+  #define BIG_SCREEN
+  
+#elif defined(DEMO_BAND)
+  #define HRS4100_IIC_CLK  4
+  #define HRS4100_IIC_SDA  3  
+  #define LIS3DH_IIC_CLK   14
+  #define LIS3DH_IIC_SDA   12
+  #define EXT_INT_PIN      7
+  #define GREEN_LED_SLE    0
+  #define RED_LED_SLE      2
+  #define IR_LED_SLE       1
+  #define RED_AGC_OFFSET   64
+  #define IR_AGC_OFFSET    64
+  #define GREEN_AGC_OFFSET 8
+       #define HR_GREEN_AGC_OFFSET 8
+  
+#elif defined(DEMO_GT01)
+  #define HRS4100_IIC_CLK  5
+  #define HRS4100_IIC_SDA  6
+  #define LIS3DH_IIC_CLK   14
+  #define LIS3DH_IIC_SDA   12 
+  #define EXT_INT_PIN      7
+  #define GREEN_LED_SLE    1
+  #define RED_LED_SLE      4
+  #define IR_LED_SLE       2
+  #define RED_AGC_OFFSET   32
+  #define IR_AGC_OFFSET    32
+  #define GREEN_AGC_OFFSET 8
+  #define BIG_SCREEN
+  
+#elif defined(EVB)
+  #define HRS4100_IIC_CLK  9
+  #define HRS4100_IIC_SDA  10  
+  #define LIS3DH_IIC_CLK   13
+  #define LIS3DH_IIC_SDA   14
+  #define EXT_INT_PIN      11
+  #define GREEN_LED_SLE    1
+  #define RED_LED_SLE      4
+  #define IR_LED_SLE       2
+  #define RED_AGC_OFFSET   64
+  #define IR_AGC_OFFSET    64
+  #define GREEN_AGC_OFFSET 8
+       #define HR_GREEN_AGC_OFFSET 10
+  
+#else
+  #define HRS4100_IIC_CLK  9
+  #define HRS4100_IIC_SDA  10  
+  #define LIS3DH_IIC_CLK   13
+  #define LIS3DH_IIC_SDA   14
+  #define EXT_INT_PIN      11
+  #define GREEN_LED_SLE    1
+  #define RED_LED_SLE      4
+  #define IR_LED_SLE       2
+  #define RED_AGC_OFFSET   64
+  #define IR_AGC_OFFSET    64
+  #define GREEN_AGC_OFFSET 8
+  
+#endif
+
+
+typedef enum {    
+       PPG_INIT, 
+       PPG_OFF, 
+       PPG_LED_OFF,
+       CAL_INIT,
+       CAL_OFF,
+       RECAL_INIT    
+} hx3918_mode_t;
+
+typedef enum {    
+       SENSOR_OK, 
+       SENSOR_OP_FAILED,   
+} SENSOR_ERROR_T;
+
+typedef enum {    
+       HRS_MODE, 
+       SPO2_MODE,
+       WEAR_MODE,
+       HRV_MODE,
+       LIVING_MODE,
+       LAB_TEST_MODE,
+       FT_LEAK_LIGHT_MODE,
+       FT_GRAY_CARD_MODE,
+       FT_INT_TEST_MODE,
+    NULL_MODE,
+  close_MODE
+} WORK_MODE_T;
+
+typedef struct {
+       uint8_t count;
+    int32_t green_data[32];
+       int32_t red_data[16];
+       int32_t ir_data[16];  
+       int32_t s_buf[64];
+    int32_t sar_data;
+       uint8_t green_cur;
+       uint8_t red_cur; 
+       uint8_t ir_cur;
+       uint8_t green_offset;
+       uint8_t red_offset; 
+       uint8_t ir_offset;     
+}ppg_sensor_data_t;
+
+typedef enum {
+       MSG_LIVING_NO_WEAR,
+       MSG_LIVING_WEAR
+} hx3918_living_wear_msg_code_t;
+
+typedef enum {
+       MSG_NO_WEAR,
+       MSG_WEAR
+} hx3918_wear_msg_code_t;
+
+typedef struct {
+       hx3918_living_wear_msg_code_t  wear_status;
+       uint32_t           data_cnt;
+       uint8_t            signal_quality;
+       uint8_t            motion_status; 
+} hx3918_living_results_t;
+
+typedef struct {
+    int32_t p1_noise; 
+       int32_t p2_noise; 
+       int32_t p3_noise;
+       int32_t p4_noise;
+}NOISE_PS_T;
+
+
+
+extern uint8_t alg_ram[11*1024];
+extern uint8_t hx3918_chip_id;
+
+extern WORK_MODE_T work_mode_flag;
+
+void hx_set_touch_mode(uint8_t current_mode);
+uint16_t hx3918_read_fifo_data(int32_t *buf, uint8_t phase_num, uint8_t sig);
+void read_data_packet(int32_t *ps_data);
+void hx3918_delay_us(uint32_t us);
+void hx3918_delay(uint32_t ms);
+bool hx3918_write_reg(uint8_t addr, uint8_t data); 
+bool hx3918_write_reg(uint8_t addr, uint8_t data);
+uint8_t hx3918_read_reg(uint8_t addr); 
+bool hx3918_brust_read_reg(uint8_t addr , uint8_t *buf, uint8_t length);
+bool hx3918_chip_check(void);
+uint8_t hx3918_read_fifo_size(void);
+void hx3918_ppg_off(void);
+void hx3918_ppg_on(void);  
+void hx3918_ppg_timer_cfg(bool en);
+void hx3918_agc_timer_cfg(bool en);
+void hx3918_gpioint_cfg(bool en);
+bool hx3918_init(WORK_MODE_T mode);
+void hx3918_agc_Int_handle(void); 
+void hx3918_gesensor_Int_handle(void);
+void hx3918_spo2_ppg_init(void);
+void hx3918_spo2_ppg_Int_handle(void);
+void hx3918_wear_ppg_Int_handle(void);
+void hx3918_ft_hrs_Int_handle(void);
+void hx3918_ft_spo2_Int_handle(void);
+void hx3918_hrs_ppg_init(void);
+void hx3918_hrs_ppg_Int_handle(void);
+void hx3918_hrv_ppg_Int_handle(void);
+void hx3918_living_Int_handle(void);
+//void hx3918_gesensor_Int_handle(void);
+void hx3918_ppg_Int_handle(void);
+uint32_t hx3918_timers_start(void);
+uint32_t hx3918_timers_stop(void);
+uint32_t hx3918_gpioint_init(void);
+
+uint32_t hx3918_gpioint_enable(void);
+uint32_t hx3918_gpioint_disable(void);
+uint32_t hx3918_40ms_timers_start(void);
+uint32_t hx3918_40ms_timers_stop(void);
+
+void hx3918_vin_check(uint16_t led_vin);
+
+#ifdef LAB_TEST
+void hx3918_lab_test_init(void);
+void hx3918_test_alg_cfg(void);
+SENSOR_ERROR_T hx3918_lab_test_enable(void);
+void hx3918_lab_test_Int_handle(void);
+void hx3918_lab_test_read_packet(uint32_t *data_buf);
+#endif
+
+#ifdef CHECK_TOUCH_LIB
+hx3918_wear_msg_code_t hx3918_check_touch(int32_t *ir_data, uint8_t data_len);
+SENSOR_ERROR_T hx3918_check_touch_enable(void);
+#endif
+
+bool hx3918_living_send_data(int32_t *new_raw_data, uint8_t dat_len, uint32_t green_data_als, int16_t *gsen_data_x, int16_t *gsen_data_y, int16_t *gsen_data_z);
+hx3918_living_results_t hx3918_living_get_results(void);
+void agc_timeout_handler(void * p_context);
+void heart_rate_meas_timeout_handler(void * p_context);
+
+int16_t hx3918xxx_read_two_reg_low_triple(uint8_t addh, uint8_t addl);
+void display_refresh(void);
+extern char hx3918_ppg_timerout_flag ;
+extern char hx3918_agc_timerout_flag ;
+#endif
diff --git a/2.sdk/Helios_SDK/components/HX3918/hx3918_check_touch.c b/2.sdk/Helios_SDK/components/HX3918/hx3918_check_touch.c
new file mode 100644 (file)
index 0000000..0b18834
--- /dev/null
@@ -0,0 +1,260 @@
+#include <stdio.h>
+#include <stdbool.h>
+#include <stdint.h>
+#include <stdlib.h>
+#include <math.h>
+
+//#include "twi_master.h"
+//#include "hx3918.h"
+//#include "SEGGER_RTT.h"
+
+//#include "tyhx_hrs_custom.h"
+#include "hx3918.h"
+#include "hx3918_check_touch.h"
+#include "hx3918_prox.h"
+//#include "segger_rtt.h"
+
+hx3918_wear_msg_code_t hx3918_wear_status = MSG_NO_WEAR;
+hx3918_wear_msg_code_t hx3918_wear_status_pre = MSG_NO_WEAR;
+extern const int32_t check_mode_unwear_thre;
+extern const int32_t check_mode_wear_thre;
+extern const int32_t check_mode_sar_thre;
+uint8_t notouch_cnt = 0;
+uint8_t touch_cnt = 0;
+extern uint8_t read_fifo_first_flg;
+
+#ifdef CHECK_TOUCH_LIB
+void hx3918_check_touch_init(void) //20200615 ericy ppg fs=25hz, phase3 conversion ready interupt en
+{
+    uint16_t sample_rate = 10;                  /*config the data rate of chip alps2_fm ,uint is Hz*/
+    uint32_t prf_clk_num = 32000/sample_rate;   /*period in clk num, num = Fclk/fs */
+
+    uint8_t ps0_enable=1;       /*ps0_enable  , 1 mean enable ; 0 mean disable */
+    uint8_t ps1_enable=1;       /*ps1_enable  , 1 mean enable ; 0 mean disable */
+    uint8_t ps2_enable=0;       /*ps0_enable  , 1 mean enable ; 0 mean disable */
+    uint8_t ps3_enable=0;       /*ps1_enable  , 1 mean enable ; 0 mean disable */
+
+    uint8_t ps0_osr = 1;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+    uint8_t ps1_osr = 1;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+    uint8_t ps2_osr = 0;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+    uint8_t ps3_osr = 0;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+
+    uint8_t ps3_cp_avg_num_sel= 0;
+    uint8_t ps2_cp_avg_num_sel= 0;
+    uint8_t ps1_cp_avg_num_sel= 0;
+    uint8_t ps0_cp_avg_num_sel= 0;
+
+    uint8_t ps3_avg_num_sel_i2c=0;
+    uint8_t ps2_avg_num_sel_i2c=0;
+    uint8_t ps1_avg_num_sel_i2c=0;
+    uint8_t ps0_avg_num_sel_i2c=0;
+
+    /***********led open enable***********/
+
+    uint8_t ps0_led_en_i2c=1;
+    uint8_t ps1_led_en_i2c=0;
+    uint8_t ps2_led_en_i2c=0;
+    uint8_t ps3_led_en_i2c=0;
+
+    uint8_t ps0_ofidac_en_i2c=1;
+    uint8_t ps1_ofidac_en_i2c=1;
+    uint8_t ps2_ofidac_en_i2c=1;
+    uint8_t ps3_ofidac_en_i2c=1;
+
+    uint8_t dccancel_ps0 =0;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps1 =0;   //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps2 =0;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps3 =0;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+
+    uint8_t leddrive_ps0 =64;     //LEDDRIVE_PS0  0~255 = 0~200ma
+    uint8_t leddrive_ps1 =0;     //LEDDRIVE_PS1  0~255 = 0~200ma
+    uint8_t leddrive_ps2 =0;    //LEDDRIVE_PS2  0~255 = 0~200ma
+    uint8_t leddrive_ps3 =0;     //LEDDRIVE_PS3  0~255 = 0~200ma
+
+    uint8_t led_en_begin =1;       // 0 = 2 ; 1 = 4 ; 2 = 8 ; 3 = 16 ;
+    uint8_t afe_reset = 1;        //* 0 = 32clk ; 1 = 64clk ; 2 = 128clk ; 3 = 256clk(d) ;
+    uint8_t en2rst_delay =3;      // pen 2 rst delay 0 = 128,256, 512, 1024
+    uint8_t init_wait_delay = 2; /* 0 = 800 ; 1 = 1600; 2 = 3200 ; 3 = 6400(d) */
+
+    uint8_t ps1_interval_i2c =0;    // ps2/ps3
+
+    uint8_t thres_int =1;    //thres int enable
+    uint8_t data_rdy_int =8;    //[3]:ps1_data2 [2]:ps1_data1 [1]:ps0_data2 [0]:ps0_data1
+
+
+    uint8_t ldrsel_ps0 =IR_LED_SLE;
+    uint8_t ldrsel_ps1 =0;
+    uint8_t ldrsel_ps2 =0;
+    uint8_t ldrsel_ps3 =0;
+
+    /***********cap *********/
+    uint8_t intcapsel_ps3 =2;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+    uint8_t intcapsel_ps2 =2;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+    uint8_t intcapsel_ps1 =2;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+    uint8_t intcapsel_ps0 =2;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+
+    uint8_t ps0_led_on_time=8;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+    uint8_t ps1_led_on_time=8;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+    uint8_t ps2_led_on_time=0;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+    uint8_t ps3_led_on_time=0;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+
+    uint8_t force_adc_clk_sel=0;
+    uint8_t force_adc_clk_cfg =0;
+    uint8_t force_PEN =0;     //phase enable
+    uint8_t force_PEN_cfg =0;
+    uint8_t force_LED_EN =0;
+    uint8_t force_LED_EN_cfg =0;
+    uint8_t force_CKAFEINT_sel =0;
+    uint8_t force_CKAFEINT_cfg =0;
+
+    hx3918_write_reg(0X16, (ps3_enable<<3| ps2_enable<<2|ps1_enable<<1|ps0_enable));
+    hx3918_write_reg(0X17, (ps3_osr<<6| ps2_osr<<4|ps1_osr<<2|ps0_osr));
+    hx3918_write_reg(0X18, (uint8_t)prf_clk_num);
+    hx3918_write_reg(0X19, (uint8_t)(prf_clk_num>>8));
+    hx3918_write_reg(0X1a, (ps1_interval_i2c));
+    hx3918_write_reg(0X1b, led_en_begin<<6|afe_reset<<4|en2rst_delay <<2|init_wait_delay);
+    //hx3918_write_reg(0X1b, 0x03);
+    hx3918_write_reg(0X1c, ps0_led_on_time);
+    hx3918_write_reg(0X1d, ps1_led_on_time);
+    hx3918_write_reg(0X1e, ps2_led_on_time);
+    hx3918_write_reg(0X1f, ps3_led_on_time);
+    hx3918_write_reg(0X20, (ps3_cp_avg_num_sel<<6|ps2_cp_avg_num_sel<<4|ps1_cp_avg_num_sel<<2|ps0_cp_avg_num_sel)); 
+    hx3918_write_reg(0X21, (ps3_avg_num_sel_i2c<<6|ps2_avg_num_sel_i2c<<4|ps1_avg_num_sel_i2c<<2|ps0_avg_num_sel_i2c));
+    hx3918_write_reg(0X23, (ps0_led_en_i2c<<7|ps1_led_en_i2c<<6|ps2_led_en_i2c<<5|ps3_led_en_i2c<<4|ps0_ofidac_en_i2c<<3|ps1_ofidac_en_i2c<<2|ps2_ofidac_en_i2c<<1|ps3_ofidac_en_i2c));
+    hx3918_write_reg(0X24, (intcapsel_ps0<<4|intcapsel_ps1));
+    hx3918_write_reg(0X25, (intcapsel_ps2<<4|intcapsel_ps3));
+    hx3918_write_reg(0X26, leddrive_ps0);
+    hx3918_write_reg(0X27, leddrive_ps1);
+    hx3918_write_reg(0X28, leddrive_ps2);
+    hx3918_write_reg(0X29, leddrive_ps3);
+    hx3918_write_reg(0X2a, (ldrsel_ps0<<4|ldrsel_ps1));
+    hx3918_write_reg(0X2b, (ldrsel_ps2<<4|ldrsel_ps3));
+    hx3918_write_reg(0X2c, dccancel_ps0);
+    hx3918_write_reg(0X2d, dccancel_ps1);
+    hx3918_write_reg(0X2e, dccancel_ps2);
+    hx3918_write_reg(0X2f, dccancel_ps3);
+    hx3918_write_reg(0X36, (thres_int<<4|data_rdy_int));
+    hx3918_write_reg(0X4e, (force_adc_clk_sel<<7|force_adc_clk_cfg<<6|force_PEN<<5|force_PEN_cfg<<4|force_LED_EN<<3|
+                            force_LED_EN_cfg<<2|force_CKAFEINT_sel<<1|force_CKAFEINT_cfg));
+
+    hx3918_write_reg(0X6d, 0x00);
+    hx3918_write_reg(0XF0, 0x22);
+    hx3918_write_reg(0xF1, 0x28);
+    hx3918_write_reg(0xF2, 0x04);
+    hx3918_write_reg(0xF3, 0x70);
+    hx3918_write_reg(0xF4, 0x32);
+    hx3918_write_reg(0xF5, 0x89);
+    hx3918_write_reg(0xF6, 0x2b);
+    hx3918_write_reg(0xF7, 0x85);
+    hx3918_write_reg(0xF8, 0x27);
+    hx3918_write_reg(0xF9, 0x00);
+    hx3918_write_reg(0xFA, 0x88);
+    hx3918_write_reg(0xFB, 0x40);
+    hx3918_write_reg(0Xf6, 0X2b);
+
+#if defined(TIMMER_MODE)
+    hx3918_write_reg(0x3d,0x83);    //bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;0011=p4;bits<7> fifo enble
+    hx3918_write_reg(0x3e,0x20);       //watermark
+    hx3918_write_reg(0x3c,0x1f);    // int_width_i2c
+    hx3918_write_reg(0X37, 0x00);   // int sel,01=prf int,04=enable almost full int
+    hx3918_write_reg(0X3b, 0x00);
+    hx3918_write_reg(0X3b, 0x10);
+#else ///////////INT Mode
+    hx3918_write_reg(0x3d,0x00);    //bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;0011=p4;bits<7> fifo enble
+    hx3918_write_reg(0x3c,0x1f);    // int_width_i2c
+    hx3918_write_reg(0X37, 0x04);   // int sel,01=prf ,04=enable almost full
+#endif
+
+    hx3918_write_reg(0X4d, 0X01);   //soft reset
+    hx3918_delay(5);
+    hx3918_write_reg(0X4d, 0X00);   //release
+    hx3918_delay(5);
+       hx3918_prox_init();
+    read_fifo_first_flg = 1;
+}
+
+void hx3918_check_touch_open(void)
+{
+    notouch_cnt = 0;
+    touch_cnt = 0;
+    hx3918_wear_status = MSG_NO_WEAR;
+}
+
+SENSOR_ERROR_T hx3918_check_touch_enable(void)
+{
+    if (!hx3918_chip_check())
+    {
+        AGC_LOG("hx3918 check id failed!\r\n");
+        return SENSOR_OP_FAILED;
+    }
+    AGC_LOG("hx3918 check id success!\r\n");
+
+    hx3918_check_touch_open();
+    hx3918_check_touch_init();
+    hx3918_ppg_timer_cfg(true);
+
+    return SENSOR_OK;
+}
+
+hx3918_wear_msg_code_t hx3918_check_touch(int32_t *ir_data, uint8_t data_len)
+{
+    uint8_t ii;
+       TYHX_LOG("\r\n check touch  ir data:    ");
+    for(ii=0; ii<data_len; ii++)
+    {
+       TYHX_LOG("%d    ", ir_data[ii]);
+        if(ir_data[ii]>check_mode_wear_thre)
+        {
+            if(notouch_cnt>0)
+            {
+                notouch_cnt--;
+            }
+            if(touch_cnt>=5)
+            {
+                hx3918_wear_status = MSG_WEAR;
+                touch_cnt=5;
+            }
+            else
+            {
+                touch_cnt++;
+            }
+        }
+        else if(ir_data[ii]<check_mode_unwear_thre)
+        {
+            if(touch_cnt>0)
+            {
+                touch_cnt--;
+            }
+            if(notouch_cnt>=5)
+            {
+                hx3918_wear_status = MSG_NO_WEAR;
+                notouch_cnt=5;
+            }
+            else
+            {
+                notouch_cnt++;
+            }
+        }
+    }
+       TYHX_LOG("\r\n");
+    return hx3918_wear_status;
+}
+
+uint8_t hx3918_check_touch_read(ppg_sensor_data_t *s_dat)
+{
+    int32_t *s_buf =  &(s_dat->s_buf[0]);
+    //int32_t *sar_lp_data  = &s_dat->sar_data;
+    uint8_t data_count = 0;
+
+    data_count = hx3918_read_fifo_data(s_buf,1,1);
+    //*sar_lp_data = hx3918_read_sar_data();
+    s_dat->count =  data_count;
+
+    return data_count;
+}
+
+#endif
diff --git a/2.sdk/Helios_SDK/components/HX3918/hx3918_check_touch.h b/2.sdk/Helios_SDK/components/HX3918/hx3918_check_touch.h
new file mode 100644 (file)
index 0000000..ee6a48e
--- /dev/null
@@ -0,0 +1,17 @@
+#ifndef _hx3918_CHECK_TOUCH_H_
+#define _hx3918_CHECK_TOUCH_H_
+
+#include <stdint.h>
+#include <stdbool.h>
+#include "hx3918.h"
+//#include "tyhx_hrs_custom.h"
+
+
+
+uint8_t hx3918_check_touch_read(ppg_sensor_data_t *s_dat);
+SENSOR_ERROR_T hx3918_check_touch_enable(void);
+uint8_t hx3918_check_touch_read(ppg_sensor_data_t *s_dat);
+hx3918_wear_msg_code_t hx3690l_check_touch_send_data(int32_t *ir_data, uint8_t count);
+hx3918_wear_msg_code_t check_touch_alg(int32_t ir_data);
+
+#endif
diff --git a/2.sdk/Helios_SDK/components/HX3918/hx3918_factory_test.c b/2.sdk/Helios_SDK/components/HX3918/hx3918_factory_test.c
new file mode 100644 (file)
index 0000000..9652f6a
--- /dev/null
@@ -0,0 +1,499 @@
+#include <stdio.h>
+#include <stdbool.h>
+#include <stdint.h>
+#include <stdlib.h>
+#include <math.h>
+
+#include "hx3918.h"
+#include "hx3918_factory_test.h"
+
+void hx3918_factory_ft_card_test_config(void)//»Ò¿¨10mm¸ß¶È²âÊÔÅäÖÃ
+{
+    uint16_t sample_rate = 25;                  /*config the data rate of chip alps2_fm ,uint is Hz*/
+    uint32_t prf_clk_num = 32000/sample_rate;   /*period in clk num, num = Fclk/fs */
+
+    uint8_t ps0_enable=1;       /*ps0_enable  , 1 mean enable ; 0 mean disable */
+    uint8_t ps1_enable=1;       /*ps1_enable  , 1 mean enable ; 0 mean disable */
+    uint8_t ps2_enable=1;       /*ps0_enable  , 1 mean enable ; 0 mean disable */
+    uint8_t ps3_enable=1;       /*ps1_enable  , 1 mean enable ; 0 mean disable */
+
+    uint8_t ps0_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+    uint8_t ps1_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+    uint8_t ps2_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+    uint8_t ps3_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+
+    uint8_t ps3_cp_avg_num_sel= 0;
+    uint8_t ps2_cp_avg_num_sel= 0;
+    uint8_t ps1_cp_avg_num_sel= 0;
+    uint8_t ps0_cp_avg_num_sel= 0;
+
+    uint8_t ps3_avg_num_sel_i2c=0;
+    uint8_t ps2_avg_num_sel_i2c=0;
+    uint8_t ps1_avg_num_sel_i2c=0;
+    uint8_t ps0_avg_num_sel_i2c=0;
+
+    /***********led open enable***********/
+
+    uint8_t ps0_led_en_i2c=1;
+    uint8_t ps1_led_en_i2c=1;
+    uint8_t ps2_led_en_i2c=1;
+    uint8_t ps3_led_en_i2c=1;
+
+    uint8_t ps0_ofidac_en_i2c=1;
+    uint8_t ps1_ofidac_en_i2c=1;
+    uint8_t ps2_ofidac_en_i2c=1;
+    uint8_t ps3_ofidac_en_i2c=1;
+
+    uint8_t dccancel_ps0 =0;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps1 =0;   //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps2 =0;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps3 =0;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+
+    uint8_t leddrive_ps0 =0;     //LEDDRIVE_PS0  0~255 = 0~200ma
+    uint8_t leddrive_ps1 =32;     //LEDDRIVE_PS1  0~255 = 0~200ma
+    uint8_t leddrive_ps2 =32;    //LEDDRIVE_PS2  0~255 = 0~200ma
+    uint8_t leddrive_ps3 =32;     //LEDDRIVE_PS3  0~255 = 0~200ma
+
+    uint8_t led_en_begin =1;       // 0 = 2 ; 1 = 4 ; 2 = 8 ; 3 = 16 ;
+    uint8_t afe_reset = 1;        //* 0 = 32clk ; 1 = 64clk ; 2 = 128clk ; 3 = 256clk(d) ;
+    uint8_t en2rst_delay =3;      // pen 2 rst delay 0 = 128,256, 512, 1024
+    uint8_t init_wait_delay = 2; /* 0 = 800 ; 1 = 1600; 2 = 3200 ; 3 = 6400(d) */
+
+    uint8_t ps1_interval_i2c =0;    // ps2/ps3
+
+    uint8_t thres_int =1;    //thres int enable
+    uint8_t data_rdy_int =8;    //[3]:ps1_data2 [2]:ps1_data1 [1]:ps0_data2 [0]:ps0_data1
+
+
+    uint8_t ldrsel_ps0 =0;
+    uint8_t ldrsel_ps1 =GREEN_LED_SLE;
+    uint8_t ldrsel_ps2 =RED_LED_SLE;
+    uint8_t ldrsel_ps3 =IR_LED_SLE;
+
+    /***********cap *********/
+    uint8_t intcapsel_ps3 =5;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+    uint8_t intcapsel_ps2 =5;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+    uint8_t intcapsel_ps1 =5;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+    uint8_t intcapsel_ps0 =5;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+
+    uint8_t ps0_led_on_time=32;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+    uint8_t ps1_led_on_time=32;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+    uint8_t ps2_led_on_time=32;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+    uint8_t ps3_led_on_time=32;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+
+    uint8_t force_adc_clk_sel=0;
+    uint8_t force_adc_clk_cfg =0;
+    uint8_t force_PEN =0;     //phase enable
+    uint8_t force_PEN_cfg =0;
+    uint8_t force_LED_EN =0;
+    uint8_t force_LED_EN_cfg =0;
+    uint8_t force_CKAFEINT_sel =0;
+    uint8_t force_CKAFEINT_cfg =0;
+
+    hx3918_write_reg(0X16, (ps3_enable<<3| ps2_enable<<2|ps1_enable<<1|ps0_enable));
+    hx3918_write_reg(0X17, (ps3_osr<<6| ps2_osr<<4|ps1_osr<<2|ps0_osr));
+    hx3918_write_reg(0X18, (uint8_t)prf_clk_num);
+    hx3918_write_reg(0X19, (uint8_t)(prf_clk_num>>8));
+    hx3918_write_reg(0X1a, (ps1_interval_i2c));
+    hx3918_write_reg(0X1b, led_en_begin<<6|afe_reset<<4|en2rst_delay <<2|init_wait_delay);
+    hx3918_write_reg(0X1c, ps0_led_on_time);
+    hx3918_write_reg(0X1d, ps1_led_on_time);
+    hx3918_write_reg(0X1e, ps2_led_on_time);
+    hx3918_write_reg(0X1f, ps3_led_on_time);
+    hx3918_write_reg(0X20, (ps3_cp_avg_num_sel<<6|ps2_cp_avg_num_sel<<4|ps1_cp_avg_num_sel<<2|ps0_cp_avg_num_sel)); 
+    hx3918_write_reg(0X21, (ps3_avg_num_sel_i2c<<6|ps2_avg_num_sel_i2c<<4|ps1_avg_num_sel_i2c<<2|ps0_avg_num_sel_i2c));
+    hx3918_write_reg(0X23, (ps0_led_en_i2c<<7|ps1_led_en_i2c<<6|ps2_led_en_i2c<<5|ps3_led_en_i2c<<4|ps0_ofidac_en_i2c<<3|ps1_ofidac_en_i2c<<2|ps2_ofidac_en_i2c<<1|ps3_ofidac_en_i2c));
+    hx3918_write_reg(0X24, (intcapsel_ps0<<4|intcapsel_ps1));
+    hx3918_write_reg(0X25, (intcapsel_ps2<<4|intcapsel_ps3));
+    hx3918_write_reg(0X26, leddrive_ps0);
+    hx3918_write_reg(0X27, leddrive_ps1);
+    hx3918_write_reg(0X28, leddrive_ps2);
+    hx3918_write_reg(0X29, leddrive_ps3);
+    hx3918_write_reg(0X2a, (ldrsel_ps0<<4|ldrsel_ps1));
+    hx3918_write_reg(0X2b, (ldrsel_ps2<<4|ldrsel_ps3));
+    hx3918_write_reg(0X2c, dccancel_ps0);
+    hx3918_write_reg(0X2d, dccancel_ps1);
+    hx3918_write_reg(0X2e, dccancel_ps2);
+    hx3918_write_reg(0X2f, dccancel_ps3);
+    hx3918_write_reg(0X36, (thres_int<<4|data_rdy_int));
+    hx3918_write_reg(0X4e, (force_adc_clk_sel<<7|force_adc_clk_cfg<<6|force_PEN<<5|force_PEN_cfg<<4|force_LED_EN<<3|
+                            force_LED_EN_cfg<<2|force_CKAFEINT_sel<<1|force_CKAFEINT_cfg));
+
+    hx3918_write_reg(0X6d, 0x00);
+    hx3918_write_reg(0XF0, 0x22);
+    hx3918_write_reg(0xF1, 0x28);
+    hx3918_write_reg(0xF2, 0x04);
+    hx3918_write_reg(0xF3, 0x70);
+    hx3918_write_reg(0xF4, 0x32);
+    hx3918_write_reg(0xF5, 0x89);
+    hx3918_write_reg(0xF6, 0x2b);
+    hx3918_write_reg(0xF7, 0x85);
+    hx3918_write_reg(0xF8, 0x27);
+    hx3918_write_reg(0xF9, 0x00);
+    hx3918_write_reg(0xFA, 0x88);
+    hx3918_write_reg(0xFB, 0x40);
+    hx3918_write_reg(0Xf6, 0X2b);
+
+    hx3918_write_reg(0x3d, 0x00);    //bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;0011=p4;bits<7> fifo enble
+    hx3918_write_reg(0x3e, 0x20);      //watermark
+    hx3918_write_reg(0x3c, 0x1f);    // int_width_i2c
+    hx3918_write_reg(0X37, 0x00);   // int sel,01=prf int,04=enable almost full int
+    hx3918_write_reg(0X3b, 0x00);
+    hx3918_write_reg(0X3b, 0x10);
+
+    hx3918_write_reg(0x4d, 0x01);   //soft reset
+    hx3918_delay(5);
+    hx3918_write_reg(0x4d, 0x00);   //release
+    hx3918_delay(5);
+}
+
+void hx3918_factory_ft_leak_light_test_config(void)//©¹â²âÊÔÅäÖÃ
+{
+    uint16_t sample_rate = 25;                  /*config the data rate of chip alps2_fm ,uint is Hz*/
+    uint32_t prf_clk_num = 32000/sample_rate;   /*period in clk num, num = Fclk/fs */
+
+    uint8_t ps0_enable=1;       /*ps0_enable  , 1 mean enable ; 0 mean disable */
+    uint8_t ps1_enable=1;       /*ps1_enable  , 1 mean enable ; 0 mean disable */
+    uint8_t ps2_enable=1;       /*ps0_enable  , 1 mean enable ; 0 mean disable */
+    uint8_t ps3_enable=1;       /*ps1_enable  , 1 mean enable ; 0 mean disable */
+
+    uint8_t ps0_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+    uint8_t ps1_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+    uint8_t ps2_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+    uint8_t ps3_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+
+    uint8_t ps3_cp_avg_num_sel= 0;
+    uint8_t ps2_cp_avg_num_sel= 0;
+    uint8_t ps1_cp_avg_num_sel= 0;
+    uint8_t ps0_cp_avg_num_sel= 0;
+
+    uint8_t ps3_avg_num_sel_i2c=0;
+    uint8_t ps2_avg_num_sel_i2c=0;
+    uint8_t ps1_avg_num_sel_i2c=0;
+    uint8_t ps0_avg_num_sel_i2c=0;
+
+    /***********led open enable***********/
+
+    uint8_t ps0_led_en_i2c=1;
+    uint8_t ps1_led_en_i2c=1;
+    uint8_t ps2_led_en_i2c=1;
+    uint8_t ps3_led_en_i2c=1;
+
+    uint8_t ps0_ofidac_en_i2c=1;
+    uint8_t ps1_ofidac_en_i2c=1;
+    uint8_t ps2_ofidac_en_i2c=1;
+    uint8_t ps3_ofidac_en_i2c=1;
+
+    uint8_t dccancel_ps0 =0;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps1 =0;   //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps2 =0;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps3 =0;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+
+    uint8_t leddrive_ps0 =0;     //LEDDRIVE_PS0  0~255 = 0~200ma
+    uint8_t leddrive_ps1 =64;     //LEDDRIVE_PS1  0~255 = 0~200ma
+    uint8_t leddrive_ps2 =64;    //LEDDRIVE_PS2  0~255 = 0~200ma
+    uint8_t leddrive_ps3 =64;     //LEDDRIVE_PS3  0~255 = 0~200ma
+
+    uint8_t led_en_begin =1;       // 0 = 2 ; 1 = 4 ; 2 = 8 ; 3 = 16 ;
+    uint8_t afe_reset = 1;        //* 0 = 32clk ; 1 = 64clk ; 2 = 128clk ; 3 = 256clk(d) ;
+    uint8_t en2rst_delay =3;      // pen 2 rst delay 0 = 128,256, 512, 1024
+    uint8_t init_wait_delay = 2; /* 0 = 800 ; 1 = 1600; 2 = 3200 ; 3 = 6400(d) */
+
+    uint8_t ps1_interval_i2c =0;    // ps2/ps3
+
+    uint8_t thres_int =1;    //thres int enable
+    uint8_t data_rdy_int =8;    //[3]:ps1_data2 [2]:ps1_data1 [1]:ps0_data2 [0]:ps0_data1
+
+
+    uint8_t ldrsel_ps0 =0;
+    uint8_t ldrsel_ps1 =GREEN_LED_SLE;
+    uint8_t ldrsel_ps2 =RED_LED_SLE;
+    uint8_t ldrsel_ps3 =IR_LED_SLE;
+
+    /***********cap *********/
+    uint8_t intcapsel_ps3 =5;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+    uint8_t intcapsel_ps2 =5;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+    uint8_t intcapsel_ps1 =5;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+    uint8_t intcapsel_ps0 =5;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+
+    uint8_t ps0_led_on_time=64;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+    uint8_t ps1_led_on_time=64;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+    uint8_t ps2_led_on_time=64;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+    uint8_t ps3_led_on_time=64;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+
+    uint8_t force_adc_clk_sel=0;
+    uint8_t force_adc_clk_cfg =0;
+    uint8_t force_PEN =0;     //phase enable
+    uint8_t force_PEN_cfg =0;
+    uint8_t force_LED_EN =0;
+    uint8_t force_LED_EN_cfg =0;
+    uint8_t force_CKAFEINT_sel =0;
+    uint8_t force_CKAFEINT_cfg =0;
+
+    hx3918_write_reg(0X16, (ps3_enable<<3| ps2_enable<<2|ps1_enable<<1|ps0_enable));
+    hx3918_write_reg(0X17, (ps3_osr<<6| ps2_osr<<4|ps1_osr<<2|ps0_osr));
+    hx3918_write_reg(0X18, (uint8_t)prf_clk_num);
+    hx3918_write_reg(0X19, (uint8_t)(prf_clk_num>>8));
+    hx3918_write_reg(0X1a, (ps1_interval_i2c));
+    hx3918_write_reg(0X1b, led_en_begin<<6|afe_reset<<4|en2rst_delay <<2|init_wait_delay);
+    hx3918_write_reg(0X1c, ps0_led_on_time);
+    hx3918_write_reg(0X1d, ps1_led_on_time);
+    hx3918_write_reg(0X1e, ps2_led_on_time);
+    hx3918_write_reg(0X1f, ps3_led_on_time);
+    hx3918_write_reg(0X20, (ps3_cp_avg_num_sel<<6|ps2_cp_avg_num_sel<<4|ps1_cp_avg_num_sel<<2|ps0_cp_avg_num_sel)); 
+    hx3918_write_reg(0X21, (ps3_avg_num_sel_i2c<<6|ps2_avg_num_sel_i2c<<4|ps1_avg_num_sel_i2c<<2|ps0_avg_num_sel_i2c));
+    hx3918_write_reg(0X23, (ps0_led_en_i2c<<7|ps1_led_en_i2c<<6|ps2_led_en_i2c<<5|ps3_led_en_i2c<<4|ps0_ofidac_en_i2c<<3|ps1_ofidac_en_i2c<<2|ps2_ofidac_en_i2c<<1|ps3_ofidac_en_i2c));
+    hx3918_write_reg(0X24, (intcapsel_ps0<<4|intcapsel_ps1));
+    hx3918_write_reg(0X25, (intcapsel_ps2<<4|intcapsel_ps3));
+    hx3918_write_reg(0X26, leddrive_ps0);
+    hx3918_write_reg(0X27, leddrive_ps1);
+    hx3918_write_reg(0X28, leddrive_ps2);
+    hx3918_write_reg(0X29, leddrive_ps3);
+    hx3918_write_reg(0X2a, (ldrsel_ps0<<4|ldrsel_ps1));
+    hx3918_write_reg(0X2b, (ldrsel_ps2<<4|ldrsel_ps3));
+    hx3918_write_reg(0X2c, dccancel_ps0);
+    hx3918_write_reg(0X2d, dccancel_ps1);
+    hx3918_write_reg(0X2e, dccancel_ps2);
+    hx3918_write_reg(0X2f, dccancel_ps3);
+    hx3918_write_reg(0X36, (thres_int<<4|data_rdy_int));
+    hx3918_write_reg(0X4e, (force_adc_clk_sel<<7|force_adc_clk_cfg<<6|force_PEN<<5|force_PEN_cfg<<4|force_LED_EN<<3|
+                            force_LED_EN_cfg<<2|force_CKAFEINT_sel<<1|force_CKAFEINT_cfg));
+
+    hx3918_write_reg(0X6d, 0x00);
+    hx3918_write_reg(0XF0, 0x22);
+    hx3918_write_reg(0xF1, 0x28);
+    hx3918_write_reg(0xF2, 0x04);
+    hx3918_write_reg(0xF3, 0x70);
+    hx3918_write_reg(0xF4, 0x32);
+    hx3918_write_reg(0xF5, 0x89);
+    hx3918_write_reg(0xF6, 0x2b);
+    hx3918_write_reg(0xF7, 0x85);
+    hx3918_write_reg(0xF8, 0x27);
+    hx3918_write_reg(0xF9, 0x00);
+    hx3918_write_reg(0xFA, 0x88);
+    hx3918_write_reg(0xFB, 0x40);
+    hx3918_write_reg(0Xf6, 0X2b);
+
+    hx3918_write_reg(0x3d, 0x00);    //bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;0011=p4;bits<7> fifo enble
+    hx3918_write_reg(0x3e, 0x20);      //watermark
+    hx3918_write_reg(0x3c, 0x1f);    // int_width_i2c
+    hx3918_write_reg(0X37, 0x00);   // int sel,01=prf int,04=enable almost full int
+    hx3918_write_reg(0X3b, 0x00);
+    hx3918_write_reg(0X3b, 0x10);
+
+    hx3918_write_reg(0x4d, 0x01);   //soft reset
+    hx3918_delay(5);
+    hx3918_write_reg(0x4d, 0x00);   //release
+    hx3918_delay(5);
+}
+
+void hx3918_factory_ft_int_test_config(void)//ÖжϲâÊÔÅäÖÃ
+{
+}
+
+bool hx3918_factory_test_read(int32_t *ps_data)
+{
+    uint8_t  databuf1[6] = {0};
+    uint8_t  databuf2[6] = {0};
+    int32_t P1 = 0, P2 = 0, P4 = 0, P3 = 0;
+    hx3918_brust_read_reg(0x02, databuf1, 6);
+    hx3918_brust_read_reg(0x08, databuf2, 6);
+
+    P1 = ((databuf1[0]) | (databuf1[1] << 8) | (databuf1[2] << 16));
+    P2 = ((databuf1[3]) | (databuf1[4] << 8) | (databuf1[5] << 16));
+    P3 = ((databuf2[0]) | (databuf2[1] << 8) | (databuf2[2] << 16));
+    P4 = ((databuf2[3]) | (databuf2[4] << 8) | (databuf2[5] << 16));
+
+    ps_data[0] = P1 ;
+    ps_data[1] = P2 ;
+    ps_data[2] = P3 ;
+    ps_data[3] = P4 ;
+    DEBUG_PRINTF("p1,p2,p3,p4 %d %d %d %d\r\n", P1, P2, P3, P4);
+    return true;
+}
+
+bool hx3918_chip_check_id(void)
+{
+    uint8_t i = 0;
+    uint8_t chip_idf =0;
+    for(i=0; i<10; i++)
+    {
+        hx3918_write_reg(0x01, 0x00);
+        hx3918_delay(5);
+        chip_idf = hx3918_read_reg(0x00);
+        if (chip_idf == 0x27)
+        {
+            return true;
+        }
+    }
+    return false;
+}
+
+factory_result_t hx3918_factroy_test(uint32_t  test_mode)
+{
+    factory_result_t factory_reslts = {0,0,0};
+    int32_t green_buffer[4] = {0,0,0,0};
+    int32_t red_buffer[4] = {0,0,0,0};
+    int32_t ir_buffer[4] = {0,0,0,0};
+    int32_t ps_data[4]= {0,0,0,0};
+
+    int32_t  green_led_data= 0;
+    int32_t  red_led_data= 0;
+    int32_t  ir_led_data= 0;
+
+    int32_t green_psdif[4] = {0,0,0,0};
+    int32_t red_psdif[4] = {0,0,0,0};
+    int32_t ir_psdif[4] = {0,0,0,0};
+
+    int32_t green_final = 0;
+    int32_t red_final = 0;
+    int32_t ir_final = 0;
+    int32_t testdata_temp = 0;
+
+    uint8_t ii = 0;
+    uint8_t jj = 0;
+    
+    if (hx3918_chip_check_id() == false)
+    {
+        return factory_reslts;
+    }
+    
+    switch(test_mode)
+    {
+        case LEAK_LIGHT_TEST:
+            hx3918_factory_ft_leak_light_test_config();
+            break;
+        case GRAY_CARD_TEST:
+            hx3918_factory_ft_card_test_config();
+            break;
+        case FT_INT_TEST:
+            hx3918_factory_ft_int_test_config();
+            break;
+        default:
+            break;
+    }
+    hx3918_delay(100);
+    if(test_mode==FT_INT_TEST)
+    {
+        return factory_reslts;
+    }
+
+    for(ii=0; ii<4; ii++) //40ms read data
+    {
+        hx3918_delay(40);
+        hx3918_factory_test_read(ps_data);
+        green_led_data = ps_data[1] - ps_data[0];
+        red_led_data = ps_data[2] - ps_data[0];
+        ir_led_data = ps_data[3] - ps_data[0];
+        green_buffer[ii] = green_led_data;
+        ir_buffer[ii] = ir_led_data;
+        red_buffer[ii] = red_led_data;
+    }
+
+    for(ii=0; ii<3; ii++)
+    {
+        for(jj=0; jj<3-ii; jj++)
+        {
+            if(green_buffer[jj]>=green_buffer[jj+1])
+            {
+                testdata_temp = green_buffer[jj];
+                green_buffer[jj] = green_buffer[jj+1];
+                green_buffer[jj+1] = testdata_temp;
+            }
+
+            if(red_buffer[jj]>=red_buffer[jj+1])
+            {
+                testdata_temp = red_buffer[jj];
+                red_buffer[jj] = red_buffer[jj+1];
+                red_buffer[jj+1] = testdata_temp;
+            }
+            if(ir_buffer[jj]>=ir_buffer[jj+1])
+            {
+                testdata_temp = ir_buffer[jj];
+                ir_buffer[jj] = ir_buffer[jj+1];
+                ir_buffer[jj+1] = testdata_temp;
+            }
+        }
+    }
+    
+    if(test_mode == LEAK_LIGHT_TEST)
+    {
+        hx3918_write_reg(0X2a, 0x00);
+        hx3918_write_reg(0X2b, 0x00);
+        hx3918_delay(100);
+        for(ii=0; ii<4; ii++) //40ms read data
+        {
+            hx3918_delay(40);
+            hx3918_factory_test_read(ps_data);
+            green_led_data = ps_data[1] - ps_data[0];
+            red_led_data = ps_data[2] - ps_data[0];
+            ir_led_data = ps_data[3] - ps_data[0];
+            green_psdif[ii] = green_led_data;
+            ir_psdif[ii] = ir_led_data;
+            red_psdif[ii] = red_led_data;
+        }
+        for(jj=0; jj<3-ii; jj++)
+        {
+            if(green_psdif[jj]>=green_psdif[jj+1])
+            {
+                testdata_temp = green_psdif[jj];
+                green_psdif[jj] = green_psdif[jj+1];
+                green_psdif[jj+1] = testdata_temp;
+            }
+
+            if(red_psdif[jj]>=red_psdif[jj+1])
+            {
+                testdata_temp = red_psdif[jj];
+                red_psdif[jj] = red_psdif[jj+1];
+                red_psdif[jj+1] = testdata_temp;
+            }
+            if(ir_psdif[jj]>=ir_psdif[jj+1])
+            {
+                testdata_temp = ir_psdif[jj];
+                ir_psdif[jj] = ir_psdif[jj+1];
+                ir_psdif[jj+1] = testdata_temp;
+            }
+        }
+    }
+
+    switch(test_mode)
+    {
+        case LEAK_LIGHT_TEST:
+            green_final = (green_buffer[1]+green_buffer[2])/2-(green_psdif[1]+green_psdif[2])/2;
+            red_final = (red_buffer[1]+red_buffer[2])/2-(red_psdif[1]+red_psdif[2])/2;
+            ir_final = (ir_buffer[1]+ir_buffer[2])/2-(ir_psdif[1]+ir_psdif[2])/2;
+            break;
+        case GRAY_CARD_TEST:
+            green_final = (green_buffer[1]+green_buffer[2])/2;
+            red_final = (red_buffer[1]+red_buffer[2])/2;
+            ir_final = (ir_buffer[1]+ir_buffer[2])/2;
+            break;
+        default:
+            break;
+    }
+    if(green_final<0)
+    {
+        green_final = 0;
+    }
+    if(red_final<0)
+    {
+        red_final = 0;
+    }
+    if(ir_final<0)
+    {
+        ir_final = 0;
+    }
+    factory_reslts.green_data_final = green_final;
+    factory_reslts.red_data_final = red_final;
+    factory_reslts.ir_data_final = ir_final;
+    DEBUG_PRINTF("%d %d %d\r\n",factory_reslts.green_data_final, factory_reslts.red_data_final,factory_reslts.ir_data_final);
+    return factory_reslts;
+}
diff --git a/2.sdk/Helios_SDK/components/HX3918/hx3918_factory_test.h b/2.sdk/Helios_SDK/components/HX3918/hx3918_factory_test.h
new file mode 100644 (file)
index 0000000..a15cfb4
--- /dev/null
@@ -0,0 +1,41 @@
+#ifndef _hx3918_FACTORY_TEST_H_
+#define _hx3918_FACTORY_TEST_H_
+
+#include <stdint.h>
+#include <stdbool.h>
+
+#define FT_OPEN_G_LED_LTH     3000 
+#define FT_OPEN_R_LED_LTH     3000
+#define FT_OPEN_IR_LED_LTH    3000
+
+#define FT_CARD_G_LED_HTH     200000 
+#define FT_CARD_R_LED_HTH     400000
+#define FT_CARD_IR_LED_HTH    400000
+
+typedef enum {
+       LEAK_LIGHT_TEST = 1,
+       GRAY_CARD_TEST = 2,
+       FT_INT_TEST = 3
+} TEST_MODE_t;
+
+typedef struct {
+    int32_t green_data_final;
+    int32_t red_data_final;
+    int32_t ir_data_final;
+} factory_result_t;
+
+
+//void hx3918_factory_test_config(void);
+void hx3918_factory_ft_leak_light_test_config(void);
+void hx3918_factory_ft_card_test_config(void);
+void hx3918_factory_ft_int_test_config(void);
+
+bool hx3918_factory_test_read(int32_t *ps_data);
+factory_result_t hx3918_factroy_test(uint32_t  test_mode);
+
+
+#endif // _hx3918_FACTORY_TEST_H_
+
+
+
+
diff --git a/2.sdk/Helios_SDK/components/HX3918/hx3918_hrs_agc.c b/2.sdk/Helios_SDK/components/HX3918/hx3918_hrs_agc.c
new file mode 100644 (file)
index 0000000..60d6afd
--- /dev/null
@@ -0,0 +1,737 @@
+#include <stdio.h>
+#include <stdbool.h>
+#include <stdint.h>
+#include <stdlib.h>
+#include <math.h>
+
+//#include "tyhx_hrs_custom.h"
+
+#include "hx3918.h"
+#include "hx3918_hrs_agc.h"
+#include "tyhx_hrs_alg.h"
+#include "hx3918_prox.h"
+
+#ifdef HRS_ALG_LIB
+
+extern uint8_t hx3918_hrs_agc_idac;
+extern uint8_t green_led_max_init;
+extern uint8_t low_vbat_flag;
+extern uint8_t read_fifo_first_flg;
+
+extern const int32_t  hrs_ir_unwear_thres;
+extern const int32_t  hrs_ir_wear_thres;
+extern const int32_t  sar_unwear_thres;
+extern const int32_t  sar_wear_thres;
+
+static uint8_t s_ppg_state = 0;
+static uint8_t s_cal_state = 0;
+static int32_t agc_buf[4] = {0};
+
+static uint8_t cal_delay = CAL_DELAY_COUNT;
+static HRS_CAL_SET_T  calReg;
+
+static hx3918_hrs_wear_msg_code_t hrs_wear_status = MSG_HRS_INIT;
+static hx3918_hrs_wear_msg_code_t hrs_wear_status_pre = MSG_HRS_INIT;
+
+static uint8_t no_touch_cnt = 0;
+
+void hx3918_hrs_ppg_init(void) //20200615 ericy ppg fs=25hz, phase3 conversion ready interupt en
+{
+    uint16_t sample_rate = 25;                  /*config the data rate of chip alps2_fm ,uint is Hz*/
+    uint32_t prf_clk_num = 32000/sample_rate;   /*period in clk num, num = Fclk/fs */
+
+    uint8_t ps0_enable=1;       /*ps0_enable  , 1 mean enable ; 0 mean disable */
+    uint8_t ps1_enable=1;       /*ps1_enable  , 1 mean enable ; 0 mean disable */
+    uint8_t ps2_enable=1;       /*ps0_enable  , 1 mean enable ; 0 mean disable */
+    uint8_t ps3_enable=1;       /*ps1_enable  , 1 mean enable ; 0 mean disable */
+
+    uint8_t ps0_osr = 1;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+    uint8_t ps1_osr = 1;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+    uint8_t ps2_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+    uint8_t ps3_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+
+    uint8_t ps3_cp_avg_num_sel= 0;
+    uint8_t ps2_cp_avg_num_sel= 2;
+    uint8_t ps1_cp_avg_num_sel= 0;
+    uint8_t ps0_cp_avg_num_sel= 0;
+
+    uint8_t ps3_avg_num_sel_i2c=0;
+    uint8_t ps2_avg_num_sel_i2c=0;
+    uint8_t ps1_avg_num_sel_i2c=0;
+    uint8_t ps0_avg_num_sel_i2c=0;
+
+    /***********led open enable***********/
+
+    uint8_t ps0_led_en_i2c=1;
+    uint8_t ps1_led_en_i2c=0;
+    uint8_t ps2_led_en_i2c=1;
+    uint8_t ps3_led_en_i2c=0;
+
+    uint8_t ps0_ofidac_en_i2c=1;
+    uint8_t ps1_ofidac_en_i2c=1;
+    uint8_t ps2_ofidac_en_i2c=1;
+    uint8_t ps3_ofidac_en_i2c=1;
+
+    uint8_t dccancel_ps0 =0;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps1 =0;   //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps2 =0;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps3 =0;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+
+    uint8_t leddrive_ps0 =64;     //LEDDRIVE_PS0  0~255 = 0~200ma
+    uint8_t leddrive_ps1 =0;     //LEDDRIVE_PS1  0~255 = 0~200ma
+    uint8_t leddrive_ps2 =0;    //LEDDRIVE_PS2  0~255 = 0~200ma
+    uint8_t leddrive_ps3 =0;     //LEDDRIVE_PS3  0~255 = 0~200ma
+
+    uint8_t led_en_begin =1;       // 0 = 2 ; 1 = 4 ; 2 = 8 ; 3 = 16 ;
+    uint8_t afe_reset = 1;        //* 0 = 32clk ; 1 = 64clk ; 2 = 128clk ; 3 = 256clk(d) ;
+    uint8_t en2rst_delay =3;      // pen 2 rst delay 0 = 128,256, 512, 1024
+    uint8_t init_wait_delay = 2; /* 0 = 800 ; 1 = 1600; 2 = 3200 ; 3 = 6400(d) */
+
+    uint8_t ps1_interval_i2c =0;    // ps2/ps3
+
+    uint8_t thres_int =1;    //thres int enable
+    uint8_t data_rdy_int =8;    //[3]:ps1_data2 [2]:ps1_data1 [1]:ps0_data2 [0]:ps0_data1
+
+
+    uint8_t ldrsel_ps0 =IR_LED_SLE;
+    uint8_t ldrsel_ps1 =0;
+    uint8_t ldrsel_ps2 =GREEN_LED_SLE;
+    uint8_t ldrsel_ps3 =0;
+
+    /***********cap *********/
+    uint8_t intcapsel_ps3 =5;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+    uint8_t intcapsel_ps2 =5;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+    uint8_t intcapsel_ps1 =5;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+    uint8_t intcapsel_ps0 =5;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+
+    uint8_t ps0_led_on_time=16;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+    uint8_t ps1_led_on_time=16;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+    uint8_t ps2_led_on_time=64;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+    uint8_t ps3_led_on_time=64;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+
+    uint8_t force_adc_clk_sel=0;
+    uint8_t force_adc_clk_cfg =0;
+    uint8_t force_PEN =0;     //phase enable
+    uint8_t force_PEN_cfg =0;
+    uint8_t force_LED_EN =0;
+    uint8_t force_LED_EN_cfg =0;
+    uint8_t force_CKAFEINT_sel =0;
+    uint8_t force_CKAFEINT_cfg =0;
+
+    hx3918_write_reg(0X16, (ps3_enable<<3| ps2_enable<<2|ps1_enable<<1|ps0_enable));
+    hx3918_write_reg(0X17, (ps3_osr<<6| ps2_osr<<4|ps1_osr<<2|ps0_osr));
+    hx3918_write_reg(0X18, (uint8_t)prf_clk_num);
+    hx3918_write_reg(0X19, (uint8_t)(prf_clk_num>>8));
+    hx3918_write_reg(0X1a, (ps1_interval_i2c));
+    hx3918_write_reg(0X1b, led_en_begin<<6|afe_reset<<4|en2rst_delay <<2|init_wait_delay);
+    //hx3918_write_reg(0X1b, 0x03);
+    hx3918_write_reg(0X1c, ps0_led_on_time);
+    hx3918_write_reg(0X1d, ps1_led_on_time);
+    hx3918_write_reg(0X1e, ps2_led_on_time);
+    hx3918_write_reg(0X1f, ps3_led_on_time);
+    hx3918_write_reg(0X20, (ps3_cp_avg_num_sel<<6|ps2_cp_avg_num_sel<<4|ps1_cp_avg_num_sel<<2|ps0_cp_avg_num_sel)); 
+    hx3918_write_reg(0X21, (ps3_avg_num_sel_i2c<<6|ps2_avg_num_sel_i2c<<4|ps1_avg_num_sel_i2c<<2|ps0_avg_num_sel_i2c));
+    hx3918_write_reg(0X23, (ps0_led_en_i2c<<7|ps1_led_en_i2c<<6|ps2_led_en_i2c<<5|ps3_led_en_i2c<<4|ps0_ofidac_en_i2c<<3|ps1_ofidac_en_i2c<<2|ps2_ofidac_en_i2c<<1|ps3_ofidac_en_i2c));
+    hx3918_write_reg(0X24, (intcapsel_ps0<<4|intcapsel_ps1));
+    hx3918_write_reg(0X25, (intcapsel_ps2<<4|intcapsel_ps3));
+    hx3918_write_reg(0X26, leddrive_ps0);
+    hx3918_write_reg(0X27, leddrive_ps1);
+    hx3918_write_reg(0X28, leddrive_ps2);
+    hx3918_write_reg(0X29, leddrive_ps3);
+    hx3918_write_reg(0X2a, (ldrsel_ps0<<4|ldrsel_ps1));
+    hx3918_write_reg(0X2b, (ldrsel_ps2<<4|ldrsel_ps3));
+    hx3918_write_reg(0X2c, dccancel_ps0);
+    hx3918_write_reg(0X2d, dccancel_ps1);
+    hx3918_write_reg(0X2e, dccancel_ps2);
+    hx3918_write_reg(0X2f, dccancel_ps3);
+    hx3918_write_reg(0X36, (thres_int<<4|data_rdy_int));
+    hx3918_write_reg(0X4e, (force_adc_clk_sel<<7|force_adc_clk_cfg<<6|force_PEN<<5|force_PEN_cfg<<4|force_LED_EN<<3|
+                            force_LED_EN_cfg<<2|force_CKAFEINT_sel<<1|force_CKAFEINT_cfg));
+
+    hx3918_write_reg(0X6d, 0x00);
+    hx3918_write_reg(0XF0, 0x22);
+    hx3918_write_reg(0xF1, 0x28);
+    hx3918_write_reg(0xF2, 0x04);
+    hx3918_write_reg(0xF3, 0x70);
+    hx3918_write_reg(0xF4, 0x32);
+    hx3918_write_reg(0xF5, 0x89);
+    hx3918_write_reg(0xF6, 0x2b);
+    hx3918_write_reg(0xF7, 0x85);
+    hx3918_write_reg(0xF8, 0x27);
+    hx3918_write_reg(0xF9, 0x00);
+    hx3918_write_reg(0xFA, 0x88);
+    hx3918_write_reg(0xFB, 0x40);
+    hx3918_write_reg(0Xf6, 0X2b);
+
+#if defined(TIMMER_MODE)
+    hx3918_write_reg(0x3d, 0x83);    //bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;0011=p4;bits<7> fifo enble
+    hx3918_write_reg(0x3e, 0x20);      //watermark
+    hx3918_write_reg(0x3c, 0x1f);    // int_width_i2c
+    hx3918_write_reg(0X37, 0x00);   // int sel,01=prf int,04=enable almost full int
+    hx3918_write_reg(0X3b, 0x00);
+    hx3918_write_reg(0X3b, 0x10);
+#else ///////////INT Mode
+    hx3918_write_reg(0x3d, 0x00);    //bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;0011=p4;bits<7> fifo enble
+    hx3918_write_reg(0x3c, 0x1f);    // int_width_i2c
+    hx3918_write_reg(0x37, 0x04);   // int sel,01=prf ,04=enable almost full
+#endif
+
+    hx3918_write_reg(0x4d, 0x01);   //soft reset
+    hx3918_delay(5);
+    hx3918_write_reg(0x4d, 0x00);   //release
+    hx3918_delay(5);
+    read_fifo_first_flg = 1;
+}
+
+void Init_hrs_PPG_Calibration_Routine(HRS_CAL_SET_T *calR)
+{
+    calR->flag = CAL_FLG_LED_DR|CAL_FLG_LED_DAC|CAL_FLG_AMB_DAC|CAL_FLG_RF;
+
+    calR->led_idac   = 0;
+    calR->amb_idac   = 0;
+    calR->ontime     = 5;
+    calR->led_cur    = HRS_CAL_INIT_LED;
+    calR->state      = hrsCalStart;
+    calR->int_cnt    = 0;
+    calR->cur255_cnt = 0;
+    if(low_vbat_flag==1)
+    {
+        calR->led_max_cur = green_led_max_init>>1;
+    }
+    else
+    {
+        calR->led_max_cur = green_led_max_init;
+    }
+}
+
+void Restart_hrs_PPG_Calibration_Routine(HRS_CAL_SET_T *calR)
+{
+    calR->flag = CAL_FLG_LED_DAC;
+    calR->state = hrsCalLed;
+    calR->int_cnt = 0;
+}
+
+hx3918_hrs_wear_msg_code_t hx3918_hrs_wear_mode_check(int32_t infrared_data)
+{
+    int32_t check_thre = 0;
+    if(hrs_wear_status == MSG_HRS_NO_WEAR)
+    {
+        check_thre = hrs_ir_wear_thres;
+    }
+    else
+    {
+        check_thre = hrs_ir_unwear_thres;
+    }
+
+    if(infrared_data < check_thre)
+    {
+        if(no_touch_cnt < NO_TOUCH_CHECK_NUM)
+        {
+            no_touch_cnt++;
+        }
+        if(no_touch_cnt >= NO_TOUCH_CHECK_NUM)
+        {
+            hrs_wear_status = MSG_HRS_NO_WEAR;
+        }
+    }
+    else if(infrared_data >= check_thre)
+    {
+        if(no_touch_cnt>0)
+        {
+            no_touch_cnt--;
+        }
+        if(no_touch_cnt == 0)
+        {
+            hrs_wear_status = MSG_HRS_WEAR;
+        }
+    }
+    //AGC_LOG("hrs wear: ir=%d,  %x\r\n",infrared_data,hx3918_read_reg(0x6a));
+    //AGC_LOG("hrs wearstates: hrs_wear_status_pre=%d,hrs_wear_status=%d\r\n",\
+    //hrs_wear_status_pre,hrs_wear_status);
+
+       //hrs_wear_status = hx3918_get_wear_result(hrs_wear_status);
+       TYHX_LOG("[hx3918_hrs_wear_mode_check end] final result = %d\r\n",hrs_wear_status);
+    if(hrs_wear_status_pre != hrs_wear_status)
+    {
+        hrs_wear_status_pre = hrs_wear_status;
+        if(hrs_wear_status == MSG_HRS_NO_WEAR)
+        {
+            hx3918_hrs_low_power();
+        }
+        else if(hrs_wear_status == MSG_HRS_WEAR)
+        {
+            tyhx_hrs_alg_open_deep();
+            hx3918_hrs_set_mode(PPG_INIT);
+            hx3918_hrs_set_mode(CAL_INIT);
+        }
+    }
+    return hrs_wear_status;  
+}
+
+/*
+hx3918_hrs_wear_msg_code_t hx3918_hrs_check_unwear(int32_t infrared_data)
+{
+    AGC_LOG("infrared_data=%d,hrs_wear_status=%d\r\n",infrared_data,hrs_wear_status);
+    if(infrared_data < hrs_ir_unwear_thres)
+    {
+        if(no_touch_cnt == NO_TOUCH_CHECK_NUM)
+        {
+            hrs_wear_status = MSG_HRS_NO_WEAR;
+            if(hrs_wear_status_pre != hrs_wear_status)
+            {
+                hx3918_hrs_low_power();
+            }
+        }
+        else
+        {
+            no_touch_cnt++;
+        }
+    }
+    else
+    {
+        no_touch_cnt = 0;
+    }
+    hrs_wear_status_pre = hrs_wear_status;
+    return hrs_wear_status;
+}
+*/
+void PPG_hrs_Calibration_Routine(HRS_CAL_SET_T *calR, int32_t led, int32_t amb)
+{
+    switch(calR->state)
+    {
+    case hrsCalStart:
+        calR->state = hrsLedCur;
+        break;
+
+    case hrsLedCur:
+        if(amb>280000)
+        {
+            calR->amb_idac = (amb-280000)/10000;
+        }
+        else
+        {
+            calR->amb_idac = 0;
+        }
+        if(led>amb+128)
+        {
+            calR->led_step = (led-amb)/HRS_CAL_INIT_LED;
+            calR->led_cur = 5000*(hx3918_hrs_agc_idac+calR->amb_idac)/calR->led_step;
+            if(calR->led_cur>calR->led_max_cur)
+            {
+                calR->led_cur = calR->led_max_cur;
+            }
+            calR->led_idac = hx3918_hrs_agc_idac>>1;
+            calR->ontime = 64;
+            calR->flag = CAL_FLG_LED_DR|CAL_FLG_LED_DAC|CAL_FLG_AMB_DAC|CAL_FLG_RF;
+            calR->state = hrsCalLed;
+        }
+        else
+        {
+            calR->led_cur = calR->led_max_cur;
+            calR->led_idac = hx3918_hrs_agc_idac>>1;
+            calR->ontime = 64;
+            calR->flag = CAL_FLG_LED_DR|CAL_FLG_LED_DAC|CAL_FLG_AMB_DAC|CAL_FLG_RF;
+            calR->state = hrsCalLed;
+        }
+        break;
+
+    case hrsCalLed:
+        if(led>350000 && calR->led_idac<=120)
+        {
+            calR->led_idac = calR->led_idac + 1;
+            calR->state = hrsCalLed;
+        }
+        else if(led<150000 && calR->led_idac>=1)
+        {
+            calR->led_idac = calR->led_idac - 1;
+            calR->state = hrsCalLed;
+        }
+        else
+        {
+            calR->state = hrsCalFinish;
+        }
+        calR->flag = CAL_FLG_LED_DAC;
+        break;
+
+    default:
+        break;
+
+    }
+    AGC_LOG("AGC: led_drv=%d,ledDac=%d,ambDac=%d,ledstep=%d,ontime=%d,state=%d\r\n",\
+            calR->led_cur, calR->led_idac, calR->amb_idac,calR->led_step,calR->ontime,calR->state);
+}
+
+HRS_CAL_SET_T PPG_hrs_agc(void)
+{
+    int32_t led_val, amb_val;
+    calReg.work = false;
+    if (!s_cal_state)
+    {
+        return  calReg;
+    }
+
+#ifdef INT_MODE
+    calReg.int_cnt ++;
+    if(calReg.int_cnt < 4)
+    {
+        return calReg;
+    }
+    calReg.int_cnt = 0;
+    hx3918_gpioint_cfg(false);
+#endif
+    calReg.work = true;
+
+    read_data_packet(agc_buf);
+    led_val = agc_buf[2];
+    amb_val = agc_buf[3];
+
+    AGC_LOG("cal dat led_val=%d,amb_val=%d \r\n", led_val, amb_val);
+
+    PPG_hrs_Calibration_Routine(&calReg, led_val, amb_val);
+
+    if (calReg.state == hrsCalFinish)
+    {
+        hx3918_hrs_set_mode(CAL_OFF);
+    }
+    else
+    {
+        hx3918_hrs_updata_reg();
+    }
+    #if defined(INT_MODE)
+    hx3918_gpioint_cfg(true);
+    #endif
+    
+    return  calReg;
+}
+
+void hx3918_hrs_cal_init(void) // 20200615 ericy afe cali online
+{
+    uint16_t sample_rate = 100;                      /*config the data rate of chip alps2_fm ,uint is Hz*/
+    uint32_t prf_clk_num = 32000/sample_rate;        /*period in clk num, num = Fclk/fs */
+    uint8_t thres_int =0;    //thres int enable
+    uint8_t data_rdy_int =8;    //[3]:ps1_data2 [2]:ps1_data1 [1]:ps0_data2 [0]:ps0_data1
+
+    hx3918_write_reg(0X18, (uint8_t)prf_clk_num);    // prf bit<7:0>6   default 0x00
+    hx3918_write_reg(0X19, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>  default 0x03
+    hx3918_write_reg(0x3d,0x00);     //bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;0011=p4;bits<7> fifo enble
+    hx3918_write_reg(0X36, (thres_int<<4|data_rdy_int));   //default 0x0f
+
+    hx3918_write_reg(0X4d, 0X01);  //soft reset
+    hx3918_delay(5);
+    hx3918_write_reg(0X4d, 0X00);  //release
+    hx3918_delay(5);             //Delay for reset time
+}
+
+void hx3918_hrs_cal_off(void) // 20200615 ericy afe cali offline
+{
+    uint16_t sample_rate = 25;                      /*config the data rate of chip alps2_fm ,uint is Hz*/
+    uint32_t prf_clk_num = 32000/sample_rate;        /*period in clk num, num = Fclk/fs */
+
+    uint8_t thres_int =0;    //thres int enable
+    uint8_t data_rdy_int =0;    //[3]:ps1_data2 [2]:ps1_data1 [1]:ps0_data2 [0]:ps0_data1
+
+    hx3918_write_reg(0X18, (uint8_t)prf_clk_num);    // prf bit<7:0>6   default 0x00
+    hx3918_write_reg(0X19, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>  default 0x03
+
+    hx3918_write_reg(0x3d, 0x83);     //bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;0011=p4;bits<7> fifo enble
+    hx3918_write_reg(0X36, (thres_int<<4|data_rdy_int));   //default 0x0f
+
+    hx3918_write_reg(0X4d, 0X01);  //soft reset
+    hx3918_delay(5);
+    hx3918_write_reg(0X4d, 0X00);  //release
+    hx3918_delay(5);             //Delay for reset time
+       #if DEBUG_PPG_ONLY
+        hx3918_prox_init();
+    #endif
+    read_fifo_first_flg = 1;
+}
+
+void hx3918_hrs_low_power(void)
+{
+    uint16_t sample_rate = 10;                  /*config the data rate of chip alps2_fm ,uint is Hz*/
+    uint32_t prf_clk_num = 32000/sample_rate;   /*period in clk num, num = Fclk/fs */
+
+    uint8_t ps3_cp_avg_num_sel= 0;
+    uint8_t ps2_cp_avg_num_sel= 0;
+    uint8_t ps1_cp_avg_num_sel= 0;
+    uint8_t ps0_cp_avg_num_sel= 0;
+
+    uint8_t ps3_avg_num_sel_i2c=0;
+    uint8_t ps2_avg_num_sel_i2c=0;
+    uint8_t ps1_avg_num_sel_i2c=0;
+    uint8_t ps0_avg_num_sel_i2c=0;
+
+    uint8_t ps0_led_en_i2c=1;
+    uint8_t ps1_led_en_i2c=0;
+    uint8_t ps2_led_en_i2c=0;
+    uint8_t ps3_led_en_i2c=0;
+
+    uint8_t dccancel_ps0 =0;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps1 =0;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps2 =0;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps3 =0;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+
+    uint8_t leddrive_ps0 =64;    //LEDDRIVE_PS0  0~255 = 0~200ma
+    uint8_t leddrive_ps1 =0;     //LEDDRIVE_PS1  0~255 = 0~200ma
+    uint8_t leddrive_ps2 =0;     //LEDDRIVE_PS2  0~255 = 0~200ma
+    uint8_t leddrive_ps3 =0;     //LEDDRIVE_PS3  0~255 = 0~200ma
+
+    hx3918_write_reg(0X18, (uint8_t)prf_clk_num);    // prf bit<7:0>6   default 0x00
+    hx3918_write_reg(0X19, (uint8_t)(prf_clk_num>>8)); // prf bit<11:8>  default 0x03
+    hx3918_write_reg(0X20, (ps3_cp_avg_num_sel<<6|ps2_cp_avg_num_sel<<4|ps1_cp_avg_num_sel<<2|ps0_cp_avg_num_sel) );
+    hx3918_write_reg(0X21, (ps3_avg_num_sel_i2c<<6|ps2_avg_num_sel_i2c<<4|ps1_avg_num_sel_i2c<<2|ps0_avg_num_sel_i2c));
+    hx3918_write_reg(0X23, (ps0_led_en_i2c<<7|ps1_led_en_i2c<<6|ps2_led_en_i2c<<5|ps3_led_en_i2c<<4|0x0f));
+
+    hx3918_write_reg(0X26, leddrive_ps0);
+    hx3918_write_reg(0X27, leddrive_ps1);
+    hx3918_write_reg(0X28, leddrive_ps2);
+    hx3918_write_reg(0X29, leddrive_ps3);
+
+    hx3918_write_reg(0X2c, dccancel_ps0);
+    hx3918_write_reg(0X2d, dccancel_ps1);
+    hx3918_write_reg(0X2e, dccancel_ps2);
+    hx3918_write_reg(0X2f, dccancel_ps3);
+
+    hx3918_write_reg(0x4d, 0x01);  //soft reset
+    hx3918_delay(5);
+    hx3918_write_reg(0x4d, 0x00);  //release
+    hx3918_delay(5);
+
+    calReg.led_cur = 0;
+       #if DEBUG_PPG_ONLY
+        hx3918_prox_init();
+    #endif
+    read_fifo_first_flg = 1;
+    AGC_LOG(" chip go to low power mode  \r\n" );
+
+}
+
+void hx3918_hrs_updata_reg(void)
+{
+    if (calReg.flag & CAL_FLG_LED_DR)
+    {
+        hx3918_write_reg(0X28, calReg.led_cur);
+    }
+
+    if (calReg.flag & CAL_FLG_LED_DAC)
+    {
+        hx3918_write_reg(0X2e, (uint8_t)calReg.led_idac);
+    }
+
+    if (calReg.flag & CAL_FLG_AMB_DAC)
+    {
+        hx3918_write_reg(0X2f, (uint8_t)calReg.amb_idac);
+    }
+
+    if (calReg.flag & CAL_FLG_RF)
+    {
+        hx3918_write_reg(0X1e, calReg.ontime); //3918 p2
+        hx3918_write_reg(0X1f, calReg.ontime); //3918 p3
+    }
+}
+
+void hx3918_hrs_set_mode(uint8_t mode_cmd)
+{
+    switch (mode_cmd)
+    {
+    case PPG_INIT:
+        hx3918_hrs_ppg_init();
+        #if defined(TIMMER_MODE)
+        hx3918_ppg_timer_cfg(true);
+        #else
+        hx3918_gpioint_cfg(true);
+        #endif
+        s_ppg_state = 1;
+        AGC_LOG("ppg init mode\r\n");
+        break;
+
+    case PPG_OFF:
+        hx3918_ppg_off();
+        s_ppg_state = 0;
+        AGC_LOG("ppg off mode\r\n");
+        break;
+
+    case PPG_LED_OFF:
+        hx3918_hrs_low_power();
+        s_ppg_state = 0;
+        AGC_LOG("ppg led off mode\r\n");
+        break;
+
+    case CAL_INIT:
+        Init_hrs_PPG_Calibration_Routine(&calReg);
+        hx3918_hrs_cal_init();
+        hx3918_hrs_updata_reg();
+        #if defined(TIMMER_MODE)
+        hx3918_agc_timer_cfg(true);
+        #endif
+        s_cal_state = 1;
+        AGC_LOG("cal init mode\r\n");
+        break;
+
+    case RECAL_INIT:
+        Restart_hrs_PPG_Calibration_Routine(&calReg);
+        hx3918_hrs_cal_init();
+        hx3918_hrs_updata_reg();
+        #if defined(TIMMER_MODE)
+        hx3918_agc_timer_cfg(true);
+        #endif
+        s_cal_state = 1;
+        AGC_LOG("Recal init mode\r\n");
+        break;
+
+    case CAL_OFF:
+        #if defined(TIMMER_MODE)
+        hx3918_agc_timer_cfg(false);
+        #endif
+        hx3918_hrs_cal_off();
+        s_cal_state = 0;
+        AGC_LOG("cal off mode\r\n");
+        break;
+
+    default:
+        break;
+    }
+}
+
+SENSOR_ERROR_T hx3918_hrs_enable(void)
+{
+    if (!hx3918_chip_check())
+    {
+        TYHX_LOG("hx3918 check id failed!\r\n");
+        return SENSOR_OP_FAILED;
+    }
+    else
+    {
+        TYHX_LOG("hx3918 check id success!\r\n");
+    }
+    if (s_ppg_state)
+    {
+        TYHX_LOG("ppg already on!\r\n");
+        return SENSOR_OP_FAILED;
+    }
+    if(!tyhx_hrs_alg_open())
+    {
+        TYHX_LOG("hrs alg open fail,or dynamic ram not enough!\r\n");
+    }
+
+    hrs_wear_status = MSG_HRS_INIT;
+    hrs_wear_status_pre = MSG_HRS_INIT;
+    hx3918_hrs_set_mode(PPG_INIT);
+    TYHX_LOG("hx3918 enable!\r\n");
+
+    return SENSOR_OK;
+}
+
+void hx3918_hrs_disable(void)
+{
+#if defined(TIMMER_MODE)
+    hx3918_ppg_timer_cfg(false);
+    hx3918_agc_timer_cfg(false);
+    #elif defined(INT_MODE)
+    hx3918_gpioint_cfg(false);
+    #endif
+    hx3918_hrs_set_mode(PPG_OFF);
+    s_ppg_state = 0;
+    s_cal_state = 0;
+    tyhx_hrs_alg_close();
+}
+
+void hx3918_hrs_data_reset(void)
+{
+    s_ppg_state = 0;
+    s_cal_state = 0;
+    tyhx_hrs_alg_close();
+}
+
+hx3918_hrs_wear_msg_code_t hx3918_hrs_get_wear_status(void)
+{
+    return  hrs_wear_status;
+}
+
+HRS_CAL_SET_T get_hrs_agc_status(void)
+{
+    HRS_CAL_SET_T cal;
+    cal.flag     = calReg.flag;
+    cal.int_cnt  = calReg.int_cnt;
+    cal.led_cur  = calReg.led_cur;
+    cal.led_idac = calReg.led_idac;
+    cal.amb_idac = calReg.amb_idac;
+    cal.ontime   = calReg.ontime;
+    cal.led_step = calReg.led_step;
+    cal.state    = calReg.state;
+    return cal;
+}
+
+uint8_t hx3918_hrs_read(ppg_sensor_data_t * s_dat)
+{
+    int32_t PPG_src_data;
+    int32_t Ir_src_data;
+    bool recal = false;
+    int32_t *PPG_buf =  &(s_dat->green_data[0]);
+    int32_t *ir_buf =  &(s_dat->ir_data[0]);
+    int32_t *s_buf =  &(s_dat->s_buf[0]);
+    s_dat->green_cur =  calReg.led_cur;
+    //int32_t *sar_lp_data  = &s_dat->sar_data;
+    int32_t ps_data[4]= {0};
+    int32_t ps_green_data = 0;
+    uint8_t data_count = 0;
+
+    if (!s_ppg_state || s_cal_state)
+    {
+        return NULL;
+    }
+
+    read_data_packet(ps_data);
+    ps_green_data = ps_data[2];
+
+    data_count = hx3918_read_fifo_data(s_buf,2,1);
+    s_dat->count =  data_count;
+       TYHX_LOG("\r\n hrs  ir data:    ");
+    for (uint8_t i=0; i<data_count; i++)
+    {
+        PPG_src_data = s_buf[i*2+1];
+        Ir_src_data = s_buf[i*2];
+        PPG_buf[i] = 2*PPG_src_data;
+        ir_buf[i] = Ir_src_data;
+               TYHX_LOG("%d    ",ir_buf[i]);
+        //DEBUG_PRINTF("ppg data size: %d\r\n", Ir_src_data);
+        hx3918_hrs_wear_mode_check(Ir_src_data);
+        
+        //DEBUG_PRINTF("%d/%d %d %d\r\n",1+i,data_count,PPG_buf[i],ir_buf[i]);
+    }
+       TYHX_LOG("\r\n");
+
+    if (ps_green_data<100000 || ps_green_data>400000)
+    {
+        recal = true;
+
+        if(hrs_wear_status==MSG_HRS_NO_WEAR)
+        {
+            recal = false;
+        }
+    }
+    if (recal)
+    {
+        cal_delay--;
+
+        if (cal_delay <= 0)
+        {
+            cal_delay = CAL_DELAY_COUNT;
+            hx3918_hrs_set_mode(RECAL_INIT);
+        }
+    }
+    else
+    {
+        cal_delay = CAL_DELAY_COUNT;
+    }
+    return 1;
+}
+#endif
+
+
+
+
diff --git a/2.sdk/Helios_SDK/components/HX3918/hx3918_hrs_agc.h b/2.sdk/Helios_SDK/components/HX3918/hx3918_hrs_agc.h
new file mode 100644 (file)
index 0000000..f657901
--- /dev/null
@@ -0,0 +1,68 @@
+#ifndef _hx3918_agc_H_
+#define _hx3918_agc_H_
+#include <stdint.h>
+#include <stdbool.h>
+#include "hx3918.h"
+
+#define CAL_DELAY_COUNT (3)
+
+#define CAL_FLG_LED_DR     0x01
+#define CAL_FLG_LED_DAC    0x02 
+#define CAL_FLG_AMB_DAC    0x04
+#define CAL_FLG_RF         0x08
+
+#define HRS_CAL_INIT_LED   64
+#define NO_TOUCH_CHECK_NUM 2
+
+
+typedef enum {      
+    hrsCalStart, 
+    hrsLedCur,
+    hrsCalLed,
+    hrsCalFinish, 
+}HRS_STATE_T;
+
+typedef struct {
+       uint8_t flag;
+       bool work;
+       uint8_t int_cnt;
+       uint8_t cur255_cnt;
+       uint16_t led_cur;
+       uint8_t led_idac; 
+       uint8_t amb_idac;
+       uint8_t ontime;
+       uint16_t led_step;
+       uint8_t state;
+       uint8_t led_max_cur;
+} HRS_CAL_SET_T;
+
+typedef enum {
+       MSG_HRS_NO_WEAR,
+       MSG_HRS_WEAR,
+       MSG_HRS_INIT
+} hx3918_hrs_wear_msg_code_t;
+
+void Init_hrs_PPG_Calibration_Routine(HRS_CAL_SET_T *calR);
+void Restart_hrs_PPG_Calibration_Routine(HRS_CAL_SET_T *calR);
+void PPG_hrs_Calibration_Routine(HRS_CAL_SET_T *calR, int32_t led, int32_t amb);
+HRS_CAL_SET_T PPG_hrs_agc(void);
+void hx3918_hrs_cal_init(void);
+void hx3918_hrs_cal_off(void);
+
+void hx3918_hrs_low_power(void);
+void hx3918_hrs_normal_power(void);
+void hx3918_hrs_updata_reg(void);
+void hx3918_hrs_set_mode(uint8_t mode_cmd);
+SENSOR_ERROR_T hx3918_hrs_enable(void);
+void hx3918_hrs_disable(void);
+hx3918_hrs_wear_msg_code_t hx3918_hrs_get_wear_status(void);
+uint8_t hx3918_hrs_read(ppg_sensor_data_t * s_dat);
+bool hx3918_hrs_init(void);
+
+hx3918_hrs_wear_msg_code_t hx3918_hrs_wear_mode_check(int32_t infrared_data);
+//hx3918_hrs_wear_msg_code_t hx3918_hrs_check_unwear(int32_t infrared_data);
+hx3918_hrs_wear_msg_code_t hx3918_hrs_check_wear(void);
+HRS_CAL_SET_T get_hrs_agc_status(void);
+void hx3918_hrs_data_reset(void);
+
+#endif
diff --git a/2.sdk/Helios_SDK/components/HX3918/hx3918_hrv_agc.c b/2.sdk/Helios_SDK/components/HX3918/hx3918_hrv_agc.c
new file mode 100644 (file)
index 0000000..1c4964c
--- /dev/null
@@ -0,0 +1,956 @@
+#include <stdio.h>
+#include <stdbool.h>
+#include <stdint.h>
+#include <stdlib.h>
+#include <math.h>
+
+//#include "tyhx_hrs_custom.h"
+#include "hx3918_hrs_agc.h"
+#include "hx3918_hrv_agc.h"
+#include "tyhx_hrv_alg.h"
+#include "hx3918_prox.h"
+//#ifdef TYHX_DEMO
+//#include "twi_master.h"
+//#include "SEGGER_RTT.h"
+//#endif
+
+#ifdef HRV_ALG_LIB
+
+extern const uint8_t  hx3918_hrs_agc_idac;
+extern const uint8_t  green_led_max_init;
+extern uint8_t low_vbat_flag;
+extern uint8_t read_fifo_first_flg;
+
+//hrv_INFRARED_THRES
+extern const int32_t  hrv_ir_unwear_thres;
+extern const int32_t  hrv_ir_wear_thres;
+
+static uint8_t s_ppg_state = 0;
+static uint8_t s_cal_state = 0;
+static int32_t agc_buf[4] = {0};
+
+static uint8_t cal_delay = CAL_DELAY_COUNT;
+static HRV_CAL_SET_T  calReg;
+//
+static hx3918_hrv_wear_msg_code_t hrv_wear_status = MSG_HRV_NO_WEAR;
+static hx3918_hrv_wear_msg_code_t hrv_wear_status_pre = MSG_HRV_NO_WEAR;
+
+static uint8_t no_touch_cnt = 0;
+
+void hx3918_hrv_ppg_init(void) //20200615 ericy ppg fs=25hz, phase3 conversion ready interupt en
+{
+    /* start cfg*/
+    uint16_t sample_rate = 125;                  /*config the data rate of chip alps2_fm ,uint is Hz*/
+    uint32_t prf_clk_num = 32000/sample_rate;   /*period in clk num, num = Fclk/fs */
+
+    uint8_t ps0_enable=1;       /*ps0_enable  , 1 mean enable ; 0 mean disable */
+    uint8_t ps1_enable=1;       /*ps1_enable  , 1 mean enable ; 0 mean disable */
+    uint8_t ps2_enable=1;       /*ps0_enable  , 1 mean enable ; 0 mean disable */
+    uint8_t ps3_enable=1;       /*ps1_enable  , 1 mean enable ; 0 mean disable */
+
+    uint8_t ps0_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+    uint8_t ps1_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+    uint8_t ps2_osr = 1;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+    uint8_t ps3_osr = 1;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+
+    uint8_t ps3_cp_avg_num_sel= 0;
+    uint8_t ps2_cp_avg_num_sel= 0;
+    uint8_t ps1_cp_avg_num_sel= 0;
+    uint8_t ps0_cp_avg_num_sel= 0;
+
+    uint8_t ps3_avg_num_sel_i2c=0;
+    uint8_t ps2_avg_num_sel_i2c=0;
+    uint8_t ps1_avg_num_sel_i2c=0;
+    uint8_t ps0_avg_num_sel_i2c=0;
+
+    /***********led open enable***********/
+
+    uint8_t ps0_led_en_i2c=1;
+    uint8_t ps1_led_en_i2c=0;
+    uint8_t ps2_led_en_i2c=1;
+    uint8_t ps3_led_en_i2c=0;
+
+    uint8_t ps0_ofidac_en_i2c=1;
+    uint8_t ps1_ofidac_en_i2c=1;
+    uint8_t ps2_ofidac_en_i2c=1;
+    uint8_t ps3_ofidac_en_i2c=1;
+
+    uint8_t dccancel_ps0 =8;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps1 =8;   //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps2 =8;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps3 =8;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+
+    uint8_t leddrive_ps0 =0;     //LEDDRIVE_PS0  0~255 = 0~200ma
+    uint8_t leddrive_ps1 =0;     //LEDDRIVE_PS1  0~255 = 0~200ma
+    uint8_t leddrive_ps2 =64;    //LEDDRIVE_PS2  0~255 = 0~200ma
+    uint8_t leddrive_ps3 =0;     //LEDDRIVE_PS3  0~255 = 0~200ma
+
+    uint16_t thres_level =0;
+    uint8_t led_en_begin =1;       // 0 = 2 ; 1 = 4 ; 2 = 8 ; 3 = 16 ;
+    uint8_t afe_reset = 1;        //* 0 = 32clk ; 1 = 64clk ; 2 = 128clk ; 3 = 256clk(d) ;
+    uint8_t en2rst_delay =3;      // pen 2 rst delay 0 = 128,256, 512, 1024
+    uint8_t init_wait_delay = 2; /* 0 = 800 ; 1 = 1600; 2 = 3200 ; 3 = 6400(d) */
+
+    uint8_t ps1_interval_i2c =0;    // ps2/ps3
+
+    uint8_t thres_int =1;    //thres int enable
+    uint8_t data_rdy_int =8;    //[3]:ps1_data2 [2]:ps1_data1 [1]:ps0_data2 [0]:ps0_data1
+
+
+    uint8_t ldrsel_ps0 =1;      //ps0 LDR SELECT 01:ldr0-GLED  02:ldr1-IR   04:ldr2-RLED
+    uint8_t ldrsel_ps1 =0;      //ps1 LDR SELECT 01:ldr0-GLED  02:ldr1-IR   04:ldr2-RLED
+    uint8_t ldrsel_ps2 =2;      //ps1 LDR SELECT 01:ldr0-GLED  02:ldr1-IR   04:ldr2-RLED
+    uint8_t ldrsel_ps3 =0;      //ps1 LDR SELECT 01:ldr0-GLED  02:ldr1-IR   04:ldr2-RLED
+
+    /***********cap *********/
+    uint8_t intcapsel_ps3 =2;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+    uint8_t intcapsel_ps2 =2;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+    uint8_t intcapsel_ps1 =2;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+    uint8_t intcapsel_ps0 =2;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+
+    uint8_t ps0_led_on_time=32;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+    uint8_t ps1_led_on_time=32;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+    uint8_t ps2_led_on_time=16;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+    uint8_t ps3_led_on_time=16;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+
+    uint8_t force_adc_clk_sel=0;
+    uint8_t force_adc_clk_cfg =0;
+    uint8_t force_PEN =0;     //phase enable
+    uint8_t force_PEN_cfg =0;
+    uint8_t force_LED_EN =0;
+    uint8_t force_LED_EN_cfg =0;
+    uint8_t force_CKAFEINT_sel =0;
+    uint8_t force_CKAFEINT_cfg =0;
+
+    uint8_t PDBIASEN =0;
+    uint8_t PDILOADEN =0;
+
+    /***********************sar*****************************/
+    uint8_t  odr_short =1;
+
+    uint8_t  ch0_cfg =3;
+    uint8_t  ch1_cfg =12;
+    uint8_t  ch2_cfg =48;
+
+    uint8_t  ch0_range=1;   // 000=1.25pF  001=2.5pF  010=3.75pF  011=5pF   100=0.625pF
+    uint8_t  ch1_range=1;   // 000=1.25pF  001=2.5pF  010=3.75pF  011=5pF   100=0.625pF
+    uint8_t  ch2_range=1;   // 000=1.25pF  001=2.5pF  010=3.75pF  011=5pF   100=0.625pF
+
+    uint8_t ch0_avg_num=1;   //    000 =1; 001 = 2;.default;010= 4;011= 8; 100= 16;101= 32;
+    uint8_t ch1_avg_num=1;
+    uint8_t ch2_avg_num=1;
+
+    uint8_t ch0_wram_num=0;
+
+    uint8_t ch0_osr_num=2;   //   000= 16;001=32;010=64;011=128;100=256;
+    uint8_t ch1_osr_num=2;   //   000= 16;001=32;010=64;011=128;100=256;
+    uint8_t ch2_osr_num=2;   //   000= 16;001=32;010=64;011=128;100=256;
+
+    uint8_t c0_offset_dac=0;
+    uint8_t c1_offset_dac=0;
+    uint8_t c2_offset_dac=0;
+
+    uint8_t sar_sample_num=8;
+
+    uint8_t sar_integ_num=8;
+
+    uint8_t ch_num_sel=0;
+
+    hx3918_write_reg(0X16, (ps3_enable<<3| ps2_enable<<2|ps1_enable<<1|ps0_enable));   //default 0x00
+    hx3918_write_reg(0X17, (ps3_osr<<6| ps2_osr<<4|ps1_osr<<2|ps0_osr));       //default 0x00
+    hx3918_write_reg(0X18, (uint8_t)prf_clk_num);    // prf bit<7:0>6   default 0x00
+    hx3918_write_reg(0X19, (uint8_t)(prf_clk_num>>8)); // prf bit<11:8>  default 0x03
+    hx3918_write_reg(0X1a, (ps1_interval_i2c));   //default 0x00
+    hx3918_write_reg(0X1b, led_en_begin<<6|afe_reset<<4|en2rst_delay <<2|init_wait_delay); // led_en_num*8     //default 0x00
+    //hx3918_write_reg(0X1b, 0x03);
+    hx3918_write_reg(0X1c, ps0_led_on_time); // led_en_num*8     //default 0x00
+    hx3918_write_reg(0X1d, ps1_led_on_time); // led_en_num*8     //default 0x00
+    hx3918_write_reg(0X1e, ps2_led_on_time); // led_en_num*8     //default 0x00
+    hx3918_write_reg(0X1f, ps3_led_on_time); // led_en_num*8     //default 0x00
+    hx3918_write_reg(0X20, (ps3_cp_avg_num_sel<<6|ps2_cp_avg_num_sel<<4|ps1_cp_avg_num_sel<<2|ps0_cp_avg_num_sel) );     //default 0x00
+    hx3918_write_reg(0X21, (ps3_avg_num_sel_i2c<<6|ps2_avg_num_sel_i2c<<4|ps1_avg_num_sel_i2c<<2|ps0_avg_num_sel_i2c));     //default 0x00
+    hx3918_write_reg(0X23, (ps0_led_en_i2c<<7|ps1_led_en_i2c<<6|ps2_led_en_i2c<<5|ps3_led_en_i2c<<4|ps0_ofidac_en_i2c<<3|ps1_ofidac_en_i2c<<2|ps2_ofidac_en_i2c<<1|ps3_ofidac_en_i2c)); // led_en  offset_en
+    hx3918_write_reg(0X24, (intcapsel_ps0<<4|intcapsel_ps1));   //default 0x00
+    hx3918_write_reg(0X25, (intcapsel_ps2<<4|intcapsel_ps3));   //default 0x00
+    hx3918_write_reg(0X26, leddrive_ps0); // led_en_num*8     //default 0x00
+    hx3918_write_reg(0X27, leddrive_ps1); // led_en_num*8     //default 0x00
+    hx3918_write_reg(0X28, leddrive_ps2); // led_en_num*8     //default 0x00
+    hx3918_write_reg(0X29, leddrive_ps3); // led_en_num*8     //default 0x00
+    hx3918_write_reg(0X2a, (ldrsel_ps0<<4|ldrsel_ps1));     //default 0x00
+    hx3918_write_reg(0X2b, (ldrsel_ps2<<4|ldrsel_ps3));     //default 0x00
+    hx3918_write_reg(0X2c, dccancel_ps0 );     //default 0x00
+    hx3918_write_reg(0X2d, dccancel_ps1 );     //default 0x00
+    hx3918_write_reg(0X2e, dccancel_ps2 );     //default 0x00
+    hx3918_write_reg(0X2f, dccancel_ps3);     //default 0x00
+    hx3918_write_reg(0X36, (thres_int<<4|data_rdy_int));
+    hx3918_write_reg(0X4e, (force_adc_clk_sel<<7|force_adc_clk_cfg<<6|force_PEN<<5|force_PEN_cfg<<4|force_LED_EN<<3|
+                            force_LED_EN_cfg<<2|force_CKAFEINT_sel<<1|force_CKAFEINT_cfg));   //default 0x00
+
+    hx3918_write_reg(0X54, odr_short);
+    hx3918_write_reg(0X55,ch0_cfg); // ch0 single input  cs0=p
+    hx3918_write_reg(0X56,ch0_cfg>>8); //
+    hx3918_write_reg(0X57,ch1_cfg); // ch1 dif input  cs0=p cs1=n
+    hx3918_write_reg(0X58,ch1_cfg>>8); //
+    hx3918_write_reg(0X59,ch2_cfg); // ch2 single input  cs2=p
+    hx3918_write_reg(0X5a,ch2_cfg>>8); //
+    hx3918_write_reg(0X5b,(ch1_range<<4|ch0_range));
+    hx3918_write_reg(0X5c, ch2_range);
+    hx3918_write_reg(0X5d, (ch0_avg_num<<5|ch0_osr_num<<2|ch0_wram_num));
+    hx3918_write_reg(0X5e, (ch2_osr_num<<4|ch0_osr_num));
+    hx3918_write_reg(0X5f, (ch2_avg_num<<4|ch1_avg_num));
+    hx3918_write_reg(0X60, c0_offset_dac);
+    hx3918_write_reg(0X61, c0_offset_dac>>8);
+    hx3918_write_reg(0X62, c1_offset_dac);
+    hx3918_write_reg(0X63, c1_offset_dac>>8);
+    hx3918_write_reg(0X64, c2_offset_dac);
+    hx3918_write_reg(0X65, c2_offset_dac>>8);
+    hx3918_write_reg(0X66, sar_sample_num);
+    hx3918_write_reg(0X67, sar_sample_num>>8);
+    hx3918_write_reg(0X68, sar_integ_num);
+    hx3918_write_reg(0X69, sar_integ_num>>8);
+    hx3918_write_reg(0X6a, ch_num_sel);
+
+    hx3918_write_reg(0X6d, 0x00);
+    hx3918_write_reg(0XF0, 0x22);
+    hx3918_write_reg(0xF1, 0x28);
+    hx3918_write_reg(0xF2, 0x04);
+    hx3918_write_reg(0xF3, 0x70);
+    hx3918_write_reg(0xF4, 0xb2);
+    hx3918_write_reg(0xF5, 0x89);
+    hx3918_write_reg(0xF6, 0x2b);
+    hx3918_write_reg(0xF7, 0x81);
+    hx3918_write_reg(0xF8, 0x27);
+    hx3918_write_reg(0xF9, 0x00);
+    hx3918_write_reg(0xFA, 0x88);
+    hx3918_write_reg(0xFB, 0x40);
+    hx3918_write_reg(0Xf6, 0X2b);
+
+#if defined(TIMMER_MODE)
+    hx3918_write_reg(0x3d,0x84);     //bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;0011=p4;bits<7> fifo enble
+    hx3918_write_reg(0x3e,0x20);                //watermark
+    hx3918_write_reg(0x3c,0x1f);     // int_width_i2c
+    hx3918_write_reg(0X37, 0x00);   // int sel,01=prf int,04=enable almost full int
+    hx3918_write_reg(0X3b, 0x00);
+    hx3918_write_reg(0X3b, 0x10);
+#else ///////////INT Mode
+    hx3918_write_reg(0x3d,0x00);     //bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;0011=p4;bits<7> fifo enble
+    hx3918_write_reg(0x3c,0x1f);     // int_width_i2c
+    hx3918_write_reg(0X37, 0x04);   // int sel,01=prf ,04=enable almost full
+#endif
+
+    hx3918_write_reg(0X4d, 0X01);  //soft reset
+    hx3918_delay(5);
+    hx3918_write_reg(0X4d, 0X00);  //release
+    hx3918_delay(5);
+       hx3918_prox_init();
+    read_fifo_first_flg = 1;
+}
+
+hx3918_hrv_wear_msg_code_t hx3918_hrv_wear_mode_check(int32_t infrared_data)
+{
+    if(infrared_data > hrv_ir_wear_thres)
+    {
+        if(no_touch_cnt < NO_TOUCH_CHECK_NUM)
+        {
+            no_touch_cnt++;
+        }
+        if(no_touch_cnt >= NO_TOUCH_CHECK_NUM)
+        {
+            hrv_wear_status = MSG_HRV_WEAR;
+        }
+    }
+    else if(infrared_data < hrv_ir_unwear_thres)
+    {
+        if(no_touch_cnt>0)
+        {
+            no_touch_cnt--;
+        }
+        if(no_touch_cnt == 0)
+        {
+            hrv_wear_status = MSG_HRV_NO_WEAR;
+        }
+    }
+
+    if(hrv_wear_status_pre != hrv_wear_status)
+    {
+        hrv_wear_status_pre = hrv_wear_status;         
+               //TYHX_LOG("[hx3918_hrv_wear_mode_check start] ir wear result = %d\r\n",hrv_wear_status);
+               //hrv_wear_status = hx3918_get_wear_result(hrv_wear_status);
+               TYHX_LOG("[hx3918_hrv_wear_mode_check end] final result = %d\r\n",hrv_wear_status);
+        if(hrv_wear_status_pre == MSG_HRV_NO_WEAR)
+        {
+            hx3918_hrv_low_power();
+        }
+        else if(hrv_wear_status_pre == MSG_HRV_WEAR)
+        {
+            tyhx_hrv_alg_open_deep();
+            hx3918_hrv_set_mode(PPG_INIT);
+            hx3918_hrv_set_mode(CAL_INIT);
+        }
+    }
+
+    return hrv_wear_status;
+}
+
+void Init_hrv_PPG_Calibration_Routine(HRV_CAL_SET_T *calR,uint8_t led)
+{
+    calR->flag = CAL_FLG_LED_DR|CAL_FLG_LED_DAC|CAL_FLG_AMB_DAC|CAL_FLG_RF;
+
+    calR->led_idac   = 8;
+    calR->amb_idac   = 8;
+    calR->ontime     = 5;  //int cap=2 ontime=5  1ofidac=9000 code
+    calR->led_cur    = HRS_CAL_INIT_LED;
+    calR->state      = hrsCalStart;
+    calR->int_cnt    = 0;
+    calR->cur255_cnt = 0;
+    if(low_vbat_flag==1)
+    {
+        calR->led_max_cur = green_led_max_init>>1;
+    }
+    else
+    {
+        calR->led_max_cur = green_led_max_init;
+    }
+}
+
+void Restart_hrv_PPG_Calibration_Routine(HRV_CAL_SET_T *calR)
+{
+    calR->flag = CAL_FLG_LED_DR|CAL_FLG_LED_DAC|CAL_FLG_AMB_DAC|CAL_FLG_RF;
+    calR->state = hrvCalLed;
+    calR->int_cnt = 0;
+}
+
+void PPG_hrv_Calibration_Routine(HRV_CAL_SET_T *calR, int32_t led, int32_t amb)
+{
+    switch(calR->state)
+    {
+    case hrvCalStart:
+        calR->state = hrvLedCur;
+        break;
+
+    case hrvLedCur:
+        if(amb>280000)
+        {
+            calR->amb_idac = (amb-280000)/10000;
+        }
+        else
+        {
+            calR->amb_idac = 0;
+        }
+        if(led>amb+128)
+        {
+            calR->led_step = (led-amb)/HRV_CAL_INIT_LED;
+            calR->led_cur = 10000*(hx3918_hrs_agc_idac+calR->amb_idac)/calR->led_step;
+            if(calR->led_cur>calR->led_max_cur)
+            {
+                calR->led_cur = calR->led_max_cur;
+            }
+            calR->led_idac = 0;
+            calR->ontime = 32;
+            calR->flag = CAL_FLG_LED_DR|CAL_FLG_LED_DAC|CAL_FLG_AMB_DAC|CAL_FLG_RF;
+            calR->state = hrvCalLed;
+        }
+        else
+        {
+            calR->led_cur = calR->led_max_cur;
+            calR->led_idac = 0;
+            calR->ontime = 32;
+            calR->flag = CAL_FLG_LED_DR|CAL_FLG_LED_DAC|CAL_FLG_AMB_DAC|CAL_FLG_RF;
+            calR->state = hrvCalLed;
+        }
+        break;
+
+    case hrvCalLed:
+        if(led>320000 && calR->led_idac<=120)
+        {
+            calR->led_idac = calR->led_idac + 1;
+            calR->state = hrvCalLed;
+        }
+        else if(led<200000 && calR->led_idac>=1)
+        {
+            calR->led_idac = calR->led_idac - 1;
+            calR->state = hrvCalLed;
+        }
+        else
+        {
+            calR->state = hrvCalFinish;
+        }
+        calR->flag = CAL_FLG_LED_DAC;
+        break;
+
+    default:
+        break;
+
+    }
+    AGC_LOG("AGC: led_drv=%d,ledDac=%d,ambDac=%d,ledstep=%d,ontime=%d,state=%d\r\n",\
+            calR->led_cur, calR->led_idac, calR->amb_idac,calR->led_step,calR->ontime,calR->state);
+}
+
+HRV_CAL_SET_T PPG_hrv_agc(void)
+{
+    int32_t led_val, amb_val;
+    calReg.work = false;
+    if (!s_cal_state)
+    {
+        return  calReg;
+    }
+
+#ifdef INT_MODE
+    calReg.int_cnt ++;
+    if(calReg.int_cnt < 8)
+    {
+        return calReg;
+    }
+    calReg.int_cnt = 0;
+    hx3918_gpioint_cfg(false);
+#endif
+    calReg.work = true;
+
+    read_data_packet(agc_buf);
+    led_val = agc_buf[0];
+    amb_val = agc_buf[1];
+
+    AGC_LOG("cal dat led_val=%d,amb_val=%d \r\n", led_val, amb_val);
+
+    PPG_hrv_Calibration_Routine(&calReg, led_val, amb_val);
+
+    if (calReg.state == hrvCalFinish)
+    {
+        hx3918_hrv_set_mode(CAL_OFF);
+#if defined(TIMMER_MODE)
+#else
+        hx3918_gpioint_cfg(true);
+#endif
+    }
+    else
+    {
+        hx3918_hrv_updata_reg();
+#if defined(INT_MODE)
+        hx3918_gpioint_cfg(true);
+#endif
+    }
+    return  calReg;
+}
+
+
+
+void hx3918_hrv_cal_init(void) // 20200615 ericy afe cali online
+{
+    uint16_t sample_rate = 100;                      /*config the data rate of chip alps2_fm ,uint is Hz*/
+    uint32_t prf_clk_num = 32000/sample_rate;        /*period in clk num, num = Fclk/fs */
+    uint8_t ps1_cp_avg_num_sel= 0;
+    uint8_t ps0_cp_avg_num_sel= 0;
+    uint8_t thres_int =0;    //thres int enable
+    uint8_t data_rdy_int =8;    //[3]:ps1_data2 [2]:ps1_data1 [1]:ps0_data2 [0]:ps0_data1
+
+    hx3918_write_reg(0X18, (uint8_t)prf_clk_num);    // prf bit<7:0>6   default 0x00
+    hx3918_write_reg(0X19, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>  default 0x03
+
+
+    hx3918_write_reg(0x3d,0x00);     //bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;0011=p4;bits<7> fifo enble
+    hx3918_write_reg(0X36, (thres_int<<4|data_rdy_int));   //default 0x0f
+
+    hx3918_write_reg(0X4d, 0X01);  //soft reset
+    hx3918_delay(5);
+    hx3918_write_reg(0X4d, 0X00);  //release
+    hx3918_delay(5);             //Delay for reset time
+}
+
+void hx3918_hrv_cal_off(void) // 20200615 ericy afe cali offline
+{
+    uint16_t sample_rate = 125;                      /*config the data rate of chip alps2_fm ,uint is Hz*/
+    uint32_t prf_clk_num = 32000/sample_rate;        /*period in clk num, num = Fclk/fs */
+    uint8_t ps1_cp_avg_num_sel= 0;
+    uint8_t ps0_cp_avg_num_sel= 0;
+
+//             if(ps0_avg_flg==0)
+//             {
+//                     ps1_cp_avg_num_sel= 0;
+//                     ps0_cp_avg_num_sel= 0;
+//             }
+//             else
+//             {
+//                     ps1_cp_avg_num_sel= 0;
+//                     ps0_cp_avg_num_sel= 2;
+//             }
+    uint8_t thres_int =0;    //thres int enable
+    uint8_t data_rdy_int =0;    //[3]:ps1_data2 [2]:ps1_data1 [1]:ps0_data2 [0]:ps0_data1
+    uint8_t databuf[3] = {0};
+
+    hx3918_write_reg(0X18, (uint8_t)prf_clk_num);    // prf bit<7:0>6   default 0x00
+    hx3918_write_reg(0X19, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>  default 0x03
+
+    hx3918_write_reg(0x3d,0x84);     //bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;0011=p4;bits<7> fifo enble
+    hx3918_write_reg(0X36, (thres_int<<4|data_rdy_int));   //default 0x0f
+
+    hx3918_write_reg(0X4d, 0X01);  //soft reset
+    hx3918_delay(5);
+    hx3918_write_reg(0X4d, 0X00);  //release
+    hx3918_delay(5);             //Delay for reset time
+    #if DEBUG_PPG_ONLY
+        hx3918_prox_init();
+    #endif
+    read_fifo_first_flg = 1;
+}
+
+void hx3918_hrv_low_power(void)
+{
+    /* start cfg*/
+    /*****************PPG***************************/
+    uint16_t sample_rate = 10;                  /*config the data rate of chip alps2_fm ,uint is Hz*/
+    uint32_t prf_clk_num = 32000/sample_rate;   /*period in clk num, num = Fclk/fs */
+
+    uint8_t ps0_enable=1;       /*ps0_enable  , 1 mean enable ; 0 mean disable */
+    uint8_t ps1_enable=0;       /*ps1_enable  , 1 mean enable ; 0 mean disable */
+    uint8_t ps2_enable=1;       /*ps0_enable  , 1 mean enable ; 0 mean disable */
+    uint8_t ps3_enable=1;       /*ps1_enable  , 1 mean enable ; 0 mean disable */
+
+    uint8_t ps0_osr = 1;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+    uint8_t ps1_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+    uint8_t ps2_osr = 1;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+    uint8_t ps3_osr = 1;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+
+    uint8_t ps3_cp_avg_num_sel= 0;
+    uint8_t ps2_cp_avg_num_sel= 0;
+    uint8_t ps1_cp_avg_num_sel= 0;
+    uint8_t ps0_cp_avg_num_sel= 0;
+
+    uint8_t ps3_avg_num_sel_i2c=0;
+    uint8_t ps2_avg_num_sel_i2c=0;
+    uint8_t ps1_avg_num_sel_i2c=0;
+    uint8_t ps0_avg_num_sel_i2c=0;
+
+    /***********led open enable***********/
+
+    uint8_t ps0_led_en_i2c=0;
+    uint8_t ps1_led_en_i2c=0;
+    uint8_t ps2_led_en_i2c=1;
+    uint8_t ps3_led_en_i2c=0;
+
+    uint8_t ps0_ofidac_en_i2c=1;
+    uint8_t ps1_ofidac_en_i2c=1;
+    uint8_t ps2_ofidac_en_i2c=1;
+    uint8_t ps3_ofidac_en_i2c=1;
+
+    uint8_t dccancel_ps0 =8;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps1 =8;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps2 =8;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps3 =8;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+
+    uint8_t leddrive_ps0 =0;     //LEDDRIVE_PS0  0~255 = 0~200ma
+    uint8_t leddrive_ps1 =0;     //LEDDRIVE_PS1  0~255 = 0~200ma
+    uint8_t leddrive_ps2 =64;     //LEDDRIVE_PS2  0~255 = 0~200ma
+    uint8_t leddrive_ps3 =0;     //LEDDRIVE_PS3  0~255 = 0~200ma
+
+    uint16_t thres_level =0;
+
+//    uint8_t adc_self  = 0;         //adc self test 1:enable  0:disable
+
+    uint8_t led_en_begin =1;       // 0 = 2 ; 1 = 4 ; 2 = 8 ; 3 = 16 ;
+    uint8_t afe_reset = 1;        //* 0 = 32clk ; 1 = 64clk ; 2 = 128clk ; 3 = 256clk(d) ;
+    uint8_t en2rst_delay =3;      // pen 2 rst delay 0 = 128,256, 512, 1024
+    uint8_t init_wait_delay = 2; /* 0 = 800 ; 1 = 1600; 2 = 3200 ; 3 = 6400(d) */
+
+
+    uint8_t ps1_interval_i2c =0;    // ps2/ps3
+
+    uint8_t thres_int =1;    //thres int enable
+    uint8_t data_rdy_int =8;    //[3]:ps1_data2 [2]:ps1_data1 [1]:ps0_data2 [0]:ps0_data1
+
+
+    uint8_t ldrsel_ps0 =0;      //ps0 LDR SELECT 01:ldr0-GLED  02:ldr1-IR   04:ldr2-RLED
+    uint8_t ldrsel_ps1 =0;      //ps1 LDR SELECT 01:ldr0-GLED  02:ldr1-IR   04:ldr2-RLED
+    uint8_t ldrsel_ps2 =2;      //ps1 LDR SELECT 01:ldr0-GLED  02:ldr1-IR   04:ldr2-RLED
+    uint8_t ldrsel_ps3 =0;      //ps1 LDR SELECT 01:ldr0-GLED  02:ldr1-IR   04:ldr2-RLED
+
+    /***********cap *********/
+    uint8_t intcapsel_ps3 =2;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+    uint8_t intcapsel_ps2 =2;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+    uint8_t intcapsel_ps1 =2;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+    uint8_t intcapsel_ps0 =2;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+
+    uint8_t ps0_led_on_time=32;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+    uint8_t ps1_led_on_time=32;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+    uint8_t ps2_led_on_time=16;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+    uint8_t ps3_led_on_time=16;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+
+    uint8_t force_adc_clk_sel=0;
+    uint8_t force_adc_clk_cfg =0;
+    uint8_t force_PEN =0;     //phase enable
+    uint8_t force_PEN_cfg =0;
+    uint8_t force_LED_EN =0;
+    uint8_t force_LED_EN_cfg =0;
+    uint8_t force_CKAFEINT_sel =0;
+    uint8_t force_CKAFEINT_cfg =0;
+
+    uint8_t PDBIASEN =0;
+    uint8_t PDILOADEN =0;
+
+    /***********************sar*****************************/
+    uint8_t  odr_short =1;
+
+    uint8_t  ch0_cfg =3;
+    uint8_t  ch1_cfg =12;
+    uint8_t  ch2_cfg =48;
+
+    uint8_t  ch0_range=1;   // 000=1.25pF  001=2.5pF  010=3.75pF  011=5pF   100=0.625pF
+    uint8_t  ch1_range=1;   // 000=1.25pF  001=2.5pF  010=3.75pF  011=5pF   100=0.625pF
+    uint8_t  ch2_range=1;   // 000=1.25pF  001=2.5pF  010=3.75pF  011=5pF   100=0.625pF
+
+    uint8_t ch0_avg_num=1;   //    000 =1; 001 = 2;.default;010= 4;011= 8; 100= 16;101= 32;
+    uint8_t ch1_avg_num=1;
+    uint8_t ch2_avg_num=1;
+
+    uint8_t ch0_wram_num=0;
+
+    uint8_t ch0_osr_num=2;   //   000= 16;001=32;010=64;011=128;100=256;
+    uint8_t ch1_osr_num=2;   //   000= 16;001=32;010=64;011=128;100=256;
+    uint8_t ch2_osr_num=2;   //   000= 16;001=32;010=64;011=128;100=256;
+
+    uint8_t c0_offset_dac=0;
+    uint8_t c1_offset_dac=0;
+    uint8_t c2_offset_dac=0;
+
+    uint8_t sar_sample_num=8;
+
+    uint8_t sar_integ_num=8;
+
+    uint8_t ch_num_sel=0;
+
+    hx3918_write_reg(0X16, (ps3_enable<<3| ps2_enable<<2|ps1_enable<<1|ps0_enable));   //default 0x00
+    hx3918_write_reg(0X17, (ps3_osr<<6| ps2_osr<<4|ps1_osr<<2|ps0_osr));       //default 0x00
+    hx3918_write_reg(0X18, (uint8_t)prf_clk_num);    // prf bit<7:0>6   default 0x00
+    hx3918_write_reg(0X19, (uint8_t)(prf_clk_num>>8)); // prf bit<11:8>  default 0x03
+    hx3918_write_reg(0X1a, (ps1_interval_i2c));   //default 0x00
+    hx3918_write_reg(0X1b, led_en_begin<<6|afe_reset<<4|en2rst_delay <<2|init_wait_delay); // led_en_num*8     //default 0x00
+    //hx3918_write_reg(0X1b, 0x03);
+    hx3918_write_reg(0X1c, ps0_led_on_time); // led_en_num*8     //default 0x00
+    hx3918_write_reg(0X1d, ps1_led_on_time); // led_en_num*8     //default 0x00
+    hx3918_write_reg(0X1e, ps2_led_on_time); // led_en_num*8     //default 0x00
+    hx3918_write_reg(0X1f, ps3_led_on_time); // led_en_num*8     //default 0x00
+    hx3918_write_reg(0X20, (ps3_cp_avg_num_sel<<6|ps2_cp_avg_num_sel<<4|ps1_cp_avg_num_sel<<2|ps0_cp_avg_num_sel) );     //default 0x00
+    hx3918_write_reg(0X21, (ps3_avg_num_sel_i2c<<6|ps2_avg_num_sel_i2c<<4|ps1_avg_num_sel_i2c<<2|ps0_avg_num_sel_i2c));     //default 0x00
+    hx3918_write_reg(0X23, (ps0_led_en_i2c<<7|ps1_led_en_i2c<<6|ps2_led_en_i2c<<5|ps3_led_en_i2c<<4|ps0_ofidac_en_i2c<<3|ps1_ofidac_en_i2c<<2|ps2_ofidac_en_i2c<<1|ps3_ofidac_en_i2c)); // led_en  offset_en
+    hx3918_write_reg(0X24, (intcapsel_ps0<<4|intcapsel_ps1));   //default 0x00
+    hx3918_write_reg(0X25, (intcapsel_ps2<<4|intcapsel_ps3));   //default 0x00
+    hx3918_write_reg(0X26, leddrive_ps0); // led_en_num*8     //default 0x00
+    hx3918_write_reg(0X27, leddrive_ps1); // led_en_num*8     //default 0x00
+    hx3918_write_reg(0X28, leddrive_ps2); // led_en_num*8     //default 0x00
+    hx3918_write_reg(0X29, leddrive_ps3); // led_en_num*8     //default 0x00
+    hx3918_write_reg(0X2a, (ldrsel_ps0<<4|ldrsel_ps1));     //default 0x00
+    hx3918_write_reg(0X2b, (ldrsel_ps2<<4|ldrsel_ps3));     //default 0x00
+    hx3918_write_reg(0X2c, dccancel_ps0 );     //default 0x00
+    hx3918_write_reg(0X2d, dccancel_ps1 );     //default 0x00
+    hx3918_write_reg(0X2e, dccancel_ps2 );     //default 0x00
+    hx3918_write_reg(0X2f, dccancel_ps3);     //default 0x00
+    hx3918_write_reg(0X36, (thres_int<<4|data_rdy_int));
+    hx3918_write_reg(0X4e, (force_adc_clk_sel<<7|force_adc_clk_cfg<<6|force_PEN<<5|force_PEN_cfg<<4|force_LED_EN<<3|
+                            force_LED_EN_cfg<<2|force_CKAFEINT_sel<<1|force_CKAFEINT_cfg));   //default 0x00
+//    hx3918_write_reg(0X52, (adc_self<<2|second_time_en<<1));     //default 0x00
+//    hx3918_write_reg(0Xc0, 0x18);
+//    hx3918_write_reg(0Xc2, 0x0a);
+////    hx3918_write_reg(0Xc3, (PDBIASEN<<5|PDILOADEN<<4));   //default 0x27
+//    hx3918_write_reg(0Xc3, 0X27);
+    hx3918_write_reg(0X54, odr_short);
+    hx3918_write_reg(0X55,ch0_cfg); // ch0 single input  cs0=p
+    hx3918_write_reg(0X56,ch0_cfg>>8); //
+    hx3918_write_reg(0X57,ch1_cfg); // ch1 dif input  cs0=p cs1=n
+    hx3918_write_reg(0X58,ch1_cfg>>8); //
+    hx3918_write_reg(0X59,ch2_cfg); // ch2 single input  cs2=p
+    hx3918_write_reg(0X5a,ch2_cfg>>8); //
+    hx3918_write_reg(0X5b,(ch1_range<<4|ch0_range));
+    hx3918_write_reg(0X5c, ch2_range);
+    hx3918_write_reg(0X5d, (ch0_avg_num<<5|ch0_osr_num<<2|ch0_wram_num));
+    hx3918_write_reg(0X5e, (ch2_osr_num<<4|ch0_osr_num));
+    hx3918_write_reg(0X5f, (ch2_avg_num<<4|ch1_avg_num));
+    hx3918_write_reg(0X60, c0_offset_dac);
+    hx3918_write_reg(0X61, c0_offset_dac>>8);
+    hx3918_write_reg(0X62, c1_offset_dac);
+    hx3918_write_reg(0X63, c1_offset_dac>>8);
+    hx3918_write_reg(0X64, c2_offset_dac);
+    hx3918_write_reg(0X65, c2_offset_dac>>8);
+    hx3918_write_reg(0X66, sar_sample_num);
+    hx3918_write_reg(0X67, sar_sample_num>>8);
+    hx3918_write_reg(0X68, sar_integ_num);
+    hx3918_write_reg(0X69, sar_integ_num>>8);
+    hx3918_write_reg(0X6a, ch_num_sel);
+
+    hx3918_write_reg(0X6d, 0x00);
+    hx3918_write_reg(0XF0, 0x22);
+    hx3918_write_reg(0xF1, 0x28);
+    hx3918_write_reg(0xF2, 0x04);
+    hx3918_write_reg(0xF3, 0x70);
+    hx3918_write_reg(0xF4, 0xb2);
+    hx3918_write_reg(0xF5, 0x89);
+    hx3918_write_reg(0xF6, 0x2b);
+    hx3918_write_reg(0xF7, 0x81);
+    hx3918_write_reg(0xF8, 0x27);
+    hx3918_write_reg(0xF9, 0x00);
+    hx3918_write_reg(0xFA, 0x88);
+    hx3918_write_reg(0xFB, 0x40);
+    hx3918_write_reg(0Xf6, 0X2b);
+
+    hx3918_write_reg(0X4d, 0X01);  //soft reset
+    hx3918_delay(5);
+    hx3918_write_reg(0X4d, 0X00);  //release
+    hx3918_delay(5);
+    calReg.led_cur = 0;
+       #if DEBUG_PPG_ONLY
+        hx3918_prox_init();
+    #endif
+//             hx3918_ppg_timer_cfg(false);
+//    hx3918_agc_timer_cfg(false);
+//             hx3918_gpioint_cfg(true);
+    AGC_LOG(" chip go to low power mode  \r\n" );
+}
+
+void hx3918_hrv_updata_reg(void)
+{
+    if (calReg.flag & CAL_FLG_LED_DR)
+    {
+        hx3918_write_reg(0X26, calReg.led_cur); // 3918
+    }
+
+    if (calReg.flag & CAL_FLG_LED_DAC)
+    {
+        hx3918_write_reg(0X2c, (uint8_t)calReg.led_idac);  //3918
+//                             hx3918_write_reg(0X19, (uint8_t)(calReg.led_idac>>8));
+    }
+
+    if (calReg.flag & CAL_FLG_AMB_DAC)
+    {
+        hx3918_write_reg(0X2d, (uint8_t)calReg.amb_idac);   // 3918
+//                             hx3918_write_reg(0X1b, (uint8_t)(calReg.amb_idac>>8));
+    }
+
+    if (calReg.flag & CAL_FLG_RF)
+    {
+        hx3918_write_reg(0X1c, calReg.ontime); //3918 p0
+        hx3918_write_reg(0X1d, calReg.ontime); //3918 p1
+        hx3918_write_reg(0X1e, calReg.ontime); //3918 p2
+        hx3918_write_reg(0X1f, calReg.ontime); //3918 p3
+    }
+}
+
+void hx3918_hrv_set_mode(uint8_t mode_cmd)
+{
+    switch (mode_cmd)
+    {
+    case PPG_INIT:
+        hx3918_hrv_ppg_init();
+#if defined(TIMMER_MODE)
+        hx3918_ppg_timer_cfg(true);
+#if defined(GSEN_40MS_TIMMER)
+        hx3918_agc_timer_cfg(true);
+#endif
+#else
+        hx3918_gpioint_cfg(true);
+#endif
+        s_ppg_state = 1;
+
+        AGC_LOG("ppg init mode\r\n");
+        break;
+
+    case PPG_OFF:
+        hx3918_ppg_off();
+        s_ppg_state = 0;
+        AGC_LOG("ppg off mode\r\n");
+        break;
+
+    case PPG_LED_OFF:
+        hx3918_hrv_low_power();
+        s_ppg_state = 0;
+        AGC_LOG("ppg led off mode\r\n");
+        break;
+
+    case CAL_INIT:
+        Init_hrv_PPG_Calibration_Routine(&calReg, 64);
+        hx3918_hrv_cal_init();
+        hx3918_hrv_updata_reg();
+#if defined(TIMMER_MODE)
+#if defined(GSEN_40MS_TIMMER)
+#else
+        hx3918_agc_timer_cfg(true);
+#endif
+#endif
+        //AGC_LOG("init  %x,%x \r\n", hx3918_read_reg(0x23),hx3918_read_reg(0x24));
+        s_cal_state = 1;
+        AGC_LOG("cal init mode\r\n");
+        break;
+
+    case RECAL_INIT:
+        Restart_hrv_PPG_Calibration_Routine(&calReg);
+        hx3918_hrv_cal_init();
+        hx3918_hrv_updata_reg();
+#if defined(TIMMER_MODE)
+#if defined(GSEN_40MS_TIMMER)
+#else
+        hx3918_agc_timer_cfg(true);
+#endif
+#endif
+        s_cal_state = 1;
+        AGC_LOG("Recal init mode\r\n");
+        break;
+
+    case CAL_OFF:
+#if defined(TIMMER_MODE)
+#if defined(GSEN_40MS_TIMMER)
+#else
+        hx3918_agc_timer_cfg(false);
+#endif
+#endif
+        hx3918_hrv_cal_off();
+        s_cal_state = 0;
+        AGC_LOG("cal off mode\r\n");
+        break;
+
+    default:
+        break;
+    }
+}
+
+SENSOR_ERROR_T hx3918_hrv_enable(void)
+{
+    if (!hx3918_chip_check())
+    {
+        AGC_LOG("hx3918 check id failed!\r\n");
+        return SENSOR_OP_FAILED;
+    }
+
+    AGC_LOG("hx3918 check id success!\r\n");
+
+    if (s_ppg_state)
+    {
+        AGC_LOG("ppg already on!\r\n");
+        return SENSOR_OP_FAILED;
+    }
+    if(!tyhx_hrv_alg_open())
+    {
+        AGC_LOG("hrv alg open fail,or dynamic ram not enough!\r\n");
+    }
+
+    hrv_wear_status = MSG_HRV_INIT;
+    hrv_wear_status_pre = MSG_HRV_INIT;
+
+    hx3918_hrv_set_mode(PPG_INIT);
+
+    AGC_LOG("hx3918 enable!\r\n");
+
+    return SENSOR_OK;
+}
+
+
+void hx3918_hrv_disable(void)
+{
+    hx3918_ppg_timer_cfg(false);
+    hx3918_agc_timer_cfg(false);
+
+    hx3918_hrv_set_mode(PPG_OFF);
+    s_ppg_state = 0;
+    s_cal_state = 0;
+    tyhx_hrv_alg_close();
+
+    AGC_LOG("hx3918 disable!\r\n");
+}
+
+void hx3918_hrv_data_reset(void)
+{
+    s_ppg_state = 0;
+    s_cal_state = 0;
+    tyhx_hrv_alg_close();
+}
+
+hx3918_hrv_wear_msg_code_t hx3918_hrv_get_wear_status(void)
+{
+    return  hrv_wear_status;
+}
+
+hx3918_hrv_wear_msg_code_t hx3918_hrv_get_wear_status_pre(void)
+{
+    return  hrv_wear_status_pre;
+}
+
+HRV_CAL_SET_T get_hrv_agc_status(void)
+{
+    HRV_CAL_SET_T cal;
+    cal.flag     = calReg.flag;
+    cal.int_cnt  = calReg.int_cnt;
+    cal.led_cur  = calReg.led_cur;
+    cal.led_idac = calReg.led_idac;
+    cal.amb_idac = calReg.amb_idac;
+    cal.ontime   = calReg.ontime;
+    cal.led_step = calReg.led_step;
+    cal.state    = calReg.state;
+    return cal;
+}
+
+uint8_t hx3918_hrv_read(hrv_sensor_data_t * s_dat)
+{
+    int32_t PPG_src_data;
+    int32_t Ir_src_data;
+    bool recal = false;
+//    uint8_t size = 0;
+//    uint8_t size_byte = 0;
+    int32_t *PPG_buf =  &(s_dat->ppg_data[0]);
+    int32_t *ir_buf =  &(s_dat->ir_data[0]);
+    int32_t *s_buf =  &(s_dat->s_buf[0]);
+    s_dat->agc_green =  calReg.led_cur;
+    int32_t ps_data[4]= {0};
+    int32_t ps_green_data = 0;
+    uint8_t data_count = 0;
+    if (!s_ppg_state || s_cal_state)
+    {
+        return NULL;
+    }
+
+    read_data_packet(ps_data);
+    Ir_src_data = ps_data[2]-ps_data[3];
+    ps_green_data = ps_data[0];
+    hx3918_hrv_wear_mode_check(Ir_src_data);
+    //DEBUG_PRINTF("%d %d %d %d\r\n" ,ps_data[0],ps_data[1],ps_data[2],ps_data[3]);
+
+    data_count = hx3918_read_fifo_data(s_buf,1,1);
+    //DEBUG_PRINTF("ppg data size: %d %d\r\n", data_count,hrs_phase_num);
+    s_dat->count =  data_count;
+    for (uint8_t i=0; i<data_count; i++)
+    {
+        PPG_src_data = s_buf[i];
+        PPG_buf[i] = 2*PPG_src_data;
+        ir_buf[i] = Ir_src_data;
+    }
+
+    if (ps_green_data<150000 || ps_green_data>350000)
+    {
+        recal = true;
+
+        if(hrv_wear_status==MSG_HRV_NO_WEAR)
+        {
+            recal = false;
+        }
+    }
+    if (recal)
+    {
+        cal_delay--;
+
+        if (cal_delay <= 0)
+        {
+            cal_delay = CAL_DELAY_COUNT;
+            hx3918_hrv_set_mode(RECAL_INIT);
+        }
+    }
+    else
+    {
+        cal_delay = CAL_DELAY_COUNT;
+    }
+    return 1;
+}
+
+#endif
diff --git a/2.sdk/Helios_SDK/components/HX3918/hx3918_hrv_agc.h b/2.sdk/Helios_SDK/components/HX3918/hx3918_hrv_agc.h
new file mode 100644 (file)
index 0000000..fc2f882
--- /dev/null
@@ -0,0 +1,80 @@
+#ifndef _HX3918_HRV_AGC_H_
+#define _HX3918_HRV_AGC_H_
+#include <stdint.h>
+#include <stdbool.h>
+#include "hx3918.h"
+
+#define CAL_DELAY_COUNT (3)
+
+#define CAL_FLG_LED_DR     0x01
+#define CAL_FLG_LED_DAC    0x02 
+#define CAL_FLG_AMB_DAC    0x04
+#define CAL_FLG_RF         0x08
+
+#define HRV_CAL_INIT_LED 16
+#define NO_TOUCH_CHECK_NUM 2 
+
+
+typedef enum {    
+    hrvCalStart, 
+               hrvLedCur,
+    hrvCalLed,
+    hrvCalLed2,
+    hrvCalFinish, 
+}HRV_STATE_T;
+
+typedef struct {
+       uint8_t count;
+       int32_t ppg_data[32];
+       int32_t ir_data[32];
+       int32_t s_buf[32]; 
+       uint32_t als;
+       uint32_t agc_green;
+}hrv_sensor_data_t;
+
+typedef enum {
+       MSG_HRV_NO_WEAR,
+       MSG_HRV_WEAR,
+       MSG_HRV_INIT
+} hx3918_hrv_wear_msg_code_t;
+
+typedef struct {
+       uint8_t flag;
+       bool work;
+       uint8_t int_cnt;
+       uint8_t cur255_cnt;
+       uint8_t led_cur;
+       uint8_t led_idac; 
+       uint8_t amb_idac;
+       uint8_t ontime;
+       uint16_t led_step;
+       uint8_t state;
+       uint8_t led_max_cur;
+} HRV_CAL_SET_T;
+
+void Init_hrv_PPG_Calibration_Routine(HRV_CAL_SET_T *calR,uint8_t led);
+void Restart_hrv_PPG_Calibration_Routine(HRV_CAL_SET_T *calR);
+void PPG_hrv_Calibration_Routine(HRV_CAL_SET_T *calR, int32_t led, int32_t amb);
+HRV_CAL_SET_T PPG_hrv_agc(void);
+
+void hx3918_hrv_cal_init(void);
+void hx3918_hrv_cal_off(void);
+uint8_t hx3918_read_fifo_size(void);
+void read_hrv_data_packet(int32_t *buf);
+void read_hrv_ir_packet(int32_t *buf);
+
+void hx3918_hrv_low_power(void);
+void hx3918_hrv_normal_power(void);
+void hx3918_hrv_updata_reg(void);
+void hx3918_hrv_set_mode(uint8_t mode_cmd);
+SENSOR_ERROR_T hx3918_hrv_enable(void);
+void hx3918_hrv_disable(void);
+hx3918_hrv_wear_msg_code_t hx3918_hrv_get_wear_status(void);
+uint8_t hx3918_hrv_read(hrv_sensor_data_t * s_dat);
+bool hx3918_hrv_init(void);
+
+hx3918_hrv_wear_msg_code_t hx3918_hrv_wear_mode_check(int32_t infrared_data);
+HRV_CAL_SET_T get_hrv_agc_status(void);
+void hx3918_hrv_data_reset(void);
+
+#endif
diff --git a/2.sdk/Helios_SDK/components/HX3918/hx3918_prox.c b/2.sdk/Helios_SDK/components/HX3918/hx3918_prox.c
new file mode 100644 (file)
index 0000000..7fc00e6
--- /dev/null
@@ -0,0 +1,829 @@
+/*****************************************************************************
+    * @file     hx90xx.c
+    * @author
+    * @date
+    * @Emial
+    * @brief    HX3918 module
+******************************************************************************/
+
+#include <stdbool.h>
+#include <stdint.h>
+#include <string.h>
+#include <stdio.h>
+
+#include "hx3918_prox.h"
+#include "hx3918.h"
+
+#ifdef TYHX_DEMO
+#include "nordic_common.h"
+#include "nrf.h"
+#include "app_error.h"
+#include "ble_hci.h"
+#include "ble_gap.h"
+#include "ble_err.h"
+#include "nrf_gpio.h"
+#include "nrf_drv_gpiote.h"
+#include "nrf_delay.h"
+#include "segger_rtt.h"
+#include "twi_master.h"
+#include "app_timer.h"
+#endif
+
+/* ²úÆ·ÐèÒª¸Ä¶¯µÄµØ·½
+#define HX3918_IR_AIR       7000     //HX3918 ¶Ô¿Õ²âÊÔÅå´÷IRµÄÖµ·¶Î§,СÓÚÕâ¸öÖµ´ú±í¶Ô¿Õ
+#define NORMALWEARDIFF      6000     //HX3918 ¿¿½ü¸ÐÓ¦Åå´÷ʱ¸ÐÓ¦µÄ½á¹û, Ò»°ãÊÇ¿íËÉÅå´÷½á¹û
+hx_set_wear_detect_mode(NORMAL_WEAR_MODE)  // ÔÚÊÖ±íÆ½³£²âÊÔÅå´÷ÓÃ
+hx_set_wear_detect_mode(SLEEP_WEAR_MODE)    //ÔÚÊÖ±í¼ì²âµ½½øÈë˯ÃߺóÐèÒªµ÷ÓÃ
+*/
+
+/* --------------------------------³ÌÐò˵Ã÷------------------------------------------------------------
+1. ±¾³ÌÐòHX3918×÷ΪÅå´÷¸ÐÓ¦²¿·ÖµÄ¿ØÖƳÌÐò
+2.  HX3918 ÄÚÖÃ3ͨµÀCAP´«¸ÐÆ÷;
+3. ¶ÁÈ¡µÄRAW DATAÊÇ×îԭʼµÄÄ£ÄâÁ¿×ª»»¹ýÀ´µÄÊý×ÖÁ¿,
+   LPÊǾ­¹ýÒ»´ÎÂ˲¨À´µÄ(Â˳ý¸ßƵ»·¾³ÔëÉù),
+   BLÊÇRAW¾­¹ýÁ½´ÎÂ˲¨À´µÄ£¨Â˳ýµÍƵÔëÉù°üº¬Î¶ȡ¢Êª¶È¡¢Ñ¹Á¦´øÀ´µÄÆ¯ÒÆ£©£¬
+4. ÓÐÁ½ÖÖ¹¤×÷ģʽ¹©Êµ¼ÊʹÓÃÑ¡Ôñ,
+    Ïà¶Ôֵģʽ, ¿ª»úºó,оƬ×ÔУ׼¸ÐÓ¦Öµµ½0¸½½ü, ¿¿½üºÍÔ¶Àë,LP-BL»á²úÉúÒ»¸ö´óµÄ²îÖµ, Ïà¶Ôֵģʽ;
+       ¾ø¶Ôֵģʽ,ÐèÒªÓû§ÔÚ¹¤³§µÄʱºò, ²ú²â³ÌÐòÒª¼Ç¼ÊÖ±í¶Ô¿ÕµÄÒ»¸öBASEÖµ(LPÖµ), ºóÃæÓÃLP-BASEÖµÀ´×öÅжÏ;
+       Ïà¶ÔֵģʽÁ÷³ÌÉÔ΢¼òµ¥, µ«ÊÇÒòΪÉϵç»á×ÔÎÒУ׼, ËùÒÔÅå´÷×Å¿ª»úÎÞ·¨¼ì²âÅå´÷Çé¿ö. ¾ø¶ÔֵģʽÎÞ´ËÎÊÌâ.
+5.     hx3918_chip_id ÊÇоƬIDµÄ±äÁ¿, ÕýÈ·µÄIDÖµÊÇ0x27, ÒòΪHX3918 ÊÇPPGºÍCAP, ÓÃÕâ¸ö±äÁ¿ÅжÏÊDz»ÊÇоƬÒѾ­Éϵç,
+       ÇÒPPG²¿·ÖÒѾ­³õʼ»¯, Èç¹ûµÈÓÚ0X27, Õâ±ß¿ØÖƲ»ÐèÒªÉϵçϵç, Èç¹ûÅöµ½²ú²âģʽ,CAP´«¸ÐÆ÷ÐèÒªµ¥¶À¹¤×÷,
+       PPG²¿·ÖûÓÐͬʱ±»³õʼ»¯, ËùÒÔ¶Áµ½µÄhx3918_chip_id = 0, ÄÇÕâÀï¾ÍÊÇ»á¼ÓÉÏоƬµÄÉÏÏÂµç¿ØÖÆ
+6.  ×¢ÒâCSxºÍCHx, CSxÊÇÖ¸ÍⲿPAD½Óµ½Ð¾Æ¬µÄ¶ÔÓ¦CS¹Ü½Å. CHÊÇÖ¸ÄÚ²¿²É¼¯Êý¾ÝµÄ3¸öͨµÀ, CSx¿ÉÅäÖÃÔÚ²»Í¬µÄCHÉÏ;
+-------------------------------- -------------------------------- -----------------------------------*/
+#define ANALOG_DIFF        //Ä£Äâ²î·Ö, Ò»°ãÓÃÕâÖÖģʽ
+//#define DIGITAL_DIFF     //Êý×Ö²î·Ö
+
+#ifdef ANALOG_DIFF
+//#define INDEPENDDENT_CH  // ¶ÀÁ¢Í¨µÀºê¶¨Òå, ¾ÍÊÇÒ»¸öPAD¶ÔÓ¦Ò»¸öCH
+#define DIFFERENCE_CH      //²î·ÖͨµÀ¶¨Òå, Á½¸öPAD×÷Ϊһ¸öCHµÄ²î·ÖÕý¶ËºÍ¸º¶Ë, °¤×Ÿ첲µÄÅå´÷ΪÕý¶Ë
+#endif
+
+extern uint8_t hx3918_chip_id;   // Ð¾Æ¬ID, Ó¦¸ÃµÈÓÚ0x27
+int16_t nv_wear_offset[2] = {0};    // Ð¾Æ¬²ú²âУ׼µÄÁ½¸öͨµÀµÄOFFSETÖµ, Öµ¼Ç¼ÔÚfashÀïÃæ
+int16_t nv_base_data[2] = {0}; // Ð¾Æ¬²ú²âУ׼µÄÁ½¸öͨµÀµÄ¶Ô¿ÕLPÖµ, Öµ¼Ç¼ÔÚflashÀïÃæ
+uint32_t ai_tune_cnt[2] = {0}; //ai_tune_cnt[0] ¼Ç¼nv_base ×ÔѧϰÏòϸüеĴÎÊý,
+//extern uint16_t sendcnt;     // À¶ÑÀÊý¾Ý²É¼¯¼ÆÊý, Õâ¸öÊDzÉÊýÓõÄ, ¿ÉÒÔ²»ÓÃ
+int16_t gdiff[2] = {0};      // gdiff[0], gdiff[1] ·Ö±ð±£´æCH0, CH1µÄ½á¹û
+int16_t lp[2] = {0};
+int16_t bl[2] = {0};
+
+//flash ¶Áд±äÁ¿, ÒÀ´Î¼Ç¼nv_wear_offset[0],nv_wear_offset[1],nv_base_data[0],nv_base_data[1],ai_tune_cnt[0],ai_tune_cnt[1]
+uint32_t fds_read[6] = {0}; //¶Á³öflash ´æ´¢Êý¾ÝµÄ±äÁ¿;
+uint32_t fds_write[6] = {0}; //дflashµÄ±äÁ¿, flashÀïÃæ·Ö±ð¼Ç¼
+
+
+
+//prox_work_mode = RELATIVE_MODE,  Ïà¶Ôֵģʽ, ²âÁ¿½á¹û = LP-BL
+//prox_work_mode = ABSOLUTE_MODE, ¾ø¶Ôֵģʽ, ²âÁ¿½á¹û = LP - NV_BASE;
+uint8_t  prox_work_mode = RELATIVE_MODE;
+uint8_t  is_factory_mode = 0;    // ²ú²âģʽ, ÓÃÀ´¶ÁÈ¡Õû»ú¶Ô¿ÕʱOFFSETºÍ¶Ô¿ÕµÄnv_baseÖµ;
+uint8_t wear_detect_mode = NORMAL_WEAR_MODE;
+
+
+
+
+/**
+ * set touch detect  mode
+ * @param current_mode ÉèÖõŤ×÷ģʽ
+ */
+void hx_set_wear_detect_mode(uint8_t current_mode)
+{
+    if(current_mode>SLEEP_WEAR_MODE)
+    {
+        TYHX_LOG("wear mode set fail , exceed the limit\r\n");
+        return;
+    }
+    wear_detect_mode = current_mode;
+
+}
+
+
+/**
+ * ¶ÁÒ»×é16bit Êý¾ÝÖµ
+ * @param addh ¼Ä´æÆ÷µØÖ·
+ * @param addl ¼Ä´æÆ÷µØÖ·
+*/
+int16_t hx3918_read_two_reg_low_triple(uint8_t addh, uint8_t addl)
+{
+    uint8_t val_l = 0;
+    uint8_t val_h = 0;
+    uint8_t val_m= 0;
+    int32_t data = 0;
+    val_l = hx3918_read_reg(addl-1);
+    val_m = hx3918_read_reg(addl);
+    val_h = hx3918_read_reg(addh);
+    data =((val_l>>4) | (val_m<<4)|((val_h & 0x0f) << 12)) ;
+    if (data > 32767)
+        return (int16_t)(data - 65536);
+    else
+        return (int16_t)data;
+}
+
+/**
+ * Ð¾Æ¬Éϵç,  ¶ÔÓ¦µÄµçÔ´¿ØÖƹܽŸúʵ¼Êµç·Ïà¹Ø,¸ù¾Ýʵ¼Êµç·×öºÃ¿ØÖÆ
+* @param NULL
+*/
+void hx3918_power_up(void)
+{
+#ifdef TYHX_DEMO
+    nrf_gpio_pin_set(4);
+    nrf_delay_ms(100);
+#endif
+}
+
+/**
+ * Ð¾Æ¬Ïµç,  ¶ÔÓ¦µÄµçÔ´¿ØÖƹܽŸúʵ¼Êµç·Ïà¹Ø,¸ù¾Ýʵ¼Êµç·×öºÃ¿ØÖÆ
+* @param NULL
+*/
+void hx3918_power_down(void)
+{
+#ifdef TYHX_DEMO
+    nrf_gpio_pin_clear(4);
+    nrf_delay_ms(100);
+#endif
+}
+
+/**
+ * Ð¾Æ¬ÖØÐÂÉϵç
+* @param NULL
+*/
+void hx3918_power_restart(void)
+{
+    hx3918_power_down();
+    hx3918_power_up();
+}
+
+/**
+ * HX3918 ¶ÁоƬID
+* @param NULL
+*/
+uint8_t hx3918_check_device_id(void)
+{
+    return hx3918_read_reg(0x00);
+}
+
+
+/**
+ * HX3918 Ð´OFFSETµÄÖµ
+* @param offset_value Ð´OFFSETµÄÖµ
+* @param chx_offset Í¨µÀ0/1/2 Ñ¡Ôñ
+*/
+void  hx3918_write_offset(uint16_t offset_value, uint8_t chx_offset)
+{
+    uint8_t  write_val = 0;
+    uint8_t byte_high =0,  byte_low = 0;
+
+    byte_high = 0x61 + chx_offset*2;
+    byte_low = 0x60 + chx_offset*2;
+    write_val = ((uint8_t)(offset_value >> 8))&0xF;
+    hx3918_write_reg(byte_high,write_val);
+    write_val = (uint8_t)offset_value;
+    hx3918_write_reg(byte_low,write_val);
+
+}
+
+/**
+ * HX3918дOFFSETµÄÖµ, ÓÃÔÚ²ú²â³ÌÐòÀïÃæµÄOFFSET¶ÁÈ¡
+* @param offset_value Ð´OFFSETµÄÖµ
+* @param chx_offset Í¨µÀ0/1/2 Ñ¡Ôñ
+*/
+static int16_t readlp_after_writeoffset(int16_t offset,uint8_t chx_offset)
+{
+    int16_t lpout;
+    hx3918_write_offset(offset,chx_offset);
+    hx3918_delay(32);
+    lpout = hx3918_read_diff_lp(chx_offset);
+    hx3918_delay(33);
+    lpout = hx3918_read_diff_lp(chx_offset);
+    return lpout;
+}
+
+/**
+ * HX3918 ¶ÁOFFSETµÄÖµ
+* @param chx_offset Í¨µÀ0/1/2 Ñ¡Ôñ
+*/
+uint16_t  hx3918_read_offset(uint8_t chx_offset)
+{
+    uint16_t writeoffset = 0;
+    int16_t lp=0;
+    uint16_t offset = 0;
+    uint16_t recordoffset = 0;
+    uint16_t mid;
+    static uint8_t cnt = 0;
+    hx3918_write_reg(0x8F,0x07);       //offset_dac_en_i2c
+    recordoffset = 1020;
+    cnt = 0;
+    while(writeoffset<=recordoffset)
+    {
+        mid =(writeoffset+recordoffset)/2;
+        lp = readlp_after_writeoffset(mid,chx_offset);
+
+        if(hx_abs(lp)>1300)
+        {
+            if(lp>1300)
+            {
+                writeoffset = mid+1;
+            }
+            else
+            {
+                recordoffset = mid-1;
+            }
+            cnt ++;
+        }
+        else
+        {
+            offset = mid;
+            TYHX_LOG(" final ch=%d,offset =%d lp=%d\r\n",chx_offset,offset,lp);
+            break;
+        }
+        //TYHX_LOG(" ch=%d,lp =%d,writeoffset=%d,recordoffset=%d\r\n",chx_offset,lp,writeoffset,recordoffset);
+    }
+    return offset;
+}
+
+
+/**
+ * HX3918¶ÁÈ¡raw data »òÕßbaseline  data  //¶ÁÈ¡µÄÊÇraw»¹ÊÇbl Í¨¹ý0x38 ¼Ä´æÆ÷ÉèÖÃ
+* @param chx_raw Í¨µÀ0/1/2 Ñ¡Ôñ
+*/
+int16_t  hx3918_read_raw_bl(uint8_t chx_raw)
+{
+    int16_t raw = 0;
+    uint8_t byte_high =0,  byte_low = 0;
+
+    byte_high = 0xBE + chx_raw*3;
+    byte_low = 0xBD + chx_raw*3;
+
+    raw = hx3918_read_two_reg_low_triple(byte_high,byte_low);
+    return raw;
+}
+
+
+/**
+ * HX3918 ¶ÁÈ¡LP data »òÕßdiff data   //¶ÁÈ¡µÄÊÇlp»¹ÊÇdiffͨ¹ý0x38 ¼Ä´æÆ÷ÉèÖÃ
+* @param chx_raw Í¨µÀ0/1/2 Ñ¡Ôñ
+*/
+int16_t  hx3918_read_diff_lp(uint8_t chx_diff)
+{
+    int16_t diff = 0;
+    uint8_t byte_high =0,  byte_low = 0;
+
+    byte_high = 0xC7+ chx_diff*3;
+    byte_low = 0xC6 + chx_diff*3;
+
+    diff = hx3918_read_two_reg_low_triple(byte_high,byte_low);
+    return diff;
+}
+
+/**
+ * HX3918 ÉèÖýӽüãÐÖµºÍÔ¶ÀëãÐÖµ
+* @param chx Í¨µÀ0/1/2 Ñ¡Ôñ
+* @param high_thres ½Ó½üãÐÖµ
+* @param low_thres Ô¶ÀëãÐÖµ
+* @param base_data
+*/
+void hx3918_config_thres(uint8_t chx,int16_t high_thres, int16_t low_thres, int16_t base_data)
+{
+
+    if ((low_thres + base_data) <= 0)
+    {
+        return;
+    }
+    int16_t thres = 0;
+    thres = (high_thres + base_data)/32;
+    hx3918_write_reg(0x9D+1*chx, (thres&0x00FF));
+    hx3918_write_reg(0xA0+1*chx, (thres&0xFF00)>>8);
+    thres = (low_thres + base_data)/32;
+    hx3918_write_reg(0xA5+1*chx, (thres&0x00FF));
+    hx3918_write_reg(0xA8+1*chx, (thres&0xFF00)>>8);
+}
+
+
+/**
+ * HX3918 init
+* @param NULL
+*/
+bool hx3918_prox_reg_init(void)
+{
+    bool write_ok = true;
+
+#ifdef ANALOG_DIFF
+    if (hx3918_chip_id != PROX_CHIPID)
+    {
+        TYHX_LOG("100hz\r\n");
+        write_ok &= hx3918_write_reg(0x18,0x40);    //prf =100HZ
+        write_ok &= hx3918_write_reg(0x19,0x01);    //
+    }
+    write_ok &= hx3918_write_reg(0x6a,0x00);    //CH0~N disable
+    write_ok &= hx3918_write_reg(0x51,0x00);    //default??
+    write_ok &= hx3918_write_reg(0x52,0x02);    //default??
+    write_ok &= hx3918_write_reg(0x53,0x00);    //default??
+
+
+#ifdef INDEPENDDENT_CH //ÓÉʵ¼ÊÓ²¼þ¾ö¶¨, Òª¿´µç·ͼ
+    write_ok &= hx3918_write_reg(0x55,0x0C);   //CS1->CH0
+    write_ok &= hx3918_write_reg(0x57,0x30);   //CS2->CH1
+#elif defined(DIFFERENCE_CH) //ÓÉʵ¼ÊÓ²¼þ¾ö¶¨, Òª¿´µç·ͼ
+    write_ok &= hx3918_write_reg(0x55,0x2c);   //CS1->CH0[P],CS2->CH0[N]
+    write_ok &= hx3918_write_reg(0x57,0x30);   //CS2->CH1
+#endif
+    write_ok &= hx3918_write_reg(0x56,0x00);   //default
+    write_ok &= hx3918_write_reg(0x58,0x00);   //default
+    write_ok &= hx3918_write_reg(0x59,0x00);   //CH2
+    write_ok &= hx3918_write_reg(0x5A,0x00);   //CH2
+
+#ifdef FULL25PF
+    write_ok &= hx3918_write_reg(0x5B,0x11);   //full range = 2.5pf 0x11=2.5pf 0x22 = 3.75pf, 0x33 = 5pf
+#elif defined(FULL375PF)
+    write_ok &= hx3918_write_reg(0x5B,0x22);   //full range = 2.5pf 0x11=2.5pf 0x22 = 3.75pf, 0x33 = 5pf
+#elif defined(FULL50PF)
+    write_ok &= hx3918_write_reg(0x5B,0x33);   //full range = 2.5pf 0x11=2.5pf 0x22 = 3.75pf, 0x33 = 5pf
+#endif
+    write_ok &= hx3918_write_reg(0x5D,0x25);   //OSR AVG
+    write_ok &= hx3918_write_reg(0x5E,0x11);   //OSR AVG
+    write_ok &= hx3918_write_reg(0x5F,0x01);   //OSR AVG
+
+    write_ok &= hx3918_write_reg(0x66,0x08);   //²ÉÑùʱ¼ä
+    write_ok &= hx3918_write_reg(0x67,0x00);   //
+    write_ok &= hx3918_write_reg(0x68,0x08);   //»ý·Öʱ¼ä
+    write_ok &= hx3918_write_reg(0x69,0x00);   //
+
+    write_ok &= hx3918_write_reg(0x6E,0x11);   //LP alpha
+    write_ok &= hx3918_write_reg(0x77,0x70);   //output Ñ¡ÔñLPºÍBL
+
+    write_ok &= hx3918_write_reg(0x7A,0x07);   //²¹³¥µçÈÝУ׼´¥·¢ÉèÖÃ=16384
+
+#ifdef INDEPENDDENT_CH
+
+    prox_work_mode = RELATIVE_MODE;
+
+#endif
+    if (prox_work_mode == RELATIVE_MODE)
+    {
+        TYHX_LOG("RELATIVE_MODE\r\n");
+        write_ok &= hx3918_write_reg(0x70,0xaa);
+        write_ok &= hx3918_write_reg(0x72,0x40);
+        write_ok &= hx3918_write_reg(0x73,0x04);
+        write_ok &= hx3918_write_reg(0x90,0x77);
+        write_ok &= hx3918_write_reg(0x8F,0x00);
+        write_ok &= hx3918_write_reg(0x95,0x00);
+        hx3918_config_thres(CH0,CH0_HIGH_DIFF, CH0_LOW_DIFF,0); // wear0
+        hx3918_config_thres(CH1,CH1_HIGH_DIFF, CH1_LOW_DIFF,0); // wear0
+    }
+    else
+    {
+        TYHX_LOG("ABSOLUTE_MODE\r\n");
+        write_ok &= hx3918_write_reg(0x70,0x22);
+        write_ok &= hx3918_write_reg(0x72,0x20);
+        write_ok &= hx3918_write_reg(0x73,0x02);
+        write_ok &= hx3918_write_reg(0x90,0x07);
+        write_ok &= hx3918_write_reg(0x8F,0x07);
+        write_ok &= hx3918_write_reg(0x95,0x0a);
+        hx3918_write_offset(nv_wear_offset[0], CH0_OFFSET);
+        hx3918_write_offset(nv_wear_offset[1], CH1_OFFSET);
+        hx3918_config_thres(CH0,CH0_HIGH_DIFF, CH0_LOW_DIFF,nv_base_data[0]); // wear0
+        hx3918_config_thres(CH1,CH1_HIGH_DIFF, CH1_LOW_DIFF,nv_base_data[1]); // wear0
+        hx3918_write_reg(0x7A,0x17);
+    }
+    write_ok &= hx3918_write_reg(0x6a,0x03); //CH0, CH1 enable
+#endif
+    hx3918_delay(50);
+    return write_ok;
+}
+
+
+//À¶ÑÀ·¢ËÍÊý¾Ý¸øAPP
+//extern uint32_t sendDataToClient(int16_t sendnum1,int16_t sendnum2,int16_t sendnum3,int16_t sendnum4);
+
+/**
+ * hx3918 »ñÈ¡¿¿½ü¸ÐÓ¦µÄ½á¹û,½á¹û=0, prox¸ÐÓ¦µÄ½á¹ûΪ·ÇÅå´÷, =1 Åå´÷
+* @param NULL
+*/
+uint8_t hx3918_report_prox_status(void)
+{
+
+
+    lp[0] = hx3918_read_diff_lp(LP0);
+    bl[0] = hx3918_read_raw_bl(BL0);
+
+    lp[1] = hx3918_read_diff_lp(LP1);
+    bl[1] = hx3918_read_raw_bl(BL1);
+
+    if (prox_work_mode == RELATIVE_MODE)
+    {
+        gdiff[0] = lp[0]- bl[0];
+        gdiff[1] = lp[1]- bl[1];
+    }
+    else
+    {
+        gdiff[0] = lp[0]- nv_base_data[0];
+        gdiff[1] = lp[1]- nv_base_data[1];
+    }
+    //sendDataToClient(lp[0],bl[0],lp[1],bl[1]);
+    if(prox_work_mode==ABSOLUTE_MODE)
+    {
+        TYHX_LOG("[absolute mode]      %d      %d      %d      %d      %d      %d\r\n",lp[0],bl[0],lp[1],bl[1],gdiff[0],nv_base_data[0]);
+    }
+    else
+    {
+        TYHX_LOG("[relatvie mode]      %d      %d      %d      %d      %d      %d\r\n",lp[0],bl[0],lp[1],bl[1],gdiff[0],nv_base_data[0]);
+    }
+
+#ifdef TEMP_COMPENSATION   //ζȲ¹³¥
+    //Õâ¸öÊÇÓ¦¶Ô¸ßλ·¾³ÒªÇó, ²»Óôò¿ª, Òª¿´¿´¾ßÌåÇé¿ö,
+    if(gdiff[1]>20000)
+    {
+        gdiff[0] = gdiff[0]*0.9; // Èç¹ûËæ×ŸßÎÂ,¸ÐÓ¦ÖµÉÏÉý,Ϊ0.9, ¸ÐӦֵϽµ¸ÄΪ1.1
+    }
+#endif
+
+    if(gdiff[0]<WEARTHRES)
+    {
+        if((gdiff[0]>=SLEEPWEARTHRES)&&(wear_detect_mode == SLEEP_WEAR_MODE ))
+        {
+            return prox_detect;
+        }
+        return prox_no_detect;
+    }
+    else
+    {
+        return prox_detect;
+    }
+
+}
+
+/**
+ * hx3918 ´Óflash¶ÁÈ¡¶Ô¿ÕУ׼ºóµÄOFFSETºÍNV_BASE
+* @param NULL
+*/
+void hx3918_read_nv(void)
+{
+
+    //´Óflash¶ÁÈ¡6¸öÖµ, ·Ö±ðÊÇÒÔǰ±£´æµÄÖµ; Õâ¸öº¯ÊýÓû§ÐèÒª×Ô¼ºÍê³É, flash´æ´¢µÄλÖò»Äܱ»Óû§²Ù×÷ɾµô
+    //flash_fds_data_get(6);
+    nv_wear_offset[0] = fds_read[0];
+    nv_wear_offset[1] = fds_read[1];
+    nv_base_data[0] = fds_read[2];
+    nv_base_data[1] = fds_read[3];
+    ai_tune_cnt[0] =  fds_read[4];
+    ai_tune_cnt[1] =  fds_read[5];
+
+    TYHX_LOG("[hx3918_read_nv]\r\n");
+    TYHX_LOG("OFF[0]:  %d,  OFF[1]:%d\r\n",nv_wear_offset[0],nv_wear_offset[1]);
+    TYHX_LOG("BASE[0]: %d, BASE[1]:%d\r\n",nv_base_data[0],nv_base_data[1]);
+    TYHX_LOG("ai_tune_cnt[0]:  %d, ai_tune_cnt[1]:%d\r\n",ai_tune_cnt[0],ai_tune_cnt[1]);
+
+    //Èç¹ûflash¼Ç¼µÄÖµ´óÓÚÉÏÏÞ, ÔòÈÿ¿½ü¸ÐÓ¦½øÈëÏà¶Ôֵģʽ
+    if(nv_wear_offset[0] > 1020)
+    {
+        nv_wear_offset[0] = 0xffff;
+        nv_base_data[0] = 0;
+    }
+
+    if (nv_wear_offset[0] == 0 && nv_base_data[0] == 0)
+    {
+        nv_wear_offset[0] = 0xFFFF;
+    }
+    if (nv_wear_offset[0] == 0xFFFF || is_factory_mode == 1 )
+    {
+        prox_work_mode = RELATIVE_MODE;//Ïà¶Ôֵģʽ
+    }
+    else
+    {
+        prox_work_mode = ABSOLUTE_MODE;//¾ø¶Ôֵģʽ
+    }
+}
+
+/**
+ * hx3918 ¿¿½ü¸ÐÓ¦³õʼ»¯, Í¨¹ý¶Ôhx3918_chip_id ÅжÏ,À´ÅжϿ¿½ü¸ÐÓ¦ÊǶÀÁ¢¹¤×÷»¹ÊǸúPPGÒ»Æð¹¤×÷
+* @param NULL
+*/
+bool hx3918_prox_init(void)
+{
+#ifdef DEBUG_PPG_ONLY
+    return true;
+#endif
+    int32_t i = 0;
+    bool ret = false;
+    //sendcnt = 0;
+    TYHX_LOG("[hx3918_prox_init]prox device_id is : 0x%.2x !\r\n", hx3918_chip_id);
+    if (hx3918_chip_id != PROX_CHIPID)
+    {
+        hx3918_power_restart();
+        //i2c_hrs_init();
+               //twi_master_init();
+        hx3918_read_nv();
+               hx3918_ppg_on();
+        hx3918_prox_reg_init();
+        for (i = 0; i<5; i++)
+        {
+            hx3918_chip_id = hx3918_check_device_id();
+            TYHX_LOG(" power restart ,prox device_id is : 0x%.2x !\r\n", hx3918_chip_id);
+            if (hx3918_chip_id == PROX_CHIPID)
+            {
+                break;
+            }
+        }
+
+        if(hx3918_chip_id == 0)
+        {
+            TYHX_LOG("no proximity device\r\n");
+            //i2c_hrs_uninit();
+                                       
+            hx3918_power_down();
+        }
+    }
+    else
+    {
+        hx3918_chip_id = hx3918_check_device_id();
+        TYHX_LOG("read prox device_id is : 0x%.2x !\r\n", hx3918_chip_id);
+        hx3918_read_nv();
+        hx3918_prox_reg_init();
+    }
+    hx3918_delay(50);
+    return ret;
+}
+
+
+/**
+ * hx3918 ¿¿½ü¸ÐÓ¦³õʼ»¯, Í¨¹ý¶Ôhx3918_chip_id ÅжÏ,À´ÅжϿ¿½ü¸ÐÓ¦ÊǶÀÁ¢¹¤×÷»¹ÊǸúPPGÒ»Æð¹¤×÷
+* @param NULL
+*/
+bool hx3918_prox_factory_init(void)
+{
+#ifdef DEBUG_PPG_ONLY
+    return true;
+#endif
+    int32_t i = 0;
+    bool ret = false;
+
+    hx3918_chip_id = 0;
+
+    hx3918_power_restart();
+    //i2c_hrs_init();
+    prox_work_mode = RELATIVE_MODE;
+    hx3918_ppg_on();
+    hx3918_prox_reg_init();
+    for (i = 0; i<5; i++)
+    {
+        hx3918_chip_id = hx3918_check_device_id();
+        TYHX_LOG(" power restart ,prox device_id is : 0x%.2x !\r\n", hx3918_chip_id);
+        if (hx3918_chip_id == PROX_CHIPID)
+        {
+            break;
+        }
+    }
+    if(hx3918_chip_id == 0)
+    {
+        TYHX_LOG("no proximity device\r\n");
+        //i2c_hrs_uninit();
+        hx3918_power_down();
+    }
+    hx3918_delay(50);
+    return ret;
+}
+
+
+/**
+ * hx3918 ¿¿½ü¸ÐÓ¦²¿·Ö ¹¤³§²ú²â³ÌÐò, Ð轫ÊÖ±íÐü¿Õ»òÕßÔ¶ÀëÆäËû¿ÉÄÜÓ°ÏìµçÈÝÖµµÄÎïÌå.
+* @param NULL
+*/
+void hx3918_prox_factory_hanging_cali(void)
+{
+    uint16_t offset0 = 0;
+    uint16_t offset1 = 0;
+    int16_t lp[2] = {0};
+    //uint8_t device_id = 0x00;
+
+    is_factory_mode = 1;
+    hx3918_prox_factory_init();
+    hx3918_delay(50);//delay 100ms
+
+    offset0 = hx3918_read_offset(CH0_OFFSET);
+    offset1 = hx3918_read_offset(CH1_OFFSET);
+
+
+    lp[0] = hx3918_read_diff_lp(LP0);
+    lp[1] = hx3918_read_diff_lp(LP1);
+
+    TYHX_LOG("offset0,offset1= %d  %d\r\n", offset0,offset1);
+
+#ifdef INDEPENDDENT_CH
+    if((offset0-offset1)<100)
+    {
+        TYHX_LOG("ERR,  resize cap of ch0\r\n");
+    }
+
+#endif
+    nv_wear_offset[0] = offset0;
+    nv_wear_offset[1] = offset1;
+    nv_base_data[0] = lp[0];
+    nv_base_data[1] = lp[1];
+    TYHX_LOG("base0,base1=      %d  %d\r\n", lp[0],lp[1]);
+
+#ifdef DIFFERENCE_CH
+    //½«²î·ÖÊý¾Ý¶Áµ½µÄOFFSET, NV_BASE¼Ç¼µ½FLASHÀïÃæ, Ð£×¼´æ´¢°Ñ×ÔѧϰµÄ¼Ç¼ҲÐèÒªÇåµôÖØÐ¼ÆËã
+    ai_tune_cnt[0] = 0;
+    ai_tune_cnt[1] = 0;
+    hx3918_factory_cali_save_nv();
+#endif
+       hx3918_ppg_off();
+    is_factory_mode = 0;
+
+}
+
+/**
+ * hx3918 ¿¿½ü¸ÐÓ¦²¿·Ö ¹¤³§²ú²â³ÌÐò, Ð轫ÊÖ±íÐü¿Õ»òÕßÔ¶ÀëÆäËû¿ÉÄÜÓ°ÏìµçÈÝÖµµÄÎïÌå.
+* @param NULL
+*/
+void hx3918_factory_cali_save_nv(void)
+{
+
+    fds_write[0] = nv_wear_offset[0];
+    fds_write[1] = nv_wear_offset[1];
+
+    fds_write[2] = nv_base_data[0];
+    fds_write[3] = nv_base_data[1];
+
+    fds_write[4] = ai_tune_cnt[0];
+    fds_write[5] = ai_tune_cnt[1];
+
+    TYHX_LOG("[hx3918_factory_cali_save_nv]");
+    for(int i=0; i<6; i++)
+    {
+        TYHX_LOG("%d   ",fds_write[i]);
+    }
+    //flash_fds_data_write(6);
+}
+
+/**
+ * ×îÖÕÓÃIRºÍPROX×ÛºÏÀ´ÅжÏÅå´÷½á¹û
+* @param ppg_wear, PPG²¿·ÖÓÃIR¼ì²âµÄ½á¹û
+*/
+bool hx3918_get_wear_result(uint8_t ppg_wear)
+{
+    uint8_t prox_result;
+    if(ppg_wear == 0)
+    {
+        prox_result = hx3918_report_prox_status();
+        return false;
+    }
+    else
+    {
+#ifdef DEBUG_PPG_ONLY
+        return true;
+#endif
+        prox_result = hx3918_report_prox_status();
+        if(prox_result == 0)
+        {
+            return false;
+        }
+        else
+        {
+            return true;
+        }
+    }
+}
+
+/**
+ * HX3918 ×ÔÎÒУ׼ºǫִ́ÐгÌÐò, Åöµ½ÒòΪż·¢ÐÔµÄÒòÄÚ²¿½á¹¹µÈ±ä»¯ÒýÆð¿¿½ü¸ÐÓ¦µÄ¶Ô¿Õ»ù×¼Öµ·¢Éú´óµÄ±ä»¯,
+ *       ÊÖ±í¶ÔÔÚ·ÇÅå´÷ʱ, ¿ÉÖ´ÐÐÒ»´Î¿¿½ü¸ÐÓ¦µÄ×ÔÎÒУ׼.
+                 ´¥·¢Ìõ¼þ, µ±IR¼ì²âΪ¶Ô¿Õ, ÇÒµ±Ç°LPµÍÓÚ-3000, ´¥·¢ºǫ́У׼. Õâ¸ö³ÌÐòÔÚ¼ì²âÅå´÷µÄº¯ÊýÖб»µ÷ÓÃ
+* @param irval ÔÚÅå´÷¼ì²âģʽʱ²âÊÔµ½µÄÖµ
+*/
+void hx3918_auto_cali_backgroud(int32_t irval)
+{
+    uint8_t prox_result;
+
+    if(irval>HX3918_IR_AIR)
+        return;
+    prox_result = hx3918_report_prox_status();
+
+    if(prox_result == prox_no_detect)
+    {
+        if((nv_base_data[0]<AUTOCALITHRES)&&(lp[0]<AUTOCALITHRES))
+        {
+            hx3918_prox_factory_hanging_cali();
+            TYHX_LOG("hi, auto cali\r\n");
+        }
+    }
+}
+
+
+#define FILTERLEN 8 // Õâ¸öÖµ±ØÐë´óÓÚµÈÓÚ4
+/**
+*  ÖÐλֵƽ¾ùÂ˲¨
+* @param pData:  Ô­Ê¼µÄLPÂ˲¨Êý¾Ý
+* @param nSize:Êý¾Ý´óС
+* @return:Â˲¨ÊýÖµ
+*/
+
+int16_t  MedianFilter(int16_t* pData,int nSize)
+{
+    int16_t max,min;
+    int sum;
+    if(nSize>=FILTERLEN)
+    {
+        max = pData[0];
+        min = max;
+        sum = 0;
+        for(int i=0; i<nSize; i++)
+        {
+            sum += pData[i];
+            if(pData[i]>max)
+            {
+                max = pData[i];   //Ò»¸öÑ­»·Ö®ºómax¾ÍÊÇ×î´óµÄÖµ
+            }
+
+            if(pData[i]<min)
+            {
+                min = pData[i];   //Ò»¸öÑ­»·Ö®ºómin¾ÍÊÇ×îСµÄÖµ
+            }
+        }
+
+        sum = sum-max-min;       //È¥µô×î´óµÄÖµºÍ×îСµÄÖµ
+        return sum/(nSize-2);    //¶ÔN-2¸öÊýÇ󯽾ùÖµ
+    }
+
+    return 0;
+}
+
+
+/**
+ * HX3918 ÏòÏÂУ׼¶Ô¿ÕÖµ, Èç×°ÅäµÈÎÊÌâµ¼ÖµçÈÝÓÐСµÄÏòÏÂÆ¯ÒÆ, »òÕßpad¿ÉÄÜÓÐСµÄÐαäµÈÒýÆðµÄ¸ÐÓ¦Öµ±äС.
+               Í¨¹ýÕâ¸ö³ÌÐò     Ð£×¼¶Ô¿ÕµÄnv_base;  ÊÖ±íÔÚ
+* @param prevlp ÔÚÅå´÷¼ì²âģʽʱ²âÊÔµ½µÄÉÏÒ»¸öLPµÄÖµ
+* @param chargetstate ³äµç״̬ = true, ÎªÁ˽«nv_base×ÔѧϰÏòÉÏÒ»µã, Èç¹û³äµçµÄʱºòÊÖ±íÍâ¿Ç½Ó´¥µ¼Ìå×ÀÃæµÈ,²»½¨Òé´ò¿ªÕâ¸ö
+*/
+void hx3918_ai_tune_nv(int16_t prevlp,int16_t prevbl)
+{
+    int16_t lpresult,blresult;
+    int16_t differ;
+    static uint8_t receivercnt = 0;     //½ÓÊܵ½µÄlpµÄ¼ÆÊý
+    static int16_t lp_filter[FILTERLEN] = {0};
+    static int16_t bl_filter[FILTERLEN] = {0};
+    static bool flashrecordupdate = false;;
+    static uint32_t get_record_time;
+    uint32_t get_new_time;
+
+    if (prox_work_mode == ABSOLUTE_MODE)
+    {
+        for(int ii=0; ii<(FILTERLEN-1); ii++)
+        {
+            lp_filter[ii] = lp_filter[ii+1];
+            bl_filter[ii] = bl_filter[ii+1];
+
+        }
+        lp_filter[FILTERLEN-1] = prevlp;
+        bl_filter[FILTERLEN-1] = prevbl;
+        if(receivercnt<FILTERLEN)
+        {
+            receivercnt++;
+        }
+        if(receivercnt>=FILTERLEN)
+        {
+            lpresult = MedianFilter(lp_filter,FILTERLEN);
+            blresult = MedianFilter(bl_filter,FILTERLEN);
+                       TYHX_LOG("lp =%d, bl = %d, receivercnt=%d\r\n",lpresult,blresult,receivercnt);
+            if((blresult>=ONAIRTHRESLOW) && (blresult<=ONAIRTHRESHIGH)&&(lpresult>=ONAIRTHRESLOW) && (lpresult<=ONAIRTHRESHIGH))
+            {
+                if((hx_abs(blresult -nv_base_data[0] )>=DIFFDETECT) &&(hx_abs(lpresult-blresult)<=100))
+                {
+                    differ = blresult-nv_base_data[0];
+                    TYHX_LOG("detect lp =%d, bl = %d, nv_base=%d\r\n",lpresult,blresult,nv_base_data[0]);
+                    nv_base_data[0] += (differ/2);
+                    hx3918_config_thres(CH0,CH0_HIGH_DIFF, CH0_LOW_DIFF,nv_base_data[0]); // wear0
+                    get_record_time = app_timer_cnt_get();
+                    flashrecordupdate = true;
+                }
+            }
+        }
+        if(flashrecordupdate)//¼ä¸ô2·ÖÖÓÈç¹ûÓÐÐèÒª¼Ç¼flashÒ»´Î, ·ÀÖ¹ÖØ¸´Ð´flash, Õâ¸öʱ¼äÓɸ÷×ÔÆ½Ì¨´¦Àí.
+        {
+            get_new_time = app_timer_cnt_get(); //»»Ëã³ÉÃë;
+            if (get_new_time >= get_record_time)//
+            {
+                get_new_time = ((get_new_time - get_record_time) )>>15;
+            }
+            else
+            {
+                get_new_time = ((get_new_time + 16777216 - get_record_time) ) >>15;
+            }
+            get_new_time *=2;
+            if(get_new_time>=120)//120 Ãë
+            {
+                ai_tune_cnt[0]++;
+                TYHX_LOG("write nv_base=%d, updata cnt = %d\r\n",nv_base_data[0],ai_tune_cnt[0] );
+                hx3918_factory_cali_save_nv();
+                flashrecordupdate = false;
+                get_new_time = 0;
+            }
+        }
+    }
+}
+
+
+
+
+
diff --git a/2.sdk/Helios_SDK/components/HX3918/hx3918_prox.h b/2.sdk/Helios_SDK/components/HX3918/hx3918_prox.h
new file mode 100644 (file)
index 0000000..1b2d331
--- /dev/null
@@ -0,0 +1,115 @@
+/**
+  ******************************************************************************
+  * @file           : hx3918_PROX.h
+  * @version        : v1.0
+  * @brief          :
+*/
+#ifndef __HX3918_PROX_H_
+#define __HX3918_PROX_H_
+
+#include <stdbool.h>
+#include <stdint.h>
+
+
+#define CH0   0
+#define CH1   1
+#define CH2   2
+
+
+#define CH0_OFFSET   0
+#define CH1_OFFSET   1
+#define CH2_OFFSET   2
+
+
+#define RAW0   0
+#define RAW1   1
+#define RAW2   2
+
+#define BL0   0
+#define BL1   1
+#define BL2   2
+
+
+#define LP0   0
+#define LP1   1
+#define LP2   2
+
+
+#define DIFF0   0
+#define DIFF1   1
+#define DIFF2   2
+
+
+#define hx_min(x,y)  ( (x)>(y)?(y):(x) )
+#define hx_abs(x)    ((x)>0?(x):(-(x)))
+
+#define RELATIVE_MODE  0
+#define ABSOLUTE_MODE  1
+
+#define PROX_CHIPID         0x27
+
+#define HX3918_IR_AIR       6000                  //СÓÚÕâ¸öÖµ´ú±íÍÑÍó
+
+#define NORMALWEARDIFF      12000                 //Õý³£Åå´÷²âÊÔµ½µÄƽ¾ùÖµ, ¿íËÉÅå´÷
+#define WEARTHRES              NORMALWEARDIFF/2      //ÆÕͨÅå´÷ãÐÖµ
+#define SLEEPWEARTHRES      NORMALWEARDIFF*0.3    //˯ÃßÅå´÷ãÐÖµ
+
+#define AUTOCALITHRES       -3000                 //ºǫ́×Ô¶¯Ð£×¼LPºÍBLãÐÖµ
+#define ONAIRTHRESLOW       -2500                  //¶Ô¿ÕµÄLP BL ×îСֵ
+#define ONAIRTHRESHIGH       1300                  //¶Ô¿ÕµÄLP BL ×î´óÖµ
+
+#define DIFFDETECT          200                   //BL ºÍ NV_BASE ±È½ÏµÄ²îÖµ
+
+#define CH0_HIGH_DIFF          SLEEPWEARTHRES
+#define CH0_LOW_DIFF           SLEEPWEARTHRES*0.7
+#define CH1_HIGH_DIFF          SLEEPWEARTHRES
+#define CH1_LOW_DIFF           SLEEPWEARTHRES*0.7
+
+
+typedef enum
+{
+    prox_no_detect = 0,   // ¿¿½ü¸ÐӦûÓмì²âµ½
+    prox_detect =1,       // ¿¿½ü¸ÐÓ¦¼ì²âµ½
+} prox_result_t;
+
+typedef enum {
+       NORMAL_WEAR_MODE = 0,// 
+       SLEEP_WEAR_MODE = 1,//
+} wear_mode_t;
+
+
+
+
+extern int16_t gdiff[2];
+extern int16_t lp[2];
+extern int16_t bl[2];
+extern int16_t nv_base_data[2];
+extern uint32_t ai_tune_cnt[2];
+extern int16_t nv_wear_offset[2];
+
+extern uint32_t fds_read[6]; //flash ¶Á
+extern uint32_t fds_write[6];//flash д
+extern uint8_t wear_detect_mode;
+
+
+
+void hx3918_power_up(void);
+void hx3918_power_down(void);
+void hx3918_power_restart(void);
+uint8_t hx3918_check_device_id(void);
+bool hx3918_prox_reg_init(void);
+uint8_t hx3918_report_prox_status(void);
+
+void hx3918_prox_factory_hanging_cali(void);
+bool hx3918_prox_init(void);
+void hx3918_factory_cali_save_nv(void);
+int16_t hx3918_read_diff_lp(uint8_t chx_diff);
+bool hx3918_get_wear_result(uint8_t ppg_wear);
+void hx3918_auto_cali_backgroud(int32_t irval);
+//void hx3918_ai_tune_nv(int16_t prevlp,bool chargetstate);
+void hx3918_ai_tune_nv(int16_t prevlp,int16_t prevbl);
+//void hx3918_ai_tune_nv(int32_t irval,int16_t prevlp,int16_t prevbl);
+bool hx3918_prox_factory_init(void);
+void hx_set_wear_detect_mode(uint8_t current_mode);
+
+#endif
diff --git a/2.sdk/Helios_SDK/components/HX3918/hx3918_spo2_agc.c b/2.sdk/Helios_SDK/components/HX3918/hx3918_spo2_agc.c
new file mode 100644 (file)
index 0000000..438e173
--- /dev/null
@@ -0,0 +1,976 @@
+#include <stdio.h>
+#include <stdbool.h>
+#include <stdint.h>
+#include <stdlib.h>
+#include <math.h>
+
+#include "hx3918.h"
+#include "hx3918_spo2_agc.h"
+#include "tyhx_spo2_alg.h"
+#include "tyhx_hrs_alg.h"
+//#include "tyhx_hrs_custom.h"
+#include "hx3918_prox.h"
+
+#ifdef SPO2_ALG_LIB
+extern const uint8_t  hx3918_spo2_agc_green_idac;  // 6,7,8...
+extern const uint8_t  hx3918_spo2_agc_red_idac;  // 6,7,8...
+extern const uint8_t  hx3918_spo2_agc_ir_idac;  // 6,7,8...
+extern const uint8_t  green_led_max_init;
+extern const uint8_t  red_led_max_init;
+extern const uint8_t  ir_led_max_init;
+extern uint8_t low_vbat_flag;
+
+extern const uint8_t  spo2_check_unwear_oft;
+extern const int32_t  spo2_ir_wear_thres;
+extern const int32_t  sar_unwear_thres;
+extern const int32_t  sar_wear_thres;
+extern uint8_t read_fifo_first_flg;
+
+static uint8_t s_ppg_state = 0;
+static uint8_t s_cal_state = 0;
+static int32_t agc_buf[4] = {0};
+
+static uint8_t cal_delay = CAL_DELAY_COUNT;
+static SPO2_CAL_SET_T  calReg;
+
+static hx3918_spo2_wear_msg_code_t spo2_wear_status = MSG_SPO2_INIT;
+static hx3918_spo2_wear_msg_code_t spo2_wear_status_pre = MSG_SPO2_INIT;
+
+void hx3918_spo2_ppg_init(void) //2023 3918
+{
+    uint16_t sample_rate = 25;                  /*config the data rate of chip alps2_fm ,uint is Hz*/
+    uint32_t prf_clk_num = 32000/sample_rate;   /*period in clk num, num = Fclk/fs */
+
+    uint8_t ps0_enable=1;       /*ps0_enable  , 1 mean enable ; 0 mean disable */
+    uint8_t ps1_enable=1;       /*ps1_enable  , 1 mean enable ; 0 mean disable */
+    uint8_t ps2_enable=1;       /*ps0_enable  , 1 mean enable ; 0 mean disable */
+    uint8_t ps3_enable=1;       /*ps1_enable  , 1 mean enable ; 0 mean disable */
+
+    uint8_t ps0_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+    uint8_t ps1_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+    uint8_t ps2_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+    uint8_t ps3_osr = 3;    /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 */
+
+    uint8_t ps3_cp_avg_num_sel= 2;
+    uint8_t ps2_cp_avg_num_sel= 1;
+    uint8_t ps1_cp_avg_num_sel= 3;
+    uint8_t ps0_cp_avg_num_sel= 0;
+
+    uint8_t ps3_avg_num_sel_i2c=0;
+    uint8_t ps2_avg_num_sel_i2c=0;
+    uint8_t ps1_avg_num_sel_i2c=0;
+    uint8_t ps0_avg_num_sel_i2c=0;
+
+    uint8_t ps0_led_en_i2c=0;
+    uint8_t ps1_led_en_i2c=1;
+    uint8_t ps2_led_en_i2c=1;
+    uint8_t ps3_led_en_i2c=1;
+
+    uint8_t ps0_ofidac_en_i2c=1;
+    uint8_t ps1_ofidac_en_i2c=1;
+    uint8_t ps2_ofidac_en_i2c=1;
+    uint8_t ps3_ofidac_en_i2c=1;
+
+    uint8_t dccancel_ps0 =0;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps1 =0;   //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps2 =0;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps3 =0;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+
+    uint8_t leddrive_ps0 =0;     //LEDDRIVE_PS0  0~255 = 0~200ma
+    uint8_t leddrive_ps1 =0;     //LEDDRIVE_PS1  0~255 = 0~200ma
+    uint8_t leddrive_ps2 =0;    //LEDDRIVE_PS2  0~255 = 0~200ma
+    uint8_t leddrive_ps3 =64;     //LEDDRIVE_PS3  0~255 = 0~200ma
+
+    uint8_t led_en_begin =1;       // 0 = 2 ; 1 = 4 ; 2 = 8 ; 3 = 16 ;
+    uint8_t afe_reset = 1;        //* 0 = 32clk ; 1 = 64clk ; 2 = 128clk ; 3 = 256clk(d) ;
+    uint8_t en2rst_delay =3;      // pen 2 rst delay 0 = 128,256, 512, 1024
+    uint8_t init_wait_delay = 2; /* 0 = 800 ; 1 = 1600; 2 = 3200 ; 3 = 6400(d) */
+
+    uint8_t ps1_interval_i2c =0;    // ps2/ps3
+
+    uint8_t thres_int =1;    //thres int enable
+    uint8_t data_rdy_int =8;    //[3]:ps1_data2 [2]:ps1_data1 [1]:ps0_data2 [0]:ps0_data1
+
+    uint8_t ldrsel_ps0 =0;      
+    uint8_t ldrsel_ps1 =RED_LED_SLE; 
+    uint8_t ldrsel_ps2 =GREEN_LED_SLE;
+    uint8_t ldrsel_ps3 =IR_LED_SLE;
+
+    /***********cap *********/
+    uint8_t intcapsel_ps3 =5;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+    uint8_t intcapsel_ps2 =5;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+    uint8_t intcapsel_ps1 =5;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+    uint8_t intcapsel_ps0 =5;   //00=4fp 01=8pf 02=12pf 03=16pf 04=20pf 05=24pf 06=28pf 07=32pf 08=36pf 09=40pf 10=44pf 11=48pf 12=52pf 13=56pf 14=60pf
+
+    uint8_t ps0_led_on_time=64;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+    uint8_t ps1_led_on_time=64;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+    uint8_t ps2_led_on_time=64;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+    uint8_t ps3_led_on_time=64;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+
+    uint8_t force_adc_clk_sel=0;
+    uint8_t force_adc_clk_cfg =0;
+    uint8_t force_PEN =0;
+    uint8_t force_PEN_cfg =0;
+    uint8_t force_LED_EN =0;
+    uint8_t force_LED_EN_cfg =0;
+    uint8_t force_CKAFEINT_sel =0;
+    uint8_t force_CKAFEINT_cfg =0;
+
+    hx3918_write_reg(0X16, (ps3_enable<<3| ps2_enable<<2|ps1_enable<<1|ps0_enable));   //default 0x00
+    hx3918_write_reg(0X17, (ps3_osr<<6| ps2_osr<<4|ps1_osr<<2|ps0_osr));       //default 0x00
+    hx3918_write_reg(0X18, (uint8_t)prf_clk_num);    // prf bit<7:0>6   default 0x00
+    hx3918_write_reg(0X19, (uint8_t)(prf_clk_num>>8)); // prf bit<11:8>  default 0x03
+    hx3918_write_reg(0X1a, (ps1_interval_i2c));   //default 0x00
+    hx3918_write_reg(0X1b, led_en_begin<<6|afe_reset<<4|en2rst_delay <<2|init_wait_delay); // led_en_num*8     //default 0x00
+    //hx3918_write_reg(0X1b, 0x03);
+    hx3918_write_reg(0X1c, ps0_led_on_time); // led_en_num*8     //default 0x00
+    hx3918_write_reg(0X1d, ps1_led_on_time); // led_en_num*8     //default 0x00
+    hx3918_write_reg(0X1e, ps2_led_on_time); // led_en_num*8     //default 0x00
+    hx3918_write_reg(0X1f, ps3_led_on_time); // led_en_num*8     //default 0x00
+    hx3918_write_reg(0X20, (ps3_cp_avg_num_sel<<6|ps2_cp_avg_num_sel<<4|ps1_cp_avg_num_sel<<2|ps0_cp_avg_num_sel) );     //default 0x00
+    hx3918_write_reg(0X21, (ps3_avg_num_sel_i2c<<6|ps2_avg_num_sel_i2c<<4|ps1_avg_num_sel_i2c<<2|ps0_avg_num_sel_i2c));     //default 0x00
+    hx3918_write_reg(0X23, (ps0_led_en_i2c<<7|ps1_led_en_i2c<<6|ps2_led_en_i2c<<5|ps3_led_en_i2c<<4|ps0_ofidac_en_i2c<<3|ps1_ofidac_en_i2c<<2|ps2_ofidac_en_i2c<<1|ps3_ofidac_en_i2c)); // led_en  offset_en
+    hx3918_write_reg(0X24, (intcapsel_ps0<<4|intcapsel_ps1));   //default 0x00
+    hx3918_write_reg(0X25, (intcapsel_ps2<<4|intcapsel_ps3));   //default 0x00
+    hx3918_write_reg(0X26, leddrive_ps0); // led_en_num*8     //default 0x00
+    hx3918_write_reg(0X27, leddrive_ps1); // led_en_num*8     //default 0x00
+    hx3918_write_reg(0X28, leddrive_ps2); // led_en_num*8     //default 0x00
+    hx3918_write_reg(0X29, leddrive_ps3); // led_en_num*8     //default 0x00
+    hx3918_write_reg(0X2a, (ldrsel_ps0<<4|ldrsel_ps1));     //default 0x00
+    hx3918_write_reg(0X2b, (ldrsel_ps2<<4|ldrsel_ps3));     //default 0x00
+    hx3918_write_reg(0X2c, dccancel_ps0 );     //default 0x00
+    hx3918_write_reg(0X2d, dccancel_ps1 );     //default 0x00
+    hx3918_write_reg(0X2e, dccancel_ps2 );     //default 0x00
+    hx3918_write_reg(0X2f, dccancel_ps3);     //default 0x00
+    hx3918_write_reg(0X36, (thres_int<<4|data_rdy_int));
+    hx3918_write_reg(0X4e, (force_adc_clk_sel<<7|force_adc_clk_cfg<<6|force_PEN<<5|force_PEN_cfg<<4|force_LED_EN<<3|
+                            force_LED_EN_cfg<<2|force_CKAFEINT_sel<<1|force_CKAFEINT_cfg));   //default 0x00
+
+    hx3918_write_reg(0X6d, 0x00);
+    hx3918_write_reg(0XF0, 0x22);
+    hx3918_write_reg(0xF1, 0x28);
+    hx3918_write_reg(0xF2, 0x04);
+    hx3918_write_reg(0xF3, 0x70);
+    hx3918_write_reg(0xF4, 0x32);
+    hx3918_write_reg(0xF5, 0x89);
+    hx3918_write_reg(0xF6, 0x2b);
+    hx3918_write_reg(0xF7, 0x85);
+    hx3918_write_reg(0xF8, 0x27);
+    hx3918_write_reg(0xF9, 0x00);
+    hx3918_write_reg(0xFA, 0x88);
+    hx3918_write_reg(0xFB, 0x40);
+    hx3918_write_reg(0Xf6, 0X2b);
+
+#if defined(TIMMER_MODE)
+    hx3918_write_reg(0x3d,0x80);     //bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;0011=p4;bits<7> fifo enble
+    hx3918_write_reg(0x3e,0x20);                //watermark
+    hx3918_write_reg(0x3c,0x1f);     // int_width_i2c
+    hx3918_write_reg(0X37,0x00);   // int sel,01=prf int,04=enable almost full int
+    hx3918_write_reg(0X3b,0x00);
+    hx3918_write_reg(0X3b,0x10);
+#else ///////////INT Mode
+    hx3918_write_reg(0x3d,0x00);     //bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;0011=p4;bits<7> fifo enble
+    hx3918_write_reg(0x3c,0x1f);     // int_width_i2c
+    hx3918_write_reg(0X37,0x04);   // int sel,01=prf ,04=enable almost full
+#endif
+
+    hx3918_write_reg(0X4d,0X01);  //soft reset
+    hx3918_delay(5);
+    hx3918_write_reg(0X4d,0X00);  //release
+    hx3918_delay(5);
+       
+    read_fifo_first_flg = 1;
+
+}
+
+void Init_Spo2_PPG_Calibration_Routine(SPO2_CAL_SET_T *calR)
+{
+    calR->flag = CAL_FLG_LED_DR|CAL_FLG_LED_DAC|CAL_FLG_AMB_DAC|CAL_FLG_RF;
+    calR->red_idac = 0;
+    calR->ir_idac = 0;
+    calR->green_idac = 0;
+    calR->amb_idac = 0;
+    calR->ontime = 5;
+    calR->green_cur = SPO2_CAL_INIT_LED_GREEN;
+    calR->red_cur = SPO2_CAL_INIT_LED_RED;
+    calR->ir_cur = SPO2_CAL_INIT_LED_IR;
+    calR->state = sCalStart;
+    calR->int_cnt = 0;
+    calR->cur255_cnt =0;
+    calR->green_led_step =0;
+    calR->red_led_step =0;
+    calR->ir_led_step =0;
+    if(low_vbat_flag == 1)
+    {
+        calR->green_max_cur = (green_led_max_init*3)>>2;
+        calR->red_max_cur = (red_led_max_init*3)>>2;
+        calR->ir_max_cur = (ir_led_max_init*3)>>2;
+    }
+    else
+    {
+        calR->green_max_cur = green_led_max_init;
+        calR->red_max_cur = red_led_max_init;
+        calR->ir_max_cur = ir_led_max_init;
+    }
+}
+
+void Restart_Spo2_PPG_Calibration_Routine(SPO2_CAL_SET_T *calR)
+{
+    calR->flag = CAL_FLG_LED_DAC;
+    calR->state = sCalLed;
+    calR->int_cnt = 0;
+}
+
+bool hx3918_spo2_check_unwear(void)
+{
+    if(calReg.ir_idac < spo2_check_unwear_oft)
+    {
+        spo2_wear_status = MSG_SPO2_NO_WEAR;
+        if(spo2_wear_status_pre != MSG_SPO2_NO_WEAR)
+        {
+            spo2_wear_status_pre = MSG_SPO2_NO_WEAR;
+            hx3918_spo2_low_power();
+            return true;
+        }
+    }
+    return false;
+}
+
+bool hx3918_spo2_check_wear(int32_t infrared_data)
+{
+       if(infrared_data > spo2_ir_wear_thres )
+    {
+       
+        spo2_wear_status = MSG_SPO2_WEAR;              
+               //TYHX_LOG("[hx3918_spo2_check_wear start] ir wear result = %d\r\n",spo2_wear_status);
+               //spo2_wear_status = hx3918_get_wear_result(spo2_wear_status);
+               TYHX_LOG("[hx3918_spo2_check_wear end] final result = %d\r\n",spo2_wear_status);
+        if(spo2_wear_status_pre != MSG_SPO2_WEAR)
+        {
+            AGC_LOG("hx3918_spo2_check_wear ir = %d\r\n", infrared_data);
+            spo2_wear_status_pre = MSG_SPO2_WEAR;
+            tyhx_spo2_alg_open_deep();
+            hx3918_spo2_set_mode(PPG_INIT);
+            hx3918_spo2_set_mode(CAL_INIT);
+            return true;
+        }
+    }
+    return false;
+}
+
+
+void PPG_Spo2_Calibration_Routine(SPO2_CAL_SET_T *calR, int32_t amb, int32_t green_led, int32_t r_led, int32_t ir_led)
+{
+    int32_t r_led_temp = 0, ir_led_temp = 0, green_led_temp = 0;
+    TYHX_LOG("AGC_before: green_cur=%d,red_cur=%d,ir_cur=%d,green_idac=%d,red_idac=%d,ir_idac=%d,green_step=%d,red_step=%d,ir_step=%d,state=%d\r\n",\
+             calR->green_cur,calR->red_cur,calR->ir_cur,calR->green_idac,calR->red_idac,calR->ir_idac,calR->green_led_step,calR->red_led_step,calR->ir_led_step,calR->state);
+    switch(calR->state)
+    {
+        case sCalStart:
+            calR->state = sCalLedCur;
+            break;
+
+        case sCalLedCur:
+            if(spo2_wear_status == MSG_SPO2_NO_WEAR)
+            {
+                calR->state = sCalFinish;
+                break;
+            }
+            calR->amb_idac = 0;
+            if(green_led>amb+128)
+            {
+                calR->green_led_step = (green_led-amb)/SPO2_CAL_INIT_LED_GREEN;
+                green_led_temp = 5000*(hx3918_spo2_agc_green_idac+calR->amb_idac)/calR->green_led_step;
+                if(green_led_temp>calR->green_max_cur)
+                {
+                    green_led_temp = calR->green_max_cur;
+                }
+                calR->green_cur = green_led_temp;
+                calR->green_idac = hx3918_spo2_agc_green_idac>>1;
+            }
+            if(r_led>amb+128)
+            {
+                calR->red_led_step = (r_led-amb)/SPO2_CAL_INIT_LED_RED;
+                r_led_temp = 10000*(hx3918_spo2_agc_red_idac+calR->amb_idac)/calR->red_led_step;
+                if(r_led_temp>calR->red_max_cur)
+                {
+                    r_led_temp = calR->red_max_cur;
+                }
+                calR->red_cur = r_led_temp;
+                calR->red_idac = hx3918_spo2_agc_red_idac>>1;
+            }
+            if(ir_led>amb+128)
+            {
+                calR->ir_led_step = (ir_led-amb)/SPO2_CAL_INIT_LED_IR;
+                ir_led_temp = 10000*(hx3918_spo2_agc_ir_idac+calR->amb_idac)/calR->ir_led_step;
+                if(ir_led_temp>calR->ir_max_cur)
+                {
+                    ir_led_temp = calR->ir_max_cur;
+                }
+                calR->ir_cur = ir_led_temp;
+                calR->ir_idac = hx3918_spo2_agc_ir_idac>>1;
+            }
+            calR->ontime = 64;
+            calR->flag = CAL_FLG_LED_DR|CAL_FLG_LED_DAC|CAL_FLG_AMB_DAC|CAL_FLG_RF;
+            calR->state = sCalLed;
+            break;
+
+        case sCalLed:
+            if(green_led>450000 && calR->green_idac < 200)
+            {
+                calR->green_idac = calR->green_idac+2;
+            }
+
+            if(r_led>450000 && calR->red_idac < 200)
+            {
+                calR->red_idac = calR->red_idac+2;
+            }
+
+            if(ir_led>450000 && calR->ir_idac < 200)
+            {
+                calR->ir_idac = calR->ir_idac+2;
+            }
+
+            if(green_led<=450000 && ir_led<=450000 && r_led<=450000)
+            {
+                calR->state = sCalLed2;
+            }
+            else if(calR->green_idac >= 200 || calR->ir_idac >= 200 || calR->red_idac >= 200)
+            {
+                calR->state = sCalFinish;
+            }
+            else
+            {
+                calR->state = sCalLed;
+            }
+            calR->flag = CAL_FLG_LED_DAC;
+            break;
+
+        case sCalLed2:
+            if(green_led>350000 && calR->green_idac < 200)
+            {
+                calR->green_idac = calR->green_idac+1;
+            }
+            else if(green_led<150000 && calR->green_idac > 0)
+            {
+                calR->green_idac = calR->green_idac-1;
+            }
+            
+            if(r_led>350000 && calR->red_idac < 200)
+            {
+                calR->red_idac = calR->red_idac+1;
+            }
+            else if(r_led<150000 && calR->red_idac > 0)
+            {
+                calR->red_idac = calR->red_idac-1;
+            }
+
+            if(ir_led>350000 && calR->ir_idac < 200)
+            {
+                calR->ir_idac = calR->ir_idac+1;
+            }
+            else if(ir_led<150000 && calR->ir_idac > 0)
+            {
+                calR->ir_idac = calR->ir_idac-1;
+            }
+
+            if(green_led<350000 && green_led>150000 && ir_led<350000 && ir_led>150000 && r_led<350000 && r_led>150000)
+            {
+                calR->state = sCalFinish;
+            }
+            else if(calR->green_idac >= 200 || calR->ir_idac >= 200 || calR->red_idac >= 200)
+            {
+                calR->state = sCalFinish;
+            }
+            else
+            {
+                calR->state = sCalLed2;
+            }
+            calR->flag = CAL_FLG_LED_DAC;
+            break;
+
+        default:
+            break;
+    }
+    TYHX_LOG("AGC_after: green_cur=%d,red_cur=%d,ir_cur=%d,green_idac=%d,red_idac=%d,ir_idac=%d,green_step=%d,red_step=%d,ir_step=%d,state=%d\r\n",\
+             calR->green_cur,calR->red_cur,calR->ir_cur,calR->green_idac,calR->red_idac,calR->ir_idac,calR->green_led_step,calR->red_led_step,calR->ir_led_step,calR->state);
+}
+
+SPO2_CAL_SET_T PPG_spo2_agc(void)
+{
+    int32_t r_led_val;
+    int32_t amb_val;
+    int32_t ir_led_val;
+    int32_t green_led_val;
+
+    calReg.work = false;
+    if (!s_cal_state)
+    {
+        return calReg;
+    }
+
+    #ifdef INT_MODE
+    calReg.int_cnt ++;
+    if(calReg.int_cnt < 8)
+    {
+        return calReg;
+    }
+    calReg.int_cnt = 0;
+    hx3918_gpioint_cfg(false);
+    #endif
+
+    calReg.work = true;
+    read_data_packet(agc_buf);
+    amb_val = agc_buf[0];
+    green_led_val = agc_buf[2];
+    r_led_val = agc_buf[1];
+    ir_led_val = agc_buf[3];
+
+    TYHX_LOG("cal dat amb=%d,g=%d,r=%d,ir=%d\r\n", amb_val, green_led_val, r_led_val, ir_led_val);
+    PPG_Spo2_Calibration_Routine(&calReg, amb_val,green_led_val,r_led_val,ir_led_val);
+
+    if (calReg.state == sCalFinish)
+    {
+        hx3918_spo2_set_mode(CAL_OFF);
+    }
+    else
+    {
+        hx3918_spo2_updata_reg();
+    }
+    #if defined(INT_MODE)
+    hx3918_gpioint_cfg(true);
+    #endif
+    return  calReg;
+}
+
+
+void hx3918_spo2_cal_init(void) // 20200615 ericy afe cali offline
+{
+    uint16_t sample_rate = 100;                      /*config the data rate of chip alps2_fm ,uint is Hz*/
+    uint32_t prf_clk_num = 32000/sample_rate;        /*period in clk num, num = Fclk/fs */
+    uint8_t thres_int =0;    //thres int enable
+    uint8_t data_rdy_int =8;    //[3]:ps1_data2 [2]:ps1_data1 [1]:ps0_data2 [0]:ps0_data1
+
+    hx3918_write_reg(0X18, (uint8_t)prf_clk_num);    // prf bit<7:0>6   default 0x00
+    hx3918_write_reg(0X19, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>  default 0x03
+    hx3918_write_reg(0x3d,0x00);     //bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;0011=p4;bits<7> fifo enble
+    hx3918_write_reg(0X36, (thres_int<<4|data_rdy_int));   //default 0x0f
+
+    hx3918_write_reg(0X4d, 0X01);  //soft reset
+    hx3918_delay(5);
+    hx3918_write_reg(0X4d, 0X00);  //release
+    hx3918_delay(5);             //Delay for reset time
+  
+}
+
+void hx3918_spo2_cal_off(void) // 20200615 ericy afe cali offline
+{
+    uint16_t sample_rate = 25;                      /*config the data rate of chip alps2_fm ,uint is Hz*/
+    uint32_t prf_clk_num = 32000/sample_rate;        /*period in clk num, num = Fclk/fs */
+
+    hx3918_write_reg(0X18, (uint8_t)prf_clk_num);    // prf bit<7:0>6   default 0x00
+    hx3918_write_reg(0X19, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>  default 0x03
+    hx3918_write_reg(0x3d,0x80);     //bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;0011=p4;bits<7> fifo enble
+
+    hx3918_write_reg(0X4d, 0X01);  //soft reset
+    hx3918_delay(5);
+    hx3918_write_reg(0X4d, 0X00);  //release
+    hx3918_delay(5);             //Delay for reset time
+    #if DEBUG_PPG_ONLY
+     hx3918_prox_init();
+    #endif
+    read_fifo_first_flg = 1;
+}
+
+void hx3918_spo2_read_data(int32_t *buf) // 20200615 ericy read reg_data phase1 and phase3
+{
+    uint8_t  databuf1[6] = {0};
+    uint8_t  databuf2[6] = {0};
+    uint32_t P1 = 0,P2 = 0,P3 = 0,P4 =0 ;
+
+    hx3918_brust_read_reg(0x03, databuf1, 6);
+    hx3918_brust_read_reg(0x09, databuf2, 6);
+
+    P1 = ((databuf1[0])|(databuf1[1]<<8)|(databuf1[2]<<16));
+    P3 = ((databuf1[3])|(databuf1[4]<<8)|(databuf1[5]<<16));
+    P4 = ((databuf2[0])|(databuf2[1]<<8)|(databuf2[2]<<16));
+    P2 = ((databuf2[3])|(databuf2[4]<<8)|(databuf2[5]<<16));
+
+    buf[0] = P1;
+    buf[1] = P2;
+    buf[2] = P3;
+    buf[3] = P4;
+}
+
+void hx3918_spo2_low_power(void)
+{
+    uint16_t sample_rate = 10;                  /*config the data rate of chip alps2_fm ,uint is Hz*/
+    uint32_t prf_clk_num = 32000/sample_rate;   /*period in clk num, num = Fclk/fs */
+
+    uint8_t ps3_cp_avg_num_sel= 0;
+    uint8_t ps2_cp_avg_num_sel= 0;
+    uint8_t ps1_cp_avg_num_sel= 0;
+    uint8_t ps0_cp_avg_num_sel= 0;
+
+    uint8_t ps3_avg_num_sel_i2c=0;
+    uint8_t ps2_avg_num_sel_i2c=0;
+    uint8_t ps1_avg_num_sel_i2c=0;
+    uint8_t ps0_avg_num_sel_i2c=0;
+
+    uint8_t ps0_led_en_i2c=0;
+    uint8_t ps1_led_en_i2c=0;
+    uint8_t ps2_led_en_i2c=0;
+    uint8_t ps3_led_en_i2c=1;
+
+    uint8_t dccancel_ps0 =0;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps1 =0;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps2 =0;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+    uint8_t dccancel_ps3 =0;    //offset idac   BIT[9:0]  0 31.25nA, 1023 32uA, step 31.25nA
+
+    uint8_t leddrive_ps0 =0;     //LEDDRIVE_PS0  0~255 = 0~200ma
+    uint8_t leddrive_ps1 =0;     //LEDDRIVE_PS1  0~255 = 0~200ma
+    uint8_t leddrive_ps2 =0;     //LEDDRIVE_PS2  0~255 = 0~200ma
+    uint8_t leddrive_ps3 =64;     //LEDDRIVE_PS3  0~255 = 0~200ma
+
+    uint8_t ps0_led_on_time=64;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+    uint8_t ps1_led_on_time=0;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+    uint8_t ps2_led_on_time=0;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+    uint8_t ps3_led_on_time=64;    /* 0 = 32clk2=8us ; 8 = 64clk=16us; 16=128clk=32us ; 32 = 256clk=64us ;
+                                     64 = 512clk=128us ; 128= 1024clk=256us; 256= 2048clk=512us*/
+
+    hx3918_write_reg(0X18, (uint8_t)prf_clk_num);    // prf bit<7:0>6   default 0x00
+    hx3918_write_reg(0X19, (uint8_t)(prf_clk_num>>8)); // prf bit<11:8>  default 0x03
+
+    hx3918_write_reg(0X1c, ps0_led_on_time);
+    hx3918_write_reg(0X1d, ps1_led_on_time);
+    hx3918_write_reg(0X1e, ps2_led_on_time); 
+    hx3918_write_reg(0X1f, ps3_led_on_time);
+    hx3918_write_reg(0X20, (ps3_cp_avg_num_sel<<6|ps2_cp_avg_num_sel<<4|ps1_cp_avg_num_sel<<2|ps0_cp_avg_num_sel) );
+    hx3918_write_reg(0X21, (ps3_avg_num_sel_i2c<<6|ps2_avg_num_sel_i2c<<4|ps1_avg_num_sel_i2c<<2|ps0_avg_num_sel_i2c));
+    hx3918_write_reg(0X23, (ps0_led_en_i2c<<7|ps1_led_en_i2c<<6|ps2_led_en_i2c<<5|ps3_led_en_i2c<<4|0x0f));
+    hx3918_write_reg(0X26, leddrive_ps0);
+    hx3918_write_reg(0X27, leddrive_ps1);
+    hx3918_write_reg(0X28, leddrive_ps2);
+    hx3918_write_reg(0X29, leddrive_ps3);
+    hx3918_write_reg(0X2c, dccancel_ps0);
+    hx3918_write_reg(0X2d, dccancel_ps1);
+    hx3918_write_reg(0X2e, dccancel_ps2);
+    hx3918_write_reg(0X2f, dccancel_ps3);
+
+    hx3918_write_reg(0X4d, 0X01);  //soft reset
+    hx3918_delay(5);
+    hx3918_write_reg(0X4d, 0X00);  //release
+    hx3918_delay(5);
+    #if DEBUG_PPG_ONLY
+        hx3918_prox_init();
+    #endif
+    read_fifo_first_flg = 1;
+    AGC_LOG(" chip go to low power mode  \r\n" );
+}
+
+void hx3918_spo2_updata_reg(void)
+{
+    if (calReg.flag & CAL_FLG_LED_DR)
+    {
+        hx3918_write_reg(0X28, calReg.green_cur);
+        hx3918_write_reg(0X27, calReg.red_cur);
+        hx3918_write_reg(0X29, calReg.ir_cur);
+    }
+
+    if (calReg.flag & CAL_FLG_LED_DAC)
+    {
+        hx3918_write_reg(0X2e, (uint8_t)calReg.green_idac);
+        hx3918_write_reg(0X2d, (uint8_t)calReg.red_idac);
+        hx3918_write_reg(0X2f, (uint8_t)calReg.ir_idac);
+    }
+
+    if (calReg.flag & CAL_FLG_AMB_DAC)
+    {
+        hx3918_write_reg(0X2c, (uint8_t)calReg.amb_idac);
+    }
+
+    if (calReg.flag & CAL_FLG_RF)
+    {
+        hx3918_write_reg(0X1c, calReg.ontime); //3918 p1
+        hx3918_write_reg(0X1d, calReg.ontime); //3918 p1
+        hx3918_write_reg(0X1e, calReg.ontime); //3918 p2
+        hx3918_write_reg(0X1f, calReg.ontime); //3918 p3
+    }
+    hx3918_delay(10);
+}
+void hx3918_spo2_set_mode(uint8_t mode_cmd)
+{
+    switch (mode_cmd)
+    {
+        case PPG_INIT:
+            hx3918_spo2_ppg_init();
+            #if defined(TIMMER_MODE)
+            hx3918_ppg_timer_cfg(true);
+            #else
+            hx3918_gpioint_cfg(true);
+            #endif
+            s_ppg_state = 1;
+            AGC_LOG("ppg init mode\r\n");
+            break;
+
+        case PPG_OFF:
+            hx3918_ppg_off();
+            s_ppg_state = 0;
+            AGC_LOG("ppg off mode\r\n");
+            break;
+
+        case PPG_LED_OFF:
+            hx3918_spo2_low_power();
+            s_ppg_state = 0;
+            AGC_LOG("ppg led off mode\r\n");
+            break;
+
+        case CAL_INIT:
+            Init_Spo2_PPG_Calibration_Routine(&calReg);
+            hx3918_spo2_cal_init();
+            hx3918_spo2_updata_reg();
+            #if defined(TIMMER_MODE)
+            hx3918_agc_timer_cfg(true);
+            #endif
+            s_cal_state = 1;
+            AGC_LOG("cal init mode\r\n");
+            break;
+
+        case RECAL_INIT:
+            Restart_Spo2_PPG_Calibration_Routine(&calReg);
+            hx3918_spo2_cal_init();
+            hx3918_spo2_updata_reg();
+            #if defined(TIMMER_MODE)
+            hx3918_agc_timer_cfg(true);
+            #endif
+            s_cal_state = 1;
+            AGC_LOG("recal init mode\r\n");
+            break;
+
+        case CAL_OFF:
+            #if defined(TIMMER_MODE)
+            hx3918_agc_timer_cfg(false);
+            #endif
+            hx3918_spo2_cal_off();
+            s_cal_state = 0;
+            AGC_LOG("cal off mode\r\n");
+            break;
+
+        default:
+            break;
+    }
+}
+
+SENSOR_ERROR_T hx3918_spo2_enable(void)
+{
+    if (!hx3918_chip_check())
+    {
+        AGC_LOG("hx3690l check id failed!\r\n");
+        return SENSOR_OP_FAILED;
+    }
+    TYHX_LOG("hx3690l check id success!\r\n");
+
+    if (s_ppg_state)
+    {
+        AGC_LOG("ppg already on!\r\n");
+        return SENSOR_OP_FAILED;
+    }
+    
+    if(!tyhx_spo2_alg_open())
+    {
+        AGC_LOG("spo2 alg open fail,or dynamic ram not enough!\r\n");
+        return SENSOR_OP_FAILED;
+    }
+    spo2_wear_status = MSG_SPO2_INIT;
+    spo2_wear_status_pre = MSG_SPO2_INIT;
+    hx3918_spo2_set_mode(PPG_INIT);
+    AGC_LOG("hx3690l enable!\r\n");
+
+    return SENSOR_OK;
+}
+
+void hx3918_spo2_disable(void)
+{
+    #if defined(TIMMER_MODE)
+    hx3918_ppg_timer_cfg(false);
+    hx3918_agc_timer_cfg(false);
+    #elif defined(INT_MODE)
+    hx3918_gpioint_cfg(false);
+    #endif
+    hx3918_spo2_set_mode(PPG_OFF);
+    s_ppg_state = 0;
+    s_cal_state = 0;
+    tyhx_spo2_alg_close();
+    AGC_LOG("hx3690l disable!\r\n");
+}
+
+void hx3918_spo2_data_reset(void)
+{
+    s_ppg_state = 0;
+    s_cal_state = 0;
+    tyhx_spo2_alg_close();
+}
+
+hx3918_spo2_wear_msg_code_t hx3918_spo2_get_wear_status(void)
+{
+    return  spo2_wear_status;
+}
+
+SPO2_CAL_SET_T get_spo2_agc_status(void)
+{
+    SPO2_CAL_SET_T cal;
+    cal.flag = calReg.flag;
+    cal.int_cnt = calReg.int_cnt;
+    cal.green_cur = calReg.green_cur;
+    cal.red_cur = calReg.red_cur;
+    cal.ir_cur = calReg.ir_cur;
+    cal.green_idac = calReg.green_idac;
+    cal.red_idac = calReg.red_idac;
+    cal.ir_idac = calReg.ir_idac;
+    cal.amb_idac = calReg.amb_idac;
+    cal.ontime = calReg.ontime;
+    cal.green_led_step = calReg.green_led_step;
+    cal.red_led_step = calReg.red_led_step;
+    cal.ir_led_step = calReg.ir_led_step;
+    cal.state = calReg.state;
+    return cal;
+}
+
+uint8_t hx3918_spo2_read(ppg_sensor_data_t * s_dat)
+{
+    int32_t Red_src_data;
+    int32_t Ir_src_data;
+    int32_t Green_src_data;
+    int32_t Amb_data;
+    bool recal = false;
+    int32_t *green_buf = &(s_dat->green_data[0]);
+    int32_t *red_buf =  &(s_dat->red_data[0]);
+    int32_t *ir_buf =  &(s_dat->ir_data[0]);
+    int32_t *s_buf =  &(s_dat->s_buf[0]);
+    //int32_t *sar_lp_data  = &s_dat->sar_data;
+    s_dat->green_cur = calReg.green_cur;
+    s_dat->red_cur =  calReg.red_cur;
+    s_dat->ir_cur =  calReg.ir_cur;
+    uint8_t data_count = 0;
+    if (!s_ppg_state || s_cal_state)
+    {
+        return NULL;
+    }
+    data_count = hx3918_read_fifo_data(s_buf,4,1);
+    //*sar_lp_data = hx3918_read_sar_data();
+    s_dat->count =  data_count;
+       TYHX_LOG("\r\n spo2  ir data:   ");
+    for (uint8_t i=0; i<data_count; i++)
+    {
+        Amb_data = s_buf[i*4];
+        Green_src_data = s_buf[i*4+2];
+        Red_src_data = s_buf[i*4+1];
+        Ir_src_data = s_buf[i*4+3];
+
+        green_buf[i] = Green_src_data-260000;
+        red_buf[i] = Red_src_data-260000;
+        ir_buf[i] = Ir_src_data-260000;
+        if(spo2_wear_status==MSG_SPO2_WEAR)
+        {        
+                       TYHX_LOG("spo2  unwear data %d\r\n:     ",calReg.ir_idac);
+            if(hx3918_spo2_check_unwear())
+            {
+                return NULL;
+            }
+        }
+        else
+        {
+               TYHX_LOG("spo2  check wear data %d\r\n: ",Ir_src_data-Amb_data);
+            if(hx3918_spo2_check_wear(Ir_src_data-Amb_data))
+            {
+                return NULL;
+            }
+        }
+        
+        if (Green_src_data<100000 || Green_src_data>400000 || Red_src_data<100000 || Red_src_data>400000 || Ir_src_data<100000 || Ir_src_data>400000)
+        {
+            recal = true;
+            if(spo2_wear_status==MSG_SPO2_NO_WEAR)
+            {
+                recal = false;
+            }
+        }
+    }
+       TYHX_LOG("\r\n");
+    if (recal)
+    {
+        cal_delay--;
+        if (cal_delay <= 0)
+        {
+            cal_delay = CAL_DELAY_COUNT;
+            hx3918_spo2_set_mode(RECAL_INIT);
+        }
+    }
+    else
+    {
+        cal_delay = CAL_DELAY_COUNT;
+    }
+    return 1;
+}
+
+#ifdef SPO2_DATA_CALI
+static int32_t red_data_fifo[4] = {0};
+static int32_t ir_data_fifo[4] = {0};
+static int32_t red_dc_temp = 0;
+static int32_t ir_dc_temp = 0;
+static int32_t red_data_pre = 0;
+static int32_t ir_data_pre = 0;
+static int32_t red_jump_delta = 0;
+static int32_t ir_jump_delta = 0;
+static int32_t cali_data_cnt = 0;
+
+void hx3918_spo2_data_cali_init(void)
+{
+    int ii=0;
+    for(ii=0; ii<4; ii++)
+    {
+        red_data_fifo[ii] = 0;
+        ir_data_fifo[ii] = 0;
+    }
+    red_dc_temp = 0;
+    ir_dc_temp = 0;
+    red_data_pre = 0;
+    ir_data_pre = 0;
+    red_jump_delta = 0;
+    ir_jump_delta = 0;
+    cali_data_cnt = 0;
+}
+
+int32_t hx3918_red_data_cali(int32_t red_new_raw_data)
+{
+    uint8_t ii;
+    int32_t red_data_final;
+    int32_t red_data_cali;
+    hx3918_spo2_wear_msg_code_t touch_status;
+    touch_status = hx3918_spo2_get_wear_status();
+    if(touch_status == MSG_SPO2_NO_WEAR)
+    {
+        cali_data_cnt = 0;
+        red_data_cali = red_new_raw_data;
+        for(ii=0; ii<4; ii++)
+        {
+            red_data_fifo[ii] = 0;
+        }
+        red_dc_temp = 0;
+    }
+    else
+    {
+        for(ii=3; ii>0; ii--)
+        {
+            red_data_fifo[ii] = red_data_fifo[ii-1];
+        }
+        red_data_fifo[0] = red_new_raw_data;
+        if(cali_data_cnt>=25)
+        {
+            if ((((red_data_fifo[1] - red_data_fifo[2]) > SOP2_DEGLITCH_THRE) && ((red_data_fifo[1] - red_new_raw_data) > SOP2_DEGLITCH_THRE)) || \
+                    (((red_data_fifo[1] - red_data_fifo[2]) < -SOP2_DEGLITCH_THRE) && ((red_data_fifo[1] - red_new_raw_data) < -SOP2_DEGLITCH_THRE)))
+            {
+                red_new_raw_data = red_data_fifo[2];
+                red_data_fifo[1] = red_data_fifo[2];
+            }
+            else
+            {
+                red_new_raw_data = red_data_fifo[1];
+            }
+            if ((abs((red_new_raw_data - red_jump_delta) - red_data_pre) > SPO2_REMOVE_JUMP_THRE))
+            {
+                red_jump_delta = red_new_raw_data - red_data_pre;
+            }
+            red_data_cali = red_new_raw_data - red_jump_delta;
+            red_data_pre = red_data_cali;
+        }
+        else
+        {
+            red_data_cali = red_data_fifo[1];
+            red_data_pre = red_data_fifo[1];
+        }
+    }
+    if(cali_data_cnt<=30)
+    {
+        red_dc_temp = red_data_cali;
+        red_data_final = red_new_raw_data;
+    }
+    else
+    {
+        red_dc_temp = (red_dc_temp*31 + red_data_cali)>>5;
+        red_data_final = red_data_cali - red_dc_temp + 2608*50*hx3918_spo2_agc_red_idac;
+    }
+    return red_data_final;
+}
+int32_t hx3918_ir_data_cali(int32_t ir_new_raw_data)
+{
+    uint8_t ii;
+    int32_t ir_data_final;
+    int32_t ir_data_cali;
+    hx3918_spo2_wear_msg_code_t touch_status;
+    touch_status = hx3918_spo2_get_wear_status();
+    if(touch_status == MSG_SPO2_NO_WEAR)
+    {
+        cali_data_cnt = 0;
+        ir_data_cali = ir_new_raw_data;
+        for(ii=0; ii<4; ii++)
+        {
+            ir_data_fifo[ii] = 0;
+        }
+        ir_dc_temp = 0;
+    }
+    else
+    {
+        for(ii=3; ii>0; ii--)
+        {
+            ir_data_fifo[ii] = ir_data_fifo[ii-1];
+        }
+        ir_data_fifo[0] = ir_new_raw_data;
+        cali_data_cnt++;
+        if(cali_data_cnt>=25)
+        {
+            if ((((ir_data_fifo[1] - ir_data_fifo[2]) > SOP2_DEGLITCH_THRE) && ((ir_data_fifo[1] - ir_new_raw_data) > SOP2_DEGLITCH_THRE)) || \
+                    (((ir_data_fifo[1] - ir_data_fifo[2]) < -SOP2_DEGLITCH_THRE) && ((ir_data_fifo[1] - ir_new_raw_data) < -SOP2_DEGLITCH_THRE)))
+            {
+                ir_new_raw_data = ir_data_fifo[2];
+                ir_data_fifo[1] = ir_data_fifo[2];
+            }
+            else
+            {
+                ir_new_raw_data = ir_data_fifo[1];
+            }
+            if ((abs((ir_new_raw_data - ir_jump_delta) - ir_data_pre) > SPO2_REMOVE_JUMP_THRE))
+            {
+                ir_jump_delta = ir_new_raw_data - ir_data_pre;
+            }
+            ir_data_cali = ir_new_raw_data - ir_jump_delta;
+            ir_data_pre = ir_data_cali;
+        }
+        else
+        {
+            ir_data_cali = ir_data_fifo[1];
+            ir_data_pre = ir_data_fifo[1];
+        }
+    }
+    if(cali_data_cnt<=30)
+    {
+        ir_dc_temp = ir_data_cali;
+        ir_data_final = ir_new_raw_data;
+    }
+    else
+    {
+        ir_dc_temp = (ir_dc_temp*31 + ir_data_cali)>>5;
+        ir_data_final = ir_data_cali - ir_dc_temp + 2608*50*hx3918_spo2_agc_ir_idac;
+    }
+    return ir_data_final;
+}
+#endif
+
+#endif
diff --git a/2.sdk/Helios_SDK/components/HX3918/hx3918_spo2_agc.h b/2.sdk/Helios_SDK/components/HX3918/hx3918_spo2_agc.h
new file mode 100644 (file)
index 0000000..04f0c8a
--- /dev/null
@@ -0,0 +1,90 @@
+#ifndef _HX3918_SPO2_AGC_H_
+#define _HX3918_SPO2_AGC_H_
+#include <stdint.h>
+#include <stdbool.h>
+#include "hx3918.h"
+
+#define CAL_DELAY_COUNT (3)
+
+#define CAL_FLG_LED_DR     0x01
+#define CAL_FLG_LED_DAC    0x02 
+#define CAL_FLG_AMB_DAC    0x04
+#define CAL_FLG_RF         0x08
+
+#define SPO2_CAL_INIT_LED_GREEN 64
+#define SPO2_CAL_INIT_LED_RED 64
+#define SPO2_CAL_INIT_LED_IR 64
+
+
+typedef enum {    
+    sCalStart,
+       sCalLedCur,     
+    sCalLed,
+    sCalLed2,
+    sCalFinish, 
+} SPO2_STATE_T;
+
+typedef enum {
+       MSG_SPO2_NO_WEAR,
+       MSG_SPO2_WEAR,
+       MSG_SPO2_INIT
+} hx3918_spo2_wear_msg_code_t;
+
+typedef struct {
+  uint8_t                 red_offset_idac;
+  uint8_t                 ir_offset_idac; 
+  uint8_t                 green_offset_idac; 
+  uint16_t                spo2_start_cnt;
+} hx3918_spo2_agcpara_t;
+
+typedef struct {
+       uint8_t flag;
+       bool work;
+       uint8_t int_cnt;
+       uint8_t cur255_cnt;
+       uint8_t green_idac;
+       uint8_t red_idac;
+       uint8_t ir_idac;
+       uint8_t amb_idac;
+       uint16_t green_cur; 
+       uint16_t red_cur;     
+       uint16_t ir_cur;       
+       uint8_t ontime;
+       uint32_t green_led_step;
+       uint32_t red_led_step;
+       uint32_t ir_led_step;
+       uint8_t state;
+       uint8_t green_max_cur;
+       uint8_t red_max_cur;
+       uint8_t ir_max_cur;
+} SPO2_CAL_SET_T;
+
+
+void Init_Spo2_PPG_Calibration_Routine(SPO2_CAL_SET_T *calR);  
+void Restart_spo2_PPG_Calibration_Routine(SPO2_CAL_SET_T *calR);
+void PPG_Spo2_Calibration_Routine(SPO2_CAL_SET_T *calR, int32_t amb, int32_t green_led, int32_t r_led, int32_t ir_led);
+SPO2_CAL_SET_T PPG_spo2_agc(void);
+
+void hx3918_spo2_cal_init(void);
+void hx3918_spo2_cal_off(void);
+
+void read_spo2_data_packet(int32_t *buf);
+void read_spo2_ir_packet(int32_t *buf);
+void hx3918_spo2_read_data(int32_t *buf);
+
+void hx3918_spo2_low_power(void);
+void hx3918_spo2_normal_power(void);
+
+void hx3918_spo2_updata_reg(void);
+void hx3918_spo2_set_mode(uint8_t mode_cmd);
+SENSOR_ERROR_T hx3918_spo2_enable(void);
+void hx3918_spo2_disable(void);
+hx3918_spo2_wear_msg_code_t hx3918_spo2_get_wear_status(void);
+uint8_t hx3918_spo2_read(ppg_sensor_data_t * s_dat);
+uint8_t hx3918_spo2_read_data_packet(int32_t *s_buf);
+bool hx3918_spo2_check_unwear(void);
+bool hx3918_spo2_check_wear(int32_t infrared_data);
+SPO2_CAL_SET_T get_spo2_agc_status(void);
+void hx3918_spo2_data_reset(void);
+
+#endif
diff --git a/2.sdk/Helios_SDK/components/HX3918/lib/gcc_3918lib_hrs_spo2_20230731_v0.1.a b/2.sdk/Helios_SDK/components/HX3918/lib/gcc_3918lib_hrs_spo2_20230731_v0.1.a
new file mode 100644 (file)
index 0000000..c67d00b
Binary files /dev/null and b/2.sdk/Helios_SDK/components/HX3918/lib/gcc_3918lib_hrs_spo2_20230731_v0.1.a differ
diff --git a/2.sdk/Helios_SDK/components/HX3918/tyhx_hrs_alg.h b/2.sdk/Helios_SDK/components/HX3918/tyhx_hrs_alg.h
new file mode 100644 (file)
index 0000000..7aea5f9
--- /dev/null
@@ -0,0 +1,117 @@
+#ifndef _TYHX_HRS_ALG_H_
+#define _TYHX_HRS_ALG_H_
+#endif
+
+#include <stdint.h>
+// /* portable 8-bit unsigned integer */
+// typedef unsigned char           uint8_t;
+// /* portable 8-bit signed integer */
+// typedef signed char             int8_t;
+// /* portable 16-bit unsigned integer */
+// typedef unsigned short int      uint16_t;
+// /* portable 16-bit signed integer */
+// typedef signed short int        int16_t;
+// /* portable 32-bit unsigned integer */
+// typedef unsigned int            uint32_t;
+// /* portable 32-bit signed integer */
+// typedef signed int              int32_t;
+
+#ifndef  bool
+#define  bool unsigned char
+#endif
+#ifndef  true
+#define  true  1
+#endif
+#ifndef  false
+#define  false  0
+#endif
+
+
+#ifdef HRS_ALG_LIB
+
+typedef enum {
+       NORMAL_MODE,
+       RIDE_MODE,
+       WALK_MODE,
+       JUMP_MODE,
+       ALLDAY_HR_MODE,
+       HIGH_POW_MODE
+} hrs_sports_mode_t;
+
+typedef enum {
+       MSG_HRS_ALG_NOT_OPEN,
+       MSG_HRS_ALG_OPEN,
+       MSG_HRS_READY,
+       MSG_HRS_ALG_TIMEOUT,
+} hrs_alg_msg_code_t;
+
+typedef enum {
+       MSG_LIVING_INITIAL,
+       MSG_LIVING_TRUE,
+       MSG_LIVING_FAIL
+} living_msg_code_t;
+
+typedef struct {
+       hrs_alg_msg_code_t  hrs_alg_status;
+    living_msg_code_t   living_status;
+       uint32_t            data_cnt;
+       uint8_t             hr_result;
+       uint16_t            cal_result;
+       uint8_t             hr_result_qual;
+    uint32_t            hr_result_std;
+} hrs_results_t;
+
+typedef struct {
+       uint32_t data_cnt;
+       uint8_t  motion_status;
+       uint32_t gsen_pow;
+       int8_t   up_clip;
+       int8_t   dn_clip;
+       uint8_t  runrun_cnt;
+} HRS_ALG_INFO_T;
+
+#ifdef BP_CUSTDOWN_ALG_LIB
+typedef enum {
+       MSG_BP_ALG_NOT_OPEN = 0x01,
+       MSG_BP_NO_TOUCH = 0x02,
+       MSG_BP_PPG_LEN_TOO_SHORT = 0x03,
+       MSG_BP_READY = 0x04,
+       MSG_BP_ALG_TIMEOUT = 0x05,
+       MSG_BP_SETTLE = 0x06
+} bp_msg_code_t;
+
+typedef struct {
+       uint8_t age;
+       uint8_t height;
+       uint8_t weight;
+       uint8_t gender;
+       uint8_t ref_sbp;
+       uint8_t ref_dbp;
+} bp_exinf_t;
+
+typedef struct {
+       bp_msg_code_t   bp_alg_status;
+       uint8_t         sbp;
+       uint8_t         dbp; 
+       uint32_t        data_cnt;
+       uint8_t         hr_result;
+       bool            object_flg;
+} bp_results_t;
+
+
+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);
+void tyhx_bp_age_fn(uint8_t hr_result, bp_exinf_t body_s);
+void tyhx_restart_bp_cal(void);
+bp_results_t tyhx_alg_get_bp_results(void);
+#endif //BP_CUSTDOWN_ALG_LIB
+
+bool tyhx_hrs_alg_open(void);
+bool tyhx_hrs_alg_open_deep(void);
+void tyhx_hrs_alg_close(void);
+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);
+bool tyhx_hrs_alg(int32_t new_raw_data, int16_t gsen_data_x, int16_t gsen_data_y, int16_t gsen_data_z);
+hrs_results_t tyhx_hrs_alg_get_results(void);
+void tyhx_hrs_set_alg_para(hrs_sports_mode_t sports_mode, uint16_t static_thre_val, uint8_t gsen_fun_lv_val);
+void tyhx_hrs_set_living(uint8_t mode, uint8_t qu_thre, uint8_t st_thre);
+HRS_ALG_INFO_T tyhx_get_hrs_alg_info(void);
+#endif //HRS_ALG_LIB
diff --git a/2.sdk/Helios_SDK/components/HX3918/tyhx_hrv_alg.h b/2.sdk/Helios_SDK/components/HX3918/tyhx_hrv_alg.h
new file mode 100644 (file)
index 0000000..37bd4d8
--- /dev/null
@@ -0,0 +1,64 @@
+#ifndef _TYHX_HRV_ALG_H_
+#define _TYHX_HRV_ALG_H_
+#endif
+       
+#include <stdint.h>
+
+// /* portable 8-bit unsigned integer */
+// typedef unsigned char           uint8_t;
+// /* portable 8-bit signed integer */
+// typedef signed char             int8_t;
+// /* portable 16-bit unsigned integer */
+// typedef unsigned short int      uint16_t;
+// /* portable 16-bit signed integer */
+// typedef signed short int        int16_t;
+// /* portable 32-bit unsigned integer */
+// typedef unsigned int            uint32_t;
+// /* portable 32-bit signed integer */
+// typedef signed int              int32_t;
+
+#ifndef  bool
+#define  bool unsigned char
+#endif
+#ifndef  true
+#define  true  1
+#endif
+#ifndef  false
+#define  false  0
+#endif
+
+#define HRV_GLITCH_THRES     20000 
+#define HRV_GSEN_POW_THRE    150
+
+#ifdef HRV_ALG_LIB
+
+typedef enum {
+    MSG_HRV_ALG_NOT_OPEN,
+    MSG_HRV_ALG_OPEN,
+    MSG_HRV_READY,
+    MSG_HRV_ALG_TIMEOUT,
+} hrv_alg_msg_code_t;
+
+typedef struct {
+    hrv_alg_msg_code_t  hrv_alg_status;
+    uint32_t    data_cnt;
+    uint8_t     hrv_result;
+    uint32_t    hrv_peak; 
+    uint8_t     spirit_pressure;
+    uint8_t     p_m;
+    uint8_t     screen_up;
+    uint8_t     motion;
+    uint8_t     signal_quality;
+} hrv_results_t;
+
+
+void tyhx_hrv_alg(int32_t new_raw_data);
+bool tyhx_hrv_alg_open(void);
+bool tyhx_hrv_alg_open_deep(void);
+void tyhx_hrv_alg_close(void);
+void kfft(double *pr,double *pi,int n,int k,double *fr,double *fi);
+
+hrv_results_t tyhx_hrv_alg_send_data(int32_t new_raw_data, int32_t green_data_als, int32_t infrared_data);
+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);
+#endif //HRV_ALG_LIB
+               
diff --git a/2.sdk/Helios_SDK/components/HX3918/tyhx_spo2_alg.h b/2.sdk/Helios_SDK/components/HX3918/tyhx_spo2_alg.h
new file mode 100644 (file)
index 0000000..dfe662a
--- /dev/null
@@ -0,0 +1,164 @@
+#ifndef _SPO2_ALG_H_
+#define _SPO2_ALG_H_
+#endif
+#include <stdint.h>
+
+//version:3.3.17
+
+//#include "tyhx_spo2_alg_para.h"
+
+
+// /* portable 8-bit unsigned integer */
+// typedef unsigned char           uint8_t;
+// /* portable 8-bit signed integer */
+// typedef signed char             int8_t;
+// /* portable 16-bit unsigned integer */
+// typedef unsigned short int      uint16_t;
+// /* portable 16-bit signed integer */
+// typedef signed short int        int16_t;
+// /* portable 32-bit unsigned integer */
+// typedef unsigned int            uint32_t;
+// /* portable 32-bit signed integer */
+// typedef signed int              int32_t;
+
+#ifndef bool
+#define bool unsigned char
+#endif
+
+#ifndef  true
+#define  true  1
+#endif
+#ifndef  false
+#define  false  0
+#endif
+
+
+#ifdef SPO2_ALG_LIB
+
+typedef enum {
+       MSG_SPO2_ALG_NOT_OPEN,
+       MSG_SPO2_ALG_OPEN,
+       MSG_SPO2_READY,
+       MSG_SPO2_ALG_TIMEOUT,
+    MSG_SPO2_END
+} spo2_alg_msg_code_t;
+
+typedef enum {
+       MSG_SPO2_LIVING_INITIAL,
+       MSG_SPO2_LIVING_TRUE,
+       MSG_SPO2_LIVING_FAIL
+} spo2_living_code_t;
+
+typedef enum {
+       SPO2_NORMAL_MODE,
+       SPO2_ALLDAY_MODE
+} spo2_mode_t;
+
+typedef struct {
+    spo2_alg_msg_code_t                spo2_alg_status;
+    spo2_living_code_t      spo2_living_status;
+    uint32_t           data_cnt;
+    uint8_t                    spo2_result;
+    uint8_t                    hr_result;
+    uint8_t                    block_cnt;
+    uint8_t                    ir_quality;
+    uint16_t           reliable_score_result;
+
+    uint8_t                    screen_up;
+    uint8_t                    motion;
+    uint8_t                    poor_signal;
+    
+    uint8_t         signal_snr;
+    uint32_t        signal_std;
+    
+} spo2_results_t;
+
+typedef struct {
+    uint8_t                    screen_up;
+    uint8_t                    motion;
+    uint8_t                    poor_signal;
+} spo2_gesture_recognize_t;
+
+typedef struct {
+       uint32_t data_cnt;
+       int32_t red_new_raw_data;
+       int32_t ir_new_raw_data;
+       int32_t green_new_raw_data;
+       int32_t ir_iir_data_filter_out;
+       int32_t ir_data_smooth;
+       int32_t red_iir_data_filter_out;
+       int32_t red_data_smooth;
+       uint8_t ir_offset_50;
+       uint8_t red_offset_50;
+       uint8_t green_offset_50;
+       int32_t ir_dc;
+       int32_t red_dc;
+       int32_t green_dc;
+       int32_t ir_data_o2_128;
+       int32_t red_data_o2_128;
+       int32_t green_data_o2_128;
+       int16_t red_ir_dc;
+       int16_t red_green_dc;
+       int16_t ir_green_dc;
+       int16_t ir_fft_snr;
+       int8_t  motion_status;
+       uint8_t xcorr_max;
+       int16_t COUNT_IN_judge;
+       uint8_t spo2_result;
+       uint8_t count_block;
+       int32_t SaO2_data_temp;
+} spo2_debug_t;
+
+typedef struct {
+         uint8_t       red_offset_idac;
+         uint8_t       ir_offset_idac; 
+         uint8_t       green_offset_idac; 
+         uint16_t      spo2_start_cnt;
+} spo2_agcpara_t;
+
+typedef struct {
+       uint8_t XCORR_MODE;
+       uint8_t QUICK_RESULT;
+} spo2_switch_t;
+
+typedef struct {
+       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;
+} spo2_usuallyadjust_t;
+
+typedef struct {
+       uint16_t MEAN_NUM;
+       int32_t  SOP2_DEGLITCH_THRE;
+       int32_t  SPO2_REMOVE_JUMP_THRE;
+       uint16_t SPO2_LOW_CLIP_END_TIME;
+       uint16_t SPO2_LOW_CLIP_DN;
+       uint16_t SPO2_NORMAL_CLIP_DN;
+       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;
+} spo2_barelychange_t;
+
+void tyhx_spo2_set_switch(uint8_t XCORR_MODE,uint8_t QUICK_RESULT);
+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);
+void tyhx_spo2_para_barelychange(uint16_t MEAN_NUM,int32_t SOP2_DEGLITCH_THRE,int32_t SPO2_REMOVE_JUMP_THRE, \
+                                   uint16_t SPO2_LOW_CLIP_END_TIME,uint16_t SPO2_LOW_CLIP_DN,uint16_t SPO2_NORMAL_CLIP_DN, \
+                                   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);
+
+void tyhx_spo2_set_living(uint8_t living_mode, uint8_t qu_thre, uint8_t st_thre);
+void tyhx_spo2_set_mode(spo2_mode_t mode);
+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);
+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);
+void tyhx_spo2_alg_close(void);
+bool tyhx_spo2_alg_open(void);
+bool tyhx_spo2_alg_open_deep(void);
+spo2_results_t tyhx_spo2_alg_get_results(void);
+spo2_debug_t tyhx_spo2_alg_debug_results(void);
+
+#endif 
+
index 54bb972..1f69028 100644 (file)
 
 /*Default Dot Per Inch. Used to initialize default sizes such as widgets sized, style paddings.
  *(Not so important, you can adjust it to modify default sizes and spaces)*/
-#define LV_DPI_DEF                  130     /*[px/inch]*/
+#define LV_DPI_DEF                  89     /*[px/inch]*/
 
 /*=======================
  * FEATURE CONFIGURATION
index 5bbcf53..450ad9c 100644 (file)
@@ -42,10 +42,10 @@ extern "C" {
 
 
 /*Gesture threshold in pixels*/
-#define LV_INDEV_DEF_GESTURE_LIMIT        50
+#define LV_INDEV_DEF_GESTURE_LIMIT        20
 
 /*Gesture min velocity at release before swipe (pixels)*/
-#define LV_INDEV_DEF_GESTURE_MIN_VELOCITY 3
+#define LV_INDEV_DEF_GESTURE_MIN_VELOCITY 2
 
 
 /**********************
index 72a23da..72b8458 100644 (file)
@@ -261,6 +261,7 @@ QPY_SRCS = \
         ports/quectel/core/source/modGsensor_SC7A20.c \
         ports/quectel/core/source/modHsensor.c \
         ports/quectel/core/source/modHsensor_GH3018.c \
+        ports/quectel/core/source/modHsensor_HX3918.c \
         ports/quectel/core/source/modrsa.c \
         ports/quectel/core/source/utils_crc32.c \
         ports/quectel/core/source/modwebserver.c \
@@ -680,6 +681,9 @@ ifeq ($(CONFIG_QRCODE), y)
 $(NAME)_COMPONENTS += components/qrcode
 endif
 
+ifeq ($(CONFIG_HX3918), y)
+$(NAME)_COMPONENTS += components/HX3918
+endif
 ifeq ($(CONFIG_GH301x), y)
 $(NAME)_COMPONENTS += components/GH301X
 endif
index 21ec318..4123890 100644 (file)
 
 #include "pyexec.h"
 #include "mphalport.h"
-
-#if 1 //MICROPY_QPY_Hsensor_GH3018
-
-extern const mp_obj_type_t Hsensor_GH3018_type;
-
+#include "autoconf.h"
+#if 1 //
 
 
 
+#if CONFIG_GH301x
+extern const mp_obj_type_t Hsensor_GH3018_type;
+extern void GH3018_thread_do(void);
+#endif
+#if CONFIG_HX3918
+extern const mp_obj_type_t Hsensor_HX3918_type;
+extern void HX3918_thread_do(void);
+#endif
+void sensor_thread_entry(void * argv)
+{
+       //GH3018_LOG("sensor_thread_entry: 11111111!!!!!!!!\r\n");
+       
+       #if CONFIG_GH301x || CONFIG_HX3918
+       while(1)
+       {       
+               #if CONFIG_GH301x
+               GH3018_thread_do();
+               #endif
+               #if CONFIG_HX3918
+               HX3918_thread_do();
+               #endif
+       }
+       #else
+       while(1)
+       {
+               #if CONFIG_SC7A20
+               SL_SC7A20_PEDO_KCAL_WRIST_SLEEP_SWAY_L_ALGO();
+               #endif
+               Helios_msleep(1000);
+               
+       }
+       #endif
+       
+}
+Helios_Thread_t sensor_thread_id = 0;
+void sensor_thread_entry(void * argv);
+Helios_ThreadAttr ThreadAttr = {
+        .name = "HealthSensor",
+        .stack_size = 1024*20,
+        .priority = 100,
+        .entry = sensor_thread_entry,
+        .argv = NULL
+    };
 STATIC const mp_rom_map_elem_t Hsensor_module_globals_table[] = {
        { MP_OBJ_NEW_QSTR(MP_QSTR___name__), MP_ROM_QSTR(MP_QSTR_Hsensor) },
 
 #if CONFIG_GH301x
        { MP_ROM_QSTR(MP_QSTR_GH3018), MP_ROM_PTR(&Hsensor_GH3018_type) },
+#endif
+#if CONFIG_HX3918
+       { MP_ROM_QSTR(MP_QSTR_HX3918), MP_ROM_PTR(&Hsensor_HX3918_type) },
 #endif
        //TODO add other deriver
 };
index 08e1903..19595de 100644 (file)
 #include "binary.h"
 
 #include <string.h>
-Helios_Thread_t sensor_thread_id = 0;
-void sensor_thread_entry(void * argv);
-Helios_ThreadAttr ThreadAttr = {
-        .name = "HealthSensor",
-        .stack_size = 1024*20,
-        .priority = 100,
-        .entry = sensor_thread_entry,
-        .argv = NULL
-    };
+#include "autoconf.h"
 #if CONFIG_GH301x
 
 #include "helios_gpio.h"
@@ -41,8 +33,11 @@ Helios_ThreadAttr ThreadAttr = {
 
 #include "helios_debug.h"
 #include "gh3011_example.h"
-#include "autoconf.h"
+
 #define GH3018_LOG(msg, ...)      custom_log("GH3018", msg, ##__VA_ARGS__)
+extern void sensor_thread_entry(void * argv);
+extern Helios_ThreadAttr ThreadAttr;
+extern Helios_Thread_t sensor_thread_id ;
 //////////////////////////////////////////////////////////////////////////////
 typedef struct _GH3018_obj_t
 {
@@ -56,8 +51,8 @@ typedef struct _GH3018_obj_t
 } GH3018_obj_t;
 
 STATIC GH3018_obj_t *g_GH3018 = NULL;
-static unsigned char is_gh3018 = 0;//是否存在IC
-static unsigned char is_open_gh3018 = 0; //是否打开测试
+unsigned char is_gh3018 = 0;//是否存在IC
+unsigned char is_open_gh3018 = 0; //是否打开测试
 static unsigned char s_gh3018_heart_rate = 0x0;//心律
 static unsigned char s_gh3018_high_blood = 0x0;//血压/高压
 static unsigned char s_gh3018_low_blood = 0x0;//血压/低压
@@ -68,7 +63,7 @@ static unsigned char s_gh3018_wear_status = 0;//佩戴状态
 unsigned char s_gh3018_heart_rate_buff[HEART_RATE_BUFF_LEN]={0};
 unsigned short s_gh3018_heart_rate_buff_count = 0;
 
-Helios_ThreadAttr ThreadAttr;
+
 char GH3018_sleep_flag =  0;
 #include "helios_extint.h"
 
@@ -85,12 +80,67 @@ extern signed char SL_SC7A20_PEDO_KCAL_WRIST_SLEEP_SWAY_L_ALGO(void);
 extern unsigned char Gsensor_init_flag ;
 
 #endif
-extern void hal_gh30x_int_handler(void);
 
+extern void hal_gh30x_int_handler(void);
+void GH3018_test(uint32_t mode);
+void gh3018_close(void);
 char GH3018_irq_lock = 0;
 // int test_count1 = 0;
 // int test_count2 = 0;
 
+void GH3018_thread_do(void)
+{
+       if(gh3018_run_mode == RUN_MODE_CLOSE)
+       {
+               gh3018_close();
+               //GH3018_LOG("GH3018_irq_cb: 1111111111111!!!!!!!!\r\n");
+               gh3018_run_mode = RUN_MODE_INVALID;
+               GH3018_irq_flag = 0;
+               return;
+       }
+       if(gh3018_run_mode != RUN_MODE_INVALID )
+       {
+               GH3018_test(gh3018_run_mode);
+               
+               gh3018_run_mode = RUN_MODE_INVALID;
+       }
+       if(is_gh3018 == 1 && is_open_gh3018 == 1)//处理Hsensor中断数据
+       {
+               if(GH3018_irq_flag)
+               {
+                       GH3018_irq_lock = 1;
+                       hal_gh30x_int_handler();
+                       
+                       GH3018_irq_lock = 0;
+                       //GH3018_LOG("GH3018_irq_cb: 1111111111111!!!!!!!!\r\n");
+                       //GH3018_LOG("hal_gh30x_int_handler:test_count1:%d test_count2:%d\r\n",test_count1,test_count2);
+                       GH3018_irq_flag = 0;
+               }
+               if(timer_Gsensor_count>(1000/TIMER_TIME_MS))//1秒定时,轮询更新Gsensor数据
+               {
+                       timer_Gsensor_count = 0;
+                       //Helios_msleep(5);
+                       #if CONFIG_SC7A20
+                       SL_SC7A20_PEDO_KCAL_WRIST_SLEEP_SWAY_L_ALGO();
+                       #endif
+
+               }
+       }
+       else
+       {
+               #if CONFIG_SC7A20
+               SL_SC7A20_PEDO_KCAL_WRIST_SLEEP_SWAY_L_ALGO();
+               #endif
+               Helios_msleep(1000);
+               if(GH3018_sleep_flag == 1)
+               {
+                       GH3018_sleep_flag = 0;
+                       Helios_msleep(3000);
+               }
+       }
+       Helios_msleep(5);
+
+}
 void sensor_timerout_cb(void);
 
 void GH3018_result_set_heart_rate(unsigned char heart_rate)
@@ -168,8 +218,7 @@ STATIC mp_obj_t GH3018_make_new(const mp_obj_type_t *type,
 STATIC mp_obj_t mp_GH3018_init(mp_obj_t self_in);
 STATIC mp_obj_t mp_GH3018_deinit(mp_obj_t self_in);
 
-void GH3018_test(uint32_t mode);
-void gh3018_close(void);
+
 
 
 void sensor_timerout_cb(void)
@@ -460,73 +509,4 @@ const mp_obj_type_t Hsensor_GH3018_type = {
 
 #endif 
 
-void sensor_thread_entry(void * argv)
-{
-       //GH3018_LOG("sensor_thread_entry: 11111111!!!!!!!!\r\n");
-       
-       #if CONFIG_GH301x
-       while(1)
-       {
-               
-               if(gh3018_run_mode == RUN_MODE_CLOSE)
-               {
-                       gh3018_close();
-                       //GH3018_LOG("GH3018_irq_cb: 1111111111111!!!!!!!!\r\n");
-                       gh3018_run_mode = RUN_MODE_INVALID;
-                       GH3018_irq_flag = 0;
-                       continue;
-               }
-               if(gh3018_run_mode != RUN_MODE_INVALID )
-               {
-                       GH3018_test(gh3018_run_mode);
-                       
-                       gh3018_run_mode = RUN_MODE_INVALID;
-               }
-               if(is_gh3018 == 1 && is_open_gh3018 == 1)//处理Hsensor中断数据
-               {
-                       if(GH3018_irq_flag)
-                       {
-                               GH3018_irq_lock = 1;
-                               hal_gh30x_int_handler();
-                               
-                               GH3018_irq_lock = 0;
-                               //GH3018_LOG("GH3018_irq_cb: 1111111111111!!!!!!!!\r\n");
-                               //GH3018_LOG("hal_gh30x_int_handler:test_count1:%d test_count2:%d\r\n",test_count1,test_count2);
-                               GH3018_irq_flag = 0;
-                       }
-                       if(timer_Gsensor_count>(1000/TIMER_TIME_MS))//1秒定时,轮询更新Gsensor数据
-                       {
-                               timer_Gsensor_count = 0;
-                               //Helios_msleep(5);
-                               #if CONFIG_SC7A20
-                               SL_SC7A20_PEDO_KCAL_WRIST_SLEEP_SWAY_L_ALGO();
-                               #endif
-
-                       }
-               }
-               else
-               {
-                       #if CONFIG_SC7A20
-                       SL_SC7A20_PEDO_KCAL_WRIST_SLEEP_SWAY_L_ALGO();
-                       #endif
-                       Helios_msleep(1000);
-                       if(GH3018_sleep_flag == 1)
-                       {
-                               GH3018_sleep_flag = 0;
-                               Helios_msleep(3000);
-                       }
-               }
-               Helios_msleep(5);
-       }
-       #else
-       while(1)
-       {
-               #if CONFIG_SC7A20
-               SL_SC7A20_PEDO_KCAL_WRIST_SLEEP_SWAY_L_ALGO();
-               #endif
-               Helios_msleep(1000);
-               
-       }
-       #endif
-       
-}
+