packsource=$HOMEDIR/code/sdk/tools/pkg/fwpkg/brandy/upload_app.fwpkg
echo do release copy
mkdir -p $releasedir
- cp -r build.log $package_dir $releasedir/
+ cp -r $HOMEDIR/build.log $package_dir $releasedir/
cp $packsource $releasedir/$filename
echo $filename > $releasedir/readme.txt
echo branch name $CURRENT_BRANCH >> $releasedir/readme.txt
cd $HOMEDIR
}
-build_target | tee build.log
+build_target | tee $HOMEDIR/build.log
+++ /dev/null
-/**
- * Copyright (c) @CompanyNameMagicTag 2022-2022. All rights reserved. \n
- *
- * Description: Test adc source \n
- * Author: @CompanyNameTag \n
- * History: \n
- * 2022-08-16, Create file. \n
- */
-
-#include "adc.h"
-#define TEST_PARAM_ARGC_1 1
-#define TEST_PARAM_ARGC_2 2
-#define TEST_PARAM_ARGC_3 3
-#define TEST_PARAM_ARGC_4 4
-#define TEST_PARAM_ARGC_5 5
-#define TEST_PARAM_ARGC_6 6
-#define TEST_PARAM_ARGC_7 7
-#define TEST_PARAM_4_BYTES 4
-#define TEST_PARAM_8_BYTES 8
-typedef enum {
- SUITE_OK = 0,
- SUITE_UNKNOWN_FUNCTION = -1,
- SUITE_ERROR_TIMED_OUT = -2,
- SUITE_ERROR_BAD_PARAMS = -3,
- SUITE_ERROR_PIN_ALLOCATION = -4,
- SUITE_ERROR_PIN_DEALLOCATION = -5,
- SUITE_ERROR_UNEXPECTED_INTERRUPT = -6,
- SUITE_ALLOC_FAILED = -7,
- SUITE_CONFIG_FAILED = -8,
- SUITE_TEST_FAILED = -254,
-} battery_error_e;
-
-#if defined(CONFIG_ADC_SUPPORT_AFE)
-
-#error CONFIG_ADC_SUPPORT_AFE
-
-#include "hal_adc_v152.h"
-#include "hal_adc_v152_regs_op.h"
-#else
-#include "hal_adc_v151.h"
-#include "hal_adc_v151_regs_op.h"
-#endif
-#include "adc_porting.h"
-
-#include "pinctrl.h"
-
-#include "debug_print.h"
-#include "soc_osal.h"
-#include "tcxo.h"
-#include "irmalloc.h"
-#include "errcode.h"
-#include "common_def.h"
-
-#include "battery.h"
-
-#if defined(CONFIG_ADC_SUPPORT_AFE)
-
-
-#define ADC_AUTO_SAMPLE_TEST_TIMES 1000
-#define HADC_DEFAULT_CALI \
-{ \
- .hadc_os_code = 0x68, \
- .hadc_wt_b22 = 0x75fdd, \
- .hadc_wt_b21 = 0x3ef67, \
- .hadc_wt_b20 = 0x1f7ae, \
- .hadc_wt_b19 = 0xfc3d, \
- .hadc_wt_b18 = 0x7e22, \
- .hadc_wt_b17 = 0x7dc9, \
- .hadc_wt_b16 = 0x3f01, \
- .hadc_wt_b15 = 0x1f80, \
- .hadc_wt_b14 = 0xfc5, \
- .hadc_wt_b13 = 0x800, \
- .hadc_wt_b12 = 0x800, \
- .hadc_wt_b11 = 0x400, \
- .hadc_wt_b10 = 0x200, \
- .hadc_wt_b9 = 0x100, \
- .dac_code1 = 0x200, \
- .dac_code2 = 0x1d5, \
-}
-
-afe_config_t g_afe_config = HADC_DEFAULT_CALI;
-static bool g_afe_open_flag = false;
-
-static int gadc_open_test(int argc, char *argv[])
-{
- if (argc < 1) {
- return SUITE_ERROR_BAD_PARAMS;
- }
- adc_v152_gadc_channel_sel_t gadc_channel = (adc_v152_gadc_channel_sel_t)strtol(argv[0], NULL, 0);
- if (gadc_channel > SINGLE_END_AINN4) {
- return SUITE_ERROR_BAD_PARAMS;
- }
- errcode_t ret = uapi_adc_init(ADC_CLOCK_NONE);
- if (ret != ERRCODE_SUCC) {
- return ret;
- }
- uapi_adc_open_channel(gadc_channel);
- uapi_adc_power_en(AFE_GADC_MODE, true);
- adc_calibration(AFE_GADC_MODE, true, false, false);
- hadc_gain_set(PGA_GAIN_EIGHT, IA_GAIN_SIXTEEN);
- uapi_adc_manual_sample((adc_channel_t)AFE_GADC_MODE);
- g_afe_open_flag = true;
- return SUITE_OK;
-}
-
-static int hadc_open_test(int argc, char *argv[])
-{
- UNUSED(argc);
- UNUSED(argv);
- bool cali_en = (bool)strtol(argv[0], NULL, 0);
- errcode_t ret = uapi_adc_init(ADC_CLOCK_NONE);
- if (ret != ERRCODE_SUCC) {
- return ret;
- }
- uapi_adc_power_en(AFE_HADC_MODE, true);
- if (cali_en) {
- adc_calibration(AFE_HADC_MODE, true, true, true);
- g_afe_config.hadc_os_code = reg32(0x57036244); // hadc_os_code
- g_afe_config.hadc_wt_b22 = reg32(0x570361B0); // hadc_wt_b22
- g_afe_config.hadc_wt_b21 = reg32(0x570361B4); // hadc_wt_b21
- g_afe_config.hadc_wt_b20 = reg32(0x570361B8); // hadc_wt_b20
- g_afe_config.hadc_wt_b19 = reg32(0x570361BC); // hadc_wt_b19
- g_afe_config.hadc_wt_b18 = reg32(0x570361C0); // hadc_wt_b18
- g_afe_config.hadc_wt_b17 = reg32(0x570361C4); // hadc_wt_b17
- g_afe_config.hadc_wt_b16 = reg32(0x570361C8); // hadc_wt_b16
- g_afe_config.hadc_wt_b15 = reg32(0x570361CC); // hadc_wt_b15
- g_afe_config.hadc_wt_b14 = reg32(0x570361D0); // hadc_wt_b14
- g_afe_config.hadc_wt_b13 = reg32(0x570361D4); // hadc_wt_b13
- g_afe_config.hadc_wt_b12 = reg32(0x570361D8); // hadc_wt_b12
- g_afe_config.hadc_wt_b11 = reg32(0x570361DC); // hadc_wt_b11
- g_afe_config.hadc_wt_b10 = reg32(0x570361E0); // hadc_wt_b10
- g_afe_config.hadc_wt_b9 = reg32(0x570361E4); // hadc_wt_b9
- g_afe_config.dac_code1 = reg32(0x570363D4); // dac_code1
- g_afe_config.dac_code2 = reg32(0x570363D8); // dac_code2
- } else {
- afe_config_t afe_config = g_afe_config;
- adc_set_cali_code(AFE_HADC_MODE, &afe_config);
- }
- uapi_adc_manual_sample(HADC_CHANNEL_0);
- g_afe_open_flag = true;
- return SUITE_OK;
-}
-
-static int adc_auto_sample_test(int argc, char *argv[])
-{
- if (argc < 1) {
- return SUITE_ERROR_BAD_PARAMS;
- }
- if (!g_afe_open_flag) {
- return SUITE_TEST_FAILED;
- }
- adc_v152_gadc_channel_sel_t channel = (adc_v152_gadc_channel_sel_t)strtol(argv[0], NULL, 0);
- uapi_adc_open_channel(channel);
- int adc_value = 0;
- adc_channel_t ch = channel <= SINGLE_END_AINN4 ? (adc_channel_t)AFE_GADC_MODE : HADC_CHANNEL_0;
- uint32_t irq_sts = osal_irq_lock();
- for (int i = 0; i < ADC_AUTO_SAMPLE_TEST_TIMES; i++) {
- adc_value = uapi_adc_auto_sample(ch);
- suite_log_stringf("adc: 0x%x = %d\n", adc_value, adc_value);
- }
- UNUSED(adc_value);
- osal_irq_restore(irq_sts);
- return SUITE_OK;
-}
-
-static int hadc_power_on(int argc, char *argv[])
-{
- UNUSED(argc);
- UNUSED(argv);
- uapi_adc_power_en(AFE_HADC_MODE, true);
- adc_set_cali_code(AFE_HADC_MODE, &g_afe_config);
- return SUITE_OK;
-}
-
-static int hadc_power_off(int argc, char *argv[])
-{
- UNUSED(argc);
- UNUSED(argv);
- uapi_adc_power_en(AFE_HADC_MODE, false);
- return SUITE_OK;
-}
-
-#else
-#define HAL_ADC_SAMPLE_NUMBER_CONFIG_0 10 /* Channel with buffer manual sample average number. */
-#define HAL_ADC_SAMPLE_NUMBER_CONFIG_1 10 /* Channel without buffer manual sample average number. */
-#define HAL_ADC_DISCARD_NUMBER_CONFIG_0 8 /* Channel with buffer manual sample discard number. */
-#define HAL_ADC_DISCARD_NUMBER_CONFIG_1 8 /* Channel without buffer manual sample discard number. */
-
-#define adc_trans_sytick_to_voltage(x) ((float)(((float)(x) * 17) / 40960))
-#define adc_trans_sytick_to_voltage_diff(x) ((float)(((float)((x) - 2048) * 17) / 20480))
-// #define adc_trans_sytick_to_voltage_without_auto_scan(x) ((float)(((float)(x) * 18) / 40960))
-#define adc_trans_sytick_to_voltage_without_auto_scan(x) ((float)(((float)(x) * 18) / 40960))
-
-static uint32_t g_adc_sample_times = 0;
-static uint32_t g_adc_sample_discard = 0;
-static uint32_t g_adc_sample_stick = 0;
-
-#define TESTADC_DISACRD_DELAY_MS 3
-#define MINIMUM_VOLTAGE_RANGE 2
-#define MAXIMUM_VOLTAGE_RANGE 17
-
-static uint32_t adc_get_sample_times(void)
-{
- return g_adc_sample_times;
-}
-
-static uint32_t adc_get_sample_discard(void)
-{
- return g_adc_sample_discard;
-}
-
-static void adc_set_sample_stick(uint32_t stick)
-{
- g_adc_sample_stick = stick;
-}
-
-static uint32_t adc_get_sample_stick(void)
-{
- return g_adc_sample_stick;
-}
-
-static float adc_stick_transfer_voltage(uint16_t stick, adc_channel_t channel)
-{
-#if defined(CONFIG_ADC_SUPPORT_AUTO_SCAN)
- hal_adc_type_info_t *adc_cfg_info = NULL;
- adc_cfg_info = adc_port_get_cfg();
- /* diff channel: (stick - 2048)/ 2048 * 1.8 ; */
- if (adc_cfg_info != NULL && adc_cfg_info[channel].channel_type == HAL_ADC_CHANNEL_TYPE_DIF_BUF) {
- return adc_trans_sytick_to_voltage_diff(stick);
- } else {
- return adc_trans_sytick_to_voltage(stick);
- }
-#else
- UNUSED(channel);
- return adc_trans_sytick_to_voltage_without_auto_scan(stick);
-#endif
-}
-
-static bool adc_get_sample_result(float *voltage, uint8_t channel)
-{
- uint32_t sample_number = 0;
- uint32_t discard_number = 0;
- uint32_t stick = 0;
- uint32_t sample_zero_count = 0;
-
-#if defined(CONFIG_ADC_SUPPORT_AUTO_SCAN)
- if (uapi_adc_auto_scan_is_enabled()) { return false; }
-#endif /* CONFIG_ADC_SUPPORT_AUTO_SCAN */
-
- if (channel >= ADC_CHANNEL_4) {
- sample_number = HAL_ADC_SAMPLE_NUMBER_CONFIG_1;
- discard_number = HAL_ADC_DISCARD_NUMBER_CONFIG_1;
- } else {
- sample_number = HAL_ADC_SAMPLE_NUMBER_CONFIG_0;
- discard_number = HAL_ADC_DISCARD_NUMBER_CONFIG_0;
- }
-
- if (g_adc_sample_times != 0) {
- sample_number = adc_get_sample_times();
- }
-
- if (g_adc_sample_discard != 0) {
- discard_number = adc_get_sample_discard();
- }
-
- /* after channel is enabled, sample result is error in previous samplings, need to be discarded */
- for (uint32_t i = 0; i < discard_number; i++) {
- uapi_adc_manual_sample(ADC_CHANNEL_NONE);
- uapi_tcxo_delay_ms((uint64_t)TESTADC_DISACRD_DELAY_MS);
- }
-
- for (uint32_t i = 0; i < sample_number; i++) {
- uint32_t irq_sts = osal_irq_lock();
- uint32_t sample_result = (uint32_t)uapi_adc_manual_sample(ADC_CHANNEL_NONE);
- osal_printk("sample_result = %d.\r\n", sample_result);
- if (sample_result == 0) { sample_zero_count++; }
- stick += sample_result;
- osal_irq_restore(irq_sts);
- }
- sample_number -= sample_zero_count;
- if (sample_number > 0) {
- stick = (stick / sample_number);
- } else {
- *voltage = 0;
- return false;
- }
-
- adc_set_sample_stick(stick);
- *voltage = adc_stick_transfer_voltage((uint16_t)stick, channel);
-
- UNUSED(discard_number);
- return true;
-}
-
-/**
- * @brief Get voltage by the channel. Available voltage rang is 0V ~ 1.7V.
- * @param voltage The sample result of voltage.
- * @param channel The adc channel.
- * @return true when select channel success, false when seclect channel failed.
- */
-static bool adc_get_voltage_by_channel(float *voltage, uint8_t channel)
-{
- bool ret = false;
-
- uapi_adc_power_en(AFE_SCAN_MODE_MAX_NUM, true);
- ret = uapi_adc_open_channel(channel);
- if (ret == ERRCODE_SUCC) {
- ret = adc_get_sample_result(voltage, channel);
- if (ret) {
- uapi_adc_close_channel(channel);
- uapi_adc_power_en(AFE_SCAN_MODE_MAX_NUM, false);
- return true;
- }
- } else {
- osal_printk("uapi_adc_open_channel failed : %d\r\n", ret);
- }
-
- *voltage = 0;
- uapi_adc_close_channel(channel);
- uapi_adc_power_en(AFE_SCAN_MODE_MAX_NUM, false);
- return false;
-}
-
-
-
-#if defined(CONFIG_ADC_SUPPORT_AUTO_SCAN)
-static bool g_adc_scan_continue = false;
-static void adc_callback(uint8_t ch, uint32_t *buffer, uint32_t length, bool *next)
-{
- osal_printk("[IRQ]channel: %d, buffer:0x%x, len: %d. \r\n", ch, buffer, length);
- uint64_t data = 0;
-#if defined(CONFIG_ADC_SUPPORT_LONG_SAMPLE)
- osal_printk("sample data head: %d %d %d %d\r\n", buffer[0], buffer[TEST_PARAM_ARGC_1],
- buffer[TEST_PARAM_ARGC_2], buffer[TEST_PARAM_ARGC_3]);
- osal_printk("sample data tail: %d %d %d %d\r\n", buffer[length - TEST_PARAM_ARGC_4],
- buffer[length - TEST_PARAM_ARGC_3], buffer[length - TEST_PARAM_ARGC_2], buffer[length - TEST_PARAM_ARGC_1]);
-#else
- for (uint32_t i = 0; i < length; i++) {
- osal_printk("[%d]data: %d\r\n", i, buffer[i]);
- data += buffer[i];
- }
-
- if (length != 0) {
- data = data / length;
- }
- osal_printk("average data: %d\r\n", (uint32_t)data);
-#endif
- *next = g_adc_scan_continue;
- UNUSED(ch);
- UNUSED(buffer);
- UNUSED(length);
- UNUSED(next);
-}
-
-static int adc_stop_auto_scan(int argc, char *argv[])
-{
- adc_channel_t channel;
- if (argc != 1) { /* 1: Indicates the number of input parameters */
- return SUITE_ERROR_BAD_PARAMS;
- }
- channel = (adc_channel_t)strtol(argv[0], NULL, 0);
- if (uapi_adc_auto_scan_ch_disable((uint8_t)channel) == ERRCODE_SUCC) {
- return SUITE_OK;
- } else {
- return SUITE_TEST_FAILED;
- }
-}
-
-static int adc_start_auto_scan(int argc, char *argv[])
-{
- pin_t pin;
- pin_mode_t mode;
-#if defined(CONFIG_ADC_SUPPORT_LONG_SAMPLE)
- if (argc != 7) { /* 7: Indicates the number of input parameters */
- return SUITE_ERROR_BAD_PARAMS;
- }
-#else
- if (argc != 6) { /* 6: Indicates the number of input parameters */
- return SUITE_ERROR_BAD_PARAMS;
- }
-#endif
- adc_channel_t channel;
- channel = (adc_channel_t)strtol(argv[0], NULL, 0);
- g_adc_scan_continue = (bool)strtol(argv[TEST_PARAM_ARGC_1], NULL, 0);
- pin = (pin_t)strtol(argv[TEST_PARAM_ARGC_2], NULL, 0);
- mode = (pin_mode_t)strtol(argv[TEST_PARAM_ARGC_3], NULL, 0);
- adc_scan_config_t config = {
- .type = (uint8_t)strtol(argv[TEST_PARAM_ARGC_4], NULL, 0),
- .threshold_l = 0.5, /* 0.5: Threshold scan volatage(v) lower limit. */
- .threshold_h = 1.5, /* 1.5: Threshold scan volatage(v) upper limit. */
- .freq = (uint8_t)strtol(argv[TEST_PARAM_ARGC_5], NULL, 0),
-#if defined(CONFIG_ADC_SUPPORT_LONG_SAMPLE)
- .long_sample_time = (uint32_t)strtol(argv[TEST_PARAM_ARGC_6], NULL, 0),
-#endif
- };
- osal_printk("chan: %d, freq: %d\r\n", channel, config.freq);
-#if defined(CONFIG_ADC_SUPPORT_LONG_SAMPLE)
- osal_printk("long_sample_time = %d\n", config.long_sample_time);
-#endif
-
- uapi_pin_set_mode(pin, mode);
- uapi_adc_power_en(AFE_SCAN_MODE_MAX_NUM, true);
- if (uapi_adc_auto_scan_ch_enable((uint8_t)channel, config, adc_callback) == ERRCODE_SUCC) {
- return SUITE_OK;
- } else {
- return SUITE_TEST_FAILED;
- }
-}
-#endif /* CONFIG_ADC_SUPPORT_AUTO_SCAN */
-#endif /* CONFIG_ADC_SUPPORT_AFE */
-bool battery_get_voltage_by_channel(float *voltage, uint8_t channel)
-{
-
-#if defined(CONFIG_ADC_SUPPORT_AFE)
- // uapi_suite_add_function("gadc_open_test", "GAFE init & enable test <Sample end: 0~7>", gadc_open_test);
- // uapi_suite_add_function("hadc_open_test", "HAFE init & enable test <Cali enable>", hadc_open_test);
- // uapi_suite_add_function("auto_sample_test", "AFE auto sample test Params: <Sample end: GAFE:0~7 HAFE:8>",
- // adc_auto_sample_test);
- // uapi_suite_add_function("hadc_power_off", "HAFE low power test, power off hafe", hadc_power_off);
- // uapi_suite_add_function("hadc_power_on", "HAFE low power test, power on hafe ", hadc_power_on);
-#else
- uapi_adc_init(ADC_CLOCK_500KHZ);
- // uapi_adc_power_en(AFE_SCAN_MODE_MAX_NUM, true);
- // uapi_suite_add_function("adc_manual_test", "Params: <Channel>, <sample_times>, <discard_times>,"
- // "<pin number>, <pin mode>", adc_manual_test);
- // adc_channel_t channel;
-
- uint64_t time1, time2;
- uint32_t param_index = 0;
- // channel = (adc_channel_t)strtol(argv[param_index++], NULL, 0);
- // g_adc_sample_times = (uint32_t)strtol(argv[param_index++], NULL, 0);
- // g_adc_sample_discard = (uint32_t)strtol(argv[param_index++], NULL, 0);
- // pin = (pin_t)strtol(argv[param_index++], NULL, 0);
- // mode = (pin_mode_t)strtol(argv[param_index++], NULL, 0);
- osal_printk("channel: %d, sample times: %d, discard: %d.\r\n", channel, g_adc_sample_times, g_adc_sample_discard);
-
- // uapi_pin_set_mode(pin, mode);
-#if defined(CONFIG_ADC_SUPPORT_AUTO_SCAN)
- uapi_adc_auto_scan_disable();
-#endif /* CONFIG_ADC_SUPPORT_AUTO_SCAN */
- // osal_printk("PINMUX SET DONE\r\n");
-
- time1 = uapi_tcxo_get_us();
-
- if (!adc_get_voltage_by_channel(voltage, channel)) {
- osal_printk("adc get sample result failed.\r\n");
- return SUITE_TEST_FAILED;
- }
- time2 = uapi_tcxo_get_us();
-
- osal_printk("tick: %d, Sample time: %d. \r\n", adc_get_sample_stick(),
- (uint64_t)(time2 - time1));
- osal_printk("voltage: %.4f.\r\n", voltage);
-
-
-#if defined(CONFIG_ADC_SUPPORT_AUTO_SCAN)
- // uapi_suite_add_function("adc_start_auto_scan", "Params: <Channel>, <scan mode:0|1 >, <freq>, <bool: continue>,"
- // "<pin number>, <pin mode>", adc_start_auto_scan);
- // uapi_suite_add_function("adc_stop_auto_scan", "Params: <Channel>", adc_stop_auto_scan);
-#endif /* CONFIG_ADC_SUPPORT_AUTO_SCAN */
-#endif /* CONFIG_ADC_SUPPORT_AFE */
- return true;
-}
+++ /dev/null
-/*
- * Copyright (c) CompanyNameMagicTag 2021-2022. All rights reserved.
- * Description: Application Core OS Priority Initialize Interface for Standard
- * Author:
- * Create: 2022-12-03
- */
-#include "debug_print.h"
-#include "thread_init.h"
-#include "common_def.h"
-#include "pm.h"
-#include "watchdog.h"
-#ifdef CFG_DRIVERS_MMC
-#ifdef __LITEOS__
-#include "soc/mmc.h"
-#endif
-#include "soc_mmc.h"
-#endif
-#include "soc_lcd_api.h"
-#ifdef CFG_DRIVERS_NANDFLASH
-#include "nandflash_config.h"
-#endif
-#if defined(TPTYPE_TMA525B)
-#include "tma525b_drv1.h"
-#elif defined(TPTYPE_ZTW523)
-#include "ztw523_touch1.h"
-#else
-#include "ztw523_touch1.h"
-#endif
-#include "thread_pri_init.h"
-#if DSP_EXIST == YES
-#include "soc_uapi_audio_sys.h"
-#include "soc_uapi_vendor.h"
-#include "soc_uapi_sound.h"
-/* Audio codec vendor select according to hardware connection:
- * define AUDIO_SMARTPA_AW88166 : macro to init smartpa aw88166;
- * define AUDIO_SMARTPA_AW88166_I2S_ID UAPI_SND_OUT_PORT_I2S0 : macro to specify i2s id connecting to smartpa aw88166;
- */
-#define AUDIO_SMARTPA_AW88262
-#define AUDIO_SMARTPA_AW88262_I2S_ID UAPI_SND_OUT_PORT_I2S2
-
-#endif /* DSP_EXIST */
-#include "panic.h"
-#include "board_init.h"
-#include "kernel_init.h"
-#ifdef SUPPORT_AT_OHOSFWK
-#include "ohosfwk_startup.h"
-#endif
-
-#define EMMC_BASE_ADDR 0x52062000
-#define TASK_PRIORITY_APP (osPriority_t)(17)
-#define TICK_TEN_MS (10U)
-
-static void thread_main(const void *unused);
-void bt_acore_btc_ipc_receive_init(void);
-
-app_task_definition_t g_thread_pri = { { "thread_pri", 0, NULL, 0, NULL, (0x1000), TASK_PRIORITY_APP, 0, 0 },
- (osThreadFunc_t)thread_main, NULL, NULL, USE_DTCM_MEM };
-store_class g_store_init_select = STORE_CLASS_NAND;
-
-#if defined(ENABLE_UIKIT) || defined(ENABLE_LVGL)
-static void sample_gfx_init(void)
-{
-#if defined(TPTYPE_TMA525B)
- tma525b_host_init_sample();
-#elif defined(TPTYPE_ZTW523)
- ztw523_host_init_sample();
-#else
- ztw523_host_init_sample();
-#endif
- uapi_lcd_init();
-#ifdef SUPPORT_GPU_GMMU
- drv_gmmu_module_init();
-#endif
- uapi_vau_module_init();
- uapi_dpu_module_init();
-#ifdef SUPPORT_GPU_JPEG
- uapi_jpeg_module_init();
-#endif
-}
-#endif
-
-#ifdef CFG_DRIVERS_MMC
-static void emmc_init(void)
-{
- /**
- * FPGA解复位, 设置CMD_CONFLICT_CHECK
- * 之后才能设置管脚
- */
- writew(EMMC_BASE_ADDR + 0x508, 0);
- init_emmc_pinmux();
- int ret = emmc_drv_context_init();
- if (ret != ENOERR) {
- PRINT("emmc init error:[%d]"NEWLINE, ret);
- }
- mmc_set_first_init_flag(true);
- mmc_set_sleep_init_flag(true);
- PRINT("emmc init success\r\n");
-}
-#endif
-
-#ifdef CFG_DRIVERS_NANDFLASH
-static void nandflash_init(void)
-{
- int32_t ret = 0;
- ret = nandflash_filesystem_init();
- if (ret != 0) {
- PRINT("nandflash init error[%d]"NEWLINE, ret);
- }
- PRINT("nandflash init success\r\n");
-}
-#endif
-
-static void board_version_class_print(void)
-{
- PRINT("**********startup info**********\r\n");
- PRINT("os init class is %s."NEWLINE, (g_os_init_select == OS_CLASS_LITEOS) ? "liteos" : "freertos");
- PRINT("store init class is %s."NEWLINE, (g_store_init_select == STORE_CLASS_NAND) ? "nandflash" : "emmc");
- PRINT("display init class is %s."NEWLINE, (g_display_init_select == DISPLAY_CLASS_QSPI) ? "QSPI" : "MIPI");
- PRINT("board init class is %s."NEWLINE, (g_board_init_select == BOARD_CLASS_E0B2) ? "E0B2" : "E0B4");
- PRINT("psram density is %s."NEWLINE, (get_psram_density() == PSRAM_DENSITY_16M) ? "16MB" : "32MB");
- PRINT("**********startup info**********\r\n");
-}
-
-#if DSP_EXIST == YES
-/**
- * The sample code of the vendor,
- * which will be implemented by the customer in the future
- */
-#ifdef AUDIO_SMARTPA_AW88262
-td_s32 audio_aw88262_init(const uapi_vendor_codec_attr *attr);
-td_s32 audio_aw88262_deinit(td_void);
-
-static uapi_vendor_driver g_aw88262_driver = {
- .out_port = AUDIO_SMARTPA_AW88262_I2S_ID,
- .init = audio_aw88262_init,
- .deinit = audio_aw88262_deinit,
- .set_aef_profile = TD_NULL,
-};
-
-static td_s32 audio_aw88262_register_driver(void)
-{
- return uapi_audio_vendor_register(&g_aw88262_driver);
-}
-#endif /* AUDIO_SMARTPA_AW88262 */
-
-#ifdef AUDIO_SMARTPA_AW88166
-td_s32 audio_aw88166_init(const uapi_vendor_codec_attr *attr);
-td_s32 audio_aw88166_deinit(td_void); /* Call when device power off */
-td_s32 audio_aw88166_start(const uapi_vendor_codec_attr *attr);
-td_s32 audio_aw88166_stop(td_void);
-td_s32 audio_aw88166_set_aef_profile(uapi_snd_aef_profile aef_profile);
-
-static uapi_vendor_driver g_aw88166_driver = {
- .out_port = AUDIO_SMARTPA_AW88166_I2S_ID,
- .init = audio_aw88166_start,
- .deinit = audio_aw88166_stop,
- .set_aef_profile = audio_aw88166_set_aef_profile,
-};
-
-static td_s32 audio_aw88166_register_driver(void)
-{
- const uapi_vendor_codec_attr attr = {};
-
- audio_aw88166_init(&attr); /* Init aw88166 once when device power on */
-
- return uapi_audio_vendor_register(&g_aw88166_driver);
-}
-#endif /* AUDIO_SMARTPA_AW88166 */
-
-static void audio_smartpa_init(void)
-{
- uint32_t ret;
-
-#ifdef AUDIO_SMARTPA_AW88262
- ret = (uint32_t)audio_aw88262_register_driver();
- if (ret != 0) {
- PRINT("aw88262 register driver error\r\n");
- }
-#endif /* AUDIO_SMARTPA_AW88262 */
-
-#ifdef AUDIO_SMARTPA_AW88166
- ret = (uint32_t)audio_aw88166_register_driver();
- if (ret != 0) {
- PRINT("aw88166 register driver error\r\n");
- }
-#endif /* AUDIO_SMARTPA_AW88166 */
-}
-#endif /* DSP_EXIST */
-
-#if DSP_EXIST == YES
-static void audio_init()
-{
- (void)osDelay(TICK_TEN_MS);
- uapi_watchdog_kick();
-
- audio_smartpa_init();
-
- uint32_t ret = (uint32_t)uapi_audio_init();
- if (ret != 0) {
- PRINT("audio init error:[%d]\r\n", ret);
- } else {
- PRINT("audio init OK\r\n");
- }
-}
-#endif
-
-static void thread_main(const void *unused)
-{
- PRINT("thread_main start "NEWLINE);
- unused(unused);
- bt_acore_btc_ipc_receive_init();
- uapi_pm_control(PM_BT_POWER_UP_AND_RUN);
- los_vfs_init();
- uint32_t ret = dpal_driver_base_init();
- if (ret != 0) {
- PRINT("dpal driver base init error"NEWLINE);
- panic(PANIC_ASSERT, __LINE__);
- }
-#ifdef CFG_DRIVERS_MMC
- emmc_init();
- g_store_init_select = STORE_CLASS_EMMC;
- sdiom_internal_freq_handler_register(mmc_set_internal_clk);
-#endif
-#ifdef CFG_DRIVERS_NANDFLASH
- nandflash_init();
- g_store_init_select = STORE_CLASS_NAND;
-#endif
- uapi_pm_control(PM_DISPLAY_POWER_UP_AND_RUN);
- (void)osDelay(TICK_TEN_MS);
-
-#if defined(ENABLE_UIKIT) || defined(ENABLE_LVGL)
- sample_gfx_init();
-#else
- uapi_pm_control(PM_DISPLAY_POWER_OFF);
-#endif
-
-#if DSP_EXIST == YES
- audio_init();
-#endif
- board_version_class_print();
- uapi_watchdog_kick();
- thread_init();
- button_app_init();
- uapi_calendar_init();
-#ifdef SUPPORT_AT_OHOSFWK
- ohos_startup();
-#endif
- uapi_pm_remove_sleep_veto(PM_ID_DEBUG);
- set_startup_finish_flag();
-}
-
-void thread_pri_init(void)
-{
- /* Create tasks */
- g_thread_pri.task_handle = osThreadNew(g_thread_pri.func, NULL, &(g_thread_pri.attr));
- if (g_thread_pri.task_handle == NULL) {
- PRINT("create thread pri failed!");
- }
-}
add_subdirectory_if_exist(drivers)
add_subdirectory_if_exist(boards)
add_subdirectory_if_exist(chips)
-add_subdirectory_if_exist(adapter)
\ No newline at end of file
+add_subdirectory_if_exist(adapter)
+add_subdirectory_if_exist(peripheral)
+++ /dev/null
-#===============================================================================
-# @brief cmake file
-# Copyright (c) @CompanyNameMagicTag 2023-2023. All rights reserved.
-#===============================================================================
-set(COMPONENT_NAME "touch")
-
-set(SOURCES
- ${CMAKE_CURRENT_SOURCE_DIR}/touch_screen_drv.c
- ${CMAKE_CURRENT_SOURCE_DIR}/touch_screen_queue1.c
-)
-
-if("TPTYPE_TMA525B" IN_LIST DEFINES)
-set(SOURCES ${SOURCES}
- ${CMAKE_CURRENT_SOURCE_DIR}/tma525b_touch/tma525b_ctrl.c
- ${CMAKE_CURRENT_SOURCE_DIR}/tma525b_touch/tma525b_drv1.c
- ${CMAKE_CURRENT_SOURCE_DIR}/tma525b_touch/tma525b_touch1.c
-)
-elseif("TPTYPE_ZTW523" IN_LIST DEFINES)
-set(SOURCES ${SOURCES}
- ${CMAKE_CURRENT_SOURCE_DIR}/ztw523_touch/ztw523_ctrl.c
- ${CMAKE_CURRENT_SOURCE_DIR}/ztw523_touch/ztw523_drv1.c
- ${CMAKE_CURRENT_SOURCE_DIR}/ztw523_touch/ztw523_touch1.c
-)
-else()
-set(SOURCES ${SOURCES}
- ${CMAKE_CURRENT_SOURCE_DIR}/ztw523_touch/ztw523_ctrl.c
- ${CMAKE_CURRENT_SOURCE_DIR}/ztw523_touch/ztw523_drv1.c
- ${CMAKE_CURRENT_SOURCE_DIR}/ztw523_touch/ztw523_touch1.c
-)
-endif()
-
-if("TPTYPE_TMA525B" IN_LIST DEFINES)
-set(PUBLIC_HEADER
- ${CMAKE_CURRENT_SOURCE_DIR}
- ${CMAKE_CURRENT_SOURCE_DIR}/tma525b_touch
- ${ROOT_DIR}/middleware/services/gui/hal/input/include
-)
-elseif("TPTYPE_ZTW523" IN_LIST DEFINES)
-set(PUBLIC_HEADER
- ${CMAKE_CURRENT_SOURCE_DIR}
- ${CMAKE_CURRENT_SOURCE_DIR}/ztw523_touch
- ${ROOT_DIR}/middleware/services/gui/hal/input/include
-)
-else()
-set(PUBLIC_HEADER
- ${CMAKE_CURRENT_SOURCE_DIR}
- ${CMAKE_CURRENT_SOURCE_DIR}/ztw523_touch
- ${ROOT_DIR}/middleware/services/gui/hal/input/include
-)
-endif()
-
-set(PRIVATE_HEADER
-)
-
-set(PRIVATE_DEFINES
-)
-
-set(PUBLIC_DEFINES
-)
-
-# use this when you want to add ccflags like -include xxx
-set(COMPONENT_PUBLIC_CCFLAGS
-)
-
-set(COMPONENT_CCFLAGS
- -Wno-incompatible-function-pointer-types
- -Wno-unused-function
-)
-
-set(WHOLE_LINK
- true
-)
-
-set(MAIN_COMPONENT
- false
-)
-
-build_component()
-
-install_sdk(${CMAKE_CURRENT_SOURCE_DIR} "*")
+++ /dev/null
-/*
- * Copyright (c) @CompanyNameMagicTag 2021-2022. All rights reserved.
- * Description: ztw523 touch driver.
- * Author: @CompanyNameTag
- * Create: 2022-04-12
- */
-
-#ifndef FT6X46_CTRL_H
-#define FT6X46_CTRL_H
-
-#include "stdio.h"
-#include "debug_print.h"
-#include "stdint.h"
-#include "td_base.h"
-#include "platform_core.h"
-#include "ft6x46_touch1.h"
-
-/* host peripheral definitions */
-#if 0//CHIP_ASIC
-#define ZTW523_I2C_BUS I2C_BUS_1
-#define ZTW523_INT_GPIO S_AGPIO5
-#define ZTW523_RESET_GPIO S_AGPIO4
-#else
-#define ZTW523_I2C_BUS I2C_BUS_5
-#define ZTW523_INT_GPIO S_MGPIO11
-#define ZTW523_RST_REG 0x5600201c
-#define ZTW523_RST_HIGH 3
-#define ZTW523_RST_LOW 0
-#endif
-
-#define ZTW523_I2C_ADDR 0x20
-#define FT6X46_I2C_ADDR 0x38
-#define ZTW523_I2C_SPEED I2C_SPEED_MODE_SS
-#define ZTW523_REG_BYTE_LEN 2
-#define OFFSET_8_BITS 8
-#define ZTW523_REG_WRITE_LEN 4
-
-#define ZTW523_CMD_SEND_LEN 2
-#define FT6X46_CMD_SEND_LEN 1
-
-#define ZTW523_REG_DATA_LEN 2
-#define ZTW523_I2C_TIME_MAX 3
-
-#define ZTW523_I2C_SEND_INDEX0 0
-#define ZTW523_I2C_SEND_INDEX1 1
-#define ZTW523_I2C_SEND_INDEX2 2
-#define ZTW523_I2C_SEND_INDEX3 3
-typedef struct {
- uint32_t int_gpio;
- i2c_bus_t i2c_id;
- uint32_t i2c_speed;
-} ztw523_ctrl_attr;
-
-typedef ext_errno (*ztw523_bus_init)(ztw523_ctrl_attr *attr);
-
-typedef struct {
- ztw523_ctrl_attr attr;
- ztw523_bus_init bus_init;
-} ztw523_ctrl_ops;
-
-ext_errno ztw523_host_peripheral_init(ztw523_ctrl_attr *attr);
-ext_errno ztw523_register_handle(const ztw523_ctrl_ops *peri_data, touch_callback func);
-ext_errno ztw523_unregister_handle(const ztw523_ctrl_ops *peri_data);
-ext_errno ztw523_reset(void);
-void ztw523_resume_reset(void);
-void ztw523_delay(uint32_t ms);
-
-ext_errno tp_i2c_data_read(uint16_t reg_addr, uint8_t *data_buf, uint32_t data_len);
-ext_errno tp_i2c_cmd_write(uint16_t cmd);
-ext_errno tp_i2c_reg_write(uint16_t reg_addr, uint16_t reg_cfg);
-ext_errno tp_i2c_data_write(uint16_t reg_addr, uint8_t *data_buf, uint32_t data_len);
-
-
-ext_errno tp_ft6x46_i2c_data_read(uint8_t reg_addr, uint8_t *data_buf, uint32_t data_len);
-ext_errno tp_ft6x46_i2c_data_write(uint8_t reg_addr, uint8_t *data_buf, uint16_t data_len);
-ext_errno tp_ft6x46_i2c_data_write_reg(uint8_t addr, uint8_t val);
-
-#endif
+++ /dev/null
-/*
- * Copyright (c) @CompanyNameMagicTag 2021-2021. All rights reserved.
- * Description: touch screen driver.
- * Author: @CompanyNameTag
- * Create: 2022-04-12
- */
-
-#include "touch_screen_drv.h"
-#include "tcxo.h"
-#include "common_def.h"
-#include "soc_osal.h"
-#include "touch_screen_def.h"
-#include "input_app.h"
-#if defined(TPTYPE_TMA525B)
-#include "tma525b_drv1.h"
-#elif defined(TPTYPE_ZTW523)
-#include "ztw523_drv1.h"
-#else
-#include "ztw523_drv1.h"
-#endif
-
-#define TOUCH_SCREEN_DEV_NAME_LEN 16
-#define TOUCH_SCREEN_DEVNAME "input/event"
-#define TOUCH_SCREEN_DYNAMIC_MINOR 65
-#define TOUCH_SCREEN_CMDID_MAX 16
-
-#define TOUCH_SCREEN_TASK_PRIO 5
-#define TOUCH_SCREEN_TASK_SIZE 0x800
-#define TOUCH_SCREEN_QUEUE_MAX_SIZE 60
-#define TOUCH_SCREEN_READY_EVENT (1 << 0)
-
-struct ts_driver_data g_touch_drv = {0};
-struct ts_driver_data *g_attr = NULL;
-
-report_event_cb g_report_event_cb = NULL;
-
-#if defined(SUPPORT_POWER_MANAGER)
-event_callback_func g_power_manager_cb = NULL;
-#endif
-
-static struct ts_driver_data *touch_screen_get_driver_data(void)
-{
- return &g_touch_drv;
-}
-
-static uint32_t touch_screen_get_state(struct ts_driver_data *tsdd)
-{
- if (tsdd != NULL && tsdd->queue != NULL) {
- return (uint32_t)ts_queue_is_empty(tsdd->queue);
- }
-
- if (tsdd == NULL) {
- tp_err("tsdd is null!");
- return EXT_ERR_FAILURE;
- }
- if (tsdd->queue == NULL) {
- tp_err("tsdd queue is null!");
- }
-
- return EXT_ERR_FAILURE;
-}
-
-static void convert_touch_info(input_dev_data_t* data, input_event_info* touch_info)
-{
- data->x = (int16_t)touch_info->tp_event_info.x_axis[0];
- data->y = (int16_t)touch_info->tp_event_info.y_axis[0];
- data->type = INDEV_TYPE_TOUCH;
- data->timestamp = (uint32_t)touch_info->tv_usec;
- if ((touch_info->tp_event == MC_TP_PRESS) || (touch_info->tp_event == MC_TP_MOVE)) {
- data->state = INDEV_STATE_PRESS;
- } else if (touch_info->tp_event == MC_TP_RELEASE) {
- data->state = INDEV_STATE_RELEASE;
- } else {
- data->state = INDEV_STATE_UNKNOWN;
- }
-}
-
-static void report_or_enqueue_event(input_event_info* touch_info, struct ts_driver_data *tsdd)
-{
- if (g_report_event_cb != NULL) {
- input_dev_data_t data;
- convert_touch_info(&data, touch_info);
- if (data.state == INDEV_STATE_UNKNOWN) {
- return;
- }
- g_report_event_cb(&data);
- } else {
- int32_t ret = ts_en_queue(tsdd->queue, touch_info);
- if (ret != EXT_ERR_SUCCESS) {
- tp_err("Failed to enqueue ts queue! ret=0x%x", ret);
- }
- }
-}
-#if defined(SUPPORT_POWER_MANAGER)
-static void report_event_to_power_manager(input_event_info *touch_info)
-{
- if (g_power_manager_cb != NULL) {
- input_dev_data_t data;
- convert_touch_info(&data, touch_info);
- if (data.state == INDEV_STATE_UNKNOWN) {
- return;
- }
- g_power_manager_cb(data.state, 0);
- }
- return;
-}
-
-uint32_t ts_register_power_manager_cb(event_callback_func callback)
-{
- if (g_power_manager_cb != NULL) {
- return EXT_ERR_FAILURE;
- }
- g_power_manager_cb = callback;
- return EXT_ERR_SUCCESS;
-}
-#endif
-ext_errno touch_info_process(void)
-{
- struct ts_driver_data *tsdd = touch_screen_get_driver_data();
- input_event_info touch_info;
- int32_t ret = 0;
-
- if (tsdd->touch_api->touch_get_tpinfo != NULL) {
- ret = tsdd->touch_api->touch_get_tpinfo((uint8_t *)(&touch_info), sizeof(input_event_info));
- if (ret != EXT_ERR_SUCCESS) {
- tp_err("get touch info fail! ret=0x%x", ret);
- }
-
- report_or_enqueue_event(&touch_info, tsdd);
-#if defined(SUPPORT_POWER_MANAGER)
- report_event_to_power_manager(&touch_info);
-#endif
- }
-
- return EXT_ERR_SUCCESS;
-}
-
-static void ts_callback_func(void)
-{
- ext_errno ret;
- if (g_attr != NULL) {
- common_notify_mail_t mail = {0};
- mail.comm.app = APP_TOUCH;
- ret = osal_msg_queue_write_copy(get_app_queue_id(), (void *)&mail,
- sizeof(common_notify_mail_t), 0);
- if (ret != OSAL_SUCCESS) {
- tp_err("touch app msg send failed! err=0x%x! \r\n", ret);
- }
- }
-}
-
-static ext_errno ts_register_callback(struct ts_driver_data *attr)
-{
- ext_errno ret = EXT_ERR_FAILURE;
- g_attr = attr;
-
- if (attr->touch_api->register_callback != NULL) {
- ret = attr->touch_api->register_callback(attr->private_data, ts_callback_func);
- if (ret != EXT_ERR_SUCCESS) {
- tp_err("register touch screen callback fail! ret=0x%x", ret);
- return ret;
- }
- } else {
- tp_err("touch screen callback register func is empty!");
- }
-
- return ret;
-}
-
-static ext_errno ts_unregister_callback(struct ts_driver_data *attr)
-{
- ext_errno ret = EXT_ERR_FAILURE;
-
- if (attr->touch_api->unregister_callback != NULL) {
- ret = attr->touch_api->unregister_callback(attr->private_data);
- if (ret != EXT_ERR_SUCCESS) {
- tp_err("unregister touch screen callback fail! ret=0x%x", ret);
- return ret;
- }
- g_attr = NULL;
- } else {
- tp_err("touch screen callback unregister func is empty!");
- }
-
- return ret;
-}
-
-static int32_t ts_dev_open(const void *private_data)
-{
- int32_t ret;
- struct ts_driver_data *tsdd = NULL;
- if (private_data == NULL) {
- tp_err("ts_open: invalid dev or driver_data!\n");
- return EXT_ERR_FAILURE;
- }
-
- // todo: get tsdd from private_data
- tsdd = touch_screen_get_driver_data();
- tsdd->queue = ts_init_queue(TOUCH_SCREEN_QUEUE_MAX_SIZE);
- if (tsdd->queue == NULL) {
- tp_err("create touch screen queue fail!\r\n");
- return EXT_ERR_FAILURE;
- }
- ret = osal_event_init(&(tsdd->event));
- if (ret != EXT_ERR_SUCCESS) {
- tp_err("touch osal_event_init fail! ret=0x%x\r\n", ret);
- return ret;
- }
-
- tsdd->task_handle = osal_kthread_create((osal_kthread_handler)touch_info_process,
- (void *)touch_screen_get_driver_data(),
- "touch_screen", TOUCH_SCREEN_TASK_SIZE);
- if (tsdd->task_handle == NULL) {
- tp_err("create touch screen thread fail!\r\n");
- return EXT_ERR_FAILURE;
- }
- osal_kthread_set_priority(tsdd->task_handle, TOUCH_SCREEN_TASK_PRIO);
-
- if (tsdd->touch_api->touch_init != NULL) {
- ret = tsdd->touch_api->touch_init(tsdd->private_data);
- if (ret != EXT_ERR_SUCCESS) {
- tp_err("touch_init fail! ret=0x%x\r\n", ret);
- return ret;
- }
- }
-
- ret = ts_register_callback(tsdd);
- if (ret != EXT_ERR_SUCCESS) {
- tp_err("register callback fail! ret=0x%x\r\n", ret);
- return ret;
- }
-
- return EXT_ERR_SUCCESS;
-}
-
-static int32_t ts_dev_release(const void *private_data)
-{
- int32_t ret;
- struct ts_driver_data *tsdd = NULL;
- if (private_data == NULL) {
- tp_err("ts_dev_release: invalid dev or driver_data!\n");
- return EXT_ERR_FAILURE;
- }
-
- // todo: get tsdd from private_data
- tsdd = touch_screen_get_driver_data();
- ret = ts_unregister_callback(tsdd);
- if (ret != EXT_ERR_SUCCESS) {
- tp_err("unregister callback fail! ret=0x%x\r\n", ret);
- return ret;
- }
- return EXT_ERR_SUCCESS;
-}
-
-static uint32_t ts_dev_poll(const osal_poll *osal_poll, const void *private_data)
-{
- unused(osal_poll);
- unused(private_data);
- // todo: get tsdd from private_data
- struct ts_driver_data *tsdd = NULL;
- tsdd = touch_screen_get_driver_data();
- if (tsdd == NULL) {
- tp_err("ts_driver_data is NULL");
- return EXT_ERR_FAILURE;
- }
-
- if (tsdd->ops->priv_operator != NULL && tsdd->ops->priv_operator(tsdd) == 0) {
- return OSAL_POLLIN | OSAL_POLLRDNORM;
- }
-
- return EXT_ERR_SUCCESS;
-}
-
-static int32_t ts_ioctl_read_touch_info(uint32_t cmd, void *arg, const void *private_data)
-{
- unused(cmd);
- ext_errno ret;
- struct ts_driver_data *tsdd = NULL;
- input_event_info *touch_info = (input_event_info *)arg;
-
- if (private_data == NULL) {
- tp_err("invalid dev or driver_data!");
- return EXT_ERR_FAILURE;
- }
-
- // todo: get tsdd from private_data
- tsdd = touch_screen_get_driver_data();
- if (tsdd->queue == NULL) {
- tp_err("invalid touch screen queue!");
- return EXT_ERR_FAILURE;
- }
-
- ret = ts_de_queue(tsdd->queue, touch_info);
- if (ret != EXT_ERR_SUCCESS) {
- tp_err("get touch info fail! ret=0x%x", ret);
- return ret;
- }
-
- return EXT_ERR_SUCCESS;
-}
-
-static osal_ioctl_cmd g_ts_cmd_list[TOUCH_SCREEN_CMDID_MAX] = {
- {TOUCH_SCREEN_GET_EVENT, ts_ioctl_read_touch_info},
-};
-
-static osal_dev *g_ts_dev = NULL;
-static osal_fileops g_ts_ops = {
- .open = ts_dev_open,
- .release = ts_dev_release,
- .poll = ts_dev_poll,
- .cmd_list = g_ts_cmd_list,
- .cmd_cnt = sizeof(g_ts_cmd_list) / sizeof(g_ts_cmd_list[0]),
-};
-
-struct ts_ops g_ts_status_ops = {
- .priv_operator = touch_screen_get_state,
-};
-
-static ext_errno touch_screen_register_device(void)
-{
- ext_errno ret;
-
- g_touch_drv.private_data = touch_screen_get_peri_attr();
- g_touch_drv.touch_api = touch_screen_get_api();
- g_touch_drv.ops = &g_ts_status_ops;
- g_ts_dev = osal_dev_create(TOUCH_SCREEN_DEVNAME);
- g_ts_dev->minor = TOUCH_SCREEN_DYNAMIC_MINOR;
- g_ts_dev->fops = &g_ts_ops;
-
- ret = osal_dev_register(g_ts_dev);
- if (ret != 0) {
- tp_err("touch screen osal_dev_register --------failed! ret=0x%x\n", ret);
- return EXT_ERR_FAILURE;
- }
-
- return EXT_ERR_SUCCESS;
-}
-
-ext_errno touch_screen_module_init(void)
-{
- ext_errno ret;
-
- ret = touch_screen_register_device();
- if (ret != EXT_ERR_SUCCESS) {
- tp_err("touch_screen_register_device ----------failed! ret=0x%x\n", ret);
- }
- tp_err("touch_screen_register_device ----------succ!!!\n");
-
- return EXT_ERR_SUCCESS;
-}
-
-ext_errno touch_screen_module_deinit(void)
-{
- return EXT_ERR_SUCCESS;
-}
-
-uint32_t ts_register_report_event_cb(report_event_cb callback)
-{
- if (g_report_event_cb != NULL) {
- return EXT_ERR_FAILURE;
- }
- g_report_event_cb = callback;
- return EXT_ERR_SUCCESS;
-}
-
-uint32_t ts_unregister_report_event_cb(void)
-{
- g_report_event_cb = NULL;
- return EXT_ERR_SUCCESS;
-}
-
-uint32_t ts_init(void)
-{
- int32_t ret;
- struct ts_driver_data *tsdd = NULL;
-
- g_touch_drv.private_data = touch_screen_get_peri_attr();
- g_touch_drv.touch_api = touch_screen_get_api();
- g_touch_drv.ops = &g_ts_status_ops;
- tsdd = touch_screen_get_driver_data();
- tsdd->queue = ts_init_queue(TOUCH_SCREEN_QUEUE_MAX_SIZE);
- if (tsdd->queue == NULL) {
- tp_err("create touch screen queue fail!\r\n");
- return EXT_ERR_FAILURE;
- }
-
- ret = ts_register_callback(tsdd);
- if (ret != EXT_ERR_SUCCESS) {
- tp_err("register callback fail! ret=0x%x\r\n", ret);
- return EXT_ERR_FAILURE;
- }
-
- return EXT_ERR_SUCCESS;
-}
-
-uint32_t ts_read(const input_dev_data_t* data)
-{
- unused(data);
- return EXT_ERR_SUCCESS;
-}
-
-uint32_t ts_close(void)
-{
- return EXT_ERR_SUCCESS;
-}
--- /dev/null
+#===============================================================================
+# @brief cmake make file
+# Copyright (c) @CompanyNameMagicTag 2022-2022. All rights reserved.
+#===============================================================================
+# add_subdirectory(hal ${PROJECT_BINARY_DIR}/hal)
+add_subdirectory_if_exist(acc)
+add_subdirectory_if_exist(button)
+add_subdirectory_if_exist(lcd)
+add_subdirectory_if_exist(mag)
+add_subdirectory_if_exist(ppg)
+add_subdirectory_if_exist(touch)
--- /dev/null
+#===============================================================================
+# @brief cmake file
+# Copyright (c) @CompanyNameMagicTag 2023-2023. All rights reserved.
+#===============================================================================
+set(COMPONENT_NAME "acc_sensor")
+
+set(SOURCES
+ ${CMAKE_CURRENT_SOURCE_DIR}/touch_screen_drv.c
+ ${CMAKE_CURRENT_SOURCE_DIR}/touch_screen_queue1.c
+)
+
+if("ACC_LIS2DOC" IN_LIST DEFINES)
+set(SOURCES ${SOURCES}
+ ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/Customer.c
+ ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/main_sample.c
+ ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/MMC5603.c
+)
+else()
+set(SOURCES ${SOURCES}
+ ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC/Customer.c
+ ${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/main_sample.c
+ ${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/MMC5603.c
+)
+endif()
+
+if("ACC_LIS2DOC" IN_LIST DEFINES)
+set(PUBLIC_HEADER
+ ${CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC
+)
+else()
+set(PUBLIC_HEADER
+ {CMAKE_CURRENT_SOURCE_DIR}/lis2doc_STdC
+)
+endif()
+
+set(PRIVATE_HEADER
+)
+
+set(PRIVATE_DEFINES
+)
+
+set(PUBLIC_DEFINES
+)
+
+# use this when you want to add ccflags like -include xxx
+set(COMPONENT_PUBLIC_CCFLAGS
+)
+
+set(COMPONENT_CCFLAGS
+ -Wno-incompatible-function-pointer-types
+ -Wno-unused-function
+)
+
+set(WHOLE_LINK
+ true
+)
+
+set(MAIN_COMPONENT
+ false
+)
+
+build_component()
+
+install_sdk(${CMAKE_CURRENT_SOURCE_DIR} "*")
--- /dev/null
+\r
+In the 'driver' folder there are the driver files of Mems Sensor (.h and .c) \r
+to be included in your project. \r
+ \r
+Driver documentation can be generate using Doxigen tool. \r
+ \r
+The driver is platform independent, you need only to complete the two functions \r
+for write and read from Mems Hardware Bus. \r
+ \r
+The files (.c) in 'example' folder, are examples showing how to integrate \r
+the Standard C driver in a project. They are written for STM32 \r
+Microcontroller using CubeMX API, but you can use it as a guideline for \r
+every hardware. \r
+ \r
+www.st.com/mems \r
+ \r
+LIS2DOC DS rev1 \r
+\r
--- /dev/null
+/**\r
+ ******************************************************************************\r
+ * @file lis2doc_reg.c\r
+ * @author Sensors Software Solution Team\r
+ * @brief LIS2DOC driver file\r
+ ******************************************************************************\r
+ * @attention\r
+ *\r
+ * <h2><center>© Copyright (c) 2021 STMicroelectronics.\r
+ * All rights reserved.</center></h2>\r
+ *\r
+ * This software component is licensed by ST under BSD 3-Clause license,\r
+ * the "License"; You may not use this file except in compliance with the\r
+ * License. You may obtain a copy of the License at:\r
+ * opensource.org/licenses/BSD-3-Clause\r
+ *\r
+ ******************************************************************************\r
+ */\r
+\r
+#include "lis2doc_reg.h"\r
+\r
+/**\r
+ * @defgroup LIS2DOC\r
+ * @brief This file provides a set of functions needed to drive the\r
+ * lis2doc enhanced inertial module.\r
+ * @{\r
+ *\r
+ */\r
+\r
+/**\r
+ * @defgroup LIS2DOC_Interfaces_Functions\r
+ * @brief This section provide a set of functions used to read and\r
+ * write a generic register of the device.\r
+ * MANDATORY: return 0 -> no Error.\r
+ * @{\r
+ *\r
+ */\r
+\r
+/**\r
+ * @brief Read generic device register\r
+ *\r
+ * @param ctx read / write interface definitions(ptr)\r
+ * @param reg register to read\r
+ * @param data pointer to buffer that store the data read(ptr)\r
+ * @param len number of consecutive register to read\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t __weak lis2doc_read_reg(stmdev_ctx_t *ctx, uint8_t reg,\r
+ uint8_t *data,\r
+ uint16_t len)\r
+{\r
+ int32_t ret;\r
+\r
+ ret = ctx->read_reg(ctx->handle, reg, data, len);\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Write generic device register\r
+ *\r
+ * @param ctx read / write interface definitions(ptr)\r
+ * @param reg register to write\r
+ * @param data pointer to data to write in register reg(ptr)\r
+ * @param len number of consecutive register to write\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t __weak lis2doc_write_reg(stmdev_ctx_t *ctx, uint8_t reg,\r
+ uint8_t *data,\r
+ uint16_t len)\r
+{\r
+ int32_t ret;\r
+\r
+ ret = ctx->write_reg(ctx->handle, reg, data, len);\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @}\r
+ *\r
+ */\r
+\r
+/**\r
+ * @defgroup LIS2DOC_Sensitivity\r
+ * @brief These functions convert raw-data into engineering units.\r
+ * @{\r
+ *\r
+ */\r
+\r
+float_t lis2doc_from_fs2_to_mg(int16_t lsb)\r
+{\r
+ return ((float_t)lsb) * 0.061f;\r
+}\r
+\r
+float_t lis2doc_from_fs4_to_mg(int16_t lsb)\r
+{\r
+ return ((float_t)lsb) * 0.122f;\r
+}\r
+\r
+float_t lis2doc_from_fs8_to_mg(int16_t lsb)\r
+{\r
+ return ((float_t)lsb) * 0.244f;\r
+}\r
+\r
+float_t lis2doc_from_fs16_to_mg(int16_t lsb)\r
+{\r
+ return ((float_t)lsb) * 0.488f;\r
+}\r
+\r
+float_t lis2doc_from_fs2_lp1_to_mg(int16_t lsb)\r
+{\r
+ return ((float_t)lsb) * 0.061f;\r
+}\r
+\r
+float_t lis2doc_from_fs4_lp1_to_mg(int16_t lsb)\r
+{\r
+ return ((float_t)lsb) * 0.122f;\r
+}\r
+\r
+float_t lis2doc_from_fs8_lp1_to_mg(int16_t lsb)\r
+{\r
+ return ((float_t)lsb) * 0.244f;\r
+}\r
+\r
+float_t lis2doc_from_fs16_lp1_to_mg(int16_t lsb)\r
+{\r
+ return ((float_t)lsb) * 0.488f;\r
+}\r
+\r
+float_t lis2doc_from_lsb_to_celsius(int16_t lsb)\r
+{\r
+ return (((float_t)lsb / 256.0f) + 25.0f);\r
+}\r
+\r
+/**\r
+ * @}\r
+ *\r
+ */\r
+\r
+/**\r
+ * @defgroup LIS2DOC_Data_Generation\r
+ * @brief This section groups all the functions concerning\r
+ * data generation\r
+ * @{\r
+ *\r
+ */\r
+\r
+/**\r
+ * @brief Select accelerometer operating modes.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of mode / lp_mode in reg CTRL1\r
+ * and low_noise in reg CTRL6\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_power_mode_set(stmdev_ctx_t *ctx,\r
+ lis2doc_mode_t val)\r
+{\r
+ lis2doc_ctrl1_t ctrl1;\r
+ lis2doc_ctrl6_t ctrl6;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL1, (uint8_t *) &ctrl1, 1);\r
+ if (ret != 0) { return ret; }\r
+\r
+ ctrl1.sdrc_en = val.sdrc;\r
+ ctrl1.lpm_en = val.lpm;\r
+ ctrl1.hpm_en = val.hpm;\r
+\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL1, (uint8_t *) &ctrl1, 1);\r
+ if (ret != 0) { return ret; }\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL6, (uint8_t *) &ctrl6, 1);\r
+ ctrl6.low_noise = val.low_noise;\r
+ ret += lis2doc_write_reg(ctx, LIS2DOC_CTRL6, (uint8_t *) &ctrl6, 1);\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Select accelerometer operating modes.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of mode / lp_mode in reg CTRL1\r
+ * and low_noise in reg CTRL6\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_power_mode_get(stmdev_ctx_t *ctx,\r
+ lis2doc_mode_t *val)\r
+{\r
+ lis2doc_ctrl1_t ctrl1;\r
+ lis2doc_ctrl6_t ctrl6;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL1, (uint8_t *) &ctrl1, 1);\r
+ ret += lis2doc_read_reg(ctx, LIS2DOC_CTRL6, (uint8_t *) &ctrl6, 1);\r
+ if (ret != 0) { return ret; }\r
+\r
+ val->sdrc = ctrl1.sdrc_en;\r
+ val->lpm = ctrl1.lpm_en;\r
+ val->hpm = ctrl1.hpm_en;\r
+ val->low_noise = ctrl6.low_noise;\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Accelerometer data rate selection.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of odr in reg CTRL1\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_data_rate_set(stmdev_ctx_t *ctx, lis2doc_odr_t val)\r
+{\r
+ lis2doc_ctrl1_t ctrl1;\r
+ lis2doc_ctrl3_t ctrl3;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL1, (uint8_t *) &ctrl1, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ ctrl1.odr = (uint8_t) val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL1, (uint8_t *) &ctrl1, 1);\r
+ }\r
+\r
+ if (ret == 0)\r
+ {\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) &ctrl3, 1);\r
+ }\r
+\r
+ if (ret == 0)\r
+ {\r
+ ctrl3.slp_mode = ((uint8_t) val & 0x30U) >> 4;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) &ctrl3, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Accelerometer data rate selection.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val Get the values of odr in reg CTRL1\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_data_rate_get(stmdev_ctx_t *ctx, lis2doc_odr_t *val)\r
+{\r
+ lis2doc_ctrl1_t ctrl1;\r
+ lis2doc_ctrl3_t ctrl3;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL1, (uint8_t *) &ctrl1, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) &ctrl3, 1);\r
+\r
+ switch ((ctrl3.slp_mode << 4) + ctrl1.odr)\r
+ {\r
+ case LIS2DOC_XL_ODR_OFF:\r
+ *val = LIS2DOC_XL_ODR_OFF;\r
+ break;\r
+\r
+ case LIS2DOC_XL_ODR_1Hz6_LP_ONLY:\r
+ *val = LIS2DOC_XL_ODR_1Hz6_LP_ONLY;\r
+ break;\r
+\r
+ case LIS2DOC_XL_ODR_12Hz5:\r
+ *val = LIS2DOC_XL_ODR_12Hz5;\r
+ break;\r
+\r
+ case LIS2DOC_XL_ODR_25Hz:\r
+ *val = LIS2DOC_XL_ODR_25Hz;\r
+ break;\r
+\r
+ case LIS2DOC_XL_ODR_50Hz:\r
+ *val = LIS2DOC_XL_ODR_50Hz;\r
+ break;\r
+\r
+ case LIS2DOC_XL_ODR_100Hz:\r
+ *val = LIS2DOC_XL_ODR_100Hz;\r
+ break;\r
+\r
+ case LIS2DOC_XL_ODR_200Hz:\r
+ *val = LIS2DOC_XL_ODR_200Hz;\r
+ break;\r
+\r
+ case LIS2DOC_XL_ODR_400Hz:\r
+ *val = LIS2DOC_XL_ODR_400Hz;\r
+ break;\r
+\r
+ case LIS2DOC_XL_ODR_800Hz:\r
+ *val = LIS2DOC_XL_ODR_800Hz;\r
+ break;\r
+\r
+ case LIS2DOC_XL_ODR_1k6Hz:\r
+ *val = LIS2DOC_XL_ODR_1k6Hz;\r
+ break;\r
+\r
+ case LIS2DOC_XL_SET_SW_TRIG:\r
+ *val = LIS2DOC_XL_SET_SW_TRIG;\r
+ break;\r
+\r
+ case LIS2DOC_XL_SET_PIN_TRIG:\r
+ *val = LIS2DOC_XL_SET_PIN_TRIG;\r
+ break;\r
+\r
+ default:\r
+ *val = LIS2DOC_XL_ODR_OFF;\r
+ break;\r
+ }\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Block data update.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of bdu in reg CTRL2\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_block_data_update_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+ lis2doc_ctrl2_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.bdu = val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Block data update.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of bdu in reg CTRL2\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_block_data_update_get(stmdev_ctx_t *ctx,\r
+ uint8_t *val)\r
+{\r
+ lis2doc_ctrl2_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) ®, 1);\r
+ *val = reg.bdu;\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Accelerometer full-scale selection.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of fs in reg CTRL6\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_full_scale_set(stmdev_ctx_t *ctx, lis2doc_fs_t val)\r
+{\r
+ lis2doc_ctrl6_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL6, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.fs = (uint8_t) val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL6, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Accelerometer full-scale selection.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val Get the values of fs in reg CTRL6\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_full_scale_get(stmdev_ctx_t *ctx, lis2doc_fs_t *val)\r
+{\r
+ lis2doc_ctrl6_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL6, (uint8_t *) ®, 1);\r
+\r
+ switch (reg.fs)\r
+ {\r
+ case LIS2DOC_2g:\r
+ *val = LIS2DOC_2g;\r
+ break;\r
+\r
+ case LIS2DOC_4g:\r
+ *val = LIS2DOC_4g;\r
+ break;\r
+\r
+ case LIS2DOC_8g:\r
+ *val = LIS2DOC_8g;\r
+ break;\r
+\r
+ case LIS2DOC_16g:\r
+ *val = LIS2DOC_16g;\r
+ break;\r
+\r
+ default:\r
+ *val = LIS2DOC_2g;\r
+ break;\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief The STATUS_REG register of the device.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val union of registers from STATUS to\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_status_reg_get(stmdev_ctx_t *ctx,\r
+ lis2doc_status_t *val)\r
+{\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_STATUS, (uint8_t *) val, 1);\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Accelerometer new data available.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of drdy in reg STATUS\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_flag_data_ready_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+ lis2doc_status_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_STATUS, (uint8_t *) ®, 1);\r
+ *val = reg.drdy;\r
+\r
+ return ret;\r
+}\r
+/**\r
+ * @brief Read all the interrupt/status flag of the device.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val registers STATUS_DUP, WAKE_UP_SRC,\r
+ * TAP_SRC, SIXD_SRC, ALL_INT_SRC\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_all_sources_get(stmdev_ctx_t *ctx,\r
+ lis2doc_all_sources_t *val)\r
+{\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_STATUS_DUP, (uint8_t *) val, 5);\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Accelerometer X-axis user offset correction expressed in two’s\r
+ * complement, weight depends on bit USR_OFF_W. The value must be\r
+ * in the range [-127 127].[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param buff buffer that contains data to write\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_usr_offset_x_set(stmdev_ctx_t *ctx, uint8_t *buff)\r
+{\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_X_OFS_USR, buff, 1);\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Accelerometer X-axis user offset correction expressed in two’s\r
+ * complement, weight depends on bit USR_OFF_W. The value must be\r
+ * in the range [-127 127].[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param buff buffer that stores data read\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_usr_offset_x_get(stmdev_ctx_t *ctx, uint8_t *buff)\r
+{\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_X_OFS_USR, buff, 1);\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Accelerometer Y-axis user offset correction expressed in two’s\r
+ * complement, weight depends on bit USR_OFF_W. The value must be\r
+ * in the range [-127 127].[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param buff buffer that contains data to write\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_usr_offset_y_set(stmdev_ctx_t *ctx, uint8_t *buff)\r
+{\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_Y_OFS_USR, buff, 1);\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Accelerometer Y-axis user offset correction expressed in two’s\r
+ * complement, weight depends on bit USR_OFF_W. The value must be\r
+ * in the range [-127 127].[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param buff buffer that stores data read\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_usr_offset_y_get(stmdev_ctx_t *ctx, uint8_t *buff)\r
+{\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_Y_OFS_USR, buff, 1);\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Accelerometer Z-axis user offset correction expressed in two’s\r
+ * complement, weight depends on bit USR_OFF_W. The value must be\r
+ * in the range [-127 127].[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param buff buffer that contains data to write\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_usr_offset_z_set(stmdev_ctx_t *ctx, uint8_t *buff)\r
+{\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_Z_OFS_USR, buff, 1);\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Accelerometer Z-axis user offset correction expressed in two’s\r
+ * complement, weight depends on bit USR_OFF_W. The value must be\r
+ * in the range [-127 127].[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param buff buffer that stores data read\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_usr_offset_z_get(stmdev_ctx_t *ctx, uint8_t *buff)\r
+{\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_Z_OFS_USR, buff, 1);\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Weight of XL user offset bits of registers X_OFS_USR,\r
+ * Y_OFS_USR, Z_OFS_USR.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of usr_off_w in\r
+ * reg CTRL_REG7\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_offset_weight_set(stmdev_ctx_t *ctx,\r
+ lis2doc_usr_off_w_t val)\r
+{\r
+ lis2doc_ctrl_reg7_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.usr_off_w = (uint8_t) val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Weight of XL user offset bits of registers X_OFS_USR,\r
+ * Y_OFS_USR, Z_OFS_USR.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val Get the values of usr_off_w in reg CTRL_REG7\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_offset_weight_get(stmdev_ctx_t *ctx,\r
+ lis2doc_usr_off_w_t *val)\r
+{\r
+ lis2doc_ctrl_reg7_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) ®, 1);\r
+\r
+ switch (reg.usr_off_w)\r
+ {\r
+ case LIS2DOC_LSb_977ug:\r
+ *val = LIS2DOC_LSb_977ug;\r
+ break;\r
+\r
+ case LIS2DOC_LSb_15mg6:\r
+ *val = LIS2DOC_LSb_15mg6;\r
+ break;\r
+\r
+ default:\r
+ *val = LIS2DOC_LSb_977ug;\r
+ break;\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @}\r
+ *\r
+ */\r
+\r
+/**\r
+ * @defgroup LIS2DOC_Data_Output\r
+ * @brief This section groups all the data output functions.\r
+ * @{\r
+ *\r
+ */\r
+\r
+/**\r
+ * @brief Temperature data output register (r). L and H registers\r
+ * together express a 16-bit word in two’s complement.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val buffer that stores data read\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_temperature_raw_get(stmdev_ctx_t *ctx, int16_t *val)\r
+{\r
+ uint8_t buff[2];\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_OUT_T_L, buff, 2);\r
+ *val = (int16_t)buff[1];\r
+ *val = (*val * 256) + (int16_t)buff[0];\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Linear acceleration output register. The value is expressed as\r
+ * a 16-bit word in two’s complement.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val buffer that stores data read\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_acceleration_raw_get(stmdev_ctx_t *ctx, int16_t *val)\r
+{\r
+ uint8_t buff[6];\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_OUT_X_L, buff, 6);\r
+ val[0] = (int16_t)buff[1];\r
+ val[0] = (val[0] * 256) + (int16_t)buff[0];\r
+ val[1] = (int16_t)buff[3];\r
+ val[1] = (val[1] * 256) + (int16_t)buff[2];\r
+ val[2] = (int16_t)buff[5];\r
+ val[2] = (val[2] * 256) + (int16_t)buff[4];\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @}\r
+ *\r
+ */\r
+\r
+/**\r
+ * @defgroup LIS2DOC_Common\r
+ * @brief This section groups common useful functions.\r
+ * @{\r
+ *\r
+ */\r
+\r
+/**\r
+ * @brief Device Who am I.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param buff buffer that stores data read\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_device_id_get(stmdev_ctx_t *ctx, uint8_t *buff)\r
+{\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_WHO_AM_I, buff, 1);\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Register address automatically incremented during multiple byte\r
+ * access with a serial interface.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of if_add_inc in reg CTRL2\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_auto_increment_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+ lis2doc_ctrl2_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.if_add_inc = val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Register address automatically incremented during multiple\r
+ * byte access with a serial interface.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of if_add_inc in reg CTRL2\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_auto_increment_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+ lis2doc_ctrl2_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) ®, 1);\r
+ *val = reg.if_add_inc;\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Software reset. Restore the default values in user registers.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of soft_reset in reg CTRL2\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_reset_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+ lis2doc_ctrl2_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.soft_reset = val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Software reset. Restore the default values in user registers.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of soft_reset in reg CTRL2\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_reset_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+ lis2doc_ctrl2_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) ®, 1);\r
+ *val = reg.soft_reset;\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Reboot memory content. Reload the calibration parameters.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of boot in reg CTRL2\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_boot_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+ lis2doc_ctrl2_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.boot = val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Reboot memory content. Reload the calibration parameters.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of boot in reg CTRL2\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_boot_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+ lis2doc_ctrl2_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) ®, 1);\r
+ *val = reg.boot;\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Sensor self-test enable.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of st in reg CTRL3\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_self_test_set(stmdev_ctx_t *ctx, lis2doc_st_t val)\r
+{\r
+ lis2doc_ctrl3_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.st = (uint8_t) val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Sensor self-test enable.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val Get the values of st in reg CTRL3\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_self_test_get(stmdev_ctx_t *ctx, lis2doc_st_t *val)\r
+{\r
+ lis2doc_ctrl3_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) ®, 1);\r
+\r
+ switch (reg.st)\r
+ {\r
+ case LIS2DOC_XL_ST_DISABLE:\r
+ *val = LIS2DOC_XL_ST_DISABLE;\r
+ break;\r
+\r
+ case LIS2DOC_XL_ST_POSITIVE:\r
+ *val = LIS2DOC_XL_ST_POSITIVE;\r
+ break;\r
+\r
+ case LIS2DOC_XL_ST_NEGATIVE:\r
+ *val = LIS2DOC_XL_ST_NEGATIVE;\r
+ break;\r
+\r
+ default:\r
+ *val = LIS2DOC_XL_ST_DISABLE;\r
+ break;\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Data-ready pulsed / letched mode.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of drdy_pulsed in reg CTRL_REG7\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_data_ready_mode_set(stmdev_ctx_t *ctx,\r
+ lis2doc_drdy_pulsed_t val)\r
+{\r
+ lis2doc_ctrl_reg7_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.drdy_pulsed = (uint8_t) val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Data-ready pulsed / letched mode.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val Get the values of drdy_pulsed in reg CTRL_REG7\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_data_ready_mode_get(stmdev_ctx_t *ctx,\r
+ lis2doc_drdy_pulsed_t *val)\r
+{\r
+ lis2doc_ctrl_reg7_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) ®, 1);\r
+\r
+ switch (reg.drdy_pulsed)\r
+ {\r
+ case LIS2DOC_DRDY_LATCHED:\r
+ *val = LIS2DOC_DRDY_LATCHED;\r
+ break;\r
+\r
+ case LIS2DOC_DRDY_PULSED:\r
+ *val = LIS2DOC_DRDY_PULSED;\r
+ break;\r
+\r
+ default:\r
+ *val = LIS2DOC_DRDY_LATCHED;\r
+ break;\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @}\r
+ *\r
+ */\r
+\r
+/**\r
+ * @defgroup LIS2DOC_Filters\r
+ * @brief This section group all the functions concerning the filters\r
+ * configuration.\r
+ * @{\r
+ *\r
+ */\r
+\r
+/**\r
+ * @brief Accelerometer filtering path for outputs.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of fds in reg CTRL6\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_filter_path_set(stmdev_ctx_t *ctx,\r
+ lis2doc_fds_t val)\r
+{\r
+ lis2doc_ctrl6_t ctrl6;\r
+ lis2doc_ctrl_reg7_t ctrl_reg7;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL6, (uint8_t *) &ctrl6, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ ctrl6.fds = ((uint8_t) val & 0x10U) >> 4;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL6, (uint8_t *) &ctrl6, 1);\r
+ }\r
+\r
+ if (ret == 0)\r
+ {\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7,\r
+ (uint8_t *) &ctrl_reg7, 1);\r
+ }\r
+\r
+ if (ret == 0)\r
+ {\r
+ ctrl_reg7.usr_off_on_out = (uint8_t) val & 0x01U;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL_REG7,\r
+ (uint8_t *) &ctrl_reg7, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Accelerometer filtering path for outputs.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val Get the values of fds in reg CTRL6\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_filter_path_get(stmdev_ctx_t *ctx,\r
+ lis2doc_fds_t *val)\r
+{\r
+ lis2doc_ctrl6_t ctrl6;\r
+ lis2doc_ctrl_reg7_t ctrl_reg7;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL6, (uint8_t *) &ctrl6, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7,\r
+ (uint8_t *) &ctrl_reg7, 1);\r
+\r
+ switch ((ctrl6.fds << 4) + ctrl_reg7.usr_off_on_out)\r
+ {\r
+ case LIS2DOC_LPF_ON_OUT:\r
+ *val = LIS2DOC_LPF_ON_OUT;\r
+ break;\r
+\r
+ case LIS2DOC_USER_OFFSET_ON_OUT:\r
+ *val = LIS2DOC_USER_OFFSET_ON_OUT;\r
+ break;\r
+\r
+ case LIS2DOC_HIGH_PASS_ON_OUT:\r
+ *val = LIS2DOC_HIGH_PASS_ON_OUT;\r
+ break;\r
+\r
+ default:\r
+ *val = LIS2DOC_LPF_ON_OUT;\r
+ break;\r
+ }\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Accelerometer cutoff filter frequency. Valid for low and high\r
+ * pass filter.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of bw_filt in reg CTRL6\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_filter_bandwidth_set(stmdev_ctx_t *ctx,\r
+ lis2doc_bw_filt_t val)\r
+{\r
+ lis2doc_ctrl6_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL6, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.bw_filt = (uint8_t) val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL6, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Accelerometer cutoff filter frequency. Valid for low and\r
+ * high pass filter.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val Get the values of bw_filt in reg CTRL6\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_filter_bandwidth_get(stmdev_ctx_t *ctx,\r
+ lis2doc_bw_filt_t *val)\r
+{\r
+ lis2doc_ctrl6_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL6, (uint8_t *) ®, 1);\r
+\r
+ switch (reg.bw_filt)\r
+ {\r
+ case LIS2DOC_ODR_DIV_2:\r
+ *val = LIS2DOC_ODR_DIV_2;\r
+ break;\r
+\r
+ case LIS2DOC_ODR_DIV_4:\r
+ *val = LIS2DOC_ODR_DIV_4;\r
+ break;\r
+\r
+ case LIS2DOC_ODR_DIV_10:\r
+ *val = LIS2DOC_ODR_DIV_10;\r
+ break;\r
+\r
+ case LIS2DOC_ODR_DIV_20:\r
+ *val = LIS2DOC_ODR_DIV_20;\r
+ break;\r
+\r
+ default:\r
+ *val = LIS2DOC_ODR_DIV_2;\r
+ break;\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Enable HP filter reference mode.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of hp_ref_mode in reg CTRL_REG7\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_reference_mode_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+ lis2doc_ctrl_reg7_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.hp_ref_mode = val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Enable HP filter reference mode.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of hp_ref_mode in reg CTRL_REG7\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_reference_mode_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+ lis2doc_ctrl_reg7_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) ®, 1);\r
+ *val = reg.hp_ref_mode;\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @}\r
+ *\r
+ */\r
+\r
+/**\r
+ * @defgroup LIS2DOC_Serial_Interface\r
+ * @brief This section groups all the functions concerning main serial\r
+ * interface management (not auxiliary)\r
+ * @{\r
+ *\r
+ */\r
+\r
+/**\r
+ * @brief SPI Serial Interface Mode selection.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of sim in reg CTRL2\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_spi_mode_set(stmdev_ctx_t *ctx, lis2doc_sim_t val)\r
+{\r
+ lis2doc_ctrl2_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.sim = (uint8_t) val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief SPI Serial Interface Mode selection.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val Get the values of sim in reg CTRL2\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_spi_mode_get(stmdev_ctx_t *ctx, lis2doc_sim_t *val)\r
+{\r
+ lis2doc_ctrl2_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) ®, 1);\r
+\r
+ switch (reg.sim)\r
+ {\r
+ case LIS2DOC_SPI_4_WIRE:\r
+ *val = LIS2DOC_SPI_4_WIRE;\r
+ break;\r
+\r
+ case LIS2DOC_SPI_3_WIRE:\r
+ *val = LIS2DOC_SPI_3_WIRE;\r
+ break;\r
+\r
+ default:\r
+ *val = LIS2DOC_SPI_4_WIRE;\r
+ break;\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Disable / Enable I2C interface.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of i2c_disable in\r
+ * reg CTRL2\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_i2c_interface_set(stmdev_ctx_t *ctx,\r
+ lis2doc_i2c_disable_t val)\r
+{\r
+ lis2doc_ctrl2_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.i2c_disable = (uint8_t) val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Disable / Enable I2C interface.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val Get the values of i2c_disable in reg CTRL2\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_i2c_interface_get(stmdev_ctx_t *ctx,\r
+ lis2doc_i2c_disable_t *val)\r
+{\r
+ lis2doc_ctrl2_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) ®, 1);\r
+\r
+ switch (reg.i2c_disable)\r
+ {\r
+ case LIS2DOC_I2C_ENABLE:\r
+ *val = LIS2DOC_I2C_ENABLE;\r
+ break;\r
+\r
+ case LIS2DOC_I2C_DISABLE:\r
+ *val = LIS2DOC_I2C_DISABLE;\r
+ break;\r
+\r
+ default:\r
+ *val = LIS2DOC_I2C_ENABLE;\r
+ break;\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Disconnect CS pull-up.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of cs_pu_disc in reg CTRL2\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_cs_mode_set(stmdev_ctx_t *ctx,\r
+ lis2doc_cs_pu_disc_t val)\r
+{\r
+ lis2doc_ctrl2_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.cs_pu_disc = (uint8_t) val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Disconnect CS pull-up.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val Get the values of cs_pu_disc in reg CTRL2\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_cs_mode_get(stmdev_ctx_t *ctx,\r
+ lis2doc_cs_pu_disc_t *val)\r
+{\r
+ lis2doc_ctrl2_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL2, (uint8_t *) ®, 1);\r
+\r
+ switch (reg.cs_pu_disc)\r
+ {\r
+ case LIS2DOC_PULL_UP_CONNECT:\r
+ *val = LIS2DOC_PULL_UP_CONNECT;\r
+ break;\r
+\r
+ case LIS2DOC_PULL_UP_DISCONNECT:\r
+ *val = LIS2DOC_PULL_UP_DISCONNECT;\r
+ break;\r
+\r
+ default:\r
+ *val = LIS2DOC_PULL_UP_CONNECT;\r
+ break;\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @}\r
+ *\r
+ */\r
+\r
+/**\r
+ * @defgroup LIS2DOC_Interrupt_Pins\r
+ * @brief This section groups all the functions that manage interrupt pins\r
+ * @{\r
+ *\r
+ */\r
+\r
+/**\r
+ * @brief Interrupt active-high/low.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of h_lactive in reg CTRL3\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_pin_polarity_set(stmdev_ctx_t *ctx,\r
+ lis2doc_h_lactive_t val)\r
+{\r
+ lis2doc_ctrl3_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.h_lactive = (uint8_t) val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Interrupt active-high/low.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val Get the values of h_lactive in reg CTRL3\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_pin_polarity_get(stmdev_ctx_t *ctx,\r
+ lis2doc_h_lactive_t *val)\r
+{\r
+ lis2doc_ctrl3_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) ®, 1);\r
+\r
+ switch (reg.h_lactive)\r
+ {\r
+ case LIS2DOC_ACTIVE_HIGH:\r
+ *val = LIS2DOC_ACTIVE_HIGH;\r
+ break;\r
+\r
+ case LIS2DOC_ACTIVE_LOW:\r
+ *val = LIS2DOC_ACTIVE_LOW;\r
+ break;\r
+\r
+ default:\r
+ *val = LIS2DOC_ACTIVE_HIGH;\r
+ break;\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Latched/pulsed interrupt.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of lir in reg CTRL3\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_int_notification_set(stmdev_ctx_t *ctx,\r
+ lis2doc_lir_t val)\r
+{\r
+ lis2doc_ctrl3_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.lir = (uint8_t) val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Latched/pulsed interrupt.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val Get the values of lir in reg CTRL3\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_int_notification_get(stmdev_ctx_t *ctx,\r
+ lis2doc_lir_t *val)\r
+{\r
+ lis2doc_ctrl3_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) ®, 1);\r
+\r
+ switch (reg.lir)\r
+ {\r
+ case LIS2DOC_INT_PULSED:\r
+ *val = LIS2DOC_INT_PULSED;\r
+ break;\r
+\r
+ case LIS2DOC_INT_LATCHED:\r
+ *val = LIS2DOC_INT_LATCHED;\r
+ break;\r
+\r
+ default:\r
+ *val = LIS2DOC_INT_PULSED;\r
+ break;\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Push-pull/open drain selection on interrupt pads.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of pp_od in reg CTRL3\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_pin_mode_set(stmdev_ctx_t *ctx, lis2doc_pp_od_t val)\r
+{\r
+ lis2doc_ctrl3_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.pp_od = (uint8_t) val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Push-pull/open drain selection on interrupt pads.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val Get the values of pp_od in reg CTRL3\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_pin_mode_get(stmdev_ctx_t *ctx,\r
+ lis2doc_pp_od_t *val)\r
+{\r
+ lis2doc_ctrl3_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL3, (uint8_t *) ®, 1);\r
+\r
+ switch (reg.pp_od)\r
+ {\r
+ case LIS2DOC_PUSH_PULL:\r
+ *val = LIS2DOC_PUSH_PULL;\r
+ break;\r
+\r
+ case LIS2DOC_OPEN_DRAIN:\r
+ *val = LIS2DOC_OPEN_DRAIN;\r
+ break;\r
+\r
+ default:\r
+ *val = LIS2DOC_PUSH_PULL;\r
+ break;\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Select the signal that need to route on int1 pad.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val register CTRL4_INT1_PAD_CTRL.\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_pin_int1_route_set(stmdev_ctx_t *ctx,\r
+ lis2doc_ctrl4_int1_pad_ctrl_t *val)\r
+{\r
+ lis2doc_ctrl5_int2_pad_ctrl_t ctrl5_int2_pad_ctrl;\r
+ lis2doc_ctrl_reg7_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL5_INT2_PAD_CTRL,\r
+ (uint8_t *)&ctrl5_int2_pad_ctrl, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ if (ret == 0)\r
+ {\r
+ if ((val->int1_tap |\r
+ val->int1_ff |\r
+ val->int1_wu |\r
+ val->int1_single_tap |\r
+ val->int1_6d |\r
+ ctrl5_int2_pad_ctrl.int2_sleep_state |\r
+ ctrl5_int2_pad_ctrl.int2_sleep_chg) != PROPERTY_DISABLE)\r
+ {\r
+ reg.interrupts_enable = PROPERTY_ENABLE;\r
+ }\r
+\r
+ else\r
+ {\r
+ reg.interrupts_enable = PROPERTY_DISABLE;\r
+ }\r
+\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL4_INT1_PAD_CTRL,\r
+ (uint8_t *) val, 1);\r
+ }\r
+\r
+ if (ret == 0)\r
+ {\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Select the signal that need to route on int1 pad.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val register CTRL4_INT1_PAD_CTRL.\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_pin_int1_route_get(stmdev_ctx_t *ctx,\r
+ lis2doc_ctrl4_int1_pad_ctrl_t *val)\r
+{\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL4_INT1_PAD_CTRL,\r
+ (uint8_t *) val, 1);\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Select the signal that need to route on int2 pad.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val register CTRL5_INT2_PAD_CTRL.\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_pin_int2_route_set(stmdev_ctx_t *ctx,\r
+ lis2doc_ctrl5_int2_pad_ctrl_t *val)\r
+{\r
+ lis2doc_ctrl4_int1_pad_ctrl_t ctrl4_int1_pad_ctrl;\r
+ lis2doc_ctrl_reg7_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL4_INT1_PAD_CTRL,\r
+ (uint8_t *) &ctrl4_int1_pad_ctrl, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ if (ret == 0)\r
+ {\r
+ if ((ctrl4_int1_pad_ctrl.int1_tap |\r
+ ctrl4_int1_pad_ctrl.int1_ff |\r
+ ctrl4_int1_pad_ctrl.int1_wu |\r
+ ctrl4_int1_pad_ctrl.int1_single_tap |\r
+ ctrl4_int1_pad_ctrl.int1_6d |\r
+ val->int2_sleep_state | val->int2_sleep_chg) != PROPERTY_DISABLE)\r
+ {\r
+ reg.interrupts_enable = PROPERTY_ENABLE;\r
+ }\r
+\r
+ else\r
+ {\r
+ reg.interrupts_enable = PROPERTY_DISABLE;\r
+ }\r
+\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL5_INT2_PAD_CTRL,\r
+ (uint8_t *) val, 1);\r
+ }\r
+\r
+ if (ret == 0)\r
+ {\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Select the signal that need to route on int2 pad.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val register CTRL5_INT2_PAD_CTRL\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_pin_int2_route_get(stmdev_ctx_t *ctx,\r
+ lis2doc_ctrl5_int2_pad_ctrl_t *val)\r
+{\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL5_INT2_PAD_CTRL,\r
+ (uint8_t *) val, 1);\r
+\r
+ return ret;\r
+}\r
+/**\r
+ * @brief All interrupt signals become available on INT1 pin.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of int2_on_int1 in reg CTRL_REG7\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_all_on_int1_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+ lis2doc_ctrl_reg7_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.int2_on_int1 = val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief All interrupt signals become available on INT1 pin.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of int2_on_int1 in reg CTRL_REG7\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_all_on_int1_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+ lis2doc_ctrl_reg7_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) ®, 1);\r
+ *val = reg.int2_on_int1;\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @}\r
+ *\r
+ */\r
+\r
+/**\r
+ * @defgroup LIS2DOC_Wake_Up_Event\r
+ * @brief This section groups all the functions that manage the Wake\r
+ * Up event generation.\r
+ * @{\r
+ *\r
+ */\r
+\r
+/**\r
+ * @brief Threshold for wakeup.1 LSB = FS_XL / 64.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of wk_ths in reg WAKE_UP_THS\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_wkup_threshold_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+ lis2doc_wake_up_ths_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_THS, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.wk_ths = val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_WAKE_UP_THS, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Threshold for wakeup.1 LSB = FS_XL / 64.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of wk_ths in reg WAKE_UP_THS\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_wkup_threshold_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+ lis2doc_wake_up_ths_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_THS, (uint8_t *) ®, 1);\r
+ *val = reg.wk_ths;\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Wake up duration event.1LSb = 1 / ODR.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of wake_dur in reg WAKE_UP_DUR\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_wkup_dur_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+ lis2doc_wake_up_dur_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_DUR, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.wake_dur = val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_WAKE_UP_DUR, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Wake up duration event.1LSb = 1 / ODR.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of wake_dur in reg WAKE_UP_DUR\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_wkup_dur_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+ lis2doc_wake_up_dur_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_DUR, (uint8_t *) ®, 1);\r
+ *val = reg.wake_dur;\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Data sent to wake-up interrupt function.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of usr_off_on_wu in reg CTRL_REG7\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_wkup_feed_data_set(stmdev_ctx_t *ctx,\r
+ lis2doc_usr_off_on_wu_t val)\r
+{\r
+ lis2doc_ctrl_reg7_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.usr_off_on_wu = (uint8_t) val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Data sent to wake-up interrupt function.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val Get the values of usr_off_on_wu in reg CTRL_REG7\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_wkup_feed_data_get(stmdev_ctx_t *ctx,\r
+ lis2doc_usr_off_on_wu_t *val)\r
+{\r
+ lis2doc_ctrl_reg7_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) ®, 1);\r
+\r
+ switch (reg.usr_off_on_wu)\r
+ {\r
+ case LIS2DOC_HP_FEED:\r
+ *val = LIS2DOC_HP_FEED;\r
+ break;\r
+\r
+ case LIS2DOC_USER_OFFSET_FEED:\r
+ *val = LIS2DOC_USER_OFFSET_FEED;\r
+ break;\r
+\r
+ default:\r
+ *val = LIS2DOC_HP_FEED;\r
+ break;\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @}\r
+ *\r
+ */\r
+\r
+/**\r
+ * @defgroup LIS2DOC_Activity/Inactivity_Detection\r
+ * @brief This section groups all the functions concerning\r
+ * activity/inactivity detection.\r
+ * @{\r
+ *\r
+ */\r
+\r
+/**\r
+ * @brief Config activity / inactivity or\r
+ * stationary / motion detection.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of sleep_on / stationary in\r
+ * reg WAKE_UP_THS / WAKE_UP_DUR\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_act_mode_set(stmdev_ctx_t *ctx,\r
+ lis2doc_sleep_on_t val)\r
+{\r
+ lis2doc_wake_up_ths_t wake_up_ths;\r
+ lis2doc_wake_up_dur_t wake_up_dur;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_THS,\r
+ (uint8_t *) &wake_up_ths, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_DUR,\r
+ (uint8_t *) &wake_up_dur, 1);\r
+ }\r
+\r
+ if (ret == 0)\r
+ {\r
+ wake_up_ths.sleep_on = (uint8_t) val & 0x01U;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_WAKE_UP_THS,\r
+ (uint8_t *) &wake_up_ths, 1);\r
+ }\r
+\r
+ if (ret == 0)\r
+ {\r
+ wake_up_dur.stationary = ((uint8_t)val & 0x02U) >> 1;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_WAKE_UP_DUR,\r
+ (uint8_t *) &wake_up_dur, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Config activity / inactivity or\r
+ * stationary / motion detection. [get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val Get the values of sleep_on in reg WAKE_UP_THS\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_act_mode_get(stmdev_ctx_t *ctx,\r
+ lis2doc_sleep_on_t *val)\r
+{\r
+ lis2doc_wake_up_ths_t wake_up_ths;\r
+ lis2doc_wake_up_dur_t wake_up_dur;;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_THS,\r
+ (uint8_t *) &wake_up_ths, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_DUR,\r
+ (uint8_t *) &wake_up_dur, 1);\r
+\r
+ switch ((wake_up_dur.stationary << 1) + wake_up_ths.sleep_on)\r
+ {\r
+ case LIS2DOC_NO_DETECTION:\r
+ *val = LIS2DOC_NO_DETECTION;\r
+ break;\r
+\r
+ case LIS2DOC_DETECT_ACT_INACT:\r
+ *val = LIS2DOC_DETECT_ACT_INACT;\r
+ break;\r
+\r
+ case LIS2DOC_DETECT_STAT_MOTION:\r
+ *val = LIS2DOC_DETECT_STAT_MOTION;\r
+ break;\r
+\r
+ default:\r
+ *val = LIS2DOC_NO_DETECTION;\r
+ break;\r
+ }\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Duration to go in sleep mode (1 LSb = 512 / ODR).[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of sleep_dur in reg WAKE_UP_DUR\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_act_sleep_dur_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+ lis2doc_wake_up_dur_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_DUR, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.sleep_dur = val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_WAKE_UP_DUR, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Duration to go in sleep mode (1 LSb = 512 / ODR).[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of sleep_dur in reg WAKE_UP_DUR\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_act_sleep_dur_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+ lis2doc_wake_up_dur_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_DUR, (uint8_t *) ®, 1);\r
+ *val = reg.sleep_dur;\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @}\r
+ *\r
+ */\r
+\r
+/**\r
+ * @defgroup LIS2DOC_Tap_Generator\r
+ * @brief This section groups all the functions that manage the tap\r
+ * and double tap event generation.\r
+ * @{\r
+ *\r
+ */\r
+\r
+/**\r
+ * @brief Threshold for tap recognition.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of tap_thsx in reg TAP_THS_X\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_tap_threshold_x_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+ lis2doc_tap_ths_x_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_X, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.tap_thsx = val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_TAP_THS_X, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Threshold for tap recognition.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of tap_thsx in reg TAP_THS_X\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_tap_threshold_x_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+ lis2doc_tap_ths_x_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_X, (uint8_t *) ®, 1);\r
+ *val = reg.tap_thsx;\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Threshold for tap recognition.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of tap_thsy in reg TAP_THS_Y\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_tap_threshold_y_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+ lis2doc_tap_ths_y_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_Y, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.tap_thsy = val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_TAP_THS_Y, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Threshold for tap recognition.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of tap_thsy in reg TAP_THS_Y\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_tap_threshold_y_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+ lis2doc_tap_ths_y_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_Y, (uint8_t *) ®, 1);\r
+ *val = reg.tap_thsy;\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Selection of axis priority for TAP detection.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of tap_prior in reg TAP_THS_Y\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_tap_axis_priority_set(stmdev_ctx_t *ctx,\r
+ lis2doc_tap_prior_t val)\r
+{\r
+ lis2doc_tap_ths_y_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_Y, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.tap_prior = (uint8_t) val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_TAP_THS_Y, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Selection of axis priority for TAP detection.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val Get the values of tap_prior in reg TAP_THS_Y\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_tap_axis_priority_get(stmdev_ctx_t *ctx,\r
+ lis2doc_tap_prior_t *val)\r
+{\r
+ lis2doc_tap_ths_y_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_Y, (uint8_t *) ®, 1);\r
+\r
+ switch (reg.tap_prior)\r
+ {\r
+ case LIS2DOC_XYZ:\r
+ *val = LIS2DOC_XYZ;\r
+ break;\r
+\r
+ case LIS2DOC_YXZ:\r
+ *val = LIS2DOC_YXZ;\r
+ break;\r
+\r
+ case LIS2DOC_XZY:\r
+ *val = LIS2DOC_XZY;\r
+ break;\r
+\r
+ case LIS2DOC_ZYX:\r
+ *val = LIS2DOC_ZYX;\r
+ break;\r
+\r
+ case LIS2DOC_YZX:\r
+ *val = LIS2DOC_YZX;\r
+ break;\r
+\r
+ case LIS2DOC_ZXY:\r
+ *val = LIS2DOC_ZXY;\r
+ break;\r
+\r
+ default:\r
+ *val = LIS2DOC_XYZ;\r
+ break;\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Threshold for tap recognition.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of tap_thsz in reg TAP_THS_Z\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_tap_threshold_z_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+ lis2doc_tap_ths_z_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_Z, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.tap_thsz = val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_TAP_THS_Z, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Threshold for tap recognition.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of tap_thsz in reg TAP_THS_Z\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_tap_threshold_z_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+ lis2doc_tap_ths_z_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_Z, (uint8_t *) ®, 1);\r
+ *val = reg.tap_thsz;\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Enable Z direction in tap recognition.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of tap_z_en in reg TAP_THS_Z\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_tap_detection_on_z_set(stmdev_ctx_t *ctx,\r
+ uint8_t val)\r
+{\r
+ lis2doc_tap_ths_z_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_Z, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.tap_z_en = val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_TAP_THS_Z, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Enable Z direction in tap recognition.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of tap_z_en in reg TAP_THS_Z\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_tap_detection_on_z_get(stmdev_ctx_t *ctx,\r
+ uint8_t *val)\r
+{\r
+ lis2doc_tap_ths_z_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_Z, (uint8_t *) ®, 1);\r
+ *val = reg.tap_z_en;\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Enable Y direction in tap recognition.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of tap_y_en in reg TAP_THS_Z\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_tap_detection_on_y_set(stmdev_ctx_t *ctx,\r
+ uint8_t val)\r
+{\r
+ lis2doc_tap_ths_z_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_Z, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.tap_y_en = val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_TAP_THS_Z, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Enable Y direction in tap recognition.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of tap_y_en in reg TAP_THS_Z\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_tap_detection_on_y_get(stmdev_ctx_t *ctx,\r
+ uint8_t *val)\r
+{\r
+ lis2doc_tap_ths_z_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_Z, (uint8_t *) ®, 1);\r
+ *val = reg.tap_y_en;\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Enable X direction in tap recognition.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of tap_x_en in reg TAP_THS_Z\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_tap_detection_on_x_set(stmdev_ctx_t *ctx,\r
+ uint8_t val)\r
+{\r
+ lis2doc_tap_ths_z_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_Z, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.tap_x_en = val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_TAP_THS_Z, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Enable X direction in tap recognition.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of tap_x_en in reg TAP_THS_Z\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_tap_detection_on_x_get(stmdev_ctx_t *ctx,\r
+ uint8_t *val)\r
+{\r
+ lis2doc_tap_ths_z_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_Z, (uint8_t *) ®, 1);\r
+ *val = reg.tap_x_en;\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Maximum duration is the maximum time of an overthreshold signal\r
+ * detection to be recognized as a tap event. The default value\r
+ * of these bits is 00b which corresponds to 4*ODR_XL time.\r
+ * If the SHOCK[1:0] bits are set to a different value, 1LSB\r
+ * corresponds to 8*ODR_XL time.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of shock in reg INT_DUR\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_tap_shock_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+ lis2doc_int_dur_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_INT_DUR, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.shock = val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_INT_DUR, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Maximum duration is the maximum time of an overthreshold signal\r
+ * detection to be recognized as a tap event. The default value\r
+ * of these bits is 00b which corresponds to 4*ODR_XL time.\r
+ * If the SHOCK[1:0] bits are set to a different value, 1LSB\r
+ * corresponds to 8*ODR_XL time.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of shock in reg INT_DUR\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_tap_shock_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+ lis2doc_int_dur_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_INT_DUR, (uint8_t *) ®, 1);\r
+ *val = reg.shock;\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Quiet time is the time after the first detected tap in which\r
+ * there must not be any overthreshold event.\r
+ * The default value of these bits is 00b which corresponds\r
+ * to 2*ODR_XL time. If the QUIET[1:0] bits are set to a different\r
+ * value, 1LSB corresponds to 4*ODR_XL time.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of quiet in reg INT_DUR\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_tap_quiet_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+ lis2doc_int_dur_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_INT_DUR, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.quiet = val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_INT_DUR, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Quiet time is the time after the first detected tap in which\r
+ * there must not be any overthreshold event.\r
+ * The default value of these bits is 00b which corresponds\r
+ * to 2*ODR_XL time. If the QUIET[1:0] bits are set to a different\r
+ * value, 1LSB corresponds to 4*ODR_XL time.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of quiet in reg INT_DUR\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_tap_quiet_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+ lis2doc_int_dur_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_INT_DUR, (uint8_t *) ®, 1);\r
+ *val = reg.quiet;\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief When double tap recognition is enabled, this register expresses\r
+ * the maximum time between two consecutive detected taps to\r
+ * determine a double tap event.\r
+ * The default value of these bits is 0000b which corresponds\r
+ * to 16*ODR_XL time. If the DUR[3:0] bits are set to a different\r
+ * value, 1LSB corresponds to 32*ODR_XL time.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of latency in reg INT_DUR\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_tap_dur_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+ lis2doc_int_dur_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_INT_DUR, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.latency = val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_INT_DUR, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief When double tap recognition is enabled, this register expresses\r
+ * the maximum time between two consecutive detected taps to\r
+ * determine a double tap event.\r
+ * The default value of these bits is 0000b which corresponds\r
+ * to 16*ODR_XL time. If the DUR[3:0] bits are set to a different\r
+ * value, 1LSB corresponds to 32*ODR_XL time.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of latency in reg INT_DUR\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_tap_dur_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+ lis2doc_int_dur_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_INT_DUR, (uint8_t *) ®, 1);\r
+ *val = reg.latency;\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Single/double-tap event enable.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of single_double_tap in reg WAKE_UP_THS\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_tap_mode_set(stmdev_ctx_t *ctx,\r
+ lis2doc_single_double_tap_t val)\r
+{\r
+ lis2doc_wake_up_ths_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_THS, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.single_double_tap = (uint8_t) val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_WAKE_UP_THS, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Single/double-tap event enable.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val Get the values of single_double_tap in reg WAKE_UP_THS\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_tap_mode_get(stmdev_ctx_t *ctx,\r
+ lis2doc_single_double_tap_t *val)\r
+{\r
+ lis2doc_wake_up_ths_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_THS, (uint8_t *) ®, 1);\r
+\r
+ switch (reg.single_double_tap)\r
+ {\r
+ case LIS2DOC_ONLY_SINGLE:\r
+ *val = LIS2DOC_ONLY_SINGLE;\r
+ break;\r
+\r
+ case LIS2DOC_BOTH_SINGLE_DOUBLE:\r
+ *val = LIS2DOC_BOTH_SINGLE_DOUBLE;\r
+ break;\r
+\r
+ default:\r
+ *val = LIS2DOC_ONLY_SINGLE;\r
+ break;\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Read the tap / double tap source register.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param lis2doc_tap_src: union of registers from TAP_SRC to\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_tap_src_get(stmdev_ctx_t *ctx,\r
+ lis2doc_tap_src_t *val)\r
+{\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_SRC, (uint8_t *) val, 1);\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @}\r
+ *\r
+ */\r
+\r
+/**\r
+ * @defgroup LIS2DOC_Six_Position_Detection(6D/4D)\r
+ * @brief This section groups all the functions concerning six\r
+ * position detection (6D).\r
+ * @{\r
+ *\r
+ */\r
+\r
+/**\r
+ * @brief Threshold for 4D/6D function.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of 6d_ths in reg TAP_THS_X\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_6d_threshold_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+ lis2doc_tap_ths_x_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_X, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg._6d_ths = val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_TAP_THS_X, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Threshold for 4D/6D function.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of 6d_ths in reg TAP_THS_X\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_6d_threshold_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+ lis2doc_tap_ths_x_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_X, (uint8_t *) ®, 1);\r
+ *val = reg._6d_ths;\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief 4D orientation detection enable.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of 4d_en in reg TAP_THS_X\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_4d_mode_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+ lis2doc_tap_ths_x_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_X, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg._4d_en = val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_TAP_THS_X, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief 4D orientation detection enable.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of 4d_en in reg TAP_THS_X\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_4d_mode_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+ lis2doc_tap_ths_x_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_TAP_THS_X, (uint8_t *) ®, 1);\r
+ *val = reg._4d_en;\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Read the 6D tap source register.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val union of registers from SIXD_SRC\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_6d_src_get(stmdev_ctx_t *ctx,\r
+ lis2doc_sixd_src_t *val)\r
+{\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_SIXD_SRC, (uint8_t *) val, 1);\r
+\r
+ return ret;\r
+}\r
+/**\r
+ * @brief Data sent to 6D interrupt function.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of lpass_on6d in reg CTRL_REG7\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_6d_feed_data_set(stmdev_ctx_t *ctx,\r
+ lis2doc_lpass_on6d_t val)\r
+{\r
+ lis2doc_ctrl_reg7_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.lpass_on6d = (uint8_t) val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Data sent to 6D interrupt function.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val Get the values of lpass_on6d in reg CTRL_REG7\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_6d_feed_data_get(stmdev_ctx_t *ctx,\r
+ lis2doc_lpass_on6d_t *val)\r
+{\r
+ lis2doc_ctrl_reg7_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_CTRL_REG7, (uint8_t *) ®, 1);\r
+\r
+ switch (reg.lpass_on6d)\r
+ {\r
+ case LIS2DOC_ODR_DIV_2_FEED:\r
+ *val = LIS2DOC_ODR_DIV_2_FEED;\r
+ break;\r
+\r
+ case LIS2DOC_LPF2_FEED:\r
+ *val = LIS2DOC_LPF2_FEED;\r
+ break;\r
+\r
+ default:\r
+ *val = LIS2DOC_ODR_DIV_2_FEED;\r
+ break;\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @}\r
+ *\r
+ */\r
+\r
+/**\r
+ * @defgroup LIS2DOC_Free_Fall\r
+ * @brief This section group all the functions concerning\r
+ * the free fall detection.\r
+ * @{\r
+ *\r
+ */\r
+\r
+/**\r
+ * @brief Free fall duration event(1LSb = 1 / ODR).[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of ff_dur in reg\r
+ * WAKE_UP_DUR /F REE_FALL\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_ff_dur_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+ lis2doc_wake_up_dur_t wake_up_dur;\r
+ lis2doc_free_fall_t free_fall;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_DUR,\r
+ (uint8_t *) &wake_up_dur, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_FREE_FALL,\r
+ (uint8_t *) &free_fall, 1);\r
+ }\r
+\r
+ if (ret == 0)\r
+ {\r
+ wake_up_dur.ff_dur = ((uint8_t) val & 0x20U) >> 5;\r
+ free_fall.ff_dur = (uint8_t) val & 0x1FU;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_WAKE_UP_DUR,\r
+ (uint8_t *) &wake_up_dur, 1);\r
+ }\r
+\r
+ if (ret == 0)\r
+ {\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_FREE_FALL,\r
+ (uint8_t *) &free_fall, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Free fall duration event(1LSb = 1 / ODR).[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of ff_dur in\r
+ * reg WAKE_UP_DUR /F REE_FALL\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_ff_dur_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+ lis2doc_wake_up_dur_t wake_up_dur;\r
+ lis2doc_free_fall_t free_fall;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_WAKE_UP_DUR,\r
+ (uint8_t *) &wake_up_dur, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_FREE_FALL,\r
+ (uint8_t *) &free_fall, 1);\r
+ *val = (wake_up_dur.ff_dur << 5) + free_fall.ff_dur;\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Free fall threshold setting.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of ff_ths in reg FREE_FALL\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_ff_threshold_set(stmdev_ctx_t *ctx,\r
+ lis2doc_ff_ths_t val)\r
+{\r
+ lis2doc_free_fall_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_FREE_FALL, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.ff_ths = (uint8_t) val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_FREE_FALL, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Free fall threshold setting.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val Get the values of ff_ths in reg FREE_FALL\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_ff_threshold_get(stmdev_ctx_t *ctx,\r
+ lis2doc_ff_ths_t *val)\r
+{\r
+ lis2doc_free_fall_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_FREE_FALL, (uint8_t *) ®, 1);\r
+\r
+ switch (reg.ff_ths)\r
+ {\r
+ case LIS2DOC_FF_TSH_5LSb_FS2g:\r
+ *val = LIS2DOC_FF_TSH_5LSb_FS2g;\r
+ break;\r
+\r
+ case LIS2DOC_FF_TSH_7LSb_FS2g:\r
+ *val = LIS2DOC_FF_TSH_7LSb_FS2g;\r
+ break;\r
+\r
+ case LIS2DOC_FF_TSH_8LSb_FS2g:\r
+ *val = LIS2DOC_FF_TSH_8LSb_FS2g;\r
+ break;\r
+\r
+ case LIS2DOC_FF_TSH_10LSb_FS2g:\r
+ *val = LIS2DOC_FF_TSH_10LSb_FS2g;\r
+ break;\r
+\r
+ case LIS2DOC_FF_TSH_11LSb_FS2g:\r
+ *val = LIS2DOC_FF_TSH_11LSb_FS2g;\r
+ break;\r
+\r
+ case LIS2DOC_FF_TSH_13LSb_FS2g:\r
+ *val = LIS2DOC_FF_TSH_13LSb_FS2g;\r
+ break;\r
+\r
+ case LIS2DOC_FF_TSH_15LSb_FS2g:\r
+ *val = LIS2DOC_FF_TSH_15LSb_FS2g;\r
+ break;\r
+\r
+ case LIS2DOC_FF_TSH_16LSb_FS2g:\r
+ *val = LIS2DOC_FF_TSH_16LSb_FS2g;\r
+ break;\r
+\r
+ default:\r
+ *val = LIS2DOC_FF_TSH_5LSb_FS2g;\r
+ break;\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @}\r
+ *\r
+ */\r
+\r
+/**\r
+ * @defgroup LIS2DOC_Fifo\r
+ * @brief This section group all the functions concerning the fifo usage\r
+ * @{\r
+ *\r
+ */\r
+\r
+/**\r
+ * @brief FIFO watermark level selection.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of fth in reg FIFO_CTRL\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_fifo_watermark_set(stmdev_ctx_t *ctx, uint8_t val)\r
+{\r
+ lis2doc_fifo_ctrl_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_FIFO_CTRL, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.fth = val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_FIFO_CTRL, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief FIFO watermark level selection.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of fth in reg FIFO_CTRL\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_fifo_watermark_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+ lis2doc_fifo_ctrl_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_FIFO_CTRL, (uint8_t *) ®, 1);\r
+ *val = reg.fth;\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief FIFO mode selection.[set]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of fmode in reg FIFO_CTRL\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_fifo_mode_set(stmdev_ctx_t *ctx,\r
+ lis2doc_fmode_t val)\r
+{\r
+ lis2doc_fifo_ctrl_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_FIFO_CTRL, (uint8_t *) ®, 1);\r
+\r
+ if (ret == 0)\r
+ {\r
+ reg.fmode = (uint8_t) val;\r
+ ret = lis2doc_write_reg(ctx, LIS2DOC_FIFO_CTRL, (uint8_t *) ®, 1);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief FIFO mode selection.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val Get the values of fmode in reg FIFO_CTRL\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_fifo_mode_get(stmdev_ctx_t *ctx,\r
+ lis2doc_fmode_t *val)\r
+{\r
+ lis2doc_fifo_ctrl_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_FIFO_CTRL, (uint8_t *) ®, 1);\r
+\r
+ switch (reg.fmode)\r
+ {\r
+ case LIS2DOC_BYPASS_MODE:\r
+ *val = LIS2DOC_BYPASS_MODE;\r
+ break;\r
+\r
+ case LIS2DOC_FIFO_MODE:\r
+ *val = LIS2DOC_FIFO_MODE;\r
+ break;\r
+\r
+ case LIS2DOC_STREAM_TO_FIFO_MODE:\r
+ *val = LIS2DOC_STREAM_TO_FIFO_MODE;\r
+ break;\r
+\r
+ case LIS2DOC_BYPASS_TO_STREAM_MODE:\r
+ *val = LIS2DOC_BYPASS_TO_STREAM_MODE;\r
+ break;\r
+\r
+ case LIS2DOC_STREAM_MODE:\r
+ *val = LIS2DOC_STREAM_MODE;\r
+ break;\r
+\r
+ default:\r
+ *val = LIS2DOC_BYPASS_MODE;\r
+ break;\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @brief Number of unread samples stored in FIFO.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of diff in reg FIFO_SAMPLES\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_fifo_data_level_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+ lis2doc_fifo_samples_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_FIFO_SAMPLES, (uint8_t *) ®, 1);\r
+ *val = reg.diff;\r
+\r
+ return ret;\r
+}\r
+/**\r
+ * @brief FIFO overrun status.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of fifo_ovr in reg FIFO_SAMPLES\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_fifo_ovr_flag_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+ lis2doc_fifo_samples_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_FIFO_SAMPLES, (uint8_t *) ®, 1);\r
+ *val = reg.fifo_ovr;\r
+\r
+ return ret;\r
+}\r
+/**\r
+ * @brief FIFO threshold status flag.[get]\r
+ *\r
+ * @param ctx read / write interface definitions\r
+ * @param val change the values of fifo_fth in reg FIFO_SAMPLES\r
+ * @retval interface status (MANDATORY: return 0 -> no Error)\r
+ *\r
+ */\r
+int32_t lis2doc_fifo_wtm_flag_get(stmdev_ctx_t *ctx, uint8_t *val)\r
+{\r
+ lis2doc_fifo_samples_t reg;\r
+ int32_t ret;\r
+\r
+ ret = lis2doc_read_reg(ctx, LIS2DOC_FIFO_SAMPLES, (uint8_t *) ®, 1);\r
+ *val = reg.fifo_fth;\r
+\r
+ return ret;\r
+}\r
+\r
+/**\r
+ * @}\r
+ *\r
+ */\r
+\r
+/**\r
+ * @}\r
+ *\r
+ */\r
+\r
+/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/\r
--- /dev/null
+/**\r
+ ******************************************************************************\r
+ * @file lis2doc_reg.h\r
+ * @author Sensors Software Solution Team\r
+ * @brief This file contains all the functions prototypes for the\r
+ * lis2doc_reg.c driver.\r
+ ******************************************************************************\r
+ * @attention\r
+ *\r
+ * <h2><center>© Copyright (c) 2021 STMicroelectronics.\r
+ * All rights reserved.</center></h2>\r
+ *\r
+ * This software component is licensed by ST under BSD 3-Clause license,\r
+ * the "License"; You may not use this file except in compliance with the\r
+ * License. You may obtain a copy of the License at:\r
+ * opensource.org/licenses/BSD-3-Clause\r
+ *\r
+ ******************************************************************************\r
+ */\r
+\r
+/* Define to prevent recursive inclusion -------------------------------------*/\r
+#ifndef LIS2DOC_REGS_H\r
+#define LIS2DOC_REGS_H\r
+\r
+#ifdef __cplusplus\r
+extern "C" {\r
+#endif\r
+\r
+/* Includes ------------------------------------------------------------------*/\r
+#include <stdint.h>\r
+#include <stddef.h>\r
+#include <math.h>\r
+\r
+/** @addtogroup LIS2DOC\r
+ * @{\r
+ *\r
+ */\r
+\r
+/** @defgroup Endianness definitions\r
+ * @{\r
+ *\r
+ */\r
+\r
+#ifndef DRV_BYTE_ORDER\r
+#ifndef __BYTE_ORDER__\r
+\r
+#define DRV_LITTLE_ENDIAN 1234\r
+#define DRV_BIG_ENDIAN 4321\r
+\r
+/** if _BYTE_ORDER is not defined, choose the endianness of your architecture\r
+ * by uncommenting the define which fits your platform endianness\r
+ */\r
+//#define DRV_BYTE_ORDER DRV_BIG_ENDIAN\r
+#define DRV_BYTE_ORDER DRV_LITTLE_ENDIAN\r
+\r
+#else /* defined __BYTE_ORDER__ */\r
+\r
+#define DRV_LITTLE_ENDIAN __ORDER_LITTLE_ENDIAN__\r
+#define DRV_BIG_ENDIAN __ORDER_BIG_ENDIAN__\r
+#define DRV_BYTE_ORDER __BYTE_ORDER__\r
+\r
+#endif /* __BYTE_ORDER__*/\r
+#endif /* DRV_BYTE_ORDER */\r
+\r
+/**\r
+ * @}\r
+ *\r
+ */\r
+\r
+/** @defgroup STMicroelectronics sensors common types\r
+ * @{\r
+ *\r
+ */\r
+\r
+#ifndef MEMS_SHARED_TYPES\r
+#define MEMS_SHARED_TYPES\r
+\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+ uint8_t bit0 : 1;\r
+ uint8_t bit1 : 1;\r
+ uint8_t bit2 : 1;\r
+ uint8_t bit3 : 1;\r
+ uint8_t bit4 : 1;\r
+ uint8_t bit5 : 1;\r
+ uint8_t bit6 : 1;\r
+ uint8_t bit7 : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+ uint8_t bit7 : 1;\r
+ uint8_t bit6 : 1;\r
+ uint8_t bit5 : 1;\r
+ uint8_t bit4 : 1;\r
+ uint8_t bit3 : 1;\r
+ uint8_t bit2 : 1;\r
+ uint8_t bit1 : 1;\r
+ uint8_t bit0 : 1;\r
+#endif /* DRV_BYTE_ORDER */\r
+} bitwise_t;\r
+\r
+#define PROPERTY_DISABLE (0U)\r
+#define PROPERTY_ENABLE (1U)\r
+\r
+/** @addtogroup Interfaces_Functions\r
+ * @brief This section provide a set of functions used to read and\r
+ * write a generic register of the device.\r
+ * MANDATORY: return 0 -> no Error.\r
+ * @{\r
+ *\r
+ */\r
+\r
+typedef int32_t (*stmdev_write_ptr)(void *, uint8_t, const uint8_t *, uint16_t);\r
+typedef int32_t (*stmdev_read_ptr)(void *, uint8_t, uint8_t *, uint16_t);\r
+typedef void (*stmdev_mdelay_ptr)(uint32_t millisec);\r
+\r
+typedef struct\r
+{\r
+ /** Component mandatory fields **/\r
+ stmdev_write_ptr write_reg;\r
+ stmdev_read_ptr read_reg;\r
+ /** Component optional fields **/\r
+ stmdev_mdelay_ptr mdelay;\r
+ /** Customizable optional pointer **/\r
+ void *handle;\r
+} stmdev_ctx_t;\r
+\r
+/**\r
+ * @}\r
+ *\r
+ */\r
+\r
+#endif /* MEMS_SHARED_TYPES */\r
+\r
+#ifndef MEMS_UCF_SHARED_TYPES\r
+#define MEMS_UCF_SHARED_TYPES\r
+\r
+/** @defgroup Generic address-data structure definition\r
+ * @brief This structure is useful to load a predefined configuration\r
+ * of a sensor.\r
+ * You can create a sensor configuration by your own or using\r
+ * Unico / Unicleo tools available on STMicroelectronics\r
+ * web site.\r
+ *\r
+ * @{\r
+ *\r
+ */\r
+\r
+typedef struct\r
+{\r
+ uint8_t address;\r
+ uint8_t data;\r
+} ucf_line_t;\r
+\r
+/**\r
+ * @}\r
+ *\r
+ */\r
+\r
+#endif /* MEMS_UCF_SHARED_TYPES */\r
+\r
+/**\r
+ * @}\r
+ *\r
+ */\r
+\r
+/** @defgroup LIS2DOC_Infos\r
+ * @{\r
+ *\r
+ */\r
+\r
+/** I2C Device Address 8 bit format if SA0=0 -> 31 if SA0=1 -> 33 **/\r
+#define LIS2DOC_I2C_ADD_L 0x31U\r
+#define LIS2DOC_I2C_ADD_H 0x33U\r
+\r
+/** Device Identification (Who am I) **/\r
+#define LIS2DOC_ID 0x44U\r
+\r
+/**\r
+ * @}\r
+ *\r
+ */\r
+\r
+#define LIS2DOC_OUT_T_L 0x0DU\r
+#define LIS2DOC_OUT_T_H 0x0EU\r
+#define LIS2DOC_WHO_AM_I 0x0FU\r
+#define LIS2DOC_CTRL1 0x20U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+ uint8_t not_used_00 : 1;\r
+ uint8_t lpm_en : 1;\r
+ uint8_t hpm_en : 1;\r
+ uint8_t sdrc_en : 1;\r
+ uint8_t odr : 4;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+ uint8_t odr : 4;\r
+ uint8_t sdrc_en : 1;\r
+ uint8_t hpm_en : 1;\r
+ uint8_t lpm_en : 1;\r
+ uint8_t not_used_00 : 1;\r
+#endif /* DRV_BYTE_ORDER */\r
+\r
+} lis2doc_ctrl1_t;\r
+\r
+#define LIS2DOC_CTRL2 0x21U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+ uint8_t sim : 1;\r
+ uint8_t i2c_disable : 1;\r
+ uint8_t if_add_inc : 1;\r
+ uint8_t bdu : 1;\r
+ uint8_t cs_pu_disc : 1;\r
+ uint8_t not_used_01 : 1;\r
+ uint8_t soft_reset : 1;\r
+ uint8_t boot : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+ uint8_t boot : 1;\r
+ uint8_t soft_reset : 1;\r
+ uint8_t not_used_01 : 1;\r
+ uint8_t cs_pu_disc : 1;\r
+ uint8_t bdu : 1;\r
+ uint8_t if_add_inc : 1;\r
+ uint8_t i2c_disable : 1;\r
+ uint8_t sim : 1;\r
+#endif /* DRV_BYTE_ORDER */\r
+\r
+} lis2doc_ctrl2_t;\r
+\r
+#define LIS2DOC_CTRL3 0x22U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+uint8_t slp_mode :\r
+ 2; /* slp_mode_sel + slp_mode_1 */\r
+ uint8_t not_used_01 : 1;\r
+ uint8_t h_lactive : 1;\r
+ uint8_t lir : 1;\r
+ uint8_t pp_od : 1;\r
+ uint8_t st : 2;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+ uint8_t st : 2;\r
+ uint8_t pp_od : 1;\r
+ uint8_t lir : 1;\r
+ uint8_t h_lactive : 1;\r
+ uint8_t not_used_01 : 1;\r
+uint8_t slp_mode :\r
+ 2; /* slp_mode_sel + slp_mode_1 */\r
+#endif /* DRV_BYTE_ORDER */\r
+\r
+} lis2doc_ctrl3_t;\r
+\r
+#define LIS2DOC_CTRL4_INT1_PAD_CTRL 0x23U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+ uint8_t int1_drdy : 1;\r
+ uint8_t int1_fth : 1;\r
+ uint8_t int1_diff5 : 1;\r
+ uint8_t int1_tap : 1;\r
+ uint8_t int1_ff : 1;\r
+ uint8_t int1_wu : 1;\r
+ uint8_t int1_single_tap : 1;\r
+ uint8_t int1_6d : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+ uint8_t int1_6d : 1;\r
+ uint8_t int1_single_tap : 1;\r
+ uint8_t int1_wu : 1;\r
+ uint8_t int1_ff : 1;\r
+ uint8_t int1_tap : 1;\r
+ uint8_t int1_diff5 : 1;\r
+ uint8_t int1_fth : 1;\r
+ uint8_t int1_drdy : 1;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_ctrl4_int1_pad_ctrl_t;\r
+\r
+#define LIS2DOC_CTRL5_INT2_PAD_CTRL 0x24U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+ uint8_t int2_drdy : 1;\r
+ uint8_t int2_fth : 1;\r
+ uint8_t int2_diff5 : 1;\r
+ uint8_t int2_ovr : 1;\r
+ uint8_t int2_drdy_t : 1;\r
+ uint8_t int2_boot : 1;\r
+ uint8_t int2_sleep_chg : 1;\r
+ uint8_t int2_sleep_state : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+ uint8_t int2_sleep_state : 1;\r
+ uint8_t int2_sleep_chg : 1;\r
+ uint8_t int2_boot : 1;\r
+ uint8_t int2_drdy_t : 1;\r
+ uint8_t int2_ovr : 1;\r
+ uint8_t int2_diff5 : 1;\r
+ uint8_t int2_fth : 1;\r
+ uint8_t int2_drdy : 1;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_ctrl5_int2_pad_ctrl_t;\r
+\r
+#define LIS2DOC_CTRL6 0x25U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+ uint8_t not_used_01 : 2;\r
+ uint8_t low_noise : 1;\r
+ uint8_t fds : 1;\r
+ uint8_t fs : 2;\r
+ uint8_t bw_filt : 2;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+ uint8_t bw_filt : 2;\r
+ uint8_t fs : 2;\r
+ uint8_t fds : 1;\r
+ uint8_t low_noise : 1;\r
+ uint8_t not_used_01 : 2;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_ctrl6_t;\r
+\r
+#define LIS2DOC_OUT_T 0x26U\r
+#define LIS2DOC_STATUS 0x27U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+ uint8_t drdy : 1;\r
+ uint8_t ff_ia : 1;\r
+ uint8_t _6d_ia : 1;\r
+ uint8_t single_tap : 1;\r
+ uint8_t double_tap : 1;\r
+ uint8_t sleep_state : 1;\r
+ uint8_t wu_ia : 1;\r
+ uint8_t fifo_ths : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+ uint8_t fifo_ths : 1;\r
+ uint8_t wu_ia : 1;\r
+ uint8_t sleep_state : 1;\r
+ uint8_t double_tap : 1;\r
+ uint8_t single_tap : 1;\r
+ uint8_t _6d_ia : 1;\r
+ uint8_t ff_ia : 1;\r
+ uint8_t drdy : 1;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_status_t;\r
+\r
+#define LIS2DOC_OUT_X_L 0x28U\r
+#define LIS2DOC_OUT_X_H 0x29U\r
+#define LIS2DOC_OUT_Y_L 0x2AU\r
+#define LIS2DOC_OUT_Y_H 0x2BU\r
+#define LIS2DOC_OUT_Z_L 0x2CU\r
+#define LIS2DOC_OUT_Z_H 0x2DU\r
+#define LIS2DOC_FIFO_CTRL 0x2EU\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+ uint8_t fth : 5;\r
+ uint8_t fmode : 3;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+ uint8_t fmode : 3;\r
+ uint8_t fth : 5;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_fifo_ctrl_t;\r
+\r
+#define LIS2DOC_FIFO_SAMPLES 0x2FU\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+ uint8_t diff : 6;\r
+ uint8_t fifo_ovr : 1;\r
+ uint8_t fifo_fth : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+ uint8_t fifo_fth : 1;\r
+ uint8_t fifo_ovr : 1;\r
+ uint8_t diff : 6;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_fifo_samples_t;\r
+\r
+#define LIS2DOC_TAP_THS_X 0x30U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+ uint8_t tap_thsx : 5;\r
+ uint8_t _6d_ths : 2;\r
+ uint8_t _4d_en : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+ uint8_t _4d_en : 1;\r
+ uint8_t _6d_ths : 2;\r
+ uint8_t tap_thsx : 5;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_tap_ths_x_t;\r
+\r
+#define LIS2DOC_TAP_THS_Y 0x31U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+ uint8_t tap_thsy : 5;\r
+ uint8_t tap_prior : 3;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+ uint8_t tap_prior : 3;\r
+ uint8_t tap_thsy : 5;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_tap_ths_y_t;\r
+\r
+#define LIS2DOC_TAP_THS_Z 0x32U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+ uint8_t tap_thsz : 5;\r
+ uint8_t tap_z_en : 1;\r
+ uint8_t tap_y_en : 1;\r
+ uint8_t tap_x_en : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+ uint8_t tap_x_en : 1;\r
+ uint8_t tap_y_en : 1;\r
+ uint8_t tap_z_en : 1;\r
+ uint8_t tap_thsz : 5;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_tap_ths_z_t;\r
+\r
+#define LIS2DOC_INT_DUR 0x33U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+ uint8_t shock : 2;\r
+ uint8_t quiet : 2;\r
+ uint8_t latency : 4;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+ uint8_t latency : 4;\r
+ uint8_t quiet : 2;\r
+ uint8_t shock : 2;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_int_dur_t;\r
+\r
+#define LIS2DOC_WAKE_UP_THS 0x34U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+ uint8_t wk_ths : 6;\r
+ uint8_t sleep_on : 1;\r
+ uint8_t single_double_tap : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+ uint8_t single_double_tap : 1;\r
+ uint8_t sleep_on : 1;\r
+ uint8_t wk_ths : 6;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_wake_up_ths_t;\r
+\r
+#define LIS2DOC_WAKE_UP_DUR 0x35U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+ uint8_t sleep_dur : 4;\r
+ uint8_t stationary : 1;\r
+ uint8_t wake_dur : 2;\r
+ uint8_t ff_dur : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+ uint8_t ff_dur : 1;\r
+ uint8_t wake_dur : 2;\r
+ uint8_t stationary : 1;\r
+ uint8_t sleep_dur : 4;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_wake_up_dur_t;\r
+\r
+#define LIS2DOC_FREE_FALL 0x36U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+ uint8_t ff_ths : 3;\r
+ uint8_t ff_dur : 5;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+ uint8_t ff_dur : 5;\r
+ uint8_t ff_ths : 3;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_free_fall_t;\r
+\r
+#define LIS2DOC_STATUS_DUP 0x37U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+ uint8_t drdy : 1;\r
+ uint8_t ff_ia : 1;\r
+ uint8_t _6d_ia : 1;\r
+ uint8_t single_tap : 1;\r
+ uint8_t double_tap : 1;\r
+ uint8_t sleep_state_ia : 1;\r
+ uint8_t drdy_t : 1;\r
+ uint8_t ovr : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+ uint8_t ovr : 1;\r
+ uint8_t drdy_t : 1;\r
+ uint8_t sleep_state_ia : 1;\r
+ uint8_t double_tap : 1;\r
+ uint8_t single_tap : 1;\r
+ uint8_t _6d_ia : 1;\r
+ uint8_t ff_ia : 1;\r
+ uint8_t drdy : 1;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_status_dup_t;\r
+\r
+#define LIS2DOC_WAKE_UP_SRC 0x38U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+ uint8_t z_wu : 1;\r
+ uint8_t y_wu : 1;\r
+ uint8_t x_wu : 1;\r
+ uint8_t wu_ia : 1;\r
+ uint8_t sleep_state_ia : 1;\r
+ uint8_t ff_ia : 1;\r
+ uint8_t not_used_01 : 2;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+ uint8_t not_used_01 : 2;\r
+ uint8_t ff_ia : 1;\r
+ uint8_t sleep_state_ia : 1;\r
+ uint8_t wu_ia : 1;\r
+ uint8_t x_wu : 1;\r
+ uint8_t y_wu : 1;\r
+ uint8_t z_wu : 1;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_wake_up_src_t;\r
+\r
+#define LIS2DOC_TAP_SRC 0x39U\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+ uint8_t z_tap : 1;\r
+ uint8_t y_tap : 1;\r
+ uint8_t x_tap : 1;\r
+ uint8_t tap_sign : 1;\r
+ uint8_t double_tap : 1;\r
+ uint8_t single_tap : 1;\r
+ uint8_t tap_ia : 1;\r
+ uint8_t not_used_01 : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+ uint8_t not_used_01 : 1;\r
+ uint8_t tap_ia : 1;\r
+ uint8_t single_tap : 1;\r
+ uint8_t double_tap : 1;\r
+ uint8_t tap_sign : 1;\r
+ uint8_t x_tap : 1;\r
+ uint8_t y_tap : 1;\r
+ uint8_t z_tap : 1;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_tap_src_t;\r
+\r
+#define LIS2DOC_SIXD_SRC 0x3AU\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+ uint8_t xl : 1;\r
+ uint8_t xh : 1;\r
+ uint8_t yl : 1;\r
+ uint8_t yh : 1;\r
+ uint8_t zl : 1;\r
+ uint8_t zh : 1;\r
+ uint8_t _6d_ia : 1;\r
+ uint8_t not_used_01 : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+ uint8_t not_used_01 : 1;\r
+ uint8_t _6d_ia : 1;\r
+ uint8_t zh : 1;\r
+ uint8_t zl : 1;\r
+ uint8_t yh : 1;\r
+ uint8_t xh : 1;\r
+ uint8_t yl : 1;\r
+ uint8_t xh : 1;\r
+ uint8_t xl : 1;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_sixd_src_t;\r
+\r
+#define LIS2DOC_ALL_INT_SRC 0x3BU\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+ uint8_t ff_ia : 1;\r
+ uint8_t wu_ia : 1;\r
+ uint8_t single_tap : 1;\r
+ uint8_t double_tap : 1;\r
+ uint8_t _6d_ia : 1;\r
+ uint8_t sleep_change_ia : 1;\r
+ uint8_t not_used_01 : 2;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+ uint8_t not_used_01 : 2;\r
+ uint8_t sleep_change_ia : 1;\r
+ uint8_t _6d_ia : 1;\r
+ uint8_t double_tap : 1;\r
+ uint8_t single_tap : 1;\r
+ uint8_t wu_ia : 1;\r
+ uint8_t ff_ia : 1;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_all_int_src_t;\r
+\r
+#define LIS2DOC_X_OFS_USR 0x3CU\r
+#define LIS2DOC_Y_OFS_USR 0x3DU\r
+#define LIS2DOC_Z_OFS_USR 0x3EU\r
+#define LIS2DOC_CTRL_REG7 0x3FU\r
+typedef struct\r
+{\r
+#if DRV_BYTE_ORDER == DRV_LITTLE_ENDIAN\r
+ uint8_t lpass_on6d : 1;\r
+ uint8_t hp_ref_mode : 1;\r
+ uint8_t usr_off_w : 1;\r
+ uint8_t usr_off_on_wu : 1;\r
+ uint8_t usr_off_on_out : 1;\r
+ uint8_t interrupts_enable : 1;\r
+ uint8_t int2_on_int1 : 1;\r
+ uint8_t drdy_pulsed : 1;\r
+#elif DRV_BYTE_ORDER == DRV_BIG_ENDIAN\r
+ uint8_t drdy_pulsed : 1;\r
+ uint8_t int2_on_int1 : 1;\r
+ uint8_t interrupts_enable : 1;\r
+ uint8_t usr_off_on_out : 1;\r
+ uint8_t usr_off_on_wu : 1;\r
+ uint8_t usr_off_w : 1;\r
+ uint8_t hp_ref_mode : 1;\r
+ uint8_t lpass_on6d : 1;\r
+#endif /* DRV_BYTE_ORDER */\r
+} lis2doc_ctrl_reg7_t;\r
+\r
+/**\r
+ * @defgroup LIS2DOC_Register_Union\r
+ * @brief This union group all the registers having a bit-field\r
+ * description.\r
+ * This union is useful but it's not needed by the driver.\r
+ *\r
+ * REMOVING this union you are compliant with:\r
+ * MISRA-C 2012 [Rule 19.2] -> " Union are not allowed "\r
+ *\r
+ * @{\r
+ *\r
+ */\r
+typedef union\r
+{\r
+ lis2doc_ctrl1_t ctrl1;\r
+ lis2doc_ctrl2_t ctrl2;\r
+ lis2doc_ctrl3_t ctrl3;\r
+ lis2doc_ctrl4_int1_pad_ctrl_t ctrl4_int1_pad_ctrl;\r
+ lis2doc_ctrl5_int2_pad_ctrl_t ctrl5_int2_pad_ctrl;\r
+ lis2doc_ctrl6_t ctrl6;\r
+ lis2doc_status_t status;\r
+ lis2doc_fifo_ctrl_t fifo_ctrl;\r
+ lis2doc_fifo_samples_t fifo_samples;\r
+ lis2doc_tap_ths_x_t tap_ths_x;\r
+ lis2doc_tap_ths_y_t tap_ths_y;\r
+ lis2doc_tap_ths_z_t tap_ths_z;\r
+ lis2doc_int_dur_t int_dur;\r
+ lis2doc_wake_up_ths_t wake_up_ths;\r
+ lis2doc_wake_up_dur_t wake_up_dur;\r
+ lis2doc_free_fall_t free_fall;\r
+ lis2doc_status_dup_t status_dup;\r
+ lis2doc_wake_up_src_t wake_up_src;\r
+ lis2doc_tap_src_t tap_src;\r
+ lis2doc_sixd_src_t sixd_src;\r
+ lis2doc_all_int_src_t all_int_src;\r
+ lis2doc_ctrl_reg7_t ctrl_reg7;\r
+ bitwise_t bitwise;\r
+ uint8_t byte;\r
+} lis2doc_reg_t;\r
+\r
+/**\r
+ * @}\r
+ *\r
+ */\r
+\r
+#ifndef __weak\r
+#define __weak __attribute__((weak))\r
+#endif /* __weak */\r
+\r
+/*\r
+ * These are the basic platform dependent I/O routines to read\r
+ * and write device registers connected on a standard bus.\r
+ * The driver keeps offering a default implementation based on function\r
+ * pointers to read/write routines for backward compatibility.\r
+ * The __weak directive allows the final application to overwrite\r
+ * them with a custom implementation.\r
+ */\r
+\r
+int32_t lis2doc_read_reg(stmdev_ctx_t *ctx, uint8_t reg,\r
+ uint8_t *data,\r
+ uint16_t len);\r
+int32_t lis2doc_write_reg(stmdev_ctx_t *ctx, uint8_t reg,\r
+ uint8_t *data,\r
+ uint16_t len);\r
+\r
+float_t lis2doc_from_fs2_to_mg(int16_t lsb);\r
+float_t lis2doc_from_fs4_to_mg(int16_t lsb);\r
+float_t lis2doc_from_fs8_to_mg(int16_t lsb);\r
+float_t lis2doc_from_fs16_to_mg(int16_t lsb);\r
+\r
+float_t lis2doc_from_fs2_lp1_to_mg(int16_t lsb);\r
+float_t lis2doc_from_fs4_lp1_to_mg(int16_t lsb);\r
+float_t lis2doc_from_fs8_lp1_to_mg(int16_t lsb);\r
+float_t lis2doc_from_fs16_lp1_to_mg(int16_t lsb);\r
+\r
+float_t lis2doc_from_lsb_to_celsius(int16_t lsb);\r
+\r
+typedef struct\r
+{\r
+ uint8_t sdrc : 1;\r
+ uint8_t lpm : 1;\r
+ uint8_t hpm : 1;\r
+ uint8_t low_noise : 1;\r
+} lis2doc_mode_t;\r
+int32_t lis2doc_power_mode_set(stmdev_ctx_t *ctx,\r
+ lis2doc_mode_t val);\r
+int32_t lis2doc_power_mode_get(stmdev_ctx_t *ctx,\r
+ lis2doc_mode_t *val);\r
+\r
+typedef enum\r
+{\r
+ LIS2DOC_XL_ODR_OFF = 0x00,\r
+ LIS2DOC_XL_ODR_1Hz6_LP_ONLY = 0x01,\r
+ LIS2DOC_XL_ODR_12Hz5 = 0x02,\r
+ LIS2DOC_XL_ODR_25Hz = 0x03,\r
+ LIS2DOC_XL_ODR_50Hz = 0x04,\r
+ LIS2DOC_XL_ODR_100Hz = 0x05,\r
+ LIS2DOC_XL_ODR_200Hz = 0x06,\r
+ LIS2DOC_XL_ODR_400Hz = 0x07,\r
+ LIS2DOC_XL_ODR_800Hz = 0x08,\r
+ LIS2DOC_XL_ODR_1k6Hz = 0x09,\r
+ LIS2DOC_XL_SET_SW_TRIG = 0x32, /* Use this only in SINGLE mode */\r
+ LIS2DOC_XL_SET_PIN_TRIG = 0x12, /* Use this only in SINGLE mode */\r
+} lis2doc_odr_t;\r
+int32_t lis2doc_data_rate_set(stmdev_ctx_t *ctx, lis2doc_odr_t val);\r
+int32_t lis2doc_data_rate_get(stmdev_ctx_t *ctx,\r
+ lis2doc_odr_t *val);\r
+\r
+int32_t lis2doc_block_data_update_set(stmdev_ctx_t *ctx,\r
+ uint8_t val);\r
+int32_t lis2doc_block_data_update_get(stmdev_ctx_t *ctx,\r
+ uint8_t *val);\r
+\r
+typedef enum\r
+{\r
+ LIS2DOC_2g = 0,\r
+ LIS2DOC_4g = 1,\r
+ LIS2DOC_8g = 2,\r
+ LIS2DOC_16g = 3,\r
+} lis2doc_fs_t;\r
+int32_t lis2doc_full_scale_set(stmdev_ctx_t *ctx, lis2doc_fs_t val);\r
+int32_t lis2doc_full_scale_get(stmdev_ctx_t *ctx,\r
+ lis2doc_fs_t *val);\r
+\r
+int32_t lis2doc_status_reg_get(stmdev_ctx_t *ctx,\r
+ lis2doc_status_t *val);\r
+\r
+int32_t lis2doc_flag_data_ready_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+typedef struct\r
+{\r
+ lis2doc_status_dup_t status_dup;\r
+ lis2doc_wake_up_src_t wake_up_src;\r
+ lis2doc_tap_src_t tap_src;\r
+ lis2doc_sixd_src_t sixd_src;\r
+ lis2doc_all_int_src_t all_int_src;\r
+} lis2doc_all_sources_t;\r
+int32_t lis2doc_all_sources_get(stmdev_ctx_t *ctx,\r
+ lis2doc_all_sources_t *val);\r
+\r
+int32_t lis2doc_usr_offset_x_set(stmdev_ctx_t *ctx, uint8_t *buff);\r
+int32_t lis2doc_usr_offset_x_get(stmdev_ctx_t *ctx, uint8_t *buff);\r
+\r
+int32_t lis2doc_usr_offset_y_set(stmdev_ctx_t *ctx, uint8_t *buff);\r
+int32_t lis2doc_usr_offset_y_get(stmdev_ctx_t *ctx, uint8_t *buff);\r
+\r
+int32_t lis2doc_usr_offset_z_set(stmdev_ctx_t *ctx, uint8_t *buff);\r
+int32_t lis2doc_usr_offset_z_get(stmdev_ctx_t *ctx, uint8_t *buff);\r
+\r
+typedef enum\r
+{\r
+ LIS2DOC_LSb_977ug = 0,\r
+ LIS2DOC_LSb_15mg6 = 1,\r
+} lis2doc_usr_off_w_t;\r
+int32_t lis2doc_offset_weight_set(stmdev_ctx_t *ctx,\r
+ lis2doc_usr_off_w_t val);\r
+int32_t lis2doc_offset_weight_get(stmdev_ctx_t *ctx,\r
+ lis2doc_usr_off_w_t *val);\r
+\r
+int32_t lis2doc_temperature_raw_get(stmdev_ctx_t *ctx, int16_t *val);\r
+\r
+int32_t lis2doc_acceleration_raw_get(stmdev_ctx_t *ctx,\r
+ int16_t *val);\r
+\r
+int32_t lis2doc_device_id_get(stmdev_ctx_t *ctx, uint8_t *buff);\r
+\r
+int32_t lis2doc_auto_increment_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_auto_increment_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_reset_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_reset_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_boot_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_boot_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+typedef enum\r
+{\r
+ LIS2DOC_XL_ST_DISABLE = 0,\r
+ LIS2DOC_XL_ST_POSITIVE = 1,\r
+ LIS2DOC_XL_ST_NEGATIVE = 2,\r
+} lis2doc_st_t;\r
+int32_t lis2doc_self_test_set(stmdev_ctx_t *ctx, lis2doc_st_t val);\r
+int32_t lis2doc_self_test_get(stmdev_ctx_t *ctx, lis2doc_st_t *val);\r
+\r
+typedef enum\r
+{\r
+ LIS2DOC_DRDY_LATCHED = 0,\r
+ LIS2DOC_DRDY_PULSED = 1,\r
+} lis2doc_drdy_pulsed_t;\r
+int32_t lis2doc_data_ready_mode_set(stmdev_ctx_t *ctx,\r
+ lis2doc_drdy_pulsed_t val);\r
+int32_t lis2doc_data_ready_mode_get(stmdev_ctx_t *ctx,\r
+ lis2doc_drdy_pulsed_t *val);\r
+\r
+typedef enum\r
+{\r
+ LIS2DOC_LPF_ON_OUT = 0x00,\r
+ LIS2DOC_USER_OFFSET_ON_OUT = 0x01,\r
+ LIS2DOC_HIGH_PASS_ON_OUT = 0x10,\r
+} lis2doc_fds_t;\r
+int32_t lis2doc_filter_path_set(stmdev_ctx_t *ctx,\r
+ lis2doc_fds_t val);\r
+int32_t lis2doc_filter_path_get(stmdev_ctx_t *ctx,\r
+ lis2doc_fds_t *val);\r
+\r
+typedef enum\r
+{\r
+ LIS2DOC_ODR_DIV_2 = 0,\r
+ LIS2DOC_ODR_DIV_4 = 1,\r
+ LIS2DOC_ODR_DIV_10 = 2,\r
+ LIS2DOC_ODR_DIV_20 = 3,\r
+} lis2doc_bw_filt_t;\r
+int32_t lis2doc_filter_bandwidth_set(stmdev_ctx_t *ctx,\r
+ lis2doc_bw_filt_t val);\r
+int32_t lis2doc_filter_bandwidth_get(stmdev_ctx_t *ctx,\r
+ lis2doc_bw_filt_t *val);\r
+\r
+int32_t lis2doc_reference_mode_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_reference_mode_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+typedef enum\r
+{\r
+ LIS2DOC_SPI_4_WIRE = 0,\r
+ LIS2DOC_SPI_3_WIRE = 1,\r
+} lis2doc_sim_t;\r
+int32_t lis2doc_spi_mode_set(stmdev_ctx_t *ctx, lis2doc_sim_t val);\r
+int32_t lis2doc_spi_mode_get(stmdev_ctx_t *ctx, lis2doc_sim_t *val);\r
+\r
+typedef enum\r
+{\r
+ LIS2DOC_I2C_ENABLE = 0,\r
+ LIS2DOC_I2C_DISABLE = 1,\r
+} lis2doc_i2c_disable_t;\r
+int32_t lis2doc_i2c_interface_set(stmdev_ctx_t *ctx,\r
+ lis2doc_i2c_disable_t val);\r
+int32_t lis2doc_i2c_interface_get(stmdev_ctx_t *ctx,\r
+ lis2doc_i2c_disable_t *val);\r
+\r
+typedef enum\r
+{\r
+ LIS2DOC_PULL_UP_CONNECT = 0,\r
+ LIS2DOC_PULL_UP_DISCONNECT = 1,\r
+} lis2doc_cs_pu_disc_t;\r
+int32_t lis2doc_cs_mode_set(stmdev_ctx_t *ctx,\r
+ lis2doc_cs_pu_disc_t val);\r
+int32_t lis2doc_cs_mode_get(stmdev_ctx_t *ctx,\r
+ lis2doc_cs_pu_disc_t *val);\r
+\r
+typedef enum\r
+{\r
+ LIS2DOC_ACTIVE_HIGH = 0,\r
+ LIS2DOC_ACTIVE_LOW = 1,\r
+} lis2doc_h_lactive_t;\r
+int32_t lis2doc_pin_polarity_set(stmdev_ctx_t *ctx,\r
+ lis2doc_h_lactive_t val);\r
+int32_t lis2doc_pin_polarity_get(stmdev_ctx_t *ctx,\r
+ lis2doc_h_lactive_t *val);\r
+\r
+typedef enum\r
+{\r
+ LIS2DOC_INT_PULSED = 0,\r
+ LIS2DOC_INT_LATCHED = 1,\r
+} lis2doc_lir_t;\r
+int32_t lis2doc_int_notification_set(stmdev_ctx_t *ctx,\r
+ lis2doc_lir_t val);\r
+int32_t lis2doc_int_notification_get(stmdev_ctx_t *ctx,\r
+ lis2doc_lir_t *val);\r
+\r
+typedef enum\r
+{\r
+ LIS2DOC_PUSH_PULL = 0,\r
+ LIS2DOC_OPEN_DRAIN = 1,\r
+} lis2doc_pp_od_t;\r
+int32_t lis2doc_pin_mode_set(stmdev_ctx_t *ctx,\r
+ lis2doc_pp_od_t val);\r
+int32_t lis2doc_pin_mode_get(stmdev_ctx_t *ctx,\r
+ lis2doc_pp_od_t *val);\r
+\r
+int32_t lis2doc_pin_int1_route_set(stmdev_ctx_t *ctx,\r
+ lis2doc_ctrl4_int1_pad_ctrl_t *val);\r
+int32_t lis2doc_pin_int1_route_get(stmdev_ctx_t *ctx,\r
+ lis2doc_ctrl4_int1_pad_ctrl_t *val);\r
+\r
+int32_t lis2doc_pin_int2_route_set(stmdev_ctx_t *ctx,\r
+ lis2doc_ctrl5_int2_pad_ctrl_t *val);\r
+int32_t lis2doc_pin_int2_route_get(stmdev_ctx_t *ctx,\r
+ lis2doc_ctrl5_int2_pad_ctrl_t *val);\r
+\r
+int32_t lis2doc_all_on_int1_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_all_on_int1_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_wkup_threshold_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_wkup_threshold_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_wkup_dur_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_wkup_dur_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+typedef enum\r
+{\r
+ LIS2DOC_HP_FEED = 0,\r
+ LIS2DOC_USER_OFFSET_FEED = 1,\r
+} lis2doc_usr_off_on_wu_t;\r
+int32_t lis2doc_wkup_feed_data_set(stmdev_ctx_t *ctx,\r
+ lis2doc_usr_off_on_wu_t val);\r
+int32_t lis2doc_wkup_feed_data_get(stmdev_ctx_t *ctx,\r
+ lis2doc_usr_off_on_wu_t *val);\r
+\r
+typedef enum\r
+{\r
+ LIS2DOC_NO_DETECTION = 0,\r
+ LIS2DOC_DETECT_ACT_INACT = 1,\r
+ LIS2DOC_DETECT_STAT_MOTION = 3,\r
+} lis2doc_sleep_on_t;\r
+int32_t lis2doc_act_mode_set(stmdev_ctx_t *ctx,\r
+ lis2doc_sleep_on_t val);\r
+int32_t lis2doc_act_mode_get(stmdev_ctx_t *ctx,\r
+ lis2doc_sleep_on_t *val);\r
+\r
+int32_t lis2doc_act_sleep_dur_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_act_sleep_dur_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_tap_threshold_x_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_tap_threshold_x_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_tap_threshold_y_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_tap_threshold_y_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+typedef enum\r
+{\r
+ LIS2DOC_XYZ = 0,\r
+ LIS2DOC_YXZ = 1,\r
+ LIS2DOC_XZY = 2,\r
+ LIS2DOC_ZYX = 3,\r
+ LIS2DOC_YZX = 5,\r
+ LIS2DOC_ZXY = 6,\r
+} lis2doc_tap_prior_t;\r
+int32_t lis2doc_tap_axis_priority_set(stmdev_ctx_t *ctx,\r
+ lis2doc_tap_prior_t val);\r
+int32_t lis2doc_tap_axis_priority_get(stmdev_ctx_t *ctx,\r
+ lis2doc_tap_prior_t *val);\r
+\r
+int32_t lis2doc_tap_threshold_z_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_tap_threshold_z_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_tap_detection_on_z_set(stmdev_ctx_t *ctx,\r
+ uint8_t val);\r
+int32_t lis2doc_tap_detection_on_z_get(stmdev_ctx_t *ctx,\r
+ uint8_t *val);\r
+\r
+int32_t lis2doc_tap_detection_on_y_set(stmdev_ctx_t *ctx,\r
+ uint8_t val);\r
+int32_t lis2doc_tap_detection_on_y_get(stmdev_ctx_t *ctx,\r
+ uint8_t *val);\r
+\r
+int32_t lis2doc_tap_detection_on_x_set(stmdev_ctx_t *ctx,\r
+ uint8_t val);\r
+int32_t lis2doc_tap_detection_on_x_get(stmdev_ctx_t *ctx,\r
+ uint8_t *val);\r
+\r
+int32_t lis2doc_tap_shock_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_tap_shock_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_tap_quiet_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_tap_quiet_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_tap_dur_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_tap_dur_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+typedef enum\r
+{\r
+ LIS2DOC_ONLY_SINGLE = 0,\r
+ LIS2DOC_BOTH_SINGLE_DOUBLE = 1,\r
+} lis2doc_single_double_tap_t;\r
+int32_t lis2doc_tap_mode_set(stmdev_ctx_t *ctx,\r
+ lis2doc_single_double_tap_t val);\r
+int32_t lis2doc_tap_mode_get(stmdev_ctx_t *ctx,\r
+ lis2doc_single_double_tap_t *val);\r
+\r
+int32_t lis2doc_tap_src_get(stmdev_ctx_t *ctx,\r
+ lis2doc_tap_src_t *val);\r
+\r
+int32_t lis2doc_6d_threshold_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_6d_threshold_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_4d_mode_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_4d_mode_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_6d_src_get(stmdev_ctx_t *ctx,\r
+ lis2doc_sixd_src_t *val);\r
+\r
+typedef enum\r
+{\r
+ LIS2DOC_ODR_DIV_2_FEED = 0,\r
+ LIS2DOC_LPF2_FEED = 1,\r
+} lis2doc_lpass_on6d_t;\r
+int32_t lis2doc_6d_feed_data_set(stmdev_ctx_t *ctx,\r
+ lis2doc_lpass_on6d_t val);\r
+int32_t lis2doc_6d_feed_data_get(stmdev_ctx_t *ctx,\r
+ lis2doc_lpass_on6d_t *val);\r
+\r
+int32_t lis2doc_ff_dur_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_ff_dur_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+typedef enum\r
+{\r
+ LIS2DOC_FF_TSH_5LSb_FS2g = 0,\r
+ LIS2DOC_FF_TSH_7LSb_FS2g = 1,\r
+ LIS2DOC_FF_TSH_8LSb_FS2g = 2,\r
+ LIS2DOC_FF_TSH_10LSb_FS2g = 3,\r
+ LIS2DOC_FF_TSH_11LSb_FS2g = 4,\r
+ LIS2DOC_FF_TSH_13LSb_FS2g = 5,\r
+ LIS2DOC_FF_TSH_15LSb_FS2g = 6,\r
+ LIS2DOC_FF_TSH_16LSb_FS2g = 7,\r
+} lis2doc_ff_ths_t;\r
+int32_t lis2doc_ff_threshold_set(stmdev_ctx_t *ctx,\r
+ lis2doc_ff_ths_t val);\r
+int32_t lis2doc_ff_threshold_get(stmdev_ctx_t *ctx,\r
+ lis2doc_ff_ths_t *val);\r
+\r
+int32_t lis2doc_fifo_watermark_set(stmdev_ctx_t *ctx, uint8_t val);\r
+int32_t lis2doc_fifo_watermark_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+typedef enum\r
+{\r
+ LIS2DOC_BYPASS_MODE = 0,\r
+ LIS2DOC_FIFO_MODE = 1,\r
+ LIS2DOC_STREAM_TO_FIFO_MODE = 3,\r
+ LIS2DOC_BYPASS_TO_STREAM_MODE = 4,\r
+ LIS2DOC_STREAM_MODE = 6,\r
+} lis2doc_fmode_t;\r
+int32_t lis2doc_fifo_mode_set(stmdev_ctx_t *ctx,\r
+ lis2doc_fmode_t val);\r
+int32_t lis2doc_fifo_mode_get(stmdev_ctx_t *ctx,\r
+ lis2doc_fmode_t *val);\r
+\r
+int32_t lis2doc_fifo_data_level_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_fifo_ovr_flag_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+int32_t lis2doc_fifo_wtm_flag_get(stmdev_ctx_t *ctx, uint8_t *val);\r
+\r
+/**\r
+ * @}\r
+ *\r
+ */\r
+\r
+#ifdef __cplusplus\r
+}\r
+#endif\r
+\r
+#endif /*LIS2DOC_REGS_H */\r
+\r
+/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/\r
--- /dev/null
+/*\r
+ ******************************************************************************\r
+ * @file activity.c\r
+ * @author Sensors Software Solution Team\r
+ * @brief This file show the simplest way to detect activity/inactivity\r
+ * from sensor.\r
+ *\r
+ ******************************************************************************\r
+ * @attention\r
+ *\r
+ * <h2><center>© Copyright (c) 2020 STMicroelectronics.\r
+ * All rights reserved.</center></h2>\r
+ *\r
+ * This software component is licensed by ST under BSD 3-Clause license,\r
+ * the "License"; You may not use this file except in compliance with the\r
+ * License. You may obtain a copy of the License at:\r
+ * opensource.org/licenses/BSD-3-Clause\r
+ *\r
+ ******************************************************************************\r
+ */\r
+\r
+/*\r
+ * This example was developed using the following STMicroelectronics\r
+ * evaluation boards:\r
+ *\r
+ * - STEVAL_MKI109V3 + STEVAL-MKI179V1\r
+ * - NUCLEO_F411RE + X_NUCLEO_IKS01A3\r
+ * - DISCOVERY_SPC584B + X_NUCLEO_IKS01A3\r
+ *\r
+ * and STM32CubeMX tool with STM32CubeF4 MCU Package\r
+ *\r
+ * Used interfaces:\r
+ *\r
+ * STEVAL_MKI109V3 - Host side: USB (Virtual COM)\r
+ * - Sensor side: SPI(Default) / I2C(supported)\r
+ *\r
+ * NUCLEO_STM32F411RE - Host side: UART(COM) to USB bridge\r
+ * - I2C(Default) / SPI(supported)\r
+ *\r
+ * DISCOVERY_SPC584B - Host side: UART(COM) to USB bridge\r
+ * - Sensor side: I2C(Default) / SPI(supported)\r
+ *\r
+ * If you need to run this example on a different hardware platform a\r
+ * modification of the functions: `platform_write`, `platform_read`,\r
+ * `tx_com` and 'platform_init' is required.\r
+ *\r
+ */\r
+\r
+/* STMicroelectronics evaluation boards definition\r
+ *\r
+ * Please uncomment ONLY the evaluation boards in use.\r
+ * If a different hardware is used please comment all\r
+ * following target board and redefine yours.\r
+ */\r
+\r
+//#define STEVAL_MKI109V3 /* little endian */\r
+//#define NUCLEO_F411RE /* little endian */\r
+//#define SPC584B_DIS /* big endian */\r
+\r
+/* ATTENTION: By default the driver is little endian. If you need switch\r
+ * to big endian please see "Endianness definitions" in the\r
+ * header file of the driver (_reg.h).\r
+ */\r
+\r
+\r
+#if defined(STEVAL_MKI109V3)\r
+/* MKI109V3: Define communication interface */\r
+#define SENSOR_BUS hspi2\r
+/* MKI109V3: Vdd and Vddio power supply values */\r
+#define PWM_3V3 915\r
+\r
+#elif defined(NUCLEO_F411RE)\r
+/* NUCLEO_F411RE: Define communication interface */\r
+#define SENSOR_BUS hi2c1\r
+\r
+#elif defined(SPC584B_DIS)\r
+/* DISCOVERY_SPC584B: Define communication interface */\r
+#define SENSOR_BUS I2CD1\r
+\r
+#endif\r
+\r
+/* Includes ------------------------------------------------------------------*/\r
+#include <string.h>\r
+#include <stdio.h>\r
+#include "lis2doc_reg.h"\r
+\r
+#if defined(NUCLEO_F411RE)\r
+#include "stm32f4xx_hal.h"\r
+#include "usart.h"\r
+#include "gpio.h"\r
+#include "i2c.h"\r
+\r
+#elif defined(STEVAL_MKI109V3)\r
+#include "stm32f4xx_hal.h"\r
+#include "usbd_cdc_if.h"\r
+#include "gpio.h"\r
+#include "spi.h"\r
+#include "tim.h"\r
+\r
+#elif defined(SPC584B_DIS)\r
+#include "components.h"\r
+#endif\r
+\r
+/* Private macro -------------------------------------------------------------*/\r
+#define BOOT_TIME 20 //ms\r
+\r
+/* Private variables ---------------------------------------------------------*/\r
+static lis2doc_mode_t pm;\r
+static uint8_t whoamI, rst;\r
+static uint8_t tx_buffer[1000];\r
+\r
+/* Extern variables ----------------------------------------------------------*/\r
+\r
+/* Private functions ---------------------------------------------------------*/\r
+\r
+/*\r
+ * WARNING:\r
+ * Functions declare in this section are defined at the end of this file\r
+ * and are strictly related to the hardware platform used.\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+ uint16_t len);\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+ uint16_t len);\r
+static void tx_com( uint8_t *tx_buffer, uint16_t len );\r
+static void platform_delay(uint32_t ms);\r
+static void platform_init(void);\r
+\r
+\r
+/* Main Example --------------------------------------------------------------*/\r
+void lis2doc_activity(void)\r
+{\r
+ /* Initialize mems driver interface */\r
+ stmdev_ctx_t dev_ctx;\r
+ lis2doc_reg_t int_route;\r
+ dev_ctx.write_reg = platform_write;\r
+ dev_ctx.read_reg = platform_read;\r
+ dev_ctx.handle = &SENSOR_BUS;\r
+ /* Initialize platform specific hardware */\r
+ platform_init();\r
+ /* Wait sensor boot time */\r
+ platform_delay(BOOT_TIME);\r
+ /* Check device ID */\r
+ lis2doc_device_id_get(&dev_ctx, &whoamI);\r
+\r
+ if (whoamI != LIS2DOC_ID)\r
+ while (1) {\r
+ /* manage here device not found */\r
+ }\r
+\r
+ /* Restore default configuration */\r
+ lis2doc_reset_set(&dev_ctx, PROPERTY_ENABLE);\r
+\r
+ do {\r
+ lis2doc_reset_get(&dev_ctx, &rst);\r
+ } while (rst);\r
+\r
+ /* Set full scale */\r
+ lis2doc_full_scale_set(&dev_ctx, LIS2DOC_2g);\r
+ /* Configure filtering chain\r
+ * Accelerometer - filter path / bandwidth\r
+ */\r
+ lis2doc_filter_path_set(&dev_ctx, LIS2DOC_LPF_ON_OUT);\r
+ lis2doc_filter_bandwidth_set(&dev_ctx, LIS2DOC_ODR_DIV_4);\r
+\r
+ /* Configure power mode */\r
+ pm.lpm = 1;\r
+ pm.low_noise = 1;\r
+ lis2doc_power_mode_set(&dev_ctx, pm);\r
+\r
+ /* Set wake-up duration\r
+ * Wake up duration event 1LSb = 1 / ODR\r
+ */\r
+ lis2doc_wkup_dur_set(&dev_ctx, 2);\r
+ /* Set sleep duration\r
+ * Duration to go in sleep mode (1 LSb = 512 / ODR)\r
+ */\r
+ lis2doc_act_sleep_dur_set(&dev_ctx, 2);\r
+ /* Set Activity wake-up threshold\r
+ * Threshold for wake-up 1 LSB = FS_XL / 64\r
+ */\r
+ lis2doc_wkup_threshold_set(&dev_ctx, 2);\r
+ /* Data sent to wake-up interrupt function */\r
+ lis2doc_wkup_feed_data_set(&dev_ctx, LIS2DOC_HP_FEED);\r
+ /* Config activity / inactivity or stationary / motion detection */\r
+ lis2doc_act_mode_set(&dev_ctx, LIS2DOC_DETECT_ACT_INACT);\r
+ /* Enable activity detection interrupt */\r
+ lis2doc_pin_int1_route_get(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);\r
+ int_route.ctrl4_int1_pad_ctrl.int1_wu = PROPERTY_ENABLE;\r
+ lis2doc_pin_int1_route_set(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);\r
+ /* Set Output Data Rate */\r
+ lis2doc_data_rate_set(&dev_ctx, LIS2DOC_XL_ODR_200Hz);\r
+\r
+ /* Wait Events */\r
+ while (1) {\r
+ lis2doc_all_sources_t all_source;\r
+ /* Read status register */\r
+ lis2doc_all_sources_get(&dev_ctx, &all_source);\r
+\r
+ /* Check if Activity/Inactivity events */\r
+ if (all_source.wake_up_src.sleep_state_ia) {\r
+ sprintf((char *)tx_buffer, "Inactivity Detected\r\n");\r
+ tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
+ }\r
+\r
+ if (all_source.wake_up_src.wu_ia) {\r
+ sprintf((char *)tx_buffer, "Activity Detected\r\n");\r
+ tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
+ }\r
+ }\r
+}\r
+\r
+/*\r
+ * @brief Write generic device register (platform dependent)\r
+ *\r
+ * @param handle customizable argument. In this examples is used in\r
+ * order to select the correct sensor bus handler.\r
+ * @param reg register to write\r
+ * @param bufp pointer to data to write in register reg\r
+ * @param len number of consecutive register to write\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+ uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_I2C_Mem_Write(handle, LIS2DOC_I2C_ADD_H, reg,\r
+ I2C_MEMADD_SIZE_8BIT, (uint8_t*) bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+ HAL_SPI_Transmit(handle, ®, 1, 1000);\r
+ HAL_SPI_Transmit(handle, (uint8_t*) bufp, len, 1000);\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+ i2c_lld_write(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, (uint8_t*) bufp, len);\r
+#endif\r
+ return 0;\r
+}\r
+\r
+/*\r
+ * @brief Read generic device register (platform dependent)\r
+ *\r
+ * @param handle customizable argument. In this examples is used in\r
+ * order to select the correct sensor bus handler.\r
+ * @param reg register to read\r
+ * @param bufp pointer to buffer that store the data read\r
+ * @param len number of consecutive register to read\r
+ *\r
+ */\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+ uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_I2C_Mem_Read(handle, LIS2DOC_I2C_ADD_H, reg,\r
+ I2C_MEMADD_SIZE_8BIT, bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ reg |= 0x80;\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+ HAL_SPI_Transmit(handle, ®, 1, 1000);\r
+ HAL_SPI_Receive(handle, bufp, len, 1000);\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+ i2c_lld_read(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, bufp, len);\r
+#endif\r
+ return 0;\r
+}\r
+\r
+/*\r
+ * @brief Write generic device register (platform dependent)\r
+ *\r
+ * @param tx_buffer buffer to transmit\r
+ * @param len number of byte to send\r
+ *\r
+ */\r
+static void tx_com(uint8_t *tx_buffer, uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_UART_Transmit(&huart2, tx_buffer, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ CDC_Transmit_FS(tx_buffer, len);\r
+#elif defined(SPC584B_DIS)\r
+ sd_lld_write(&SD2, tx_buffer, len);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief platform specific delay (platform dependent)\r
+ *\r
+ * @param ms delay in ms\r
+ *\r
+ */\r
+static void platform_delay(uint32_t ms)\r
+{\r
+#if defined(NUCLEO_F411RE) | defined(STEVAL_MKI109V3)\r
+ HAL_Delay(ms);\r
+#elif defined(SPC584B_DIS)\r
+ osalThreadDelayMilliseconds(ms);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief platform specific initialization (platform dependent)\r
+ */\r
+static void platform_init(void)\r
+{\r
+#if defined(STEVAL_MKI109V3)\r
+ TIM3->CCR1 = PWM_3V3;\r
+ TIM3->CCR2 = PWM_3V3;\r
+ HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);\r
+ HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);\r
+ HAL_Delay(1000);\r
+#endif\r
+}
\ No newline at end of file
--- /dev/null
+/*\r
+ ******************************************************************************\r
+ * @file free_fall.c\r
+ * @author Sensors Software Solution Team\r
+ * @brief This file show the simplest way to detect free fall events\r
+ * from sensor.\r
+ *\r
+ ******************************************************************************\r
+ * @attention\r
+ *\r
+ * <h2><center>© Copyright (c) 2020 STMicroelectronics.\r
+ * All rights reserved.</center></h2>\r
+ *\r
+ * This software component is licensed by ST under BSD 3-Clause license,\r
+ * the "License"; You may not use this file except in compliance with the\r
+ * License. You may obtain a copy of the License at:\r
+ * opensource.org/licenses/BSD-3-Clause\r
+ *\r
+ ******************************************************************************\r
+ */\r
+\r
+/*\r
+ * This example was developed using the following STMicroelectronics\r
+ * evaluation boards:\r
+ *\r
+ * - STEVAL_MKI109V3 + STEVAL-MKI179V1\r
+ * - NUCLEO_F411RE + X_NUCLEO_IKS01A3\r
+ * - DISCOVERY_SPC584B + X_NUCLEO_IKS01A3\r
+ *\r
+ * and STM32CubeMX tool with STM32CubeF4 MCU Package\r
+ *\r
+ * Used interfaces:\r
+ *\r
+ * STEVAL_MKI109V3 - Host side: USB (Virtual COM)\r
+ * - Sensor side: SPI(Default) / I2C(supported)\r
+ *\r
+ * NUCLEO_STM32F411RE - Host side: UART(COM) to USB bridge\r
+ * - I2C(Default) / SPI(supported)\r
+ *\r
+ * DISCOVERY_SPC584B - Host side: UART(COM) to USB bridge\r
+ * - Sensor side: I2C(Default) / SPI(supported)\r
+ *\r
+ * If you need to run this example on a different hardware platform a\r
+ * modification of the functions: `platform_write`, `platform_read`,\r
+ * `tx_com` and 'platform_init' is required.\r
+ *\r
+ */\r
+\r
+/* STMicroelectronics evaluation boards definition\r
+ *\r
+ * Please uncomment ONLY the evaluation boards in use.\r
+ * If a different hardware is used please comment all\r
+ * following target board and redefine yours.\r
+ */\r
+\r
+//#define STEVAL_MKI109V3 /* little endian */\r
+//#define NUCLEO_F411RE /* little endian */\r
+//#define SPC584B_DIS /* big endian */\r
+\r
+/* ATTENTION: By default the driver is little endian. If you need switch\r
+ * to big endian please see "Endianness definitions" in the\r
+ * header file of the driver (_reg.h).\r
+ */\r
+\r
+\r
+#if defined(STEVAL_MKI109V3)\r
+/* MKI109V3: Define communication interface */\r
+#define SENSOR_BUS hspi2\r
+/* MKI109V3: Vdd and Vddio power supply values */\r
+#define PWM_3V3 915\r
+\r
+#elif defined(NUCLEO_F411RE)\r
+/* NUCLEO_F411RE: Define communication interface */\r
+#define SENSOR_BUS hi2c1\r
+\r
+#elif defined(SPC584B_DIS)\r
+/* DISCOVERY_SPC584B: Define communication interface */\r
+#define SENSOR_BUS I2CD1\r
+\r
+#endif\r
+\r
+/* Includes ------------------------------------------------------------------*/\r
+#include <string.h>\r
+#include <stdio.h>\r
+#include "lis2doc_reg.h"\r
+\r
+#if defined(NUCLEO_F411RE)\r
+#include "stm32f4xx_hal.h"\r
+#include "usart.h"\r
+#include "gpio.h"\r
+#include "i2c.h"\r
+\r
+#elif defined(STEVAL_MKI109V3)\r
+#include "stm32f4xx_hal.h"\r
+#include "usbd_cdc_if.h"\r
+#include "gpio.h"\r
+#include "spi.h"\r
+#include "tim.h"\r
+\r
+#elif defined(SPC584B_DIS)\r
+#include "components.h"\r
+#endif\r
+\r
+/* Private macro -------------------------------------------------------------*/\r
+#define BOOT_TIME 20 //ms\r
+\r
+/* Private variables ---------------------------------------------------------*/\r
+static lis2doc_mode_t pm;\r
+static uint8_t whoamI, rst;\r
+static uint8_t tx_buffer[1000];\r
+\r
+/* Extern variables ----------------------------------------------------------*/\r
+\r
+/* Private functions ---------------------------------------------------------*/\r
+/*\r
+ * WARNING:\r
+ * Functions declare in this section are defined at the end of this file\r
+ * and are strictly related to the hardware platform used.\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+ uint16_t len);\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+ uint16_t len);\r
+static void tx_com( uint8_t *tx_buffer, uint16_t len );\r
+static void platform_delay(uint32_t ms);\r
+static void platform_init(void);\r
+\r
+/* Main Example --------------------------------------------------------------*/\r
+void lis2doc_free_fall(void)\r
+{\r
+ /* Initialize mems driver interface */\r
+ stmdev_ctx_t dev_ctx;\r
+ lis2doc_reg_t int_route;\r
+ dev_ctx.write_reg = platform_write;\r
+ dev_ctx.read_reg = platform_read;\r
+ dev_ctx.handle = &SENSOR_BUS;\r
+ /* Initialize platform specific hardware */\r
+ platform_init();\r
+ /* Wait sensor boot time */\r
+ platform_delay(BOOT_TIME);\r
+ /* Check device ID */\r
+ lis2doc_device_id_get(&dev_ctx, &whoamI);\r
+\r
+ if (whoamI != LIS2DOC_ID)\r
+ while (1) {\r
+ /* manage here device not found */\r
+ }\r
+\r
+ /* Restore default configuration */\r
+ lis2doc_reset_set(&dev_ctx, PROPERTY_ENABLE);\r
+\r
+ do {\r
+ lis2doc_reset_get(&dev_ctx, &rst);\r
+ } while (rst);\r
+\r
+ /* Configure power mode */\r
+ pm.hpm = 1;\r
+ pm.low_noise = 1;\r
+ lis2doc_power_mode_set(&dev_ctx, pm);\r
+\r
+ /* Set Output Data Rate */\r
+ lis2doc_data_rate_set(&dev_ctx, LIS2DOC_XL_ODR_200Hz);\r
+ /* Set full scale to 2 g */\r
+ lis2doc_full_scale_set(&dev_ctx, LIS2DOC_2g);\r
+ /* Configure Free Fall duration and samples count */\r
+ lis2doc_ff_dur_set(&dev_ctx, 0x06);\r
+ lis2doc_ff_threshold_set(&dev_ctx, LIS2DOC_FF_TSH_10LSb_FS2g);\r
+ /* Enable free fall interrupt */\r
+ lis2doc_pin_int1_route_get(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);\r
+ int_route.ctrl4_int1_pad_ctrl.int1_ff = PROPERTY_ENABLE;\r
+ lis2doc_pin_int1_route_set(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);\r
+ /* Set latched interrupt */\r
+ lis2doc_int_notification_set(&dev_ctx, LIS2DOC_INT_LATCHED);\r
+\r
+ /* Wait Events */\r
+ while (1) {\r
+ /* Check Free Fall events */\r
+ lis2doc_all_sources_t src;\r
+ lis2doc_all_sources_get(&dev_ctx, &src);\r
+\r
+ if (src.wake_up_src.ff_ia) {\r
+ sprintf((char *)tx_buffer, "free fall detected\r\n");\r
+ tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
+ }\r
+ }\r
+}\r
+\r
+/*\r
+ * @brief Write generic device register (platform dependent)\r
+ *\r
+ * @param handle customizable argument. In this examples is used in\r
+ * order to select the correct sensor bus handler.\r
+ * @param reg register to write\r
+ * @param bufp pointer to data to write in register reg\r
+ * @param len number of consecutive register to write\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+ uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_I2C_Mem_Write(handle, LIS2DOC_I2C_ADD_H, reg,\r
+ I2C_MEMADD_SIZE_8BIT, (uint8_t*) bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+ HAL_SPI_Transmit(handle, ®, 1, 1000);\r
+ HAL_SPI_Transmit(handle, (uint8_t*) bufp, len, 1000);\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+ i2c_lld_write(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, (uint8_t*) bufp, len);\r
+#endif\r
+ return 0;\r
+}\r
+\r
+/*\r
+ * @brief Read generic device register (platform dependent)\r
+ *\r
+ * @param handle customizable argument. In this examples is used in\r
+ * order to select the correct sensor bus handler.\r
+ * @param reg register to read\r
+ * @param bufp pointer to buffer that store the data read\r
+ * @param len number of consecutive register to read\r
+ *\r
+ */\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+ uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_I2C_Mem_Read(handle, LIS2DOC_I2C_ADD_H, reg,\r
+ I2C_MEMADD_SIZE_8BIT, bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ reg |= 0x80;\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+ HAL_SPI_Transmit(handle, ®, 1, 1000);\r
+ HAL_SPI_Receive(handle, bufp, len, 1000);\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+ i2c_lld_read(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, bufp, len);\r
+#endif\r
+ return 0;\r
+}\r
+\r
+/*\r
+ * @brief Write generic device register (platform dependent)\r
+ *\r
+ * @param tx_buffer buffer to transmit\r
+ * @param len number of byte to send\r
+ *\r
+ */\r
+static void tx_com(uint8_t *tx_buffer, uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_UART_Transmit(&huart2, tx_buffer, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ CDC_Transmit_FS(tx_buffer, len);\r
+#elif defined(SPC584B_DIS)\r
+ sd_lld_write(&SD2, tx_buffer, len);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief platform specific delay (platform dependent)\r
+ *\r
+ * @param ms delay in ms\r
+ *\r
+ */\r
+static void platform_delay(uint32_t ms)\r
+{\r
+#if defined(NUCLEO_F411RE) | defined(STEVAL_MKI109V3)\r
+ HAL_Delay(ms);\r
+#elif defined(SPC584B_DIS)\r
+ osalThreadDelayMilliseconds(ms);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief platform specific initialization (platform dependent)\r
+ */\r
+static void platform_init(void)\r
+{\r
+#if defined(STEVAL_MKI109V3)\r
+ TIM3->CCR1 = PWM_3V3;\r
+ TIM3->CCR2 = PWM_3V3;\r
+ HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);\r
+ HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);\r
+ HAL_Delay(1000);\r
+#endif\r
+}
\ No newline at end of file
--- /dev/null
+/*\r
+ ******************************************************************************\r
+ * @file orientation.c\r
+ * @author Sensors Software Solution Team\r
+ * @brief This file show the simplest way to detect 6D orientation from sensor.\r
+ *\r
+ ******************************************************************************\r
+ * @attention\r
+ *\r
+ * <h2><center>© Copyright (c) 2020 STMicroelectronics.\r
+ * All rights reserved.</center></h2>\r
+ *\r
+ * This software component is licensed by ST under BSD 3-Clause license,\r
+ * the "License"; You may not use this file except in compliance with the\r
+ * License. You may obtain a copy of the License at:\r
+ * opensource.org/licenses/BSD-3-Clause\r
+ *\r
+ ******************************************************************************\r
+ */\r
+\r
+/*\r
+ * This example was developed using the following STMicroelectronics\r
+ * evaluation boards:\r
+ *\r
+ * - STEVAL_MKI109V3 + STEVAL-MKI179V1\r
+ * - NUCLEO_F411RE + X_NUCLEO_IKS01A3\r
+ * - DISCOVERY_SPC584B + X_NUCLEO_IKS01A3\r
+ *\r
+ * and STM32CubeMX tool with STM32CubeF4 MCU Package\r
+ *\r
+ * Used interfaces:\r
+ *\r
+ * STEVAL_MKI109V3 - Host side: USB (Virtual COM)\r
+ * - Sensor side: SPI(Default) / I2C(supported)\r
+ *\r
+ * NUCLEO_STM32F411RE - Host side: UART(COM) to USB bridge\r
+ * - I2C(Default) / SPI(supported)\r
+ *\r
+ * DISCOVERY_SPC584B - Host side: UART(COM) to USB bridge\r
+ * - Sensor side: I2C(Default) / SPI(supported)\r
+ *\r
+ * If you need to run this example on a different hardware platform a\r
+ * modification of the functions: `platform_write`, `platform_read`,\r
+ * `tx_com` and 'platform_init' is required.\r
+ *\r
+ */\r
+\r
+/* STMicroelectronics evaluation boards definition\r
+ *\r
+ * Please uncomment ONLY the evaluation boards in use.\r
+ * If a different hardware is used please comment all\r
+ * following target board and redefine yours.\r
+ */\r
+\r
+//#define STEVAL_MKI109V3 /* little endian */\r
+//#define NUCLEO_F411RE /* little endian */\r
+//#define SPC584B_DIS /* big endian */\r
+\r
+/* ATTENTION: By default the driver is little endian. If you need switch\r
+ * to big endian please see "Endianness definitions" in the\r
+ * header file of the driver (_reg.h).\r
+ */\r
+\r
+\r
+#if defined(STEVAL_MKI109V3)\r
+/* MKI109V3: Define communication interface */\r
+#define SENSOR_BUS hspi2\r
+/* MKI109V3: Vdd and Vddio power supply values */\r
+#define PWM_3V3 915\r
+\r
+#elif defined(NUCLEO_F411RE)\r
+/* NUCLEO_F411RE: Define communication interface */\r
+#define SENSOR_BUS hi2c1\r
+\r
+#elif defined(SPC584B_DIS)\r
+/* DISCOVERY_SPC584B: Define communication interface */\r
+#define SENSOR_BUS I2CD1\r
+\r
+#endif\r
+\r
+/* Includes ------------------------------------------------------------------*/\r
+#include <string.h>\r
+#include <stdio.h>\r
+#include "lis2doc_reg.h"\r
+\r
+#if defined(NUCLEO_F411RE)\r
+#include "stm32f4xx_hal.h"\r
+#include "usart.h"\r
+#include "gpio.h"\r
+#include "i2c.h"\r
+\r
+#elif defined(STEVAL_MKI109V3)\r
+#include "stm32f4xx_hal.h"\r
+#include "usbd_cdc_if.h"\r
+#include "gpio.h"\r
+#include "spi.h"\r
+#include "tim.h"\r
+\r
+#elif defined(SPC584B_DIS)\r
+#include "components.h"\r
+#endif\r
+\r
+/* Private macro -------------------------------------------------------------*/\r
+#define BOOT_TIME 20 //ms\r
+\r
+/* Private variables ---------------------------------------------------------*/\r
+static lis2doc_mode_t pm;\r
+static uint8_t whoamI, rst;\r
+static uint8_t tx_buffer[1000];\r
+\r
+/* Extern variables ----------------------------------------------------------*/\r
+\r
+/* Private functions ---------------------------------------------------------*/\r
+/*\r
+ * WARNING:\r
+ * Functions declare in this section are defined at the end of this file\r
+ * and are strictly related to the hardware platform used.\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+ uint16_t len);\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+ uint16_t len);\r
+static void tx_com( uint8_t *tx_buffer, uint16_t len );\r
+static void platform_delay(uint32_t ms);\r
+static void platform_init(void);\r
+\r
+/* Main Example --------------------------------------------------------------*/\r
+void lis2doc_orientation(void)\r
+{\r
+ /* Initialize mems driver interface */\r
+ stmdev_ctx_t dev_ctx;\r
+ lis2doc_reg_t int_route;\r
+ dev_ctx.write_reg = platform_write;\r
+ dev_ctx.read_reg = platform_read;\r
+ dev_ctx.handle = &SENSOR_BUS;\r
+ /* Initialize platform specific hardware */\r
+ platform_init();\r
+ /* Wait sensor boot time */\r
+ platform_delay(BOOT_TIME);\r
+ /* Check device ID */\r
+ lis2doc_device_id_get(&dev_ctx, &whoamI);\r
+\r
+ if (whoamI != LIS2DOC_ID)\r
+ while (1) {\r
+ /* manage here device not found */\r
+ }\r
+\r
+ /* Restore default configuration */\r
+ lis2doc_reset_set(&dev_ctx, PROPERTY_ENABLE);\r
+\r
+ do {\r
+ lis2doc_reset_get(&dev_ctx, &rst);\r
+ } while (rst);\r
+\r
+ /* Set full scale */\r
+ lis2doc_full_scale_set(&dev_ctx, LIS2DOC_2g);\r
+\r
+ /* Configure power mode */\r
+ pm.lpm = 1;\r
+ pm.low_noise = 1;\r
+ lis2doc_power_mode_set(&dev_ctx, pm);\r
+\r
+ /* Set threshold to 60 degrees */\r
+ lis2doc_6d_threshold_set(&dev_ctx, 0x02);\r
+ /* LPF2 on 6D function selection. */\r
+ lis2doc_6d_feed_data_set(&dev_ctx, LIS2DOC_LPF2_FEED);\r
+ /* Enable interrupt generation on 6D INT1 pin. */\r
+ lis2doc_pin_int1_route_get(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);\r
+ int_route.ctrl4_int1_pad_ctrl.int1_6d = PROPERTY_ENABLE;\r
+ lis2doc_pin_int1_route_set(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);\r
+ /* Set Output Data Rate */\r
+ lis2doc_data_rate_set(&dev_ctx, LIS2DOC_XL_ODR_200Hz);\r
+\r
+ /* Wait Events. */\r
+ while (1) {\r
+ lis2doc_all_sources_t all_source;\r
+ lis2doc_all_sources_get(&dev_ctx, &all_source);\r
+\r
+ /* Check 6D Orientation events */\r
+ if (all_source.sixd_src._6d_ia) {\r
+ sprintf((char *)tx_buffer, "6D Or. switched to ");\r
+\r
+ if (all_source.sixd_src.xh) {\r
+ strcat((char *)tx_buffer, "XH");\r
+ }\r
+\r
+ if (all_source.sixd_src.xl) {\r
+ strcat((char *)tx_buffer, "XL");\r
+ }\r
+\r
+ if (all_source.sixd_src.yh) {\r
+ strcat((char *)tx_buffer, "YH");\r
+ }\r
+\r
+ if (all_source.sixd_src.yl) {\r
+ strcat((char *)tx_buffer, "YL");\r
+ }\r
+\r
+ if (all_source.sixd_src.zh) {\r
+ strcat((char *)tx_buffer, "ZH");\r
+ }\r
+\r
+ if (all_source.sixd_src.zl) {\r
+ strcat((char *)tx_buffer, "ZL");\r
+ }\r
+\r
+ strcat((char *)tx_buffer, "\r\n");\r
+ tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
+ }\r
+ }\r
+}\r
+\r
+/*\r
+ * @brief Write generic device register (platform dependent)\r
+ *\r
+ * @param handle customizable argument. In this examples is used in\r
+ * order to select the correct sensor bus handler.\r
+ * @param reg register to write\r
+ * @param bufp pointer to data to write in register reg\r
+ * @param len number of consecutive register to write\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+ uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_I2C_Mem_Write(handle, LIS2DOC_I2C_ADD_H, reg,\r
+ I2C_MEMADD_SIZE_8BIT, (uint8_t*) bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+ HAL_SPI_Transmit(handle, ®, 1, 1000);\r
+ HAL_SPI_Transmit(handle, (uint8_t*) bufp, len, 1000);\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+ i2c_lld_write(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, (uint8_t*) bufp, len);\r
+#endif\r
+ return 0;\r
+}\r
+\r
+/*\r
+ * @brief Read generic device register (platform dependent)\r
+ *\r
+ * @param handle customizable argument. In this examples is used in\r
+ * order to select the correct sensor bus handler.\r
+ * @param reg register to read\r
+ * @param bufp pointer to buffer that store the data read\r
+ * @param len number of consecutive register to read\r
+ *\r
+ */\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+ uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_I2C_Mem_Read(handle, LIS2DOC_I2C_ADD_H, reg,\r
+ I2C_MEMADD_SIZE_8BIT, bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ reg |= 0x80;\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+ HAL_SPI_Transmit(handle, ®, 1, 1000);\r
+ HAL_SPI_Receive(handle, bufp, len, 1000);\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+ i2c_lld_read(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, bufp, len);\r
+#endif\r
+ return 0;\r
+}\r
+\r
+/*\r
+ * @brief Write generic device register (platform dependent)\r
+ *\r
+ * @param tx_buffer buffer to transmit\r
+ * @param len number of byte to send\r
+ *\r
+ */\r
+static void tx_com(uint8_t *tx_buffer, uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_UART_Transmit(&huart2, tx_buffer, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ CDC_Transmit_FS(tx_buffer, len);\r
+#elif defined(SPC584B_DIS)\r
+ sd_lld_write(&SD2, tx_buffer, len);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief platform specific delay (platform dependent)\r
+ *\r
+ * @param ms delay in ms\r
+ *\r
+ */\r
+static void platform_delay(uint32_t ms)\r
+{\r
+#if defined(NUCLEO_F411RE) | defined(STEVAL_MKI109V3)\r
+ HAL_Delay(ms);\r
+#elif defined(SPC584B_DIS)\r
+ osalThreadDelayMilliseconds(ms);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief platform specific initialization (platform dependent)\r
+ */\r
+static void platform_init(void)\r
+{\r
+#if defined(STEVAL_MKI109V3)\r
+ TIM3->CCR1 = PWM_3V3;\r
+ TIM3->CCR2 = PWM_3V3;\r
+ HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);\r
+ HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);\r
+ HAL_Delay(1000);\r
+#endif\r
+}
\ No newline at end of file
--- /dev/null
+/*\r
+ ******************************************************************************\r
+ * @file read_data_polling.c\r
+ * @author Sensors Software Solution Team\r
+ * @brief This file show the simplest way to get data from sensor.\r
+ *\r
+ ******************************************************************************\r
+ * @attention\r
+ *\r
+ * <h2><center>© Copyright (c) 2020 STMicroelectronics.\r
+ * All rights reserved.</center></h2>\r
+ *\r
+ * This software component is licensed by ST under BSD 3-Clause license,\r
+ * the "License"; You may not use this file except in compliance with the\r
+ * License. You may obtain a copy of the License at:\r
+ * opensource.org/licenses/BSD-3-Clause\r
+ *\r
+ ******************************************************************************\r
+ */\r
+\r
+/*\r
+ * This example was developed using the following STMicroelectronics\r
+ * evaluation boards:\r
+ *\r
+ * - STEVAL_MKI109V3 + STEVAL-MKI179V1\r
+ * - NUCLEO_F411RE + X_NUCLEO_IKS01A3\r
+ * - DISCOVERY_SPC584B + X_NUCLEO_IKS01A3\r
+ *\r
+ * and STM32CubeMX tool with STM32CubeF4 MCU Package\r
+ *\r
+ * Used interfaces:\r
+ *\r
+ * STEVAL_MKI109V3 - Host side: USB (Virtual COM)\r
+ * - Sensor side: SPI(Default) / I2C(supported)\r
+ *\r
+ * NUCLEO_STM32F411RE - Host side: UART(COM) to USB bridge\r
+ * - I2C(Default) / SPI(supported)\r
+ *\r
+ * DISCOVERY_SPC584B - Host side: UART(COM) to USB bridge\r
+ * - Sensor side: I2C(Default) / SPI(supported)\r
+ *\r
+ * If you need to run this example on a different hardware platform a\r
+ * modification of the functions: `platform_write`, `platform_read`,\r
+ * `tx_com` and 'platform_init' is required.\r
+ *\r
+ */\r
+\r
+/* STMicroelectronics evaluation boards definition\r
+ *\r
+ * Please uncomment ONLY the evaluation boards in use.\r
+ * If a different hardware is used please comment all\r
+ * following target board and redefine yours.\r
+ */\r
+\r
+//#define STEVAL_MKI109V3 /* little endian */\r
+//#define NUCLEO_F411RE /* little endian */\r
+//#define SPC584B_DIS /* big endian */\r
+\r
+/* ATTENTION: By default the driver is little endian. If you need switch\r
+ * to big endian please see "Endianness definitions" in the\r
+ * header file of the driver (_reg.h).\r
+ */\r
+\r
+\r
+#if defined(STEVAL_MKI109V3)\r
+/* MKI109V3: Define communication interface */\r
+#define SENSOR_BUS hspi2\r
+/* MKI109V3: Vdd and Vddio power supply values */\r
+#define PWM_3V3 915\r
+\r
+#elif defined(NUCLEO_F411RE)\r
+/* NUCLEO_F411RE: Define communication interface */\r
+#define SENSOR_BUS hi2c1\r
+\r
+#elif defined(SPC584B_DIS)\r
+/* DISCOVERY_SPC584B: Define communication interface */\r
+#define SENSOR_BUS I2CD1\r
+\r
+#endif\r
+\r
+/* Includes ------------------------------------------------------------------*/\r
+#include <string.h>\r
+#include <stdio.h>\r
+#include "lis2doc_reg.h"\r
+\r
+#if defined(NUCLEO_F411RE)\r
+#include "stm32f4xx_hal.h"\r
+#include "usart.h"\r
+#include "gpio.h"\r
+#include "i2c.h"\r
+\r
+#elif defined(STEVAL_MKI109V3)\r
+#include "stm32f4xx_hal.h"\r
+#include "usbd_cdc_if.h"\r
+#include "gpio.h"\r
+#include "spi.h"\r
+#include "tim.h"\r
+\r
+#elif defined(SPC584B_DIS)\r
+#include "components.h"\r
+#endif\r
+\r
+/* Private macro -------------------------------------------------------------*/\r
+#define BOOT_TIME 20 //ms\r
+\r
+/* Private variables ---------------------------------------------------------*/\r
+\r
+static lis2doc_mode_t pm;\r
+static int16_t data_raw_acceleration[3];\r
+static float acceleration_mg[3];\r
+static uint8_t whoamI, rst;\r
+static uint8_t tx_buffer[1000];\r
+\r
+/* Extern variables ----------------------------------------------------------*/\r
+\r
+/* Private functions ---------------------------------------------------------*/\r
+/*\r
+ * WARNING:\r
+ * Functions declare in this section are defined at the end of this file\r
+ * and are strictly related to the hardware platform used.\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+ uint16_t len);\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+ uint16_t len);\r
+static void tx_com( uint8_t *tx_buffer, uint16_t len );\r
+static void platform_delay(uint32_t ms);\r
+static void platform_init(void);\r
+\r
+/* Main Example --------------------------------------------------------------*/\r
+void lis2doc_read_data_polling(void)\r
+{\r
+ /* Initialize mems driver interface */\r
+ stmdev_ctx_t dev_ctx;\r
+\r
+ dev_ctx.write_reg = platform_write;\r
+ dev_ctx.read_reg = platform_read;\r
+ dev_ctx.handle = &SENSOR_BUS;\r
+ /* Initialize platform specific hardware */\r
+ platform_init();\r
+ /* Wait sensor boot time */\r
+ platform_delay(BOOT_TIME);\r
+ /* Check device ID */\r
+ lis2doc_device_id_get(&dev_ctx, &whoamI);\r
+\r
+ if (whoamI != LIS2DOC_ID)\r
+ while (1) {\r
+ /* manage here device not found */\r
+ }\r
+\r
+ /* Restore default configuration */\r
+ lis2doc_reset_set(&dev_ctx, PROPERTY_ENABLE);\r
+\r
+ do {\r
+ lis2doc_reset_get(&dev_ctx, &rst);\r
+ } while (rst);\r
+\r
+ /* Enable Block Data Update */\r
+ lis2doc_block_data_update_set(&dev_ctx, PROPERTY_ENABLE);\r
+ /* Set full scale */\r
+ //lis2doc_full_scale_set(&dev_ctx, LIS2DOC_8g);\r
+ lis2doc_full_scale_set(&dev_ctx, LIS2DOC_2g);\r
+ /* Configure filtering chain\r
+ * Accelerometer - filter path / bandwidth\r
+ */\r
+ lis2doc_filter_path_set(&dev_ctx, LIS2DOC_LPF_ON_OUT);\r
+ lis2doc_filter_bandwidth_set(&dev_ctx, LIS2DOC_ODR_DIV_4);\r
+\r
+ /* Configure power mode */\r
+ pm.hpm = 1;\r
+ pm.low_noise = 1;\r
+ lis2doc_power_mode_set(&dev_ctx, pm);\r
+\r
+ /* Set Output Data Rate */\r
+ lis2doc_data_rate_set(&dev_ctx, LIS2DOC_XL_ODR_25Hz);\r
+\r
+ /* Read samples in polling mode (no int) */\r
+ while (1) {\r
+ uint8_t reg;\r
+ /* Read output only if new value is available */\r
+ lis2doc_flag_data_ready_get(&dev_ctx, ®);\r
+\r
+ if (reg) {\r
+ /* Read acceleration data */\r
+ memset(data_raw_acceleration, 0x00, 3 * sizeof(int16_t));\r
+ lis2doc_acceleration_raw_get(&dev_ctx, data_raw_acceleration);\r
+ //acceleration_mg[0] = lis2doc_from_fs8_lp1_to_mg(data_raw_acceleration[0]);\r
+ //acceleration_mg[1] = lis2doc_from_fs8_lp1_to_mg(data_raw_acceleration[1]);\r
+ //acceleration_mg[2] = lis2doc_from_fs8_lp1_to_mg(data_raw_acceleration[2]);\r
+ acceleration_mg[0] = lis2doc_from_fs2_to_mg(\r
+ data_raw_acceleration[0]);\r
+ acceleration_mg[1] = lis2doc_from_fs2_to_mg(\r
+ data_raw_acceleration[1]);\r
+ acceleration_mg[2] = lis2doc_from_fs2_to_mg(\r
+ data_raw_acceleration[2]);\r
+ sprintf((char *)tx_buffer,\r
+ "Acceleration [mg]:%4.2f\t%4.2f\t%4.2f\r\n",\r
+ acceleration_mg[0], acceleration_mg[1], acceleration_mg[2]);\r
+ tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
+ }\r
+ }\r
+}\r
+\r
+/*\r
+ * @brief Write generic device register (platform dependent)\r
+ *\r
+ * @param handle customizable argument. In this examples is used in\r
+ * order to select the correct sensor bus handler.\r
+ * @param reg register to write\r
+ * @param bufp pointer to data to write in register reg\r
+ * @param len number of consecutive register to write\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+ uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_I2C_Mem_Write(handle, LIS2DOC_I2C_ADD_H, reg,\r
+ I2C_MEMADD_SIZE_8BIT, (uint8_t*) bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+ HAL_SPI_Transmit(handle, ®, 1, 1000);\r
+ HAL_SPI_Transmit(handle, (uint8_t*) bufp, len, 1000);\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+ i2c_lld_write(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, (uint8_t*) bufp, len);\r
+#endif\r
+ return 0;\r
+}\r
+\r
+/*\r
+ * @brief Read generic device register (platform dependent)\r
+ *\r
+ * @param handle customizable argument. In this examples is used in\r
+ * order to select the correct sensor bus handler.\r
+ * @param reg register to read\r
+ * @param bufp pointer to buffer that store the data read\r
+ * @param len number of consecutive register to read\r
+ *\r
+ */\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+ uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_I2C_Mem_Read(handle, LIS2DOC_I2C_ADD_H, reg,\r
+ I2C_MEMADD_SIZE_8BIT, bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ reg |= 0x80;\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+ HAL_SPI_Transmit(handle, ®, 1, 1000);\r
+ HAL_SPI_Receive(handle, bufp, len, 1000);\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+ i2c_lld_read(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, bufp, len);\r
+#endif\r
+ return 0;\r
+}\r
+\r
+/*\r
+ * @brief Write generic device register (platform dependent)\r
+ *\r
+ * @param tx_buffer buffer to transmit\r
+ * @param len number of byte to send\r
+ *\r
+ */\r
+static void tx_com(uint8_t *tx_buffer, uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_UART_Transmit(&huart2, tx_buffer, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ CDC_Transmit_FS(tx_buffer, len);\r
+#elif defined(SPC584B_DIS)\r
+ sd_lld_write(&SD2, tx_buffer, len);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief platform specific delay (platform dependent)\r
+ *\r
+ * @param ms delay in ms\r
+ *\r
+ */\r
+static void platform_delay(uint32_t ms)\r
+{\r
+#if defined(NUCLEO_F411RE) | defined(STEVAL_MKI109V3)\r
+ HAL_Delay(ms);\r
+#elif defined(SPC584B_DIS)\r
+ osalThreadDelayMilliseconds(ms);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief platform specific initialization (platform dependent)\r
+ */\r
+static void platform_init(void)\r
+{\r
+#if defined(STEVAL_MKI109V3)\r
+ TIM3->CCR1 = PWM_3V3;\r
+ TIM3->CCR2 = PWM_3V3;\r
+ HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);\r
+ HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);\r
+ HAL_Delay(1000);\r
+#endif\r
+}\r
--- /dev/null
+/*\r
+ ******************************************************************************\r
+ * @file read_data_simple.c\r
+ * @author Sensors Software Solution Team\r
+ * @brief This file show the simplest way to get data from sensor.\r
+ *\r
+ ******************************************************************************\r
+ * @attention\r
+ *\r
+ * <h2><center>© Copyright (c) 2020 STMicroelectronics.\r
+ * All rights reserved.</center></h2>\r
+ *\r
+ * This software component is licensed by ST under BSD 3-Clause license,\r
+ * the "License"; You may not use this file except in compliance with the\r
+ * License. You may obtain a copy of the License at:\r
+ * opensource.org/licenses/BSD-3-Clause\r
+ *\r
+ ******************************************************************************\r
+ */\r
+\r
+/*\r
+ * This example was developed using the following STMicroelectronics\r
+ * evaluation boards:\r
+ *\r
+ * - STEVAL_MKI109V3 + STEVAL-MKI179V1\r
+ * - NUCLEO_F411RE + X_NUCLEO_IKS01A3\r
+ * - DISCOVERY_SPC584B + X_NUCLEO_IKS01A3\r
+ *\r
+ * and STM32CubeMX tool with STM32CubeF4 MCU Package\r
+ *\r
+ * Used interfaces:\r
+ *\r
+ * STEVAL_MKI109V3 - Host side: USB (Virtual COM)\r
+ * - Sensor side: SPI(Default) / I2C(supported)\r
+ *\r
+ * NUCLEO_STM32F411RE - Host side: UART(COM) to USB bridge\r
+ * - I2C(Default) / SPI(supported)\r
+ *\r
+ * DISCOVERY_SPC584B - Host side: UART(COM) to USB bridge\r
+ * - Sensor side: I2C(Default) / SPI(supported)\r
+ *\r
+ * If you need to run this example on a different hardware platform a\r
+ * modification of the functions: `platform_write`, `platform_read`,\r
+ * `tx_com` and 'platform_init' is required.\r
+ *\r
+ */\r
+\r
+/* STMicroelectronics evaluation boards definition\r
+ *\r
+ * Please uncomment ONLY the evaluation boards in use.\r
+ * If a different hardware is used please comment all\r
+ * following target board and redefine yours.\r
+ */\r
+\r
+//#define STEVAL_MKI109V3 /* little endian */\r
+//#define NUCLEO_F411RE /* little endian */\r
+//#define SPC584B_DIS /* big endian */\r
+\r
+/* ATTENTION: By default the driver is little endian. If you need switch\r
+ * to big endian please see "Endianness definitions" in the\r
+ * header file of the driver (_reg.h).\r
+ */\r
+\r
+\r
+#if defined(STEVAL_MKI109V3)\r
+/* MKI109V3: Define communication interface */\r
+#define SENSOR_BUS hspi2\r
+/* MKI109V3: Vdd and Vddio power supply values */\r
+#define PWM_3V3 915\r
+\r
+#elif defined(NUCLEO_F411RE)\r
+/* NUCLEO_F411RE: Define communication interface */\r
+#define SENSOR_BUS hi2c1\r
+\r
+#elif defined(SPC584B_DIS)\r
+/* DISCOVERY_SPC584B: Define communication interface */\r
+#define SENSOR_BUS I2CD1\r
+\r
+#endif\r
+\r
+/* Includes ------------------------------------------------------------------*/\r
+#include <string.h>\r
+#include <stdio.h>\r
+#include "lis2doc_reg.h"\r
+\r
+#if defined(NUCLEO_F411RE)\r
+#include "stm32f4xx_hal.h"\r
+#include "usart.h"\r
+#include "gpio.h"\r
+#include "i2c.h"\r
+\r
+#elif defined(STEVAL_MKI109V3)\r
+#include "stm32f4xx_hal.h"\r
+#include "usbd_cdc_if.h"\r
+#include "gpio.h"\r
+#include "spi.h"\r
+#include "tim.h"\r
+\r
+#elif defined(SPC584B_DIS)\r
+#include "components.h"\r
+#endif\r
+\r
+/* Private macro -------------------------------------------------------------*/\r
+#define BOOT_TIME 20 //ms\r
+\r
+/* Private variables ---------------------------------------------------------*/\r
+static lis2doc_mode_t pm;\r
+static int16_t data_raw_acceleration[3];\r
+static float acceleration_mg[3];\r
+static uint8_t whoamI, rst;\r
+static uint8_t tx_buffer[1000];\r
+static lis2doc_ctrl4_int1_pad_ctrl_t ctrl4_int1_pad;\r
+\r
+/* Extern variables ----------------------------------------------------------*/\r
+\r
+/* Private functions ---------------------------------------------------------*/\r
+/*\r
+ * WARNING:\r
+ * Functions declare in this section are defined at the end of this file\r
+ * and are strictly related to the hardware platform used.\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+ uint16_t len);\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+ uint16_t len);\r
+static void tx_com( uint8_t *tx_buffer, uint16_t len );\r
+static void platform_delay(uint32_t ms);\r
+static void platform_init(void);\r
+\r
+/* Main Example --------------------------------------------------------------*/\r
+void lis2doc_read_data_single(void)\r
+{\r
+ /* Initialize mems driver interface */\r
+ stmdev_ctx_t dev_ctx;\r
+ dev_ctx.write_reg = platform_write;\r
+ dev_ctx.read_reg = platform_read;\r
+ dev_ctx.handle = &SENSOR_BUS;\r
+ /* Initialize platform specific hardware */\r
+ platform_init();\r
+ /* Wait sensor boot time */\r
+ platform_delay(BOOT_TIME);\r
+ /* Check device ID */\r
+ lis2doc_device_id_get(&dev_ctx, &whoamI);\r
+\r
+ if (whoamI != LIS2DOC_ID)\r
+ while (1) {\r
+ /* manage here device not found */\r
+ }\r
+\r
+ /* Restore default configuration */\r
+ lis2doc_reset_set(&dev_ctx, PROPERTY_ENABLE);\r
+\r
+ do {\r
+ lis2doc_reset_get(&dev_ctx, &rst);\r
+ } while (rst);\r
+\r
+ /* Enable Block Data Update */\r
+ lis2doc_block_data_update_set(&dev_ctx, PROPERTY_ENABLE);\r
+ //lis2doc_cs_mode_set(&dev_ctx, LIS2DOC_PULL_UP_DISCONNECT);\r
+ //lis2doc_i2c_interface_set(&dev_ctx, LIS2DOC_I2C_DISABLE);\r
+ //lis2doc_spi_mode_set(&dev_ctx, LIS2DOC_SPI_3_WIRE);\r
+ lis2doc_int_notification_set(&dev_ctx, LIS2DOC_INT_LATCHED);\r
+ lis2doc_pin_polarity_set(&dev_ctx, LIS2DOC_ACTIVE_LOW);\r
+ lis2doc_pin_int1_route_get(&dev_ctx, &ctrl4_int1_pad);\r
+ ctrl4_int1_pad.int1_drdy = PROPERTY_ENABLE;\r
+ lis2doc_pin_int1_route_set(&dev_ctx, &ctrl4_int1_pad);\r
+ /* Set full scale */\r
+ lis2doc_full_scale_set(&dev_ctx, LIS2DOC_2g);\r
+ /* Configure filtering chain accelerometer */\r
+ lis2doc_filter_path_set(&dev_ctx, LIS2DOC_LPF_ON_OUT);\r
+ lis2doc_filter_bandwidth_set(&dev_ctx, LIS2DOC_ODR_DIV_10);\r
+\r
+ /* Configure power mode */\r
+ pm.lpm = 1;\r
+ pm.low_noise = 1;\r
+ lis2doc_power_mode_set(&dev_ctx, pm);\r
+\r
+ lis2doc_data_rate_set(&dev_ctx, LIS2DOC_XL_SET_SW_TRIG);\r
+\r
+ /* Read samples in polling mode (no int) */\r
+ while (1) {\r
+ /* polling on DRDY signal */\r
+ if (GPIO_PIN_RESET == HAL_GPIO_ReadPin(GPIOC, GPIO_PIN_0)) {\r
+ /* Read acceleration data */\r
+ memset(data_raw_acceleration, 0x00, 3 * sizeof(int16_t));\r
+ lis2doc_acceleration_raw_get(&dev_ctx, data_raw_acceleration);\r
+ acceleration_mg[0] = lis2doc_from_fs2_lp1_to_mg(\r
+ data_raw_acceleration[0]);\r
+ acceleration_mg[1] = lis2doc_from_fs2_lp1_to_mg(\r
+ data_raw_acceleration[1]);\r
+ acceleration_mg[2] = lis2doc_from_fs2_lp1_to_mg(\r
+ data_raw_acceleration[2]);\r
+#ifdef STEVAL_MKI109V3\r
+\r
+ /* After data ready signal rise, is not possible to set a\r
+ * new trigger before 175us.\r
+ * I2C read data operation fit this constraint while SPI need\r
+ * a wait loop in order to guarantee it.\r
+ */\r
+ for (int i = 0; i < 0x3FF; i++);\r
+\r
+#endif\r
+ lis2doc_data_rate_set(&dev_ctx, LIS2DOC_XL_SET_SW_TRIG);\r
+ sprintf((char *)tx_buffer,\r
+ "Acceleration [mg]:%4.2f\t%4.2f\t%4.2f\r\n",\r
+ acceleration_mg[0], acceleration_mg[1], acceleration_mg[2]);\r
+ tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
+ }\r
+ }\r
+}\r
+\r
+/*\r
+ * @brief Write generic device register (platform dependent)\r
+ *\r
+ * @param handle customizable argument. In this examples is used in\r
+ * order to select the correct sensor bus handler.\r
+ * @param reg register to write\r
+ * @param bufp pointer to data to write in register reg\r
+ * @param len number of consecutive register to write\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+ uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_I2C_Mem_Write(handle, LIS2DOC_I2C_ADD_H, reg,\r
+ I2C_MEMADD_SIZE_8BIT, (uint8_t*) bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+ HAL_SPI_Transmit(handle, ®, 1, 1000);\r
+ HAL_SPI_Transmit(handle, (uint8_t*) bufp, len, 1000);\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+ i2c_lld_write(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, (uint8_t*) bufp, len);\r
+#endif\r
+ return 0;\r
+}\r
+\r
+/*\r
+ * @brief Read generic device register (platform dependent)\r
+ *\r
+ * @param handle customizable argument. In this examples is used in\r
+ * order to select the correct sensor bus handler.\r
+ * @param reg register to read\r
+ * @param bufp pointer to buffer that store the data read\r
+ * @param len number of consecutive register to read\r
+ *\r
+ */\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+ uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_I2C_Mem_Read(handle, LIS2DOC_I2C_ADD_H, reg,\r
+ I2C_MEMADD_SIZE_8BIT, bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ reg |= 0x80;\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+ HAL_SPI_Transmit(handle, ®, 1, 1000);\r
+ HAL_SPI_Receive(handle, bufp, len, 1000);\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+ i2c_lld_read(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, bufp, len);\r
+#endif\r
+ return 0;\r
+}\r
+\r
+/*\r
+ * @brief Write generic device register (platform dependent)\r
+ *\r
+ * @param tx_buffer buffer to transmit\r
+ * @param len number of byte to send\r
+ *\r
+ */\r
+static void tx_com(uint8_t *tx_buffer, uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_UART_Transmit(&huart2, tx_buffer, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ CDC_Transmit_FS(tx_buffer, len);\r
+#elif defined(SPC584B_DIS)\r
+ sd_lld_write(&SD2, tx_buffer, len);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief platform specific delay (platform dependent)\r
+ *\r
+ * @param ms delay in ms\r
+ *\r
+ */\r
+static void platform_delay(uint32_t ms)\r
+{\r
+#if defined(NUCLEO_F411RE) | defined(STEVAL_MKI109V3)\r
+ HAL_Delay(ms);\r
+#elif defined(SPC584B_DIS)\r
+ osalThreadDelayMilliseconds(ms);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief platform specific initialization (platform dependent)\r
+ */\r
+static void platform_init(void)\r
+{\r
+#if defined(STEVAL_MKI109V3)\r
+ TIM3->CCR1 = PWM_3V3;\r
+ TIM3->CCR2 = PWM_3V3;\r
+ HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);\r
+ HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);\r
+ HAL_Delay(1000);\r
+#endif\r
+}\r
--- /dev/null
+/*\r
+ ******************************************************************************\r
+ * @file read_fifo.c\r
+ * @author Sensors Software Solution Team\r
+ * @brief This file show how to get data from sensor FIFO.\r
+ *\r
+ ******************************************************************************\r
+ * @attention\r
+ *\r
+ * <h2><center>© Copyright (c) 2021 STMicroelectronics.\r
+ * All rights reserved.</center></h2>\r
+ *\r
+ * This software component is licensed by ST under BSD 3-Clause license,\r
+ * the "License"; You may not use this file except in compliance with the\r
+ * License. You may obtain a copy of the License at:\r
+ * opensource.org/licenses/BSD-3-Clause\r
+ *\r
+ ******************************************************************************\r
+ */\r
+\r
+/*\r
+ * This example was developed using the following STMicroelectronics\r
+ * evaluation boards:\r
+ *\r
+ * - STEVAL_MKI109V3 + STEVAL-MKI179V1\r
+ * - NUCLEO_F411RE + X_NUCLEO_IKS01A3\r
+ * - DISCOVERY_SPC584B + X_NUCLEO_IKS01A3\r
+ *\r
+ * and STM32CubeMX tool with STM32CubeF4 MCU Package\r
+ *\r
+ * Used interfaces:\r
+ *\r
+ * STEVAL_MKI109V3 - Host side: USB (Virtual COM)\r
+ * - Sensor side: SPI(Default) / I2C(supported)\r
+ *\r
+ * NUCLEO_STM32F411RE - Host side: UART(COM) to USB bridge\r
+ * - I2C(Default) / SPI(supported)\r
+ *\r
+ * DISCOVERY_SPC584B - Host side: UART(COM) to USB bridge\r
+ * - Sensor side: I2C(Default) / SPI(supported)\r
+ *\r
+ * If you need to run this example on a different hardware platform a\r
+ * modification of the functions: `platform_write`, `platform_read`,\r
+ * `tx_com` and 'platform_init' is required.\r
+ *\r
+ */\r
+\r
+/* STMicroelectronics evaluation boards definition\r
+ *\r
+ * Please uncomment ONLY the evaluation boards in use.\r
+ * If a different hardware is used please comment all\r
+ * following target board and redefine yours.\r
+ */\r
+\r
+//#define STEVAL_MKI109V3 /* little endian */\r
+//#define NUCLEO_F411RE /* little endian */\r
+//#define SPC584B_DIS /* big endian */\r
+\r
+/* ATTENTION: By default the driver is little endian. If you need switch\r
+ * to big endian please see "Endianness definitions" in the\r
+ * header file of the driver (_reg.h).\r
+ */\r
+\r
+\r
+#if defined(STEVAL_MKI109V3)\r
+/* MKI109V3: Define communication interface */\r
+#define SENSOR_BUS hspi2\r
+/* MKI109V3: Vdd and Vddio power supply values */\r
+#define PWM_3V3 915\r
+\r
+#elif defined(NUCLEO_F411RE)\r
+/* NUCLEO_F411RE: Define communication interface */\r
+#define SENSOR_BUS hi2c1\r
+\r
+#elif defined(SPC584B_DIS)\r
+/* DISCOVERY_SPC584B: Define communication interface */\r
+#define SENSOR_BUS I2CD1\r
+\r
+#endif\r
+\r
+/* Includes ------------------------------------------------------------------*/\r
+#include <string.h>\r
+#include <stdio.h>\r
+#include "lis2doc_reg.h"\r
+\r
+#if defined(NUCLEO_F411RE)\r
+#include "stm32f4xx_hal.h"\r
+#include "usart.h"\r
+#include "gpio.h"\r
+#include "i2c.h"\r
+\r
+#elif defined(STEVAL_MKI109V3)\r
+#include "stm32f4xx_hal.h"\r
+#include "usbd_cdc_if.h"\r
+#include "gpio.h"\r
+#include "spi.h"\r
+#include "tim.h"\r
+\r
+#elif defined(SPC584B_DIS)\r
+#include "components.h"\r
+#endif\r
+\r
+/* Private macro -------------------------------------------------------------*/\r
+#define BOOT_TIME 20 //ms\r
+\r
+/* Private variables ---------------------------------------------------------*/\r
+static lis2doc_mode_t pm;\r
+static int16_t data_raw_acceleration[3];\r
+static float acceleration_mg[3];\r
+static uint8_t whoamI, rst;\r
+static uint8_t tx_buffer[1000];\r
+\r
+/* Extern variables ----------------------------------------------------------*/\r
+\r
+/* Private functions ---------------------------------------------------------*/\r
+/*\r
+ * WARNING:\r
+ * Functions declare in this section are defined at the end of this file\r
+ * and are strictly related to the hardware platform used.\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+ uint16_t len);\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+ uint16_t len);\r
+static void tx_com( uint8_t *tx_buffer, uint16_t len );\r
+static void platform_delay(uint32_t ms);\r
+static void platform_init(void);\r
+\r
+/* Main Example --------------------------------------------------------------*/\r
+void lis2doc_read_data_fifo(void)\r
+{\r
+ /* Initialize mems driver interface */\r
+ stmdev_ctx_t dev_ctx;\r
+ dev_ctx.write_reg = platform_write;\r
+ dev_ctx.read_reg = platform_read;\r
+ dev_ctx.handle = &SENSOR_BUS;\r
+ /* Initialize platform specific hardware */\r
+ platform_init();\r
+ /* Wait sensor boot time */\r
+ platform_delay(BOOT_TIME);\r
+ /* Check device ID */\r
+ lis2doc_device_id_get(&dev_ctx, &whoamI);\r
+\r
+ if (whoamI != LIS2DOC_ID)\r
+ while (1) {\r
+ /* manage here device not found */\r
+ }\r
+\r
+ /* Restore default configuration */\r
+ lis2doc_reset_set(&dev_ctx, PROPERTY_ENABLE);\r
+\r
+ do {\r
+ lis2doc_reset_get(&dev_ctx, &rst);\r
+ } while (rst);\r
+\r
+ /* Enable Block Data Update */\r
+ lis2doc_block_data_update_set(&dev_ctx, PROPERTY_ENABLE);\r
+ /* Set full scale */\r
+ //lis2doc_full_scale_set(&dev_ctx, LIS2DOC_8g);\r
+ lis2doc_full_scale_set(&dev_ctx, LIS2DOC_2g);\r
+ /* Configure filtering chain\r
+ * Accelerometer - filter path / bandwidth\r
+ */\r
+ lis2doc_filter_path_set(&dev_ctx, LIS2DOC_LPF_ON_OUT);\r
+ lis2doc_filter_bandwidth_set(&dev_ctx, LIS2DOC_ODR_DIV_4);\r
+ /* Configure FIFO */\r
+ lis2doc_fifo_watermark_set(&dev_ctx, 10);\r
+ lis2doc_fifo_mode_set(&dev_ctx, LIS2DOC_STREAM_MODE);\r
+\r
+ /* Configure power mode */\r
+ pm.hpm = 1;\r
+ pm.low_noise = 1;\r
+ lis2doc_power_mode_set(&dev_ctx, pm);\r
+\r
+ //lis2doc_power_mode_set(&dev_ctx, LIS2DOC_CONT_LOW_PWR_LOW_NOISE_12bit);\r
+ /* Set Output Data Rate */\r
+ lis2doc_data_rate_set(&dev_ctx, LIS2DOC_XL_ODR_25Hz);\r
+\r
+ /* Read samples in polling mode (no int) */\r
+ while (1) {\r
+ uint8_t val, i;\r
+ /* Read output only if new value is available */\r
+ lis2doc_fifo_wtm_flag_get(&dev_ctx, &val);\r
+\r
+ if (val) {\r
+ lis2doc_fifo_data_level_get(&dev_ctx, &val);\r
+\r
+ for (i = 0; i < val; i++) {\r
+ /* Read acceleration data */\r
+ memset(data_raw_acceleration, 0x00, 3 * sizeof(int16_t));\r
+ lis2doc_acceleration_raw_get(&dev_ctx, data_raw_acceleration);\r
+ //acceleration_mg[0] = lis2doc_from_fs8_lp1_to_mg(data_raw_acceleration[0]);\r
+ //acceleration_mg[1] = lis2doc_from_fs8_lp1_to_mg(data_raw_acceleration[1]);\r
+ //acceleration_mg[2] = lis2doc_from_fs8_lp1_to_mg(data_raw_acceleration[2]);\r
+ acceleration_mg[0] = lis2doc_from_fs2_to_mg(\r
+ data_raw_acceleration[0]);\r
+ acceleration_mg[1] = lis2doc_from_fs2_to_mg(\r
+ data_raw_acceleration[1]);\r
+ acceleration_mg[2] = lis2doc_from_fs2_to_mg(\r
+ data_raw_acceleration[2]);\r
+ sprintf((char *)tx_buffer,\r
+ "Acceleration [mg]:%4.2f\t%4.2f\t%4.2f\r\n",\r
+ acceleration_mg[0], acceleration_mg[1], acceleration_mg[2]);\r
+ tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
+ }\r
+ }\r
+ }\r
+}\r
+\r
+/*\r
+ * @brief Write generic device register (platform dependent)\r
+ *\r
+ * @param handle customizable argument. In this examples is used in\r
+ * order to select the correct sensor bus handler.\r
+ * @param reg register to write\r
+ * @param bufp pointer to data to write in register reg\r
+ * @param len number of consecutive register to write\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+ uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_I2C_Mem_Write(handle, LIS2DOC_I2C_ADD_H, reg,\r
+ I2C_MEMADD_SIZE_8BIT, (uint8_t*) bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+ HAL_SPI_Transmit(handle, ®, 1, 1000);\r
+ HAL_SPI_Transmit(handle, (uint8_t*) bufp, len, 1000);\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+ i2c_lld_write(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, (uint8_t*) bufp, len);\r
+#endif\r
+ return 0;\r
+}\r
+\r
+/*\r
+ * @brief Read generic device register (platform dependent)\r
+ *\r
+ * @param handle customizable argument. In this examples is used in\r
+ * order to select the correct sensor bus handler.\r
+ * @param reg register to read\r
+ * @param bufp pointer to buffer that store the data read\r
+ * @param len number of consecutive register to read\r
+ *\r
+ */\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+ uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_I2C_Mem_Read(handle, LIS2DOC_I2C_ADD_H, reg,\r
+ I2C_MEMADD_SIZE_8BIT, bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ reg |= 0x80;\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+ HAL_SPI_Transmit(handle, ®, 1, 1000);\r
+ HAL_SPI_Receive(handle, bufp, len, 1000);\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+ i2c_lld_read(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, bufp, len);\r
+#endif\r
+ return 0;\r
+}\r
+\r
+/*\r
+ * @brief Write generic device register (platform dependent)\r
+ *\r
+ * @param tx_buffer buffer to transmit\r
+ * @param len number of byte to send\r
+ *\r
+ */\r
+static void tx_com(uint8_t *tx_buffer, uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_UART_Transmit(&huart2, tx_buffer, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ CDC_Transmit_FS(tx_buffer, len);\r
+#elif defined(SPC584B_DIS)\r
+ sd_lld_write(&SD2, tx_buffer, len);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief platform specific delay (platform dependent)\r
+ *\r
+ * @param ms delay in ms\r
+ *\r
+ */\r
+static void platform_delay(uint32_t ms)\r
+{\r
+#if defined(NUCLEO_F411RE) | defined(STEVAL_MKI109V3)\r
+ HAL_Delay(ms);\r
+#elif defined(SPC584B_DIS)\r
+ osalThreadDelayMilliseconds(ms);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief platform specific initialization (platform dependent)\r
+ */\r
+static void platform_init(void)\r
+{\r
+#if defined(STEVAL_MKI109V3)\r
+ TIM3->CCR1 = PWM_3V3;\r
+ TIM3->CCR2 = PWM_3V3;\r
+ HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);\r
+ HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);\r
+ HAL_Delay(1000);\r
+#endif\r
+}\r
--- /dev/null
+/*\r
+ ******************************************************************************\r
+ * @file test_self_test.c\r
+ * @author Sensors Software Solution Team\r
+ * @brief This file run selt test procedure\r
+ *\r
+ ******************************************************************************\r
+ * @attention\r
+ *\r
+ * <h2><center>© Copyright (c) 2020 STMicroelectronics.\r
+ * All rights reserved.</center></h2>\r
+ *\r
+ * This software component is licensed by ST under BSD 3-Clause license,\r
+ * the "License"; You may not use this file except in compliance with the\r
+ * License. You may obtain a copy of the License at:\r
+ * opensource.org/licenses/BSD-3-Clause\r
+ *\r
+ ******************************************************************************\r
+ */\r
+\r
+/*\r
+ * This example was developed using the following STMicroelectronics\r
+ * evaluation boards:\r
+ *\r
+ * - STEVAL_MKI109V3 + STEVAL-MKI179V1\r
+ * - NUCLEO_F411RE + X_NUCLEO_IKS01A3\r
+ * - DISCOVERY_SPC584B + X_NUCLEO_IKS01A3\r
+ *\r
+ * and STM32CubeMX tool with STM32CubeF4 MCU Package\r
+ *\r
+ * Used interfaces:\r
+ *\r
+ * STEVAL_MKI109V3 - Host side: USB (Virtual COM)\r
+ * - Sensor side: SPI(Default) / I2C(supported)\r
+ *\r
+ * NUCLEO_STM32F411RE - Host side: UART(COM) to USB bridge\r
+ * - I2C(Default) / SPI(supported)\r
+ *\r
+ * DISCOVERY_SPC584B - Host side: UART(COM) to USB bridge\r
+ * - Sensor side: I2C(Default) / SPI(supported)\r
+ *\r
+ * If you need to run this example on a different hardware platform a\r
+ * modification of the functions: `platform_write`, `platform_read`,\r
+ * `tx_com` and 'platform_init' is required.\r
+ *\r
+ */\r
+\r
+/* STMicroelectronics evaluation boards definition\r
+ *\r
+ * Please uncomment ONLY the evaluation boards in use.\r
+ * If a different hardware is used please comment all\r
+ * following target board and redefine yours.\r
+ */\r
+\r
+//#define STEVAL_MKI109V3 /* little endian */\r
+//#define NUCLEO_F411RE /* little endian */\r
+//#define SPC584B_DIS /* big endian */\r
+\r
+/* ATTENTION: By default the driver is little endian. If you need switch\r
+ * to big endian please see "Endianness definitions" in the\r
+ * header file of the driver (_reg.h).\r
+ */\r
+\r
+\r
+#if defined(STEVAL_MKI109V3)\r
+/* MKI109V3: Define communication interface */\r
+#define SENSOR_BUS hspi2\r
+/* MKI109V3: Vdd and Vddio power supply values */\r
+#define PWM_3V3 915\r
+\r
+#elif defined(NUCLEO_F411RE)\r
+/* NUCLEO_F411RE: Define communication interface */\r
+#define SENSOR_BUS hi2c1\r
+\r
+#elif defined(SPC584B_DIS)\r
+/* DISCOVERY_SPC584B: Define communication interface */\r
+#define SENSOR_BUS I2CD1\r
+\r
+#endif\r
+\r
+/* Includes ------------------------------------------------------------------*/\r
+#include <string.h>\r
+#include <stdio.h>\r
+#include "lis2doc_reg.h"\r
+\r
+#if defined(NUCLEO_F411RE)\r
+#include "stm32f4xx_hal.h"\r
+#include "usart.h"\r
+#include "gpio.h"\r
+#include "i2c.h"\r
+\r
+#elif defined(STEVAL_MKI109V3)\r
+#include "stm32f4xx_hal.h"\r
+#include "usbd_cdc_if.h"\r
+#include "gpio.h"\r
+#include "spi.h"\r
+#include "tim.h"\r
+\r
+#elif defined(SPC584B_DIS)\r
+#include "components.h"\r
+#endif\r
+\r
+typedef union {\r
+ int16_t i16bit[3];\r
+} axis3bit16_t;\r
+\r
+/* Private macro -------------------------------------------------------------*/\r
+#define BOOT_TIME 20 //ms\r
+\r
+/* Self-test recommended samples */\r
+#define SELF_TEST_SAMPLES 5\r
+\r
+/* Self-test positive difference */\r
+#define ST_MIN_POS 70.0f\r
+#define ST_MAX_POS 1500.0f\r
+\r
+/* Private variables ---------------------------------------------------------*/\r
+static lis2doc_mode_t pm;\r
+static axis3bit16_t data_raw_acceleration[SELF_TEST_SAMPLES];\r
+static float acceleration_mg[SELF_TEST_SAMPLES][3];\r
+static uint8_t whoamI, rst;\r
+static uint8_t tx_buffer[1000];\r
+\r
+/* Extern variables ----------------------------------------------------------*/\r
+\r
+/* Private functions ---------------------------------------------------------*/\r
+/*\r
+ * WARNING:\r
+ * Functions declare in this section are defined at the end of this file\r
+ * and are strictly related to the hardware platform used.\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+ uint16_t len);\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+ uint16_t len);\r
+static void tx_com( uint8_t *tx_buffer, uint16_t len );\r
+static void platform_delay(uint32_t ms);\r
+static void platform_init(void);\r
+\r
+/* Utility functions ---------------------------------------------------------*/\r
+static inline float ABSF(float _x)\r
+{\r
+ return (_x < 0.0f) ? -(_x) : _x;\r
+}\r
+\r
+static int flush_samples(stmdev_ctx_t *dev_ctx)\r
+{\r
+ lis2doc_reg_t reg;\r
+ axis3bit16_t dummy;\r
+ int samples = 0;\r
+ /*\r
+ * Discard old samples\r
+ */\r
+ lis2doc_status_reg_get(dev_ctx, ®.status);\r
+\r
+ if (reg.status.drdy) {\r
+ lis2doc_acceleration_raw_get(dev_ctx, dummy.i16bit);\r
+ samples++;\r
+ }\r
+\r
+ return samples;\r
+}\r
+\r
+static void test_self_test_lis2doc(stmdev_ctx_t *dev_ctx)\r
+{\r
+ lis2doc_reg_t reg;\r
+ float media[3] = { 0.0f, 0.0f, 0.0f };\r
+ float mediast[3] = { 0.0f, 0.0f, 0.0f };\r
+ uint8_t match[3] = { 0, 0, 0 };\r
+ uint8_t j = 0;\r
+ uint16_t i = 0;\r
+ uint8_t k = 0;\r
+ uint8_t axis;\r
+ /* Restore default configuration */\r
+ lis2doc_reset_set(dev_ctx, PROPERTY_ENABLE);\r
+\r
+ do {\r
+ lis2doc_reset_get(dev_ctx, &rst);\r
+ } while (rst);\r
+\r
+ lis2doc_block_data_update_set(dev_ctx, PROPERTY_ENABLE);\r
+ lis2doc_full_scale_set(dev_ctx, LIS2DOC_4g);\r
+\r
+ /* Configure power mode */\r
+ pm.hpm = 1;\r
+ pm.low_noise = 1;\r
+ lis2doc_power_mode_set(dev_ctx, pm);\r
+\r
+ lis2doc_data_rate_set(dev_ctx, LIS2DOC_XL_ODR_50Hz);\r
+ HAL_Delay(100);\r
+ /* Flush old samples */\r
+ flush_samples(dev_ctx);\r
+\r
+ do {\r
+ lis2doc_status_reg_get(dev_ctx, ®.status);\r
+\r
+ if (reg.status.drdy) {\r
+ /* Read accelerometer data */\r
+ memset(data_raw_acceleration[i].i16bit, 0x00, 3 * sizeof(int16_t));\r
+ lis2doc_acceleration_raw_get(dev_ctx,\r
+ data_raw_acceleration[i].i16bit);\r
+\r
+ for (axis = 0; axis < 3; axis++) {\r
+ acceleration_mg[i][axis] =\r
+ lis2doc_from_fs4_to_mg(data_raw_acceleration[i].i16bit[axis]);\r
+ }\r
+\r
+ i++;\r
+ }\r
+ } while (i < SELF_TEST_SAMPLES);\r
+\r
+ for (k = 0; k < 3; k++) {\r
+ for (j = 0; j < SELF_TEST_SAMPLES; j++) {\r
+ media[k] += acceleration_mg[j][k];\r
+ }\r
+\r
+ media[k] = (media[k] / j);\r
+ }\r
+\r
+ /* Enable self test mode */\r
+ lis2doc_self_test_set(dev_ctx, LIS2DOC_XL_ST_POSITIVE);\r
+ HAL_Delay(100);\r
+ i = 0;\r
+ /* Flush old samples */\r
+ flush_samples(dev_ctx);\r
+\r
+ do {\r
+ lis2doc_status_reg_get(dev_ctx, ®.status);\r
+\r
+ if (reg.status.drdy) {\r
+ /* Read accelerometer data */\r
+ memset(data_raw_acceleration[i].i16bit, 0x00, 3 * sizeof(int16_t));\r
+ lis2doc_acceleration_raw_get(dev_ctx,\r
+ data_raw_acceleration[i].i16bit);\r
+\r
+ for (axis = 0; axis < 3; axis++)\r
+ acceleration_mg[i][axis] =\r
+ lis2doc_from_fs4_to_mg(data_raw_acceleration[i].i16bit[axis]);\r
+\r
+ i++;\r
+ }\r
+ } while (i < SELF_TEST_SAMPLES);\r
+\r
+ for (k = 0; k < 3; k++) {\r
+ for (j = 0; j < SELF_TEST_SAMPLES; j++) {\r
+ mediast[k] += acceleration_mg[j][k];\r
+ }\r
+\r
+ mediast[k] = (mediast[k] / j);\r
+ }\r
+\r
+ /* Check for all axis self test value range */\r
+ for (k = 0; k < 3; k++) {\r
+ if ((ABSF(mediast[k] - media[k]) >= ST_MIN_POS) &&\r
+ (ABSF(mediast[k] - media[k]) <= ST_MAX_POS)) {\r
+ match[k] = 1;\r
+ }\r
+\r
+ sprintf((char *)tx_buffer, "%d: |%f| <= |%f| <= |%f| %s\r\n", k,\r
+ ST_MIN_POS, ABSF(mediast[k] - media[k]), ST_MAX_POS,\r
+ match[k] == 1 ? "PASSED" : "FAILED");\r
+ tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
+ }\r
+\r
+ /* Disable self test mode */\r
+ lis2doc_data_rate_set(dev_ctx, LIS2DOC_XL_ODR_OFF);\r
+ lis2doc_self_test_set(dev_ctx, LIS2DOC_XL_ST_DISABLE);\r
+}\r
+\r
+/* Main Example --------------------------------------------------------------*/\r
+void lis2doc_self_test(void)\r
+{\r
+ /* Initialize mems driver interface */\r
+ stmdev_ctx_t dev_ctx;\r
+ dev_ctx.write_reg = platform_write;\r
+ dev_ctx.read_reg = platform_read;\r
+ dev_ctx.handle = &SENSOR_BUS;\r
+ /* Initialize platform specific hardware */\r
+ platform_init();\r
+ /* Wait sensor boot time */\r
+ platform_delay(BOOT_TIME);\r
+ /* Check device ID */\r
+ lis2doc_device_id_get(&dev_ctx, &whoamI);\r
+\r
+ if (whoamI != LIS2DOC_ID)\r
+ while (1) {\r
+ /* manage here device not found */\r
+ }\r
+\r
+ /* Start self test */\r
+ while (1) {\r
+ test_self_test_lis2doc(&dev_ctx);\r
+ }\r
+}\r
+\r
+/*\r
+ * @brief Write generic device register (platform dependent)\r
+ *\r
+ * @param handle customizable argument. In this examples is used in\r
+ * order to select the correct sensor bus handler.\r
+ * @param reg register to write\r
+ * @param bufp pointer to data to write in register reg\r
+ * @param len number of consecutive register to write\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+ uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_I2C_Mem_Write(handle, LIS2DOC_I2C_ADD_H, reg,\r
+ I2C_MEMADD_SIZE_8BIT, (uint8_t*) bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+ HAL_SPI_Transmit(handle, ®, 1, 1000);\r
+ HAL_SPI_Transmit(handle, (uint8_t*) bufp, len, 1000);\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+ i2c_lld_write(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, (uint8_t*) bufp, len);\r
+#endif\r
+ return 0;\r
+}\r
+\r
+/*\r
+ * @brief Read generic device register (platform dependent)\r
+ *\r
+ * @param handle customizable argument. In this examples is used in\r
+ * order to select the correct sensor bus handler.\r
+ * @param reg register to read\r
+ * @param bufp pointer to buffer that store the data read\r
+ * @param len number of consecutive register to read\r
+ *\r
+ */\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+ uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_I2C_Mem_Read(handle, LIS2DOC_I2C_ADD_H, reg,\r
+ I2C_MEMADD_SIZE_8BIT, bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ reg |= 0x80;\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+ HAL_SPI_Transmit(handle, ®, 1, 1000);\r
+ HAL_SPI_Receive(handle, bufp, len, 1000);\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+ i2c_lld_read(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, bufp, len);\r
+#endif\r
+ return 0;\r
+}\r
+\r
+/*\r
+ * @brief Write generic device register (platform dependent)\r
+ *\r
+ * @param tx_buffer buffer to transmit\r
+ * @param len number of byte to send\r
+ *\r
+ */\r
+static void tx_com(uint8_t *tx_buffer, uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_UART_Transmit(&huart2, tx_buffer, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ CDC_Transmit_FS(tx_buffer, len);\r
+#elif defined(SPC584B_DIS)\r
+ sd_lld_write(&SD2, tx_buffer, len);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief platform specific delay (platform dependent)\r
+ *\r
+ * @param ms delay in ms\r
+ *\r
+ */\r
+static void platform_delay(uint32_t ms)\r
+{\r
+#if defined(NUCLEO_F411RE) | defined(STEVAL_MKI109V3)\r
+ HAL_Delay(ms);\r
+#elif defined(SPC584B_DIS)\r
+ osalThreadDelayMilliseconds(ms);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief platform specific initialization (platform dependent)\r
+ */\r
+static void platform_init(void)\r
+{\r
+#if defined(STEVAL_MKI109V3)\r
+ TIM3->CCR1 = PWM_3V3;\r
+ TIM3->CCR2 = PWM_3V3;\r
+ HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);\r
+ HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);\r
+ HAL_Delay(1000);\r
+#endif\r
+}\r
--- /dev/null
+/*\r
+ ******************************************************************************\r
+ * @file double_tap.c\r
+ * @author Sensors Software Solution Team\r
+ * @brief This file show the simplest way to detect double tap from sensor.\r
+ *\r
+ ******************************************************************************\r
+ * @attention\r
+ *\r
+ * <h2><center>© Copyright (c) 2020 STMicroelectronics.\r
+ * All rights reserved.</center></h2>\r
+ *\r
+ * This software component is licensed by ST under BSD 3-Clause license,\r
+ * the "License"; You may not use this file except in compliance with the\r
+ * License. You may obtain a copy of the License at:\r
+ * opensource.org/licenses/BSD-3-Clause\r
+ *\r
+ ******************************************************************************\r
+ */\r
+\r
+/*\r
+ * This example was developed using the following STMicroelectronics\r
+ * evaluation boards:\r
+ *\r
+ * - STEVAL_MKI109V3 + STEVAL-MKI179V1\r
+ * - NUCLEO_F411RE + X_NUCLEO_IKS01A3\r
+ * - DISCOVERY_SPC584B + X_NUCLEO_IKS01A3\r
+ *\r
+ * and STM32CubeMX tool with STM32CubeF4 MCU Package\r
+ *\r
+ * Used interfaces:\r
+ *\r
+ * STEVAL_MKI109V3 - Host side: USB (Virtual COM)\r
+ * - Sensor side: SPI(Default) / I2C(supported)\r
+ *\r
+ * NUCLEO_STM32F411RE - Host side: UART(COM) to USB bridge\r
+ * - I2C(Default) / SPI(supported)\r
+ *\r
+ * DISCOVERY_SPC584B - Host side: UART(COM) to USB bridge\r
+ * - Sensor side: I2C(Default) / SPI(supported)\r
+ *\r
+ * If you need to run this example on a different hardware platform a\r
+ * modification of the functions: `platform_write`, `platform_read`,\r
+ * `tx_com` and 'platform_init' is required.\r
+ *\r
+ */\r
+\r
+/* STMicroelectronics evaluation boards definition\r
+ *\r
+ * Please uncomment ONLY the evaluation boards in use.\r
+ * If a different hardware is used please comment all\r
+ * following target board and redefine yours.\r
+ */\r
+\r
+//#define STEVAL_MKI109V3 /* little endian */\r
+//#define NUCLEO_F411RE /* little endian */\r
+//#define SPC584B_DIS /* big endian */\r
+\r
+/* ATTENTION: By default the driver is little endian. If you need switch\r
+ * to big endian please see "Endianness definitions" in the\r
+ * header file of the driver (_reg.h).\r
+ */\r
+\r
+\r
+#if defined(STEVAL_MKI109V3)\r
+/* MKI109V3: Define communication interface */\r
+#define SENSOR_BUS hspi2\r
+/* MKI109V3: Vdd and Vddio power supply values */\r
+#define PWM_3V3 915\r
+\r
+#elif defined(NUCLEO_F411RE)\r
+/* NUCLEO_F411RE: Define communication interface */\r
+#define SENSOR_BUS hi2c1\r
+\r
+#elif defined(SPC584B_DIS)\r
+/* DISCOVERY_SPC584B: Define communication interface */\r
+#define SENSOR_BUS I2CD1\r
+\r
+#endif\r
+\r
+/* Includes ------------------------------------------------------------------*/\r
+#include <string.h>\r
+#include <stdio.h>\r
+#include "lis2doc_reg.h"\r
+\r
+#if defined(NUCLEO_F411RE)\r
+#include "stm32f4xx_hal.h"\r
+#include "usart.h"\r
+#include "gpio.h"\r
+#include "i2c.h"\r
+\r
+#elif defined(STEVAL_MKI109V3)\r
+#include "stm32f4xx_hal.h"\r
+#include "usbd_cdc_if.h"\r
+#include "gpio.h"\r
+#include "spi.h"\r
+#include "tim.h"\r
+\r
+#elif defined(SPC584B_DIS)\r
+#include "components.h"\r
+#endif\r
+\r
+\r
+/* Private macro -------------------------------------------------------------*/\r
+#define BOOT_TIME 20 //ms\r
+\r
+/* Private variables ---------------------------------------------------------*/\r
+static lis2doc_mode_t pm;\r
+static uint8_t whoamI, rst;\r
+static uint8_t tx_buffer[1000];\r
+\r
+/* Extern variables ----------------------------------------------------------*/\r
+\r
+/* Private functions ---------------------------------------------------------*/\r
+/*\r
+ * WARNING:\r
+ * Functions declare in this section are defined at the end of this file\r
+ * and are strictly related to the hardware platform used.\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+ uint16_t len);\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+ uint16_t len);\r
+static void tx_com( uint8_t *tx_buffer, uint16_t len );\r
+static void platform_delay(uint32_t ms);\r
+static void platform_init(void);\r
+\r
+/* Main Example --------------------------------------------------------------*/\r
+void lis2doc_double_tap(void)\r
+{\r
+ /* Initialize mems driver interface */\r
+ stmdev_ctx_t dev_ctx;\r
+ lis2doc_reg_t int_route;\r
+ dev_ctx.write_reg = platform_write;\r
+ dev_ctx.read_reg = platform_read;\r
+ dev_ctx.handle = &SENSOR_BUS;\r
+ /* Initialize platform specific hardware */\r
+ platform_init();\r
+ /* Wait sensor boot time */\r
+ platform_delay(BOOT_TIME);\r
+ /* Check device ID */\r
+ lis2doc_device_id_get(&dev_ctx, &whoamI);\r
+\r
+ if (whoamI != LIS2DOC_ID)\r
+ while (1) {\r
+ /* manage here device not found */\r
+ }\r
+\r
+ /* Restore default configuration */\r
+ lis2doc_reset_set(&dev_ctx, PROPERTY_ENABLE);\r
+\r
+ do {\r
+ lis2doc_reset_get(&dev_ctx, &rst);\r
+ } while (rst);\r
+\r
+ /* Set full scale */\r
+ lis2doc_full_scale_set(&dev_ctx, LIS2DOC_2g);\r
+\r
+ /* Configure power mode */\r
+ pm.lpm = 1;\r
+ pm.low_noise = 1;\r
+ lis2doc_power_mode_set(&dev_ctx, pm);\r
+\r
+ /* Set Output Data Rate */\r
+ lis2doc_data_rate_set(&dev_ctx, LIS2DOC_XL_ODR_400Hz);\r
+ /* Enable Tap detection on X, Y, Z */\r
+ lis2doc_tap_detection_on_z_set(&dev_ctx, PROPERTY_ENABLE);\r
+ lis2doc_tap_detection_on_y_set(&dev_ctx, PROPERTY_ENABLE);\r
+ lis2doc_tap_detection_on_x_set(&dev_ctx, PROPERTY_ENABLE);\r
+ /* Set Tap threshold on all axis */\r
+ lis2doc_tap_threshold_x_set(&dev_ctx, 12);\r
+ lis2doc_tap_threshold_y_set(&dev_ctx, 12);\r
+ lis2doc_tap_threshold_z_set(&dev_ctx, 12);\r
+ /* Configure Double Tap parameter */\r
+ lis2doc_tap_dur_set(&dev_ctx, 7);\r
+ lis2doc_tap_quiet_set(&dev_ctx, 3);\r
+ lis2doc_tap_shock_set(&dev_ctx, 3);\r
+ /* Enable Double Tap detection */\r
+ lis2doc_tap_mode_set(&dev_ctx, LIS2DOC_BOTH_SINGLE_DOUBLE);\r
+ /* Enable single tap detection interrupt */\r
+ lis2doc_pin_int1_route_get(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);\r
+ int_route.ctrl4_int1_pad_ctrl.int1_tap = PROPERTY_ENABLE;\r
+ lis2doc_pin_int1_route_set(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);\r
+\r
+ /* Wait Events. */\r
+ while (1) {\r
+ lis2doc_all_sources_t all_source;\r
+ /* Check Double Tap events */\r
+ lis2doc_all_sources_get(&dev_ctx, &all_source);\r
+\r
+ if (all_source.tap_src.double_tap) {\r
+ sprintf((char *)tx_buffer, "Double Tap Detected: Sign %s",\r
+ all_source.tap_src.tap_sign ? "positive" : "negative");\r
+\r
+ if (all_source.tap_src.x_tap) {\r
+ sprintf((char *)tx_buffer, "%s on X", tx_buffer);\r
+ }\r
+\r
+ if (all_source.tap_src.y_tap) {\r
+ sprintf((char *)tx_buffer, "%s on Y", tx_buffer);\r
+ }\r
+\r
+ if (all_source.tap_src.z_tap) {\r
+ sprintf((char *)tx_buffer, "%s on Z", tx_buffer);\r
+ }\r
+\r
+ sprintf((char *)tx_buffer, "%s axis\r\n", tx_buffer);\r
+ tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
+ }\r
+\r
+ /* Check Single Tap events */\r
+ if (all_source.tap_src.single_tap) {\r
+ sprintf((char *)tx_buffer, "Tap Detected: Sign %s",\r
+ all_source.tap_src.tap_sign ? "positive" : "negative");\r
+\r
+ if (all_source.tap_src.x_tap) {\r
+ sprintf((char *)tx_buffer, "%s on X", tx_buffer);\r
+ }\r
+\r
+ if (all_source.tap_src.y_tap) {\r
+ sprintf((char *)tx_buffer, "%s on Y", tx_buffer);\r
+ }\r
+\r
+ if (all_source.tap_src.z_tap) {\r
+ sprintf((char *)tx_buffer, "%s on Z", tx_buffer);\r
+ }\r
+\r
+ sprintf((char *)tx_buffer, "%s axis\r\n", tx_buffer);\r
+ tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
+ }\r
+ }\r
+}\r
+\r
+/*\r
+ * @brief Write generic device register (platform dependent)\r
+ *\r
+ * @param handle customizable argument. In this examples is used in\r
+ * order to select the correct sensor bus handler.\r
+ * @param reg register to write\r
+ * @param bufp pointer to data to write in register reg\r
+ * @param len number of consecutive register to write\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+ uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_I2C_Mem_Write(handle, LIS2DOC_I2C_ADD_H, reg,\r
+ I2C_MEMADD_SIZE_8BIT, (uint8_t*) bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+ HAL_SPI_Transmit(handle, ®, 1, 1000);\r
+ HAL_SPI_Transmit(handle, (uint8_t*) bufp, len, 1000);\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+ i2c_lld_write(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, (uint8_t*) bufp, len);\r
+#endif\r
+ return 0;\r
+}\r
+\r
+/*\r
+ * @brief Read generic device register (platform dependent)\r
+ *\r
+ * @param handle customizable argument. In this examples is used in\r
+ * order to select the correct sensor bus handler.\r
+ * @param reg register to read\r
+ * @param bufp pointer to buffer that store the data read\r
+ * @param len number of consecutive register to read\r
+ *\r
+ */\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+ uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_I2C_Mem_Read(handle, LIS2DOC_I2C_ADD_H, reg,\r
+ I2C_MEMADD_SIZE_8BIT, bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ reg |= 0x80;\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+ HAL_SPI_Transmit(handle, ®, 1, 1000);\r
+ HAL_SPI_Receive(handle, bufp, len, 1000);\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+ i2c_lld_read(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, bufp, len);\r
+#endif\r
+ return 0;\r
+}\r
+\r
+/*\r
+ * @brief Write generic device register (platform dependent)\r
+ *\r
+ * @param tx_buffer buffer to transmit\r
+ * @param len number of byte to send\r
+ *\r
+ */\r
+static void tx_com(uint8_t *tx_buffer, uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_UART_Transmit(&huart2, tx_buffer, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ CDC_Transmit_FS(tx_buffer, len);\r
+#elif defined(SPC584B_DIS)\r
+ sd_lld_write(&SD2, tx_buffer, len);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief platform specific delay (platform dependent)\r
+ *\r
+ * @param ms delay in ms\r
+ *\r
+ */\r
+static void platform_delay(uint32_t ms)\r
+{\r
+#if defined(NUCLEO_F411RE) | defined(STEVAL_MKI109V3)\r
+ HAL_Delay(ms);\r
+#elif defined(SPC584B_DIS)\r
+ osalThreadDelayMilliseconds(ms);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief platform specific initialization (platform dependent)\r
+ */\r
+static void platform_init(void)\r
+{\r
+#if defined(STEVAL_MKI109V3)\r
+ TIM3->CCR1 = PWM_3V3;\r
+ TIM3->CCR2 = PWM_3V3;\r
+ HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);\r
+ HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);\r
+ HAL_Delay(1000);\r
+#endif\r
+}
\ No newline at end of file
--- /dev/null
+/*\r
+ ******************************************************************************\r
+ * @file single_tap.c\r
+ * @author Sensors Software Solution Team\r
+ * @brief This file show the simplest way to detect single tap from sensor.\r
+ *\r
+ ******************************************************************************\r
+ * @attention\r
+ *\r
+ * <h2><center>© Copyright (c) 2020 STMicroelectronics.\r
+ * All rights reserved.</center></h2>\r
+ *\r
+ * This software component is licensed by ST under BSD 3-Clause license,\r
+ * the "License"; You may not use this file except in compliance with the\r
+ * License. You may obtain a copy of the License at:\r
+ * opensource.org/licenses/BSD-3-Clause\r
+ *\r
+ ******************************************************************************\r
+ */\r
+\r
+/*\r
+ * This example was developed using the following STMicroelectronics\r
+ * evaluation boards:\r
+ *\r
+ * - STEVAL_MKI109V3 + STEVAL-MKI179V1\r
+ * - NUCLEO_F411RE + X_NUCLEO_IKS01A3\r
+ * - DISCOVERY_SPC584B + X_NUCLEO_IKS01A3\r
+ *\r
+ * and STM32CubeMX tool with STM32CubeF4 MCU Package\r
+ *\r
+ * Used interfaces:\r
+ *\r
+ * STEVAL_MKI109V3 - Host side: USB (Virtual COM)\r
+ * - Sensor side: SPI(Default) / I2C(supported)\r
+ *\r
+ * NUCLEO_STM32F411RE - Host side: UART(COM) to USB bridge\r
+ * - I2C(Default) / SPI(supported)\r
+ *\r
+ * DISCOVERY_SPC584B - Host side: UART(COM) to USB bridge\r
+ * - Sensor side: I2C(Default) / SPI(supported)\r
+ *\r
+ * If you need to run this example on a different hardware platform a\r
+ * modification of the functions: `platform_write`, `platform_read`,\r
+ * `tx_com` and 'platform_init' is required.\r
+ *\r
+ */\r
+\r
+/* STMicroelectronics evaluation boards definition\r
+ *\r
+ * Please uncomment ONLY the evaluation boards in use.\r
+ * If a different hardware is used please comment all\r
+ * following target board and redefine yours.\r
+ */\r
+\r
+//#define STEVAL_MKI109V3 /* little endian */\r
+//#define NUCLEO_F411RE /* little endian */\r
+//#define SPC584B_DIS /* big endian */\r
+\r
+/* ATTENTION: By default the driver is little endian. If you need switch\r
+ * to big endian please see "Endianness definitions" in the\r
+ * header file of the driver (_reg.h).\r
+ */\r
+\r
+\r
+#if defined(STEVAL_MKI109V3)\r
+/* MKI109V3: Define communication interface */\r
+#define SENSOR_BUS hspi2\r
+/* MKI109V3: Vdd and Vddio power supply values */\r
+#define PWM_3V3 915\r
+\r
+#elif defined(NUCLEO_F411RE)\r
+/* NUCLEO_F411RE: Define communication interface */\r
+#define SENSOR_BUS hi2c1\r
+\r
+#elif defined(SPC584B_DIS)\r
+/* DISCOVERY_SPC584B: Define communication interface */\r
+#define SENSOR_BUS I2CD1\r
+\r
+#endif\r
+\r
+/* Includes ------------------------------------------------------------------*/\r
+#include <string.h>\r
+#include <stdio.h>\r
+#include "lis2doc_reg.h"\r
+\r
+#if defined(NUCLEO_F411RE)\r
+#include "stm32f4xx_hal.h"\r
+#include "usart.h"\r
+#include "gpio.h"\r
+#include "i2c.h"\r
+\r
+#elif defined(STEVAL_MKI109V3)\r
+#include "stm32f4xx_hal.h"\r
+#include "usbd_cdc_if.h"\r
+#include "gpio.h"\r
+#include "spi.h"\r
+#include "tim.h"\r
+\r
+#elif defined(SPC584B_DIS)\r
+#include "components.h"\r
+#endif\r
+\r
+\r
+/* Private macro -------------------------------------------------------------*/\r
+#define BOOT_TIME 20 //ms\r
+\r
+/* Private variables ---------------------------------------------------------*/\r
+static lis2doc_mode_t pm;\r
+static uint8_t whoamI, rst;\r
+static uint8_t tx_buffer[1000];\r
+\r
+/* Extern variables ----------------------------------------------------------*/\r
+\r
+/* Private functions ---------------------------------------------------------*/\r
+/*\r
+ * WARNING:\r
+ * Functions declare in this section are defined at the end of this file\r
+ * and are strictly related to the hardware platform used.\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+ uint16_t len);\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+ uint16_t len);\r
+static void tx_com( uint8_t *tx_buffer, uint16_t len );\r
+static void platform_delay(uint32_t ms);\r
+static void platform_init(void);\r
+\r
+/* Main Example --------------------------------------------------------------*/\r
+void lis2doc_single_tap(void)\r
+{\r
+ /* Initialize mems driver interface. */\r
+ stmdev_ctx_t dev_ctx;\r
+ lis2doc_reg_t int_route;\r
+ dev_ctx.write_reg = platform_write;\r
+ dev_ctx.read_reg = platform_read;\r
+ dev_ctx.handle = &SENSOR_BUS;\r
+ /* Initialize platform specific hardware */\r
+ platform_init();\r
+ /* Wait sensor boot time */\r
+ platform_delay(BOOT_TIME);\r
+ /* Check device ID */\r
+ lis2doc_device_id_get(&dev_ctx, &whoamI);\r
+\r
+ if (whoamI != LIS2DOC_ID)\r
+ while (1) {\r
+ /* manage here device not found */\r
+ }\r
+\r
+ /* Restore default configuration */\r
+ lis2doc_reset_set(&dev_ctx, PROPERTY_ENABLE);\r
+\r
+ do {\r
+ lis2doc_reset_get(&dev_ctx, &rst);\r
+ } while (rst);\r
+\r
+ /* Set full scale */\r
+ lis2doc_full_scale_set(&dev_ctx, LIS2DOC_2g);\r
+\r
+ /* Configure power mode */\r
+ pm.lpm = 1;\r
+ pm.low_noise = 1;\r
+ lis2doc_power_mode_set(&dev_ctx, pm);\r
+\r
+ /* Set Output Data Rate */\r
+ lis2doc_data_rate_set(&dev_ctx, LIS2DOC_XL_ODR_400Hz);\r
+ /* Enable Tap detection on X, Y, Z */\r
+ lis2doc_tap_detection_on_z_set(&dev_ctx, PROPERTY_ENABLE);\r
+ lis2doc_tap_detection_on_y_set(&dev_ctx, PROPERTY_ENABLE);\r
+ lis2doc_tap_detection_on_x_set(&dev_ctx, PROPERTY_ENABLE);\r
+ /* Set Tap threshold on all axis */\r
+ lis2doc_tap_threshold_x_set(&dev_ctx, 9);\r
+ lis2doc_tap_threshold_y_set(&dev_ctx, 9);\r
+ lis2doc_tap_threshold_z_set(&dev_ctx, 9);\r
+ /* Configure Single Tap parameter */\r
+ lis2doc_tap_quiet_set(&dev_ctx, 1);\r
+ lis2doc_tap_shock_set(&dev_ctx, 2);\r
+ /* Enable Single Tap detection only */\r
+ lis2doc_tap_mode_set(&dev_ctx, LIS2DOC_ONLY_SINGLE);\r
+ /* Enable single tap detection interrupt */\r
+ lis2doc_pin_int1_route_get(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);\r
+ int_route.ctrl4_int1_pad_ctrl.int1_single_tap = PROPERTY_ENABLE;\r
+ lis2doc_pin_int1_route_set(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);\r
+\r
+ /* Wait Events */\r
+ while (1) {\r
+ lis2doc_all_sources_t all_source;\r
+ /* Check Single Tap events */\r
+ lis2doc_all_sources_get(&dev_ctx, &all_source);\r
+\r
+ if (all_source.tap_src.single_tap) {\r
+ sprintf((char *)tx_buffer, "Tap Detected: Sign %s",\r
+ all_source.tap_src.tap_sign ? "positive" : "negative");\r
+\r
+ if (all_source.tap_src.x_tap) {\r
+ sprintf((char *)tx_buffer, "%s on X axis\r\n", tx_buffer);\r
+ }\r
+\r
+ if (all_source.tap_src.y_tap) {\r
+ sprintf((char *)tx_buffer, "%s on Y axis\r\n", tx_buffer);\r
+ }\r
+\r
+ if (all_source.tap_src.z_tap) {\r
+ sprintf((char *)tx_buffer, "%s on Z axis\r\n", tx_buffer);\r
+ }\r
+\r
+ tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
+ }\r
+ }\r
+}\r
+\r
+/*\r
+ * @brief Write generic device register (platform dependent)\r
+ *\r
+ * @param handle customizable argument. In this examples is used in\r
+ * order to select the correct sensor bus handler.\r
+ * @param reg register to write\r
+ * @param bufp pointer to data to write in register reg\r
+ * @param len number of consecutive register to write\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+ uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_I2C_Mem_Write(handle, LIS2DOC_I2C_ADD_H, reg,\r
+ I2C_MEMADD_SIZE_8BIT, (uint8_t*) bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+ HAL_SPI_Transmit(handle, ®, 1, 1000);\r
+ HAL_SPI_Transmit(handle, (uint8_t*) bufp, len, 1000);\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+ i2c_lld_write(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, (uint8_t*) bufp, len);\r
+#endif\r
+ return 0;\r
+}\r
+\r
+/*\r
+ * @brief Read generic device register (platform dependent)\r
+ *\r
+ * @param handle customizable argument. In this examples is used in\r
+ * order to select the correct sensor bus handler.\r
+ * @param reg register to read\r
+ * @param bufp pointer to buffer that store the data read\r
+ * @param len number of consecutive register to read\r
+ *\r
+ */\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+ uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_I2C_Mem_Read(handle, LIS2DOC_I2C_ADD_H, reg,\r
+ I2C_MEMADD_SIZE_8BIT, bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ reg |= 0x80;\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+ HAL_SPI_Transmit(handle, ®, 1, 1000);\r
+ HAL_SPI_Receive(handle, bufp, len, 1000);\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+ i2c_lld_read(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, bufp, len);\r
+#endif\r
+ return 0;\r
+}\r
+\r
+/*\r
+ * @brief Write generic device register (platform dependent)\r
+ *\r
+ * @param tx_buffer buffer to transmit\r
+ * @param len number of byte to send\r
+ *\r
+ */\r
+static void tx_com(uint8_t *tx_buffer, uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_UART_Transmit(&huart2, tx_buffer, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ CDC_Transmit_FS(tx_buffer, len);\r
+#elif defined(SPC584B_DIS)\r
+ sd_lld_write(&SD2, tx_buffer, len);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief platform specific delay (platform dependent)\r
+ *\r
+ * @param ms delay in ms\r
+ *\r
+ */\r
+static void platform_delay(uint32_t ms)\r
+{\r
+#if defined(NUCLEO_F411RE) | defined(STEVAL_MKI109V3)\r
+ HAL_Delay(ms);\r
+#elif defined(SPC584B_DIS)\r
+ osalThreadDelayMilliseconds(ms);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief platform specific initialization (platform dependent)\r
+ */\r
+static void platform_init(void)\r
+{\r
+#if defined(STEVAL_MKI109V3)\r
+ TIM3->CCR1 = PWM_3V3;\r
+ TIM3->CCR2 = PWM_3V3;\r
+ HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);\r
+ HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);\r
+ HAL_Delay(1000);\r
+#endif\r
+}\r
--- /dev/null
+/*\r
+ ******************************************************************************\r
+ * @file lis2doc_wake_up.c\r
+ * @author Sensors Software Solution Team\r
+ * @brief This file show the simplest way to detect wake_up from sensor.\r
+ *\r
+ ******************************************************************************\r
+ * @attention\r
+ *\r
+ * <h2><center>© Copyright (c) 2020 STMicroelectronics.\r
+ * All rights reserved.</center></h2>\r
+ *\r
+ * This software component is licensed by ST under BSD 3-Clause license,\r
+ * the "License"; You may not use this file except in compliance with the\r
+ * License. You may obtain a copy of the License at:\r
+ * opensource.org/licenses/BSD-3-Clause\r
+ *\r
+ ******************************************************************************\r
+ */\r
+\r
+/*\r
+ * This example was developed using the following STMicroelectronics\r
+ * evaluation boards:\r
+ *\r
+ * - STEVAL_MKI109V3 + STEVAL-MKI179V1\r
+ * - NUCLEO_F411RE + X_NUCLEO_IKS01A3\r
+ * - DISCOVERY_SPC584B + X_NUCLEO_IKS01A3\r
+ *\r
+ * and STM32CubeMX tool with STM32CubeF4 MCU Package\r
+ *\r
+ * Used interfaces:\r
+ *\r
+ * STEVAL_MKI109V3 - Host side: USB (Virtual COM)\r
+ * - Sensor side: SPI(Default) / I2C(supported)\r
+ *\r
+ * NUCLEO_STM32F411RE - Host side: UART(COM) to USB bridge\r
+ * - I2C(Default) / SPI(supported)\r
+ *\r
+ * DISCOVERY_SPC584B - Host side: UART(COM) to USB bridge\r
+ * - Sensor side: I2C(Default) / SPI(supported)\r
+ *\r
+ * If you need to run this example on a different hardware platform a\r
+ * modification of the functions: `platform_write`, `platform_read`,\r
+ * `tx_com` and 'platform_init' is required.\r
+ *\r
+ */\r
+\r
+/* STMicroelectronics evaluation boards definition\r
+ *\r
+ * Please uncomment ONLY the evaluation boards in use.\r
+ * If a different hardware is used please comment all\r
+ * following target board and redefine yours.\r
+ */\r
+\r
+//#define STEVAL_MKI109V3 /* little endian */\r
+//#define NUCLEO_F411RE /* little endian */\r
+//#define SPC584B_DIS /* big endian */\r
+\r
+/* ATTENTION: By default the driver is little endian. If you need switch\r
+ * to big endian please see "Endianness definitions" in the\r
+ * header file of the driver (_reg.h).\r
+ */\r
+\r
+\r
+#if defined(STEVAL_MKI109V3)\r
+/* MKI109V3: Define communication interface */\r
+#define SENSOR_BUS hspi2\r
+/* MKI109V3: Vdd and Vddio power supply values */\r
+#define PWM_3V3 915\r
+\r
+#elif defined(NUCLEO_F411RE)\r
+/* NUCLEO_F411RE: Define communication interface */\r
+#define SENSOR_BUS hi2c1\r
+\r
+#elif defined(SPC584B_DIS)\r
+/* DISCOVERY_SPC584B: Define communication interface */\r
+#define SENSOR_BUS I2CD1\r
+\r
+#endif\r
+\r
+/* Includes ------------------------------------------------------------------*/\r
+#include <string.h>\r
+#include <stdio.h>\r
+#include "lis2doc_reg.h"\r
+\r
+#if defined(NUCLEO_F411RE)\r
+#include "stm32f4xx_hal.h"\r
+#include "usart.h"\r
+#include "gpio.h"\r
+#include "i2c.h"\r
+\r
+#elif defined(STEVAL_MKI109V3)\r
+#include "stm32f4xx_hal.h"\r
+#include "usbd_cdc_if.h"\r
+#include "gpio.h"\r
+#include "spi.h"\r
+#include "tim.h"\r
+\r
+#elif defined(SPC584B_DIS)\r
+#include "components.h"\r
+#endif\r
+\r
+/* Private macro -------------------------------------------------------------*/\r
+#define BOOT_TIME 20 //ms\r
+\r
+/* Private variables ---------------------------------------------------------*/\r
+static lis2doc_mode_t pm;\r
+static uint8_t whoamI, rst;\r
+static uint8_t tx_buffer[1000];\r
+\r
+/* Extern variables ----------------------------------------------------------*/\r
+\r
+/* Private functions ---------------------------------------------------------*/\r
+/*\r
+ * WARNING:\r
+ * Functions declare in this section are defined at the end of this file\r
+ * and are strictly related to the hardware platform used.\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+ uint16_t len);\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+ uint16_t len);\r
+static void tx_com( uint8_t *tx_buffer, uint16_t len );\r
+static void platform_delay(uint32_t ms);\r
+static void platform_init(void);\r
+\r
+/* Main Example --------------------------------------------------------------*/\r
+void lis2doc_wake_up(void)\r
+{\r
+ /* Initialize mems driver interface */\r
+ stmdev_ctx_t dev_ctx;\r
+ lis2doc_reg_t int_route;\r
+ dev_ctx.write_reg = platform_write;\r
+ dev_ctx.read_reg = platform_read;\r
+ dev_ctx.handle = &SENSOR_BUS;\r
+ /* Initialize platform specific hardware */\r
+ platform_init();\r
+ /* Wait sensor boot time */\r
+ platform_delay(BOOT_TIME);\r
+ /* Check device ID */\r
+ lis2doc_device_id_get(&dev_ctx, &whoamI);\r
+\r
+ if (whoamI != LIS2DOC_ID)\r
+ while (1) {\r
+ /* manage here device not found */\r
+ }\r
+\r
+ /* Restore default configuration */\r
+ lis2doc_reset_set(&dev_ctx, PROPERTY_ENABLE);\r
+\r
+ do {\r
+ lis2doc_reset_get(&dev_ctx, &rst);\r
+ } while (rst);\r
+\r
+ /* Set full scale */\r
+ lis2doc_full_scale_set(&dev_ctx, LIS2DOC_2g);\r
+\r
+ /* Configure power mode */\r
+ pm.lpm = 1;\r
+ pm.low_noise = 1;\r
+ lis2doc_power_mode_set(&dev_ctx, pm);\r
+\r
+ /* Set Output Data Rate */\r
+ lis2doc_data_rate_set(&dev_ctx, LIS2DOC_XL_ODR_200Hz);\r
+ /* Apply high-pass digital filter on Wake-Up function */\r
+ lis2doc_filter_path_set(&dev_ctx, LIS2DOC_HIGH_PASS_ON_OUT);\r
+ /* Apply high-pass digital filter on Wake-Up function\r
+ * Duration time is set to zero so Wake-Up interrupt signal\r
+ * is generated for each X,Y,Z filtered data exceeding the\r
+ * configured threshold\r
+ */\r
+ lis2doc_wkup_dur_set(&dev_ctx, 0);\r
+ /* Set wake-up threshold\r
+ * Set Wake-Up threshold: 1 LSb corresponds to FS_XL/2^6\r
+ */\r
+ lis2doc_wkup_threshold_set(&dev_ctx, 2);\r
+ /* Enable interrupt generation on Wake-Up INT1 pin */\r
+ lis2doc_pin_int1_route_get(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);\r
+ int_route.ctrl4_int1_pad_ctrl.int1_wu = PROPERTY_ENABLE;\r
+ lis2doc_pin_int1_route_set(&dev_ctx, &int_route.ctrl4_int1_pad_ctrl);\r
+\r
+ /* Wait Events */\r
+ while (1) {\r
+ lis2doc_all_sources_t all_source;\r
+ /* Check Wake-Up events */\r
+ lis2doc_all_sources_get(&dev_ctx, &all_source);\r
+\r
+ if (all_source.wake_up_src.wu_ia) {\r
+ sprintf((char *)tx_buffer, "Wake-Up event on ");\r
+\r
+ if (all_source.wake_up_src.x_wu) {\r
+ strcat((char *)tx_buffer, "X");\r
+ }\r
+\r
+ if (all_source.wake_up_src.y_wu) {\r
+ strcat((char *)tx_buffer, "Y");\r
+ }\r
+\r
+ if (all_source.wake_up_src.z_wu) {\r
+ strcat((char *)tx_buffer, "Z");\r
+ }\r
+\r
+ strcat((char *)tx_buffer, " direction\r\n");\r
+ tx_com(tx_buffer, strlen((char const *)tx_buffer));\r
+ }\r
+ }\r
+}\r
+\r
+/*\r
+ * @brief Write generic device register (platform dependent)\r
+ *\r
+ * @param handle customizable argument. In this examples is used in\r
+ * order to select the correct sensor bus handler.\r
+ * @param reg register to write\r
+ * @param bufp pointer to data to write in register reg\r
+ * @param len number of consecutive register to write\r
+ *\r
+ */\r
+static int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,\r
+ uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_I2C_Mem_Write(handle, LIS2DOC_I2C_ADD_H, reg,\r
+ I2C_MEMADD_SIZE_8BIT, (uint8_t*) bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+ HAL_SPI_Transmit(handle, ®, 1, 1000);\r
+ HAL_SPI_Transmit(handle, (uint8_t*) bufp, len, 1000);\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+ i2c_lld_write(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, (uint8_t*) bufp, len);\r
+#endif\r
+ return 0;\r
+}\r
+\r
+/*\r
+ * @brief Read generic device register (platform dependent)\r
+ *\r
+ * @param handle customizable argument. In this examples is used in\r
+ * order to select the correct sensor bus handler.\r
+ * @param reg register to read\r
+ * @param bufp pointer to buffer that store the data read\r
+ * @param len number of consecutive register to read\r
+ *\r
+ */\r
+static int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,\r
+ uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_I2C_Mem_Read(handle, LIS2DOC_I2C_ADD_H, reg,\r
+ I2C_MEMADD_SIZE_8BIT, bufp, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ reg |= 0x80;\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_RESET);\r
+ HAL_SPI_Transmit(handle, ®, 1, 1000);\r
+ HAL_SPI_Receive(handle, bufp, len, 1000);\r
+ HAL_GPIO_WritePin(CS_up_GPIO_Port, CS_up_Pin, GPIO_PIN_SET);\r
+#elif defined(SPC584B_DIS)\r
+ i2c_lld_read(handle, LIS2DOC_I2C_ADD_H & 0xFE, reg, bufp, len);\r
+#endif\r
+ return 0;\r
+}\r
+\r
+/*\r
+ * @brief Write generic device register (platform dependent)\r
+ *\r
+ * @param tx_buffer buffer to transmit\r
+ * @param len number of byte to send\r
+ *\r
+ */\r
+static void tx_com(uint8_t *tx_buffer, uint16_t len)\r
+{\r
+#if defined(NUCLEO_F411RE)\r
+ HAL_UART_Transmit(&huart2, tx_buffer, len, 1000);\r
+#elif defined(STEVAL_MKI109V3)\r
+ CDC_Transmit_FS(tx_buffer, len);\r
+#elif defined(SPC584B_DIS)\r
+ sd_lld_write(&SD2, tx_buffer, len);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief platform specific delay (platform dependent)\r
+ *\r
+ * @param ms delay in ms\r
+ *\r
+ */\r
+static void platform_delay(uint32_t ms)\r
+{\r
+#if defined(NUCLEO_F411RE) | defined(STEVAL_MKI109V3)\r
+ HAL_Delay(ms);\r
+#elif defined(SPC584B_DIS)\r
+ osalThreadDelayMilliseconds(ms);\r
+#endif\r
+}\r
+\r
+/*\r
+ * @brief platform specific initialization (platform dependent)\r
+ */\r
+static void platform_init(void)\r
+{\r
+#if defined(STEVAL_MKI109V3)\r
+ TIM3->CCR1 = PWM_3V3;\r
+ TIM3->CCR2 = PWM_3V3;\r
+ HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);\r
+ HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);\r
+ HAL_Delay(1000);\r
+#endif\r
+}\r
#endif
#else
uapi_gpio_set_val(RESET_LCD_GPIO, GPIO_LEVEL_LOW);
- uapi_gpio_set_dir(RESET_LCD_GPIO, GPIO_DIRECTION_INPUT);
+ uapi_gpio_set_dir(RESET_LCD_GPIO, GPIO_DIRECTION_INPUT); //设置成Input,是为了解决漏电 ??
#ifndef QSPI_DISPLAY
uapi_gpio_set_val(VCI_LCD_GPIO, GPIO_LEVEL_LOW);
uapi_gpio_set_dir(VCI_LCD_GPIO, GPIO_DIRECTION_INPUT);
--- /dev/null
+#===============================================================================
+# @brief cmake file
+# Copyright (c) @CompanyNameMagicTag 2023-2023. All rights reserved.
+#===============================================================================
+set(COMPONENT_NAME "mag_sensor")
+
+set(SOURCES
+ ${CMAKE_CURRENT_SOURCE_DIR}/touch_screen_drv.c
+ ${CMAKE_CURRENT_SOURCE_DIR}/touch_screen_queue1.c
+)
+
+if("MAG_MMC5603" IN_LIST DEFINES)
+set(SOURCES ${SOURCES}
+ ${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/Customer.c
+ ${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/main_sample.c
+ ${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/MMC5603.c
+)
+else()
+set(SOURCES ${SOURCES}
+ ${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/Customer.c
+ ${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/main_sample.c
+ ${CMAKE_CURRENT_SOURCE_DIR}/mmc5603/MMC5603.c
+)
+endif()
+
+if("MAG_MMC5603" IN_LIST DEFINES)
+set(PUBLIC_HEADER
+ ${CMAKE_CURRENT_SOURCE_DIR}/mmc5603
+)
+else()
+set(PUBLIC_HEADER
+ {CMAKE_CURRENT_SOURCE_DIR}/mmc5603
+)
+endif()
+
+set(PRIVATE_HEADER
+)
+
+set(PRIVATE_DEFINES
+)
+
+set(PUBLIC_DEFINES
+)
+
+# use this when you want to add ccflags like -include xxx
+set(COMPONENT_PUBLIC_CCFLAGS
+)
+
+set(COMPONENT_CCFLAGS
+ -Wno-incompatible-function-pointer-types
+ -Wno-unused-function
+)
+
+set(WHOLE_LINK
+ true
+)
+
+set(MAIN_COMPONENT
+ false
+)
+
+build_component()
+
+install_sdk(${CMAKE_CURRENT_SOURCE_DIR} "*")
--- /dev/null
+#include "Customer.h"\r
+\r
+void Delay_Ms(int cnt)\r
+{\r
+ /* cnt is the time to wait */\r
+ \r
+ /* \r
+ .\r
+ . Need to be implemented by user. \r
+ .\r
+ */\r
+ \r
+ return;\r
+}\r
+void Delay_Us(int cnt)\r
+{\r
+ /* cnt is the time to wait */\r
+ \r
+ /* \r
+ .\r
+ . Need to be implemented by user. \r
+ .\r
+ */\r
+ \r
+ return;\r
+}\r
+int I2C_Write_Reg(unsigned char i2c_add, unsigned char reg_add, unsigned char cmd)\r
+{\r
+ /* i2c_add is the 7-bit i2c address of the sensor\r
+ * reg_add is the register address to wtite\r
+ * cmd is the value that need to be written to the register\r
+ * I2C operating successfully, return 1, otherwise return 0;\r
+ */\r
+ \r
+ /* \r
+ .\r
+ . Need to be implemented by user. \r
+ .\r
+ */ \r
+ \r
+ return 1;\r
+}\r
+int I2C_Read_Reg(unsigned char i2c_add, unsigned char reg_add, unsigned char *data)\r
+{\r
+ /* i2c_add is the 7-bit i2c address of the sensor\r
+ * reg_add is the register address to read\r
+ * data is the first address of the buffer that need to store the register value\r
+ * I2C operating successfully, return 1, otherwise return 0; \r
+ */\r
+ \r
+ /* \r
+ .\r
+ . Need to be implemented by user. \r
+ .\r
+ */ \r
+ \r
+ return 1;\r
+}\r
+int I2C_MultiRead_Reg(unsigned char i2c_add, unsigned char reg_add, int num, unsigned char *data)\r
+{\r
+ /* i2c_add is the 7-bit i2c address of the sensor\r
+ * reg_add is the first register address to read\r
+ * num is the number of the register to read \r
+ * data is the first address of the buffer that need to store the register value\r
+ * I2C operating successfully, return 1, otherwise return 0; \r
+ */\r
+ \r
+ /* \r
+ .\r
+ . Need to be implemented by user. \r
+ .\r
+ */\r
+ \r
+ return 1;\r
+}\r
+\r
--- /dev/null
+\r
+/**\r
+ * @brief Delay function.\r
+ */\r
+void Delay_Ms(int cnt);\r
+\r
+/**\r
+ * @brief Delay function.\r
+ */\r
+void Delay_Us(int cnt);\r
+\r
+/**\r
+ * @brief I2C write register.\r
+ */\r
+int I2C_Write_Reg(unsigned char i2c_add, unsigned char reg_add, unsigned char cmd);\r
+\r
+/**\r
+ * @brief I2C read register.\r
+ */\r
+int I2C_Read_Reg(unsigned char i2c_add, unsigned char reg_add, unsigned char *data);\r
+\r
+/**\r
+ * @brief I2C multi read.\r
+ */\r
+int I2C_MultiRead_Reg(unsigned char i2c_add, unsigned char reg_add, int num, unsigned char *data);\r
--- /dev/null
+/*****************************************************************************\r
+ * Copyright Statement:\r
+ * --------------------\r
+ * This software is protected by Copyright, and the information and source code\r
+ * contained herein is confidential. The software including the source code\r
+ * may not be copied and the information contained herein may not be used or\r
+ * disclosed except with the written permission of MEMSIC Inc. (C) 2019\r
+ *****************************************************************************/\r
+\r
+ /**\r
+ * @brief\r
+ * This file implement magnetic sensor driver APIs.\r
+ * Modified history: \r
+ * V1.5: Update to 1 step factory selftest on 20190619\r
+ */\r
+\r
+#include "MMC5603.h"\r
+#include "Customer.h"\r
+\r
+#include "math.h"\r
+\r
+/* Indicate working mode of sensor */\r
+static uint8_t sensor_state = 1;\r
+\r
+/* Function declaration */\r
+\r
+/**\r
+ * @brief Factory test mode\r
+ */\r
+int MMC5603_Factory_Test_Mode(void);\r
+\r
+/**\r
+ * @brief SET operation \r
+ */\r
+void MMC5603_SET(void);\r
+\r
+/**\r
+ * @brief RESET operation \r
+ */\r
+void MMC5603_RESET(void);\r
+\r
+/**\r
+ * @brief OTP read done check\r
+ */\r
+int MMC5603_Check_OTP(void);\r
+\r
+/**\r
+ * @brief Check Product ID\r
+ */\r
+int MMC5603_CheckID(void);\r
+\r
+/**\r
+ * @brief Auto self-test registers configuration\r
+ */\r
+void MMC5603_Auto_SelfTest_Configuration(void);\r
+\r
+/**\r
+ * @brief Auto self-test\r
+ */\r
+int MMC5603_Auto_SelfTest(void);\r
+\r
+/*********************************************************************************\r
+* decription: Factory test mode \r
+*********************************************************************************/\r
+int MMC5603_Factory_Test_Mode(void)\r
+{\r
+ int i;\r
+ uint8_t data_reg[6] ={0};\r
+ uint16_t data_set[3] = {0};\r
+ uint16_t data_reset[3] = {0}; \r
+ uint32_t delta_data[3] = {0};\r
+ \r
+ const uint16_t thr_srst_low = 100; \r
+ \r
+ /* Write reg 0x1D */\r
+ /* Set Cmm_en bit '0', Disable continuous mode */ \r
+ I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL2, 0x00);\r
+ \r
+ Delay_Ms(20);\r
+ \r
+ /* Write reg 0x1B */\r
+ /* Set Auto_SR_en bit '0', Disable the function of automatic set/reset */\r
+ I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL0, 0x00); \r
+ \r
+ /* Write reg 0x1C, Set BW<1:0> = 00 */\r
+ I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL1, 0x00); \r
+ \r
+ /* Do RESET operation */\r
+ MMC5603_RESET(); \r
+ /* Write 0x01 to register 0x1B, set Take_meas_M bit '1' */\r
+ I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL0, MMC5603_CMD_TMM); \r
+ /* Delay 10 ms to finish the TM operation */\r
+ Delay_Ms(10); \r
+ /* Read register data */\r
+ I2C_MultiRead_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_DATA, 6, data_reg);\r
+ /* Get high 16bits data */\r
+ data_reset[0] = (uint16_t)(data_reg[0] << 8 | data_reg[1]); //X axis\r
+ data_reset[1] = (uint16_t)(data_reg[2] << 8 | data_reg[3]); //Y axis \r
+ data_reset[2] = (uint16_t)(data_reg[4] << 8 | data_reg[5]); //Z axis \r
+ \r
+ /* Do SET operation */\r
+ MMC5603_SET(); \r
+ /* Write 0x01 to register 0x1B, set Take_meas_M bit '1' */\r
+ I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS,MMC5603_REG_CTRL0,MMC5603_CMD_TMM); \r
+ /* Delay 10 ms to finish the TM operation */\r
+ Delay_Ms(10); \r
+ /* Read register data */\r
+ I2C_MultiRead_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_DATA, 6, data_reg);\r
+ /* Get high 16bits data */\r
+ data_set[0] = (uint16_t)(data_reg[0] << 8 | data_reg[1]); //X axis\r
+ data_set[1] = (uint16_t)(data_reg[2] << 8 | data_reg[3]); //Y axis \r
+ data_set[2] = (uint16_t)(data_reg[4] << 8 | data_reg[5]); //Z axis \r
+ \r
+ for(i=0;i<3;i++)\r
+ {\r
+ if(data_set[i] >= data_reset[i])\r
+ delta_data[i] = data_set[i] - data_reset[i];\r
+ else\r
+ delta_data[i] = data_reset[i] - data_set[i];\r
+ }\r
+ \r
+ /* If output < 100lsb, fail*/\r
+ if(delta_data[0]<thr_srst_low && delta_data[1]<thr_srst_low && delta_data[2]<thr_srst_low)\r
+ return -1; // fail\r
+ \r
+ return 1; //pass\r
+}\r
+\r
+/*********************************************************************************\r
+* decription: SET operation \r
+*********************************************************************************/\r
+void MMC5603_SET(void)\r
+{ \r
+ /* Write 0x08 to register 0x1B, set SET bit high */\r
+ I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL0, MMC5603_CMD_SET); \r
+ \r
+ /* Delay to finish the SET operation */\r
+ Delay_Ms(1);\r
+ \r
+ return; \r
+}\r
+\r
+/*********************************************************************************\r
+* decription: RESET operation \r
+*********************************************************************************/\r
+void MMC5603_RESET(void)\r
+{ \r
+ /* Write 0x10 to register 0x1B, set RESET bit high */\r
+ I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL0, MMC5603_CMD_RESET);\r
+ \r
+ /* Delay to finish the RESET operation */\r
+ Delay_Ms(1);\r
+ \r
+ return; \r
+}\r
+\r
+/*********************************************************************************\r
+* decription: Product ID check\r
+*********************************************************************************/\r
+int MMC5603_CheckID(void)\r
+{\r
+ unsigned char pro_id = 0;\r
+ \r
+ /* Read register 0x39, check product ID */\r
+ I2C_Read_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_PRODUCTID1, &pro_id); \r
+ if(pro_id != MMC5603_PRODUCT_ID)\r
+ return -1;\r
+ \r
+ return 1;\r
+}\r
+\r
+/*********************************************************************************\r
+* decription: Auto self-test registers configuration\r
+*********************************************************************************/\r
+void MMC5603_Auto_SelfTest_Configuration(void)\r
+{\r
+ int i;\r
+ uint8_t reg_value[3];\r
+ int16_t st_thr_data[3]={0};\r
+ int16_t st_thr_new[3]={0};\r
+ \r
+ int16_t st_thd[3]={0};\r
+ uint8_t st_thd_reg[3]; \r
+\r
+ /* Read trim data from reg 0x27-0x29 */\r
+ I2C_MultiRead_Reg(MMC5603_7BITI2C_ADDRESS,MMC5603_REG_ST_X_VAL,3,reg_value); \r
+ for(i=0;i<3;i++)\r
+ {\r
+ st_thr_data[i] = (int16_t)(reg_value[i]-128)*32; \r
+ if(st_thr_data[i]<0)\r
+ st_thr_data[i] = -st_thr_data[i];\r
+ st_thr_new[i] = st_thr_data[i]-st_thr_data[i]/5;\r
+ \r
+ st_thd[i] = st_thr_new[i]/8;\r
+ if(st_thd[i]>255)\r
+ st_thd_reg[i] = 0xFF;\r
+ else\r
+ st_thd_reg[i] = (uint8_t)st_thd[i];\r
+ }\r
+ /* Write threshold into the reg 0x1E-0x20 */\r
+ I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_X_THD, st_thd_reg[0]);\r
+ I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_Y_THD, st_thd_reg[1]);\r
+ I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_Z_THD, st_thd_reg[2]);\r
+ \r
+ return;\r
+}\r
+\r
+/*********************************************************************************\r
+* decription: Auto self-test\r
+*********************************************************************************/\r
+int MMC5603_Auto_SelfTest(void)\r
+{\r
+ uint8_t reg_status = 0;\r
+ \r
+ /* Write 0x40 to register 0x1B, set Auto_st_en bit high */\r
+ I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL0, MMC5603_CMD_AUTO_ST_EN);\r
+ \r
+ /* Delay 15ms to finish the selftest process */\r
+ Delay_Ms(15);\r
+ \r
+ /* Read register 0x18, check Sat_sensor bit */\r
+ I2C_Read_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_STATUS1, ®_status); \r
+ if((reg_status&MMC5603_SAT_SENSOR))\r
+ {\r
+ return -1;\r
+ }\r
+ \r
+ return 1;\r
+}\r
+\r
+/*********************************************************************************\r
+* decription: Continuous mode configuration with auto set and reset\r
+*********************************************************************************/\r
+void MMC5603_Continuous_Mode_With_Auto_SR(uint8_t bandwith, uint8_t sampling_rate)\r
+{\r
+ /* Write reg 0x1C, Set BW<1:0> = bandwith */\r
+ I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL1, bandwith);\r
+ \r
+ /* Write reg 0x1A, set ODR<7:0> = sampling_rate */\r
+ I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_ODR, sampling_rate); \r
+ \r
+ /* Write reg 0x1B */\r
+ /* Set Auto_SR_en bit '1', Enable the function of automatic set/reset */\r
+ /* Set Cmm_freq_en bit '1', Start the calculation of the measurement period according to the ODR*/ \r
+ I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL0, MMC5603_CMD_CMM_FREQ_EN|MMC5603_CMD_AUTO_SR_EN);\r
+\r
+ /* Write reg 0x1D */\r
+ /* Set Cmm_en bit '1', Enter continuous mode */ \r
+ I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL2, MMC5603_CMD_CMM_EN); \r
+ \r
+ return;\r
+}\r
+\r
+/*********************************************************************************\r
+* decription: Do selftest operation periodically\r
+*********************************************************************************/\r
+int MMC5603_Saturation_Checking(void)\r
+{ \r
+ int ret = 0; //1 pass, -1 fail, 0 elapsed time is less 5 seconds\r
+\r
+ /* If sampling rate is 50Hz, then do saturation checking every 250 loops, i.e. 5 seconds */\r
+ static int NumOfSamples = 250;\r
+ static int cnt = 0;\r
+\r
+ if((cnt++)>=NumOfSamples)\r
+ {\r
+ cnt = 0;\r
+ ret = MMC5603_Auto_SelfTest();\r
+ if(ret == -1) \r
+ {\r
+ /* Sensor is saturated, need to do SET operation */\r
+ MMC5603_SET(); \r
+ }\r
+ \r
+ /* Do TM_M after selftest operation */\r
+ I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS,MMC5603_REG_CTRL0,MMC5603_CMD_TMM); \r
+ Delay_Ms(8);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+/*********************************************************************************\r
+* decription: Auto switch the working mode between Auto_SR and SETonly\r
+*********************************************************************************/\r
+void MMC5603_Auto_Switch(uint16_t *mag)\r
+{\r
+ float mag_out[3]; \r
+ \r
+ mag_out[0] = ((float)mag[0] - MMC5603_16BIT_OFFSET)/MMC5603_16BIT_SENSITIVITY;\r
+ mag_out[1] = ((float)mag[1] - MMC5603_16BIT_OFFSET)/MMC5603_16BIT_SENSITIVITY;\r
+ mag_out[2] = ((float)mag[2] - MMC5603_16BIT_OFFSET)/MMC5603_16BIT_SENSITIVITY;\r
+ \r
+ if(sensor_state == 1)\r
+ {\r
+ /* If X or Y axis output exceed 10 Gauss, then switch to single mode */\r
+ if((fabs(mag_out[0])>10.0f) || (fabs(mag_out[1])>10.0f))\r
+ { \r
+ sensor_state = 2;\r
+ \r
+ /* Disable continuous mode */ \r
+ I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL2, 0x00);\r
+ Delay_Ms(15);//Delay 15ms to finish the last sampling\r
+ \r
+ /* Do SET operation */\r
+ I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL0, MMC5603_CMD_SET); \r
+ Delay_Ms(1);//Delay 1ms to finish the SET operation\r
+ \r
+ /* Do TM_M before next data reading */\r
+ I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS,MMC5603_REG_CTRL0,MMC5603_CMD_TMM); \r
+ Delay_Ms(8);//Delay 8ms to finish the TM_M operation \r
+ } \r
+ }\r
+ else if(sensor_state == 2)\r
+ {\r
+ /* If both of X and Y axis output less than 8 Gauss, then switch to continuous mode with Auto_SR */\r
+ if((fabs(mag_out[0])<8.0f) && (fabs(mag_out[1])<8.0f))\r
+ { \r
+ sensor_state = 1;\r
+ \r
+ /* Enable continuous mode with Auto_SR */\r
+ I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL0, MMC5603_CMD_CMM_FREQ_EN|MMC5603_CMD_AUTO_SR_EN);\r
+ I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL2, MMC5603_CMD_CMM_EN);\r
+ }\r
+ else\r
+ { \r
+ /* Sensor checking */\r
+ if(MMC5603_Saturation_Checking()==0)\r
+ { \r
+ /* Do TM_M before next data reading */\r
+ I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS,MMC5603_REG_CTRL0,MMC5603_CMD_TMM); \r
+ }\r
+ } \r
+ }\r
+ \r
+ return; \r
+}\r
+\r
+/*********************************************************************************\r
+* decription: Disable sensor continuous mode\r
+*********************************************************************************/\r
+void MMC5603_Disable(void)\r
+{\r
+ /* Write reg 0x1D */\r
+ /* Set Cmm_en bit '0', Disable continuous mode */ \r
+ I2C_Write_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_CTRL2, 0x00);\r
+ \r
+ Delay_Ms(20);\r
+ \r
+ return;\r
+}\r
+\r
+/*********************************************************************************\r
+* decription: Enable sensor\r
+*********************************************************************************/\r
+void MMC5603_Enable(void)\r
+{ \r
+ int ret = 0;\r
+ \r
+ /* Inite the sensor state */\r
+ sensor_state = 1;\r
+ \r
+ /* Check product ID */\r
+ ret = MMC5603_CheckID();\r
+ if(ret<0)\r
+ return; \r
+ \r
+ /* Auto self-test registers configuration */\r
+ MMC5603_Auto_SelfTest_Configuration();\r
+ \r
+ /* Do SET operation */\r
+ MMC5603_SET(); \r
+\r
+ /* Work mode setting */\r
+ MMC5603_Continuous_Mode_With_Auto_SR(MMC5603_CMD_BW00, 50);\r
+ \r
+ Delay_Ms(20);\r
+ \r
+ return;\r
+}\r
+\r
+/*********************************************************************************\r
+* decription: Read the data register and convert to magnetic field \r
+*********************************************************************************/\r
+void MMC5603_GetData(float *mag_out)\r
+{\r
+ uint8_t data_reg[6] ={0};\r
+ uint16_t data_temp[3] = {0};\r
+ \r
+ /* Read register data */\r
+ I2C_MultiRead_Reg(MMC5603_7BITI2C_ADDRESS, MMC5603_REG_DATA, 6, data_reg);\r
+ \r
+ /* Get high 16bits data */\r
+ data_temp[0] = (uint16_t)(data_reg[0] << 8 | data_reg[1]); \r
+ data_temp[1] = (uint16_t)(data_reg[2] << 8 | data_reg[3]); \r
+ data_temp[2] = (uint16_t)(data_reg[4] << 8 | data_reg[5]); \r
+\r
+ /* Transform to unit Gauss */\r
+ mag_out[0] = ((float)data_temp[0] - MMC5603_16BIT_OFFSET)/MMC5603_16BIT_SENSITIVITY; \r
+ mag_out[1] = ((float)data_temp[1] - MMC5603_16BIT_OFFSET)/MMC5603_16BIT_SENSITIVITY;\r
+ mag_out[2] = ((float)data_temp[2] - MMC5603_16BIT_OFFSET)/MMC5603_16BIT_SENSITIVITY;\r
+\r
+ MMC5603_Auto_Switch(data_temp); \r
+ \r
+ return;\r
+}\r
--- /dev/null
+/*****************************************************************************\r
+ * Copyright Statement:\r
+ * --------------------\r
+ * This software is protected by Copyright and the information and source code\r
+ * contained herein is confidential. The software including the source code\r
+ * may not be copied and the information contained herein may not be used or\r
+ * disclosed except with the written permission of MEMSIC Inc. (C) 2019\r
+ *****************************************************************************/\r
+\r
+ /**\r
+ * @brief\r
+ * This file implement magnetic sensor driver APIs.\r
+ * Modified history: \r
+ * V1.5: Update to 1 step factory selftest on 20190619\r
+ */\r
+ \r
+#ifndef _MMC5603_H\r
+#define _MMC5603_H \r
+\r
+typedef signed char int8_t; // signed 8-bit number (-128 to +127)\r
+typedef unsigned char uint8_t; // unsigned 8-bit number (+0 to +255)\r
+typedef signed short int16_t; // signed 16-bt number (-32768 to +32767)\r
+typedef unsigned short uint16_t; // unsigned 16-bit number (+0 to +65535)\r
+typedef signed int int32_t; // signed 32-bt number (-2,147,483,648 to +2,147,483,647)\r
+typedef unsigned int uint32_t; // unsigned 32-bit number (+0 to +4,294,967,295)\r
+\r
+#define MMC5603_7BITI2C_ADDRESS 0x30\r
+\r
+#define MMC5603_REG_DATA 0x00\r
+\r
+#define MMC5603_REG_STATUS1 0x18\r
+#define MMC5603_REG_STATUS0 0x19\r
+\r
+#define MMC5603_REG_ODR 0x1A\r
+#define MMC5603_REG_CTRL0 0x1B\r
+#define MMC5603_REG_CTRL1 0x1C\r
+#define MMC5603_REG_CTRL2 0x1D\r
+\r
+#define MMC5603_REG_X_THD 0x1E\r
+#define MMC5603_REG_Y_THD 0x1F\r
+#define MMC5603_REG_Z_THD 0x20\r
+\r
+#define MMC5603_REG_ST_X_VAL 0x27\r
+#define MMC5603_REG_ST_Y_VAL 0x28\r
+#define MMC5603_REG_ST_Z_VAL 0x29\r
+\r
+#define MMC5603_REG_PRODUCTID1 0x39\r
+\r
+/* Bit definition for control register ODR 0x1A */\r
+#define MMC5603_CMD_ODR_1HZ 0x01\r
+#define MMC5603_CMD_ODR_5HZ 0x05\r
+#define MMC5603_CMD_ODR_10HZ 0x0A\r
+#define MMC5603_CMD_ODR_50HZ 0x32\r
+#define MMC5603_CMD_ODR_100HZ 0x64\r
+#define MMC5603_CMD_ODR_200HZ 0xC8\r
+#define MMC5603_CMD_ODR_255HZ 0xFF\r
+\r
+/* Bit definition for control register 0 0x1B */\r
+#define MMC5603_CMD_TMM 0x01\r
+#define MMC5603_CMD_TMT 0x02\r
+#define MMC5603_CMD_START_MDT 0x04\r
+#define MMC5603_CMD_SET 0x08\r
+#define MMC5603_CMD_RESET 0x10\r
+#define MMC5603_CMD_AUTO_SR_EN 0x20\r
+#define MMC5603_CMD_AUTO_ST_EN 0x40\r
+#define MMC5603_CMD_CMM_FREQ_EN 0x80\r
+\r
+/* Bit definition for control register 1 0x1C */\r
+#define MMC5603_CMD_BW00 0x00\r
+#define MMC5603_CMD_BW01 0x01\r
+#define MMC5603_CMD_BW10 0x02\r
+#define MMC5603_CMD_BW11 0x03\r
+#define MMC5603_CMD_ST_ENP 0x20\r
+#define MMC5603_CMD_ST_ENM 0x40\r
+#define MMC5603_CMD_SW_RST 0x80\r
+\r
+/* Bit definition for control register 2 0x1D */\r
+#define MMC5603_CMD_PART_SET1 0x00\r
+#define MMC5603_CMD_PART_SET25 0x01\r
+#define MMC5603_CMD_PART_SET75 0x02\r
+#define MMC5603_CMD_PART_SET100 0x03\r
+#define MMC5603_CMD_PART_SET250 0x04\r
+#define MMC5603_CMD_PART_SET500 0x05\r
+#define MMC5603_CMD_PART_SET1000 0x06\r
+#define MMC5603_CMD_PART_SET2000 0x07\r
+#define MMC5603_CMD_EN_PART_SET 0x08\r
+#define MMC5603_CMD_CMM_EN 0x10\r
+#define MMC5603_CMD_INT_MDT_EN 0x20\r
+#define MMC5603_CMD_INT_MD_EN 0x40\r
+#define MMC5603_CMD_HPOWER 0x80\r
+\r
+#define MMC5603_PRODUCT_ID 0x10\r
+#define MMC5603_MM_DONE_INT 0x01\r
+#define MMC5603_MT_DONE_INT 0x02\r
+#define MMC5603_MDT_FLAG_INT 0x04\r
+#define MMC5603_ST_FAIL_INT 0x08\r
+#define MMC5603_OTP_READ_DONE 0x10\r
+#define MMC5603_SAT_SENSOR 0x20\r
+#define MMC5603_MM_DONE 0x40\r
+#define MMC5603_MT_DONE 0x80\r
+\r
+// 16-bit mode, null field output (32768)\r
+#define MMC5603_16BIT_OFFSET 32768\r
+#define MMC5603_16BIT_SENSITIVITY 1024\r
+\r
+/**\r
+ * @brief Enable the sensor\r
+ */\r
+void MMC5603_Enable(void);\r
+\r
+/**\r
+ * @brief Disable the sensor\r
+ */\r
+void MMC5603_Disable(void);\r
+\r
+/**\r
+ * @brief Get sensor data\r
+ * @param mag_out is the magnetic field vector, unit is gauss\r
+ */\r
+void MMC5603_GetData(float *mag_out);\r
+\r
+#endif\r
+\r
--- /dev/null
+#include "Customer.h"\r
+#include "MMC5603.h" \r
+\r
+float magnetic_field_x;\r
+float magnetic_field_y;\r
+float magnetic_field_z;\r
+\r
+int main(void)\r
+{\r
+ /* Magnetic field vector, unit is gauss */\r
+ float mag_raw_data[3] = {0.0}; \r
+ \r
+ /* Enable the sensor. */\r
+ MMC5603_Enable(); \r
+ \r
+ while(1)\r
+ { \r
+ /* Get the MMC5603 data, unit is gauss */\r
+ MMC5603_GetData(mag_raw_data); \r
+\r
+ magnetic_field_x = mag_raw_data[0]; //unit is gauss\r
+ magnetic_field_y = mag_raw_data[1]; //unit is gauss\r
+ magnetic_field_z = mag_raw_data[2]; //unit is gauss\r
+ \r
+ /* Sampling interval is 20ms, and the sampling rate is 50Hz. */\r
+ Delay_Ms(20);\r
+ }\r
+}\r
--- /dev/null
+#===============================================================================
+# @brief cmake file
+# Copyright (c) @CompanyNameMagicTag 2022-2023. All rights reserved.
+#===============================================================================
+set(COMPONENT_NAME "ppg_sensor")
+
+set(SOURCES
+ ${CMAKE_CURRENT_SOURCE_DIR}/button.c
+)
+
+set(PUBLIC_HEADER
+ ${CMAKE_CURRENT_SOURCE_DIR}
+)
+
+set(PRIVATE_HEADER
+)
+
+set(PRIVATE_DEFINES
+)
+
+set(PUBLIC_DEFINES
+)
+
+# use this when you want to add ccflags like -include xxx
+set(COMPONENT_PUBLIC_CCFLAGS
+)
+
+set(COMPONENT_CCFLAGS
+)
+
+set(WHOLE_LINK
+ true
+)
+
+set(MAIN_COMPONENT
+ false
+)
+
+build_component()
--- /dev/null
+#include <stdio.h>\r
+#include <stdbool.h>\r
+#include <stdint.h>\r
+#include <stdlib.h>\r
+#include <math.h>\r
+\r
+#include "tyhx_hrs_custom.h"\r
+#include "tyhx_mems.h"\r
+\r
+#ifdef CHIP_HX3695\r
+#include "hx3695.h"\r
+#ifdef HRS_ALG_LIB\r
+#include "hx3695_hrs_agc.h"\r
+#include "tyhx_hrs_alg.h"\r
+#endif\r
+#ifdef SPO2_ALG_LIB\r
+#include "hx3695_spo2_agc.h"\r
+#include "tyhx_spo2_alg.h"\r
+#endif\r
+#ifdef HRV_ALG_LIB\r
+#include "hx3695_hrv_agc.h"\r
+#include "tyhx_hrv_alg.h"\r
+#endif\r
+#ifdef CHECK_TOUCH_LIB\r
+#include "hx3695_check_touch.h"\r
+#endif\r
+#include "hx3695_factory_test.h"\r
+\r
+\r
+\r
+#ifdef SPO2_VECTOR\r
+#include "spo2_vec.h"\r
+uint32_t spo2_send_cnt = 0;\r
+uint32_t spo2_send_cnt1 = 0;\r
+int32_t red_buf_vec[8];\r
+int32_t ir_buf_vec[8];\r
+int32_t green_buf_vec[8];\r
+#endif\r
+\r
+#ifdef HR_VECTOR\r
+#include "hr_vec.h"\r
+uint32_t vec_send_cnt = 0;\r
+int32_t PPG_buf_vec[8];\r
+#endif\r
+\r
+#ifdef HRV_TESTVEC\r
+#include "hrv_testvec.h"\r
+#endif\r
+\r
+int32_t s_buf[256];\r
+uint32_t cnt_num = 0;\r
+uint32_t phase3_rdy_num = 0;\r
+uint8_t fifo_data_buf[768];\r
+uint8_t hrs_phase_num= 3;\r
+uint8_t spo2_phase_num= 4;\r
+uint8_t hrv_phase_num = 4;\r
+extern uint8_t data_count;\r
+\r
+//spo2 agc\r
+const uint8_t hx3695_spo2_agc_red_idac = RED_AGC_OFFSET;\r
+const uint8_t hx3695_spo2_agc_ir_idac = IR_AGC_OFFSET;\r
+const uint8_t hx3695_spo2_agc_ir_idac1 = IR_AGC_OFFSET;\r
+const uint8_t hx3695_spo2_agc_ir_idac2 = IR_AGC_OFFSET;\r
+const uint8_t hx3695_spo2_agc_green_idac = GREEN_AGC_OFFSET;\r
+//hrs agc\r
+const uint8_t hx3695_hrs_agc_idac = HR_GREEN_AGC_OFFSET;\r
+const uint8_t hx3695_hrs_g1_agc_idac = HR_GREEN1_AGC_OFFSET;\r
+const uint8_t hx3695_hrs_g2_agc_idac = HR_GREEN2_AGC_OFFSET; \r
+const uint8_t hx3695_hrs_g3_agc_idac = HR_GREEN3_AGC_OFFSET;\r
+//hrv agc\r
+const uint8_t hx3695_hrv_agc_idac = HR_GREEN_AGC_OFFSET;\r
+\r
+const uint8_t green_led_max_init = 128;\r
+const uint8_t red_led_max_init = 255;\r
+const uint8_t ir_led_max_init = 128;\r
+\r
+uint8_t low_vbat_flag =0;\r
+WORK_MODE_T work_mode_flag = HRS_MODE;\r
+const uint16_t static_thre_val = 150;\r
+const uint8_t gsen_lv_val = 0;\r
+uint8_t read_fifo_first_flg = 0;\r
+\r
+//HRS_INFRARED_THRES\r
+const int32_t hrs_ir_unwear_thres = 20000;\r
+const int32_t hrs_ir_wear_thres = 10000;\r
+//HRV_INFRARED_THRES\r
+const int32_t hrv_ir_unwear_thres = 10000; //demo143b 25000\r
+const int32_t hrv_ir_wear_thres = 20000;\r
+//SPO2_INFRARED_THRES\r
+const int32_t spo2_ir_unwear_thres = 8000; //demo143b 25000 30000\r
+const int32_t spo2_ir_wear_thres = 10000;\r
+const uint8_t spo2_ir_wear_offset = 15;\r
+//CHECK_WEAR_MODE_THRES\r
+const int32_t check_mode_unwear_thre = 20000;\r
+const int32_t check_mode_wear_thre = 30000;\r
+\r
+uint8_t alg_ram[11 * 1024] __attribute__((aligned(4)));\r
+//uint8_t alg_ram[10] = {0};\r
+ppg_sensor_data_t ppg_s_data;\r
+\r
+\r
+//////// spo2 para and switches\r
+const uint8_t COUNT_BLOCK_NUM = 25; //delay the block of some single good signal after a series of bad signal\r
+const uint8_t SPO2_LOW_XCORR_THRE = 30; //(64*xcorr)'s square below this threshold, means error signal\r
+const uint8_t SPO2_CALI = 1; //spo2_result cali mode\r
+const uint8_t XCORR_MODE = 1; //xcorr mode switch\r
+const uint8_t QUICK_RESULT = 1; //come out the spo2 result quickly ;0 is normal,1 is quick\r
+const uint16_t MEAN_NUM = 32; //the length of smooth-average ;the value of MEAN_NUM can be given only 256 and 512\r
+const uint8_t G_SENSOR = 0; //if =1, open the gsensor mode\r
+const uint8_t SPO2_GSEN_POW_THRE = 150; //gsen pow judge move, range:0-200;\r
+const uint32_t SPO2_BASE_LINE_INIT = 135500; //spo2 baseline init, = 103000 + ratio(a variable quantity,depends on different cases)*SPO2_SLOPE\r
+const int32_t SOP2_DEGLITCH_THRE = 100000; //remove signal glitch over this threshold\r
+const int32_t SPO2_REMOVE_JUMP_THRE = 50000; //remove signal jump over this threshold\r
+const uint32_t SPO2_SLOPE = 50000; //increase this slope, spo2 reduce more\r
+const uint16_t SPO2_LOW_CLIP_END_TIME = 1500; //low clip mode before this data_cnt, normal clip mode after this\r
+const uint16_t SPO2_LOW_CLIP_DN = 150; //spo2 reduce 0.15/s at most in low clip mode\r
+const uint16_t SPO2_NORMAL_CLIP_DN = 500; //spo2 reduce 0.5/s at most in normal clip mode\r
+const uint8_t SPO2_LOW_SNR_THRE = 40; //snr below this threshold, means error signal\r
+const uint16_t IR_AC_TOUCH_THRE = 200; //AC_min*0.3\r
+const uint16_t IR_FFT_POW_THRE = 500; //fft_pow_min\r
+const uint8_t SLOPE_PARA_MAX = 28;\r
+const uint8_t SLOPE_PARA_MIN = 3;\r
+\r
+#ifdef SPO2_DATA_CALI\r
+static int32_t red_data_fifo[4] = {0};\r
+static int32_t ir_data_fifo[4] = {0};\r
+static int32_t red_dc_temp = 0;\r
+static int32_t ir_dc_temp = 0;\r
+static int32_t red_data_pre = 0;\r
+static int32_t ir_data_pre = 0;\r
+static int32_t red_jump_delta = 0;\r
+static int32_t ir_jump_delta = 0;\r
+static int32_t cali_data_cnt = 0;\r
+#endif\r
+\r
+// us ÑÓʱº¯Êý£¬ ¿Í»§ÐèÌîд\r
+void hx3695_delay_us(uint32_t us)\r
+{\r
+ tyhx_delay_us(us);\r
+}\r
+\r
+\r
+void hx3695_delay_ms(uint32_t ms)\r
+{\r
+ tyhx_delay_ms(ms);\r
+}\r
+\r
+// i2c дº¯Êý£¬ ¿Í»§ÐèÌîд, µØÖ·0x44(7bit)\r
+bool hx3695_write_reg(uint8_t addr, uint8_t data)\r
+{\r
+\r
+ tyhx_write_reg(I2C_DEV_8ADDR,addr,data);\r
+ return true;\r
+}\r
+\r
+// i2c ¶Áº¯Êý£¬ ¿Í»§ÐèÌîд\r
+uint8_t hx3695_read_reg(uint8_t addr)\r
+{\r
+ uint8_t data_buf = 0;\r
+\r
+ tyhx_read_regs(I2C_DEV_8ADDR,addr,&data_buf,1);\r
+ return data_buf;\r
+}\r
+\r
+// i2c Á¬¶Áº¯Êý£¬ ¿Í»§ÐèÌîд\r
+bool hx3695_brust_read_reg(uint8_t addr, uint8_t *buf, uint8_t length)\r
+{\r
+ //TYHX_LOG("brust read\r\n");\r
+ tyhx_read_regs(I2C_DEV_8ADDR,addr,buf,length);\r
+ return true;\r
+}\r
+\r
+\r
+\r
+uint32_t hx3695_timers_start(void)\r
+{\r
+ tyhx_timer_start(TYHX_TIMER_320MS);\r
+ return 0;\r
+}\r
+uint32_t hx3695_timers_stop(void)\r
+{\r
+ tyhx_timer_stop(TYHX_TIMER_320MS);\r
+ return 0;\r
+}\r
+\r
+uint32_t gsen_read_timers_start(void)\r
+{\r
+ tyhx_timer_start(TYHX_TIMER_40MS);\r
+ return 0;\r
+}\r
+uint32_t gsen_read_timers_stop(void)\r
+{\r
+ tyhx_timer_stop(TYHX_TIMER_40MS);\r
+ return 0;\r
+}\r
+\r
+\r
+/* Íê³É¶ÁÈ¡PPGÊý¾Ý¶¨Ê±Æ÷½Ó¿Ú£¬ Ñ»·µ÷Ó㬠ĬÈÏ320ms\r
+void heart_rate_meas_timeout_handler(void * p_context)\r
+*/\r
+void hx3695_320ms_timer_cfg(bool en)\r
+{\r
+ if(en)\r
+ {\r
+ hx3695_timers_start();\r
+ }\r
+ else\r
+ {\r
+ hx3695_timers_stop();\r
+ }\r
+\r
+}\r
+\r
+void hx3695_40ms_timer_cfg(bool en)\r
+{\r
+ if(en)\r
+ {\r
+ gsen_read_timers_start();\r
+ }\r
+ else\r
+ {\r
+ gsen_read_timers_stop();\r
+ }\r
+}\r
+\r
+#if defined(INT_MODE)\r
+/* Èç²ÉÓÃÖжÏģʽ£¬ ÈçÍê³ÉÖжϿªÆôºÍ¹Ø±Õ½Ó¿Ú\r
+void hx3695_ppg_Int_handle(void)\r
+*/\r
+void hx3695_gpioint_cfg(bool en)\r
+{\r
+ if(en)\r
+ {\r
+ hx3695_gpioint_enable();\r
+ }\r
+ else\r
+ {\r
+ hx3695_gpioint_disable();\r
+ }\r
+}\r
+#endif\r
+\r
+bool hx3695_chip_check(void)\r
+{\r
+ uint8_t i = 0;\r
+ uint8_t chip_id = 0;\r
+ for(i=0; i<10; i++)\r
+ {\r
+// hx3695_write_reg(0x02, 0x00);\r
+// hx3695_delay_ms(5);\r
+ chip_id = hx3695_read_reg(0x00);\r
+\r
+ if (chip_id == 0x65)\r
+ {\r
+ TYHX_LOG(" %x, hx3695_chip_check ok\r\n",chip_id);\r
+ return true;\r
+ }\r
+ }\r
+ TYHX_LOG(" %x, hx3695_chip_check fail!\r\n",chip_id);\r
+ return false;\r
+}\r
+\r
+uint8_t hx3695_read_fifo_size(void)\r
+{\r
+ uint8_t data_len_h,data_len_l;\r
+ uint16_t fifo_data_length;\r
+ data_len_h = hx3695_read_reg(0x21);\r
+ data_len_l = hx3695_read_reg(0x20);\r
+ fifo_data_length = (((data_len_h&0x01)<<8)|data_len_l);\r
+\r
+ return fifo_data_length;\r
+}\r
+\r
+\r
+uint16_t hx3695_read_fifo_data(int32_t *buf, uint8_t phase_num, uint8_t sig)\r
+{\r
+ uint8_t data_flg_start = 0;\r
+ uint8_t data_flg_end = 0;\r
+// int32_t data;\r
+ uint8_t databuf[3];\r
+ uint32_t ii=0;\r
+ uint16_t data_len_h = 0;\r
+ uint16_t data_len_l = 0;\r
+ uint16_t fifo_data_length = 0;\r
+ uint16_t fifo_read_length = 0;\r
+ uint16_t fifo_read_bytes = 0;\r
+ uint16_t fifo_out_length = 0;\r
+ uint16_t fifo_out_count = 0;\r
+ \r
+ data_len_h = hx3695_read_reg(0x21);\r
+ data_len_l = hx3695_read_reg(0x20);\r
+ fifo_data_length = (((data_len_h&0x01)<<8)|data_len_l);\r
+// SEGGER_RTT_printf(0,"fifo_data_length = %d\r\n", fifo_data_length); \r
+ if(fifo_data_length<2*phase_num)\r
+ {\r
+ return 0;\r
+ }\r
+ fifo_read_length = ((fifo_data_length-phase_num)/phase_num)*phase_num;\r
+// SEGGER_RTT_printf(0,"fifo_data_length_change = %d\r\n", fifo_read_length);\r
+ fifo_read_bytes = fifo_read_length*3;\r
+ if(read_fifo_first_flg == 1)\r
+ {\r
+ hx3695_brust_read_reg(0x22, databuf, 3); \r
+ read_fifo_first_flg = 0;\r
+ } \r
+ hx3695_brust_read_reg(0x22, fifo_data_buf, fifo_read_bytes); \r
+// for(ii=0; ii<fifo_read_bytes; ii++)\r
+// {\r
+// SEGGER_RTT_printf(0,"%d/%d, %d\r\n", ii+1,fifo_read_bytes,fifo_data_buf[ii]); \r
+// }\r
+ for(ii=0; ii<fifo_read_length; ii++)\r
+ {\r
+ if(sig==0)\r
+ {\r
+ buf[ii] = (int32_t)(fifo_data_buf[ii*3]|(fifo_data_buf[ii*3+1]<<8)|((fifo_data_buf[ii*3+2]&0x1f)<<16));\r
+ }\r
+ else\r
+ {\r
+ if((fifo_data_buf[ii*3+2]&0x10)!=0)\r
+ {\r
+ buf[ii] = (int32_t)(fifo_data_buf[ii*3]|(fifo_data_buf[ii*3+1]<<8)|((fifo_data_buf[ii*3+2]&0x0f)<<16))-1048576;\r
+ }\r
+ else\r
+ {\r
+ buf[ii] = (int32_t)(fifo_data_buf[ii*3]|(fifo_data_buf[ii*3+1]<<8)|((fifo_data_buf[ii*3+2]&0x1f)<<16));\r
+ }\r
+ }\r
+ SEGGER_RTT_printf(0,"fifo_length = %d/%d, %d %d\r\n", ii+1,fifo_read_length,buf[ii],fifo_data_buf[ii*3+2]>>5); \r
+ }\r
+ data_flg_start = fifo_data_buf[2]>>5;\r
+ data_flg_end = fifo_data_buf[fifo_read_bytes-1]>>5;\r
+ fifo_out_length = fifo_read_length;\r
+ if(data_flg_start>0)\r
+ {\r
+ fifo_out_length = fifo_read_length-phase_num + data_flg_start;\r
+ for(ii=0; ii<fifo_out_length; ii++)\r
+ {\r
+ buf[ii] = buf[ii+ phase_num - data_flg_start];\r
+ }\r
+ for(ii= fifo_out_length; ii< fifo_read_length; ii++)\r
+ {\r
+ buf[ii] = 0;\r
+ }\r
+ }\r
+ if(data_flg_end < phase_num -1)\r
+ {\r
+ for(ii=fifo_out_length; ii<fifo_out_length+phase_num-data_flg_end-1; ii++)\r
+ hx3695_brust_read_reg(0x22, databuf, 3);\r
+ buf[ii] = (int32_t)(databuf[0]|(databuf[1]<<8)|((databuf[2]&0x1f)<<16)); \r
+ } \r
+ for(ii=0; ii<fifo_out_length; ii++)\r
+ {\r
+// SEGGER_RTT_printf(0,"fifo_buf %d/%d, %d\r\n", ii+1,fifo_out_length,buf[ii]); \r
+ }\r
+ fifo_out_length = fifo_out_length+phase_num-data_flg_end - 1;\r
+ fifo_out_count = fifo_out_length/phase_num;\r
+ return fifo_out_count;\r
+}\r
+\r
+void hx3695_vin_check(uint16_t led_vin)\r
+{\r
+ low_vbat_flag = 0;\r
+ if(led_vin < 3700)\r
+ {\r
+ low_vbat_flag = 1;\r
+ }\r
+}\r
+\r
+void hx3695_ppg_off(void)\r
+{\r
+\r
+ hx3695_delay_ms(5);\r
+ hx3695_write_reg(0x5c, 0x02);\r
+}\r
+\r
+void hx3695_ppg_on(void)\r
+{\r
+ hx3695_write_reg(0x5c, 0x00);\r
+ hx3695_delay_ms(5);\r
+}\r
+\r
+void hx3695_data_reset(void)\r
+{\r
+#if defined(TIMMER_MODE)\r
+ hx3695_320ms_timer_cfg(false);\r
+ hx3695_40ms_timer_cfg(false);\r
+#elif defined(INT_MODE)\r
+ hx3695_gpioint_cfg(false);\r
+#endif\r
+#if defined(HRS_ALG_LIB)\r
+ hx3695_hrs_data_reset();\r
+#endif\r
+#if defined(SPO2_ALG_LIB)\r
+ hx3695_spo2_data_reset();\r
+#endif\r
+#if defined(HRV_ALG_LIB)\r
+ hx3695_hrv_data_reset();\r
+#endif\r
+ AGC_LOG("hx3695 data reset!\r\n");\r
+}\r
+\r
+#ifdef HRS_ALG_LIB\r
+// ÐÄÂÊģʽÏÂppg ³õʼ»¯ÅäÖÃ\r
+void hx3695_hrs_ppg_init(void) // ppg fs=25hz, phase conversion ready interupt en\r
+{\r
+ uint16_t sample_rate = 25; /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+ uint32_t prf_clk_num = 32000/sample_rate; /*period in clk num, num = Fclk/fs */\r
+ \r
+// uint16_t fifo_watermark= 81 ;\r
+ uint8_t adc_rst_post_num=0; /* 00=16,01=32,10=64,11=128*/ \r
+ uint8_t samp_delay_leden_num = 0; /* 00=8,01=16,10=32,11=64*/ \r
+ uint8_t samp_copy_avg = 0; /* 0=1, 1=2, 2=4 ,3=8, 4=16*/\r
+ uint8_t data_avg_num = 0; /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+ uint8_t phase7_8_internal = 0; /* phase7 and phase8 prf internal cfg */\r
+ \r
+ uint8_t phase1_enable = 1; /*phase1_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase2_enable = 1; /*phase2_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase3_enable = 1; /*phase3_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase4_enable = 1; /*phase4_enable , 1 mean enable ; 0 mean disable */\r
+ uint8_t phase5_enable = 1; /*phase5_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase6_enable = 1; /*phase6_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase7_enable = 1; /*phase7_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase8_enable = 1; /*phase8_enable , 1 mean enable ; 0 mean disable */ \r
+\r
+ uint8_t phase1_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase2_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase3_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase4_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase5_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase6_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase7_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase8_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ \r
+ uint8_t phase1_mux_sel = 0; /* sel phase1*/\r
+ uint8_t phase2_mux_sel = 1; /* sel phase2*/\r
+ uint8_t phase3_mux_sel = 2; /* sel phase3*/\r
+ uint8_t phase4_mux_sel = 3; /* sel phase4*/\r
+ uint8_t phase5_mux_sel = 4; /* sel phase5*/\r
+ uint8_t phase6_mux_sel = 5; /* sel phase6*/\r
+ uint8_t phase7_mux_sel = 6; /* sel phase7*/\r
+ uint8_t phase8_mux_sel = 7; /* sel phase8*/\r
+ \r
+\r
+ uint8_t phase1_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase1_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase1_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase1_led_drv1_cha_sel = 0; /* 1 = ldr1 NG; 2 = ldr2 GR; 4 = ldr3 IR; 8 = ldr4 RED; */\r
+ uint8_t phase1_led_drv2_cha_sel = 0; /*ldr5:0x20 ldr6: 0x40 red ldr8 0x80 ir */\r
+ uint8_t phase1_pd_sel = 0x03; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase1_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase1_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase1_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase1_ldr2_cur = 0;\r
+// uint8_t phase1_of_idac1_cur = 0;\r
+// uint8_t phase1_of_idac2_cur = 0;\r
+ uint8_t phase1_ad_inr_ctrl = 3;\r
+ uint8_t phase1_ad_of_idac_ctrl = 0;\r
+// uint8_t afe_offset = 0;\r
+ uint8_t phase1_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase1_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase1_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+\r
+\r
+ uint8_t phase2_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase2_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase2_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase2_led_drv1_cha_sel = 0x10; //GREEN_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase2_led_drv2_cha_sel = 0;\r
+ uint8_t phase2_pd_sel = 0x03; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase2_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase2_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase2_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase2_ldr2_cur = 0;\r
+// uint8_t phase2_of_idac1_cur = 0;\r
+// uint8_t phase2_of_idac2_cur = 0;\r
+ uint8_t phase2_ad_inr_ctrl = 3;\r
+ uint8_t phase2_ad_of_idac_ctrl = 0;\r
+// uint8_t phase2_afe_offset = 0;\r
+ uint8_t phase2_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase2_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase2_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ \r
+ uint8_t phase3_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase3_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase3_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase3_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase3_led_drv2_cha_sel = 0;\r
+ uint8_t phase3_pd_sel = 0x03; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase3_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase3_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase3_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase3_ldr2_cur = 0;\r
+// uint8_t phase3_of_idac1_cur = 0;\r
+// uint8_t phase3_of_idac2_cur = 0;\r
+ uint8_t phase3_ad_inr_ctrl = 3;\r
+ uint8_t phase3_ad_of_idac_ctrl = 0;\r
+// uint8_t phase3_afe_offset = 0;\r
+ uint8_t phase3_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase3_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase3_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ \r
+ uint8_t phase4_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase4_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase4_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase4_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase4_led_drv2_cha_sel = 0;\r
+ uint8_t phase4_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase4_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase4_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase4_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase4_ldr2_cur = 0;\r
+// uint8_t phase4_of_idac1_cur = 0;\r
+// uint8_t phase4_of_idac2_cur = 0;\r
+ uint8_t phase4_ad_inr_ctrl = 3;\r
+ uint8_t phase4_ad_of_idac_ctrl = 0;\r
+// uint8_t phase4_afe_offset = 0;\r
+ uint8_t phase4_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase4_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase4_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase5_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase5_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase5_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase5_led_drv1_cha_sel = 0x10; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase5_led_drv2_cha_sel = 0;\r
+ uint8_t phase5_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase5_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase5_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase5_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase5_ldr2_cur = 0;\r
+// uint8_t phase5_of_idac1_cur = 0;\r
+// uint8_t phase5_of_idac2_cur = 0;\r
+ uint8_t phase5_ad_inr_ctrl = 3;\r
+ uint8_t phase5_ad_of_idac_ctrl = 0;\r
+// uint8_t phase5_afe_offset = 0;\r
+ uint8_t phase5_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase5_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase5_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase6_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase6_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase6_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase6_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase6_led_drv2_cha_sel = 0;\r
+ uint8_t phase6_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase6_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase6_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase6_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase6_ldr2_cur = 0;\r
+// uint8_t phase6_of_idac1_cur = 0;\r
+// uint8_t phase6_of_idac2_cur = 0;\r
+ uint8_t phase6_ad_inr_ctrl = 3;\r
+ uint8_t phase6_ad_of_idac_ctrl = 0;\r
+// uint8_t phase6_afe_offset = 0;\r
+ uint8_t phase6_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase6_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase6_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase7_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase7_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase7_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase7_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase7_led_drv2_cha_sel = 0;\r
+ uint8_t phase7_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase7_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase7_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase7_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase7_ldr2_cur = 0;\r
+// uint8_t phase7_of_idac1_cur = 0;\r
+// uint8_t phase7_of_idac2_cur = 0;\r
+ uint8_t phase7_ad_inr_ctrl = 3;\r
+ uint8_t phase7_ad_of_idac_ctrl = 0;\r
+// uint8_t phase7_afe_offset = 0;\r
+ uint8_t phase7_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase7_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase7_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase8_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase8_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase8_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase8_led_drv1_cha_sel = 0x40; //IR_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase8_led_drv2_cha_sel = 0;\r
+ uint8_t phase8_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase8_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase8_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase8_ldr1_cur = 32; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase8_ldr2_cur = 0;\r
+// uint8_t phase8_of_idac1_cur = 0;\r
+// uint8_t phase8_of_idac2_cur = 0;\r
+ uint8_t phase8_ad_inr_ctrl = 3;\r
+ uint8_t phase8_ad_of_idac_ctrl = 0;\r
+// uint8_t phase8_afe_offset = 0;\r
+ uint8_t phase8_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase8_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase8_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t init_wait_delay = 5 ; /* 0 = 31clk ; 1 = 64clk ; 2 = 127clk ; 3 = 255clk(d) ;\r
+ 4 = 511clk; 5 = 1023clk; 6 = 2047; 7 = 4095clk */ \r
+ \r
+ uint8_t afe_reset = 3; /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d) ;\r
+ 4 = 255clk; 5 = 511clk; 6 = 1024; 7 = 2047clk */\r
+ \r
+ uint8_t afe_rst_cnvt = 1; /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d)*/\r
+ \r
+ uint8_t led_en_idac_pre = 2; /* 0 = 8clk ; 1 = 16clk ; 2 = 32clk ; 3 = 64clk(d)*/ \r
+ \r
+ uint8_t led_en_idac = 1; /* 0 = 4clk ; 1 = 8clk ; 2 = 16clk ; 3 = 32clk(d)*/ \r
+ \r
+ uint8_t led_on_time = 2; /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+ 4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+ \r
+ hx3695_delay_ms(10); \r
+ \r
+ hx3695_write_reg(0X2a, (uint8_t)prf_clk_num); // prf bit<7:0>6\r
+ hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+ hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16> \r
+ \r
+ hx3695_write_reg(0X25, (afe_rst_cnvt<<4| led_en_idac_pre<<2|led_en_idac)); \r
+ hx3695_write_reg(0X2d, phase7_8_internal); \r
+ hx3695_write_reg(0X2e, 0x33);// gpio ctrl \r
+ hx3695_write_reg(0X2f, ((afe_reset<<4)| init_wait_delay));\r
+ hx3695_write_reg(0X30, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+ hx3695_write_reg(0X72, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+\r
+\r
+ hx3695_write_reg(0X31, (led_on_time<<4| 0x00));\r
+ hx3695_write_reg(0X33, 0x83);// Öжϼ«ÐÔ¼°¿í¶ÈÅäÖã»\r
+ hx3695_write_reg(0X34, 0x00);// ÖжÏÌØÊâÅäÖã»\r
+ hx3695_write_reg(0X36, 0x00);// phase data ready ±êÖ¾ÉèÖã»\r
+ hx3695_write_reg(0X38, 0x00);\r
+ \r
+ hx3695_write_reg(0X3a, (phase1_inner_avg | (phase2_inner_avg<<4))); \r
+ hx3695_write_reg(0X3b, (phase3_inner_avg | (phase4_inner_avg<<4))); \r
+ hx3695_write_reg(0X3c, (phase5_inner_avg | (phase6_inner_avg<<4))); \r
+ hx3695_write_reg(0X3d, (phase7_inner_avg | (phase8_inner_avg<<4))); \r
+ hx3695_write_reg(0X3e, adc_rst_post_num<<6 | samp_delay_leden_num<<4 | samp_copy_avg); \r
+ hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+ \r
+ hx3695_write_reg(0X43, phase1_mux_sel); \r
+ hx3695_write_reg(0X44, phase1_tia_cap<<4|phase1_tia_res); \r
+ hx3695_write_reg(0X45, phase1_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase1_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase1_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase1_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+\r
+ hx3695_write_reg(0X49, phase1_ad_inr_ctrl<<4|phase1_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase1_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase1_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase1_dsp_mov_avg_num | phase1_dsp_iir_lp_coeff<<4);\r
+\r
+// hx3695_write_reg(0X4e, thred_value);\r
+// hx3695_write_reg(0X4f, thred_value>>5);\r
+ \r
+ hx3695_write_reg(0X43, phase2_mux_sel); \r
+ hx3695_write_reg(0X44, phase2_tia_cap<<4|phase2_tia_res); \r
+ hx3695_write_reg(0X45, phase2_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase2_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase2_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase2_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase2_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase2_ad_inr_ctrl<<4|phase2_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase2_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase2_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase2_dsp_mov_avg_num | phase2_dsp_iir_lp_coeff<<4);\r
+ \r
+//phase3 sel\r
+\r
+ hx3695_write_reg(0X43, phase3_mux_sel); \r
+ hx3695_write_reg(0X44, phase3_tia_cap<<4|phase3_tia_res); \r
+ hx3695_write_reg(0X45, phase3_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase3_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase3_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase3_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase3_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase3_ad_inr_ctrl<<4|phase3_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase3_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase3_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase3_dsp_mov_avg_num | phase3_dsp_iir_lp_coeff<<4);\r
+ \r
+//phase4 sel\r
+\r
+ hx3695_write_reg(0X43, phase4_mux_sel); \r
+ hx3695_write_reg(0X44, phase4_tia_cap<<4|phase4_tia_res); \r
+ hx3695_write_reg(0X45, phase4_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase4_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase4_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase4_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase4_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase4_ad_inr_ctrl<<4|phase4_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase4_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase4_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase4_dsp_mov_avg_num | phase4_dsp_iir_lp_coeff<<4);\r
+\r
+ hx3695_write_reg(0X43, phase5_mux_sel); \r
+ hx3695_write_reg(0X44, phase5_tia_cap<<4|phase5_tia_res); \r
+ hx3695_write_reg(0X45, phase5_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase5_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase5_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase5_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase5_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase5_ad_inr_ctrl<<4|phase5_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase5_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase5_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase5_dsp_mov_avg_num | phase5_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase6_mux_sel); \r
+ hx3695_write_reg(0X44, phase6_tia_cap<<4|phase6_tia_res); \r
+ hx3695_write_reg(0X45, phase6_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase6_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase6_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase6_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase6_ad_inr_ctrl<<4|phase6_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase6_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase6_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase6_dsp_mov_avg_num | phase6_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase7_mux_sel); \r
+ hx3695_write_reg(0X44, phase7_tia_cap<<4|phase7_tia_res); \r
+ hx3695_write_reg(0X45, phase7_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase7_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase7_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase7_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase7_ad_inr_ctrl<<4|phase7_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase7_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase7_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase7_dsp_mov_avg_num | phase7_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase8_mux_sel); \r
+ hx3695_write_reg(0X44, phase8_tia_cap<<4|phase8_tia_res); \r
+ hx3695_write_reg(0X45, phase8_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase8_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase8_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase8_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase8_led_offset_idac);\r
+// hx3695_write_reg(0X48, phas8_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase8_ad_inr_ctrl<<4|phase8_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase8_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase8_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase8_dsp_mov_avg_num | phase8_dsp_iir_lp_coeff<<4);\r
+ \r
+\r
+// analog circuit cfg \r
+ hx3695_write_reg(0X60, 0x14); //\r
+ hx3695_write_reg(0X61, 0xf0); \r
+ hx3695_write_reg(0X62, 0x22); \r
+ hx3695_write_reg(0X63, 0x15); \r
+ \r
+ hx3695_write_reg(0X64, 0x08); \r
+ hx3695_write_reg(0X65, 0x88); //bug\r
+ \r
+ hx3695_write_reg(0X66, 0x30); // bits<3>=adc selftest en 0x30\r
+ hx3695_write_reg(0X67, 0x23); \r
+ hx3695_write_reg(0X68, 0x46); \r
+ hx3695_write_reg(0X69, 0x42); \r
+ \r
+ hx3695_write_reg(0X39, 0xff); // ofset idac1 phase enable cfg\r
+ hx3695_write_reg(0x73, 0xff); //led_offset_idac phase enable\r
+ \r
+ hx3695_write_reg(0X6a, 0X0f); \r
+ hx3695_write_reg(0X6b, 0X22); \r
+ hx3695_write_reg(0X6c, 0X00); \r
+ hx3695_write_reg(0X6d, 0X37); \r
+ hx3695_write_reg(0X6e, 0X82); \r
+ hx3695_write_reg(0X6f, 0X08);\r
+/////////FIFO and adc conversion ready config////////\r
+/////////FIFO and adc conversion ready config////////\r
+#if defined(PPG_INT_MODE)\r
+ hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble\r
+ hx3695_write_reg(0X33, 0x83); // int width \r
+ hx3695_write_reg(0X21, 0x00); // fifo int sel,00=FIFO INT config clear\r
+ hx3695_write_reg(0X38, 0x01); // int sel,00=close almost full int,04=enable almost full int\r
+#elif defined(INT_MODE) //FIFO_ALL_MOST_FULL)\r
+ hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble\r
+ hx3695_write_reg(0X1c, (fifo_watermark&0xff)); //fifo_watermark\r
+ hx3695_write_reg(0X1d, fifo_watermark<<8); //bit<0>=fifo_watermark[8] \r
+ hx3695_write_reg(0X33, 0x83); // int width \r
+ hx3695_write_reg(0X21, 0x00); // fifo int sel,00=FIFO INT config clear\r
+ hx3695_write_reg(0X38, 0x04); // int sel,00=close almost full int,04=enable almost full int\r
+\r
+#else\r
+ hx3695_write_reg(0X1b, 0x92); // bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble \r
+ hx3695_write_reg(0X38, 0x01); // int sel,00=close almost full int,04=enable almost full int\r
+ \r
+#endif\r
+\r
+ \r
+ hx3695_write_reg(0X26,(phase1_enable<<3)|(phase1_adc_osr)|(phase2_enable<<7)|(phase2_adc_osr<<4) ); \r
+ hx3695_write_reg(0X27,(phase3_enable<<3)|(phase3_adc_osr)|(phase4_enable<<7)|(phase4_adc_osr<<4) ); \r
+ hx3695_write_reg(0X28,(phase5_enable<<3)|(phase5_adc_osr)|(phase6_enable<<7)|(phase6_adc_osr<<4) );\r
+ hx3695_write_reg(0X29,(phase7_enable<<3)|(phase7_adc_osr)|(phase8_enable<<7)|(phase8_adc_osr<<4) ); \r
+\r
+// hx3695_write_reg(0X5c, 0x02);//soft reset\r
+ hx3695_delay_ms(5); \r
+ hx3695_write_reg(0X5c, 0x00);//release\r
+ read_fifo_first_flg = 1;\r
+ return ;\r
+}\r
+#endif\r
+\r
+#ifdef SPO2_ALG_LIB\r
+// ѪÑõģʽÏ ³õʼ»¯ÅäÖÃ\r
+void hx3695_spo2_ppg_init(void) //20200615 ericy ppg fs=25hz, phase3 conversion ready interupt en\r
+{\r
+ uint16_t sample_rate = 25; /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+ uint32_t prf_clk_num = 32000/sample_rate; /*period in clk num, num = Fclk/fs */\r
+ \r
+// uint16_t fifo_watermark= 250 ;\r
+ uint8_t adc_rst_post_num=0; /* 00=16,01=32,10=64,11=128*/ \r
+ uint8_t samp_delay_leden_num = 0; /* 00=8,01=16,10=32,11=64*/ \r
+ uint8_t samp_copy_avg = 0; /* 0=1, 1=2, 2=4 ,3=8, 4=16*/\r
+ uint8_t data_avg_num = 0; /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+ uint8_t phase7_8_internal = 0; /* phase7 and phase8 prf internal cfg */\r
+ \r
+// uint16_t thred_value = 32500;\r
+ \r
+ uint8_t phase1_enable = 1; /*phase1_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase2_enable = 1; /*phase2_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase3_enable = 1; /*phase3_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase4_enable = 1; /*phase4_enable , 1 mean enable ; 0 mean disable */\r
+ uint8_t phase5_enable = 1; /*phase5_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase6_enable = 1; /*phase6_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase7_enable = 1; /*phase7_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase8_enable = 1; /*phase8_enable , 1 mean enable ; 0 mean disable */ \r
+\r
+ uint8_t phase1_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase2_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase3_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase4_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase5_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase6_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase7_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase8_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ \r
+ uint8_t phase1_mux_sel = 0; /* sel phase1*/\r
+ uint8_t phase2_mux_sel = 1; /* sel phase2*/\r
+ uint8_t phase3_mux_sel = 2; /* sel phase3*/\r
+ uint8_t phase4_mux_sel = 3; /* sel phase4*/\r
+ uint8_t phase5_mux_sel = 4; /* sel phase5*/\r
+ uint8_t phase6_mux_sel = 5; /* sel phase6*/\r
+ uint8_t phase7_mux_sel = 6; /* sel phase7*/\r
+ uint8_t phase8_mux_sel = 7; /* sel phase8*/\r
+ \r
+\r
+ uint8_t phase1_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase1_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase1_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase1_led_drv1_cha_sel = 0; /* 1 = ldr1 NG; 2 = ldr2 GR; 4 = ldr3 IR; 8 = ldr4 RED; */\r
+ uint8_t phase1_led_drv2_cha_sel = 0; /*ldr5:0x20 ldr6: 0x40 red ldr8 0x80 ir */\r
+ uint8_t phase1_pd_sel = 0x08; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase1_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase1_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase1_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase1_ldr2_cur = 0;\r
+// uint8_t phase1_of_idac1_cur = 0;\r
+// uint8_t phase1_of_idac2_cur = 0;\r
+ uint8_t phase1_ad_inr_ctrl = 3;\r
+ uint8_t phase1_ad_of_idac_ctrl = 0;\r
+// uint8_t afe_offset = 0;\r
+ uint8_t phase1_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase1_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase1_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+\r
+\r
+ uint8_t phase2_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase2_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase2_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase2_led_drv1_cha_sel = 0X10; //GREEN_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase2_led_drv2_cha_sel = 0x00;\r
+ uint8_t phase2_pd_sel = 0x08; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase2_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase2_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase2_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase2_ldr2_cur = 0;\r
+// uint8_t phase2_of_idac1_cur = 0;\r
+// uint8_t phase2_of_idac2_cur = 0;\r
+ uint8_t phase2_ad_inr_ctrl = 3;\r
+ uint8_t phase2_ad_of_idac_ctrl = 0;\r
+// uint8_t phase2_afe_offset = 0;\r
+ uint8_t phase2_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase2_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase2_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ \r
+ uint8_t phase3_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase3_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase3_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase3_led_drv1_cha_sel = 0; //RED_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase3_led_drv2_cha_sel = 0;\r
+ uint8_t phase3_pd_sel = 0x08; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase3_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase3_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase3_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase3_ldr2_cur = 0;\r
+// uint8_t phase3_of_idac1_cur = 0;\r
+// uint8_t phase3_of_idac2_cur = 0;\r
+ uint8_t phase3_ad_inr_ctrl = 3;\r
+ uint8_t phase3_ad_of_idac_ctrl = 0;\r
+// uint8_t phase3_afe_offset = 0;\r
+ uint8_t phase3_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase3_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase3_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ \r
+ uint8_t phase4_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase4_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase4_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase4_led_drv1_cha_sel = 0x20; //IR_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase4_led_drv2_cha_sel = 0;\r
+ uint8_t phase4_pd_sel = 0x08; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase4_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase4_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase4_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase4_ldr2_cur = 0;\r
+// uint8_t phase4_of_idac1_cur = 0;\r
+// uint8_t phase4_of_idac2_cur = 0;\r
+ uint8_t phase4_ad_inr_ctrl = 3;\r
+ uint8_t phase4_ad_of_idac_ctrl = 0;\r
+// uint8_t phase4_afe_offset = 0;\r
+ uint8_t phase4_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase4_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase4_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase5_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase5_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase5_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase5_led_drv1_cha_sel = 0x00; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase5_led_drv2_cha_sel = 0;\r
+ uint8_t phase5_pd_sel = 0x08; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase5_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase5_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase5_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase5_ldr2_cur = 0;\r
+// uint8_t phase5_of_idac1_cur = 0;\r
+// uint8_t phase5_of_idac2_cur = 0;\r
+ uint8_t phase5_ad_inr_ctrl = 3;\r
+ uint8_t phase5_ad_of_idac_ctrl = 0;\r
+// uint8_t phase5_afe_offset = 0;\r
+ uint8_t phase5_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase5_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase5_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase6_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase6_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase6_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase6_led_drv1_cha_sel = 0x40; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase6_led_drv2_cha_sel = 0;\r
+ uint8_t phase6_pd_sel = 0x08; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase6_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase6_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase6_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase6_ldr2_cur = 0;\r
+// uint8_t phase6_of_idac1_cur = 0;\r
+// uint8_t phase6_of_idac2_cur = 0;\r
+ uint8_t phase6_ad_inr_ctrl = 3;\r
+ uint8_t phase6_ad_of_idac_ctrl = 0;\r
+// uint8_t phase6_afe_offset = 0;\r
+ uint8_t phase6_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase6_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase6_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase7_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase7_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase7_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase7_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase7_led_drv2_cha_sel = 0;\r
+ uint8_t phase7_pd_sel = 0x08; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase7_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase7_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase7_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase7_ldr2_cur = 0;\r
+// uint8_t phase7_of_idac1_cur = 0;\r
+// uint8_t phase7_of_idac2_cur = 0;\r
+ uint8_t phase7_ad_inr_ctrl = 3;\r
+ uint8_t phase7_ad_of_idac_ctrl = 0;\r
+// uint8_t phase7_afe_offset = 0;\r
+ uint8_t phase7_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase7_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase7_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase8_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase8_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase8_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase8_led_drv1_cha_sel = 0x40; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase8_led_drv2_cha_sel = 0;\r
+ uint8_t phase8_pd_sel = 0x08; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase8_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase8_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase8_ldr1_cur = 20; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase8_ldr2_cur = 0;\r
+// uint8_t phase8_of_idac1_cur = 0;\r
+// uint8_t phase8_of_idac2_cur = 0;\r
+ uint8_t phase8_ad_inr_ctrl = 3;\r
+ uint8_t phase8_ad_of_idac_ctrl = 0;\r
+// uint8_t phase8_afe_offset = 0;\r
+ uint8_t phase8_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase8_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase8_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t init_wait_delay = 4 ; /* 0 = 31clk ; 1 = 64clk ; 2 = 127clk ; 3 = 255clk(d) ;\r
+ 4 = 511clk; 5 = 1023clk; 6 = 2047; 7 = 4095clk */ \r
+ \r
+ uint8_t afe_reset = 3; /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d) ;\r
+ 4 = 255clk; 5 = 511clk; 6 = 1024; 7 = 2047clk */\r
+ \r
+ uint8_t afe_rst_cnvt = 1; /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d)*/\r
+ \r
+ uint8_t led_en_idac_pre = 2; /* 0 = 8clk ; 1 = 16clk ; 2 = 32clk ; 3 = 64clk(d)*/ \r
+ \r
+ uint8_t led_en_idac = 1; /* 0 = 4clk ; 1 = 8clk ; 2 = 16clk ; 3 = 32clk(d)*/ \r
+ \r
+ uint8_t led_on_time = 2; /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+ 4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+ \r
+ hx3695_delay_ms(10); \r
+ \r
+ hx3695_write_reg(0X2a, (uint8_t)prf_clk_num); // prf bit<7:0>6\r
+ hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+ hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16> \r
+ \r
+ hx3695_write_reg(0X25, (afe_rst_cnvt<<4| led_en_idac_pre<<2|led_en_idac)); \r
+ hx3695_write_reg(0X2d, phase7_8_internal); \r
+ hx3695_write_reg(0X2e, 0x33);// gpio ctrl \r
+ hx3695_write_reg(0X2f, ((afe_reset<<4)| init_wait_delay));\r
+ hx3695_write_reg(0X30, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+ hx3695_write_reg(0X72, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+\r
+\r
+ hx3695_write_reg(0X31, (led_on_time<<4| 0x00));\r
+ hx3695_write_reg(0X33, 0x83);// Öжϼ«ÐÔ¼°¿í¶ÈÅäÖã»\r
+ hx3695_write_reg(0X34, 0x00);// ÖжÏÌØÊâÅäÖã»\r
+ hx3695_write_reg(0X36, 0x00);// phase data ready ±êÖ¾ÉèÖã»\r
+ hx3695_write_reg(0X38, 0x00);\r
+ \r
+ hx3695_write_reg(0X3a, (phase1_inner_avg | (phase2_inner_avg<<4))); \r
+ hx3695_write_reg(0X3b, (phase3_inner_avg | (phase4_inner_avg<<4))); \r
+ hx3695_write_reg(0X3c, (phase5_inner_avg | (phase6_inner_avg<<4))); \r
+ hx3695_write_reg(0X3d, (phase7_inner_avg | (phase8_inner_avg<<4))); \r
+ hx3695_write_reg(0X3e, adc_rst_post_num<<6 | samp_delay_leden_num<<4 | samp_copy_avg); \r
+ hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+ \r
+ hx3695_write_reg(0X43, phase1_mux_sel); \r
+ hx3695_write_reg(0X44, phase1_tia_cap<<4|phase1_tia_res); \r
+ hx3695_write_reg(0X45, phase1_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase1_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase1_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase1_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase1_ad_inr_ctrl<<4|phase1_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase1_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase1_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase1_dsp_mov_avg_num | phase1_dsp_iir_lp_coeff<<4);\r
+\r
+ \r
+ hx3695_write_reg(0X43, phase2_mux_sel); \r
+ hx3695_write_reg(0X44, phase2_tia_cap<<4|phase2_tia_res); \r
+ hx3695_write_reg(0X45, phase2_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase2_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase2_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase2_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase2_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase2_ad_inr_ctrl<<4|phase2_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase2_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase2_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase2_dsp_mov_avg_num | phase2_dsp_iir_lp_coeff<<4);\r
+ \r
+//phase3 sel\r
+\r
+ hx3695_write_reg(0X43, phase3_mux_sel); \r
+ hx3695_write_reg(0X44, phase3_tia_cap<<4|phase3_tia_res); \r
+ hx3695_write_reg(0X45, phase3_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase3_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase3_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase3_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase3_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase3_ad_inr_ctrl<<4|phase3_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase3_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase3_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase3_dsp_mov_avg_num | phase3_dsp_iir_lp_coeff<<4);\r
+ \r
+//phase4 sel\r
+\r
+ hx3695_write_reg(0X43, phase4_mux_sel); \r
+ hx3695_write_reg(0X44, phase4_tia_cap<<4|phase4_tia_res); \r
+ hx3695_write_reg(0X45, phase4_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase4_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase4_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase4_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase4_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase4_ad_inr_ctrl<<4|phase4_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase4_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase4_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase4_dsp_mov_avg_num | phase4_dsp_iir_lp_coeff<<4);\r
+\r
+ hx3695_write_reg(0X43, phase5_mux_sel); \r
+ hx3695_write_reg(0X44, phase5_tia_cap<<4|phase5_tia_res); \r
+ hx3695_write_reg(0X45, phase5_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase5_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase5_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase5_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase5_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase5_ad_inr_ctrl<<4|phase5_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase5_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase5_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase5_dsp_mov_avg_num | phase5_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase6_mux_sel); \r
+ hx3695_write_reg(0X44, phase6_tia_cap<<4|phase6_tia_res); \r
+ hx3695_write_reg(0X45, phase6_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase6_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase6_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase6_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase6_ad_inr_ctrl<<4|phase6_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase6_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase6_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase6_dsp_mov_avg_num | phase6_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase7_mux_sel); \r
+ hx3695_write_reg(0X44, phase7_tia_cap<<4|phase7_tia_res); \r
+ hx3695_write_reg(0X45, phase7_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase7_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase7_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase7_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase7_ad_inr_ctrl<<4|phase7_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase7_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase7_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase7_dsp_mov_avg_num | phase7_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase8_mux_sel); \r
+ hx3695_write_reg(0X44, phase8_tia_cap<<4|phase8_tia_res); \r
+ hx3695_write_reg(0X45, phase8_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase8_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase8_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase8_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase8_led_offset_idac);\r
+// hx3695_write_reg(0X48, phas8_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase8_ad_inr_ctrl<<4|phase8_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase8_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase8_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase8_dsp_mov_avg_num | phase8_dsp_iir_lp_coeff<<4);\r
+ \r
+\r
+// analog circuit cfg \r
+ hx3695_write_reg(0X60, 0x14); //\r
+ hx3695_write_reg(0X61, 0xf0); \r
+ hx3695_write_reg(0X62, 0x22); \r
+ hx3695_write_reg(0X63, 0x15); \r
+ \r
+ hx3695_write_reg(0X64, 0x08); \r
+ hx3695_write_reg(0X65, 0x88); //bug\r
+ \r
+ hx3695_write_reg(0X66, 0x30); // bits<3>=adc selftest en 0x30\r
+ hx3695_write_reg(0X67, 0x23); \r
+ hx3695_write_reg(0X68, 0x46); \r
+ hx3695_write_reg(0X69, 0x42); \r
+ \r
+ hx3695_write_reg(0X39, 0xff); // ofset idac1 phase enable cfg\r
+ hx3695_write_reg(0x73, 0xff); //led_offset_idac phase enable\r
+ \r
+ hx3695_write_reg(0X6a, 0X0f); \r
+ hx3695_write_reg(0X6b, 0X22); \r
+ hx3695_write_reg(0X6c, 0X00); \r
+ hx3695_write_reg(0X6d, 0X37); \r
+ hx3695_write_reg(0X6e, 0X82); \r
+ hx3695_write_reg(0X6f, 0X08);\r
+/////////FIFO and adc conversion ready config////////\r
+/////////FIFO and adc conversion ready config////////\r
+#if defined(PPG_INT_MODE)\r
+ hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble\r
+ hx3695_write_reg(0X33, 0x83); // int width \r
+ hx3695_write_reg(0X21, 0x00); // fifo int sel,00=FIFO INT config clear\r
+ hx3695_write_reg(0X38, 0x08); // int sel,00=close almost full int,04=enable almost full int\r
+#elif defined(INT_MODE) //(FIFO_ALL_MOST_FULL)\r
+ hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble\r
+ hx3695_write_reg(0X1c, (fifo_watermark&0xff)); //fifo_watermark\r
+ hx3695_write_reg(0X1d, fifo_watermark<<8); //bit<0>=fifo_watermark[8] \r
+ hx3695_write_reg(0X33, 0x83); // int width \r
+ hx3695_write_reg(0X38, 0x04); // int sel,00=close almost full int,04=enable almost full int\r
+\r
+#else\r
+ hx3695_write_reg(0X1b, 0x91);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble \r
+ hx3695_write_reg(0X36, 0x00); \r
+ \r
+ hx3695_write_reg(0X38, 0x00); // int sel,00=close almost full int,01= prf int 04=enable almost full int\r
+\r
+#endif\r
+\r
+ \r
+ hx3695_write_reg(0X26,(phase1_enable<<3)|(phase1_adc_osr)|(phase2_enable<<7)|(phase2_adc_osr<<4) ); \r
+ hx3695_write_reg(0X27,(phase3_enable<<3)|(phase3_adc_osr)|(phase4_enable<<7)|(phase4_adc_osr<<4) ); \r
+ hx3695_write_reg(0X28,(phase5_enable<<3)|(phase5_adc_osr)|(phase6_enable<<7)|(phase6_adc_osr<<4) );\r
+ hx3695_write_reg(0X29,(phase7_enable<<3)|(phase7_adc_osr)|(phase8_enable<<7)|(phase8_adc_osr<<4) ); \r
+\r
+ hx3695_write_reg(0X5c, 0x02);//soft reset\r
+ hx3695_delay_ms(5); \r
+ hx3695_write_reg(0X5c, 0x00);//release\r
+// uint8_t fifo_data_temp[3] = {0};\r
+// hx3695_brust_read_reg(0x22, fifo_data_temp, 3); \r
+ read_fifo_first_flg = 1;\r
+ return ;\r
+\r
+}\r
+#endif\r
+\r
+#ifdef HRV_ALG_LIB\r
+// HRVģʽÏ ³õʼ»¯ÅäÖÃ\r
+void hx3695_hrv_ppg_init(void) //20200615 ericy ppg fs=25hz, phase3 conversion ready interupt en\r
+{\r
+ uint16_t sample_rate = 125; /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+ uint32_t prf_clk_num = 32000/sample_rate; /*period in clk num, num = Fclk/fs */\r
+ \r
+;\r
+ uint8_t adc_rst_post_num=0; /* 00=16,01=32,10=64,11=128*/ \r
+ uint8_t samp_delay_leden_num = 0; /* 00=8,01=16,10=32,11=64*/ \r
+ uint8_t samp_copy_avg = 0; /* 0=1, 1=2, 2=4 ,3=8, 4=16*/\r
+ uint8_t data_avg_num = 0; /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+ uint8_t phase7_8_internal = 0; /* phase7 and phase8 prf internal cfg */\r
+ \r
+ uint8_t phase1_enable = 1; /*phase1_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase2_enable = 1; /*phase2_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase3_enable = 1; /*phase3_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase4_enable = 1; /*phase4_enable , 1 mean enable ; 0 mean disable */\r
+ uint8_t phase5_enable = 0; /*phase5_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase6_enable = 0; /*phase6_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase7_enable = 0; /*phase7_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase8_enable = 0; /*phase8_enable , 1 mean enable ; 0 mean disable */ \r
+\r
+ uint8_t phase1_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase2_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase3_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase4_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase5_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase6_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase7_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase8_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ \r
+ uint8_t phase1_mux_sel = 0; /* sel phase1*/\r
+ uint8_t phase2_mux_sel = 1; /* sel phase2*/\r
+ uint8_t phase3_mux_sel = 2; /* sel phase3*/\r
+ uint8_t phase4_mux_sel = 3; /* sel phase4*/\r
+ uint8_t phase5_mux_sel = 4; /* sel phase5*/\r
+ uint8_t phase6_mux_sel = 5; /* sel phase6*/\r
+ uint8_t phase7_mux_sel = 6; /* sel phase7*/\r
+ uint8_t phase8_mux_sel = 7; /* sel phase8*/\r
+ \r
+\r
+ uint8_t phase1_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase1_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase1_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase1_led_drv1_cha_sel = 0X10; /* 1 = ldr1 NG; 2 = ldr2 GR; 4 = ldr3 IR; 8 = ldr4 RED; */\r
+ uint8_t phase1_led_drv2_cha_sel = 0; /*ldr5:0x20 ldr6: 0x40 red ldr8 0x80 ir */\r
+ uint8_t phase1_pd_sel = 0x0a; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase1_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase1_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase1_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase1_ldr2_cur = 0;\r
+// uint8_t phase1_of_idac1_cur = 0;\r
+// uint8_t phase1_of_idac2_cur = 0;\r
+ uint8_t phase1_ad_inr_ctrl = 3;\r
+ uint8_t phase1_ad_of_idac_ctrl = 0;\r
+// uint8_t afe_offset = 0;\r
+ uint8_t phase1_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase1_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase1_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+\r
+\r
+ uint8_t phase2_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase2_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase2_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase2_led_drv1_cha_sel = 0; //GREEN_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase2_led_drv2_cha_sel = 0;\r
+ uint8_t phase2_pd_sel = 0x0a; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase2_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase2_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase2_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase2_ldr2_cur = 0;\r
+// uint8_t phase2_of_idac1_cur = 0;\r
+// uint8_t phase2_of_idac2_cur = 0;\r
+ uint8_t phase2_ad_inr_ctrl = 3;\r
+ uint8_t phase2_ad_of_idac_ctrl = 0;\r
+// uint8_t phase2_afe_offset = 0;\r
+ uint8_t phase2_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase2_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase2_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ \r
+ uint8_t phase3_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase3_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase3_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase3_led_drv1_cha_sel = 0x40; //RED_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase3_led_drv2_cha_sel = 0;\r
+ uint8_t phase3_pd_sel = 0x0a; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase3_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase3_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase3_ldr1_cur = 15; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase3_ldr2_cur = 0;\r
+// uint8_t phase3_of_idac1_cur = 0;\r
+// uint8_t phase3_of_idac2_cur = 0;\r
+ uint8_t phase3_ad_inr_ctrl = 3;\r
+ uint8_t phase3_ad_of_idac_ctrl = 0;\r
+// uint8_t phase3_afe_offset = 0;\r
+ uint8_t phase3_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase3_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase3_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ \r
+ uint8_t phase4_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase4_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase4_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase4_led_drv1_cha_sel = 0; //IR_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase4_led_drv2_cha_sel = 0;\r
+ uint8_t phase4_pd_sel = 0x0a; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase4_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase4_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase4_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase4_ldr2_cur = 0;\r
+// uint8_t phase4_of_idac1_cur = 0;\r
+// uint8_t phase4_of_idac2_cur = 0;\r
+ uint8_t phase4_ad_inr_ctrl = 3;\r
+ uint8_t phase4_ad_of_idac_ctrl = 0;\r
+// uint8_t phase4_afe_offset = 0;\r
+ uint8_t phase4_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase4_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase4_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase5_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase5_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase5_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase5_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase5_led_drv2_cha_sel = 0;\r
+ uint8_t phase5_pd_sel = 0x0a; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase5_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase5_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase5_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase5_ldr2_cur = 0;\r
+// uint8_t phase5_of_idac1_cur = 0;\r
+// uint8_t phase5_of_idac2_cur = 0;\r
+ uint8_t phase5_ad_inr_ctrl = 3;\r
+ uint8_t phase5_ad_of_idac_ctrl = 0;\r
+// uint8_t phase5_afe_offset = 0;\r
+ uint8_t phase5_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase5_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase5_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase6_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase6_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase6_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase6_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase6_led_drv2_cha_sel = 0;\r
+ uint8_t phase6_pd_sel = 0x0a; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase6_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase6_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase6_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase6_ldr2_cur = 0;\r
+// uint8_t phase6_of_idac1_cur = 0;\r
+// uint8_t phase6_of_idac2_cur = 0;\r
+ uint8_t phase6_ad_inr_ctrl = 3;\r
+ uint8_t phase6_ad_of_idac_ctrl = 0;\r
+// uint8_t phase6_afe_offset = 0;\r
+ uint8_t phase6_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase6_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase6_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase7_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase7_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase7_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase7_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase7_led_drv2_cha_sel = 0;\r
+ uint8_t phase7_pd_sel = 0x0a; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase7_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase7_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase7_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase7_ldr2_cur = 0;\r
+// uint8_t phase7_of_idac1_cur = 0;\r
+// uint8_t phase7_of_idac2_cur = 0;\r
+ uint8_t phase7_ad_inr_ctrl = 3;\r
+ uint8_t phase7_ad_of_idac_ctrl = 0;\r
+// uint8_t phase7_afe_offset = 0;\r
+ uint8_t phase7_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase7_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase7_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase8_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase8_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase8_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase8_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase8_led_drv2_cha_sel = 0;\r
+ uint8_t phase8_pd_sel = 0x0a; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase8_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase8_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase8_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase8_ldr2_cur = 0;\r
+// uint8_t phase8_of_idac1_cur = 0;\r
+// uint8_t phase8_of_idac2_cur = 0;\r
+ uint8_t phase8_ad_inr_ctrl = 3;\r
+ uint8_t phase8_ad_of_idac_ctrl = 0;\r
+// uint8_t phase8_afe_offset = 0;\r
+ uint8_t phase8_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase8_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase8_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t init_wait_delay = 4 ; /* 0 = 31clk ; 1 = 64clk ; 2 = 127clk ; 3 = 255clk(d) ;\r
+ 4 = 511clk; 5 = 1023clk; 6 = 2047; 7 = 4095clk */ \r
+ \r
+ uint8_t afe_reset = 3; /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d) ;\r
+ 4 = 255clk; 5 = 511clk; 6 = 1024; 7 = 2047clk */\r
+ \r
+ uint8_t afe_rst_cnvt = 1; /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d)*/\r
+ \r
+ uint8_t led_en_idac_pre = 2; /* 0 = 8clk ; 1 = 16clk ; 2 = 32clk ; 3 = 64clk(d)*/ \r
+ \r
+ uint8_t led_en_idac = 1; /* 0 = 4clk ; 1 = 8clk ; 2 = 16clk ; 3 = 32clk(d)*/ \r
+ \r
+ uint8_t led_on_time = 2; /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+ 4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+ \r
+ hx3695_delay_ms(10); \r
+ \r
+ hx3695_write_reg(0X2a, (uint8_t)prf_clk_num); // prf bit<7:0>6\r
+ hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+ hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16> \r
+ \r
+ hx3695_write_reg(0X25, (afe_rst_cnvt<<4| led_en_idac_pre<<2|led_en_idac)); \r
+ hx3695_write_reg(0X2d, phase7_8_internal); \r
+ hx3695_write_reg(0X2e, 0x33);// gpio ctrl \r
+ hx3695_write_reg(0X2f, ((afe_reset<<4)| init_wait_delay));\r
+ hx3695_write_reg(0X30, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+ hx3695_write_reg(0X72, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+\r
+\r
+ hx3695_write_reg(0X31, (led_on_time<<4| 0x00));\r
+ hx3695_write_reg(0X33, 0x83);// Öжϼ«ÐÔ¼°¿í¶ÈÅäÖã»\r
+ hx3695_write_reg(0X34, 0x00);// ÖжÏÌØÊâÅäÖã»\r
+ hx3695_write_reg(0X36, 0x00);// phase data ready ±êÖ¾ÉèÖã»\r
+ hx3695_write_reg(0X38, 0x00);\r
+ \r
+ hx3695_write_reg(0X3a, (phase1_inner_avg | (phase2_inner_avg<<4))); \r
+ hx3695_write_reg(0X3b, (phase3_inner_avg | (phase4_inner_avg<<4))); \r
+ hx3695_write_reg(0X3c, (phase5_inner_avg | (phase6_inner_avg<<4))); \r
+ hx3695_write_reg(0X3d, (phase7_inner_avg | (phase8_inner_avg<<4))); \r
+ hx3695_write_reg(0X3e, adc_rst_post_num<<6 | samp_delay_leden_num<<4 | samp_copy_avg); \r
+ hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+ \r
+ hx3695_write_reg(0X43, phase1_mux_sel); \r
+ hx3695_write_reg(0X44, phase1_tia_cap<<4|phase1_tia_res); \r
+ hx3695_write_reg(0X45, phase1_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase1_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase1_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase1_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase1_ad_inr_ctrl<<4|phase1_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase1_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase1_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase1_dsp_mov_avg_num | phase1_dsp_iir_lp_coeff<<4);\r
+\r
+ \r
+ hx3695_write_reg(0X43, phase2_mux_sel); \r
+ hx3695_write_reg(0X44, phase2_tia_cap<<4|phase2_tia_res); \r
+ hx3695_write_reg(0X45, phase2_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase2_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase2_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase2_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase2_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase2_ad_inr_ctrl<<4|phase2_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase2_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase2_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase2_dsp_mov_avg_num | phase2_dsp_iir_lp_coeff<<4);\r
+ \r
+//phase3 sel\r
+\r
+ hx3695_write_reg(0X43, phase3_mux_sel); \r
+ hx3695_write_reg(0X44, phase3_tia_cap<<4|phase3_tia_res); \r
+ hx3695_write_reg(0X45, phase3_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase3_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase3_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase3_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase3_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase3_ad_inr_ctrl<<4|phase3_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase3_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase3_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase3_dsp_mov_avg_num | phase3_dsp_iir_lp_coeff<<4);\r
+ \r
+//phase4 sel\r
+\r
+ hx3695_write_reg(0X43, phase4_mux_sel); \r
+ hx3695_write_reg(0X44, phase4_tia_cap<<4|phase4_tia_res); \r
+ hx3695_write_reg(0X45, phase4_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase4_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase4_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase4_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase4_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase4_ad_inr_ctrl<<4|phase4_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase4_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase4_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase4_dsp_mov_avg_num | phase4_dsp_iir_lp_coeff<<4);\r
+\r
+ hx3695_write_reg(0X43, phase5_mux_sel); \r
+ hx3695_write_reg(0X44, phase5_tia_cap<<4|phase5_tia_res); \r
+ hx3695_write_reg(0X45, phase5_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase5_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase5_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase5_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase5_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase5_ad_inr_ctrl<<4|phase5_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase5_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase5_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase5_dsp_mov_avg_num | phase5_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase6_mux_sel); \r
+ hx3695_write_reg(0X44, phase6_tia_cap<<4|phase6_tia_res); \r
+ hx3695_write_reg(0X45, phase6_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase6_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase6_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase6_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase6_ad_inr_ctrl<<4|phase6_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase6_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase6_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase6_dsp_mov_avg_num | phase6_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase7_mux_sel); \r
+ hx3695_write_reg(0X44, phase7_tia_cap<<4|phase7_tia_res); \r
+ hx3695_write_reg(0X45, phase7_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase7_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase7_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase7_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase7_ad_inr_ctrl<<4|phase7_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase7_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase7_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase7_dsp_mov_avg_num | phase7_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase8_mux_sel); \r
+ hx3695_write_reg(0X44, phase8_tia_cap<<4|phase8_tia_res); \r
+ hx3695_write_reg(0X45, phase8_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase8_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase8_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase8_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase8_led_offset_idac);\r
+// hx3695_write_reg(0X48, phas8_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase8_ad_inr_ctrl<<4|phase8_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase8_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase8_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase8_dsp_mov_avg_num | phase8_dsp_iir_lp_coeff<<4);\r
+ \r
+\r
+// analog circuit cfg \r
+ hx3695_write_reg(0X60, 0x14); //\r
+ hx3695_write_reg(0X61, 0xf0); \r
+ hx3695_write_reg(0X62, 0x22); \r
+ hx3695_write_reg(0X63, 0x15); \r
+ \r
+ hx3695_write_reg(0X64, 0x08); \r
+ hx3695_write_reg(0X65, 0x88); //bug\r
+ \r
+ hx3695_write_reg(0X66, 0x30); // bits<3>=adc selftest en 0x30\r
+ hx3695_write_reg(0X67, 0x23); \r
+ hx3695_write_reg(0X68, 0x46); \r
+ hx3695_write_reg(0X69, 0x42); \r
+ \r
+ hx3695_write_reg(0X39, 0xff); // ofset idac1 phase enable cfg\r
+ hx3695_write_reg(0x73, 0xff); //led_offset_idac phase enable\r
+ \r
+ hx3695_write_reg(0X6a, 0X0f); \r
+ hx3695_write_reg(0X6b, 0X22); \r
+ hx3695_write_reg(0X6c, 0X00); \r
+ hx3695_write_reg(0X6d, 0X37); \r
+ hx3695_write_reg(0X6e, 0X82); \r
+ hx3695_write_reg(0X6f, 0X08);\r
+/////////FIFO and adc conversion ready config////////\r
+/////////FIFO and adc conversion ready config////////\r
+#if defined(PPG_INT_MODE)\r
+ hx3695_write_reg(0X1b, 0x00);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble\r
+ hx3695_write_reg(0X33, 0x83); // int width \r
+ hx3695_write_reg(0X21, 0x00); // fifo int sel,00=FIFO INT config clear\r
+ hx3695_write_reg(0X38, 0x08); // int sel,00=close almost full int,04=enable almost full int\r
+#elif defined(INT_MODE) //(FIFO_ALL_MOST_FULL)\r
+ hx3695_write_reg(0X1b, 0x90);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble\r
+ hx3695_write_reg(0X1c, (fifo_watermark&0xff)); //fifo_watermark\r
+ hx3695_write_reg(0X1d, fifo_watermark<<8); //bit<0>=fifo_watermark[8] \r
+ hx3695_write_reg(0X33, 0x83); // int width \r
+ hx3695_write_reg(0X38, 0x04); // int sel,00=close almost full int,04=enable almost full int\r
+\r
+#else\r
+ hx3695_write_reg(0X1b, 0x90);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble \r
+ hx3695_write_reg(0X36, 0x00); \r
+ \r
+ hx3695_write_reg(0X38, 0x00); // int sel,00=close almost full int,01= prf int 04=enable almost full int\r
+\r
+#endif\r
+\r
+ \r
+ hx3695_write_reg(0X26,(phase1_enable<<3)|(phase1_adc_osr)|(phase2_enable<<7)|(phase2_adc_osr<<4) ); \r
+ hx3695_write_reg(0X27,(phase3_enable<<3)|(phase3_adc_osr)|(phase4_enable<<7)|(phase4_adc_osr<<4) ); \r
+ hx3695_write_reg(0X28,(phase5_enable<<3)|(phase5_adc_osr)|(phase6_enable<<7)|(phase6_adc_osr<<4) );\r
+ hx3695_write_reg(0X29,(phase7_enable<<3)|(phase7_adc_osr)|(phase8_enable<<7)|(phase8_adc_osr<<4) ); \r
+\r
+ hx3695_write_reg(0X5c, 0x02);//soft reset\r
+ hx3695_delay_ms(5); \r
+ hx3695_write_reg(0X5c, 0x00);//release\r
+// uint8_t fifo_data_temp[3] = {0};\r
+// hx3695_brust_read_reg(0x22, fifo_data_temp, 3); \r
+ read_fifo_first_flg = 1;\r
+ return ;\r
+}\r
+#endif\r
+\r
+#ifdef CHECK_TOUCH_LIB\r
+void hx3695_check_touch_init(void) //\r
+{ \r
+ uint16_t sample_rate = 25; /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+ uint32_t prf_clk_num = 32000/sample_rate; /*period in clk num, num = Fclk/fs */\r
+ \r
+// uint16_t fifo_watermark= 250 ;\r
+ uint8_t adc_rst_post_num= 0; /* 00=16,01=32,10=64,11=128*/ \r
+ uint8_t samp_delay_leden_num = 0; /* 00=8,01=16,10=32,11=64*/ \r
+ uint8_t samp_copy_avg = 0; /* 0=1, 1=2, 2=4 ,3=8, 4=16*/\r
+ uint8_t data_avg_num = 0; /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+ uint8_t phase7_8_internal = 0; //0x18; /* phase7 and phase8 prf internal cfg */\r
+ \r
+// uint16_t thred_value = 32500;\r
+ \r
+ uint8_t phase1_enable = 0; /*phase1_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase2_enable = 0; /*phase2_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase3_enable = 0; /*phase3_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase4_enable = 0; /*phase4_enable , 1 mean enable ; 0 mean disable */\r
+ uint8_t phase5_enable = 0; /*phase5_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase6_enable = 0; /*phase6_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase7_enable = 1; /*phase7_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase8_enable = 1; /*phase8_enable , 1 mean enable ; 0 mean disable */ \r
+\r
+ uint8_t phase1_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase2_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase3_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase4_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase5_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase6_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase7_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase8_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ \r
+ uint8_t phase1_mux_sel = 0; /* sel phase1*/\r
+ uint8_t phase2_mux_sel = 1; /* sel phase2*/\r
+ uint8_t phase3_mux_sel = 2; /* sel phase3*/\r
+ uint8_t phase4_mux_sel = 3; /* sel phase4*/\r
+ uint8_t phase5_mux_sel = 4; /* sel phase5*/\r
+ uint8_t phase6_mux_sel = 5; /* sel phase6*/\r
+ uint8_t phase7_mux_sel = 6; /* sel phase7*/\r
+ uint8_t phase8_mux_sel = 7; /* sel phase8*/\r
+ \r
+\r
+ uint8_t phase1_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase1_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase1_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase1_led_drv1_cha_sel = 0; /* 1 = ldr1 NG; 2 = ldr2 GR; 4 = ldr3 IR; 8 = ldr4 RED; */\r
+ uint8_t phase1_led_drv2_cha_sel = 0; /*ldr5:0x20 ldr6: 0x40 red ldr8 0x80 ir */\r
+ uint8_t phase1_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase1_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase1_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase1_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase1_ldr2_cur = 0;\r
+// uint8_t phase1_of_idac1_cur = 0;\r
+// uint8_t phase1_of_idac2_cur = 0;\r
+ uint8_t phase1_ad_inr_ctrl = 3;\r
+ uint8_t phase1_ad_of_idac_ctrl = 0;\r
+// uint8_t afe_offset = 0;\r
+ uint8_t phase1_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase1_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase1_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+\r
+\r
+ uint8_t phase2_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase2_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase2_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase2_led_drv1_cha_sel = 0; //GREEN_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase2_led_drv2_cha_sel = 0;\r
+ uint8_t phase2_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase2_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase2_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase2_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase2_ldr2_cur = 0;\r
+// uint8_t phase2_of_idac1_cur = 0;\r
+// uint8_t phase2_of_idac2_cur = 0;\r
+ uint8_t phase2_ad_inr_ctrl = 3;\r
+ uint8_t phase2_ad_of_idac_ctrl = 0;\r
+// uint8_t phase2_afe_offset = 0;\r
+ uint8_t phase2_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase2_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase2_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ \r
+ uint8_t phase3_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase3_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase3_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase3_led_drv1_cha_sel = 0; //RED_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase3_led_drv2_cha_sel = 0;\r
+ uint8_t phase3_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase3_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase3_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase3_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase3_ldr2_cur = 0;\r
+// uint8_t phase3_of_idac1_cur = 0;\r
+// uint8_t phase3_of_idac2_cur = 0;\r
+ uint8_t phase3_ad_inr_ctrl = 3;\r
+ uint8_t phase3_ad_of_idac_ctrl = 0;\r
+// uint8_t phase3_afe_offset = 0;\r
+ uint8_t phase3_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase3_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase3_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ \r
+ uint8_t phase4_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase4_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase4_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase4_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase4_led_drv2_cha_sel = 0;\r
+ uint8_t phase4_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase4_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase4_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase4_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase4_ldr2_cur = 0;\r
+// uint8_t phase4_of_idac1_cur = 0;\r
+// uint8_t phase4_of_idac2_cur = 0;\r
+ uint8_t phase4_ad_inr_ctrl = 3;\r
+ uint8_t phase4_ad_of_idac_ctrl = 0;\r
+// uint8_t phase4_afe_offset = 0;\r
+ uint8_t phase4_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase4_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase4_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase5_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase5_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase5_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase5_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase5_led_drv2_cha_sel = 0;\r
+ uint8_t phase5_pd_sel = 4; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase5_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase5_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase5_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase5_ldr2_cur = 0;\r
+// uint8_t phase5_of_idac1_cur = 0;\r
+// uint8_t phase5_of_idac2_cur = 0;\r
+ uint8_t phase5_ad_inr_ctrl = 3;\r
+ uint8_t phase5_ad_of_idac_ctrl = 0;\r
+// uint8_t phase5_afe_offset = 0;\r
+ uint8_t phase5_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase5_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase5_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase6_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase6_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase6_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase6_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase6_led_drv2_cha_sel = 0;\r
+ uint8_t phase6_pd_sel = 4; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase6_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase6_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase6_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase6_ldr2_cur = 0;\r
+// uint8_t phase6_of_idac1_cur = 0;\r
+// uint8_t phase6_of_idac2_cur = 0;\r
+ uint8_t phase6_ad_inr_ctrl = 3;\r
+ uint8_t phase6_ad_of_idac_ctrl = 0;\r
+// uint8_t phase6_afe_offset = 0;\r
+ uint8_t phase6_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase6_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase6_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase7_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase7_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase7_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase7_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase7_led_drv2_cha_sel = 0;\r
+ uint8_t phase7_pd_sel = 0x00; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase7_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase7_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase7_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase7_ldr2_cur = 0;\r
+// uint8_t phase7_of_idac1_cur = 0;\r
+// uint8_t phase7_of_idac2_cur = 0;\r
+ uint8_t phase7_ad_inr_ctrl = 3;\r
+ uint8_t phase7_ad_of_idac_ctrl = 0;\r
+// uint8_t phase7_afe_offset = 0;\r
+ uint8_t phase7_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase7_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase7_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase8_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase8_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase8_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase8_led_drv1_cha_sel = 0x40; //IR_LED_SLE /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase8_led_drv2_cha_sel = 0;\r
+ uint8_t phase8_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase8_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase8_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase8_ldr1_cur = 20; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase8_ldr2_cur = 0;\r
+// uint8_t phase8_of_idac1_cur = 0;\r
+// uint8_t phase8_of_idac2_cur = 0;\r
+ uint8_t phase8_ad_inr_ctrl = 3;\r
+ uint8_t phase8_ad_of_idac_ctrl = 0;\r
+// uint8_t phase8_afe_offset = 0;\r
+ uint8_t phase8_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase8_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase8_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t init_wait_delay = 4 ; /* 0 = 31clk ; 1 = 64clk ; 2 = 127clk ; 3 = 255clk(d) ;\r
+ 4 = 511clk; 5 = 1023clk; 6 = 2047; 7 = 4095clk */ \r
+ \r
+ uint8_t afe_reset = 3; /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d) ;\r
+ 4 = 255clk; 5 = 511clk; 6 = 1024; 7 = 2047clk */\r
+ \r
+ uint8_t afe_rst_cnvt = 1; /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d)*/\r
+ \r
+ uint8_t led_en_idac_pre = 2; /* 0 = 8clk ; 1 = 16clk ; 2 = 32clk ; 3 = 64clk(d)*/ \r
+ \r
+ uint8_t led_en_idac = 1; /* 0 = 4clk ; 1 = 8clk ; 2 = 16clk ; 3 = 32clk(d)*/ \r
+ \r
+ uint8_t led_on_time = 2; /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+ 4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+ \r
+ hx3695_delay_ms(10); \r
+ \r
+ hx3695_write_reg(0X2a, (uint8_t)prf_clk_num); // prf bit<7:0>6\r
+ hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+ hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16> \r
+ \r
+ hx3695_write_reg(0X25, (afe_rst_cnvt<<4| led_en_idac_pre<<2|led_en_idac)); \r
+ hx3695_write_reg(0X2d, phase7_8_internal); \r
+ hx3695_write_reg(0X2e, 0x33);// gpio ctrl \r
+ hx3695_write_reg(0X2f, ((afe_reset<<4)| init_wait_delay));\r
+ hx3695_write_reg(0X30, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+ hx3695_write_reg(0X72, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+\r
+\r
+ hx3695_write_reg(0X31, (led_on_time<<4| 0x00));\r
+ hx3695_write_reg(0X33, 0x83);// Öжϼ«ÐÔ¼°¿í¶ÈÅäÖã»\r
+ hx3695_write_reg(0X34, 0x00);// ÖжÏÌØÊâÅäÖã»\r
+ hx3695_write_reg(0X36, 0x00);// phase data ready ±êÖ¾ÉèÖã»\r
+ hx3695_write_reg(0X38, 0x00);\r
+ \r
+ hx3695_write_reg(0X3a, (phase1_inner_avg | (phase2_inner_avg<<4))); \r
+ hx3695_write_reg(0X3b, (phase3_inner_avg | (phase4_inner_avg<<4))); \r
+ hx3695_write_reg(0X3c, (phase5_inner_avg | (phase6_inner_avg<<4))); \r
+ hx3695_write_reg(0X3d, (phase7_inner_avg | (phase8_inner_avg<<4))); \r
+ hx3695_write_reg(0X3e, adc_rst_post_num<<6 | samp_delay_leden_num<<4 | samp_copy_avg); \r
+ hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+ \r
+ hx3695_write_reg(0X43, phase1_mux_sel); \r
+ hx3695_write_reg(0X44, phase1_tia_cap<<4|phase1_tia_res); \r
+ hx3695_write_reg(0X45, phase1_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase1_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase1_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase1_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase1_ad_inr_ctrl<<4|phase1_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase1_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase1_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase1_dsp_mov_avg_num | phase1_dsp_iir_lp_coeff<<4);\r
+\r
+ \r
+ hx3695_write_reg(0X43, phase2_mux_sel); \r
+ hx3695_write_reg(0X44, phase2_tia_cap<<4|phase2_tia_res); \r
+ hx3695_write_reg(0X45, phase2_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase2_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase2_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase2_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase2_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase2_ad_inr_ctrl<<4|phase2_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase2_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase2_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase2_dsp_mov_avg_num | phase2_dsp_iir_lp_coeff<<4);\r
+ \r
+//phase3 sel\r
+\r
+ hx3695_write_reg(0X43, phase3_mux_sel); \r
+ hx3695_write_reg(0X44, phase3_tia_cap<<4|phase3_tia_res); \r
+ hx3695_write_reg(0X45, phase3_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase3_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase3_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase3_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase3_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase3_ad_inr_ctrl<<4|phase3_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase3_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase3_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase3_dsp_mov_avg_num | phase3_dsp_iir_lp_coeff<<4);\r
+ \r
+//phase4 sel\r
+\r
+ hx3695_write_reg(0X43, phase4_mux_sel); \r
+ hx3695_write_reg(0X44, phase4_tia_cap<<4|phase4_tia_res); \r
+ hx3695_write_reg(0X45, phase4_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase4_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase4_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase4_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase4_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase4_ad_inr_ctrl<<4|phase4_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase4_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase4_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase4_dsp_mov_avg_num | phase4_dsp_iir_lp_coeff<<4);\r
+\r
+ hx3695_write_reg(0X43, phase5_mux_sel); \r
+ hx3695_write_reg(0X44, phase5_tia_cap<<4|phase5_tia_res); \r
+ hx3695_write_reg(0X45, phase5_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase5_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase5_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase5_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase5_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase5_ad_inr_ctrl<<4|phase5_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase5_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase5_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase5_dsp_mov_avg_num | phase5_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase6_mux_sel); \r
+ hx3695_write_reg(0X44, phase6_tia_cap<<4|phase6_tia_res); \r
+ hx3695_write_reg(0X45, phase6_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase6_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase6_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase6_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase6_ad_inr_ctrl<<4|phase6_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase6_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase6_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase6_dsp_mov_avg_num | phase6_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase7_mux_sel); \r
+ hx3695_write_reg(0X44, phase7_tia_cap<<4|phase7_tia_res); \r
+ hx3695_write_reg(0X45, phase7_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase7_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase7_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase7_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase7_ad_inr_ctrl<<4|phase7_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase7_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase7_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase7_dsp_mov_avg_num | phase7_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase8_mux_sel); \r
+ hx3695_write_reg(0X44, phase8_tia_cap<<4|phase8_tia_res); \r
+ hx3695_write_reg(0X45, phase8_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase8_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase8_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase8_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase8_led_offset_idac);\r
+// hx3695_write_reg(0X48, phas8_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase8_ad_inr_ctrl<<4|phase8_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase8_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase8_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase8_dsp_mov_avg_num | phase8_dsp_iir_lp_coeff<<4);\r
+ \r
+\r
+// analog circuit cfg \r
+ hx3695_write_reg(0X60, 0x14); //\r
+ hx3695_write_reg(0X61, 0xf0); \r
+ hx3695_write_reg(0X62, 0x22); \r
+ hx3695_write_reg(0X63, 0x15); \r
+ \r
+ hx3695_write_reg(0X64, 0x08); \r
+ hx3695_write_reg(0X65, 0x88); //bug\r
+ \r
+ hx3695_write_reg(0X66, 0x30); // bits<3>=adc selftest en 0x30\r
+ hx3695_write_reg(0X67, 0x23); \r
+ hx3695_write_reg(0X68, 0x46); \r
+ hx3695_write_reg(0X69, 0x42); \r
+ \r
+ hx3695_write_reg(0X39, 0xff); // ofset idac1 phase enable cfg\r
+ hx3695_write_reg(0x73, 0xff); //led_offset_idac phase enable\r
+ \r
+ hx3695_write_reg(0X6a, 0X0f); \r
+ hx3695_write_reg(0X6b, 0X22); \r
+ hx3695_write_reg(0X6c, 0X00); \r
+ hx3695_write_reg(0X6d, 0X37); \r
+ hx3695_write_reg(0X6e, 0X82); \r
+ hx3695_write_reg(0X6f, 0X08);\r
+/////////FIFO and adc conversion ready config////////\r
+/////////FIFO and adc conversion ready config////////\r
+#if defined(PPG_INT_MODE)\r
+ hx3695_write_reg(0X1b, 0x90);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble\r
+ hx3695_write_reg(0X33, 0x83); // int width \r
+ hx3695_write_reg(0X21, 0x00); // fifo int sel,00=FIFO INT config clear\r
+ hx3695_write_reg(0X38, 0x08); // int sel,00=close almost full int,04=enable almost full int\r
+#elif defined(INT_MODE) //(FIFO_ALL_MOST_FULL)\r
+ hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble\r
+ hx3695_write_reg(0X1c, (fifo_watermark&0xff)); //fifo_watermark\r
+ hx3695_write_reg(0X1d, fifo_watermark<<8); //bit<0>=fifo_watermark[8] \r
+ hx3695_write_reg(0X33, 0x83); // int width \r
+ hx3695_write_reg(0X38, 0x04); // int sel,00=close almost full int,04=enable almost full int\r
+\r
+#else\r
+ hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble \r
+ hx3695_write_reg(0X36, 0x00); //intrupt \r
+ \r
+ hx3695_write_reg(0X38, 0x00); // int sel,00=close almost full int,01= prf int 04=enable almost full int\r
+\r
+#endif\r
+\r
+ \r
+ hx3695_write_reg(0X26,(phase1_enable<<3)|(phase1_adc_osr)|(phase2_enable<<7)|(phase2_adc_osr<<4) ); \r
+ hx3695_write_reg(0X27,(phase3_enable<<3)|(phase3_adc_osr)|(phase4_enable<<7)|(phase4_adc_osr<<4) ); \r
+ hx3695_write_reg(0X28,(phase5_enable<<3)|(phase5_adc_osr)|(phase6_enable<<7)|(phase6_adc_osr<<4) );\r
+ hx3695_write_reg(0X29,(phase7_enable<<3)|(phase7_adc_osr)|(phase8_enable<<7)|(phase8_adc_osr<<4) ); \r
+\r
+ hx3695_write_reg(0X5c, 0x02);//soft reset\r
+ hx3695_delay_ms(5); \r
+ hx3695_write_reg(0X5c, 0x00);//release\r
+// uint8_t fifo_data_temp[3] = {0};\r
+// hx3695_brust_read_reg(0x22, fifo_data_temp, 3); \r
+ read_fifo_first_flg = 1;\r
+ return ;\r
+}\r
+#endif\r
+\r
+// ³õʼ»¯µ÷ÓÃÈë¿Úº¯Êý\r
+bool hx3695_init(WORK_MODE_T mode)\r
+{\r
+ work_mode_flag = mode;\r
+ hx3695_data_reset();\r
+ hx3695_vin_check(3800);\r
+ switch (work_mode_flag)\r
+ {\r
+ case HRS_MODE:\r
+#ifdef HRS_ALG_LIB\r
+ tyhx_hrs_set_living(1, 15, 30);\r
+ if(hx3695_hrs_enable()== SENSOR_OP_FAILED)\r
+ {\r
+ return false;\r
+ }\r
+#endif\r
+ break;\r
+\r
+ case LIVING_MODE:\r
+#ifdef CHECK_LIVING_LIB\r
+ if(hx3695_hrs_enable()== SENSOR_OP_FAILED)\r
+ {\r
+ return false;\r
+ }\r
+#endif\r
+ break;\r
+\r
+ case SPO2_MODE:\r
+#ifdef SPO2_DATA_CALI\r
+// hx3695_spo2_data_cali_init();\r
+#endif\r
+\r
+#ifdef SPO2_ALG_LIB\r
+ tyhx_spo2_para_usuallyadjust(SPO2_LOW_XCORR_THRE,SPO2_LOW_SNR_THRE,COUNT_BLOCK_NUM,SPO2_BASE_LINE_INIT,SPO2_SLOPE,SPO2_GSEN_POW_THRE);\r
+ tyhx_spo2_para_barelychange(MEAN_NUM,SOP2_DEGLITCH_THRE,SPO2_REMOVE_JUMP_THRE, \\r
+ SPO2_LOW_CLIP_END_TIME,SPO2_LOW_CLIP_DN,SPO2_NORMAL_CLIP_DN, \\r
+ IR_AC_TOUCH_THRE,IR_FFT_POW_THRE,SPO2_CALI,SLOPE_PARA_MAX,SLOPE_PARA_MIN);\r
+ tyhx_spo2_set_living(1, 15, 30);\r
+ if(hx3695_spo2_enable()== SENSOR_OP_FAILED)\r
+ {\r
+ return false;\r
+ }\r
+#endif\r
+ break;\r
+\r
+ case HRSPO2_MODE:\r
+#if defined(HRS_ALG_LIB) && defined (SPO2_ALG_LIB)\r
+ tyhx_spo2_para_usuallyadjust(SPO2_LOW_XCORR_THRE,SPO2_LOW_SNR_THRE,COUNT_BLOCK_NUM,SPO2_BASE_LINE_INIT,SPO2_SLOPE,SPO2_GSEN_POW_THRE);\r
+ tyhx_spo2_para_barelychange(MEAN_NUM,SOP2_DEGLITCH_THRE,SPO2_REMOVE_JUMP_THRE, \\r
+ SPO2_LOW_CLIP_END_TIME,SPO2_LOW_CLIP_DN,SPO2_NORMAL_CLIP_DN, \\r
+ IR_AC_TOUCH_THRE,IR_FFT_POW_THRE,SPO2_CALI,SLOPE_PARA_MAX,SLOPE_PARA_MIN);\r
+ if(hx3695_spo2_enable()== SENSOR_OP_FAILED)\r
+ {\r
+ return false;\r
+ }\r
+#endif\r
+\r
+ case HRV_MODE:\r
+#ifdef HRV_ALG_LIB\r
+ if(hx3695_hrv_enable()== SENSOR_OP_FAILED)\r
+ {\r
+ return false;\r
+ }\r
+#endif\r
+ break;\r
+\r
+ case WEAR_MODE:\r
+#ifdef CHECK_TOUCH_LIB\r
+ if(hx3695_check_touch_enable()== SENSOR_OP_FAILED)\r
+ {\r
+ return false;\r
+ }\r
+#endif\r
+ break;\r
+\r
+ case FT_LEAK_LIGHT_MODE:\r
+ if (!hx3695_chip_check())\r
+ {\r
+ AGC_LOG("hx3695 check id failed!\r\n");\r
+ return false;\r
+ }\r
+ hx3695_factroy_test(LEAK_LIGHT_TEST);\r
+ return true;\r
+\r
+ break;\r
+\r
+ case FT_GRAY_CARD_MODE:\r
+ if (!hx3695_chip_check())\r
+ {\r
+ AGC_LOG("hx3695 check id failed!\r\n");\r
+ return false;\r
+ }\r
+ hx3695_factroy_test(GRAY_CARD_TEST);\r
+ break;\r
+\r
+ case FT_INT_TEST_MODE:\r
+ hx3695_factroy_test(FT_INT_TEST);\r
+ break;\r
+\r
+ case FT_SINGLE_CHECK_MODE:\r
+ hx3695_factroy_test(SINGLE_CHECK_TEST);\r
+ break;\r
+\r
+ case FT_LED_OFF_MODE:\r
+ hx3695_factroy_test(LED_OFF_TEST);\r
+ break;\r
+\r
+ case FT_WEAR_MODE:\r
+ hx3695_factroy_test(WEAR_MODE_TEST);\r
+ break;\r
+\r
+ case LAB_TEST_MODE:\r
+#ifdef LAB_TEST\r
+ if(hx3695_lab_test_enable()== SENSOR_OP_FAILED)\r
+ {\r
+ return false;\r
+ }\r
+#endif\r
+ break;\r
+\r
+ default:\r
+ break;\r
+ }\r
+ return true;\r
+}\r
+\r
+void hx3695_agc_Int_handle(void)\r
+{\r
+ switch (work_mode_flag)\r
+ {\r
+ case HRS_MODE:\r
+#ifdef HRS_ALG_LIB\r
+ PPG_hrs_agc();\r
+#endif\r
+ break;\r
+\r
+ case LIVING_MODE:\r
+#ifdef HRS_ALG_LIB\r
+ PPG_hrs_agc();\r
+#endif\r
+ break;\r
+\r
+ case HRV_MODE:\r
+#ifdef HRV_ALG_LIB\r
+ PPG_hrv_agc();\r
+#endif\r
+ break;\r
+\r
+ case SPO2_MODE:\r
+#ifdef SPO2_ALG_LIB\r
+ PPG_spo2_agc();\r
+#endif\r
+ break;\r
+\r
+ case HRSPO2_MODE:\r
+#if defined(HRS_ALG_LIB) && defined (SPO2_ALG_LIB)\r
+ PPG_spo2_agc();\r
+#endif\r
+\r
+ case LAB_TEST_MODE:\r
+#ifdef LAB_TEST\r
+ hx3695_lab_test_Int_handle();\r
+#endif\r
+\r
+ default:\r
+ break;\r
+ }\r
+}\r
+\r
+void agc_timeout_handler(void * p_context)\r
+{\r
+ hx3695_agc_Int_handle();\r
+\r
+#if defined(GSEN_40MS_TIMMER)\r
+ hx3695_gesensor_Int_handle();\r
+#endif\r
+}\r
+\r
+void heart_rate_meas_timeout_handler(void * p_context)\r
+{\r
+ switch(work_mode_flag)\r
+ {\r
+ case HRS_MODE:\r
+#ifdef HRS_ALG_LIB\r
+ hx3695_hrs_ppg_Int_handle();\r
+#endif\r
+ break;\r
+\r
+ case HRV_MODE:\r
+#ifdef HRV_ALG_LIB\r
+ hx3695_hrv_ppg_Int_handle();\r
+#endif\r
+ break;\r
+\r
+ case SPO2_MODE:\r
+#ifdef SPO2_ALG_LIB\r
+ hx3695_spo2_ppg_Int_handle();\r
+#endif\r
+ break;\r
+\r
+ case WEAR_MODE:\r
+#ifdef CHECK_TOUCH_LIB\r
+ hx3695_wear_ppg_Int_handle();\r
+#endif\r
+ break;\r
+\r
+ case LIVING_MODE:\r
+#ifdef CHECK_LIVING_LIB\r
+ hx3695_living_Int_handle();\r
+#endif\r
+ break;\r
+\r
+ case HRSPO2_MODE:\r
+#if defined(HRS_ALG_LIB) && defined (SPO2_ALG_LIB)\r
+ hx3695_hrspo2_ppg_Int_handle();\r
+#endif\r
+\r
+ default:\r
+ break;\r
+ }\r
+}\r
+\r
+void hx3695_ppg_Int_handle(void)\r
+{\r
+ hx3695_agc_Int_handle();\r
+#if defined(INT_MODE)\r
+ switch(work_mode_flag)\r
+ {\r
+ case HRS_MODE:\r
+#ifdef HRS_ALG_LIB\r
+ hx3695_hrs_ppg_Int_handle();\r
+#endif\r
+ break;\r
+\r
+ case SPO2_MODE:\r
+#ifdef SPO2_ALG_LIB\r
+ hx3695_spo2_ppg_Int_handle();\r
+#endif\r
+ break;\r
+\r
+ case HRV_MODE:\r
+#ifdef HRV_ALG_LIB\r
+ hx3695_hrv_ppg_Int_handle();\r
+#endif\r
+ break;\r
+\r
+ case WEAR_MODE:\r
+#ifdef CHECK_TOUCH_LIB\r
+ hx3695_wear_ppg_Int_handle();\r
+#endif\r
+ break;\r
+\r
+ case LAB_TEST_MODE:\r
+#ifdef LAB_TEST\r
+ hx3695_lab_test_Int_handle();\r
+#endif\r
+\r
+ default:\r
+ break;\r
+ }\r
+#endif\r
+}\r
+\r
+\r
+\r
+#ifdef HRS_ALG_LIB\r
+/*TYHX ÐÄÂÊģʽÏ ¶ÁÈ¡PPG£¬ ĬÈÏ320ms*/\r
+hrs_sensor_data_t hrs_s_dat;\r
+//hx3695_results_t alg_results_pre;\r
+\r
+void hx3695_hrs_ppg_Int_handle(void)\r
+{\r
+ uint8_t ii=0;\r
+ hrs_results_t alg_results = {MSG_HRS_ALG_NOT_OPEN,0,0,0,0};\r
+ hrs_wear_msg_code_t hrs_wear_status = MSG_HRS_NO_WEAR;\r
+ int32_t *PPG_buf = &(hrs_s_dat.green_data[0]);\r
+ int32_t *ir_buf = &(hrs_s_dat.ir_data[0]);\r
+ uint8_t *count = &(hrs_s_dat.count);\r
+ //int32_t *s_buf = &(ppg_s_data.s_buf[0]);\r
+ int16_t gsen_fifo_x_send[32]= {0};\r
+ int16_t gsen_fifo_y_send[32]= {0};\r
+ int16_t gsen_fifo_z_send[32]= {0};\r
+ \r
+ HRS_CAL_SET_T cal;\r
+ cal = get_hrs_agc_status();\r
+\r
+#ifdef HR_VECTOR\r
+ for(ii=0; ii<8; ii++)\r
+ {\r
+ PPG_buf_vec[ii] = hrm_input_data[vec_send_cnt+ii];\r
+ gsen_fifo_x_send[ii] = gsen_input_data_x[vec_send_cnt+ii];\r
+ gsen_fifo_y_send[ii] = gsen_input_data_y[vec_send_cnt+ii];\r
+ gsen_fifo_z_send[ii] = gsen_input_data_z[vec_send_cnt+ii];\r
+ }\r
+ vec_send_cnt = vec_send_cnt+8;\r
+ *count = 8;\r
+ tyhx_hrs_alg_send_data(PPG_buf_vec,*count, gsen_fifo_x_send, gsen_fifo_y_send, gsen_fifo_z_send);\r
+\r
+#else\r
+ if(hx3695_hrs_read(&hrs_s_dat) == 0)\r
+ {\r
+ return;\r
+ }\r
+ \r
+#ifndef GSEN_40MS_TIMMER\r
+ readFifoByHrsModule();\r
+#endif\r
+// DEBUG_PRINTF("\r\nsend jlink cnt=%d\r\n",*count); \r
+ \r
+ for(ii=0; ii<*count; ii++)\r
+ {\r
+ gsen_fifo_x_send[ii] = gsen_fifo_x[32-*count+ii];\r
+ gsen_fifo_y_send[ii] = gsen_fifo_y[32-*count+ii];\r
+ gsen_fifo_z_send[ii] = gsen_fifo_z[32-*count+ii];\r
+\r
+// DEBUG_PRINTF("gr,ir,gsen:%d/%d %d %d %d %d %d %d\r\n" ,1+ii,*count,PPG_buf[ii],ir_buf[0],gsen_fifo_x[ii],gsen_fifo_y[ii],gsen_fifo_z[ii],ppg_s_data.green_cur);\r
+ }\r
+\r
+ hrs_wear_status = hx3695_hrs_get_wear_status();\r
+ if(hrs_wear_status == MSG_HRS_WEAR)\r
+ {\r
+ tyhx_hrs_alg_send_data(PPG_buf, *count, gsen_fifo_x_send, gsen_fifo_y_send, gsen_fifo_z_send, cal.Group1_Ledidac);\r
+ }\r
+#endif\r
+\r
+ alg_results = tyhx_hrs_alg_get_results();\r
+ hrsresult.lastesthrs = alg_results.hr_result;\r
+ hrsresult.hr_living = alg_results.living_status;\r
+ hrsresult.hr_living_qu = alg_results.hr_result_qual;\r
+ hrsresult.hr_living_std = alg_results.hr_result_std;\r
+ \r
+ \r
+ \r
+\r
+ DEBUG_PRINTF("data_cnt: %d, hr_result:%d \r\n",alg_results.data_cnt, alg_results.hr_result);\r
+#ifdef BP_CUSTDOWN_ALG_LIB\r
+ bp_results_t bp_alg_results;\r
+ bp_alg_results = tyhx_alg_get_bp_results();\r
+#endif\r
+\r
+////////////////////////////////////////BLE+DISPLAY/////////////////////////////////\r
+\r
+\r
+#ifdef HRS_BLE_APP\r
+ {\r
+ rawdata_vector_t rawdata;\r
+ for(ii=0; ii<*count; ii++)\r
+ {\r
+ rawdata.vector_flag = HRS_VECTOR_FLAG;\r
+ rawdata.data_cnt = alg_results.data_cnt-*count+ii;\r
+ rawdata.hr_result = alg_results.hr_result;\r
+ rawdata.red_raw_data = PPG_buf[ii];\r
+ rawdata.ir_raw_data = ir_buf[ii];\r
+ rawdata.gsensor_x = gsen_fifo_x_send[ii];\r
+ rawdata.gsensor_y = gsen_fifo_y_send[ii];\r
+ rawdata.gsensor_z = gsen_fifo_z_send[ii];\r
+ rawdata.red_cur = cal.Group1_Cur;\r
+ rawdata.ir_cur = cal.Group1_Ledidac;\r
+ \r
+ ble_rawdata_vector_push(rawdata);\r
+ }\r
+ }\r
+ ble_rawdata_send_handler();\r
+#endif\r
+\r
+////////////////////////////////////////////////////////////////////////////////////\r
+}\r
+#endif\r
+\r
+#ifdef CHECK_LIVING_LIB\r
+hrs_sensor_data_t hrs_s_dat; \r
+\r
+void hx3695_living_Int_handle(void)\r
+{\r
+ uint8_t ii=0;\r
+ hx3695_living_results_t living_alg_results = {MSG_LIVING_NO_WEAR,0,0,0};\r
+ int32_t *PPG_buf = &(hrs_s_dat.green_data[0]);\r
+ int32_t *ir_buf = &(hrs_s_dat.ir_data[0]);\r
+ uint8_t *count = &(hrs_s_dat.count);\r
+ hrs_wear_msg_code_t hrs_wear_status = MSG_HRS_NO_WEAR;\r
+ int16_t gsen_fifo_x_send[32]= {0};\r
+ int16_t gsen_fifo_y_send[32]= {0};\r
+ int16_t gsen_fifo_z_send[32]= {0};\r
+\r
+ if(hx3695_hrs_read(&hrs_s_dat) == 0)\r
+ {\r
+ return;\r
+ }\r
+ \r
+#ifndef GSEN_40MS_TIMMER\r
+ readFifoByHrsModule();\r
+#endif\r
+ DEBUG_PRINTF("\r\nsend jlink cnt=%d\r\n",*count); \r
+ \r
+ \r
+ for(ii=0; ii<*count; ii++)\r
+ {\r
+ gsen_fifo_x_send[ii] = gsen_fifo_x[32-*count+ii];\r
+ gsen_fifo_y_send[ii] = gsen_fifo_y[32-*count+ii];\r
+ gsen_fifo_z_send[ii] = gsen_fifo_z[32-*count+ii];\r
+\r
+ DEBUG_PRINTF("ger:%d/%d %d %d %d %d %d %d\r\n" ,1+ii,*count,PPG_buf[ii],ir_buf[0],gsen_fifo_x[ii],gsen_fifo_y[ii],gsen_fifo_z[ii],ppg_s_data.green_cur);\r
+ }\r
+ hrs_wear_status = hx3695_hrs_get_wear_status();\r
+ if(hrs_wear_status == MSG_HRS_WEAR)\r
+ {\r
+ hx3695_living_send_data(PPG_buf, *count, gsen_fifo_x_send, gsen_fifo_y_send, gsen_fifo_z_send);\r
+ }\r
+ living_alg_results = hx3695_living_get_results();\r
+ DEBUG_PRINTF("res:%d %d %d %d\r\n",living_alg_results.data_cnt,living_alg_results.motion_status,living_alg_results.signal_quality,hrs_wear_status);\r
+}\r
+#endif\r
+\r
+\r
+#ifdef SPO2_ALG_LIB\r
+\r
+#ifdef SPO2_DATA_CALI\r
+void hx3695_spo2_data_cali_init(void)\r
+{\r
+ uint8_t ii;\r
+ for(ii=0; ii<4; ii++)\r
+ {\r
+ red_data_fifo[ii] = 0;\r
+ ir_data_fifo[ii] = 0;\r
+ }\r
+ red_dc_temp = 0;\r
+ ir_dc_temp = 0;\r
+ red_data_pre = 0;\r
+ ir_data_pre = 0;\r
+ red_jump_delta = 0;\r
+ ir_jump_delta = 0;\r
+ cali_data_cnt = 0;\r
+}\r
+\r
+int32_t hx3695_red_data_cali(int32_t red_new_raw_data)\r
+{\r
+ uint8_t ii;\r
+ int32_t red_data_final;\r
+ int32_t red_data_cali;\r
+ spo2_wear_msg_code_t touch_status;\r
+ touch_status = hx3695_spo2_get_wear_status();\r
+ if(touch_status == MSG_SPO2_NO_WEAR)\r
+ {\r
+ cali_data_cnt = 0;\r
+ red_data_cali = red_new_raw_data;\r
+ for(ii=0; ii<4; ii++)\r
+ {\r
+ red_data_fifo[ii] = 0;\r
+ }\r
+ red_dc_temp = 0;\r
+ }\r
+ else\r
+ {\r
+ for(ii=3; ii>0; ii--)\r
+ {\r
+ red_data_fifo[ii] = red_data_fifo[ii-1];\r
+ }\r
+ red_data_fifo[0] = red_new_raw_data;\r
+ if(cali_data_cnt>=25)\r
+ {\r
+ if ((((red_data_fifo[1] - red_data_fifo[2]) > SOP2_DEGLITCH_THRE) && ((red_data_fifo[1] - red_new_raw_data) > SOP2_DEGLITCH_THRE)) || \\r
+ (((red_data_fifo[1] - red_data_fifo[2]) < -SOP2_DEGLITCH_THRE) && ((red_data_fifo[1] - red_new_raw_data) < -SOP2_DEGLITCH_THRE)))\r
+ {\r
+ red_new_raw_data = red_data_fifo[2];\r
+ red_data_fifo[1] = red_data_fifo[2];\r
+ }\r
+ else\r
+ {\r
+ red_new_raw_data = red_data_fifo[1];\r
+ }\r
+ if ((abs((red_new_raw_data - red_jump_delta) - red_data_pre) > SPO2_REMOVE_JUMP_THRE))\r
+ {\r
+ red_jump_delta = red_new_raw_data - red_data_pre;\r
+ }\r
+ red_data_cali = red_new_raw_data - red_jump_delta;\r
+ red_data_pre = red_data_cali;\r
+ }\r
+ else\r
+ {\r
+ red_data_cali = red_data_fifo[1];\r
+ red_data_pre = red_data_fifo[1];\r
+ }\r
+ }\r
+ if(cali_data_cnt<=30)\r
+ {\r
+ red_dc_temp = red_data_cali;\r
+ red_data_final = red_new_raw_data;\r
+ }\r
+ else\r
+ {\r
+ //red_dc_temp = (red_dc_temp*31 + red_data_cali)>>5;\r
+ red_dc_temp = 0;\r
+ red_data_final = red_data_cali - red_dc_temp + 2608*50*hx3695_spo2_agc_red_idac;\r
+ }\r
+ //DEBUG_PRINTF("%d %d %d %d %d %d\r\n", cali_data_cnt, red_new_raw_data, red_data_final, red_data_cali, red_dc_temp, hx3695_spo2_agc_red_idac);\r
+ return red_data_final;\r
+}\r
+int32_t hx3695_ir_data_cali(int32_t ir_new_raw_data)\r
+{\r
+ uint8_t ii;\r
+ int32_t ir_data_final;\r
+ int32_t ir_data_cali;\r
+ spo2_wear_msg_code_t touch_status;\r
+ touch_status = hx3695_spo2_get_wear_status();\r
+ if(touch_status == MSG_SPO2_NO_WEAR)\r
+ {\r
+ cali_data_cnt = 0;\r
+ ir_data_cali = ir_new_raw_data;\r
+ for(ii=0; ii<4; ii++)\r
+ {\r
+ ir_data_fifo[ii] = 0;\r
+ }\r
+ ir_dc_temp = 0;\r
+ }\r
+ else\r
+ {\r
+ for(ii=3; ii>0; ii--)\r
+ {\r
+ ir_data_fifo[ii] = ir_data_fifo[ii-1];\r
+ }\r
+ ir_data_fifo[0] = ir_new_raw_data;\r
+ cali_data_cnt++;\r
+ if(cali_data_cnt>=25)\r
+ {\r
+ if ((((ir_data_fifo[1] - ir_data_fifo[2]) > SOP2_DEGLITCH_THRE) && ((ir_data_fifo[1] - ir_new_raw_data) > SOP2_DEGLITCH_THRE)) || \\r
+ (((ir_data_fifo[1] - ir_data_fifo[2]) < -SOP2_DEGLITCH_THRE) && ((ir_data_fifo[1] - ir_new_raw_data) < -SOP2_DEGLITCH_THRE)))\r
+ {\r
+ ir_new_raw_data = ir_data_fifo[2];\r
+ ir_data_fifo[1] = ir_data_fifo[2];\r
+ }\r
+ else\r
+ {\r
+ ir_new_raw_data = ir_data_fifo[1];\r
+ }\r
+ if ((abs((ir_new_raw_data - ir_jump_delta) - ir_data_pre) > SPO2_REMOVE_JUMP_THRE))\r
+ {\r
+ ir_jump_delta = ir_new_raw_data - ir_data_pre;\r
+ }\r
+ ir_data_cali = ir_new_raw_data - ir_jump_delta;\r
+ ir_data_pre = ir_data_cali;\r
+ }\r
+ else\r
+ {\r
+ ir_data_cali = ir_data_fifo[1];\r
+ ir_data_pre = ir_data_fifo[1];\r
+ }\r
+ }\r
+ if(cali_data_cnt<=30)\r
+ {\r
+ ir_dc_temp = ir_data_cali;\r
+ ir_data_final = ir_new_raw_data;\r
+ }\r
+ else\r
+ {\r
+ //ir_dc_temp = (ir_dc_temp*31 + ir_data_cali)>>5;\r
+ ir_dc_temp = 0;\r
+ ir_data_final = ir_data_cali - ir_dc_temp + 2608*50*hx3695_spo2_agc_ir_idac;\r
+ }\r
+ //DEBUG_PRINTF("%d %d %d %d %d %d\r\n", cali_data_cnt, ir_new_raw_data, ir_data_final, ir_data_cali, ir_dc_temp, hx3695_spo2_agc_ir_idac);\r
+ return ir_data_final;\r
+}\r
+#endif //SPO2_DATA_CALI\r
+\r
+//#ifdef SPO2_ALG_LIB\r
+spo2_sensor_data_t spo2_s_dat;\r
+\r
+/*TYHX ѪÑõģʽÏ ¶ÁÈ¡PPG£¬ ĬÈÏ320ms*/\r
+void hx3695_spo2_ppg_Int_handle(void)\r
+{\r
+ uint8_t ii=0;\r
+ spo2_results_t spo2_alg_results = {MSG_SPO2_ALG_NOT_OPEN,0,0,0,0,0,0,1,0,0};\r
+ spo2_wear_msg_code_t spo2_wear_status = MSG_SPO2_NO_WEAR;\r
+ SPO2_CAL_SET_T cal = get_spo2_agc_status();\r
+ int32_t *red_buf = &(spo2_s_dat.red_data[0]);\r
+ int32_t *ir_buf = &(spo2_s_dat.ir_data1[0]);\r
+ int32_t *green_buf = &(spo2_s_dat.green_data[0]);\r
+ uint8_t *count = &(spo2_s_dat.count);\r
+ int16_t gsen_fifo_x_send[32]= {0};\r
+ int16_t gsen_fifo_y_send[32]= {0};\r
+ int16_t gsen_fifo_z_send[32]= {0};\r
+#ifdef SPO2_DATA_CALI\r
+ int32_t red_data_cali, ir_data_cali;\r
+#endif\r
+\r
+#ifdef SPO2_VECTOR\r
+ for(ii=0; ii<8; ii++)\r
+ {\r
+ red_buf_vec[ii] = vec_red_data[spo2_send_cnt+ii];\r
+ ir_buf_vec[ii] = vec_ir_data[spo2_send_cnt+ii];\r
+ green_buf_vec[ii] = vec_green_data[spo2_send_cnt+ii];\r
+ }\r
+ spo2_send_cnt = spo2_send_cnt+8;\r
+ *count = 8;\r
+ tyhx_spo2_alg_send_data(red_buf, ir_buf, green_buf, cal.R_LEDDAC, cal.IR_LEDDAC1, cal.R_LEDDAC, gsen_fifo_x_send, gsen_fifo_y_send, gsen_fifo_z_send, *count);\r
+\r
+#else\r
+ if(hx3695_spo2_read(&spo2_s_dat) == 0)\r
+ {\r
+ return;\r
+ }\r
+ \r
+ \r
+#ifndef GSEN_40MS_TIMMER\r
+ readFifoByHrsModule();\r
+#endif\r
+ DEBUG_PRINTF("\r\n send1 jlink cnt=%d\r\n",*count); \r
+ \r
+ for(ii=0; ii<*count; ii++)\r
+ {\r
+ gsen_fifo_x_send[ii] = gsen_fifo_x[32-*count+ii];\r
+ gsen_fifo_y_send[ii] = gsen_fifo_y[32-*count+ii];\r
+ gsen_fifo_z_send[ii] = gsen_fifo_z[32-*count+ii];\r
+ //DEBUG_PRINTF("%d/%d %d %d %d %d %d %d\r\n" ,1+ii,*count,red_buf[ii],ir_buf[ii],green_buf[ii],gsen_fifo_x[ii],gsen_fifo_y[ii],gsen_fifo_z[ii]);\r
+\r
+ }\r
+ //DEBUG_PRINTF("%d %d %d %d %d %d\r\n", cal.R_LED, cal.IR_LED, cal.G_LED, cal.R_LEDDAC, cal.IR_LEDDAC, cal.G_LEDDAC);\r
+ spo2_wear_status = hx3695_spo2_get_wear_status();\r
+ if(spo2_wear_status == MSG_SPO2_WEAR)\r
+ {\r
+ tyhx_spo2_alg_send_data(red_buf, ir_buf, green_buf, cal.R_LEDDAC, cal.IR_LEDDAC1, cal.G_LEDDAC, gsen_fifo_x_send, gsen_fifo_y_send, gsen_fifo_z_send, *count);\r
+ }\r
+#endif\r
+\r
+ spo2_alg_results = tyhx_spo2_alg_get_results();\r
+//------------------------adjust-------------------\r
+ //DEBUG_PRINTF("block_cnt: %d, data_cnt:%d, hr_result:%d,ir_quality:%d,motion:%d,poor_signal:%d,reliable_score_result:%d,screen_up:%d,spo2_result:%d\r\n",spo2_alg_results.block_cnt,spo2_alg_results.data_cnt,spo2_alg_results.hr_result,spo2_alg_results.ir_quality,spo2_alg_results.motion,spo2_alg_results.poor_signal,spo2_alg_results.reliable_score_result,spo2_alg_results.screen_up,spo2_alg_results.spo2_result);\r
+\r
+ hrsresult.lastestspo2 = spo2_alg_results.spo2_result;\r
+\r
+\r
+/////////////////////////////////////////BLE+DISPLAY//////////////////////////////////////////\r
+\r
+\r
+#ifdef HRS_BLE_APP\r
+ {\r
+ rawdata_vector_t rawdata;\r
+ SPO2_CAL_SET_T cal= get_spo2_agc_status();\r
+ for(ii=0; ii<*count; ii++)\r
+ {\r
+#ifdef SPO2_DATA_CALI\r
+ ir_data_cali = hx3695_ir_data_cali(ir_buf[ii]);\r
+ red_data_cali = hx3695_red_data_cali(red_buf[ii]);\r
+ rawdata.red_raw_data = red_data_cali>>2;\r
+ rawdata.ir_raw_data = ir_data_cali>>2;\r
+#else\r
+ rawdata.red_raw_data = red_buf[ii];\r
+ rawdata.ir_raw_data = ir_buf[ii];\r
+#endif\r
+ rawdata.vector_flag = SPO2_VECTOR_FLAG;\r
+ rawdata.data_cnt = cal.G_LEDDAC;\r
+ rawdata.hr_result = spo2_alg_results.spo2_result;\r
+ rawdata.gsensor_x = (int16_t)(green_buf[ii]>>5);\r
+ rawdata.gsensor_y = cal.R_LEDDAC;\r
+ rawdata.gsensor_z = cal.IR_LEDDAC1;\r
+ rawdata.red_cur = cal.R_LED;\r
+ rawdata.ir_cur = cal.IR_LED1;\r
+ ble_rawdata_vector_push(rawdata);\r
+ }\r
+ ble_rawdata_send_handler();\r
+ }\r
+#endif\r
+\r
+/////////////////////////////////////////////////////////////////////////////////////////////////\r
+}\r
+#endif //SPO2_ALG_LIB\r
+\r
+\r
+\r
+#if defined(HRS_ALG_LIB) && defined (SPO2_ALG_LIB)\r
+spo2_sensor_data_t hrspo2_s_data;\r
+\r
+void hx3695_hrspo2_ppg_Int_handle(void)\r
+{\r
+ uint8_t ii=0;\r
+ spo2_results_t spo2_alg_results = {MSG_SPO2_ALG_NOT_OPEN,0,0,0,0,0,0};\r
+ hrs_results_t alg_results = {MSG_HRS_ALG_NOT_OPEN,0,0,0,0};\r
+ spo2_wear_msg_code_t spo2_wear_status = MSG_SPO2_NO_WEAR;\r
+ SPO2_CAL_SET_T cal = get_spo2_agc_status();\r
+ int32_t *red_buf = &(hrspo2_s_data.red_data[0]);\r
+ int32_t *ir_buf = &(hrspo2_s_data.ir_data1[0]);\r
+ int32_t *green_buf = &(hrspo2_s_data.red_data[0]); // &(hrspo2_s_data.green_data[0]);\r
+ uint8_t *count = &(ppg_s_data.count);\r
+ int16_t gsen_fifo_x_send[32]= {0};\r
+ int16_t gsen_fifo_y_send[32]= {0};\r
+ int16_t gsen_fifo_z_send[32]= {0};\r
+#ifdef SPO2_DATA_CALI\r
+ int32_t red_data_cali, ir_data_cali;\r
+#endif\r
+\r
+ if(hx3695_spo2_read(&hrspo2_s_data) == NULL)\r
+ {\r
+ return;\r
+ }\r
+ \r
+#ifndef GSEN_40MS_TIMMER\r
+ readFifoByHrsModule();\r
+#endif\r
+ DEBUG_PRINTF("\r\nsend jlink cnt=%d\r\n",*count); \r
+ \r
+ \r
+ for(ii=0; ii<*count; ii++)\r
+ {\r
+ gsen_fifo_x_send[ii] = gsen_fifo_x[32-*count+ii];\r
+ gsen_fifo_y_send[ii] = gsen_fifo_y[32-*count+ii];\r
+ gsen_fifo_z_send[ii] = gsen_fifo_z[32-*count+ii];\r
+\r
+ }\r
+ spo2_wear_status = hx3695_spo2_get_wear_status();\r
+ if(spo2_wear_status == MSG_SPO2_WEAR)\r
+ {\r
+ tyhx_spo2_alg_send_data(red_buf, ir_buf, green_buf, cal.R_LEDDAC, cal.IR_LEDDAC1, cal.R_LEDDAC, gsen_fifo_x_send, gsen_fifo_y_send, gsen_fifo_z_send, *count);\r
+ //tyhx_hrs_alg_send_data(green_buf,*count, gsen_fifo_x_send, gsen_fifo_y_send, gsen_fifo_z_send);\r
+ //DEBUG_PRINTF("%d/%d %d %d %d %d %d %d\r\n" ,1+ii,*count,red_buf[ii],ir_buf[ii],green_buf[ii],gsen_fifo_x[ii],gsen_fifo_y[ii],gsen_fifo_z[ii]);\r
+ }\r
+ //DEBUG_PRINTF("%d %d %d %d %d %d\r\n", cal.R_LED, cal.IR_LED, cal.G_LED, cal.R_LEDDAC, cal.IR_LEDDAC, cal.G_LEDDAC);\r
+\r
+ spo2_alg_results = tyhx_spo2_alg_get_results();\r
+ alg_results = tyhx_hrs_alg_get_results();\r
+ //DEBUG_PRINTF("spo2_wear_status: %d, hr_result:%d, spo2_result:%d\r\n" ,spo2_wear_status, spo2_alg_results.hr_result,spo2_alg_results.spo2_result);\r
+\r
+/////////////////////////////////////////BLE+DISPLAY//////////////////////////////////////////\r
+\r
+#ifdef HRS_BLE_APP\r
+ {\r
+ rawdata_vector_t rawdata;\r
+ SPO2_CAL_SET_T cal= get_spo2_agc_status();\r
+ for(ii=0; ii<*count; ii++)\r
+ {\r
+#ifdef SPO2_DATA_CALI\r
+ ir_data_cali = hx3695_ir_data_cali(ir_buf[ii]);\r
+ red_data_cali = hx3695_red_data_cali(red_buf[ii]);\r
+ rawdata.red_raw_data = red_data_cali>>2;\r
+ rawdata.ir_raw_data = ir_data_cali>>2;\r
+#else\r
+ rawdata.red_raw_data = red_buf[ii];\r
+ rawdata.ir_raw_data = ir_buf[ii];\r
+#endif\r
+ rawdata.vector_flag = SPO2_VECTOR_FLAG;\r
+ rawdata.data_cnt = cal.G_LEDDAC;\r
+ rawdata.hr_result = spo2_alg_results.spo2_result;\r
+ rawdata.gsensor_x = (int16_t)(green_buf[ii]>>5);\r
+ rawdata.gsensor_y = cal.R_LEDDAC;\r
+ rawdata.gsensor_z = cal.IR_LEDDAC1;\r
+ rawdata.red_cur = cal.R_LED;\r
+ rawdata.ir_cur = cal.IR_LED1;\r
+ ble_rawdata_vector_push(rawdata);\r
+ }\r
+ ble_rawdata_send_handler();\r
+ }\r
+#endif\r
+\r
+/////////////////////////////////////////////////////////////////////////////////////////////////\r
+}\r
+#endif //defined(HRS_ALG_LIB) && defined (SPO2_ALG_LIB)\r
+\r
+#ifdef HRV_ALG_LIB\r
+hrv_sensor_data_t hrv_s_dat;\r
+void hx3695_hrv_ppg_Int_handle(void)\r
+{\r
+ uint8_t ii=0;\r
+ hrv_results_t hrv_alg_results= {MSG_HRV_ALG_NOT_OPEN,0,0,0,0,0,1,0,0};\r
+ int32_t *PPG_buf = &(hrv_s_dat.green_data[0]);\r
+ int32_t *ir_buf = &(hrv_s_dat.ir_data[0]);\r
+ uint8_t *count = &(hrv_s_dat.count);\r
+ hrv_wear_msg_code_t hrv_wear_status = MSG_HRV_NO_WEAR;\r
+ int16_t gsen_fifo_x_send[64]= {0};\r
+ int16_t gsen_fifo_y_send[64]= {0};\r
+ int16_t gsen_fifo_z_send[64]= {0};\r
+\r
+ // DEBUG_PRINTF("1111 \r\n" );\r
+#ifdef HRV_TESTVEC\r
+ int32_t hrm_raw_data;\r
+ hrm_raw_data = vec_data[vec_data_cnt];\r
+ vec_data_cnt++;\r
+ alg_hrv_results = hx3695_hrv_alg_send_data(hrm_raw_data, 0, 0);\r
+#else\r
+ if(hx3695_hrv_read(&hrv_s_dat) == 0)\r
+ {\r
+ TYHX_LOG("read ppg_s data invalid\r\n");\r
+ return;\r
+ }\r
+ \r
+#ifndef GSEN_40MS_TIMMER\r
+ readFifoByHrsModule();\r
+#endif\r
+ DEBUG_PRINTF("\r\nsend jlink cnt=%d\r\n",*count); \r
+ \r
+ for(ii=0; ii<*count; ii++)\r
+ {\r
+ gsen_fifo_x_send[ii] = gsen_fifo_x[32-8+ii%8];\r
+ gsen_fifo_y_send[ii] = gsen_fifo_y[32-8+ii%8];\r
+ gsen_fifo_z_send[ii] = gsen_fifo_z[32-8+ii%8];\r
+ // DEBUG_PRINTF("%d/%d %d %d %d %d %d \r\n" ,1+ii,*count,PPG_buf[ii],ir_buf[0],gsen_fifo_x_send[ii] ,gsen_fifo_y_send[ii] ,gsen_fifo_z_send[ii] );\r
+\r
+ }\r
+ hrv_wear_status = hx3695_hrv_get_wear_status();\r
+// DEBUG_PRINTF("wear:%d \r\n" ,hrv_wear_status);\r
+ if(hrv_wear_status==MSG_HRS_WEAR)\r
+ {\r
+ hrv_alg_results = tyhx_hrv_alg_send_bufdata(PPG_buf, *count, gsen_fifo_x_send, gsen_fifo_y_send, gsen_fifo_z_send);\r
+ hrsresult.lastesthrv = hrv_alg_results.hrv_result;\r
+ TYHX_LOG("get the hrv = %d\r\n",hrv_alg_results.hrv_result);\r
+ }\r
+ //--------------adjust----------------\r
+// hrv_alg_results.motion,hrv_alg_results.screen_up;\r
+ //DEBUG_PRINTF("data_cnt:%d hrv_result:%d motion:%d p_m:%d screen_up:%d signal_quality:%d \r\n", hrv_alg_results.data_cnt,hrv_alg_results.hrv_result,hrv_alg_results.motion,hrv_alg_results.p_m,hrv_alg_results.screen_up,hrv_alg_results.signal_quality);\r
+#endif\r
+\r
+/////////////////////////////////////////BLE+DISPLAY//////////////////////////////////////////\r
+\r
+\r
+#ifdef HRS_BLE_APP\r
+ {\r
+ rawdata_vector_t rawdata;\r
+ HRS_CAL_SET_T cal= get_hrs_agc_status();\r
+ for(ii=0; ii<*count; ii++)\r
+ {\r
+ rawdata.vector_flag = HRS_VECTOR_FLAG;\r
+ rawdata.data_cnt = 0;\r
+ rawdata.hr_result = hrv_alg_results.hrv_result;\r
+ rawdata.red_raw_data = PPG_buf[ii];\r
+ rawdata.ir_raw_data = 0;\r
+ rawdata.gsensor_x = gsen_fifo_x_send[ii];\r
+ rawdata.gsensor_y = gsen_fifo_y_send[ii];\r
+ rawdata.gsensor_z = gsen_fifo_z_send[ii];\r
+ rawdata.red_cur = cal.Group1_Cur;\r
+ rawdata.ir_cur = 0;\r
+ ble_rawdata_vector_push(rawdata);\r
+ }\r
+ }\r
+\r
+ ble_rawdata_send_handler();\r
+#endif\r
+\r
+//////////////////////////////////////////////////////////////////////////////////////////////\r
+}\r
+#endif\r
+\r
+#ifdef CHECK_TOUCH_LIB\r
+void hx3695_wear_ppg_Int_handle(void)\r
+{\r
+ uint8_t *count = &(ppg_s_data.count);\r
+ int32_t *ir_buf = &(ppg_s_data.ir_data[0]);\r
+ hx3695_wear_msg_code_t hx3695_wear_status;\r
+ \r
+ hx3695_check_touch_read(&ppg_s_data);\r
+ hx3695_wear_status = hx3695_check_touch_send_data(ir_buf,*count);\r
+ hrsresult.wearstatus = hx3695_wear_status;\r
+// for(int i=0;i<*count;i++)\r
+// {\r
+// DEBUG_PRINTF("%d,%d,%d,%d,%d,%d\r\n",1+i,*count,ir_buf[i],ppg_s_data.s_buf[i*2],ppg_s_data.s_buf[i*2+1],hx3695_wear_status);\r
+// }\r
+}\r
+#endif\r
+\r
+#ifdef LAB_TEST\r
+void hx3695_lab_test_Int_handle(void)\r
+{\r
+ NOISE_PS_T ps_noise;\r
+ ps_noise = hx3695_lab_test_read_packet();\r
+ DEBUG_PRINTF("%d %d %d %d\r\n", ps_noise.p1_noise, ps_noise.p2_noise, ps_noise.p3_noise, ps_noise.p4_noise);\r
+}\r
+#endif\r
+\r
+\r
+#endif //CHIP_HX3695\r
--- /dev/null
+#ifndef _hx3695_H_\r
+#define _hx3695_H_\r
+#include <stdint.h>\r
+#include <stdbool.h>\r
+\r
+/********************* alg_swi *********************\r
+HRS_ALG_LIB ÐÄÂʹ¦ÄÜ\r
+SPO2_ALG_LIB ѪÑõ¹¦ÄÜ\r
+HRV_ALG_LIB HRV¹¦ÄÜ\r
+CHECK_TOUCH_LIB ´¿Åå´÷¹¦ÄÜ£¨·ÇÐÄÂÊѪÑõģʽ£©\r
+CHECK_LIVING_LIB ´¿ÎïÌåʶ±ð¹¦ÄÜ£¨·ÇÐÄÂÊѪÑõģʽ£©\r
+BP_CUSTDOWN_ALG_LIB Ѫѹ¹¦ÄÜ\r
+\r
+TIMMER_MODE ¶¨Ê±Æ÷ģʽ£¬ ¶ÁPPGÊý¾Ý£¬ ĬÈϲÉÓö¨Ê±Æ÷ģʽ\r
+INT_MODE ÖжÏģʽ£¬¶ÁPPGÊý¾Ý\r
+\r
+DEMO_MI demoÏà¹ØÅäÖ㬠¿Í»§¹Ø±Õ£¬ ÔÚÏÂÃæelseÀï½øÐÐÅäÖÃ\r
+HRS_BLE_APP DEMOÀ¶ÑÀ¿ØÖƺ꣬ ¿Í»§¹Ø±Õ\r
+SPO2_DATA_CALI ѪÑõDC²¹³¥Ä£Ê½£¬ ¿Í»§¹Ø±Õ\r
+HRS_DEBUG µ÷ÊԺ꣬ ¸ù¾Ýƽ̨¶¨Òå´òÓ¡º¯Êý\r
+AGC_DEBUG µ÷ÊԺ꣬ ¸ù¾Ýƽ̨¶¨Òå´òÓ¡º¯Êý\r
+GSEN_40MS_TIMMER DEMOµ÷ÊÔʹÓ㬠¿Í»§¹Ø±Õ\r
+NEW_GSEN_SCHME DEMOµ÷ÊÔʹÓ㬠¿Í»§¹Ø±Õ\r
+*/\r
+#define HRS_ALG_LIB \r
+#define SPO2_ALG_LIB\r
+#define HRV_ALG_LIB\r
+//#define CHECK_TOUCH_LIB\r
+//#define CHECK_LIVING_LIB\r
+#define BP_CUSTDOWN_ALG_LIB\r
+\r
+//**************** read_data_mode ******************//\r
+#define TIMMER_MODE //timmer read fifo\r
+//#define INT_MODE //fifo_all_most_full\r
+\r
+//****************** gsen_cgf *********************//\r
+//#define GSEN_40MS_TIMMER\r
+//#define NEW_GSEN_SCHME\r
+\r
+//****************** other_cgf ********************//\r
+#define DEMO_COMMON\r
+//#define HRS_BLE_APP\r
+//#define SPO2_DATA_CALI\r
+\r
+//***************** vecter_swi ********************//\r
+//#define SPO2_VECTOR\r
+//#define HR_VECTOR\r
+//#define HRV_TESTVEC\r
+\r
+//**************** lab_test_mode ******************//\r
+//#define LAB_TEST \r
+//#define LAB_TEST_AGC \r
+\r
+//****************** print_swi ********************//\r
+//#define HRS_DEBUG\r
+//#define AGC_DEBUG\r
+\r
+//**************************************************//\r
+\r
+#ifdef AGC_DEBUG\r
+#define AGC_LOG(...) SEGGER_RTT_printf(0,__VA_ARGS__)\r
+#else\r
+#define AGC_LOG(...)\r
+#endif\r
+\r
+#ifdef HRS_DEBUG\r
+#define DEBUG_PRINTF(...) SEGGER_RTT_printf(0,__VA_ARGS__)\r
+#else\r
+#define DEBUG_PRINTF(...)\r
+#endif\r
+\r
+\r
+#if defined(DEMO_COMMON)\r
+ #define HRS4100_IIC_CLK 30\r
+ #define HRS4100_IIC_SDA 0 \r
+ #define LIS3DH_IIC_CLK 18\r
+ #define LIS3DH_IIC_SDA 16\r
+ #define EXT_INT_PIN 1\r
+ #define GREEN_LED_SLE 0x10\r
+ #define RED_LED_SLE 0x20\r
+ #define IR_LED_SLE 0x40\r
+ #define RED_AGC_OFFSET 64 //32\r
+ #define IR_AGC_OFFSET 64 //32\r
+ #define GREEN_AGC_OFFSET 4 //10\r
+ #define HR_GREEN_AGC_OFFSET 20\r
+ #define HR_GREEN1_AGC_OFFSET 24\r
+ #define HR_GREEN2_AGC_OFFSET 24\r
+ #define HR_GREEN3_AGC_OFFSET 24\r
+ \r
+ \r
+ \r
+ #define BIG_SCREEN\r
+ \r
+#elif defined(DEMO_MI)\r
+ #define HRS4100_IIC_CLK 30\r
+ #define HRS4100_IIC_SDA 0 \r
+ #define LIS3DH_IIC_CLK 18\r
+ #define LIS3DH_IIC_SDA 16\r
+ #define EXT_INT_PIN 1\r
+ #define GREEN_LED_SLE 1\r
+ #define RED_LED_SLE 2\r
+ #define IR_LED_SLE 4\r
+ #define RED_AGC_OFFSET 50\r
+ #define IR_AGC_OFFSET 50\r
+ #define GREEN_AGC_OFFSET 4\r
+ #define HR_GREEN_AGC_OFFSET 4\r
+ #define BIG_SCREEN\r
+ \r
+#elif defined(DEMO_NEW)\r
+ #define HRS4100_IIC_CLK 30\r
+ #define HRS4100_IIC_SDA 0 \r
+ #define LIS3DH_IIC_CLK 18\r
+ #define LIS3DH_IIC_SDA 16\r
+ #define EXT_INT_PIN 1\r
+ #define GREEN_LED_SLE 1\r
+ #define RED_LED_SLE 2\r
+ #define IR_LED_SLE 4\r
+ #define RED_AGC_OFFSET 75\r
+ #define IR_AGC_OFFSET 75\r
+ #define GREEN_AGC_OFFSET 4\r
+ #define HR_GREEN_AGC_OFFSET 8\r
+ #define BIG_SCREEN\r
+ \r
+#elif defined(EVB)\r
+ #define HRS4100_IIC_CLK 9\r
+ #define HRS4100_IIC_SDA 10 \r
+ #define LIS3DH_IIC_CLK 13\r
+ #define LIS3DH_IIC_SDA 14\r
+ #define EXT_INT_PIN 11\r
+ #define GREEN_LED_SLE 1\r
+ #define RED_LED_SLE 2\r
+ #define IR_LED_SLE 4\r
+ #define RED_AGC_OFFSET 64\r
+ #define IR_AGC_OFFSET 64\r
+ #define GREEN_AGC_OFFSET 8\r
+ #define HR_GREEN_AGC_OFFSET 10\r
+ \r
+#else\r
+ #define GREEN_LED_SLE 1\r
+ #define RED_LED_SLE 4\r
+ #define IR_LED_SLE 2\r
+ #define RED_AGC_OFFSET 64\r
+ #define IR_AGC_OFFSET 64\r
+ #define GREEN_AGC_OFFSET 8\r
+ \r
+#endif\r
+\r
+typedef enum { \r
+ PPG_INIT, \r
+ PPG_OFF, \r
+ PPG_LED_OFF,\r
+ CAL_INIT,\r
+ CAL_OFF,\r
+ RECAL_INIT \r
+} hx3695_mode_t;\r
+\r
+typedef enum { \r
+ SENSOR_OK, \r
+ SENSOR_OP_FAILED, \r
+} SENSOR_ERROR_T;\r
+\r
+\r
+typedef enum { \r
+ DATA_TYPE_PPG, \r
+ DATA_TYPE_GSEN, \r
+} SENSOR_TYPE_T;\r
+\r
+typedef enum { \r
+ HRS_MODE, \r
+ SPO2_MODE,\r
+ HRSPO2_MODE,\r
+ WEAR_MODE,\r
+ HRV_MODE,\r
+ LIVING_MODE,\r
+ LAB_TEST_MODE,\r
+ FT_LEAK_LIGHT_MODE,\r
+ FT_GRAY_CARD_MODE,\r
+ FT_INT_TEST_MODE,\r
+ FT_SINGLE_CHECK_MODE,\r
+ FT_LED_OFF_MODE,\r
+ FT_WEAR_MODE,\r
+ NULL_MODE,\r
+} WORK_MODE_T;\r
+\r
+\r
+//typedef struct {\r
+// uint8_t count;\r
+// int32_t green_data[64];\r
+// int32_t ir_data[64];\r
+// int32_t s_buf[64]; \r
+// uint32_t als;\r
+// uint32_t agc_green;\r
+//} hrs_sensor_data_t;\r
+\r
+\r
+typedef struct {\r
+ uint8_t count;\r
+ int32_t red_data[64];\r
+ int32_t green_data[64];\r
+ int32_t ir_data[64]; \r
+ int32_t s_buf[64];\r
+ uint8_t green_cur;\r
+ uint8_t red_cur; \r
+ uint8_t ir_cur;\r
+ uint8_t green_offset;\r
+ uint8_t red_offset; \r
+ uint8_t ir_offset; \r
+}ppg_sensor_data_t;\r
+\r
+typedef enum {\r
+ MSG_LIVING_INIT,\r
+ MSG_LIVING_NO_WEAR,\r
+ MSG_LIVING_WEAR\r
+} hx3695_living_wear_msg_code_t;\r
+\r
+typedef enum {\r
+ MSG_NO_WEAR,\r
+ MSG_WEAR\r
+} hx3695_wear_msg_code_t;\r
+\r
+typedef struct {\r
+ hx3695_living_wear_msg_code_t wear_status;\r
+ uint32_t data_cnt;\r
+ uint8_t signal_quality;\r
+ uint8_t motion_status;\r
+} hx3695_living_results_t;\r
+\r
+typedef struct {\r
+ int32_t p1_noise; \r
+ int32_t p2_noise; \r
+ int32_t p3_noise;\r
+ int32_t p4_noise;\r
+}NOISE_PS_T;\r
+\r
+\r
+extern uint8_t alg_ram[11*1024];\r
+//extern uint8_t alg_ram[10];\r
+\r
+void hx3695_delay_us(uint32_t us);\r
+void hx3695_delay_ms(uint32_t ms);\r
+bool hx3695_write_reg(uint8_t addr, uint8_t data); \r
+uint8_t hx3695_read_reg(uint8_t addr); \r
+bool hx3695_brust_read_reg(uint8_t addr , uint8_t *buf, uint8_t length);\r
+bool hx3695_chip_check(void);\r
+uint8_t hx3695_read_fifo_size(void);\r
+uint16_t hx3695_read_fifo_data(int32_t *s_buf, uint8_t size, uint8_t phase_num);\r
+void hx3695_ppg_off(void);\r
+void hx3695_ppg_on(void); \r
+void hx3695_320ms_timer_cfg(bool en);\r
+void hx3695_40ms_timer_cfg(bool en);\r
+void hx3695_gpioint_cfg(bool en);\r
+bool hx3695_init(WORK_MODE_T mode);\r
+void hx3695_agc_Int_handle(void); \r
+void hx3695_gesensor_Int_handle(void);\r
+void hx3695_spo2_ppg_init(void);\r
+void hx3695_spo2_data_cali_init(void);\r
+void hx3695_spo2_ppg_Int_handle(void);\r
+void hx3695_check_touch_init(void);\r
+void hx3695_wear_ppg_Int_handle(void);\r
+void hx3695_hrs_ppg_init(void);\r
+void hx3695_hrs_ppg_Int_handle(void);\r
+void hx3695_hrv_ppg_init(void);\r
+void hx3695_hrv_ppg_Int_handle(void);\r
+void hx3695_living_Int_handle(void);\r
+void hx3695_hrspo2_ppg_Int_handle(void);\r
+\r
+void hx3695_ppg_Int_handle(void);\r
+uint32_t hx3695_timers_start(void);\r
+uint32_t hx3695_timers_stop(void);\r
+uint32_t hx3695_gpioint_init(void);\r
+\r
+uint32_t hx3695_gpioint_enable(void);\r
+uint32_t hx3695_gpioint_disable(void);\r
+uint32_t gsen_read_timers_start(void);\r
+uint32_t gsen_read_timers_stop(void);\r
+\r
+void hx3695_vin_check(uint16_t led_vin);\r
+\r
+#ifdef LAB_TEST\r
+void hx3695_lab_test_init(void);\r
+void hx3695_test_alg_cfg(void);\r
+SENSOR_ERROR_T hx3695_lab_test_enable(void);\r
+void hx3695_lab_test_Int_handle(void);\r
+NOISE_PS_T hx3695_lab_test_read_packet(void);\r
+#endif\r
+\r
+bool hx3695_living_send_data(int32_t *new_raw_data, uint8_t dat_len, int16_t *gsen_data_x, int16_t *gsen_data_y, int16_t *gsen_data_z);\r
+hx3695_living_results_t hx3695_living_get_results(void);\r
+void agc_timeout_handler(void * p_context);\r
+void heart_rate_meas_timeout_handler(void * p_context);\r
+\r
+#endif\r
--- /dev/null
+#include <stdio.h>\r
+#include <stdbool.h>\r
+#include <stdint.h>\r
+#include <stdlib.h>\r
+#include <math.h>\r
+\r
+\r
+#include "tyhx_hrs_custom.h"\r
+#include "hx3695.h"\r
+#include "hx3695_check_touch.h"\r
+\r
+\r
+\r
+hx3695_wear_msg_code_t hx3695_wear_status = MSG_NO_WEAR;\r
+hx3695_wear_msg_code_t hx3695_wear_status_pre = MSG_NO_WEAR;\r
+extern uint8_t hrs_phase_num;\r
+extern const int32_t check_mode_unwear_thre;\r
+extern const int32_t check_mode_wear_thre;\r
+static uint8_t notouch_cnt = 0;\r
+static uint8_t touch_cnt = 0;\r
+\r
+#ifdef CHECK_TOUCH_LIB\r
+\r
+\r
+SENSOR_ERROR_T hx3695_check_touch_enable(void)\r
+{\r
+ if (!hx3695_chip_check())\r
+ {\r
+ AGC_LOG("hx3695 check id failed!\r\n");\r
+ return SENSOR_OP_FAILED;\r
+ }\r
+\r
+ AGC_LOG("hx3695 check id success!\r\n");\r
+\r
+ hx3695_check_touch_init();\r
+ hx3695_delay_ms(100); \r
+// uint16_t i,reg_value ;\r
+// for(i = 0;i < 0x7f; i++)\r
+// {\r
+// reg_value = hx3695_read_reg(i);\r
+// AGC_LOG("Reg_value: %x, 0x%x \r\n",i,reg_value);\r
+// \r
+// hx3695_delay_ms(5);\r
+// }\r
+ \r
+ \r
+// AGC_LOG("hx3695 here!\r\n");\r
+ hx3695_delay_ms(100); \r
+ \r
+ hx3695_320ms_timer_cfg(true);\r
+\r
+ return SENSOR_OK;\r
+}\r
+\r
+//uint8_t hx3695_check_touch_read_fifo(int32_t *ir_buf)\r
+//{\r
+// uint8_t data_flg = 127;\r
+// int32_t data;\r
+// uint8_t databuf[3];\r
+// uint8_t ii=0;\r
+// uint8_t data_size=0;\r
+// uint8_t count=0;\r
+// int32_t buf[64];\r
+\r
+// data_size = hx3695_read_fifo_size();\r
+// count = data_size>>1;\r
+// data_size = count*2;\r
+\r
+// for(ii=0; ii<data_size; ii++)\r
+// {\r
+// hx3695_write_reg(0x17, 0x00); // write any walue to 0x17 will update a new data\r
+// hx3695_delay_us(100);\r
+// hx3695_brust_read_reg(0x15, databuf, 3);\r
+// data_flg = databuf[2]>>5;\r
+// data = (int32_t)(databuf[0]|(databuf[1]<<8)|((databuf[2]&0x1f)<<16));\r
+\r
+// if(ii==0)\r
+// {\r
+// if(data_flg ==3)\r
+// {\r
+// ii=3;\r
+// buf[0] = 0;\r
+// buf[1] = 0;\r
+// buf[2] = 0;\r
+// }\r
+// if(data_flg ==2)\r
+// {\r
+// ii=2;\r
+// buf[0] = 0;\r
+// buf[1] = 0;\r
+// }\r
+// if(data_flg ==1)\r
+// {\r
+// ii=1;\r
+// buf[0] = 0;\r
+// }\r
+// }\r
+\r
+// if(data_flg == 0)\r
+// {\r
+// buf[ii]= data;\r
+// }\r
+// else if(data_flg == 1)\r
+// {\r
+// buf[ii]= data;\r
+// }\r
+// else if(data_flg == 2)\r
+// {\r
+// buf[ii]= data;\r
+// }\r
+// else if(data_flg == 3)\r
+// {\r
+// buf[ii]= data;\r
+// }\r
+// }\r
+// for (ii=0; ii<count; ii++)\r
+// {\r
+// //DEBUG_PRINTF(0,"%d %d %d\r\n" ,buf[ii*2],buf[ii*2+1],hx3695_read_reg(0x2c));\r
+// if(buf[ii*2]>buf[ii*2+1])\r
+// {\r
+// ir_buf[ii] = buf[ii*2] - buf[ii*2+1];\r
+// }\r
+// else\r
+// {\r
+// ir_buf[ii] = 0;\r
+// }\r
+// }\r
+// return count;\r
+//}\r
+\r
+\r
+uint8_t hx3695_check_touch_read(ppg_sensor_data_t *s_dat)\r
+{\r
+ uint8_t i=0;\r
+ uint8_t size = 0;\r
+ uint8_t fifo_out_size = 0;\r
+ int32_t *green_data = &(s_dat->green_data[0]);\r
+ int32_t *ir_buf = &(s_dat->ir_data[0]);\r
+ int32_t *s_buf = &(s_dat->s_buf[0]);\r
+\r
+// size = hx3695_read_fifo_size();\r
+// \r
+// if(size<2)\r
+// {\r
+// return 0;\r
+// }\r
+\r
+// if (size && size <= 256)\r
+// {\r
+ fifo_out_size = hx3695_read_fifo_data(s_buf,hrs_phase_num,2);\r
+ s_dat->count = fifo_out_size;\r
+ for (i=0; i<fifo_out_size; i++)\r
+ { \r
+ green_data[i] = (s_buf[i*3]);\r
+ ir_buf[i] = (s_buf[i*3+2] );\r
+ TYHX_LOG("touch_green:%d/%d %d, touch_ir: %d \r\n" ,1+i,fifo_out_size,green_data[i],s_buf[i*3+2]);\r
+ }\r
+// }\r
+ return size;\r
+}\r
+\r
+hx3695_wear_msg_code_t hx3695_check_touch_send_data(int32_t *ir_data, uint8_t count)\r
+{\r
+ uint8_t ii;\r
+ hx3695_wear_msg_code_t wear_status;\r
+ if(count==0)\r
+ {\r
+ return wear_status;\r
+ }\r
+ for(ii=0; ii<count; ii++)\r
+ {\r
+ wear_status = check_touch_alg(ir_data[ii]);\r
+ }\r
+ return wear_status;\r
+}\r
+\r
+hx3695_wear_msg_code_t check_touch_alg(int32_t ir_data)\r
+{\r
+ if(ir_data>check_mode_wear_thre)\r
+ {\r
+ notouch_cnt = 0;\r
+ if(touch_cnt>=2)\r
+ {\r
+ hx3695_wear_status = MSG_WEAR;\r
+ touch_cnt=0;\r
+ }\r
+ else\r
+ {\r
+ touch_cnt++;\r
+ }\r
+ }\r
+ else if(ir_data<check_mode_unwear_thre)\r
+ {\r
+ touch_cnt = 0;\r
+ if(notouch_cnt>=2)\r
+ {\r
+ hx3695_wear_status = MSG_NO_WEAR;\r
+ notouch_cnt=0;\r
+ }\r
+ else\r
+ {\r
+ notouch_cnt++;\r
+ }\r
+ }\r
+ return hx3695_wear_status;\r
+}\r
+#endif\r
--- /dev/null
+#ifndef _HX3695_CHECK_TOUCH_H_\r
+#define _HX3695_CHECK_TOUCH_H_\r
+\r
+#include <stdint.h>\r
+#include <stdbool.h>\r
+#include "hx3695.h"\r
+#include "hx3695.h"\r
+#include "hx3695_hrv_agc.h"\r
+\r
+\r
+hx3695_wear_msg_code_t check_touch_alg(int32_t ir_data);\r
+SENSOR_ERROR_T hx3695_check_touch_enable(void);\r
+uint8_t hx3695_check_touch_read(ppg_sensor_data_t *s_dat);\r
+hx3695_wear_msg_code_t hx3695_check_touch_send_data(int32_t *ir_data, uint8_t count);\r
+hx3695_wear_msg_code_t check_touch_alg(int32_t ir_data);\r
+\r
+#endif\r
--- /dev/null
+#include <stdio.h>\r
+#include <stdbool.h>\r
+#include <stdint.h>\r
+#include <stdlib.h>\r
+#include <math.h>\r
+\r
+#include "tyhx_hrs_custom.h"\r
+#include "hx3695.h"\r
+#include "hx3695_factory_test.h"\r
+\r
+\r
+void hx3695_factory_wear_mode_config(void)\r
+{\r
+ uint16_t sample_rate = 10; /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+ uint32_t prf_clk_num = 32000/sample_rate; /*period in clk num, num = Fclk/fs */\r
+ \r
+ uint8_t adc_rst_post_num=0; /* 00=16,01=32,10=64,11=128*/ \r
+ uint8_t samp_delay_leden_num = 0; /* 00=8,01=16,10=32,11=64*/ \r
+ uint8_t samp_copy_avg = 0; /* 0=1, 1=2, 2=4 ,3=8, 4=16*/\r
+ uint8_t data_avg_num = 0; /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+ uint8_t phase7_8_internal = 0; /* phase7 and phase8 prf internal cfg */\r
+ \r
+ uint8_t phase1_enable = 1; /*phase1_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase2_enable = 1; /*phase2_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase3_enable = 0; /*phase3_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase4_enable = 0; /*phase4_enable , 1 mean enable ; 0 mean disable */\r
+ uint8_t phase5_enable = 0; /*phase5_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase6_enable = 0; /*phase6_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase7_enable = 0; /*phase7_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase8_enable = 0; /*phase8_enable , 1 mean enable ; 0 mean disable */ \r
+\r
+ uint8_t phase1_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase2_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase3_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase4_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase5_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase6_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase7_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase8_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ \r
+ uint8_t phase1_mux_sel = 0; /* sel phase1*/\r
+ uint8_t phase2_mux_sel = 1; /* sel phase2*/\r
+ uint8_t phase3_mux_sel = 2; /* sel phase3*/\r
+ uint8_t phase4_mux_sel = 3; /* sel phase4*/\r
+ uint8_t phase5_mux_sel = 4; /* sel phase5*/\r
+ uint8_t phase6_mux_sel = 5; /* sel phase6*/\r
+ uint8_t phase7_mux_sel = 6; /* sel phase7*/\r
+ uint8_t phase8_mux_sel = 7; /* sel phase8*/\r
+ \r
+\r
+ uint8_t phase1_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase1_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase1_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase1_led_drv1_cha_sel = 0x10; /* 1 = ldr1 NG; 2 = ldr2 GR; 4 = ldr3 IR; 8 = ldr4 RED; */\r
+ uint8_t phase1_led_drv2_cha_sel = 0; /*ldr5:0x20 ldr6: 0x40 red ldr8 0x80 ir */\r
+ uint8_t phase1_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase1_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase1_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase1_ldr1_cur = 64; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase1_ldr2_cur = 0;\r
+// uint8_t phase1_of_idac1_cur = 0;\r
+// uint8_t phase1_of_idac2_cur = 0;\r
+ uint8_t phase1_ad_inr_ctrl = 3;\r
+ uint8_t phase1_ad_of_idac_ctrl = 0;\r
+// uint8_t afe_offset = 0;\r
+ uint8_t phase1_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase1_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase1_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+\r
+\r
+ uint8_t phase2_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase2_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase2_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase2_led_drv1_cha_sel = 0; //GREEN_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase2_led_drv2_cha_sel = 0;\r
+ uint8_t phase2_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase2_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase2_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase2_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase2_ldr2_cur = 0;\r
+// uint8_t phase2_of_idac1_cur = 0;\r
+// uint8_t phase2_of_idac2_cur = 0;\r
+ uint8_t phase2_ad_inr_ctrl = 3;\r
+ uint8_t phase2_ad_of_idac_ctrl = 0;\r
+// uint8_t phase2_afe_offset = 0;\r
+ uint8_t phase2_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase2_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase2_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ \r
+ uint8_t phase3_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase3_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase3_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase3_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase3_led_drv2_cha_sel = 0;\r
+ uint8_t phase3_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase3_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase3_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase3_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase3_ldr2_cur = 0;\r
+// uint8_t phase3_of_idac1_cur = 0;\r
+// uint8_t phase3_of_idac2_cur = 0;\r
+ uint8_t phase3_ad_inr_ctrl = 3;\r
+ uint8_t phase3_ad_of_idac_ctrl = 0;\r
+// uint8_t phase3_afe_offset = 0;\r
+ uint8_t phase3_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase3_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase3_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ \r
+ uint8_t phase4_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase4_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase4_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase4_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase4_led_drv2_cha_sel = 0;\r
+ uint8_t phase4_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase4_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase4_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase4_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase4_ldr2_cur = 0;\r
+// uint8_t phase4_of_idac1_cur = 0;\r
+// uint8_t phase4_of_idac2_cur = 0;\r
+ uint8_t phase4_ad_inr_ctrl = 3;\r
+ uint8_t phase4_ad_of_idac_ctrl = 0;\r
+// uint8_t phase4_afe_offset = 0;\r
+ uint8_t phase4_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase4_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase4_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase5_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase5_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase5_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase5_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase5_led_drv2_cha_sel = 0;\r
+ uint8_t phase5_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase5_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase5_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase5_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase5_ldr2_cur = 0;\r
+// uint8_t phase5_of_idac1_cur = 0;\r
+// uint8_t phase5_of_idac2_cur = 0;\r
+ uint8_t phase5_ad_inr_ctrl = 3;\r
+ uint8_t phase5_ad_of_idac_ctrl = 0;\r
+// uint8_t phase5_afe_offset = 0;\r
+ uint8_t phase5_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase5_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase5_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase6_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase6_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase6_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase6_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase6_led_drv2_cha_sel = 0;\r
+ uint8_t phase6_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase6_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase6_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase6_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase6_ldr2_cur = 0;\r
+// uint8_t phase6_of_idac1_cur = 0;\r
+// uint8_t phase6_of_idac2_cur = 0;\r
+ uint8_t phase6_ad_inr_ctrl = 3;\r
+ uint8_t phase6_ad_of_idac_ctrl = 0;\r
+// uint8_t phase6_afe_offset = 0;\r
+ uint8_t phase6_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase6_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase6_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase7_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase7_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase7_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase7_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase7_led_drv2_cha_sel = 0;\r
+ uint8_t phase7_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase7_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase7_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase7_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase7_ldr2_cur = 0;\r
+// uint8_t phase7_of_idac1_cur = 0;\r
+// uint8_t phase7_of_idac2_cur = 0;\r
+ uint8_t phase7_ad_inr_ctrl = 3;\r
+ uint8_t phase7_ad_of_idac_ctrl = 0;\r
+// uint8_t phase7_afe_offset = 0;\r
+ uint8_t phase7_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase7_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase7_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase8_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase8_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase8_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase8_led_drv1_cha_sel = 0; //IR_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase8_led_drv2_cha_sel = 0;\r
+ uint8_t phase8_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase8_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase8_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase8_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase8_ldr2_cur = 0;\r
+// uint8_t phase8_of_idac1_cur = 0;\r
+// uint8_t phase8_of_idac2_cur = 0;\r
+ uint8_t phase8_ad_inr_ctrl = 3;\r
+ uint8_t phase8_ad_of_idac_ctrl = 0;\r
+// uint8_t phase8_afe_offset = 0;\r
+ uint8_t phase8_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase8_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase8_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t init_wait_delay = 5 ; /* 0 = 31clk ; 1 = 64clk ; 2 = 127clk ; 3 = 255clk(d) ;\r
+ 4 = 511clk; 5 = 1023clk; 6 = 2047; 7 = 4095clk */ \r
+ \r
+ uint8_t afe_reset = 3; /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d) ;\r
+ 4 = 255clk; 5 = 511clk; 6 = 1024; 7 = 2047clk */\r
+ \r
+ uint8_t afe_rst_cnvt = 1; /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d)*/\r
+ \r
+ uint8_t led_en_idac_pre = 2; /* 0 = 8clk ; 1 = 16clk ; 2 = 32clk ; 3 = 64clk(d)*/ \r
+ \r
+ uint8_t led_en_idac = 1; /* 0 = 4clk ; 1 = 8clk ; 2 = 16clk ; 3 = 32clk(d)*/ \r
+ \r
+ uint8_t led_on_time = 2; /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+ 4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+ \r
+ hx3695_delay_ms(10); \r
+ \r
+ hx3695_write_reg(0X2a, (uint8_t)prf_clk_num); // prf bit<7:0>6\r
+ hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+ hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16> \r
+ \r
+ hx3695_write_reg(0X25, (afe_rst_cnvt<<4| led_en_idac_pre<<2|led_en_idac)); \r
+ hx3695_write_reg(0X2d, phase7_8_internal); \r
+ hx3695_write_reg(0X2e, 0x33);// gpio ctrl \r
+ hx3695_write_reg(0X2f, ((afe_reset<<4)| init_wait_delay));\r
+ hx3695_write_reg(0X30, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+ hx3695_write_reg(0X72, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+\r
+\r
+ hx3695_write_reg(0X31, (led_on_time<<4| 0x00));\r
+ hx3695_write_reg(0X33, 0x83);// Öжϼ«ÐÔ¼°¿í¶ÈÅäÖã»\r
+ hx3695_write_reg(0X34, 0x00);// ÖжÏÌØÊâÅäÖã»\r
+ hx3695_write_reg(0X36, 0x00);// phase data ready ±êÖ¾ÉèÖã»\r
+ hx3695_write_reg(0X38, 0x00);\r
+ \r
+ hx3695_write_reg(0X3a, (phase1_inner_avg | (phase2_inner_avg<<4))); \r
+ hx3695_write_reg(0X3b, (phase3_inner_avg | (phase4_inner_avg<<4))); \r
+ hx3695_write_reg(0X3c, (phase5_inner_avg | (phase6_inner_avg<<4))); \r
+ hx3695_write_reg(0X3d, (phase7_inner_avg | (phase8_inner_avg<<4))); \r
+ hx3695_write_reg(0X3e, adc_rst_post_num<<6 | samp_delay_leden_num<<4 | samp_copy_avg); \r
+ hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+ \r
+ hx3695_write_reg(0X43, phase1_mux_sel); \r
+ hx3695_write_reg(0X44, phase1_tia_cap<<4|phase1_tia_res); \r
+ hx3695_write_reg(0X45, phase1_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase1_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase1_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase1_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+\r
+ hx3695_write_reg(0X49, phase1_ad_inr_ctrl<<4|phase1_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase1_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase1_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase1_dsp_mov_avg_num | phase1_dsp_iir_lp_coeff<<4);\r
+\r
+// hx3695_write_reg(0X4e, thred_value);\r
+// hx3695_write_reg(0X4f, thred_value>>5);\r
+ \r
+ hx3695_write_reg(0X43, phase2_mux_sel); \r
+ hx3695_write_reg(0X44, phase2_tia_cap<<4|phase2_tia_res); \r
+ hx3695_write_reg(0X45, phase2_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase2_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase2_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase2_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase2_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase2_ad_inr_ctrl<<4|phase2_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase2_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase2_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase2_dsp_mov_avg_num | phase2_dsp_iir_lp_coeff<<4);\r
+ \r
+//phase3 sel\r
+\r
+ hx3695_write_reg(0X43, phase3_mux_sel); \r
+ hx3695_write_reg(0X44, phase3_tia_cap<<4|phase3_tia_res); \r
+ hx3695_write_reg(0X45, phase3_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase3_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase3_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase3_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase3_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase3_ad_inr_ctrl<<4|phase3_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase3_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase3_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase3_dsp_mov_avg_num | phase3_dsp_iir_lp_coeff<<4);\r
+ \r
+//phase4 sel\r
+\r
+ hx3695_write_reg(0X43, phase4_mux_sel); \r
+ hx3695_write_reg(0X44, phase4_tia_cap<<4|phase4_tia_res); \r
+ hx3695_write_reg(0X45, phase4_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase4_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase4_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase4_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase4_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase4_ad_inr_ctrl<<4|phase4_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase4_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase4_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase4_dsp_mov_avg_num | phase4_dsp_iir_lp_coeff<<4);\r
+\r
+ hx3695_write_reg(0X43, phase5_mux_sel); \r
+ hx3695_write_reg(0X44, phase5_tia_cap<<4|phase5_tia_res); \r
+ hx3695_write_reg(0X45, phase5_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase5_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase5_pd_sel)); //<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase5_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase5_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase5_ad_inr_ctrl<<4|phase5_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase5_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase5_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase5_dsp_mov_avg_num | phase5_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase6_mux_sel); \r
+ hx3695_write_reg(0X44, phase6_tia_cap<<4|phase6_tia_res); \r
+ hx3695_write_reg(0X45, phase6_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase6_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase6_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase6_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase6_ad_inr_ctrl<<4|phase6_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase6_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase6_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase6_dsp_mov_avg_num | phase6_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase7_mux_sel); \r
+ hx3695_write_reg(0X44, phase7_tia_cap<<4|phase7_tia_res); \r
+ hx3695_write_reg(0X45, phase7_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase7_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase7_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase7_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase7_ad_inr_ctrl<<4|phase7_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase7_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase7_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase7_dsp_mov_avg_num | phase7_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase8_mux_sel); \r
+ hx3695_write_reg(0X44, phase8_tia_cap<<4|phase8_tia_res); \r
+ hx3695_write_reg(0X45, phase8_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase8_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase8_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase8_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase8_led_offset_idac);\r
+// hx3695_write_reg(0X48, phas8_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase8_ad_inr_ctrl<<4|phase8_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase8_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase8_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase8_dsp_mov_avg_num | phase8_dsp_iir_lp_coeff<<4);\r
+ \r
+\r
+// analog circuit cfg \r
+ hx3695_write_reg(0X60, 0x14); //\r
+ hx3695_write_reg(0X61, 0xf0); \r
+ hx3695_write_reg(0X62, 0x22); \r
+ hx3695_write_reg(0X63, 0x15); \r
+ \r
+ hx3695_write_reg(0X64, 0x08); \r
+ hx3695_write_reg(0X65, 0x88); //bug\r
+ \r
+ hx3695_write_reg(0X66, 0x30); // bits<3>=adc selftest en 0x30\r
+ hx3695_write_reg(0X67, 0x23); \r
+ hx3695_write_reg(0X68, 0x46); \r
+ hx3695_write_reg(0X69, 0x42); \r
+ \r
+ hx3695_write_reg(0X39, 0xff); // ofset idac1 phase enable cfg\r
+ hx3695_write_reg(0x73, 0xff); //led_offset_idac phase enable\r
+ \r
+ hx3695_write_reg(0X6a, 0X0f); \r
+ hx3695_write_reg(0X6b, 0X22); \r
+ hx3695_write_reg(0X6c, 0X00); \r
+ hx3695_write_reg(0X6d, 0X37); \r
+ hx3695_write_reg(0X6e, 0X82); \r
+ hx3695_write_reg(0X6f, 0X08);\r
+/////////FIFO and adc conversion ready config////////\r
+/////////FIFO and adc conversion ready config////////\r
+#if defined(PPG_INT_MODE)\r
+ hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble\r
+ hx3695_write_reg(0X33, 0x83); // int width \r
+ hx3695_write_reg(0X21, 0x00); // fifo int sel,00=FIFO INT config clear\r
+ hx3695_write_reg(0X38, 0x01); // int sel,00=close almost full int,04=enable almost full int\r
+#elif defined(INT_MODE) //FIFO_ALL_MOST_FULL)\r
+ hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble\r
+ hx3695_write_reg(0X1c, (fifo_watermark&0xff)); //fifo_watermark\r
+ hx3695_write_reg(0X1d, fifo_watermark<<8); //bit<0>=fifo_watermark[8] \r
+ hx3695_write_reg(0X33, 0x83); // int width \r
+ hx3695_write_reg(0X21, 0x00); // fifo int sel,00=FIFO INT config clear\r
+ hx3695_write_reg(0X38, 0x04); // int sel,00=close almost full int,04=enable almost full int\r
+\r
+#else\r
+ hx3695_write_reg(0X1b, 0x92); // bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble \r
+ hx3695_write_reg(0X38, 0x01); // int sel,00=close almost full int,04=enable almost full int\r
+ \r
+#endif\r
+\r
+ \r
+ hx3695_write_reg(0X26,(phase1_enable<<3)|(phase1_adc_osr)|(phase2_enable<<7)|(phase2_adc_osr<<4) ); \r
+ hx3695_write_reg(0X27,(phase3_enable<<3)|(phase3_adc_osr)|(phase4_enable<<7)|(phase4_adc_osr<<4) ); \r
+ hx3695_write_reg(0X28,(phase5_enable<<3)|(phase5_adc_osr)|(phase6_enable<<7)|(phase6_adc_osr<<4) );\r
+ hx3695_write_reg(0X29,(phase7_enable<<3)|(phase7_adc_osr)|(phase8_enable<<7)|(phase8_adc_osr<<4) ); \r
+\r
+// hx3695_write_reg(0X5c, 0x02);//soft reset\r
+ hx3695_delay_ms(5); \r
+ hx3695_write_reg(0X5c, 0x00);//release\r
+// read_fifo_first_flg = 1;\r
+ return ;\r
+ \r
+ \r
+ \r
+}\r
+\r
+void hx3695_factory_ft_card_test_config(void)//»Ò¿¨15mm¸ß¶È²âÊÔÅäÖÃ\r
+{\r
+ uint16_t sample_rate = 25; /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+ uint32_t prf_clk_num = 32000/sample_rate; /*period in clk num, num = Fclk/fs */\r
+ \r
+// uint16_t fifo_watermark= 250 ;\r
+ uint8_t adc_rst_post_num= 0; /* 00=16,01=32,10=64,11=128*/ \r
+ uint8_t samp_delay_leden_num = 0; /* 00=8,01=16,10=32,11=64*/ \r
+ uint8_t samp_copy_avg = 0; /* 0=1, 1=2, 2=4 ,3=8, 4=16*/\r
+ uint8_t data_avg_num = 0; /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+ uint8_t phase7_8_internal = 0; //0x18; /* phase7 and phase8 prf internal cfg */\r
+ \r
+// uint16_t thred_value = 32500;\r
+ \r
+ uint8_t phase1_enable = 1; /*phase1_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase2_enable = 1; /*phase2_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase3_enable = 1; /*phase3_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase4_enable = 1; /*phase4_enable , 1 mean enable ; 0 mean disable */\r
+ uint8_t phase5_enable = 0; /*phase5_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase6_enable = 0; /*phase6_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase7_enable = 0; /*phase7_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase8_enable = 0; /*phase8_enable , 1 mean enable ; 0 mean disable */ \r
+\r
+ uint8_t phase1_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase2_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase3_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase4_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase5_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase6_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase7_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase8_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ \r
+ uint8_t phase1_mux_sel = 0; /* sel phase1*/\r
+ uint8_t phase2_mux_sel = 1; /* sel phase2*/\r
+ uint8_t phase3_mux_sel = 2; /* sel phase3*/\r
+ uint8_t phase4_mux_sel = 3; /* sel phase4*/\r
+ uint8_t phase5_mux_sel = 4; /* sel phase5*/\r
+ uint8_t phase6_mux_sel = 5; /* sel phase6*/\r
+ uint8_t phase7_mux_sel = 6; /* sel phase7*/\r
+ uint8_t phase8_mux_sel = 7; /* sel phase8*/\r
+ \r
+\r
+ uint8_t phase1_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase1_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase1_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase1_led_drv1_cha_sel = 0; /* 1 = ldr1 NG; 2 = ldr2 GR; 4 = ldr3 IR; 8 = ldr4 RED; */\r
+ uint8_t phase1_led_drv2_cha_sel = 0; /*ldr5:0x20 ldr6: 0x40 red ldr8 0x80 ir */\r
+ uint8_t phase1_pd_sel = 0x0a; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase1_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase1_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase1_ldr1_cur = 32; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase1_ldr2_cur = 0;\r
+// uint8_t phase1_of_idac1_cur = 0;\r
+// uint8_t phase1_of_idac2_cur = 0;\r
+ uint8_t phase1_ad_inr_ctrl = 3;\r
+ uint8_t phase1_ad_of_idac_ctrl = 0;\r
+// uint8_t afe_offset = 0;\r
+ uint8_t phase1_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase1_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase1_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+\r
+\r
+ uint8_t phase2_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase2_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase2_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase2_led_drv1_cha_sel = GREEN_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase2_led_drv2_cha_sel = 0x00;\r
+ uint8_t phase2_pd_sel = 0x0a; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase2_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase2_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase2_ldr1_cur = 32; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase2_ldr2_cur = 0;\r
+// uint8_t phase2_of_idac1_cur = 0;\r
+// uint8_t phase2_of_idac2_cur = 0;\r
+ uint8_t phase2_ad_inr_ctrl = 3;\r
+ uint8_t phase2_ad_of_idac_ctrl = 0;\r
+// uint8_t phase2_afe_offset = 0;\r
+ uint8_t phase2_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase2_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase2_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ \r
+ uint8_t phase3_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase3_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase3_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase3_led_drv1_cha_sel = RED_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase3_led_drv2_cha_sel = 0;\r
+ uint8_t phase3_pd_sel = 0x0a; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase3_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase3_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase3_ldr1_cur = 32; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase3_ldr2_cur = 0;\r
+// uint8_t phase3_of_idac1_cur = 0;\r
+// uint8_t phase3_of_idac2_cur = 0;\r
+ uint8_t phase3_ad_inr_ctrl = 3;\r
+ uint8_t phase3_ad_of_idac_ctrl = 0;\r
+// uint8_t phase3_afe_offset = 0;\r
+ uint8_t phase3_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase3_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase3_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ \r
+ uint8_t phase4_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase4_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase4_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase4_led_drv1_cha_sel = IR_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase4_led_drv2_cha_sel = 0;\r
+ uint8_t phase4_pd_sel = 0x0a; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase4_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase4_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase4_ldr1_cur = 32; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase4_ldr2_cur = 0;\r
+// uint8_t phase4_of_idac1_cur = 0;\r
+// uint8_t phase4_of_idac2_cur = 0;\r
+ uint8_t phase4_ad_inr_ctrl = 3;\r
+ uint8_t phase4_ad_of_idac_ctrl = 0;\r
+// uint8_t phase4_afe_offset = 0;\r
+ uint8_t phase4_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase4_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase4_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase5_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase5_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase5_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase5_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase5_led_drv2_cha_sel = 0;\r
+ uint8_t phase5_pd_sel = 0x0a; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase5_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase5_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase5_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase5_ldr2_cur = 0;\r
+// uint8_t phase5_of_idac1_cur = 0;\r
+// uint8_t phase5_of_idac2_cur = 0;\r
+ uint8_t phase5_ad_inr_ctrl = 3;\r
+ uint8_t phase5_ad_of_idac_ctrl = 0;\r
+// uint8_t phase5_afe_offset = 0;\r
+ uint8_t phase5_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase5_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase5_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase6_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase6_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase6_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase6_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase6_led_drv2_cha_sel = 0;\r
+ uint8_t phase6_pd_sel = 4; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase6_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase6_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase6_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase6_ldr2_cur = 0;\r
+// uint8_t phase6_of_idac1_cur = 0;\r
+// uint8_t phase6_of_idac2_cur = 0;\r
+ uint8_t phase6_ad_inr_ctrl = 3;\r
+ uint8_t phase6_ad_of_idac_ctrl = 0;\r
+// uint8_t phase6_afe_offset = 0;\r
+ uint8_t phase6_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase6_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase6_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase7_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase7_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase7_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase7_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase7_led_drv2_cha_sel = 0;\r
+ uint8_t phase7_pd_sel = 0x00; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase7_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase7_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase7_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase7_ldr2_cur = 0;\r
+// uint8_t phase7_of_idac1_cur = 0;\r
+// uint8_t phase7_of_idac2_cur = 0;\r
+ uint8_t phase7_ad_inr_ctrl = 3;\r
+ uint8_t phase7_ad_of_idac_ctrl = 0;\r
+// uint8_t phase7_afe_offset = 0;\r
+ uint8_t phase7_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase7_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase7_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase8_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase8_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase8_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase8_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase8_led_drv2_cha_sel = 0;\r
+ uint8_t phase8_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase8_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase8_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase8_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase8_ldr2_cur = 0;\r
+// uint8_t phase8_of_idac1_cur = 0;\r
+// uint8_t phase8_of_idac2_cur = 0;\r
+ uint8_t phase8_ad_inr_ctrl = 3;\r
+ uint8_t phase8_ad_of_idac_ctrl = 0;\r
+// uint8_t phase8_afe_offset = 0;\r
+ uint8_t phase8_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase8_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase8_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t init_wait_delay = 4 ; /* 0 = 31clk ; 1 = 64clk ; 2 = 127clk ; 3 = 255clk(d) ;\r
+ 4 = 511clk; 5 = 1023clk; 6 = 2047; 7 = 4095clk */ \r
+ \r
+ uint8_t afe_reset = 3; /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d) ;\r
+ 4 = 255clk; 5 = 511clk; 6 = 1024; 7 = 2047clk */\r
+ \r
+ uint8_t afe_rst_cnvt = 1; /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d)*/\r
+ \r
+ uint8_t led_en_idac_pre = 2; /* 0 = 8clk ; 1 = 16clk ; 2 = 32clk ; 3 = 64clk(d)*/ \r
+ \r
+ uint8_t led_en_idac = 1; /* 0 = 4clk ; 1 = 8clk ; 2 = 16clk ; 3 = 32clk(d)*/ \r
+ \r
+ uint8_t led_on_time = 2; /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+ 4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+ \r
+ hx3695_delay_ms(10); \r
+ \r
+ hx3695_write_reg(0X2a, (uint8_t)prf_clk_num); // prf bit<7:0>6\r
+ hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+ hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16> \r
+ \r
+ hx3695_write_reg(0X25, (afe_rst_cnvt<<4| led_en_idac_pre<<2|led_en_idac)); \r
+ hx3695_write_reg(0X2d, phase7_8_internal); \r
+ hx3695_write_reg(0X2e, 0x33);// gpio ctrl \r
+ hx3695_write_reg(0X2f, ((afe_reset<<4)| init_wait_delay));\r
+ hx3695_write_reg(0X30, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+ hx3695_write_reg(0X72, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+\r
+\r
+ hx3695_write_reg(0X31, (led_on_time<<4| 0x00));\r
+ hx3695_write_reg(0X33, 0x83);// Öжϼ«ÐÔ¼°¿í¶ÈÅäÖã»\r
+ hx3695_write_reg(0X34, 0x00);// ÖжÏÌØÊâÅäÖã»\r
+ hx3695_write_reg(0X36, 0x00);// phase data ready ±êÖ¾ÉèÖã»\r
+ hx3695_write_reg(0X38, 0x00);\r
+ \r
+ hx3695_write_reg(0X3a, (phase1_inner_avg | (phase2_inner_avg<<4))); \r
+ hx3695_write_reg(0X3b, (phase3_inner_avg | (phase4_inner_avg<<4))); \r
+ hx3695_write_reg(0X3c, (phase5_inner_avg | (phase6_inner_avg<<4))); \r
+ hx3695_write_reg(0X3d, (phase7_inner_avg | (phase8_inner_avg<<4))); \r
+ hx3695_write_reg(0X3e, adc_rst_post_num<<6 | samp_delay_leden_num<<4 | samp_copy_avg); \r
+ hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+ \r
+ hx3695_write_reg(0X43, phase1_mux_sel); \r
+ hx3695_write_reg(0X44, phase1_tia_cap<<4|phase1_tia_res); \r
+ hx3695_write_reg(0X45, phase1_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase1_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase1_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase1_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase1_ad_inr_ctrl<<4|phase1_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase1_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase1_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase1_dsp_mov_avg_num | phase1_dsp_iir_lp_coeff<<4);\r
+\r
+ \r
+ hx3695_write_reg(0X43, phase2_mux_sel); \r
+ hx3695_write_reg(0X44, phase2_tia_cap<<4|phase2_tia_res); \r
+ hx3695_write_reg(0X45, phase2_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase2_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase2_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase2_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase2_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase2_ad_inr_ctrl<<4|phase2_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase2_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase2_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase2_dsp_mov_avg_num | phase2_dsp_iir_lp_coeff<<4);\r
+ \r
+//phase3 sel\r
+\r
+ hx3695_write_reg(0X43, phase3_mux_sel); \r
+ hx3695_write_reg(0X44, phase3_tia_cap<<4|phase3_tia_res); \r
+ hx3695_write_reg(0X45, phase3_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase3_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase3_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase3_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase3_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase3_ad_inr_ctrl<<4|phase3_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase3_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase3_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase3_dsp_mov_avg_num | phase3_dsp_iir_lp_coeff<<4);\r
+ \r
+//phase4 sel\r
+\r
+ hx3695_write_reg(0X43, phase4_mux_sel); \r
+ hx3695_write_reg(0X44, phase4_tia_cap<<4|phase4_tia_res); \r
+ hx3695_write_reg(0X45, phase4_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase4_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase4_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase4_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase4_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase4_ad_inr_ctrl<<4|phase4_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase4_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase4_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase4_dsp_mov_avg_num | phase4_dsp_iir_lp_coeff<<4);\r
+\r
+ hx3695_write_reg(0X43, phase5_mux_sel); \r
+ hx3695_write_reg(0X44, phase5_tia_cap<<4|phase5_tia_res); \r
+ hx3695_write_reg(0X45, phase5_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase5_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase5_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase5_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase5_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase5_ad_inr_ctrl<<4|phase5_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase5_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase5_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase5_dsp_mov_avg_num | phase5_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase6_mux_sel); \r
+ hx3695_write_reg(0X44, phase6_tia_cap<<4|phase6_tia_res); \r
+ hx3695_write_reg(0X45, phase6_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase6_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase6_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase6_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase6_ad_inr_ctrl<<4|phase6_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase6_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase6_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase6_dsp_mov_avg_num | phase6_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase7_mux_sel); \r
+ hx3695_write_reg(0X44, phase7_tia_cap<<4|phase7_tia_res); \r
+ hx3695_write_reg(0X45, phase7_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase7_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase7_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase7_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase7_ad_inr_ctrl<<4|phase7_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase7_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase7_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase7_dsp_mov_avg_num | phase7_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase8_mux_sel); \r
+ hx3695_write_reg(0X44, phase8_tia_cap<<4|phase8_tia_res); \r
+ hx3695_write_reg(0X45, phase8_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase8_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase8_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase8_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase8_led_offset_idac);\r
+// hx3695_write_reg(0X48, phas8_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase8_ad_inr_ctrl<<4|phase8_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase8_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase8_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase8_dsp_mov_avg_num | phase8_dsp_iir_lp_coeff<<4);\r
+ \r
+\r
+// analog circuit cfg \r
+ hx3695_write_reg(0X60, 0x14); //\r
+ hx3695_write_reg(0X61, 0xf0); \r
+ hx3695_write_reg(0X62, 0x22); \r
+ hx3695_write_reg(0X63, 0x15); \r
+ \r
+ hx3695_write_reg(0X64, 0x08); \r
+ hx3695_write_reg(0X65, 0x88); //bug\r
+ \r
+ hx3695_write_reg(0X66, 0x30); // bits<3>=adc selftest en 0x30\r
+ hx3695_write_reg(0X67, 0x23); \r
+ hx3695_write_reg(0X68, 0x46); \r
+ hx3695_write_reg(0X69, 0x42); \r
+ \r
+ hx3695_write_reg(0X39, 0xff); // ofset idac1 phase enable cfg\r
+ hx3695_write_reg(0x73, 0xff); //led_offset_idac phase enable\r
+ \r
+ hx3695_write_reg(0X6a, 0X0f); \r
+ hx3695_write_reg(0X6b, 0X22); \r
+ hx3695_write_reg(0X6c, 0X00); \r
+ hx3695_write_reg(0X6d, 0X37); \r
+ hx3695_write_reg(0X6e, 0X82); \r
+ hx3695_write_reg(0X6f, 0X08);\r
+/////////FIFO and adc conversion ready config////////\r
+/////////FIFO and adc conversion ready config////////\r
+#if defined(PPG_INT_MODE)\r
+ hx3695_write_reg(0X1b, 0x00);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble\r
+ hx3695_write_reg(0X33, 0x83); // int width \r
+ hx3695_write_reg(0X21, 0x00); // fifo int sel,00=FIFO INT config clear\r
+ hx3695_write_reg(0X38, 0x08); // int sel,00=close almost full int,04=enable almost full int\r
+#elif defined(INT_MODE) //(FIFO_ALL_MOST_FULL)\r
+ hx3695_write_reg(0X1b, 0x90);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble\r
+ hx3695_write_reg(0X1c, (fifo_watermark&0xff)); //fifo_watermark\r
+ hx3695_write_reg(0X1d, fifo_watermark<<8); //bit<0>=fifo_watermark[8] \r
+ hx3695_write_reg(0X33, 0x83); // int width \r
+ hx3695_write_reg(0X38, 0x04); // int sel,00=close almost full int,04=enable almost full int\r
+\r
+#else\r
+ hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble \r
+ hx3695_write_reg(0X36, 0x00); //intrupt \r
+ \r
+ hx3695_write_reg(0X38, 0x00); // int sel,00=close almost full int,01= prf int 04=enable almost full int\r
+\r
+#endif\r
+\r
+ \r
+ hx3695_write_reg(0X26,(phase1_enable<<3)|(phase1_adc_osr)|(phase2_enable<<7)|(phase2_adc_osr<<4) ); \r
+ hx3695_write_reg(0X27,(phase3_enable<<3)|(phase3_adc_osr)|(phase4_enable<<7)|(phase4_adc_osr<<4) ); \r
+ hx3695_write_reg(0X28,(phase5_enable<<3)|(phase5_adc_osr)|(phase6_enable<<7)|(phase6_adc_osr<<4) );\r
+ hx3695_write_reg(0X29,(phase7_enable<<3)|(phase7_adc_osr)|(phase8_enable<<7)|(phase8_adc_osr<<4) ); \r
+\r
+// hx3695_write_reg(0X5c, 0x02);//soft reset\r
+ hx3695_delay_ms(5); \r
+ hx3695_write_reg(0X5c, 0x00);//release\r
+\r
+ return ; \r
+}\r
+\r
+void hx3695_factory_ft_single_check_config(void)//»Ò¿¨10mm¸ß¶È²âÊÔÅäÖÃ\r
+{\r
+\r
+ uint16_t sample_rate = 200; /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+ uint32_t prf_clk_num = 32000/sample_rate; /*period in clk num, num = Fclk/fs */\r
+ \r
+ uint8_t adc_rst_post_num=0; /* 00=16,01=32,10=64,11=128*/ \r
+ uint8_t samp_delay_leden_num = 0; /* 00=8,01=16,10=32,11=64*/ \r
+ uint8_t samp_copy_avg = 0; /* 0=1, 1=2, 2=4 ,3=8, 4=16*/\r
+ uint8_t data_avg_num = 0; /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+ uint8_t phase7_8_internal = 0; /* phase7 and phase8 prf internal cfg */\r
+ \r
+ uint8_t phase1_enable = 1; /*phase1_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase2_enable = 1; /*phase2_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase3_enable = 1; /*phase3_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase4_enable = 1; /*phase4_enable , 1 mean enable ; 0 mean disable */\r
+ uint8_t phase5_enable = 0; /*phase5_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase6_enable = 0; /*phase6_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase7_enable = 0; /*phase7_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase8_enable = 0; /*phase8_enable , 1 mean enable ; 0 mean disable */ \r
+\r
+ uint8_t phase1_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase2_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase3_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase4_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase5_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase6_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase7_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase8_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ \r
+ uint8_t phase1_mux_sel = 0; /* sel phase1*/\r
+ uint8_t phase2_mux_sel = 1; /* sel phase2*/\r
+ uint8_t phase3_mux_sel = 2; /* sel phase3*/\r
+ uint8_t phase4_mux_sel = 3; /* sel phase4*/\r
+ uint8_t phase5_mux_sel = 4; /* sel phase5*/\r
+ uint8_t phase6_mux_sel = 5; /* sel phase6*/\r
+ uint8_t phase7_mux_sel = 6; /* sel phase7*/\r
+ uint8_t phase8_mux_sel = 7; /* sel phase8*/\r
+ \r
+\r
+ uint8_t phase1_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase1_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase1_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase1_led_drv1_cha_sel = 0; /* 1 = ldr1 NG; 2 = ldr2 GR; 4 = ldr3 IR; 8 = ldr4 RED; */\r
+ uint8_t phase1_led_drv2_cha_sel = 0; /*ldr5:0x20 ldr6: 0x40 red ldr8 0x80 ir */\r
+ uint8_t phase1_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase1_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase1_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase1_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase1_ldr2_cur = 0;\r
+// uint8_t phase1_of_idac1_cur = 0;\r
+// uint8_t phase1_of_idac2_cur = 0;\r
+ uint8_t phase1_ad_inr_ctrl = 3;\r
+ uint8_t phase1_ad_of_idac_ctrl = 0;\r
+// uint8_t afe_offset = 0;\r
+ uint8_t phase1_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase1_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase1_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+\r
+\r
+ uint8_t phase2_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase2_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase2_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase2_led_drv1_cha_sel = GREEN_LED_SLE; //GREEN_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase2_led_drv2_cha_sel = 0x00;\r
+ uint8_t phase2_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase2_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase2_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase2_ldr1_cur = 16; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase2_ldr2_cur = 0;\r
+// uint8_t phase2_of_idac1_cur = 0;\r
+// uint8_t phase2_of_idac2_cur = 0;\r
+ uint8_t phase2_ad_inr_ctrl = 3;\r
+ uint8_t phase2_ad_of_idac_ctrl = 0;\r
+// uint8_t phase2_afe_offset = 0;\r
+ uint8_t phase2_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase2_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase2_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ \r
+ uint8_t phase3_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase3_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase3_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase3_led_drv1_cha_sel = RED_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase3_led_drv2_cha_sel = 0;\r
+ uint8_t phase3_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase3_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase3_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase3_ldr1_cur = 16; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase3_ldr2_cur = 0;\r
+// uint8_t phase3_of_idac1_cur = 0;\r
+// uint8_t phase3_of_idac2_cur = 0;\r
+ uint8_t phase3_ad_inr_ctrl = 3;\r
+ uint8_t phase3_ad_of_idac_ctrl = 0;\r
+// uint8_t phase3_afe_offset = 0;\r
+ uint8_t phase3_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase3_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase3_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ \r
+ uint8_t phase4_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase4_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase4_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase4_led_drv1_cha_sel = IR_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase4_led_drv2_cha_sel = 0;\r
+ uint8_t phase4_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase4_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase4_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase4_ldr1_cur = 16; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase4_ldr2_cur = 0;\r
+// uint8_t phase4_of_idac1_cur = 0;\r
+// uint8_t phase4_of_idac2_cur = 0;\r
+ uint8_t phase4_ad_inr_ctrl = 3;\r
+ uint8_t phase4_ad_of_idac_ctrl = 0;\r
+// uint8_t phase4_afe_offset = 0;\r
+ uint8_t phase4_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase4_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase4_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase5_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase5_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase5_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase5_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase5_led_drv2_cha_sel = 0;\r
+ uint8_t phase5_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase5_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase5_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase5_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase5_ldr2_cur = 0;\r
+// uint8_t phase5_of_idac1_cur = 0;\r
+// uint8_t phase5_of_idac2_cur = 0;\r
+ uint8_t phase5_ad_inr_ctrl = 3;\r
+ uint8_t phase5_ad_of_idac_ctrl = 0;\r
+// uint8_t phase5_afe_offset = 0;\r
+ uint8_t phase5_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase5_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase5_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase6_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase6_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase6_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase6_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase6_led_drv2_cha_sel = 0;\r
+ uint8_t phase6_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase6_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase6_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase6_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase6_ldr2_cur = 0;\r
+// uint8_t phase6_of_idac1_cur = 0;\r
+// uint8_t phase6_of_idac2_cur = 0;\r
+ uint8_t phase6_ad_inr_ctrl = 3;\r
+ uint8_t phase6_ad_of_idac_ctrl = 0;\r
+// uint8_t phase6_afe_offset = 0;\r
+ uint8_t phase6_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase6_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase6_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase7_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase7_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase7_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase7_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase7_led_drv2_cha_sel = 0;\r
+ uint8_t phase7_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase7_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase7_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase7_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase7_ldr2_cur = 0;\r
+// uint8_t phase7_of_idac1_cur = 0;\r
+// uint8_t phase7_of_idac2_cur = 0;\r
+ uint8_t phase7_ad_inr_ctrl = 3;\r
+ uint8_t phase7_ad_of_idac_ctrl = 0;\r
+// uint8_t phase7_afe_offset = 0;\r
+ uint8_t phase7_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase7_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase7_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase8_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase8_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase8_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase8_led_drv1_cha_sel = 0; //IR_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase8_led_drv2_cha_sel = 0;\r
+ uint8_t phase8_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase8_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase8_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase8_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase8_ldr2_cur = 0;\r
+// uint8_t phase8_of_idac1_cur = 0;\r
+// uint8_t phase8_of_idac2_cur = 0;\r
+ uint8_t phase8_ad_inr_ctrl = 3;\r
+ uint8_t phase8_ad_of_idac_ctrl = 0;\r
+// uint8_t phase8_afe_offset = 0;\r
+ uint8_t phase8_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase8_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase8_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t init_wait_delay = 5 ; /* 0 = 31clk ; 1 = 64clk ; 2 = 127clk ; 3 = 255clk(d) ;\r
+ 4 = 511clk; 5 = 1023clk; 6 = 2047; 7 = 4095clk */ \r
+ \r
+ uint8_t afe_reset = 3; /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d) ;\r
+ 4 = 255clk; 5 = 511clk; 6 = 1024; 7 = 2047clk */\r
+ \r
+ uint8_t afe_rst_cnvt = 1; /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d)*/\r
+ \r
+ uint8_t led_en_idac_pre = 2; /* 0 = 8clk ; 1 = 16clk ; 2 = 32clk ; 3 = 64clk(d)*/ \r
+ \r
+ uint8_t led_en_idac = 1; /* 0 = 4clk ; 1 = 8clk ; 2 = 16clk ; 3 = 32clk(d)*/ \r
+ \r
+ uint8_t led_on_time = 2; /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+ 4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+ \r
+ hx3695_delay_ms(10); \r
+ \r
+ hx3695_write_reg(0X2a, (uint8_t)prf_clk_num); // prf bit<7:0>6\r
+ hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+ hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16> \r
+ \r
+ hx3695_write_reg(0X25, (afe_rst_cnvt<<4| led_en_idac_pre<<2|led_en_idac)); \r
+ hx3695_write_reg(0X2d, phase7_8_internal); \r
+ hx3695_write_reg(0X2e, 0x33);// gpio ctrl \r
+ hx3695_write_reg(0X2f, ((afe_reset<<4)| init_wait_delay));\r
+ hx3695_write_reg(0X30, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+ hx3695_write_reg(0X72, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+\r
+\r
+ hx3695_write_reg(0X31, (led_on_time<<4| 0x00));\r
+ hx3695_write_reg(0X33, 0x83);// Öжϼ«ÐÔ¼°¿í¶ÈÅäÖã»\r
+ hx3695_write_reg(0X34, 0x00);// ÖжÏÌØÊâÅäÖã»\r
+ hx3695_write_reg(0X36, 0x00);// phase data ready ±êÖ¾ÉèÖã»\r
+ hx3695_write_reg(0X38, 0x00);\r
+ \r
+ hx3695_write_reg(0X3a, (phase1_inner_avg | (phase2_inner_avg<<4))); \r
+ hx3695_write_reg(0X3b, (phase3_inner_avg | (phase4_inner_avg<<4))); \r
+ hx3695_write_reg(0X3c, (phase5_inner_avg | (phase6_inner_avg<<4))); \r
+ hx3695_write_reg(0X3d, (phase7_inner_avg | (phase8_inner_avg<<4))); \r
+ hx3695_write_reg(0X3e, adc_rst_post_num<<6 | samp_delay_leden_num<<4 | samp_copy_avg); \r
+ hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+ \r
+ hx3695_write_reg(0X43, phase1_mux_sel); \r
+ hx3695_write_reg(0X44, phase1_tia_cap<<4|phase1_tia_res); \r
+ hx3695_write_reg(0X45, phase1_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase1_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase1_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase1_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+\r
+ hx3695_write_reg(0X49, phase1_ad_inr_ctrl<<4|phase1_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase1_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase1_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase1_dsp_mov_avg_num | phase1_dsp_iir_lp_coeff<<4);\r
+\r
+// hx3695_write_reg(0X4e, thred_value);\r
+// hx3695_write_reg(0X4f, thred_value>>5);\r
+ \r
+ hx3695_write_reg(0X43, phase2_mux_sel); \r
+ hx3695_write_reg(0X44, phase2_tia_cap<<4|phase2_tia_res); \r
+ hx3695_write_reg(0X45, phase2_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase2_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase2_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase2_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase2_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase2_ad_inr_ctrl<<4|phase2_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase2_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase2_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase2_dsp_mov_avg_num | phase2_dsp_iir_lp_coeff<<4);\r
+ \r
+//phase3 sel\r
+\r
+ hx3695_write_reg(0X43, phase3_mux_sel); \r
+ hx3695_write_reg(0X44, phase3_tia_cap<<4|phase3_tia_res); \r
+ hx3695_write_reg(0X45, phase3_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase3_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase3_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase3_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase3_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase3_ad_inr_ctrl<<4|phase3_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase3_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase3_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase3_dsp_mov_avg_num | phase3_dsp_iir_lp_coeff<<4);\r
+ \r
+//phase4 sel\r
+\r
+ hx3695_write_reg(0X43, phase4_mux_sel); \r
+ hx3695_write_reg(0X44, phase4_tia_cap<<4|phase4_tia_res); \r
+ hx3695_write_reg(0X45, phase4_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase4_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase4_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase4_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase4_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase4_ad_inr_ctrl<<4|phase4_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase4_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase4_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase4_dsp_mov_avg_num | phase4_dsp_iir_lp_coeff<<4);\r
+\r
+ hx3695_write_reg(0X43, phase5_mux_sel); \r
+ hx3695_write_reg(0X44, phase5_tia_cap<<4|phase5_tia_res); \r
+ hx3695_write_reg(0X45, phase5_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase5_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase5_pd_sel)); //<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase5_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase5_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase5_ad_inr_ctrl<<4|phase5_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase5_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase5_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase5_dsp_mov_avg_num | phase5_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase6_mux_sel); \r
+ hx3695_write_reg(0X44, phase6_tia_cap<<4|phase6_tia_res); \r
+ hx3695_write_reg(0X45, phase6_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase6_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase6_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase6_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase6_ad_inr_ctrl<<4|phase6_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase6_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase6_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase6_dsp_mov_avg_num | phase6_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase7_mux_sel); \r
+ hx3695_write_reg(0X44, phase7_tia_cap<<4|phase7_tia_res); \r
+ hx3695_write_reg(0X45, phase7_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase7_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase7_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase7_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase7_ad_inr_ctrl<<4|phase7_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase7_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase7_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase7_dsp_mov_avg_num | phase7_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase8_mux_sel); \r
+ hx3695_write_reg(0X44, phase8_tia_cap<<4|phase8_tia_res); \r
+ hx3695_write_reg(0X45, phase8_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase8_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase8_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase8_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase8_led_offset_idac);\r
+// hx3695_write_reg(0X48, phas8_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase8_ad_inr_ctrl<<4|phase8_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase8_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase8_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase8_dsp_mov_avg_num | phase8_dsp_iir_lp_coeff<<4);\r
+ \r
+\r
+// analog circuit cfg \r
+ hx3695_write_reg(0X60, 0x14); //\r
+ hx3695_write_reg(0X61, 0xf0); \r
+ hx3695_write_reg(0X62, 0x22); \r
+ hx3695_write_reg(0X63, 0x15); \r
+ \r
+ hx3695_write_reg(0X64, 0x08); \r
+ hx3695_write_reg(0X65, 0x88); //bug\r
+ \r
+ hx3695_write_reg(0X66, 0x30); // bits<3>=adc selftest en 0x30\r
+ hx3695_write_reg(0X67, 0x23); \r
+ hx3695_write_reg(0X68, 0x46); \r
+ hx3695_write_reg(0X69, 0x42); \r
+ \r
+ hx3695_write_reg(0X39, 0xff); // ofset idac1 phase enable cfg\r
+ hx3695_write_reg(0x73, 0xff); //led_offset_idac phase enable\r
+ \r
+ hx3695_write_reg(0X6a, 0X0f); \r
+ hx3695_write_reg(0X6b, 0X22); \r
+ hx3695_write_reg(0X6c, 0X00); \r
+ hx3695_write_reg(0X6d, 0X37); \r
+ hx3695_write_reg(0X6e, 0X82); \r
+ hx3695_write_reg(0X6f, 0X08);\r
+/////////FIFO and adc conversion ready config////////\r
+/////////FIFO and adc conversion ready config////////\r
+#if defined(PPG_INT_MODE)\r
+ hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble\r
+ hx3695_write_reg(0X33, 0x83); // int width \r
+ hx3695_write_reg(0X21, 0x00); // fifo int sel,00=FIFO INT config clear\r
+ hx3695_write_reg(0X38, 0x01); // int sel,00=close almost full int,04=enable almost full int\r
+#elif defined(INT_MODE) //FIFO_ALL_MOST_FULL)\r
+ hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble\r
+ hx3695_write_reg(0X1c, (fifo_watermark&0xff)); //fifo_watermark\r
+ hx3695_write_reg(0X1d, fifo_watermark<<8); //bit<0>=fifo_watermark[8] \r
+ hx3695_write_reg(0X33, 0x83); // int width \r
+ hx3695_write_reg(0X21, 0x00); // fifo int sel,00=FIFO INT config clear\r
+ hx3695_write_reg(0X38, 0x04); // int sel,00=close almost full int,04=enable almost full int\r
+\r
+#else\r
+ hx3695_write_reg(0X1b, 0x92); // bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble \r
+ hx3695_write_reg(0X38, 0x01); // int sel,00=close almost full int,04=enable almost full int\r
+ \r
+#endif\r
+\r
+ \r
+ hx3695_write_reg(0X26,(phase1_enable<<3)|(phase1_adc_osr)|(phase2_enable<<7)|(phase2_adc_osr<<4) ); \r
+ hx3695_write_reg(0X27,(phase3_enable<<3)|(phase3_adc_osr)|(phase4_enable<<7)|(phase4_adc_osr<<4) ); \r
+ hx3695_write_reg(0X28,(phase5_enable<<3)|(phase5_adc_osr)|(phase6_enable<<7)|(phase6_adc_osr<<4) );\r
+ hx3695_write_reg(0X29,(phase7_enable<<3)|(phase7_adc_osr)|(phase8_enable<<7)|(phase8_adc_osr<<4) ); \r
+\r
+// hx3695_write_reg(0X5c, 0x02);//soft reset\r
+ hx3695_delay_ms(5); \r
+ hx3695_write_reg(0X5c, 0x00);//release\r
+\r
+ return ;\r
+}\r
+\r
+void hx3695_factory_ft_leak_light_test_config(void)//©¹â²âÊÔÅäÖÃ\r
+{\r
+ uint16_t sample_rate = 25; /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+ uint32_t prf_clk_num = 32000/sample_rate; /*period in clk num, num = Fclk/fs */\r
+ \r
+\r
+ uint8_t adc_rst_post_num= 0; /* 00=16,01=32,10=64,11=128*/ \r
+ uint8_t samp_delay_leden_num = 0; /* 00=8,01=16,10=32,11=64*/ \r
+ uint8_t samp_copy_avg = 0; /* 0=1, 1=2, 2=4 ,3=8, 4=16*/\r
+ uint8_t data_avg_num = 0; /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+ uint8_t phase7_8_internal = 0; //0x18; /* phase7 and phase8 prf internal cfg */\r
+ \r
+// uint16_t thred_value = 32500;\r
+ \r
+ uint8_t phase1_enable = 1; /*phase1_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase2_enable = 1; /*phase2_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase3_enable = 1; /*phase3_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase4_enable = 1; /*phase4_enable , 1 mean enable ; 0 mean disable */\r
+ uint8_t phase5_enable = 0; /*phase5_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase6_enable = 0; /*phase6_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase7_enable = 0; /*phase7_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase8_enable = 0; /*phase8_enable , 1 mean enable ; 0 mean disable */ \r
+\r
+ uint8_t phase1_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase2_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase3_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase4_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase5_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase6_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase7_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase8_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ \r
+ uint8_t phase1_mux_sel = 0; /* sel phase1*/\r
+ uint8_t phase2_mux_sel = 1; /* sel phase2*/\r
+ uint8_t phase3_mux_sel = 2; /* sel phase3*/\r
+ uint8_t phase4_mux_sel = 3; /* sel phase4*/\r
+ uint8_t phase5_mux_sel = 4; /* sel phase5*/\r
+ uint8_t phase6_mux_sel = 5; /* sel phase6*/\r
+ uint8_t phase7_mux_sel = 6; /* sel phase7*/\r
+ uint8_t phase8_mux_sel = 7; /* sel phase8*/\r
+ \r
+\r
+ uint8_t phase1_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase1_tia_res = 5; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase1_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase1_led_drv1_cha_sel = 0; /* 1 = ldr1 NG; 2 = ldr2 GR; 4 = ldr3 IR; 8 = ldr4 RED; */\r
+ uint8_t phase1_led_drv2_cha_sel = 0; /*ldr5:0x20 ldr6: 0x40 red ldr8 0x80 ir */\r
+ uint8_t phase1_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase1_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase1_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase1_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase1_ldr2_cur = 0;\r
+// uint8_t phase1_of_idac1_cur = 0;\r
+// uint8_t phase1_of_idac2_cur = 0;\r
+ uint8_t phase1_ad_inr_ctrl = 3;\r
+ uint8_t phase1_ad_of_idac_ctrl = 0;\r
+// uint8_t afe_offset = 0;\r
+ uint8_t phase1_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase1_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase1_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+\r
+\r
+ uint8_t phase2_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase2_tia_res = 5; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase2_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase2_led_drv1_cha_sel = GREEN_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase2_led_drv2_cha_sel = 0x00;\r
+ uint8_t phase2_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase2_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase2_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase2_ldr1_cur = 64; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase2_ldr2_cur = 0;\r
+// uint8_t phase2_of_idac1_cur = 0;\r
+// uint8_t phase2_of_idac2_cur = 0;\r
+ uint8_t phase2_ad_inr_ctrl = 3;\r
+ uint8_t phase2_ad_of_idac_ctrl = 0;\r
+// uint8_t phase2_afe_offset = 0;\r
+ uint8_t phase2_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase2_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase2_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ \r
+ uint8_t phase3_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase3_tia_res = 5; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase3_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase3_led_drv1_cha_sel = RED_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase3_led_drv2_cha_sel = 0;\r
+ uint8_t phase3_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase3_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase3_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase3_ldr1_cur = 64; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase3_ldr2_cur = 0;\r
+// uint8_t phase3_of_idac1_cur = 0;\r
+// uint8_t phase3_of_idac2_cur = 0;\r
+ uint8_t phase3_ad_inr_ctrl = 3;\r
+ uint8_t phase3_ad_of_idac_ctrl = 0;\r
+// uint8_t phase3_afe_offset = 0;\r
+ uint8_t phase3_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase3_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase3_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ \r
+ uint8_t phase4_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase4_tia_res = 5; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase4_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase4_led_drv1_cha_sel = IR_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase4_led_drv2_cha_sel = 0;\r
+ uint8_t phase4_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase4_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase4_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase4_ldr1_cur = 64; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase4_ldr2_cur = 0;\r
+// uint8_t phase4_of_idac1_cur = 0;\r
+// uint8_t phase4_of_idac2_cur = 0;\r
+ uint8_t phase4_ad_inr_ctrl = 3;\r
+ uint8_t phase4_ad_of_idac_ctrl = 0;\r
+// uint8_t phase4_afe_offset = 0;\r
+ uint8_t phase4_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase4_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase4_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase5_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase5_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase5_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase5_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase5_led_drv2_cha_sel = 0;\r
+ uint8_t phase5_pd_sel = 4; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase5_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase5_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase5_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase5_ldr2_cur = 0;\r
+// uint8_t phase5_of_idac1_cur = 0;\r
+// uint8_t phase5_of_idac2_cur = 0;\r
+ uint8_t phase5_ad_inr_ctrl = 3;\r
+ uint8_t phase5_ad_of_idac_ctrl = 0;\r
+// uint8_t phase5_afe_offset = 0;\r
+ uint8_t phase5_led_en = 0; /* phase1 led enable*/\r
+ \r
+ uint8_t phase5_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase5_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase6_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase6_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase6_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase6_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase6_led_drv2_cha_sel = 0;\r
+ uint8_t phase6_pd_sel = 4; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase6_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase6_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase6_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase6_ldr2_cur = 0;\r
+// uint8_t phase6_of_idac1_cur = 0;\r
+// uint8_t phase6_of_idac2_cur = 0;\r
+ uint8_t phase6_ad_inr_ctrl = 3;\r
+ uint8_t phase6_ad_of_idac_ctrl = 0;\r
+// uint8_t phase6_afe_offset = 0;\r
+ uint8_t phase6_led_en = 0; /* phase1 led enable*/\r
+ \r
+ uint8_t phase6_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase6_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase7_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase7_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase7_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase7_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase7_led_drv2_cha_sel = 0;\r
+ uint8_t phase7_pd_sel = 0x00; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase7_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase7_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase7_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase7_ldr2_cur = 0;\r
+// uint8_t phase7_of_idac1_cur = 0;\r
+// uint8_t phase7_of_idac2_cur = 0;\r
+ uint8_t phase7_ad_inr_ctrl = 3;\r
+ uint8_t phase7_ad_of_idac_ctrl = 0;\r
+// uint8_t phase7_afe_offset = 0;\r
+ uint8_t phase7_led_en = 0; /* phase1 led enable*/\r
+ \r
+ uint8_t phase7_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase7_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase8_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase8_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase8_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase8_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase8_led_drv2_cha_sel = 0;\r
+ uint8_t phase8_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase8_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase8_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase8_ldr1_cur = 50; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase8_ldr2_cur = 0;\r
+// uint8_t phase8_of_idac1_cur = 0;\r
+// uint8_t phase8_of_idac2_cur = 0;\r
+ uint8_t phase8_ad_inr_ctrl = 3;\r
+ uint8_t phase8_ad_of_idac_ctrl = 0;\r
+// uint8_t phase8_afe_offset = 0;\r
+ uint8_t phase8_led_en = 0; /* phase1 led enable*/\r
+ \r
+ uint8_t phase8_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase8_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t init_wait_delay = 4 ; /* 0 = 31clk ; 1 = 64clk ; 2 = 127clk ; 3 = 255clk(d) ;\r
+ 4 = 511clk; 5 = 1023clk; 6 = 2047; 7 = 4095clk */ \r
+ \r
+ uint8_t afe_reset = 3; /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d) ;\r
+ 4 = 255clk; 5 = 511clk; 6 = 1024; 7 = 2047clk */\r
+ \r
+ uint8_t afe_rst_cnvt = 1; /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d)*/\r
+ \r
+ uint8_t led_en_idac_pre = 2; /* 0 = 8clk ; 1 = 16clk ; 2 = 32clk ; 3 = 64clk(d)*/ \r
+ \r
+ uint8_t led_en_idac = 1; /* 0 = 4clk ; 1 = 8clk ; 2 = 16clk ; 3 = 32clk(d)*/ \r
+ \r
+ uint8_t led_on_time = 2; /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+ 4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+ \r
+ hx3695_delay_ms(10); \r
+ \r
+ hx3695_write_reg(0X2a, (uint8_t)prf_clk_num); // prf bit<7:0>6\r
+ hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+ hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16> \r
+ \r
+ hx3695_write_reg(0X25, (afe_rst_cnvt<<4| led_en_idac_pre<<2|led_en_idac)); \r
+ hx3695_write_reg(0X2d, phase7_8_internal); \r
+ hx3695_write_reg(0X2e, 0x33);// gpio ctrl \r
+ hx3695_write_reg(0X2f, ((afe_reset<<4)| init_wait_delay));\r
+ hx3695_write_reg(0X30, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+ hx3695_write_reg(0X72, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+\r
+\r
+ hx3695_write_reg(0X31, (led_on_time<<4| 0x00));\r
+ hx3695_write_reg(0X33, 0x83);// Öжϼ«ÐÔ¼°¿í¶ÈÅäÖã»\r
+ hx3695_write_reg(0X34, 0x00);// ÖжÏÌØÊâÅäÖã»\r
+ hx3695_write_reg(0X36, 0x00);// phase data ready ±êÖ¾ÉèÖã»\r
+ hx3695_write_reg(0X38, 0x00);\r
+ \r
+ hx3695_write_reg(0X3a, (phase1_inner_avg | (phase2_inner_avg<<4))); \r
+ hx3695_write_reg(0X3b, (phase3_inner_avg | (phase4_inner_avg<<4))); \r
+ hx3695_write_reg(0X3c, (phase5_inner_avg | (phase6_inner_avg<<4))); \r
+ hx3695_write_reg(0X3d, (phase7_inner_avg | (phase8_inner_avg<<4))); \r
+ hx3695_write_reg(0X3e, adc_rst_post_num<<6 | samp_delay_leden_num<<4 | samp_copy_avg); \r
+ hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+ \r
+ hx3695_write_reg(0X43, phase1_mux_sel); \r
+ hx3695_write_reg(0X44, phase1_tia_cap<<4|phase1_tia_res); \r
+ hx3695_write_reg(0X45, phase1_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase1_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase1_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase1_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase1_ad_inr_ctrl<<4|phase1_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase1_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase1_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase1_dsp_mov_avg_num | phase1_dsp_iir_lp_coeff<<4);\r
+\r
+ \r
+ hx3695_write_reg(0X43, phase2_mux_sel); \r
+ hx3695_write_reg(0X44, phase2_tia_cap<<4|phase2_tia_res); \r
+ hx3695_write_reg(0X45, phase2_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase2_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase2_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase2_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase2_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase2_ad_inr_ctrl<<4|phase2_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase2_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase2_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase2_dsp_mov_avg_num | phase2_dsp_iir_lp_coeff<<4);\r
+ \r
+//phase3 sel\r
+\r
+ hx3695_write_reg(0X43, phase3_mux_sel); \r
+ hx3695_write_reg(0X44, phase3_tia_cap<<4|phase3_tia_res); \r
+ hx3695_write_reg(0X45, phase3_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase3_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase3_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase3_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase3_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase3_ad_inr_ctrl<<4|phase3_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase3_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase3_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase3_dsp_mov_avg_num | phase3_dsp_iir_lp_coeff<<4);\r
+ \r
+//phase4 sel\r
+\r
+ hx3695_write_reg(0X43, phase4_mux_sel); \r
+ hx3695_write_reg(0X44, phase4_tia_cap<<4|phase4_tia_res); \r
+ hx3695_write_reg(0X45, phase4_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase4_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase4_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase4_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase4_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase4_ad_inr_ctrl<<4|phase4_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase4_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase4_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase4_dsp_mov_avg_num | phase4_dsp_iir_lp_coeff<<4);\r
+\r
+ hx3695_write_reg(0X43, phase5_mux_sel); \r
+ hx3695_write_reg(0X44, phase5_tia_cap<<4|phase5_tia_res); \r
+ hx3695_write_reg(0X45, phase5_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase5_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase5_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase5_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase5_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase5_ad_inr_ctrl<<4|phase5_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase5_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase5_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase5_dsp_mov_avg_num | phase5_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase6_mux_sel); \r
+ hx3695_write_reg(0X44, phase6_tia_cap<<4|phase6_tia_res); \r
+ hx3695_write_reg(0X45, phase6_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase6_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase6_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase6_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase6_ad_inr_ctrl<<4|phase6_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase6_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase6_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase6_dsp_mov_avg_num | phase6_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase7_mux_sel); \r
+ hx3695_write_reg(0X44, phase7_tia_cap<<4|phase7_tia_res); \r
+ hx3695_write_reg(0X45, phase7_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase7_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase7_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase7_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase7_ad_inr_ctrl<<4|phase7_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase7_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase7_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase7_dsp_mov_avg_num | phase7_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase8_mux_sel); \r
+ hx3695_write_reg(0X44, phase8_tia_cap<<4|phase8_tia_res); \r
+ hx3695_write_reg(0X45, phase8_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase8_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase8_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase8_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase8_led_offset_idac);\r
+// hx3695_write_reg(0X48, phas8_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase8_ad_inr_ctrl<<4|phase8_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase8_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase8_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase8_dsp_mov_avg_num | phase8_dsp_iir_lp_coeff<<4);\r
+ \r
+\r
+// analog circuit cfg \r
+ hx3695_write_reg(0X60, 0x14); //\r
+ hx3695_write_reg(0X61, 0xf0); \r
+ hx3695_write_reg(0X62, 0x22); \r
+ hx3695_write_reg(0X63, 0x15); \r
+ \r
+ hx3695_write_reg(0X64, 0x08); \r
+ hx3695_write_reg(0X65, 0x88); //bug\r
+ \r
+ hx3695_write_reg(0X66, 0x30); // bits<3>=adc selftest en 0x30\r
+ hx3695_write_reg(0X67, 0x23); \r
+ hx3695_write_reg(0X68, 0x46); \r
+ hx3695_write_reg(0X69, 0x42); \r
+ \r
+ hx3695_write_reg(0X39, 0xff); // ofset idac1 phase enable cfg\r
+ hx3695_write_reg(0x73, 0xff); //led_offset_idac phase enable\r
+ \r
+ hx3695_write_reg(0X6a, 0X0f); \r
+ hx3695_write_reg(0X6b, 0X22); \r
+ hx3695_write_reg(0X6c, 0X00); \r
+ hx3695_write_reg(0X6d, 0X37); \r
+ hx3695_write_reg(0X6e, 0X82); \r
+ hx3695_write_reg(0X6f, 0X08);\r
+/////////FIFO and adc conversion ready config////////\r
+/////////FIFO and adc conversion ready config////////\r
+#if defined(PPG_INT_MODE)\r
+ hx3695_write_reg(0X1b, 0x00);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble\r
+ hx3695_write_reg(0X33, 0x83); // int width \r
+ hx3695_write_reg(0X21, 0x00); // fifo int sel,00=FIFO INT config clear\r
+ hx3695_write_reg(0X38, 0x08); // int sel,00=close almost full int,04=enable almost full int\r
+#elif defined(INT_MODE) //(FIFO_ALL_MOST_FULL)\r
+ hx3695_write_reg(0X1b, 0x90);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble\r
+ hx3695_write_reg(0X1c, (fifo_watermark&0xff)); //fifo_watermark\r
+ hx3695_write_reg(0X1d, fifo_watermark<<8); //bit<0>=fifo_watermark[8] \r
+ hx3695_write_reg(0X33, 0x83); // int width \r
+ hx3695_write_reg(0X38, 0x04); // int sel,00=close almost full int,04=enable almost full int\r
+\r
+#else\r
+ hx3695_write_reg(0X1b, 0x90);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble \r
+ hx3695_write_reg(0X36, 0x00); //intrupt \r
+ \r
+ hx3695_write_reg(0X38, 0x00); // int sel,00=close almost full int,01= prf int 04=enable almost full int\r
+\r
+#endif\r
+\r
+ \r
+ hx3695_write_reg(0X26,(phase1_enable<<3)|(phase1_adc_osr)|(phase2_enable<<7)|(phase2_adc_osr<<4) ); \r
+ hx3695_write_reg(0X27,(phase3_enable<<3)|(phase3_adc_osr)|(phase4_enable<<7)|(phase4_adc_osr<<4) ); \r
+ hx3695_write_reg(0X28,(phase5_enable<<3)|(phase5_adc_osr)|(phase6_enable<<7)|(phase6_adc_osr<<4) );\r
+ hx3695_write_reg(0X29,(phase7_enable<<3)|(phase7_adc_osr)|(phase8_enable<<7)|(phase8_adc_osr<<4) ); \r
+\r
+// hx3695_write_reg(0X5c, 0x02);//soft reset\r
+ hx3695_delay_ms(5); \r
+ hx3695_write_reg(0X5c, 0x00);//release\r
+\r
+ return ;\r
+}\r
+\r
+void hx3695_factory_led_off_config(void)\r
+{\r
+ uint16_t sample_rate = 25; /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+ uint32_t prf_clk_num = 32000/sample_rate; /*period in clk num, num = Fclk/fs */\r
+\r
+ uint8_t adc_rst_post_num=0; /* 00=16,01=32,10=64,11=128*/ \r
+ uint8_t samp_delay_leden_num = 0; /* 00=8,01=16,10=32,11=64*/ \r
+ uint8_t samp_copy_avg = 0; /* 0=1, 1=2, 2=4 ,3=8, 4=16*/\r
+ uint8_t data_avg_num = 0; /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+ uint8_t phase7_8_internal = 0; /* phase7 and phase8 prf internal cfg */\r
+ \r
+ uint8_t phase1_enable = 1; /*phase1_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase2_enable = 1; /*phase2_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase3_enable = 1; /*phase3_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase4_enable = 1; /*phase4_enable , 1 mean enable ; 0 mean disable */\r
+ uint8_t phase5_enable = 0; /*phase5_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase6_enable = 0; /*phase6_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase7_enable = 0; /*phase7_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase8_enable = 0; /*phase8_enable , 1 mean enable ; 0 mean disable */ \r
+\r
+ uint8_t phase1_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase2_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase3_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase4_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase5_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase6_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase7_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase8_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ \r
+ uint8_t phase1_mux_sel = 0; /* sel phase1*/\r
+ uint8_t phase2_mux_sel = 1; /* sel phase2*/\r
+ uint8_t phase3_mux_sel = 2; /* sel phase3*/\r
+ uint8_t phase4_mux_sel = 3; /* sel phase4*/\r
+ uint8_t phase5_mux_sel = 4; /* sel phase5*/\r
+ uint8_t phase6_mux_sel = 5; /* sel phase6*/\r
+ uint8_t phase7_mux_sel = 6; /* sel phase7*/\r
+ uint8_t phase8_mux_sel = 7; /* sel phase8*/\r
+ \r
+\r
+ uint8_t phase1_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase1_tia_res = 5; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase1_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase1_led_drv1_cha_sel = 0; /* 1 = ldr1 NG; 2 = ldr2 GR; 4 = ldr3 IR; 8 = ldr4 RED; */\r
+ uint8_t phase1_led_drv2_cha_sel = 0; /*ldr5:0x20 ldr6: 0x40 red ldr8 0x80 ir */\r
+ uint8_t phase1_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase1_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase1_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase1_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase1_ldr2_cur = 0;\r
+// uint8_t phase1_of_idac1_cur = 0;\r
+// uint8_t phase1_of_idac2_cur = 0;\r
+ uint8_t phase1_ad_inr_ctrl = 3;\r
+ uint8_t phase1_ad_of_idac_ctrl = 0;\r
+// uint8_t afe_offset = 0;\r
+ uint8_t phase1_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase1_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase1_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+\r
+\r
+ uint8_t phase2_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase2_tia_res = 5; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase2_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase2_led_drv1_cha_sel = GREEN_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase2_led_drv2_cha_sel = 0;\r
+ uint8_t phase2_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase2_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase2_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase2_ldr1_cur = 15; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase2_ldr2_cur = 0;\r
+// uint8_t phase2_of_idac1_cur = 0;\r
+// uint8_t phase2_of_idac2_cur = 0;\r
+ uint8_t phase2_ad_inr_ctrl = 3;\r
+ uint8_t phase2_ad_of_idac_ctrl = 0;\r
+// uint8_t phase2_afe_offset = 0;\r
+ uint8_t phase2_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase2_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase2_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ \r
+ uint8_t phase3_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase3_tia_res = 5; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase3_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase3_led_drv1_cha_sel = RED_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase3_led_drv2_cha_sel = 0;\r
+ uint8_t phase3_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase3_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase3_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase3_ldr1_cur = 15; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase3_ldr2_cur = 0;\r
+// uint8_t phase3_of_idac1_cur = 0;\r
+// uint8_t phase3_of_idac2_cur = 0;\r
+ uint8_t phase3_ad_inr_ctrl = 3;\r
+ uint8_t phase3_ad_of_idac_ctrl = 0;\r
+// uint8_t phase3_afe_offset = 0;\r
+ uint8_t phase3_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase3_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase3_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ \r
+ uint8_t phase4_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase4_tia_res = 5; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase4_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase4_led_drv1_cha_sel = IR_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase4_led_drv2_cha_sel = 0;\r
+ uint8_t phase4_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase4_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase4_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase4_ldr1_cur = 15; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase4_ldr2_cur = 0;\r
+// uint8_t phase4_of_idac1_cur = 0;\r
+// uint8_t phase4_of_idac2_cur = 0;\r
+ uint8_t phase4_ad_inr_ctrl = 3;\r
+ uint8_t phase4_ad_of_idac_ctrl = 0;\r
+// uint8_t phase4_afe_offset = 0;\r
+ uint8_t phase4_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase4_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase4_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase5_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase5_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase5_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase5_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase5_led_drv2_cha_sel = 0;\r
+ uint8_t phase5_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase5_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase5_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase5_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase5_ldr2_cur = 0;\r
+// uint8_t phase5_of_idac1_cur = 0;\r
+// uint8_t phase5_of_idac2_cur = 0;\r
+ uint8_t phase5_ad_inr_ctrl = 3;\r
+ uint8_t phase5_ad_of_idac_ctrl = 0;\r
+// uint8_t phase5_afe_offset = 0;\r
+ uint8_t phase5_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase5_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase5_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase6_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase6_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase6_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase6_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase6_led_drv2_cha_sel = 0;\r
+ uint8_t phase6_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase6_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase6_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase6_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase6_ldr2_cur = 0;\r
+// uint8_t phase6_of_idac1_cur = 0;\r
+// uint8_t phase6_of_idac2_cur = 0;\r
+ uint8_t phase6_ad_inr_ctrl = 3;\r
+ uint8_t phase6_ad_of_idac_ctrl = 0;\r
+// uint8_t phase6_afe_offset = 0;\r
+ uint8_t phase6_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase6_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase6_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase7_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase7_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase7_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase7_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase7_led_drv2_cha_sel = 0;\r
+ uint8_t phase7_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase7_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase7_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase7_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase7_ldr2_cur = 0;\r
+// uint8_t phase7_of_idac1_cur = 0;\r
+// uint8_t phase7_of_idac2_cur = 0;\r
+ uint8_t phase7_ad_inr_ctrl = 3;\r
+ uint8_t phase7_ad_of_idac_ctrl = 0;\r
+// uint8_t phase7_afe_offset = 0;\r
+ uint8_t phase7_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase7_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase7_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase8_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase8_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase8_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase8_led_drv1_cha_sel = 0; //IR_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase8_led_drv2_cha_sel = 0;\r
+ uint8_t phase8_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase8_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase8_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase8_ldr1_cur = 20; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase8_ldr2_cur = 0;\r
+// uint8_t phase8_of_idac1_cur = 0;\r
+// uint8_t phase8_of_idac2_cur = 0;\r
+ uint8_t phase8_ad_inr_ctrl = 3;\r
+ uint8_t phase8_ad_of_idac_ctrl = 0;\r
+// uint8_t phase8_afe_offset = 0;\r
+ uint8_t phase8_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase8_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase8_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t init_wait_delay = 5 ; /* 0 = 31clk ; 1 = 64clk ; 2 = 127clk ; 3 = 255clk(d) ;\r
+ 4 = 511clk; 5 = 1023clk; 6 = 2047; 7 = 4095clk */ \r
+ \r
+ uint8_t afe_reset = 3; /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d) ;\r
+ 4 = 255clk; 5 = 511clk; 6 = 1024; 7 = 2047clk */\r
+ \r
+ uint8_t afe_rst_cnvt = 1; /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d)*/\r
+ \r
+ uint8_t led_en_idac_pre = 2; /* 0 = 8clk ; 1 = 16clk ; 2 = 32clk ; 3 = 64clk(d)*/ \r
+ \r
+ uint8_t led_en_idac = 1; /* 0 = 4clk ; 1 = 8clk ; 2 = 16clk ; 3 = 32clk(d)*/ \r
+ \r
+ uint8_t led_on_time = 2; /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+ 4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+ \r
+ hx3695_delay_ms(10); \r
+ \r
+ hx3695_write_reg(0X2a, (uint8_t)prf_clk_num); // prf bit<7:0>6\r
+ hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+ hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16> \r
+ \r
+ hx3695_write_reg(0X25, (afe_rst_cnvt<<4| led_en_idac_pre<<2|led_en_idac)); \r
+ hx3695_write_reg(0X2d, phase7_8_internal); \r
+ hx3695_write_reg(0X2e, 0x33);// gpio ctrl \r
+ hx3695_write_reg(0X2f, ((afe_reset<<4)| init_wait_delay));\r
+ hx3695_write_reg(0X30, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+ hx3695_write_reg(0X72, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+\r
+\r
+ hx3695_write_reg(0X31, (led_on_time<<4| 0x00));\r
+ hx3695_write_reg(0X33, 0x83);// Öжϼ«ÐÔ¼°¿í¶ÈÅäÖã»\r
+ hx3695_write_reg(0X34, 0x00);// ÖжÏÌØÊâÅäÖã»\r
+ hx3695_write_reg(0X36, 0x00);// phase data ready ±êÖ¾ÉèÖã»\r
+ hx3695_write_reg(0X38, 0x00);\r
+ \r
+ hx3695_write_reg(0X3a, (phase1_inner_avg | (phase2_inner_avg<<4))); \r
+ hx3695_write_reg(0X3b, (phase3_inner_avg | (phase4_inner_avg<<4))); \r
+ hx3695_write_reg(0X3c, (phase5_inner_avg | (phase6_inner_avg<<4))); \r
+ hx3695_write_reg(0X3d, (phase7_inner_avg | (phase8_inner_avg<<4))); \r
+ hx3695_write_reg(0X3e, adc_rst_post_num<<6 | samp_delay_leden_num<<4 | samp_copy_avg); \r
+ hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+ \r
+ hx3695_write_reg(0X43, phase1_mux_sel); \r
+ hx3695_write_reg(0X44, phase1_tia_cap<<4|phase1_tia_res); \r
+ hx3695_write_reg(0X45, phase1_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase1_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase1_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase1_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+\r
+ hx3695_write_reg(0X49, phase1_ad_inr_ctrl<<4|phase1_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase1_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase1_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase1_dsp_mov_avg_num | phase1_dsp_iir_lp_coeff<<4);\r
+\r
+// hx3695_write_reg(0X4e, thred_value);\r
+// hx3695_write_reg(0X4f, thred_value>>5);\r
+ \r
+ hx3695_write_reg(0X43, phase2_mux_sel); \r
+ hx3695_write_reg(0X44, phase2_tia_cap<<4|phase2_tia_res); \r
+ hx3695_write_reg(0X45, phase2_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase2_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase2_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase2_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase2_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase2_ad_inr_ctrl<<4|phase2_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase2_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase2_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase2_dsp_mov_avg_num | phase2_dsp_iir_lp_coeff<<4);\r
+ \r
+//phase3 sel\r
+\r
+ hx3695_write_reg(0X43, phase3_mux_sel); \r
+ hx3695_write_reg(0X44, phase3_tia_cap<<4|phase3_tia_res); \r
+ hx3695_write_reg(0X45, phase3_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase3_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase3_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase3_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase3_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase3_ad_inr_ctrl<<4|phase3_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase3_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase3_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase3_dsp_mov_avg_num | phase3_dsp_iir_lp_coeff<<4);\r
+ \r
+//phase4 sel\r
+\r
+ hx3695_write_reg(0X43, phase4_mux_sel); \r
+ hx3695_write_reg(0X44, phase4_tia_cap<<4|phase4_tia_res); \r
+ hx3695_write_reg(0X45, phase4_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase4_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase4_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase4_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase4_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase4_ad_inr_ctrl<<4|phase4_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase4_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase4_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase4_dsp_mov_avg_num | phase4_dsp_iir_lp_coeff<<4);\r
+\r
+ hx3695_write_reg(0X43, phase5_mux_sel); \r
+ hx3695_write_reg(0X44, phase5_tia_cap<<4|phase5_tia_res); \r
+ hx3695_write_reg(0X45, phase5_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase5_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase5_pd_sel)); //<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase5_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase5_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase5_ad_inr_ctrl<<4|phase5_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase5_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase5_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase5_dsp_mov_avg_num | phase5_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase6_mux_sel); \r
+ hx3695_write_reg(0X44, phase6_tia_cap<<4|phase6_tia_res); \r
+ hx3695_write_reg(0X45, phase6_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase6_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase6_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase6_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase6_ad_inr_ctrl<<4|phase6_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase6_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase6_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase6_dsp_mov_avg_num | phase6_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase7_mux_sel); \r
+ hx3695_write_reg(0X44, phase7_tia_cap<<4|phase7_tia_res); \r
+ hx3695_write_reg(0X45, phase7_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase7_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase7_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase7_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase7_ad_inr_ctrl<<4|phase7_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase7_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase7_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase7_dsp_mov_avg_num | phase7_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase8_mux_sel); \r
+ hx3695_write_reg(0X44, phase8_tia_cap<<4|phase8_tia_res); \r
+ hx3695_write_reg(0X45, phase8_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase8_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase8_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase8_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase8_led_offset_idac);\r
+// hx3695_write_reg(0X48, phas8_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase8_ad_inr_ctrl<<4|phase8_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase8_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase8_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase8_dsp_mov_avg_num | phase8_dsp_iir_lp_coeff<<4);\r
+ \r
+\r
+// analog circuit cfg \r
+ hx3695_write_reg(0X60, 0x14); //\r
+ hx3695_write_reg(0X61, 0xf0); \r
+ hx3695_write_reg(0X62, 0x22); \r
+ hx3695_write_reg(0X63, 0x15); \r
+ \r
+ hx3695_write_reg(0X64, 0x08); \r
+ hx3695_write_reg(0X65, 0x88); //bug\r
+ \r
+ hx3695_write_reg(0X66, 0x30); // bits<3>=adc selftest en 0x30\r
+ hx3695_write_reg(0X67, 0x23); \r
+ hx3695_write_reg(0X68, 0x46); \r
+ hx3695_write_reg(0X69, 0x42); \r
+ \r
+ hx3695_write_reg(0X39, 0xff); // ofset idac1 phase enable cfg\r
+ hx3695_write_reg(0x73, 0xff); //led_offset_idac phase enable\r
+ \r
+ hx3695_write_reg(0X6a, 0X0f); \r
+ hx3695_write_reg(0X6b, 0X22); \r
+ hx3695_write_reg(0X6c, 0X00); \r
+ hx3695_write_reg(0X6d, 0X37); \r
+ hx3695_write_reg(0X6e, 0X82); \r
+ hx3695_write_reg(0X6f, 0X08);\r
+/////////FIFO and adc conversion ready config////////\r
+/////////FIFO and adc conversion ready config////////\r
+#if defined(PPG_INT_MODE)\r
+ hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble\r
+ hx3695_write_reg(0X33, 0x83); // int width \r
+ hx3695_write_reg(0X21, 0x00); // fifo int sel,00=FIFO INT config clear\r
+ hx3695_write_reg(0X38, 0x01); // int sel,00=close almost full int,04=enable almost full int\r
+#elif defined(INT_MODE) //FIFO_ALL_MOST_FULL)\r
+ hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble\r
+ hx3695_write_reg(0X1c, (fifo_watermark&0xff)); //fifo_watermark\r
+ hx3695_write_reg(0X1d, fifo_watermark<<8); //bit<0>=fifo_watermark[8] \r
+ hx3695_write_reg(0X33, 0x83); // int width \r
+ hx3695_write_reg(0X21, 0x00); // fifo int sel,00=FIFO INT config clear\r
+ hx3695_write_reg(0X38, 0x04); // int sel,00=close almost full int,04=enable almost full int\r
+\r
+#else\r
+ hx3695_write_reg(0X1b, 0x92); // bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble \r
+ hx3695_write_reg(0X38, 0x01); // int sel,00=close almost full int,04=enable almost full int\r
+ \r
+#endif\r
+\r
+ \r
+ hx3695_write_reg(0X26,(phase1_enable<<3)|(phase1_adc_osr)|(phase2_enable<<7)|(phase2_adc_osr<<4) ); \r
+ hx3695_write_reg(0X27,(phase3_enable<<3)|(phase3_adc_osr)|(phase4_enable<<7)|(phase4_adc_osr<<4) ); \r
+ hx3695_write_reg(0X28,(phase5_enable<<3)|(phase5_adc_osr)|(phase6_enable<<7)|(phase6_adc_osr<<4) );\r
+ hx3695_write_reg(0X29,(phase7_enable<<3)|(phase7_adc_osr)|(phase8_enable<<7)|(phase8_adc_osr<<4) ); \r
+\r
+// hx3695_write_reg(0X5c, 0x02);//soft reset\r
+ hx3695_delay_ms(5); \r
+ hx3695_write_reg(0X5c, 0x00);//release\r
+// read_fifo_first_flg = 1;\r
+ return ;\r
+}\r
+\r
+void hx3695_factory_ft_int_test_config(void)//ÖжϲâÊÔÅäÖÃ\r
+{\r
+ uint16_t sample_rate = 25; /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+ uint32_t prf_clk_num = 32000/sample_rate; /*period in clk num, num = Fclk/fs */\r
+\r
+ uint8_t adc_rst_post_num=0; /* 00=16,01=32,10=64,11=128*/ \r
+ uint8_t samp_delay_leden_num = 0; /* 00=8,01=16,10=32,11=64*/ \r
+ uint8_t samp_copy_avg = 0; /* 0=1, 1=2, 2=4 ,3=8, 4=16*/\r
+ uint8_t data_avg_num = 0; /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+ uint8_t phase7_8_internal = 0; /* phase7 and phase8 prf internal cfg */\r
+ \r
+ uint8_t phase1_enable = 1; /*phase1_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase2_enable = 1; /*phase2_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase3_enable = 1; /*phase3_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase4_enable = 1; /*phase4_enable , 1 mean enable ; 0 mean disable */\r
+ uint8_t phase5_enable = 0; /*phase5_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase6_enable = 0; /*phase6_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase7_enable = 0; /*phase7_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase8_enable = 0; /*phase8_enable , 1 mean enable ; 0 mean disable */ \r
+\r
+ uint8_t phase1_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase2_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase3_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase4_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase5_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase6_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase7_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase8_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ \r
+ uint8_t phase1_mux_sel = 0; /* sel phase1*/\r
+ uint8_t phase2_mux_sel = 1; /* sel phase2*/\r
+ uint8_t phase3_mux_sel = 2; /* sel phase3*/\r
+ uint8_t phase4_mux_sel = 3; /* sel phase4*/\r
+ uint8_t phase5_mux_sel = 4; /* sel phase5*/\r
+ uint8_t phase6_mux_sel = 5; /* sel phase6*/\r
+ uint8_t phase7_mux_sel = 6; /* sel phase7*/\r
+ uint8_t phase8_mux_sel = 7; /* sel phase8*/\r
+ \r
+\r
+ uint8_t phase1_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase1_tia_res = 3; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase1_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase1_led_drv1_cha_sel = 0; /* 1 = ldr1 NG; 2 = ldr2 GR; 4 = ldr3 IR; 8 = ldr4 RED; */\r
+ uint8_t phase1_led_drv2_cha_sel = 0; /*ldr5:0x20 ldr6: 0x40 red ldr8 0x80 ir */\r
+ uint8_t phase1_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase1_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase1_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase1_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase1_ldr2_cur = 0;\r
+// uint8_t phase1_of_idac1_cur = 0;\r
+// uint8_t phase1_of_idac2_cur = 0;\r
+ uint8_t phase1_ad_inr_ctrl = 3;\r
+ uint8_t phase1_ad_of_idac_ctrl = 0;\r
+// uint8_t afe_offset = 0;\r
+ uint8_t phase1_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase1_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase1_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+\r
+\r
+ uint8_t phase2_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase2_tia_res = 3; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase2_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase2_led_drv1_cha_sel = GREEN_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase2_led_drv2_cha_sel = 0;\r
+ uint8_t phase2_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase2_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase2_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase2_ldr1_cur = 15; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase2_ldr2_cur = 0;\r
+// uint8_t phase2_of_idac1_cur = 0;\r
+// uint8_t phase2_of_idac2_cur = 0;\r
+ uint8_t phase2_ad_inr_ctrl = 3;\r
+ uint8_t phase2_ad_of_idac_ctrl = 0;\r
+// uint8_t phase2_afe_offset = 0;\r
+ uint8_t phase2_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase2_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase2_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ \r
+ uint8_t phase3_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase3_tia_res = 3; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase3_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase3_led_drv1_cha_sel = RED_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase3_led_drv2_cha_sel = 0;\r
+ uint8_t phase3_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase3_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase3_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase3_ldr1_cur = 15; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase3_ldr2_cur = 0;\r
+// uint8_t phase3_of_idac1_cur = 0;\r
+// uint8_t phase3_of_idac2_cur = 0;\r
+ uint8_t phase3_ad_inr_ctrl = 3;\r
+ uint8_t phase3_ad_of_idac_ctrl = 0;\r
+// uint8_t phase3_afe_offset = 0;\r
+ uint8_t phase3_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase3_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase3_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ \r
+ uint8_t phase4_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase4_tia_res = 3; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase4_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase4_led_drv1_cha_sel = IR_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase4_led_drv2_cha_sel = 0;\r
+ uint8_t phase4_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; 4 = pd3*/\r
+ uint8_t phase4_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase4_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase4_ldr1_cur = 15; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase4_ldr2_cur = 0;\r
+// uint8_t phase4_of_idac1_cur = 0;\r
+// uint8_t phase4_of_idac2_cur = 0;\r
+ uint8_t phase4_ad_inr_ctrl = 3;\r
+ uint8_t phase4_ad_of_idac_ctrl = 0;\r
+// uint8_t phase4_afe_offset = 0;\r
+ uint8_t phase4_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase4_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase4_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase5_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase5_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase5_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase5_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase5_led_drv2_cha_sel = 0;\r
+ uint8_t phase5_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase5_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase5_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase5_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase5_ldr2_cur = 0;\r
+// uint8_t phase5_of_idac1_cur = 0;\r
+// uint8_t phase5_of_idac2_cur = 0;\r
+ uint8_t phase5_ad_inr_ctrl = 3;\r
+ uint8_t phase5_ad_of_idac_ctrl = 0;\r
+// uint8_t phase5_afe_offset = 0;\r
+ uint8_t phase5_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase5_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase5_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase6_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase6_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase6_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase6_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase6_led_drv2_cha_sel = 0;\r
+ uint8_t phase6_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase6_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase6_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase6_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase6_ldr2_cur = 0;\r
+// uint8_t phase6_of_idac1_cur = 0;\r
+// uint8_t phase6_of_idac2_cur = 0;\r
+ uint8_t phase6_ad_inr_ctrl = 3;\r
+ uint8_t phase6_ad_of_idac_ctrl = 0;\r
+// uint8_t phase6_afe_offset = 0;\r
+ uint8_t phase6_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase6_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase6_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase7_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase7_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase7_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase7_led_drv1_cha_sel = 0; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase7_led_drv2_cha_sel = 0;\r
+ uint8_t phase7_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase7_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase7_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase7_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase7_ldr2_cur = 0;\r
+// uint8_t phase7_of_idac1_cur = 0;\r
+// uint8_t phase7_of_idac2_cur = 0;\r
+ uint8_t phase7_ad_inr_ctrl = 3;\r
+ uint8_t phase7_ad_of_idac_ctrl = 0;\r
+// uint8_t phase7_afe_offset = 0;\r
+ uint8_t phase7_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase7_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase7_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t phase8_inner_avg = 0; /* phase1 adc avg num 0=1, 1=2, 2=4, 3=8 , 4=16*/\r
+ uint8_t phase8_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase8_tia_cap = 4; /* 0= ; 1= ; 2= ; 3= ; 4= ; 5= ; 6= ; 7= */\r
+ uint8_t phase8_led_drv1_cha_sel = 0; //IR_LED_SLE; /* 1 = ldr1; 2 = ldr2; 4 = ldr3; 8 = ldr4 ; */\r
+ uint8_t phase8_led_drv2_cha_sel = 0;\r
+ uint8_t phase8_pd_sel = 0x0c; /* 1 = pd1; 2 = pd2; */\r
+ uint8_t phase8_als_offset_idac = 0; /* 0~255 = 0 ~ 128ua , step = 0.5ua */\r
+ uint8_t phase8_led_offset_idac = 0; /* 0~255 = 0 ~ 64ua , step = 0.25ua */\r
+ uint8_t phase8_ldr1_cur = 0; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ uint8_t phase8_ldr2_cur = 0;\r
+// uint8_t phase8_of_idac1_cur = 0;\r
+// uint8_t phase8_of_idac2_cur = 0;\r
+ uint8_t phase8_ad_inr_ctrl = 3;\r
+ uint8_t phase8_ad_of_idac_ctrl = 0;\r
+// uint8_t phase8_afe_offset = 0;\r
+ uint8_t phase8_led_en = 1; /* phase1 led enable*/\r
+ \r
+ uint8_t phase8_dsp_mov_avg_num = 0; /* 0=bypass ; 1=2 ; 2=4 ; 3=8 */\r
+ uint8_t phase8_dsp_iir_lp_coeff = 0; /* 0=bypass ; 1=1/2 ; 2=1/4 ; 3=1/8 ,...,7=1/128 */\r
+\r
+ uint8_t init_wait_delay = 5 ; /* 0 = 31clk ; 1 = 64clk ; 2 = 127clk ; 3 = 255clk(d) ;\r
+ 4 = 511clk; 5 = 1023clk; 6 = 2047; 7 = 4095clk */ \r
+ \r
+ uint8_t afe_reset = 3; /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d) ;\r
+ 4 = 255clk; 5 = 511clk; 6 = 1024; 7 = 2047clk */\r
+ \r
+ uint8_t afe_rst_cnvt = 1; /* 0 = 15clk ; 1 = 31clk ; 2 = 63clk ; 3 = 127clk(d)*/\r
+ \r
+ uint8_t led_en_idac_pre = 2; /* 0 = 8clk ; 1 = 16clk ; 2 = 32clk ; 3 = 64clk(d)*/ \r
+ \r
+ uint8_t led_en_idac = 1; /* 0 = 4clk ; 1 = 8clk ; 2 = 16clk ; 3 = 32clk(d)*/ \r
+ \r
+ uint8_t led_on_time = 2; /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+ 4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+ \r
+ hx3695_delay_ms(10); \r
+ \r
+ hx3695_write_reg(0X2a, (uint8_t)prf_clk_num); // prf bit<7:0>6\r
+ hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+ hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16> \r
+ \r
+ hx3695_write_reg(0X25, (afe_rst_cnvt<<4| led_en_idac_pre<<2|led_en_idac)); \r
+ hx3695_write_reg(0X2d, phase7_8_internal); \r
+ hx3695_write_reg(0X2e, 0x33);// gpio ctrl \r
+ hx3695_write_reg(0X2f, ((afe_reset<<4)| init_wait_delay));\r
+ hx3695_write_reg(0X30, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+ hx3695_write_reg(0X72, (phase8_led_en<<7 | phase7_led_en<<6 |phase6_led_en<<5 |phase5_led_en<<4 |phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+\r
+\r
+ hx3695_write_reg(0X31, (led_on_time<<4| 0x00));\r
+ hx3695_write_reg(0X33, 0x83);// Öжϼ«ÐÔ¼°¿í¶ÈÅäÖã»\r
+ hx3695_write_reg(0X34, 0x00);// ÖжÏÌØÊâÅäÖã»\r
+ hx3695_write_reg(0X36, 0x00);// phase data ready ±êÖ¾ÉèÖã»\r
+ hx3695_write_reg(0X38, 0x00);\r
+ \r
+ hx3695_write_reg(0X3a, (phase1_inner_avg | (phase2_inner_avg<<4))); \r
+ hx3695_write_reg(0X3b, (phase3_inner_avg | (phase4_inner_avg<<4))); \r
+ hx3695_write_reg(0X3c, (phase5_inner_avg | (phase6_inner_avg<<4))); \r
+ hx3695_write_reg(0X3d, (phase7_inner_avg | (phase8_inner_avg<<4))); \r
+ hx3695_write_reg(0X3e, adc_rst_post_num<<6 | samp_delay_leden_num<<4 | samp_copy_avg); \r
+ hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+ \r
+ hx3695_write_reg(0X43, phase1_mux_sel); \r
+ hx3695_write_reg(0X44, phase1_tia_cap<<4|phase1_tia_res); \r
+ hx3695_write_reg(0X45, phase1_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase1_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase1_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase1_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+\r
+ hx3695_write_reg(0X49, phase1_ad_inr_ctrl<<4|phase1_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase1_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase1_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase1_dsp_mov_avg_num | phase1_dsp_iir_lp_coeff<<4);\r
+\r
+// hx3695_write_reg(0X4e, thred_value);\r
+// hx3695_write_reg(0X4f, thred_value>>5);\r
+ \r
+ hx3695_write_reg(0X43, phase2_mux_sel); \r
+ hx3695_write_reg(0X44, phase2_tia_cap<<4|phase2_tia_res); \r
+ hx3695_write_reg(0X45, phase2_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase2_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase2_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase2_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase2_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase2_ad_inr_ctrl<<4|phase2_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase2_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase2_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase2_dsp_mov_avg_num | phase2_dsp_iir_lp_coeff<<4);\r
+ \r
+//phase3 sel\r
+\r
+ hx3695_write_reg(0X43, phase3_mux_sel); \r
+ hx3695_write_reg(0X44, phase3_tia_cap<<4|phase3_tia_res); \r
+ hx3695_write_reg(0X45, phase3_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase3_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase3_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase3_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase3_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase3_ad_inr_ctrl<<4|phase3_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase3_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase3_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase3_dsp_mov_avg_num | phase3_dsp_iir_lp_coeff<<4);\r
+ \r
+//phase4 sel\r
+\r
+ hx3695_write_reg(0X43, phase4_mux_sel); \r
+ hx3695_write_reg(0X44, phase4_tia_cap<<4|phase4_tia_res); \r
+ hx3695_write_reg(0X45, phase4_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase4_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase4_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase4_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase4_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase4_ad_inr_ctrl<<4|phase4_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase4_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase4_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase4_dsp_mov_avg_num | phase4_dsp_iir_lp_coeff<<4);\r
+\r
+ hx3695_write_reg(0X43, phase5_mux_sel); \r
+ hx3695_write_reg(0X44, phase5_tia_cap<<4|phase5_tia_res); \r
+ hx3695_write_reg(0X45, phase5_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase5_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase5_pd_sel)); //<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase5_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase5_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase1_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase5_ad_inr_ctrl<<4|phase5_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase5_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase5_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase5_dsp_mov_avg_num | phase5_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase6_mux_sel); \r
+ hx3695_write_reg(0X44, phase6_tia_cap<<4|phase6_tia_res); \r
+ hx3695_write_reg(0X45, phase6_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase6_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase6_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase6_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase6_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase6_ad_inr_ctrl<<4|phase6_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase6_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase6_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase6_dsp_mov_avg_num | phase6_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase7_mux_sel); \r
+ hx3695_write_reg(0X44, phase7_tia_cap<<4|phase7_tia_res); \r
+ hx3695_write_reg(0X45, phase7_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase7_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase7_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase7_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+// hx3695_write_reg(0X48, phase7_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase7_ad_inr_ctrl<<4|phase7_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase7_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase7_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase7_dsp_mov_avg_num | phase7_dsp_iir_lp_coeff<<4);\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase8_mux_sel); \r
+ hx3695_write_reg(0X44, phase8_tia_cap<<4|phase8_tia_res); \r
+ hx3695_write_reg(0X45, phase8_ldr1_cur); //LED_DRV1_CUR\r
+ hx3695_write_reg(0x70, phase8_ldr2_cur); //ps8--ps1 led_drv2_cur\r
+ hx3695_write_reg(0X46, (phase8_pd_sel<<4 | 0x00));\r
+ hx3695_write_reg(0X47, phase8_als_offset_idac);\r
+ hx3695_write_reg(0X48, phase8_led_offset_idac);\r
+// hx3695_write_reg(0X48, phas8_led_offset_idac);\r
+ hx3695_write_reg(0X49, phase8_ad_inr_ctrl<<4|phase8_ad_of_idac_ctrl); \r
+ hx3695_write_reg(0X4a, phase8_led_drv1_cha_sel);\r
+ hx3695_write_reg(0X4b, phase8_led_drv2_cha_sel);\r
+ hx3695_write_reg(0X71, phase8_dsp_mov_avg_num | phase8_dsp_iir_lp_coeff<<4);\r
+ \r
+\r
+// analog circuit cfg \r
+ hx3695_write_reg(0X60, 0x14); //\r
+ hx3695_write_reg(0X61, 0xf0); \r
+ hx3695_write_reg(0X62, 0x22); \r
+ hx3695_write_reg(0X63, 0x15); \r
+ \r
+ hx3695_write_reg(0X64, 0x08); \r
+ hx3695_write_reg(0X65, 0x88); //bug\r
+ \r
+ hx3695_write_reg(0X66, 0x30); // bits<3>=adc selftest en 0x30\r
+ hx3695_write_reg(0X67, 0x23); \r
+ hx3695_write_reg(0X68, 0x46); \r
+ hx3695_write_reg(0X69, 0x42); \r
+ \r
+ hx3695_write_reg(0X39, 0xff); // ofset idac1 phase enable cfg\r
+ hx3695_write_reg(0x73, 0xff); //led_offset_idac phase enable\r
+ \r
+ hx3695_write_reg(0X6a, 0X0f); \r
+ hx3695_write_reg(0X6b, 0X22); \r
+ hx3695_write_reg(0X6c, 0X00); \r
+ hx3695_write_reg(0X6d, 0X37); \r
+ hx3695_write_reg(0X6e, 0X82); \r
+ hx3695_write_reg(0X6f, 0X08);\r
+/////////FIFO and adc conversion ready config////////\r
+/////////FIFO and adc conversion ready config////////\r
+#if defined(PPG_INT_MODE)\r
+ hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble\r
+ hx3695_write_reg(0X33, 0x83); // int width \r
+ hx3695_write_reg(0X21, 0x00); // fifo int sel,00=FIFO INT config clear\r
+ hx3695_write_reg(0X38, 0x01); // int sel,00=close almost full int,04=enable almost full int\r
+#elif defined(INT_MODE) //FIFO_ALL_MOST_FULL)\r
+ hx3695_write_reg(0X1b, 0x92);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble\r
+ hx3695_write_reg(0X1c, (fifo_watermark&0xff)); //fifo_watermark\r
+ hx3695_write_reg(0X1d, fifo_watermark<<8); //bit<0>=fifo_watermark[8] \r
+ hx3695_write_reg(0X33, 0x83); // int width \r
+ hx3695_write_reg(0X21, 0x00); // fifo int sel,00=FIFO INT config clear\r
+ hx3695_write_reg(0X38, 0x04); // int sel,00=close almost full int,04=enable almost full int\r
+\r
+#else\r
+ hx3695_write_reg(0X1b, 0x92); // bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble \r
+ hx3695_write_reg(0X38, 0x01); // int sel,00=close almost full int,04=enable almost full int\r
+ \r
+#endif\r
+\r
+ \r
+ hx3695_write_reg(0X26,(phase1_enable<<3)|(phase1_adc_osr)|(phase2_enable<<7)|(phase2_adc_osr<<4) ); \r
+ hx3695_write_reg(0X27,(phase3_enable<<3)|(phase3_adc_osr)|(phase4_enable<<7)|(phase4_adc_osr<<4) ); \r
+ hx3695_write_reg(0X28,(phase5_enable<<3)|(phase5_adc_osr)|(phase6_enable<<7)|(phase6_adc_osr<<4) );\r
+ hx3695_write_reg(0X29,(phase7_enable<<3)|(phase7_adc_osr)|(phase8_enable<<7)|(phase8_adc_osr<<4) ); \r
+\r
+// hx3695_write_reg(0X5c, 0x02);//soft reset\r
+ hx3695_delay_ms(5); \r
+ hx3695_write_reg(0X5c, 0x00);//release\r
+\r
+ \r
+}\r
+\r
+bool hx3695_factory_test_read(int32_t *phase_data)\r
+{\r
+ uint8_t databuf[12] = {0};\r
+ int32_t P1 = 0, P2 = 0,P3 = 0,P4 = 0;\r
+ hx3695_brust_read_reg(0x03, databuf, 12);\r
+ P1 = ((databuf[0])|(databuf[1]<<8)|(databuf[2]<<16));\r
+ P2 = ((databuf[3])|(databuf[4]<<8)|(databuf[5]<<16));\r
+ P3 = ((databuf[6])|(databuf[7]<<8)|(databuf[8]<<16));\r
+ P4 = ((databuf[9])|(databuf[10]<<8)|(databuf[11]<<16));\r
+\r
+ phase_data[0] = P1 ;\r
+ phase_data[1] = P2 ;\r
+ phase_data[2] = P3 ;\r
+ phase_data[3] = P4 ;\r
+\r
+ DEBUG_PRINTF("p1,p2,p3,p4 %d %d %d %d\r\n", P1, P2, P3, P4);\r
+ return true;\r
+}\r
+\r
+int32_t hx3695_sort_cal(int32_t *data)\r
+{\r
+ uint8_t ii,jj;\r
+ int32_t data_temp = 0;\r
+ int32_t data_final = 0;\r
+ for(ii=0; ii<3; ii++)\r
+ {\r
+ for(jj=0; jj<3-ii; jj++)\r
+ {\r
+ if(data[jj]>=data[jj+1])\r
+ {\r
+ data_temp = data[jj];\r
+ data[jj] = data[jj+1];\r
+ data[jj+1] = data_temp;\r
+ }\r
+ }\r
+ }\r
+ data_final = (data[1]+data[2])>>1;\r
+ return data_final;\r
+}\r
+\r
+\r
+bool hx3695_chip_check_id(void)\r
+{\r
+ uint8_t i = 0;\r
+ uint8_t chip_id =0;\r
+ for(i=0; i<10; i++)\r
+ {\r
+ chip_id = hx3695_read_reg(0x00);\r
+ TYHX_LOG("chip id = 0x%x\r\n",chip_id);\r
+ if (chip_id == 0x65)\r
+ {\r
+ return true;\r
+ }\r
+ }\r
+ return false;\r
+}\r
+\r
+FT_RESULTS_t hx3695_factory_led_off_get_result(void)\r
+{\r
+ uint8_t ii = 0;\r
+ int32_t phase_data[4] = {0,0,0,0};\r
+ int32_t phase1_data[4] = {0,0,0,0};\r
+ int32_t phase2_data[4] = {0,0,0,0};\r
+ int32_t phase3_data[4] = {0,0,0,0};\r
+ int32_t phase4_data[4] = {0,0,0,0};\r
+ int32_t gr_buffer[4] = {0,0,0,0};\r
+ int32_t red_buffer[4] = {0,0,0,0};\r
+ int32_t ir_buffer[4] = {0,0,0,0};\r
+ FT_RESULTS_t ft_result = {0,0,0,0,0,0,0,0,0,0,0,0};\r
+\r
+ for(ii=0; ii<4; ii++)\r
+ {\r
+ hx3695_delay_ms(40);\r
+ hx3695_factory_test_read(phase_data);\r
+ gr_buffer[ii] = phase_data[1] - phase_data[0];\r
+ red_buffer[ii] = phase_data[2] - phase_data[0];\r
+ ir_buffer[ii] = phase_data[3] - phase_data[0];\r
+ phase1_data[ii] = phase_data[0];\r
+ phase2_data[ii] = phase_data[1];\r
+ phase3_data[ii] = phase_data[2];\r
+ phase4_data[ii] = phase_data[3];\r
+ }\r
+ ft_result.phase1_data_avg = hx3695_sort_cal(phase1_data);\r
+ ft_result.phase2_data_avg = hx3695_sort_cal(phase2_data);\r
+ ft_result.phase3_data_avg = hx3695_sort_cal(phase3_data);\r
+ ft_result.phase4_data_avg = hx3695_sort_cal(phase4_data);\r
+ ft_result.gr_ps_dif = hx3695_sort_cal(gr_buffer);\r
+ ft_result.red_ps_dif = hx3695_sort_cal(red_buffer);\r
+ ft_result.ir_ps_dif = hx3695_sort_cal(ir_buffer);\r
+\r
+ return ft_result;\r
+}\r
+\r
+FT_RESULTS_t hx3695_factory_wear_mode_get_result(void)\r
+{\r
+ uint8_t ii = 0;\r
+ int32_t phase_data[4] = {0,0,0,0};\r
+ int32_t data_buffer[4] = {0,0,0,0};\r
+ FT_RESULTS_t ft_result = {0,0,0,0,0,0,0,0,0,0,0,0};\r
+\r
+ for(ii=0; ii<4; ii++)\r
+ {\r
+ hx3695_delay_ms(110);\r
+ hx3695_factory_test_read(phase_data);\r
+ data_buffer[ii] = phase_data[0] - phase_data[1];\r
+ }\r
+ ft_result.gr_data_final = hx3695_sort_cal(data_buffer);\r
+ if(data_buffer[0]==data_buffer[1] && data_buffer[0]==data_buffer[2] && data_buffer[0]==data_buffer[3])\r
+ {\r
+ ft_result.gr_data_final = 0;\r
+ }\r
+\r
+ return ft_result;\r
+}\r
+\r
+FT_RESULTS_t hx3695_factory_ft_leak_light_test_get_result(void)\r
+{\r
+ uint8_t ii = 0;\r
+ int32_t phase_data[4] = {0,0,0,0};\r
+ int32_t gr_buffer[4] = {0,0,0,0};\r
+ int32_t red_buffer[4] = {0,0,0,0};\r
+ int32_t ir_buffer[4] = {0,0,0,0};\r
+ int32_t gr_data_ledoff = 0;\r
+ int32_t red_data_ledoff = 0;\r
+ int32_t ir_data_ledoff = 0;\r
+ int32_t gr_data_ledon = 0;\r
+ int32_t red_data_ledon = 0;\r
+ int32_t ir_data_ledon = 0;\r
+ FT_RESULTS_t ft_result = {0,0,0,0,0,0,0,0,0,0,0,0};\r
+\r
+ for(ii=0; ii<4; ii++)\r
+ {\r
+ hx3695_delay_ms(40);\r
+ hx3695_factory_test_read(phase_data);\r
+ gr_buffer[ii] = phase_data[1] - phase_data[0];\r
+ red_buffer[ii] = phase_data[2] - phase_data[0];\r
+ ir_buffer[ii] = phase_data[3] - phase_data[0];\r
+ }\r
+ gr_data_ledon = hx3695_sort_cal(gr_buffer);\r
+ red_data_ledon = hx3695_sort_cal(red_buffer);\r
+ ir_data_ledon = hx3695_sort_cal(ir_buffer);\r
+\r
+ hx3695_write_reg(0x30, 0x00);\r
+ hx3695_write_reg(0x72, 0x00);\r
+ hx3695_delay_ms(100);\r
+\r
+ for(ii=0; ii<4; ii++)\r
+ {\r
+ hx3695_delay_ms(40);\r
+ hx3695_factory_test_read(phase_data);\r
+ gr_buffer[ii] = phase_data[1] - phase_data[0];\r
+ red_buffer[ii] = phase_data[2] - phase_data[0];\r
+ ir_buffer[ii] = phase_data[3] - phase_data[0];\r
+ }\r
+ gr_data_ledoff = hx3695_sort_cal(gr_buffer);\r
+ red_data_ledoff = hx3695_sort_cal(red_buffer);\r
+ ir_data_ledoff = hx3695_sort_cal(ir_buffer);\r
+\r
+ ft_result.gr_ps_dif = gr_data_ledoff;\r
+ ft_result.red_ps_dif = red_data_ledoff;\r
+ ft_result.ir_ps_dif = ir_data_ledoff;\r
+ ft_result.gr_data_final = gr_data_ledon - gr_data_ledoff;\r
+ ft_result.red_data_final = red_data_ledon - red_data_ledoff;\r
+ ft_result.ir_data_final = ir_data_ledon - ir_data_ledoff;\r
+ if(ft_result.gr_data_final<0)\r
+ {\r
+ ft_result.gr_data_final = 0;\r
+ }\r
+ if(ft_result.red_data_final<0)\r
+ {\r
+ ft_result.red_data_final = 0;\r
+ }\r
+ if(ft_result.ir_data_final<0)\r
+ {\r
+ ft_result.ir_data_final = 0;\r
+ }\r
+ //TYHX_LOG("leaking result=%d\r\n",ft_result.gr_data_final );\r
+ //hrsresult.leak_green =ft_result.gr_data_final;\r
+\r
+\r
+\r
+ return ft_result;\r
+}\r
+\r
+FT_RESULTS_t hx3695_factory_ft_card_test_get_result(void)\r
+{\r
+ uint8_t ii = 0;\r
+ int32_t phase_data[4] = {0,0,0,0};\r
+ int32_t gr_buffer[4] = {0,0,0,0};\r
+ int32_t red_buffer[4] = {0,0,0,0};\r
+ int32_t ir_buffer[4] = {0,0,0,0};\r
+ FT_RESULTS_t ft_result = {0,0,0,0,0,0,0,0,0,0,0,0};\r
+\r
+ for(ii=0; ii<4; ii++)\r
+ {\r
+ hx3695_delay_ms(40);\r
+ hx3695_factory_test_read(phase_data);\r
+ gr_buffer[ii] = phase_data[1] - phase_data[0];\r
+ red_buffer[ii] = phase_data[2] - phase_data[0];\r
+ ir_buffer[ii] = phase_data[3] - phase_data[0];\r
+ }\r
+ ft_result.gr_data_final = hx3695_sort_cal(gr_buffer);\r
+ ft_result.red_data_final = hx3695_sort_cal(red_buffer);\r
+ ft_result.ir_data_final = hx3695_sort_cal(ir_buffer);\r
+ DEBUG_PRINTF("ft card,g%d,r%d,ir%d\r\n",ft_result.gr_data_final,ft_result.red_data_final,ft_result.ir_data_final );\r
+\r
+ if(gr_buffer[0] == gr_buffer[1] && gr_buffer[0] == gr_buffer[2] && gr_buffer[0] == gr_buffer[3])\r
+ {\r
+ ft_result.gr_data_final = 0;\r
+ ft_result.red_data_final = 0;\r
+ ft_result.ir_data_final = 0;\r
+ }\r
+ if(ft_result.gr_data_final < 0)\r
+ {\r
+ ft_result.gr_data_final = 0;\r
+ }\r
+ if(ft_result.red_data_final < 0)\r
+ {\r
+ ft_result.red_data_final = 0;\r
+ }\r
+ if(ft_result.ir_data_final < 0)\r
+ {\r
+ ft_result.ir_data_final = 0;\r
+ }\r
+\r
+ return ft_result;\r
+}\r
+\r
+FT_RESULTS_t hx3695_factory_ft_single_check_get_result(void)\r
+{\r
+ uint8_t ii = 0;\r
+ int32_t phase_data[4] = {0,0,0,0};\r
+ int32_t gr_buffer[4] = {0,0,0,0};\r
+ int32_t red_buffer[4] = {0,0,0,0};\r
+ int32_t ir_buffer[4] = {0,0,0,0};\r
+ FT_RESULTS_t ft_result = {0,0,0,0,0,0,0,0,0,0,0,0};\r
+\r
+ for(ii=0; ii<4; ii++)\r
+ {\r
+ hx3695_delay_ms(12);\r
+ hx3695_factory_test_read(phase_data);\r
+ gr_buffer[ii] = phase_data[1] - phase_data[0];\r
+ red_buffer[ii] = phase_data[2] - phase_data[0];\r
+ ir_buffer[ii] = phase_data[3] - phase_data[0];\r
+ }\r
+ ft_result.gr_data_final = hx3695_sort_cal(gr_buffer);\r
+ ft_result.red_data_final = hx3695_sort_cal(red_buffer);\r
+ ft_result.ir_data_final = hx3695_sort_cal(ir_buffer);\r
+\r
+ hx3695_write_reg(0x33, 0xff);\r
+ hx3695_delay_ms(10);\r
+\r
+ for(ii=0; ii<4; ii++)\r
+ {\r
+ hx3695_delay_ms(12);\r
+ hx3695_factory_test_read(phase_data);\r
+ gr_buffer[ii] = phase_data[1] - phase_data[0];\r
+ red_buffer[ii] = phase_data[2] - phase_data[0];\r
+ ir_buffer[ii] = phase_data[3] - phase_data[0];\r
+ }\r
+ ft_result.gr_data_high = hx3695_sort_cal(gr_buffer);\r
+\r
+ if(gr_buffer[0] == gr_buffer[1] && gr_buffer[0] == gr_buffer[2] && gr_buffer[0] == gr_buffer[3])\r
+ {\r
+ ft_result.gr_data_final = 0;\r
+ ft_result.red_data_final = 0;\r
+ ft_result.ir_data_final = 0;\r
+ }\r
+ if(ft_result.gr_data_final < 0)\r
+ {\r
+ ft_result.gr_data_final = 0;\r
+ }\r
+ if(ft_result.red_data_final < 0)\r
+ {\r
+ ft_result.red_data_final = 0;\r
+ }\r
+ if(ft_result.ir_data_final < 0)\r
+ {\r
+ ft_result.ir_data_final = 0;\r
+ }\r
+ if(ft_result.gr_data_final > 0)\r
+ {\r
+ ft_result.single_gr_led_judge = ft_result.gr_data_high*100/ft_result.gr_data_final;\r
+ }\r
+\r
+ return ft_result;\r
+}\r
+\r
+FT_RESULTS_t hx3695_factroy_test(TEST_MODE_t test_mode)\r
+{\r
+ FT_RESULTS_t ft_result = {0,0,0,0,0,0,0,0,0,0,0,0};\r
+\r
+ //if (hx3695_chip_check_id() == false)\r
+ {\r
+ // return ft_result;\r
+ }\r
+ switch(test_mode)\r
+ {\r
+ case LED_OFF_TEST:\r
+ hx3695_factory_led_off_config();\r
+ hx3695_delay_ms(50);\r
+ ft_result = hx3695_factory_led_off_get_result();\r
+ break;\r
+ case WEAR_MODE_TEST:\r
+ hx3695_factory_wear_mode_config();\r
+ hx3695_delay_ms(50);\r
+ ft_result = hx3695_factory_wear_mode_get_result();\r
+ break;\r
+ case LEAK_LIGHT_TEST:\r
+ hx3695_factory_ft_leak_light_test_config();\r
+ hx3695_delay_ms(50);\r
+ ft_result = hx3695_factory_ft_leak_light_test_get_result();\r
+ hrsresult.leak_green = ft_result.gr_data_final;\r
+ hrsresult.leak_red = ft_result.red_data_final;\r
+ hrsresult.leak_ir = ft_result.ir_data_final;\r
+ TYHX_LOG("leak g=%d\r\n",hrsresult.leak_green);\r
+ break;\r
+ case GRAY_CARD_TEST:\r
+ hx3695_factory_ft_card_test_config();\r
+ hx3695_delay_ms(50);\r
+ ft_result = hx3695_factory_ft_card_test_get_result();\r
+ hrsresult.card_green = ft_result.gr_data_final;\r
+ hrsresult.card_red = ft_result.red_data_final;\r
+ hrsresult.card_ir = ft_result.ir_data_final;\r
+ break;\r
+ case FT_INT_TEST:\r
+ hx3695_factory_ft_int_test_config();\r
+ break;\r
+ case SINGLE_CHECK_TEST:\r
+ hx3695_factory_ft_single_check_config();\r
+ hx3695_delay_ms(50);\r
+ ft_result = hx3695_factory_ft_single_check_get_result();\r
+ break;\r
+ default:\r
+ break;\r
+ }\r
+\r
+ //hx3695_ppg_off();\r
+ DEBUG_PRINTF("%d %d %d %d %d %d %d %d %d %d %d %d\r\n", ft_result.phase1_data_avg, ft_result.phase2_data_avg, ft_result.phase3_data_avg, ft_result.phase4_data_avg, \\r
+ ft_result.gr_ps_dif, ft_result.red_ps_dif, ft_result.ir_ps_dif, ft_result.gr_data_final, ft_result.red_data_final, ft_result.ir_data_final, ft_result.gr_data_high, \\r
+ ft_result.single_gr_led_judge);\r
+\r
+ return ft_result;\r
+}\r
--- /dev/null
+#ifndef _HX3695_FACTORY_TEST_H_\r
+#define _HX3695_FACTORY_TEST_H_\r
+\r
+#include <stdint.h>\r
+#include <stdbool.h>\r
+\r
+typedef enum {\r
+ LEAK_LIGHT_TEST = 1,\r
+ GRAY_CARD_TEST = 2,\r
+ FT_INT_TEST = 3,\r
+ SINGLE_CHECK_TEST = 4,\r
+ LED_OFF_TEST = 5,\r
+ WEAR_MODE_TEST = 6\r
+} TEST_MODE_t;\r
+\r
+typedef struct { \r
+ int32_t phase1_data_avg;\r
+ int32_t phase2_data_avg;\r
+ int32_t phase3_data_avg;\r
+ int32_t phase4_data_avg;\r
+ int32_t gr_ps_dif;\r
+ int32_t red_ps_dif;\r
+ int32_t ir_ps_dif;\r
+ int32_t gr_data_final;\r
+ int32_t red_data_final;\r
+ int32_t ir_data_final;\r
+ int32_t gr_data_high;\r
+ int32_t single_gr_led_judge;\r
+} FT_RESULTS_t;\r
+\r
+void hx3695_factory_ft_leak_light_test_config(void);\r
+void hx3695_factory_ft_card_test_config(void);\r
+void hx3695_factory_ft_int_test_config(void);\r
+\r
+bool hx3695_factory_test_read(int32_t *phase_data);\r
+FT_RESULTS_t hx3695_factroy_test(TEST_MODE_t test_mode);\r
+\r
+void hx3695_lab_test(uint32_t test_mode);\r
+void hx3695_lab_test_read(void);\r
+\r
+\r
+#endif // _HX3695_FACTORY_TEST_H_\r
+\r
+\r
+\r
+\r
--- /dev/null
+\r
+#include <stdio.h>\r
+#include <stdbool.h>\r
+#include <stdint.h>\r
+#include <stdlib.h>\r
+#include <math.h>\r
+\r
+#include "tyhx_hrs_custom.h"\r
+\r
+#include "hx3695.h"\r
+#include "hx3695_hrs_agc.h"\r
+#include "tyhx_hrs_alg.h"\r
+\r
+\r
+#ifdef HRS_ALG_LIB\r
+extern const uint8_t hx3695_hrs_agc_idac;\r
+extern uint8_t hx3695_hrs_g1_agc_idac;\r
+extern uint8_t hx3695_hrs_g2_agc_idac;\r
+extern uint8_t hx3695_hrs_g3_agc_idac;\r
+\r
+extern const uint8_t green_led_max_init;\r
+extern uint8_t low_vbat_flag;\r
+extern uint8_t hrs_phase_num;\r
+extern uint8_t read_fifo_first_flg;\r
+\r
+\r
+//HRS_INFRARED_THRES\r
+extern const int32_t hrs_ir_unwear_thres;\r
+extern const int32_t hrs_ir_wear_thres;\r
+\r
+static uint8_t s_ppg_state = 0;\r
+static uint8_t hrs_cal_state = 0;\r
+\r
+static int32_t s_buf[64] = {0}; \r
+static int32_t agc_buf[8] = {0};\r
+static uint8_t fifo_data_temp[3] = {0};\r
+\r
+static uint8_t cal_delay = CAL_DELAY_COUNT;\r
+static HRS_CAL_SET_T calReg_Hrs;;\r
+//\r
+static hrs_wear_msg_code_t hrs_wear_status = MSG_HRS_NO_WEAR;\r
+static hrs_wear_msg_code_t hrs_wear_status_pre = MSG_HRS_NO_WEAR;\r
+\r
+static uint8_t no_touch_cnt = 0;\r
+\r
+void Init_hrs_PPG_Calibration_Routine(HRS_CAL_SET_T *calR)\r
+{\r
+ calR->flag = CAL_FLG_LED_DR|CAL_FLG_LED_DAC|CAL_FLG_AMB_DAC|CAL_FLG_RF;\r
+ calR->Group1_Ledidac = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+ calR->Group2_Ledidac = 0;\r
+// calR->Group3_Ledidac = 0;\r
+\r
+ calR->Group1_AMBDAC = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+ calR->Group2_AMBDAC = 0;\r
+// calR->Group3_AMBDAC = 0; \r
+\r
+ \r
+ calR->Group1_RF = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ calR->Group2_RF = 0;\r
+// calR->Group3_RF = 0;\r
+\r
+ calR->Group1_Cur = HRS_CAL_INIT_LED;\r
+ calR->Group2_Cur = HRS_CAL_INIT_LED;\r
+// calR->Group3_Cur = HRS_CAL_INIT_LED;\r
+ \r
+ \r
+ calR->state = hrsCalStart;\r
+ calR->int_cnt = 0;\r
+ calR->cur255_cnt =0;\r
+ if(low_vbat_flag==1)\r
+ {\r
+// calR->led_max_cur = 128;\r
+ calR->Group1_max_cur = 128;\r
+ calR->Group2_max_cur = 128;\r
+// calR->Group3_max_cur = 128;\r
+ }\r
+ else\r
+ {\r
+ calR->Group1_max_cur = green_led_max_init; \r
+ calR->Group2_max_cur = green_led_max_init; \r
+// calR->Group3_max_cur = green_led_max_init; \r
+ \r
+ }\r
+}\r
+\r
+void Restart_hrs_PPG_Calibration_Routine(HRS_CAL_SET_T *calR)\r
+{\r
+ calR->flag = CAL_FLG_LED_DAC;\r
+ calR->state = hrsCalLed;\r
+ calR->int_cnt = 0;\r
+}\r
+\r
+hrs_wear_msg_code_t hx3695_hrs_wear_mode_check(WORK_MODE_T mode, int32_t infrared_data)\r
+{\r
+ if(infrared_data > hrs_ir_wear_thres)\r
+ {\r
+ if(no_touch_cnt < NO_TOUCH_CHECK_NUM)\r
+ {\r
+ no_touch_cnt++; \r
+ } \r
+ if(no_touch_cnt >= NO_TOUCH_CHECK_NUM) \r
+ {\r
+ hrs_wear_status = MSG_HRS_WEAR;\r
+ } \r
+ }\r
+ else if(infrared_data < hrs_ir_unwear_thres)\r
+ {\r
+ if(no_touch_cnt>0)\r
+ {\r
+ no_touch_cnt--;\r
+ }\r
+ if(no_touch_cnt == 0)\r
+ {\r
+ hrs_wear_status = MSG_HRS_NO_WEAR; \r
+ } \r
+ } \r
+// SEGGER_RTT_printf(0,"hrs ir_data: %d, hrs_wear_status_pre=%d, hrs_wear_status=%d\r\n",\\r
+ infrared_data,hrs_wear_status_pre,hrs_wear_status);\r
+ if(mode == WEAR_MODE)\r
+ {\r
+ return hrs_wear_status;\r
+ }\r
+ if(hrs_wear_status_pre != hrs_wear_status)\r
+ {\r
+ hrs_wear_status_pre = hrs_wear_status;\r
+ if(hrs_wear_status_pre == MSG_HRS_NO_WEAR)\r
+ {\r
+ SEGGER_RTT_printf(0,"run here_low_pow!! \r\n");\r
+ hx3695_hrs_low_power();\r
+ \r
+ \r
+ }\r
+ else if(hrs_wear_status_pre == MSG_HRS_WEAR)\r
+ {\r
+ tyhx_hrs_alg_open_deep();\r
+ hx3695_hrs_set_mode(PPG_INIT);\r
+ hx3695_hrs_set_mode(CAL_INIT);\r
+ } \r
+ } \r
+ return hrs_wear_status;\r
+}\r
+\r
+\r
+\r
+\r
+//void PPG_hrs_Calibration_Routine(HRS_CAL_SET_T *calR, int32_t g1_led,int32_t g2_led,int32_t g3_led, int32_t g1_amb, int32_t g2_amb,int32_t g3_amb)\r
+void PPG_hrs_Calibration_Routine(HRS_CAL_SET_T *calR, int32_t g1_led,int32_t g2_led, int32_t g1_amb, int32_t g2_amb)\r
+\r
+{\r
+ switch(calR->state)\r
+ {\r
+ case hrsCalStart:\r
+ calR->state = hrsCalStart1;\r
+ break;\r
+ \r
+ case hrsCalStart1:\r
+ if(g1_amb>525000)\r
+ {\r
+ calR->Group1_AMBDAC = (g1_amb-525000)/1300;\r
+ }\r
+ else\r
+ {\r
+ calR->Group1_AMBDAC = 0;\r
+ }\r
+ \r
+ if(g2_amb > 525000)\r
+ {\r
+ calR->Group2_AMBDAC = (g2_amb - 525000)/1300;\r
+ }\r
+ else\r
+ {\r
+ calR->Group2_AMBDAC = 0;\r
+ }\r
+// if(g3_amb>525000)\r
+// {\r
+// calR->Group3_AMBDAC = (g3_amb-525000)/1300;\r
+// }\r
+// else\r
+// {\r
+// calR->Group3_AMBDAC = 0;\r
+// }\r
+ \r
+ if(g1_led > g1_amb+256)\r
+ { \r
+ calR->Group1_step = (g1_led - g1_amb)/(HRS_CAL_INIT_LED);\r
+ calR->Group1_Cur = 1300*(hx3695_hrs_g1_agc_idac + calR->Group1_AMBDAC)/(calR->Group1_step);\r
+ AGC_LOG("AGC1: calR->Group1_Cur = %d,\r\n",calR->Group1_Cur);\r
+\r
+ if(calR->Group1_Cur > calR->Group1_max_cur)\r
+ {\r
+ calR->Group1_Cur = calR->Group1_max_cur;\r
+ }\r
+ if(calR->Group1_Cur != calR->Group1_max_cur)\r
+ {\r
+ calR->Group1_Ledidac = (hx3695_hrs_g1_agc_idac*3)>>2;\r
+ }\r
+ else\r
+ {\r
+ calR->Group1_Ledidac = hx3695_hrs_g1_agc_idac>>1;\r
+ }\r
+ }\r
+ \r
+ if(g2_led > g2_amb+256)\r
+ { \r
+ calR->Group2_step = (g2_led - g2_amb)/(HRS_CAL_INIT_LED);\r
+ calR->Group2_Cur = 1300*(hx3695_hrs_g2_agc_idac + calR->Group2_AMBDAC)/(calR->Group2_step);\r
+ AGC_LOG("AGC2: calR->Group2_Cur = %d,\r\n",calR->Group2_Cur);\r
+\r
+ if(calR->Group2_Cur > calR->Group2_max_cur)\r
+ {\r
+ calR->Group2_Cur = calR->Group2_max_cur;\r
+ }\r
+ if(calR->Group2_Cur != calR->Group2_max_cur)\r
+ {\r
+ calR->Group2_Ledidac = (hx3695_hrs_g2_agc_idac*3)>>2;\r
+ }\r
+ else\r
+ {\r
+ calR->Group2_Ledidac = hx3695_hrs_g2_agc_idac>>1;\r
+ }\r
+ }\r
+ \r
+\r
+// if(g3_led > g3_amb+256)\r
+// { \r
+// calR->Group3_step = (g3_led - g3_amb)/(HRS_CAL_INIT_LED);\r
+// calR->Group3_Cur = 1300*(hx3695_hrs_g3_agc_idac + calR->Group3_AMBDAC)/(calR->Group3_step);\r
+// AGC_LOG("AGC3: calR->Group3_Cur = %d,\r\n",calR->Group3_Cur);\r
+\r
+// if(calR->Group3_Cur > calR->Group3_max_cur)\r
+// {\r
+// calR->Group3_Cur = calR->Group3_max_cur;\r
+// }\r
+// if(calR->Group3_Cur != calR->Group3_max_cur)\r
+// {\r
+// calR->Group3_Ledidac = (hx3695_hrs_g3_agc_idac*3)>>2;\r
+// }\r
+// else\r
+// {\r
+// calR->Group3_Ledidac = hx3695_hrs_g3_agc_idac>>1;\r
+// }\r
+// } \r
+ \r
+ calR->Group1_RF = 5;\r
+ calR->Group2_RF = 5;\r
+// calR->Group3_RF = 6;\r
+ \r
+ calR->flag = CAL_FLG_LED_DR|CAL_FLG_LED_DAC|CAL_FLG_AMB_DAC|CAL_FLG_RF; \r
+ calR->state = hrsCalLed;\r
+ \r
+ break;\r
+ \r
+ case hrsCalLed: \r
+ \r
+ if(g1_led>900000 && calR->Group1_Ledidac<= 55)\r
+ {\r
+ calR->Group1_Ledidac = calR->Group1_Ledidac + 6;\r
+ } \r
+ if(g2_led>900000 && calR->Group2_Ledidac<= 55)\r
+ {\r
+ calR->Group2_Ledidac = calR->Group2_Ledidac + 6; \r
+ } \r
+// if(g3_led>900000 && calR->Group3_Ledidac<= 55)\r
+// {\r
+// calR->Group3_Ledidac = calR->Group3_Ledidac + 6;\r
+// }\r
+ \r
+ if(g1_led < 900000 && g2_led < 900000)\r
+ {\r
+ calR->state = hrsCalLed2;\r
+ }\r
+ else if(calR->Group1_Ledidac >120 || calR->Group2_Ledidac > 120)\r
+ {\r
+ calR->state = hrsCalLed3; \r
+ }\r
+ else\r
+ {\r
+ calR->state = hrsCalLed;\r
+ }\r
+ calR->flag = CAL_FLG_LED_DAC;\r
+ break; \r
+ \r
+ case hrsCalLed2:\r
+ \r
+ if(g1_led>650000 && calR->Group1_Ledidac<=120)\r
+ {\r
+ calR->Group1_Ledidac = calR->Group1_Ledidac + 3;\r
+ }\r
+ else if(g1_led < 400000 && calR->Group1_Ledidac >= 3)\r
+ {\r
+ calR->Group1_Ledidac = calR->Group1_Ledidac - 3;\r
+ }\r
+ else if(g1_led < 400000 && calR->Group1_Ledidac>0)\r
+ {\r
+ calR->Group1_Ledidac = calR->Group1_Ledidac - 1;\r
+ \r
+ } \r
+ \r
+ if(g2_led>650000 && calR->Group2_Ledidac<=120)\r
+ {\r
+ calR->Group2_Ledidac = calR->Group2_Ledidac + 3;\r
+ \r
+ }\r
+ if(g2_led<400000 && calR->Group2_Ledidac >= 3)\r
+ {\r
+ calR->Group2_Ledidac = calR->Group2_Ledidac - 3;\r
+ \r
+ }\r
+ if(g2_led < 400000 && calR->Group2_Ledidac>0)\r
+ {\r
+ calR->Group2_Ledidac = calR->Group2_Ledidac - 1;\r
+ }\r
+ \r
+ \r
+// if(g3_led>750000 && calR->Group3_Ledidac<=120)\r
+// {\r
+// calR->Group3_Ledidac = calR->Group3_Ledidac + 3;\r
+// } \r
+// if(g3_led<350000 && calR->Group3_Ledidac >= 3)\r
+// {\r
+// calR->Group3_Ledidac = calR->Group3_Ledidac - 3;\r
+// }\r
+// if(g3_led < 350000 && calR->Group3_Ledidac>0)\r
+// {\r
+// calR->Group3_Ledidac = calR->Group3_Ledidac - 1;\r
+// } \r
+ \r
+ \r
+// if(g1_led<750000 && g1_led>350000 && g2_led<750000 && g2_led>350000 && g3_led<750000 && g3_led>350000)\r
+ if(g1_led<650000 && g1_led>400000 && g2_led<650000 && g2_led>400000 )\r
+ {\r
+ calR->state = hrsCalFinish;\r
+ }\r
+// else if(calR->Group1_Ledidac >= 120 || calR->Group2_Ledidac >= 120 || calR->Group3_Ledidac >= 120)\r
+ else if(calR->Group1_Ledidac >= 120 || calR->Group2_Ledidac >= 120)\r
+\r
+ {\r
+ calR->state = hrsCalLed3;\r
+ }\r
+ else\r
+ {\r
+ calR->state = hrsCalLed2; \r
+ } \r
+ calR->flag = CAL_FLG_LED_DAC;\r
+ break;\r
+ \r
+ case hrsCalLed3: \r
+ if(calR->Group1_Ledidac >=120)\r
+ {\r
+ calR->Group1_Cur = (calR->Group1_Cur*3)>>2;\r
+ }\r
+ if(calR->Group2_Ledidac>=120)\r
+ {\r
+ calR->Group2_Cur = (calR->Group2_Cur*3)>>2;\r
+ }\r
+// if(calR->Group3_Ledidac>=120)\r
+// {\r
+// calR->Group3_Cur = (calR->Group3_Cur*3)>>2;\r
+// }\r
+ calR->flag = CAL_FLG_LED_DR;\r
+ calR->state = hrsCalLed; \r
+ break; \r
+ \r
+ case hrsCalRfEnd:\r
+ calR->state = hrsCalFinish;\r
+ calR->flag = 0;\r
+ break;\r
+ \r
+ default:\r
+ break; \r
+ }\r
+ AGC_LOG("AGC111: led_drv=%d,ledDac=%d,ambDac=%d,ledstep=%d,rf=%d,state = %d\r\n",\\r
+ calR->Group1_Cur, calR->Group1_Ledidac, calR->Group1_AMBDAC,calR->Group1_step,calR->Group1_RF,calR->state);\r
+ AGC_LOG("AGC222: led_drv=%d,ledDac=%d,ambDac=%d,ledstep=%d,rf=%d,state = %d\r\n",\\r
+ calR->Group2_Cur, calR->Group2_Ledidac, calR->Group2_AMBDAC,calR->Group2_step,calR->Group2_RF,calR->state);\r
+// AGC_LOG("AGC333: led_drv=%d,ledDac=%d,ambDac=%d,ledstep=%d,rf=%d,state = %d\r\n",\\r
+// calR->Group3_Cur, calR->Group3_Ledidac, calR->Group3_AMBDAC,calR->Group3_step,calR->Group3_RF,calR->state);\r
+}\r
+\r
+\r
+HRS_CAL_SET_T PPG_hrs_agc( )\r
+{\r
+ int32_t g1_led_val, g2_led_val, g1_amb_val, g2_amb_val;\r
+ \r
+ //AGC_LOG("agc in\r\n");\r
+ calReg_Hrs.work = false;\r
+ if (!hrs_cal_state) \r
+ {\r
+// AGC_LOG("s_cal_state1: %d \r\n", hrs_cal_state);\r
+ return calReg_Hrs;\r
+ } \r
+ //AGC_LOG("agc in\r\n");\r
+ #ifdef INT_MODE \r
+ calReg_Hrs.int_cnt ++;\r
+ if(calReg_Hrs.int_cnt < 8)\r
+ {\r
+ return calReg_Hrs; \r
+ }\r
+ calReg_Hrs.int_cnt = 0;\r
+ hx3695_gpioint_cfg(false);\r
+ #endif \r
+ calReg_Hrs.work = true; \r
+ \r
+ read_hrs_data_packet(agc_buf); \r
+ TYHX_LOG("phase_0x03 %d,%d,%d,%d,%d,%d,%d,%d \r\n",\r
+ agc_buf[0], agc_buf[1], agc_buf[2], agc_buf[3],agc_buf[4], agc_buf[5],agc_buf[6], agc_buf[7]);\r
+ \r
+ g1_led_val = agc_buf[1];\r
+ g1_amb_val = (agc_buf[0] + agc_buf[2])/2 ;\r
+ \r
+ g2_led_val = agc_buf[4];\r
+ g2_amb_val = (agc_buf[3] + agc_buf[5])/2 ;\r
+ \r
+ TYHX_LOG("cal dat g1=%d,g2=%d, a1=%d,a2=%d \r\n",\r
+ g1_led_val, g1_amb_val, g2_led_val, g2_amb_val );\r
+ \r
+ PPG_hrs_Calibration_Routine(&calReg_Hrs, g1_led_val, g2_led_val, g1_amb_val, g2_amb_val );\r
+ \r
+ if (calReg_Hrs.state == hrsCalFinish) \r
+ {\r
+ hx3695_hrs_set_mode(CAL_OFF);\r
+// AGC_LOG("hrs_state = %d \r\n",calReg_Hrs.state);\r
+ #if defined(TIMMER_MODE)\r
+ #else\r
+ hx3695_gpioint_cfg(true);\r
+ #endif\r
+ } \r
+ else\r
+ {\r
+ hx3695_hrs_updata_reg();\r
+// AGC_LOG("hrs_state1 = %d \r\n",calReg_Hrs.state);\r
+ #if defined(INT_MODE)\r
+ hx3695_gpioint_cfg(true);\r
+ #endif \r
+ }\r
+ return calReg_Hrs;\r
+}\r
+\r
+void hx3695_hrs_cal_init(void)\r
+{\r
+ uint16_t sample_rate = 200; //200 /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+ uint32_t prf_clk_num = 32000/sample_rate; /*period in clk num, num = Fclk/fs */\r
+ uint8_t data_avg_num = 0;\r
+ hx3695_write_reg(0X2a, (uint8_t)prf_clk_num); // prf bit<7:0>\r
+ hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+ hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>\r
+ hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+ \r
+ hx3695_write_reg(0x1b,0x92); //FIFO bypass mode enable old 0x10\r
+ hx3695_write_reg(0x36,0x08); // phase4 convertion ready enable\r
+ \r
+ #if defined(INT_MODE)\r
+// hx3695_write_reg(0x36,0x88); //phase8 phase4 convertion ready enable\r
+ hx3695_write_reg(0x38,0x01);\r
+ #endif\r
+ \r
+ hx3695_write_reg(0x5c,0x0a); //Chip reset\r
+ hx3695_delay_ms(5); //Delay for reset time\r
+ hx3695_write_reg(0x5c,0x08); //Chip state machine work normal\r
+ hx3695_delay_ms(10); //Delay for reset time\r
+}\r
+\r
+void hx3695_hrs_cal_off(void)\r
+{\r
+ uint16_t sample_rate = 25; /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+ uint32_t prf_clk_num = 32000/sample_rate; /*period in clk num, num = Fclk/fs */\r
+ uint8_t data_avg_num = 0;\r
+ hx3695_write_reg(0X2a, (uint8_t)prf_clk_num); // prf bit<7:0>\r
+ hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+ hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>\r
+ \r
+ hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+ \r
+ #if defined(INT_MODE) \r
+ hx3695_write_reg(0x1b,0x92); //FIFO mode enable\r
+ hx3695_write_reg(0x36,0x00); //phase convertion ready disable\r
+ hx3695_write_reg(0x38,0x04); \r
+ #endif\r
+ hx3695_write_reg(0x1b, 0x92);\r
+ hx3695_write_reg(0x5c,0x0a); //Chip reset\r
+ hx3695_delay_ms(5); //Delay for reset time\r
+ hx3695_write_reg(0x1b, 0x92);\r
+\r
+ hx3695_write_reg(0x5c,0x08); //Chip state machine work normal\r
+ hx3695_delay_ms(5);\r
+ read_fifo_first_flg = 1;\r
+// SEGGER_RTT_printf(0,"caloff_fifo: %d\r\n", (fifo_data_temp[0]|(fifo_data_temp[1]<<8)|(fifo_data_temp[2]<<16)));\r
+}\r
+\r
+void read_hrs_data_packet(int32_t *s_buf)\r
+{\r
+ uint8_t databuf1[6] = {0};\r
+ uint8_t databuf2[6] = {0};\r
+ uint8_t databuf3[6] = {0};\r
+ uint8_t databuf4[6] = {0};\r
+\r
+ hx3695_brust_read_reg(0x03, databuf1, 6); \r
+ hx3695_delay_ms(5);\r
+ hx3695_brust_read_reg(0x09, databuf2, 6); \r
+ hx3695_brust_read_reg(0x0f, databuf3, 6); \r
+ hx3695_brust_read_reg(0x15, databuf4, 6);\r
+ \r
+ s_buf[0] = ((databuf1[0])|(databuf1[1]<<8)|(databuf1[2]<<16)); \r
+ s_buf[1] = ((databuf1[3])|(databuf1[4]<<8)|(databuf1[5]<<16)); \r
+ s_buf[2] = ((databuf2[0])|(databuf2[1]<<8)|(databuf2[2]<<16)); \r
+ s_buf[3] = ((databuf2[3])|(databuf2[4]<<8)|(databuf2[5]<<16));\r
+ s_buf[4] = ((databuf3[0])|(databuf3[1]<<8)|(databuf3[2]<<16)); \r
+ s_buf[5] = ((databuf3[3])|(databuf3[4]<<8)|(databuf3[5]<<16)); \r
+ s_buf[6] = ((databuf4[0])|(databuf4[1]<<8)|(databuf4[2]<<16)); \r
+ s_buf[7] = ((databuf4[3])|(databuf4[4]<<8)|(databuf4[5]<<16));\r
+ \r
+// SEGGER_RTT_printf(0,"phase7_data: %d, phase8_data: %d\r\n", s_buf[6],s_buf[7]);\r
+ \r
+}\r
+\r
+void read_hrs_ir_packet(int32_t *buf)\r
+{\r
+ uint8_t dataBuf[6];\r
+\r
+ hx3695_brust_read_reg(0x06, dataBuf, 6);\r
+\r
+ for (uint8_t i=0; i<2; i++)\r
+ {\r
+ buf[i] = (int32_t)(dataBuf[3*i]|(dataBuf[3*i+1]<<8)|(dataBuf[3*i+2]<<16));\r
+ }\r
+}\r
+\r
+void hx3695_hrs_read_data_packet(int32_t *buf)\r
+{\r
+ uint8_t databuf1[6] = {0};\r
+ uint8_t databuf2[6] = {0};\r
+ uint32_t P1 = 0,P2 = 0,P3 = 0,P4 =0 ;\r
+\r
+ hx3695_brust_read_reg(0x03, databuf1, 6);\r
+ hx3695_brust_read_reg(0x09, databuf2, 6);\r
+\r
+ P1 = ((databuf1[0])|(databuf1[1]<<8)|(databuf1[2]<<16));\r
+ P2 = ((databuf1[3])|(databuf1[4]<<8)|(databuf1[5]<<16));\r
+ P3 = ((databuf2[0])|(databuf2[1]<<8)|(databuf2[2]<<16));\r
+ P4 = ((databuf2[3])|(databuf2[4]<<8)|(databuf2[5]<<16));\r
+\r
+ buf[0] = P1;\r
+ buf[1] = P2;\r
+ buf[2] = P3;\r
+ buf[3] = P4;\r
+ \r
+// TYHX_LOG("tyhx_here ! \r\n");\r
+ \r
+// SEGGER_RTT_printf(0,"P1~P4: %x, %x %x, %x \r\n", P1,P2,P3,P4); \r
+ \r
+}\r
+\r
+void hx3695_hrs_low_power(void)\r
+{\r
+ uint16_t sample_rate = 25; /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+ uint8_t data_avg_num = 0; /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+ uint32_t prf_clk_num = 32000/sample_rate; /*period in clk num, num = Fclk/fs */\r
+ \r
+ uint8_t phase2_offset_idac = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+ uint8_t phase5_offset_idac = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+ uint8_t phase2_ldr_cur = 0; \r
+ uint8_t phase5_ldr_cur = 0;\r
+ \r
+ uint8_t phase1_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase2_tia_res = 0; \r
+ uint8_t phase3_tia_res = 0;\r
+ \r
+ uint8_t phase4_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase5_tia_res = 0; \r
+ uint8_t phase6_tia_res = 0;\r
+ \r
+ uint8_t phase1_led_en = 1;\r
+ uint8_t phase2_led_en = 1;\r
+ uint8_t phase3_led_en = 1;\r
+ uint8_t phase4_led_en = 1;\r
+ uint8_t phase5_led_en = 1;\r
+ uint8_t phase6_led_en = 1;\r
+ uint8_t phase7_led_en = 1;\r
+ uint8_t phase8_led_en = 1;\r
+ \r
+ uint8_t phase1_mux_sel = 0; \r
+ uint8_t phase2_mux_sel = 1; \r
+ uint8_t phase3_mux_sel = 2; \r
+ uint8_t phase4_mux_sel = 3; \r
+ uint8_t phase5_mux_sel = 4; \r
+ uint8_t phase6_mux_sel = 5; \r
+ uint8_t phase7_mux_sel = 6; \r
+ uint8_t phase8_mux_sel = 7; \r
+ \r
+ uint8_t phase8_ldr_cur = 25; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+ \r
+ uint8_t led_on_time = 1; /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+ 4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+ \r
+ hx3695_write_reg(0X2a, (uint8_t)prf_clk_num); // prf bit<7:0>\r
+ hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+ hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>\r
+\r
+ hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num );\r
+ \r
+ hx3695_write_reg(0X43, phase1_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | phase1_tia_res));\r
+ hx3695_write_reg(0X43, phase2_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | phase2_tia_res));\r
+ hx3695_write_reg(0X43, phase3_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | phase3_tia_res));\r
+ \r
+ hx3695_write_reg(0X43, phase4_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | phase1_tia_res));\r
+ hx3695_write_reg(0X43, phase5_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | phase2_tia_res));\r
+ hx3695_write_reg(0X43, phase6_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | phase3_tia_res));\r
+\r
+ hx3695_write_reg(0X43, phase2_mux_sel); \r
+ hx3695_write_reg(0X47, phase2_offset_idac);\r
+ hx3695_write_reg(0X45, phase2_ldr_cur); \r
+// hx3695_write_reg(0X70, phase2_ldr_cur); \r
+\r
+ hx3695_write_reg(0X43, phase5_mux_sel); \r
+ hx3695_write_reg(0X47, phase5_offset_idac);\r
+ hx3695_write_reg(0X45, phase5_ldr_cur); \r
+ \r
+ hx3695_write_reg(0X43, phase8_mux_sel);\r
+ hx3695_write_reg(0X46, 0XC0);\r
+ hx3695_write_reg(0X45, phase8_ldr_cur); \r
+ \r
+ hx3695_write_reg(0X31, led_on_time<<4|(hx3695_read_reg(0X31)&0x0f));\r
+ hx3695_write_reg(0X30, phase8_led_en<<7 | phase7_led_en<<6 | phase6_led_en<<5 | phase5_led_en<<4 | phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en);\r
+ \r
+ //hx3695_write_reg(0X69, 0xa2); //bit<0>: rc_comb_en bits<1>=rc_rbp_en bits<7>= vcom_clamp_en bits<6:4>= LED_vdesl\r
+ \r
+ #ifdef INT_MODE\r
+ \r
+ hx3695_write_reg(0x1b,0x92); //FIFO bypass mode enable\r
+// hx3695_write_reg(0x36,0x00); //phase3 convertion ready disable\r
+// hx3695_write_reg(0X33, 0x83); // int width \r
+// hx3695_write_reg(0X21,0x04); // fifo almostfull cfg ,max=0x40;\r
+ hx3695_write_reg(0X38,0x04); // fifo almostfull cfg ,max=0x40;\r
+ #else\r
+ hx3695_write_reg(0x1b,0x92); //FIFO bypass mode enable\r
+ hx3695_write_reg(0x36,0x00); //phase3 convertion ready disable\r
+ #endif\r
+ hx3695_write_reg(0x5c,0x0a); //Chip reset\r
+ hx3695_delay_ms(5); //Delay for reset time\r
+ hx3695_write_reg(0x5c,0x00); //Chip state machine work normal\r
+ hx3695_delay_ms(5);\r
+ calReg_Hrs.Group1_Cur = 0;\r
+ calReg_Hrs.Group2_Cur = 0;\r
+ calReg_Hrs.Group3_Cur = 0;\r
+\r
+ TYHX_LOG(" chip3 go to low power mode \r\n" ); \r
+\r
+}\r
+\r
+void hx3695_hrs_updata_reg(void)\r
+{\r
+ uint8_t phase1_mux_sel = 0;\r
+ uint8_t phase2_mux_sel = 1;\r
+ uint8_t phase3_mux_sel = 2;\r
+ uint8_t phase4_mux_sel = 3;\r
+ uint8_t phase5_mux_sel = 4;\r
+ uint8_t phase6_mux_sel = 5;\r
+ uint8_t phase7_mux_sel = 6;\r
+ uint8_t phase8_mux_sel = 7;\r
+\r
+ \r
+ if (calReg_Hrs.flag & CAL_FLG_LED_DR) \r
+ {\r
+ hx3695_write_reg(0X43, phase2_mux_sel);\r
+ hx3695_write_reg(0X45, calReg_Hrs.Group1_Cur); // phase1 led driver config\r
+// hx3695_write_reg(0X70, calReg_Hrs.LED);\r
+// AGC_LOG(" phase2_led_cur_0x45 = %d \r\n",hx3695_read_reg(0x45) ); \r
+// hx3695_write_reg(0X43, phase4_mux_sel);\r
+// hx3695_write_reg(0X45, calReg_Hrs.Group2_Cur); // phase1 led driver config\r
+// \r
+ hx3695_write_reg(0X43, phase5_mux_sel);\r
+ hx3695_write_reg(0X45, calReg_Hrs.Group2_Cur); // phase1 led driver config\r
+ AGC_LOG(" phase2_led_cur_0x45 = %d \r\n",hx3695_read_reg(0x45) );\r
+ }\r
+ \r
+ if (calReg_Hrs.flag & CAL_FLG_LED_DAC) \r
+ {\r
+ hx3695_write_reg(0X43, phase2_mux_sel);\r
+ hx3695_write_reg(0X48, calReg_Hrs.Group1_Ledidac);\r
+// AGC_LOG(" Phase2_LEDDAC_0x47 = %d \r\n",hx3695_read_reg(0x47) ); \r
+// hx3695_write_reg(0X43, phase4_mux_sel);\r
+// hx3695_write_reg(0X48, calReg_Hrs.Group2_Ledidac);\r
+ \r
+ hx3695_write_reg(0X43, phase5_mux_sel);\r
+ hx3695_write_reg(0X48, calReg_Hrs.Group2_Ledidac);\r
+ }\r
+ \r
+ if (calReg_Hrs.flag & CAL_FLG_AMB_DAC) \r
+ {\r
+ hx3695_write_reg(0X43, phase1_mux_sel);\r
+ hx3695_write_reg(0X48, calReg_Hrs.Group1_AMBDAC); // phase1 offset idac cfg\r
+// AGC_LOG(" PHASE1_AMBDAC_0x47 = %d \r\n",hx3695_read_reg(0x47) ); \r
+ hx3695_write_reg(0X43, phase3_mux_sel);\r
+ hx3695_write_reg(0X48, calReg_Hrs.Group1_AMBDAC); // phase3 offset idac cfg\r
+// AGC_LOG(" PHASE3_AMBDAC_0x47 = %d \r\n",hx3695_read_reg(0x47) ); \r
+ hx3695_write_reg(0X43, phase4_mux_sel);\r
+ hx3695_write_reg(0X48, calReg_Hrs.Group2_AMBDAC); // phase5 offset idac cfg\r
+ \r
+ hx3695_write_reg(0X43, phase6_mux_sel);\r
+ hx3695_write_reg(0X48, calReg_Hrs.Group2_AMBDAC); // phase5 offset idac cfg\r
+ }\r
+ \r
+ if (calReg_Hrs.flag & CAL_FLG_RF) \r
+ { \r
+ hx3695_write_reg(0X43, phase1_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | calReg_Hrs.Group1_RF));\r
+// AGC_LOG(" PHASE1_RF_0x44 = %d \r\n",(hx3695_read_reg(0x44)&0x0f) ); \r
+ hx3695_write_reg(0X43, phase2_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | calReg_Hrs.Group1_RF));\r
+// AGC_LOG(" PHASE2_RF_0x44 = %d \r\n",(hx3695_read_reg(0x44)&0x0f) ); \r
+ hx3695_write_reg(0X43, phase3_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | calReg_Hrs.Group1_RF));\r
+// AGC_LOG(" PHASE3_RF_0x44 = %d \r\n",(hx3695_read_reg(0x44)&0x0f) ); \r
+ \r
+ hx3695_write_reg(0X43, phase4_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | calReg_Hrs.Group2_RF));\r
+ \r
+ hx3695_write_reg(0X43, phase5_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | calReg_Hrs.Group2_RF));\r
+ \r
+ hx3695_write_reg(0X43, phase6_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | calReg_Hrs.Group2_RF));\r
+ }\r
+}\r
+\r
+void hx3695_hrs_set_mode(uint8_t mode_cmd)\r
+{\r
+ switch (mode_cmd)\r
+ {\r
+ case PPG_INIT:\r
+ hx3695_hrs_ppg_init();\r
+#if defined(TIMMER_MODE)\r
+ hx3695_320ms_timer_cfg(true);\r
+#if defined(GSEN_40MS_TIMMER)\r
+ hx3695_40ms_timer_cfg(true);\r
+ #endif\r
+#else\r
+ hx3695_gpioint_cfg(true);\r
+#endif\r
+ s_ppg_state = 1;\r
+ AGC_LOG("ppg init mode\r\n");\r
+ break;\r
+\r
+ case PPG_OFF:\r
+ hx3695_ppg_off();\r
+ s_ppg_state = 0;\r
+ AGC_LOG("ppg off mode\r\n");\r
+ break;\r
+\r
+ case PPG_LED_OFF:\r
+ hx3695_hrs_low_power();\r
+ s_ppg_state = 0;\r
+ AGC_LOG("ppg led off mode\r\n");\r
+ break;\r
+\r
+ case CAL_INIT:\r
+ Init_hrs_PPG_Calibration_Routine(&calReg_Hrs);\r
+ hx3695_hrs_cal_init();\r
+ hx3695_hrs_updata_reg();\r
+ #if defined(TIMMER_MODE)\r
+ #if defined(GSEN_40MS_TIMMER)\r
+ #else\r
+ hx3695_40ms_timer_cfg(true);\r
+ #endif\r
+ #endif\r
+ hrs_cal_state = 1;\r
+ AGC_LOG("cal init mode\r\n");\r
+ break;\r
+\r
+ case RECAL_INIT:\r
+ Restart_hrs_PPG_Calibration_Routine(&calReg_Hrs);\r
+ hx3695_hrs_cal_init();\r
+ hx3695_hrs_updata_reg();\r
+#if defined(TIMMER_MODE)\r
+#if defined(GSEN_40MS_TIMMER)\r
+#else\r
+ hx3695_40ms_timer_cfg(true);\r
+#endif\r
+#endif\r
+ hrs_cal_state = 1;\r
+ AGC_LOG("Recal init mode\r\n");\r
+ break;\r
+\r
+ case CAL_OFF:\r
+#if defined(TIMMER_MODE)\r
+#if defined(GSEN_40MS_TIMMER)\r
+#else\r
+ hx3695_40ms_timer_cfg(false);\r
+#endif\r
+#endif\r
+ hx3695_hrs_cal_off();\r
+ hrs_cal_state = 0;\r
+ AGC_LOG("cal off mode\r\n");\r
+ break;\r
+\r
+ default:\r
+ break;\r
+ }\r
+}\r
+\r
+SENSOR_ERROR_T hx3695_hrs_enable(void)\r
+{\r
+ if (!hx3695_chip_check())\r
+ {\r
+ AGC_LOG("hx3695 check id failed!\r\n");\r
+ return SENSOR_OP_FAILED;\r
+ }\r
+\r
+ AGC_LOG("hx3695 check id success!\r\n");\r
+\r
+ if (s_ppg_state)\r
+ {\r
+ AGC_LOG("ppg already on!\r\n");\r
+ return SENSOR_OP_FAILED;\r
+ }\r
+ if(!tyhx_hrs_alg_open())\r
+ {\r
+ AGC_LOG("hrs alg open fail,or dynamic ram not enough!\r\n");\r
+ }\r
+\r
+ hrs_wear_status = MSG_HRS_NO_WEAR;\r
+ hrs_wear_status_pre = MSG_HRS_NO_WEAR;\r
+\r
+ hx3695_hrs_set_mode(PPG_INIT);\r
+\r
+ AGC_LOG("hx3695 enable!\r\n");\r
+\r
+ return SENSOR_OK;\r
+}\r
+\r
+void hx3695_hrs_disable(void)\r
+{\r
+#if defined(TIMMER_MODE)\r
+ hx3695_320ms_timer_cfg(false);\r
+ hx3695_40ms_timer_cfg(false);\r
+#elif defined(INT_MODE)\r
+ hx3695_gpioint_cfg(false);\r
+#endif\r
+ hx3695_hrs_set_mode(PPG_OFF);\r
+ s_ppg_state = 0;\r
+ hrs_cal_state = 0;\r
+ tyhx_hrs_alg_close();\r
+ AGC_LOG("hx3695 disable!\r\n");\r
+}\r
+\r
+void hx3695_hrs_data_reset(void)\r
+{\r
+ s_ppg_state = 0;\r
+ hrs_cal_state = 0;\r
+ tyhx_hrs_alg_close();\r
+}\r
+\r
+hrs_wear_msg_code_t hx3695_hrs_get_wear_status(void)\r
+{\r
+ return hrs_wear_status;\r
+}\r
+\r
+HRS_CAL_SET_T get_hrs_agc_status(void)\r
+{\r
+ HRS_CAL_SET_T cal;\r
+// cal.flag = calReg_Hrs.flag;\r
+// cal.int_cnt = calReg_Hrs.int_cnt;\r
+// cal.cur255_cnt = calReg_Hrs.cur255_cnt;\r
+// \r
+// cal.led_idac = calReg_Hrs.led_idac;\r
+// \r
+// cal.Group1_Ledidac = calReg_Hrs.Group1_Ledidac;\r
+// \r
+// cal.LEDDAC = calReg_Hrs.LEDDAC;\r
+// cal.AMBDAC = calReg_Hrs.AMBDAC;\r
+// cal.RF = calReg_Hrs.RF;\r
+// cal.led_step = calReg_Hrs.led_step;\r
+// cal.state = calReg_Hrs.state;\r
+// cal.led_max_cur = calReg_Hrs.led_max_cur;\r
+// cal.work = calReg_Hrs.work;\r
+ cal = calReg_Hrs;\r
+ return cal;\r
+}\r
+\r
+uint8_t hx3695_hrs_read(hrs_sensor_data_t * s_dat)\r
+{\r
+ int32_t PPG_src_data, PPG_src_data2;\r
+ int32_t Ir_src_data;\r
+ bool recal = false;\r
+ uint8_t size = 0;\r
+ uint16_t data_count = 0;\r
+ uint8_t size_byte = 0;\r
+ int32_t *PPG_buf = &(s_dat->green_data[0]);\r
+ int32_t *ir_buf = &(s_dat->ir_data[0]); \r
+ int32_t *s_buf = &(s_dat->s_buf[0]); \r
+ \r
+ int32_t ps_data[8] = {0};\r
+ int32_t ps_green_data = 0;\r
+ s_dat->agc_green = calReg_Hrs.Group1_Cur;\r
+\r
+ if (!s_ppg_state || hrs_cal_state) \r
+ {\r
+// TYHX_LOG("ppg_state: %d ,hrs_cal_state: %d\r\n",s_ppg_state,hrs_cal_state);\r
+ return 0;\r
+ } \r
+// TYHX_LOG("ppg_state: %d ,hrs_cal_state: %d\r\n",s_ppg_state,hrs_cal_state); \r
+ data_count = hx3695_read_fifo_data(s_buf,hrs_phase_num,1); \r
+ //SEGGER_RTT_printf(0,"ppg data size: %d %d\r\n", data_count,hrs_phase_num);\r
+// SEGGER_RTT_printf(0,"af_hx3695_read_fifo_data:::%d %d %d\r\n", hx3695_read_reg(0X2a),hx3695_read_reg(0X2b),hx3695_read_reg(0X2c));\r
+ s_dat->count = data_count; \r
+\r
+ read_hrs_data_packet(ps_data);\r
+ for (uint8_t i=0; i<data_count; i++) \r
+ {\r
+// PPG_src_data = ps_data[1] - ps_data[0]; // s_buf[i*3];\r
+ Ir_src_data = ps_data[7] - ps_data[6]; //s_buf[i*3+2]; \r
+ PPG_src_data = s_buf[i*3];\r
+ PPG_src_data2 = s_buf[i*3+1];\r
+// Ir_src_data = s_buf[i*4+3]; \r
+\r
+ PPG_buf[i] = PPG_src_data * 2;\r
+ ir_buf[i] = PPG_src_data2 * 2; //Ir_src_data;\r
+// SEGGER_RTT_printf(0,"PPG_data: %d , PPG_src_data2: %d\r\n", PPG_src_data,PPG_src_data2);\r
+ hx3695_hrs_wear_mode_check(HRS_MODE,Ir_src_data); \r
+// SEGGER_RTT_printf(0,"hx3690_hrs_wear_mode_check:::%d %d %d\r\n", hx3695_read_reg(0X2a),hx3695_read_reg(0X2b),hx3695_read_reg(0X2c));\r
+// SEGGER_RTT_printf(0,"fifo:%d/%d %d %d, fifo_data: %d %d %d %d\r\n" ,1+i,data_count, \\r
+ PPG_buf[i],ir_buf[i],s_buf[i*3],s_buf[i*3+1],s_buf[i*3+2],calReg_Hrs.LED); \r
+ }\r
+ ps_green_data = ps_data[1]; // - ((ps_data[2]+ps_data[0])>>1);\r
+// SEGGER_RTT_printf(0,"ps_green_data: %d PS8: %d, PS7: %d\r\n", ps_green_data,ps_data[7],ps_data[6]);\r
+ if (ps_green_data<300000 || ps_green_data>800000) \r
+ {\r
+ recal = true;\r
+ \r
+ if(hrs_wear_status==MSG_HRS_NO_WEAR)\r
+ {\r
+ recal = false;\r
+ } \r
+ }\r
+ if (recal) \r
+ //if (0)\r
+ {\r
+ cal_delay--;\r
+\r
+ if (cal_delay <= 0) \r
+ {\r
+ cal_delay = CAL_DELAY_COUNT;\r
+ hx3695_hrs_set_mode(RECAL_INIT);\r
+ AGC_LOG("========>>>>LED_IDAC = %d %d %d\r\n",calReg_Hrs.Group1_Ledidac,calReg_Hrs.Group2_Ledidac,calReg_Hrs.Group3_Ledidac);\r
+ }\r
+ }\r
+ else \r
+ {\r
+ cal_delay = CAL_DELAY_COUNT;\r
+ }\r
+// } \r
+ return 1;\r
+}\r
+\r
+\r
+#endif\r
--- /dev/null
+#ifndef _hx3695_hrs_agc_H_\r
+#define _hx3695_hrs_agc_H_\r
+#include <stdint.h>\r
+#include <stdbool.h>\r
+#include "hx3695.h"\r
+\r
+#define CAL_FLG_LED_DR 0x01\r
+#define CAL_FLG_LED_DAC 0x02 \r
+#define CAL_FLG_AMB_DAC 0x04\r
+#define CAL_FLG_RF 0x08\r
+\r
+#define HRS_CAL_INIT_LED 128\r
+#define NO_TOUCH_CHECK_NUM 2 \r
+#define CAL_DELAY_COUNT 2\r
+\r
+typedef enum {\r
+ MSG_HRS_NO_WEAR,\r
+ MSG_HRS_WEAR\r
+} hrs_wear_msg_code_t;\r
+\r
+typedef struct {\r
+ uint8_t count;\r
+ int32_t green_data[64];\r
+ int32_t ir_data[64];\r
+ int32_t s_buf[64]; \r
+ uint32_t als;\r
+ uint32_t agc_green;\r
+} hrs_sensor_data_t;\r
+\r
+\r
+//typedef struct {\r
+// SENSOR_TYPE_T type;\r
+// uint8_t count;\r
+// int32_t ppg_data[64];\r
+// int32_t ir_data[64];\r
+// int32_t s_buf[64]; \r
+// uint32_t als;\r
+// uint32_t agc_green;\r
+//}hrs_sensor_data_t;\r
+\r
+//typedef enum { \r
+// hrsCalStart, \r
+// hrsCalLedCur,\r
+// hrsCalLed,\r
+// hrsCalLed2,\r
+// hrsCalLed3,\r
+// hrsCalFinish, \r
+//} HRS_STATE_T;\r
+\r
+\r
+typedef enum { \r
+ hrsCalStart, \r
+ hrsCalStart1,\r
+ hrsCalLed,\r
+ hrsCalLed2,\r
+ hrsCalLed3,\r
+ hrsCalRf,\r
+ hrsCalRfEnd,\r
+ hrsCalFinish, \r
+}HRS_STATE_T;\r
+\r
+typedef struct {\r
+ uint8_t flag;\r
+ bool work;\r
+ uint8_t int_cnt;\r
+ uint8_t cur255_cnt;\r
+ uint8_t Group1_Ledidac; //led_idac\r
+ uint8_t Group2_Ledidac; \r
+ uint8_t Group3_Ledidac; \r
+ uint16_t Group1_Cur; //LED; \r
+ uint16_t Group2_Cur; //LED;\r
+ uint16_t Group3_Cur; //LED;\r
+// uint8_t LEDDAC; \r
+ uint8_t Group1_AMBDAC; \r
+ uint8_t Group2_AMBDAC;\r
+ uint8_t Group3_AMBDAC; \r
+ uint8_t Group1_RF;\r
+ uint8_t Group2_RF;\r
+ uint8_t Group3_RF; \r
+ uint32_t Group1_step;\r
+ uint32_t Group2_step;\r
+ uint32_t Group3_step;\r
+ uint8_t state;\r
+ uint8_t Group1_max_cur;\r
+ uint8_t Group2_max_cur;\r
+ uint8_t Group3_max_cur;\r
+} HRS_CAL_SET_T;\r
+\r
+HRS_CAL_SET_T PPG_hrs_agc( );\r
+void Init_hrs_PPG_Calibration_Routine(HRS_CAL_SET_T *calR); \r
+void Restart_hrs_PPG_Calibration_Routine(HRS_CAL_SET_T *calR);\r
+//void PPG_hrs_Calibration_Routine(HRS_CAL_SET_T *calR, int32_t g1_led,int32_t g2_led,int32_t g3_led, int32_t g1_amb, int32_t g2_amb,int32_t g3_amb);\r
+void PPG_hrs_Calibration_Routine(HRS_CAL_SET_T *calR, int32_t g1_led,int32_t g2_led, int32_t g1_amb, int32_t g2_amb);\r
+\r
+void hx3695_hrs_cal_init(void);\r
+void hx3695_hrs_cal_off(void);\r
+uint8_t hx3695_read_fifo_size(void);\r
+void read_hrs_data_packet(int32_t *buf);\r
+void read_hrs_ir_packet(int32_t *buf);\r
+void hx3695_hrs_read_data_packet(int32_t *buf); \r
+void hx3695_hrs_low_power(void);\r
+void hx3695_hrs_normal_power(void);\r
+void hx3695_hrs_updata_reg(void);\r
+void hx3695_hrs_set_mode(uint8_t mode_cmd);\r
+SENSOR_ERROR_T hx3695_hrs_enable(void);\r
+void hx3695_hrs_disable(void);\r
+hrs_wear_msg_code_t hx3695_hrs_get_wear_status(void);\r
+uint8_t hx3695_hrs_read(hrs_sensor_data_t *s_dat);\r
+bool hx3695_hrs_init(void); \r
+hrs_wear_msg_code_t hx3695_hrs_wear_mode_check(WORK_MODE_T mode, int32_t infrared_data);\r
+\r
+HRS_CAL_SET_T get_hrs_agc_status(void);\r
+void hx3695_hrs_data_reset(void);\r
+\r
+#endif\r
--- /dev/null
+#include <stdio.h>\r
+#include <stdbool.h>\r
+#include <stdint.h>\r
+#include <stdlib.h>\r
+#include <math.h>\r
+\r
+#include "tyhx_hrs_custom.h"\r
+#include "hx3695.h"\r
+#include "hx3695_hrv_agc.h"\r
+#include "tyhx_hrv_alg.h"\r
+\r
+\r
+#ifdef HRV_ALG_LIB\r
+\r
+extern const uint8_t hx3695_hrs_agc_idac;\r
+extern const uint8_t green_led_max_init;\r
+extern uint8_t low_vbat_flag;\r
+extern uint8_t hrv_phase_num;\r
+extern uint8_t read_fifo_first_flg;\r
+\r
+//hrv_INFRARED_THRES\r
+extern const int32_t hrv_ir_unwear_thres;\r
+extern const int32_t hrv_ir_wear_thres;\r
+\r
+static uint8_t s_ppg_state = 0;\r
+static uint8_t s_cal_state = 0;\r
+static int32_t agc_buf[4] = {0};\r
+\r
+static uint8_t cal_delay = HRV_CAL_DELAY_COUNT;\r
+static HRV_CAL_SET_T calReg;\r
+//\r
+static hrv_wear_msg_code_t hrv_wear_status = MSG_HRV_NO_WEAR;\r
+static hrv_wear_msg_code_t hrv_wear_status_pre = MSG_HRV_NO_WEAR;\r
+\r
+static uint8_t no_touch_cnt = 0;\r
+\r
+hrv_wear_msg_code_t hx3695_hrv_wear_mode_check(int32_t infrared_data)\r
+{\r
+ if(infrared_data > hrv_ir_wear_thres)\r
+ {\r
+ if(no_touch_cnt < NO_TOUCH_CHECK_NUM)\r
+ {\r
+ no_touch_cnt++;\r
+ }\r
+ if(no_touch_cnt >= NO_TOUCH_CHECK_NUM)\r
+ {\r
+ hrv_wear_status = MSG_HRV_WEAR;\r
+ }\r
+ }\r
+ else if(infrared_data < hrv_ir_unwear_thres)\r
+ {\r
+ if(no_touch_cnt>0)\r
+ {\r
+ no_touch_cnt--;\r
+ }\r
+ if(no_touch_cnt == 0)\r
+ {\r
+ hrv_wear_status = MSG_HRV_NO_WEAR;\r
+ }\r
+ }\r
+\r
+ if(hrv_wear_status_pre != hrv_wear_status)\r
+ {\r
+ hrv_wear_status_pre = hrv_wear_status;\r
+ if(hrv_wear_status_pre == MSG_HRV_NO_WEAR)\r
+ {\r
+ hx3695_hrv_low_power();\r
+ }\r
+ else if(hrv_wear_status_pre == MSG_HRV_WEAR)\r
+ {\r
+ tyhx_hrv_alg_open_deep();\r
+ hx3695_hrv_set_mode(PPG_INIT);\r
+ hx3695_hrv_set_mode(CAL_INIT);\r
+ }\r
+ }\r
+\r
+ return hrv_wear_status;\r
+}\r
+\r
+void Init_hrv_PPG_Calibration_Routine(HRV_CAL_SET_T *calR,uint8_t led)\r
+{\r
+ calR->flag = CAL_FLG_LED_DR|CAL_FLG_LED_DAC|CAL_FLG_AMB_DAC|CAL_FLG_RF;\r
+\r
+ calR->LEDDAC = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+ calR->AMBDAC = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+ calR->RF = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ calR->LED = HRV_CAL_INIT_LED;\r
+ calR->state = hrvCalStart;\r
+ calR->int_cnt = 0;\r
+ calR->cur255_cnt =0;\r
+ if(low_vbat_flag==1)\r
+ {\r
+ calR->led_max_cur = 128;\r
+ }\r
+ else\r
+ {\r
+ calR->led_max_cur = green_led_max_init;\r
+ }\r
+}\r
+\r
+void Restart_hrv_PPG_Calibration_Routine(HRV_CAL_SET_T *calR)\r
+{\r
+ calR->flag = CAL_FLG_LED_DR|CAL_FLG_LED_DAC|CAL_FLG_AMB_DAC|CAL_FLG_RF;\r
+ calR->state = hrvCalLed;\r
+ calR->int_cnt = 0;\r
+}\r
+\r
+void PPG_hrv_Calibration_Routine(HRV_CAL_SET_T *calR, int32_t led, int32_t amb)\r
+{\r
+ switch(calR->state)\r
+ {\r
+ case hrvCalStart:\r
+ calR->state = hrvLedCur;\r
+ break;\r
+\r
+ case hrvLedCur:\r
+ if(amb>525000)\r
+ {\r
+ calR->AMBDAC = (amb-525000)/1300;\r
+ }\r
+ else\r
+ {\r
+ calR->AMBDAC = 0;\r
+ }\r
+ if(led>amb+256)\r
+ {\r
+ calR->led_step = (led-amb)/HRV_CAL_INIT_LED;\r
+ calR->LED = 1300*(hx3695_hrs_agc_idac+calR->AMBDAC)/calR->led_step;\r
+ if(calR->LED > calR->led_max_cur)\r
+ {\r
+ calR->LED = calR->led_max_cur;\r
+ }\r
+ else if(calR->LED < 15)\r
+ {\r
+ calR->LED = 15;\r
+ }\r
+ if(calR->LED != calR->led_max_cur)\r
+ {\r
+ calR->LEDDAC = (hx3695_hrs_agc_idac*3)>>2;\r
+ }\r
+ else\r
+ {\r
+ calR->LEDDAC = hx3695_hrs_agc_idac>>1;\r
+ }\r
+ calR->RF = 5;\r
+ calR->flag = CAL_FLG_LED_DR|CAL_FLG_LED_DAC|CAL_FLG_AMB_DAC|CAL_FLG_RF;\r
+ calR->state = hrvCalLed;\r
+ }\r
+ else\r
+ {\r
+ calR->state = hrvCalFinish;\r
+ }\r
+ break;\r
+\r
+ case hrvCalLed:\r
+ if(led>800000 && calR->LEDDAC<=120)\r
+ {\r
+ calR->LEDDAC = calR->LEDDAC + 2;\r
+ calR->state = hrvCalLed;\r
+ }\r
+ else if(led<350000 && calR->LEDDAC>=2)\r
+ {\r
+ calR->LEDDAC = calR->LEDDAC - 2;\r
+ calR->state = hrvCalLed;\r
+ }\r
+ else if(led<350000 && calR->LEDDAC>0)\r
+ {\r
+ calR->LEDDAC = calR->LEDDAC - 1;\r
+ calR->state = hrvCalLed;\r
+ }\r
+ else\r
+ {\r
+ calR->state = hrvCalLed2;\r
+ }\r
+ calR->flag = CAL_FLG_LED_DAC;\r
+ break;\r
+\r
+ case hrvCalLed2:\r
+ if(led+calR->LEDDAC*26000 < (amb+calR->AMBDAC*26000)+((26000*hx3695_hrs_agc_idac*3)>>2) && calR->LED < calR->led_max_cur)\r
+ {\r
+ calR->LED = calR->led_max_cur;\r
+ calR->state = hrvCalLed;\r
+ calR->flag = CAL_FLG_LED_DR;\r
+ }\r
+ else\r
+ {\r
+ calR->state = hrvCalFinish;\r
+ calR->flag = 0;\r
+ }\r
+ break;\r
+\r
+ default:\r
+ break;\r
+\r
+ }\r
+ AGC_LOG("AGC: led_drv=%d,ledDac=%d,ambDac=%d,ledstep=%d,rf=%d,\r\n",\\r
+ calR->LED, calR->LEDDAC, calR->AMBDAC,calR->led_step,calR->RF);\r
+}\r
+\r
+HRV_CAL_SET_T PPG_hrv_agc(void)\r
+{\r
+ int32_t led_val, amb_val;\r
+ calReg.work = false;\r
+ if (!s_cal_state)\r
+ {\r
+ return calReg;\r
+ }\r
+\r
+#ifdef INT_MODE\r
+ calReg.int_cnt ++;\r
+ if(calReg.int_cnt < 8)\r
+ {\r
+ return calReg;\r
+ }\r
+ calReg.int_cnt = 0;\r
+ hx3695_gpioint_cfg(false);\r
+#endif\r
+\r
+ calReg.work = true;\r
+ \r
+ hx3695_hrv_read_data_packet(agc_buf);\r
+ \r
+ led_val = agc_buf[0];\r
+ amb_val = agc_buf[1];\r
+\r
+ AGC_LOG("cal dat ch1=%d,ch2=%d,led_val=%d,amb_val=%d \r\n",\\r
+ agc_buf[0], agc_buf[1], led_val, amb_val);\r
+\r
+ PPG_hrv_Calibration_Routine(&calReg, led_val, amb_val);\r
+\r
+ if (calReg.state == hrvCalFinish)\r
+ {\r
+ hx3695_hrv_set_mode(CAL_OFF);\r
+#if defined(TIMMER_MODE)\r
+#else\r
+ hx3695_gpioint_cfg(true);\r
+#endif\r
+ }\r
+ else\r
+ {\r
+ hx3695_hrv_updata_reg();\r
+#if defined(INT_MODE)\r
+ hx3695_gpioint_cfg(true);\r
+#endif\r
+ }\r
+ return calReg;\r
+}\r
+\r
+void hx3695_hrv_cal_init(void) // 20200615 ericy afe cali online\r
+{\r
+uint16_t sample_rate = 200; /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+ uint8_t data_avg_num = 0; /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+ uint32_t prf_clk_num = 32000/sample_rate; /*period in clk num, num = Fclk/fs */\r
+ hx3695_write_reg(0X2a, (uint8_t)prf_clk_num); // prf bit<7:0>\r
+ hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+ hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>\r
+// AGC_LOG("prf_clk_num =%d %d %d\r\n", hx3695_read_reg(0X2a), hx3695_read_reg(0X2b), hx3695_read_reg(0X2c));\r
+ hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num ); \r
+ \r
+ hx3695_write_reg(0x1b,0x90); //FIFO mode enable\r
+ hx3695_write_reg(0x36,0x00); //phase3 convertion ready disable \r
+ \r
+ #if defined(INT_MODE)\r
+ hx3695_write_reg(0X33, 0x83); // int width \r
+ hx3695_write_reg(0x38,0x04); \r
+ #endif\r
+ hx3695_write_reg(0x1b, 0x90);\r
+ hx3695_write_reg(0x5c,0x0a); //Chip reset\r
+ hx3695_delay_ms(5); //Delay for reset time\r
+ hx3695_write_reg(0x5c,0x08); //Chip state machine work normal\r
+ hx3695_delay_ms(5);\r
+// hx3695_brust_read_reg(0x22, fifo_data_buf, 3);\r
+ read_fifo_first_flg = 1;\r
+// AGC_LOG("herehere %d,%d,%d \r\n",hx3695_read_reg(0X2a),hx3695_read_reg(0X2b),hx3695_read_reg(0X2c));\r
+}\r
+\r
+void hx3695_hrv_cal_off(void) // 20200615 ericy afe cali offline\r
+{\r
+ uint16_t sample_rate = 125; /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+ uint8_t data_avg_num = 0; /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+ uint32_t prf_clk_num = 32000/sample_rate; /*period in clk num, num = Fclk/fs */\r
+ hx3695_write_reg(0X2a, (uint8_t)prf_clk_num); // prf bit<7:0>\r
+ hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+ hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>\r
+// AGC_LOG("prf_clk_num =%d %d %d\r\n", hx3695_read_reg(0X2a), hx3695_read_reg(0X2b), hx3695_read_reg(0X2c));\r
+ hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num ); \r
+ \r
+ hx3695_write_reg(0x1b,0x90); //FIFO mode enable\r
+ hx3695_write_reg(0x36,0x00); //phase3 convertion ready disable \r
+ \r
+ #if defined(INT_MODE)\r
+ hx3695_write_reg(0X33, 0x83); // int width \r
+ hx3695_write_reg(0x38,0x04); \r
+ #endif\r
+ \r
+ hx3695_write_reg(0x5c,0x0a); //Chip reset\r
+ hx3695_delay_ms(5); //Delay for reset time\r
+// hx3695_write_reg(0x1b, 0x10);\r
+// hx3695_delay(5);\r
+ hx3695_write_reg(0x1b, 0x90);\r
+ hx3695_write_reg(0x5c,0x08); //Chip state machine work normal\r
+ hx3695_delay_ms(5);\r
+// hx3695_brust_read_reg(0x22, fifo_data_buf, 3);\r
+ read_fifo_first_flg = 1;\r
+// AGC_LOG("herehere %d,%d,%d \r\n",hx3695_read_reg(0X2a),hx3695_read_reg(0X2b),hx3695_read_reg(0X2c));\r
+}\r
+\r
+void read_hrv_data_packet(int32_t *buf)\r
+{\r
+ uint8_t dataBuf[6];\r
+\r
+ hx3695_brust_read_reg(0x03, dataBuf, 3);\r
+ hx3695_brust_read_reg(0x0c, dataBuf+3, 3);\r
+\r
+ for (uint8_t i=0; i<2; i++)\r
+ {\r
+ buf[i] = (int32_t)(dataBuf[3*i]|(dataBuf[3*i+1]<<8)|(dataBuf[3*i+2]<<16));\r
+ }\r
+}\r
+\r
+void read_hrv_ir_packet(int32_t *buf)\r
+{\r
+ uint8_t dataBuf[6];\r
+\r
+ hx3695_brust_read_reg(0x06, dataBuf, 6);\r
+\r
+ for (uint8_t i=0; i<2; i++)\r
+ {\r
+ buf[i] = (int32_t)(dataBuf[3*i]|(dataBuf[3*i+1]<<8)|(dataBuf[3*i+2]<<16));\r
+ }\r
+}\r
+\r
+void hx3695_hrv_read_data_packet(int32_t *buf)\r
+{\r
+ uint8_t databuf1[6] = {0};\r
+ uint8_t databuf2[6] = {0};\r
+ uint32_t P1 = 0,P2 = 0,P3 = 0,P4 =0 ;\r
+\r
+ hx3695_brust_read_reg(0x03, databuf1, 6);\r
+ hx3695_brust_read_reg(0x09, databuf2, 6);\r
+\r
+ P1 = ((databuf1[0])|(databuf1[1]<<8)|(databuf1[2]<<16));\r
+ P2 = ((databuf1[3])|(databuf1[4]<<8)|(databuf1[5]<<16));\r
+ P3 = ((databuf2[0])|(databuf2[1]<<8)|(databuf2[2]<<16));\r
+ P4 = ((databuf2[3])|(databuf2[4]<<8)|(databuf2[5]<<16));\r
+\r
+ buf[0] = P1;\r
+ buf[1] = P2;\r
+ buf[2] = P3;\r
+ buf[3] = P4;\r
+ \r
+ AGC_LOG("Reg_data_0x03 %d,%d,%d,%d\r\n",P1,P2,P3,P4);\r
+}\r
+\r
+void hx3695_hrv_low_power(void)\r
+{\r
+ uint16_t sample_rate = 10; /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+ uint32_t prf_clk_num = 32000/sample_rate; /*period in clk num, num = Fclk/fs */\r
+\r
+ uint8_t data_avg_num = 0; /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+ uint8_t phase1_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase1_led_idac = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+ uint8_t phase1_ldr_cur = 0;\r
+ \r
+ uint8_t phase1_enable = 1; /*phase1_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase2_enable = 1; /*phase2_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase3_enable = 1; /*phase3_enable , 1 mean enable ; 0 mean disable */ \r
+ uint8_t phase4_enable = 1; /*phase4_enable , 1 mean enable ; 0 mean disable */\r
+ \r
+ uint8_t phase1_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase2_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase3_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ uint8_t phase4_adc_osr = 3; /* 0 = 128 ; 1 = 256 ; 2 = 512 ; 3 = 1024 ; 4 = 2048*/\r
+ \r
+ uint8_t phase1_mux_sel = 0; /* sel phase1*/\r
+ uint8_t phase2_mux_sel = 1; /* sel phase2*/\r
+ uint8_t phase3_mux_sel = 2; /* sel phase3*/\r
+ uint8_t phase4_mux_sel = 3; /* sel phase4*/\r
+ \r
+ \r
+ uint8_t phase1_led_en = 0;\r
+ uint8_t phase2_led_en = 0;\r
+ uint8_t phase3_led_en = 1;\r
+ uint8_t phase4_led_en = 0;\r
+\r
+ uint8_t phase3_tia_res = 0;\r
+ uint8_t phase4_tia_res = 0;\r
+\r
+ uint8_t phase3_ldr_cur = 15; /* 0~255 = 0 ~ 200ma, step = 0.8ma */\r
+\r
+ uint8_t led_on_time = 1; /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+ 4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+\r
+ hx3695_write_reg(0X2a, (uint8_t)prf_clk_num); // prf bit<7:0>\r
+ hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+ hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>\r
+ \r
+ hx3695_write_reg(0X3a, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X3b, data_avg_num<<4 | data_avg_num );\r
+ \r
+ \r
+ \r
+ hx3695_write_reg(0X30, (phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+// hx3695_write_reg(0X72, (|phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en) );\r
+\r
+ hx3695_write_reg(0X31, (led_on_time<<4| 0x00));\r
+\r
+ \r
+ hx3695_write_reg(0X43, phase3_mux_sel);\r
+ hx3695_write_reg(0X44, (0x04<<4 | phase3_tia_res));\r
+ hx3695_write_reg(0X45, phase3_ldr_cur); //cur\r
+ \r
+ \r
+ hx3695_write_reg(0X43, phase4_mux_sel);\r
+ hx3695_write_reg(0X44, (0x04<<4 | phase4_tia_res));\r
+\r
+ hx3695_write_reg(0X43, phase1_mux_sel);\r
+ hx3695_write_reg(0X44, (0x04<<4 | phase4_tia_res));\r
+ hx3695_write_reg(0X48, phase1_led_idac);\r
+ hx3695_write_reg(0X45, phase1_ldr_cur);\r
+\r
+ \r
+ hx3695_write_reg(0X26,(phase1_enable<<3)|(phase1_adc_osr)|(phase2_enable<<7)|(phase2_adc_osr<<4) ); \r
+ hx3695_write_reg(0X27,(phase3_enable<<3)|(phase3_adc_osr)|(phase4_enable<<7)|(phase4_adc_osr<<4) ); \r
+\r
+#ifdef INT_MODE\r
+ hx3695_write_reg(0X1b, 0x90);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble\r
+ hx3695_write_reg(0X33, 0x83); // int width \r
+// hx3695_write_reg(0X21, 0x00); // fifo int sel,00=FIFO INT config clear\r
+ hx3695_write_reg(0X38, 0x081); // int sel,00=close almost full int,04=enable almost full int\r
+#else\r
+ hx3695_write_reg(0X1b, 0x90);// bits<3:0> fifo data sel, 0000 = p1;0001= p2;0010=p3;\\r
+ 0011=p4;0100=p5;0101=p6;0110=p7;\\r
+ bits<7> fifo enble \r
+ hx3695_write_reg(0X36, 0x00); \r
+ \r
+ hx3695_write_reg(0X38, 0x00); // int sel,00=close almost full int,01= prf int 04=enable almost full int\r
+#endif\r
+\r
+ hx3695_write_reg(0x5c,0x02); //Chip reset\r
+ hx3695_delay_ms(5); //Delay for reset time\r
+ hx3695_write_reg(0x5c,0x00); //Chip state machine work normal\r
+ hx3695_delay_ms(5);\r
+\r
+ calReg.LED = phase1_ldr_cur;\r
+ AGC_LOG(" chip go to low power mode \r\n" );\r
+}\r
+\r
+void hx3695_hrv_updata_reg(void)\r
+{ \r
+ uint8_t phase1_mux_sel = 0;\r
+ uint8_t phase2_mux_sel = 1;\r
+ uint8_t phase3_mux_sel = 2;\r
+ uint8_t phase4_mux_sel = 3;\r
+ if (calReg.flag & CAL_FLG_LED_DR) \r
+ {\r
+ //AGC_LOG("CAL_FLG_LED_DR\r\n");\r
+ hx3695_write_reg(0X43, phase1_mux_sel); \r
+ hx3695_write_reg(0X45, calReg.LED);\r
+ \r
+// hx3695_write_reg(0X43, phase3_mux_sel); \r
+// hx3695_write_reg(0X45, calReg.R_LED);\r
+// hx3695_write_reg(0X43, phase4_mux_sel); \r
+// hx3695_write_reg(0X45, calReg.IR_LED); \r
+ }\r
+ \r
+ if (calReg.flag & CAL_FLG_LED_DAC) \r
+ {\r
+ //AGC_LOG("CAL_FLG_LED_DAC\r\n");\r
+ hx3695_write_reg(0X43, phase1_mux_sel);\r
+ hx3695_write_reg(0X48, calReg.LEDDAC);\r
+// hx3695_write_reg(0X43, phase3_mux_sel);\r
+// hx3695_write_reg(0X48, calReg.R_LEDDAC);\r
+// hx3695_write_reg(0X43, phase4_mux_sel);\r
+// hx3695_write_reg(0X48, calReg.IR_LEDDAC);\r
+ // AGC_LOG("IR_LEDDAC:%d \r\n",hx3695_read_reg(0X47));\r
+\r
+ }\r
+ \r
+ if (calReg.flag & CAL_FLG_AMB_DAC) \r
+ {\r
+ //AGC_LOG("CAL_FLG_AMB_DAC\r\n");\r
+ hx3695_write_reg(0X43, phase2_mux_sel);\r
+ hx3695_write_reg(0X48, calReg.AMBDAC); // phase2 offset idac cfg\r
+\r
+ }\r
+ \r
+ if (calReg.flag & CAL_FLG_RF) \r
+ {\r
+ //AGC_LOG("CAL_FLG_RF\r\n");\r
+ hx3695_write_reg(0X43, phase1_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | calReg.RF));\r
+ //AGC_LOG("RF:%x \r\n",hx3695_read_reg(0X44));\r
+// hx3695_write_reg(0X44, (hx3695_read_reg(0X44)| 0x07)&(calReg.R_RF|0xff)); \r
+ hx3695_write_reg(0X43, phase2_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | calReg.RF));\r
+ //AGC_LOG("RF:%x \r\n",hx3695_read_reg(0X44)); \r
+ }\r
+\r
+}\r
+\r
+void hx3695_hrv_set_mode(uint8_t mode_cmd)\r
+{\r
+ switch (mode_cmd)\r
+ {\r
+ case PPG_INIT:\r
+ hx3695_hrv_ppg_init();\r
+#if defined(TIMMER_MODE)\r
+ hx3695_320ms_timer_cfg(true);\r
+#if defined(GSEN_40MS_TIMMER)\r
+ hx3695_40ms_timer_cfg(true);\r
+#endif\r
+#else\r
+ hx3695_gpioint_cfg(true);\r
+#endif\r
+ s_ppg_state = 1;\r
+\r
+ AGC_LOG("ppg init mode\r\n");\r
+ break;\r
+\r
+ case PPG_OFF:\r
+ hx3695_ppg_off();\r
+ s_ppg_state = 0;\r
+ AGC_LOG("ppg off mode\r\n");\r
+ break;\r
+\r
+ case PPG_LED_OFF:\r
+ hx3695_hrv_low_power();\r
+ s_ppg_state = 0;\r
+ AGC_LOG("ppg led off mode\r\n");\r
+ break;\r
+\r
+ case CAL_INIT:\r
+ Init_hrv_PPG_Calibration_Routine(&calReg, 64);\r
+ hx3695_hrv_cal_init();\r
+ hx3695_hrv_updata_reg();\r
+#if defined(TIMMER_MODE)\r
+#if defined(GSEN_40MS_TIMMER)\r
+#else\r
+ hx3695_40ms_timer_cfg(true);\r
+#endif\r
+#endif\r
+ s_cal_state = 1;\r
+ AGC_LOG("cal init mode\r\n");\r
+ break;\r
+\r
+ case RECAL_INIT:\r
+ Restart_hrv_PPG_Calibration_Routine(&calReg);\r
+ hx3695_hrv_cal_init();\r
+ hx3695_hrv_updata_reg();\r
+#if defined(TIMMER_MODE)\r
+#if defined(GSEN_40MS_TIMMER)\r
+#else\r
+ hx3695_40ms_timer_cfg(true);\r
+#endif\r
+#endif\r
+ s_cal_state = 1;\r
+ AGC_LOG("Recal init mode\r\n");\r
+ break;\r
+\r
+ case CAL_OFF:\r
+#if defined(TIMMER_MODE)\r
+#if defined(GSEN_40MS_TIMMER)\r
+#else\r
+ hx3695_40ms_timer_cfg(false);\r
+#endif\r
+#endif\r
+ hx3695_hrv_cal_off();\r
+ s_cal_state = 0;\r
+ AGC_LOG("cal off mode\r\n");\r
+ break;\r
+\r
+ default:\r
+ break;\r
+ }\r
+}\r
+\r
+SENSOR_ERROR_T hx3695_hrv_enable(void)\r
+{\r
+ if (!hx3695_chip_check())\r
+ {\r
+ AGC_LOG("hx3695 check id failed!\r\n");\r
+ return SENSOR_OP_FAILED;\r
+ }\r
+\r
+ AGC_LOG("hx3695 check id success!\r\n");\r
+\r
+ if (s_ppg_state)\r
+ {\r
+ AGC_LOG("ppg already on!\r\n");\r
+ return SENSOR_OP_FAILED;\r
+ }\r
+ if(!tyhx_hrv_alg_open())\r
+ {\r
+ AGC_LOG("hrv alg open fail,or dynamic ram not enough!\r\n");\r
+ }\r
+\r
+ hrv_wear_status = MSG_HRV_NO_WEAR;\r
+ hrv_wear_status_pre = MSG_HRV_NO_WEAR;\r
+\r
+ hx3695_hrv_set_mode(PPG_INIT);\r
+\r
+ AGC_LOG("hx3695 enable!\r\n");\r
+\r
+ return SENSOR_OK;\r
+}\r
+\r
+\r
+void hx3695_hrv_disable(void)\r
+{\r
+ hx3695_320ms_timer_cfg(false);\r
+ hx3695_40ms_timer_cfg(false);\r
+\r
+ hx3695_hrv_set_mode(CAL_OFF);\r
+ hx3695_hrv_set_mode(PPG_OFF);\r
+ tyhx_hrv_alg_close();\r
+\r
+ AGC_LOG("hx3695 disable!\r\n");\r
+}\r
+\r
+void hx3695_hrv_data_reset(void)\r
+{\r
+ s_ppg_state = 0;\r
+ s_cal_state = 0;\r
+ tyhx_hrv_alg_close();\r
+}\r
+\r
+hrv_wear_msg_code_t hx3695_hrv_get_wear_status(void)\r
+{\r
+ return hrv_wear_status;\r
+}\r
+\r
+hrv_wear_msg_code_t hx3695_hrv_get_wear_status_pre(void)\r
+{\r
+ return hrv_wear_status_pre;\r
+}\r
+\r
+HRV_CAL_SET_T get_hrv_agc_status(void)\r
+{\r
+ HRV_CAL_SET_T cal;\r
+\r
+ cal.flag = calReg.flag;\r
+ cal.int_cnt = calReg.int_cnt;\r
+ cal.LED= calReg.LED; // phasex led driver config\r
+ cal.LEDDAC= calReg.LEDDAC; // phasex led offset idac cfg\r
+ cal.AMBDAC= calReg.AMBDAC; // phasex offset idac cfg\r
+ cal.RF= calReg.RF; // phasex tia feed back resister cfg\r
+ cal.led_step= calReg.led_step;\r
+ cal.state= calReg.state;\r
+\r
+ return cal;\r
+}\r
+\r
+//void hx3695_hrv_read_fifo_data(uint8_t read_fifo_size,int32_t *buf)\r
+//{\r
+// uint8_t data_flg = 127;\r
+// int32_t data;\r
+// uint8_t databuf[3];\r
+// uint8_t ii=0;\r
+// for(ii=0; ii<read_fifo_size; ii++)\r
+// {\r
+//// hx3695_write_reg(0x17, 0x00); // write any walue to 0x17 will update a new data\r
+//// hx3695_delay_us(100);\r
+// hx3695_brust_read_reg(0x22, databuf, 3);\r
+// data_flg = databuf[2]>>5;\r
+// data = (int32_t)(databuf[0]|(databuf[1]<<8)|((databuf[2]&0x1f)<<16));\r
+\r
+// if(ii==0)\r
+// {\r
+// if(data_flg ==3)\r
+// {\r
+// ii=3;\r
+// buf[0] = 0;\r
+// buf[1] = 0;\r
+// buf[2] = 0;\r
+// }\r
+// if(data_flg ==2)\r
+// {\r
+// ii=2;\r
+// buf[0] = 0;\r
+// buf[1] = 0;\r
+// }\r
+// if(data_flg ==1)\r
+// {\r
+// ii=1;\r
+// buf[0] = 0;\r
+// }\r
+// }\r
+\r
+// if(data_flg == 0)\r
+// {\r
+// buf[ii]= data;\r
+// }\r
+// else if(data_flg == 1)\r
+// {\r
+// buf[ii]= data;\r
+// }\r
+// else if(data_flg == 2)\r
+// {\r
+// buf[ii]= data;\r
+// }\r
+// else if(data_flg == 3)\r
+// {\r
+// buf[ii]= data;\r
+// }\r
+// }\r
+//}\r
+\r
+uint8_t hx3695_hrv_read(hrv_sensor_data_t *s_dat)\r
+{\r
+ uint8_t i = 0;\r
+ int32_t PPG_src_data = 0;\r
+ int32_t Ir_src_data = 0;\r
+ bool recal = false;\r
+ uint8_t size = 0;\r
+ uint8_t fifo_out_size = 0;\r
+ int32_t *PPG_buf = &(s_dat->green_data[0]);\r
+ int32_t *ir_buf = &(s_dat->ir_data[0]);\r
+ int32_t *s_buf = &(s_dat->s_buf[0]);\r
+ s_dat->green_cur = calReg.LED;\r
+ int32_t ps_data[4];\r
+\r
+ if (!s_ppg_state || s_cal_state)\r
+ {\r
+ DEBUG_PRINTF("ppg state = %d, cal_state = %d\r\n",s_ppg_state,s_cal_state);\r
+ return 0;\r
+ }\r
+// size = hx3695_read_fifo_size();\r
+// DEBUG_PRINTF("size = %d\r\n",size);\r
+\r
+// if(size<1)\r
+// {\r
+// return 0;\r
+// }\r
+\r
+ hx3695_hrv_read_data_packet(ps_data);\r
+ Ir_src_data = ps_data[2]-ps_data[3];\r
+ DEBUG_PRINTF("%d %d \r\n" ,ps_data[2],ps_data[3]);\r
+ ir_buf[0] = Ir_src_data;\r
+ //DEBUG_PRINTF("111: %d \r\n" ,ir_buf[0] );\r
+ hx3695_hrv_wear_mode_check(Ir_src_data);\r
+\r
+// if ((size) && (size <= 64))\r
+// {\r
+ fifo_out_size = hx3695_read_fifo_data(s_buf,hrv_phase_num,1);\r
+ s_dat->count = fifo_out_size;\r
+ for (i=0; i<fifo_out_size; i++)\r
+ {\r
+ PPG_src_data = s_buf[i];\r
+ if (s_buf[i]<350000 || s_buf[i]>750000)\r
+ {\r
+ recal = true;\r
+\r
+ if(hrv_wear_status==MSG_HRV_NO_WEAR)\r
+ {\r
+ recal = false;\r
+ }\r
+ }\r
+ PPG_buf[i] = PPG_src_data;\r
+ //AGC_LOG("%d/%d %d %d %d\r\n" ,1+i,size, s_buf[i],calReg.LED,recal);\r
+ }\r
+\r
+ if (recal)\r
+ {\r
+ cal_delay--;\r
+ if (cal_delay <= 0)\r
+ {\r
+ cal_delay = HRV_CAL_DELAY_COUNT;\r
+ hx3695_hrv_set_mode(RECAL_INIT);\r
+ }\r
+ }\r
+ else\r
+ {\r
+ cal_delay = HRV_CAL_DELAY_COUNT;\r
+ }\r
+// }\r
+ return 1;\r
+}\r
+\r
+#endif\r
--- /dev/null
+#ifndef _hx3695_hrv_agc_H_\r
+#define _hx3695_hrv_agc_H_\r
+//#endif\r
+\r
+#include <stdint.h>\r
+#include <stdbool.h>\r
+#include "hx3695.h"\r
+#define HRV_CAL_DELAY_COUNT 2\r
+\r
+#define CAL_FLG_LED_DR 0x01\r
+#define CAL_FLG_LED_DAC 0x02 \r
+#define CAL_FLG_AMB_DAC 0x04\r
+#define CAL_FLG_RF 0x08\r
+\r
+#define HRV_CAL_INIT_LED 128\r
+#define HRV_OFFSET_IDAC 64\r
+\r
+#define NO_TOUCH_CHECK_NUM 2\r
+\r
+#ifdef HRV_ALG_LIB\r
+typedef enum { \r
+ hrvCalStart, \r
+ hrvLedCur,\r
+ hrvCalLed,\r
+ hrvCalLed2,\r
+ hrvCalLed3,\r
+ hrvCalFinish, \r
+}HRV_STATE_T;\r
+\r
+typedef struct {\r
+ uint8_t count;\r
+ uint8_t green_cur;\r
+ int32_t green_data[64];\r
+ int32_t ir_data[64];\r
+ int32_t s_buf[64]; \r
+ uint32_t als;\r
+ uint32_t agc_green;\r
+}hrv_sensor_data_t;\r
+\r
+typedef struct {\r
+ uint8_t flag;\r
+ bool work;\r
+ uint8_t int_cnt;\r
+ uint8_t cur255_cnt;\r
+ uint8_t led_idac; \r
+ uint16_t LED; \r
+ uint8_t LEDDAC; \r
+ uint8_t AMBDAC; \r
+ uint8_t RF; \r
+ uint32_t led_step;\r
+ uint8_t state;\r
+ uint8_t led_max_cur;\r
+} HRV_CAL_SET_T;\r
+\r
+typedef enum {\r
+ MSG_HRV_NO_WEAR,\r
+ MSG_HRV_WEAR\r
+} hrv_wear_msg_code_t;\r
+\r
+void Init_hrv_PPG_Calibration_Routine(HRV_CAL_SET_T *calR,uint8_t led);\r
+void Restart_hrv_PPG_Calibration_Routine(HRV_CAL_SET_T *calR);\r
+void PPG_hrv_Calibration_Routine(HRV_CAL_SET_T *calR, int32_t led, int32_t amb);\r
+\r
+void hx3695_hrv_cal_init(void);\r
+void hx3695_hrv_cal_off(void);\r
+uint8_t hx3695_read_fifo_size(void);\r
+void read_hrv_data_packet(int32_t *buf);\r
+void read_hrv_ir_packet(int32_t *buf);\r
+void hx3695_hrv_read_data_packet(int32_t *buf);\r
+\r
+void hx3695_hrv_low_power(void);\r
+void hx3695_hrv_updata_reg(void);\r
+void hx3695_hrv_set_mode(uint8_t mode_cmd);\r
+SENSOR_ERROR_T hx3695_hrv_enable(void);\r
+void hx3695_hrv_disable(void);\r
+hrv_wear_msg_code_t hx3695_hrv_get_wear_status(void);\r
+uint8_t hx3695_hrv_read(hrv_sensor_data_t * s_dat);\r
+bool hx3695_hrv_init(void);\r
+HRV_CAL_SET_T PPG_hrv_agc(void);\r
+hrv_wear_msg_code_t hx3695_hrv_wear_mode_check(int32_t infrared_data);\r
+HRV_CAL_SET_T get_hrv_agc_status(void);\r
+void hx3695_hrv_data_reset(void);\r
+#endif\r
+#endif\r
--- /dev/null
+#include <stdio.h>\r
+#include <stdbool.h>\r
+#include <stdint.h>\r
+#include <stdlib.h>\r
+#include <math.h>\r
+\r
+#include "hx3695.h"\r
+#include "hx3695_spo2_agc.h"\r
+#include "tyhx_spo2_alg.h"\r
+#include "tyhx_hrs_alg.h"\r
+\r
+\r
+#include "tyhx_hrs_custom.h"\r
+\r
+\r
+\r
+#ifdef SPO2_ALG_LIB\r
+\r
+extern const uint8_t hx3695_spo2_agc_red_idac; // 6,7,8...\r
+extern const uint8_t hx3695_spo2_agc_ir_idac; // 6,7,8...\r
+extern const uint8_t hx3695_spo2_agc_green_idac; // 6,7,8...\r
+extern const uint8_t green_led_max_init;\r
+extern const uint8_t red_led_max_init;\r
+extern const uint8_t ir_led_max_init;\r
+extern uint8_t low_vbat_flag;\r
+extern uint8_t spo2_phase_num;\r
+\r
+//SPO2_INFRARED_THRES\r
+extern const int32_t spo2_ir_unwear_thres;\r
+extern const int32_t spo2_ir_wear_thres;\r
+extern const uint8_t spo2_ir_wear_offset;\r
+extern uint8_t read_fifo_first_flg;\r
+\r
+static uint8_t s_ppg_state = 0;\r
+static uint8_t s_cal_state = 0;\r
+static int32_t agc_buf[8] = {0};\r
+\r
+static uint8_t cal_delay = SPO2_CAL_DELAY_COUNT;\r
+static SPO2_CAL_SET_T calReg_SPO2;\r
+\r
+static spo2_wear_msg_code_t spo2_wear_status = MSG_SPO2_NO_WEAR;\r
+static spo2_wear_msg_code_t spo2_wear_status_pre = MSG_SPO2_NO_WEAR;\r
+\r
+void Init_Spo2_PPG_Calibration_Routine(SPO2_CAL_SET_T *calR,uint8_t led)\r
+{\r
+ calR->flag = CAL_FLG_LED_DR|CAL_FLG_LED_DAC|CAL_FLG_AMB_DAC|CAL_FLG_RF;\r
+ calR->G_LEDDAC = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+ calR->R_LEDDAC = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+ calR->IR_LEDDAC1 = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+ calR->AMBDAC = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+ calR->RED_AMBDAC = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+ calR->IR_AMBDAC1 = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+ \r
+ calR->G_RF = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ calR->R_RF = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ calR->IR_RF1 = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ calR->G_LED = SPO2_CAL_INIT_LED_GREEN;\r
+ calR->R_LED = SPO2_CAL_INIT_LED_RED;\r
+ calR->IR_LED1 = SPO2_CAL_INIT_LED_IR;\r
+ calR->state = sCalStart;\r
+ calR->int_cnt = 0;\r
+ calR->cur255_cnt =0;\r
+ if(low_vbat_flag == 1)\r
+ {\r
+ calR->green_idac = (hx3695_spo2_agc_green_idac)>>1;\r
+ calR->red_idac = (hx3695_spo2_agc_red_idac*3)>>2;\r
+ calR->ir_idac1 = (hx3695_spo2_agc_ir_idac*3)>>2;\r
+ calR->green_max_cur = (green_led_max_init)>>1;\r
+ calR->red_max_cur = (red_led_max_init*3)>>2;\r
+ calR->ir_max_cur = (ir_led_max_init*3)>>2;\r
+ }\r
+ else\r
+ {\r
+ calR->green_idac = hx3695_spo2_agc_green_idac;\r
+ calR->red_idac = hx3695_spo2_agc_red_idac;\r
+ calR->ir_idac1 = hx3695_spo2_agc_ir_idac;\r
+ calR->green_max_cur = green_led_max_init;\r
+ calR->red_max_cur = red_led_max_init;\r
+ calR->ir_max_cur = ir_led_max_init;\r
+ }\r
+ \r
+}\r
+\r
+void Restart_Spo2_PPG_Calibration_Routine(SPO2_CAL_SET_T *calR)\r
+{\r
+ calR->flag = CAL_FLG_LED_DAC;\r
+ calR->state = sCalLed;\r
+ calR->int_cnt = 0;\r
+}\r
+\r
+bool hx3695_spo2_check_unwear(int32_t infrared_data)\r
+{\r
+ if( infrared_data < spo2_ir_unwear_thres)\r
+ {\r
+ spo2_wear_status = MSG_SPO2_NO_WEAR;\r
+ if(spo2_wear_status_pre != MSG_SPO2_NO_WEAR)\r
+ {\r
+ spo2_wear_status_pre = MSG_SPO2_NO_WEAR;\r
+ hx3695_spo2_low_power();\r
+ return true;\r
+ }\r
+ }\r
+ return false;\r
+}\r
+\r
+bool hx3695_spo2_check_wear(int32_t infrared_data)\r
+{\r
+ if(infrared_data > spo2_ir_wear_thres)\r
+ {\r
+ spo2_wear_status = MSG_SPO2_WEAR;\r
+ if(spo2_wear_status_pre != MSG_SPO2_WEAR)\r
+ {\r
+ spo2_wear_status_pre = MSG_SPO2_WEAR;\r
+ tyhx_spo2_alg_open_deep();\r
+ hx3695_spo2_set_mode(PPG_INIT);\r
+ hx3695_spo2_set_mode(CAL_INIT);\r
+// DEBUG_PRINTF("check_wear\r\n");\r
+ return true;\r
+ }\r
+ }\r
+ return false;\r
+}\r
+\r
+\r
+//void PPG_Spo2_Calibration_Routine(SPO2_CAL_SET_T *calR, int32_t g_led, int32_t r_led, int32_t amb, int32_t ir_led)\r
+void PPG_Spo2_Calibration_Routine(SPO2_CAL_SET_T *calRS, int32_t g_led, int32_t r_led, int32_t ir_led1, int32_t g_amb, int32_t red_amb, int32_t ir_amb1)\r
+\r
+{\r
+ int32_t g_led_temp = 0, r_led_temp = 0, ir_led_temp1 = 0,ir_led_temp2 = 0;\r
+\r
+ switch(calRS->state)\r
+ {\r
+ case sCalStart: \r
+ calRS->state = sCalStart1;\r
+ break;\r
+ \r
+ case sCalStart1: \r
+ if(spo2_wear_status == MSG_SPO2_NO_WEAR)\r
+ {\r
+ calRS->state = sCalFinish;\r
+ break;\r
+ } \r
+ \r
+ if(g_amb>525000)\r
+ {\r
+ calRS->GREEN_AMBDAC = (g_amb - 525000)/1100;\r
+ }\r
+ else\r
+ {\r
+ calRS->GREEN_AMBDAC = 0;\r
+ }\r
+\r
+\r
+ \r
+ if(red_amb>525000)\r
+ {\r
+ calRS->RED_AMBDAC = (red_amb - 525000)/1100;\r
+ }\r
+ else\r
+ {\r
+ calRS->RED_AMBDAC = 0;\r
+ }\r
+ \r
+ if(ir_amb1>525000)\r
+ {\r
+ calRS->IR_AMBDAC1 = (ir_amb1 - 525000)/1300;\r
+ }\r
+ else\r
+ {\r
+ calRS->IR_AMBDAC1 = 0;\r
+ }\r
+ \r
+ \r
+ \r
+ if(r_led> (red_amb+256))\r
+ {\r
+ calRS->R_led_step = (r_led - red_amb)/SPO2_CAL_INIT_LED_RED*3/4; //64\r
+ r_led_temp = 1100*(hx3695_spo2_agc_red_idac+calRS->RED_AMBDAC)/calRS->R_led_step;\r
+ \r
+ if(r_led_temp>calRS->red_max_cur)\r
+ {\r
+ r_led_temp = calRS->red_max_cur;\r
+ }\r
+ calRS->R_LED = r_led_temp;\r
+ if(calRS->R_LED != calRS->red_max_cur)\r
+ {\r
+ calRS->R_LEDDAC = (hx3695_spo2_agc_red_idac*3)>>2;\r
+ }\r
+ else\r
+ {\r
+ calRS->R_LEDDAC = hx3695_spo2_agc_red_idac>>1;\r
+ }\r
+ } \r
+ if(ir_led1>(ir_amb1+256))\r
+ {\r
+ calRS->IR_led_step1 = (ir_led1 - ir_amb1)/SPO2_CAL_INIT_LED_IR; //32\r
+ ir_led_temp1 = 1300*(hx3695_spo2_agc_ir_idac + calRS->IR_AMBDAC1)/calRS->IR_led_step1;\r
+ \r
+ if(ir_led_temp1>calRS->ir_max_cur)\r
+ {\r
+ ir_led_temp1 = calRS->ir_max_cur;\r
+ }\r
+ calRS->IR_LED1 = ir_led_temp1;\r
+ if(calRS->IR_LED1 != calRS->ir_max_cur)\r
+ {\r
+ calRS->IR_LEDDAC1 = (hx3695_spo2_agc_ir_idac*3)>>2;\r
+ }\r
+ else\r
+ {\r
+ calRS->IR_LEDDAC1 = hx3695_spo2_agc_ir_idac>>1;\r
+ }\r
+ TYHX_LOG("calRS->R_IR_LED1: %d %d\r\n",calRS->R_LED,calRS->IR_LED1);\r
+\r
+ } \r
+ if(g_led >g_amb + 256)\r
+ {\r
+ calRS->G_led_step = (g_led-g_amb)/(SPO2_CAL_INIT_LED_GREEN); \r
+ g_led_temp = 1300*(hx3695_spo2_agc_green_idac+calRS->GREEN_AMBDAC)/calRS->G_led_step;\r
+ if(g_led_temp>calRS->green_max_cur) \r
+ {\r
+ g_led_temp = calRS->green_max_cur;\r
+ }\r
+ calRS->G_LED = g_led_temp;\r
+ if(calRS->G_LED != calRS->green_max_cur)\r
+ {\r
+ calRS->G_LEDDAC = (hx3695_spo2_agc_green_idac*3)>>2;\r
+ }\r
+ else\r
+ {\r
+ calRS->G_LEDDAC = hx3695_spo2_agc_green_idac>>1;\r
+ }\r
+ } \r
+ calRS->G_RF = 6;\r
+ calRS->R_RF = 6;\r
+ calRS->IR_RF1 = 6;\r
+ calRS->flag = CAL_FLG_LED_DR|CAL_FLG_LED_DAC|CAL_FLG_AMB_DAC|CAL_FLG_RF; \r
+ calRS->state = sCalLed;\r
+ break;\r
+ \r
+ case sCalLed: \r
+ if(r_led>900000 && calRS->R_LEDDAC < 120) //110\r
+ {\r
+ calRS->R_LEDDAC = calRS->R_LEDDAC+6; \r
+ }\r
+\r
+ if(ir_led1>900000 && calRS->IR_LEDDAC1 < 120) //110\r
+ {\r
+ calRS->IR_LEDDAC1 = calRS->IR_LEDDAC1+6; \r
+ }\r
+ \r
+ if(g_led>900000 && calRS->G_LEDDAC < 110) //110\r
+ {\r
+ calRS->G_LEDDAC = calRS->G_LEDDAC+6; \r
+ }\r
+\r
+ if(ir_led1 <= 900000 && r_led <= 900000 && g_led<=900000)\r
+ {\r
+ calRS->state = sCalLed2;\r
+ }\r
+ else if(calRS->R_LEDDAC>=120 || calRS->IR_LEDDAC1 >= 120 || calRS->G_LEDDAC >= 120)\r
+ {\r
+ calRS->state = sCalLed3; \r
+ } \r
+ else\r
+ {\r
+ calRS->state = sCalLed;\r
+ } \r
+ calRS->flag = CAL_FLG_LED_DAC;\r
+ break;\r
+ \r
+ case sCalLed2: \r
+ if(r_led > 650000 && calRS->R_LEDDAC < 120)\r
+ {\r
+ calRS->R_LEDDAC = calRS->R_LEDDAC+3; \r
+ }\r
+ else if(r_led <400000 && calRS->R_LEDDAC >= 3)\r
+ {\r
+ calRS->R_LEDDAC = calRS->R_LEDDAC-3; \r
+ }\r
+ else if(r_led<400000 && calRS->R_LEDDAC > 0)\r
+ {\r
+ calRS->R_LEDDAC = calRS->R_LEDDAC-1; \r
+ }\r
+ \r
+ if(ir_led1>650000 && calRS->IR_LEDDAC1 < 120)\r
+ {\r
+ calRS->IR_LEDDAC1 = calRS->IR_LEDDAC1+3; \r
+ }\r
+ else if(ir_led1<400000 && calRS->IR_LEDDAC1 >= 3)\r
+ {\r
+ calRS->IR_LEDDAC1 = calRS->IR_LEDDAC1-3; \r
+ }\r
+ else if(ir_led1 <400000 && calRS->IR_LEDDAC1 > 0)\r
+ {\r
+ calRS->IR_LEDDAC1 = calRS->IR_LEDDAC1 -1; \r
+ }\r
+ \r
+ if(g_led>650000 && calRS->G_LEDDAC < 120)\r
+ {\r
+ calRS->G_LEDDAC = calRS->G_LEDDAC+3; \r
+ }\r
+ else if(g_led<400000 && calRS->G_LEDDAC >= 3)\r
+ {\r
+ calRS->G_LEDDAC = calRS->G_LEDDAC-3; \r
+ }\r
+ else if(g_led<400000 && calRS->G_LEDDAC > 0)\r
+ {\r
+ calRS->G_LEDDAC = calRS->G_LEDDAC-1; \r
+ }\r
+ \r
+ if(ir_led1 <650000 && ir_led1 > 400000 && r_led<650000 && r_led>400000 && g_led<650000 && g_led>400000)\r
+// if(ir_led1 <750000 && ir_led1 > 500000 && r_led<750000 && r_led>500000 ) \r
+ {\r
+ calRS->state = sCalFinish;\r
+ }\r
+// else if(calR->R_LEDDAC >= 120 || calR->IR_LEDDAC1 >= 120 || calR->G_LEDDAC >= 120)\r
+ else if(calRS->R_LEDDAC >= 120 || calRS->IR_LEDDAC1 >= 120 )\r
+ {\r
+ calRS->state = sCalLed3;\r
+ }\r
+ else\r
+ {\r
+ calRS->state = sCalLed2; \r
+ } \r
+ calRS->flag = CAL_FLG_LED_DAC;\r
+ break;\r
+ \r
+ case sCalLed3: \r
+ if(calRS->R_LEDDAC>=120)\r
+ {\r
+ calRS->R_LED = (calRS->R_LED*3)>>2;\r
+ }\r
+ if(calRS->IR_LEDDAC1>=120)\r
+ {\r
+ calRS->IR_LED1 = (calRS->IR_LED1*3)>>2;\r
+ }\r
+// if(calR->G_LEDDAC>=120)\r
+// {\r
+// calR->G_LED = (calR->G_LED*3)>>2;\r
+// }\r
+ calRS->flag = CAL_FLG_LED_DR;\r
+ calRS->state = sCalLed; \r
+ break; \r
+ \r
+ case sCalRfEnd:\r
+ calRS->state = sCalFinish;\r
+ break;\r
+ \r
+ default: \r
+ break;\r
+ \r
+ }\r
+// AGC_LOG("AGC: R_cur=%d,G_cur=%d,Ir_cur=%d,ambDac=%d,R_Dac=%d,G_Dac=%d,Ir_Dac=%d,R_step=%d,G_step=%d,Ir_step=%d,state=%d\r\n",\\r
+// calR->R_LED,calR->G_LED,calR->IR_LED,calR->AMBDAC,calR->R_LEDDAC,calR->G_LEDDAC,calR->IR_LEDDAC,\\r
+// calR->R_led_step,calR->G_led_step,calR->IR_led_step,calR->state); \r
+ \r
+ TYHX_LOG("AGC:R_cur=%d, Ir_cur=%d,R_ambDac=%d, IR_ambDac=%d, R_Dac=%d,Ir_Dac=%d,R_step=%d,Ir_step=%d,state=%d \r\n",\\r
+ calRS->R_LED,calRS->IR_LED1,calRS->RED_AMBDAC, calRS->IR_AMBDAC1, calRS->R_LEDDAC,calRS->IR_LEDDAC1,\\r
+ calRS->R_led_step,calRS->IR_led_step1,calRS->state);\r
+}\r
+\r
+SPO2_CAL_SET_T PPG_spo2_agc(void)\r
+{\r
+ int32_t green_amb_val, green_led_val, red_led_val, red_amb_val;\r
+ int32_t ir_led_val1, ir_amb_val1, ir_led_val2, ir_amb_val2;\r
+\r
+ calReg_SPO2.work = false;\r
+\r
+ if (!s_cal_state)\r
+ {\r
+ return calReg_SPO2;\r
+ }\r
+\r
+#ifdef INT_MODE\r
+ calReg_SPO2.int_cnt ++;\r
+ if(calReg_SPO2.int_cnt < 8)\r
+ {\r
+ return calReg_SPO2;\r
+ }\r
+ calReg_SPO2.int_cnt = 0;\r
+ hx3695_gpioint_cfg(false);\r
+#endif\r
+ calReg_SPO2.work = true;\r
+ \r
+ hx3695_spo2_read_data(agc_buf);\r
+ \r
+ green_amb_val = (agc_buf[0]); // + agc_buf[2])>>1;\r
+ green_led_val = agc_buf[1];\r
+ red_amb_val = (agc_buf[2]); // + agc_buf[2])>>1;\r
+ red_led_val = agc_buf[3];\r
+ ir_amb_val1 = (agc_buf[4]); // + agc_buf[5])>>1;\r
+ ir_led_val1 = agc_buf[5];\r
+ \r
+// ir_amb_val2 = agc_buf[6];\r
+// ir_led_val2 = agc_buf[7];\r
+ TYHX_LOG("cal_ch= %d,%d, %d,%d, %d,%d \r\n", green_amb_val,green_led_val, red_amb_val, red_led_val, ir_amb_val1, ir_led_val1);\r
+ \r
+ PPG_Spo2_Calibration_Routine(&calReg_SPO2, green_led_val,red_led_val, ir_led_val1, green_amb_val, red_amb_val, ir_amb_val1 );\r
+\r
+ if (calReg_SPO2.state == sCalFinish)\r
+ {\r
+ hx3695_spo2_set_mode(CAL_OFF);\r
+ if(spo2_wear_status == MSG_SPO2_NO_WEAR)\r
+ {\r
+ hx3695_spo2_low_power();\r
+ \r
+ }\r
+ #if defined(TIMMER_MODE)\r
+\r
+ #else\r
+ hx3695_gpioint_cfg(true);\r
+ #endif\r
+ }\r
+ else\r
+ {\r
+ hx3695_spo2_updata_reg();\r
+#if defined(INT_MODE)\r
+ hx3695_gpioint_cfg(true);\r
+#endif\r
+ }\r
+// TYHX_LOG("calReg_spo2.R_LED %d, ir_led %d \r\n",calReg_SPO2.R_LED,calReg_SPO2.IR_LED1);\r
+ return calReg_SPO2;\r
+}\r
+\r
+\r
+void hx3695_spo2_cal_init(void)\r
+{\r
+ uint16_t sample_rate = 200; /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+ uint32_t prf_clk_num = 32000/sample_rate; /*period in clk num, num = Fclk/fs */\r
+ uint8_t data_avg_num = 0; /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+ \r
+ hx3695_write_reg(0X2a, (uint8_t)prf_clk_num); // prf bit<7:0>\r
+ hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+ hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>\r
+ \r
+ hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num ); \r
+ \r
+ \r
+ hx3695_write_reg(0x1b,0x91); //FIFO bypass mode enable old 0x10\r
+ hx3695_write_reg(0x36,0x08); // phase4 convertion ready enable\r
+ \r
+ #if defined(INT_MODE)\r
+// hx3695_write_reg(0x36,0x88); //phase8 phase4 convertion ready enable\r
+ hx3695_write_reg(0x38,0x01);\r
+ #endif\r
+ hx3695_write_reg(0x1b,0x91);\r
+ hx3695_delay_ms(5);\r
+ hx3695_write_reg(0x5c,0x02); //Chip reset\r
+ hx3695_delay_ms(5); //Delay for reset time\r
+ hx3695_write_reg(0x5c,0x00); //Chip state machine work normal\r
+ hx3695_delay_ms(10); //Delay for reset time\r
+ \r
+ \r
+}\r
+\r
+\r
+\r
+void hx3695_spo2_cal_off(void)\r
+{\r
+ uint16_t sample_rate = 25; /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+ uint8_t data_avg_num = 0; /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+ uint32_t prf_clk_num = 32000/sample_rate; /*period in clk num, num = Fclk/fs */\r
+ hx3695_write_reg(0X2a, (uint8_t)prf_clk_num); // prf bit<7:0>\r
+ hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+ hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>\r
+// AGC_LOG("prf_clk_num =%d %d %d\r\n", hx3695_read_reg(0X2a), hx3695_read_reg(0X2b), hx3695_read_reg(0X2c));\r
+ hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X41, data_avg_num<<4 | data_avg_num );\r
+ hx3695_write_reg(0X42, data_avg_num<<4 | data_avg_num ); \r
+ \r
+ hx3695_write_reg(0x1b,0x91); //FIFO mode enable\r
+ hx3695_write_reg(0x36,0x00); //phase3 convertion ready disable \r
+ \r
+ #if defined(INT_MODE)\r
+ hx3695_write_reg(0X33, 0x83); // int width \r
+ hx3695_write_reg(0x38,0x04); \r
+ #endif\r
+ \r
+ hx3695_write_reg(0x5c,0x02); //Chip reset\r
+ hx3695_delay_ms(5); //Delay for reset time\r
+ hx3695_write_reg(0x1b, 0x91);\r
+ hx3695_write_reg(0x5c,0x00); //Chip state machine work normal\r
+ hx3695_delay_ms(5);\r
+// hx3695_brust_read_reg(0x22, fifo_data_buf, 3);\r
+ read_fifo_first_flg = 1;\r
+// AGC_LOG("herehere %d,%d,%d \r\n",hx3695_read_reg(0X2a),hx3695_read_reg(0X2b),hx3695_read_reg(0X2c));\r
+}\r
+\r
+void hx3695_spo2_read_data(int32_t *s_buf)\r
+{\r
+ uint8_t databuf1[6] = {0};\r
+ uint8_t databuf2[6] = {0};\r
+ uint8_t databuf3[6] = {0};\r
+ uint8_t databuf4[6] = {0};\r
+ \r
+ hx3695_brust_read_reg(0x03, databuf1, 6);\r
+ \r
+ hx3695_brust_read_reg(0x09, databuf2, 6); \r
+ hx3695_delay_ms(5); \r
+ hx3695_brust_read_reg(0x0f, databuf3, 6); \r
+ hx3695_brust_read_reg(0x15, databuf4, 6);\r
+ hx3695_delay_ms(5);\r
+ \r
+ s_buf[0] = ((databuf1[0])|(databuf1[1]<<8)|(databuf1[2]<<16)); \r
+ s_buf[1] = ((databuf1[3])|(databuf1[4]<<8)|(databuf1[5]<<16)); \r
+ s_buf[2] = ((databuf2[0])|(databuf2[1]<<8)|(databuf2[2]<<16)); \r
+ s_buf[3] = ((databuf2[3])|(databuf2[4]<<8)|(databuf2[5]<<16));\r
+ s_buf[4] = ((databuf3[0])|(databuf3[1]<<8)|(databuf3[2]<<16)); \r
+ s_buf[5] = ((databuf3[3])|(databuf3[4]<<8)|(databuf3[5]<<16)); \r
+ s_buf[6] = ((databuf4[0])|(databuf4[1]<<8)|(databuf4[2]<<16)); \r
+ s_buf[7] = ((databuf4[3])|(databuf4[4]<<8)|(databuf4[5]<<16));\r
+ hx3695_delay_ms(5);\r
+ \r
+// return 1;\r
+}\r
+\r
+\r
+\r
+\r
+void hx3695_spo2_low_power(void)\r
+{\r
+ uint16_t sample_rate = 25; /*config the data rate of chip alps2_fm ,uint is Hz*/\r
+ uint8_t data_avg_num = 0; /* 0 = 1 ; 1 = 2; 2 =4 ; 3 =8 ; 4 =16 ;*/\r
+ uint32_t prf_clk_num = 32000/sample_rate; /*period in clk num, num = Fclk/fs */\r
+\r
+ uint8_t phase1_led_en = 1;\r
+ uint8_t phase2_led_en = 1;\r
+ uint8_t phase3_led_en = 1;\r
+ uint8_t phase4_led_en = 1;\r
+ uint8_t phase5_led_en = 1;\r
+ uint8_t phase6_led_en = 1;\r
+ uint8_t phase7_led_en = 1;\r
+ uint8_t phase8_led_en = 1;\r
+\r
+ uint8_t phase1_offset_idac = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+ uint8_t phase2_offset_idac = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+ uint8_t phase3_offset_idac = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+ uint8_t phase4_offset_idac = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+ uint8_t phase5_offset_idac = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+ uint8_t phase6_offset_idac = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+ uint8_t phase7_offset_idac = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+ uint8_t phase8_offset_idac = 0; /* 0~127 = 0 ~ 32ua , step = 0.25ua */\r
+\r
+ uint8_t phase1_ldr_cur = 0;\r
+ uint8_t phase2_ldr_cur = 0;\r
+ uint8_t phase3_ldr_cur = 0;\r
+ uint8_t phase4_ldr_cur = 0;\r
+ uint8_t phase5_ldr_cur = 0;\r
+ uint8_t phase6_ldr_cur = 0;\r
+ uint8_t phase7_ldr_cur = 0;\r
+ uint8_t phase8_ldr_cur = 32;\r
+\r
+\r
+ uint8_t phase1_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase2_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase3_tia_res = 0;\r
+ uint8_t phase4_tia_res = 0;\r
+ uint8_t phase5_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase6_tia_res = 0; /* 0= 10K; 1= 20k; 2= 50k; 3= 100k; 4= 150k; 5= 200k; 6= 500k; 7= 1M*/\r
+ uint8_t phase7_tia_res = 0;\r
+ uint8_t phase8_tia_res = 0;\r
+ \r
+ uint8_t phase1_mux_sel = 0; \r
+ uint8_t phase2_mux_sel = 1;\r
+ uint8_t phase3_mux_sel = 2; /* sel phase3*/\r
+ uint8_t phase4_mux_sel = 3; /* sel phase4*/\r
+ uint8_t phase5_mux_sel = 4; \r
+ uint8_t phase6_mux_sel = 5;\r
+ uint8_t phase7_mux_sel = 6; /* sel phase7*/\r
+ uint8_t phase8_mux_sel = 7; /* sel phase8*/\r
+\r
+ uint8_t led_on_time = 2; /* 0 = 32clk=8us ; 1 = 64clk=16us; 2=128clk=32us ; 3 = 256clk=64us ;\r
+ 4 = 512clk=128us ; 5 = 1024clk=256us; 6= 2048clk=512us; 7 = 4096clk=1024us */\r
+// hx3695_write_reg(0X6a, 0X0f); //rest int\r
+ hx3695_delay_ms(10);\r
+ hx3695_write_reg(0X2a, (uint8_t)prf_clk_num); // prf bit<7:0>\r
+ hx3695_write_reg(0X2b, (uint8_t)(prf_clk_num>>8)); // prf bit<15:8>\r
+ hx3695_write_reg(0X2c, (uint8_t)(prf_clk_num>>16)); // prf bit<23:16>\r
+// hx3695_write_reg(0X3f, data_avg_num<<4 | data_avg_num );\r
+// hx3695_write_reg(0X40, data_avg_num<<4 | data_avg_num ); \r
+ \r
+ hx3695_write_reg(0X43, phase1_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | phase1_tia_res));\r
+ hx3695_write_reg(0X45, phase1_ldr_cur);\r
+// hx3695_write_reg(0X70, phase1_ldr2_cur);\r
+ hx3695_write_reg(0X48, phase1_offset_idac);\r
+ \r
+ hx3695_write_reg(0X43, phase2_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | phase2_tia_res));\r
+ hx3695_write_reg(0X45, phase2_ldr_cur);\r
+ hx3695_write_reg(0X48, phase2_offset_idac);\r
+ \r
+ hx3695_write_reg(0X43, phase3_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | phase3_tia_res));\r
+ hx3695_write_reg(0X45, phase3_ldr_cur);\r
+ hx3695_write_reg(0X48, phase3_offset_idac);\r
+ \r
+ hx3695_write_reg(0X43, phase4_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | phase4_tia_res));\r
+ hx3695_write_reg(0X45, phase4_ldr_cur);\r
+ hx3695_write_reg(0X48, phase4_offset_idac);\r
+ \r
+ hx3695_write_reg(0X43, phase5_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | phase4_tia_res));\r
+ hx3695_write_reg(0X45, phase5_ldr_cur);\r
+ hx3695_write_reg(0X48, phase5_offset_idac);\r
+ \r
+ hx3695_write_reg(0X43, phase6_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | phase6_tia_res));\r
+ hx3695_write_reg(0X45, phase6_ldr_cur);\r
+ hx3695_write_reg(0X48, phase6_offset_idac);\r
+ \r
+ hx3695_write_reg(0X43, phase7_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | phase7_tia_res));\r
+ hx3695_write_reg(0X45, phase7_ldr_cur);\r
+ hx3695_write_reg(0X48, phase7_offset_idac);\r
+ \r
+ hx3695_write_reg(0X43, phase8_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | phase8_tia_res));\r
+ hx3695_write_reg(0X45, phase8_ldr_cur);\r
+ hx3695_write_reg(0X48, phase8_offset_idac);\r
+\r
+\r
+\r
+ hx3695_write_reg(0X30, phase8_led_en<<7 | phase7_led_en<<6 | phase6_led_en<<5 | phase5_led_en<<4 | phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en);\r
+ hx3695_write_reg(0X72, phase8_led_en<<7 | phase7_led_en<<6 | phase6_led_en<<5 | phase5_led_en<<4 | phase4_led_en<<3 | phase3_led_en<<2 | phase2_led_en<<1 | phase1_led_en);\r
+ hx3695_write_reg(0X31, led_on_time<<4 | (0x0f&hx3695_read_reg(0X31)));\r
+\r
+ hx3695_write_reg(0X6a, 0X0f);\r
+\r
+ \r
+ #ifdef INT_MODE\r
+ hx3695_write_reg(0X1c,0x14); // fifo almostfull cfg ,max=0x40;\r
+ hx3695_write_reg(0x1b,0x91); //FIFO bypass mode enable\r
+ hx3695_write_reg(0x36,0x00); //phase3 convertion ready disable\r
+\r
+ #else\r
+ hx3695_write_reg(0x1b,0x91); //FIFO bypass mode enable\r
+ hx3695_write_reg(0x36,0x00); //phase3 convertion ready disable\r
+\r
+ #endif\r
+ \r
+ hx3695_write_reg(0x5c,0x02); //Chip reset\r
+ hx3695_delay_ms(5); //Delay for reset time\r
+// hx3695_write_reg(0x1b, 0x10);\r
+// hx3695_delay_ms(5);\r
+// hx3695_write_reg(0x1b, 0x90);\r
+ hx3695_write_reg(0x5c,0x00); //Chip state machine work normal\r
+\r
+ hx3695_delay_ms(5);\r
+ \r
+ calReg_SPO2.G_LED = phase2_ldr_cur;\r
+ calReg_SPO2.G_LEDDAC = phase2_offset_idac;\r
+ calReg_SPO2.R_LED = phase4_ldr_cur;\r
+ calReg_SPO2.R_LEDDAC = phase4_offset_idac;\r
+ \r
+ calReg_SPO2.IR_LED1 = phase6_ldr_cur;\r
+ calReg_SPO2.IR_LEDDAC1 = phase6_offset_idac; \r
+// hx3695_brust_read_reg(0x22, fifo_data_buf, 3);\r
+ read_fifo_first_flg = 1;\r
+ AGC_LOG(" chip1 go to low power mode \r\n" ); \r
+}\r
+\r
+\r
+\r
+void hx3695_spo2_updata_reg(void)\r
+{\r
+ uint8_t phase1_mux_sel = 0;\r
+ uint8_t phase2_mux_sel = 1;\r
+ uint8_t phase3_mux_sel = 2;\r
+ uint8_t phase4_mux_sel = 3;\r
+ uint8_t phase5_mux_sel = 4;\r
+ uint8_t phase6_mux_sel = 5;\r
+ uint8_t phase7_mux_sel = 6;\r
+ uint8_t phase8_mux_sel = 7;\r
+ if (calReg_SPO2.flag & CAL_FLG_LED_DR) \r
+ {\r
+ //AGC_LOG("CAL_FLG_LED_DR\r\n");\r
+ hx3695_write_reg(0X43, phase2_mux_sel); \r
+ hx3695_write_reg(0X45, calReg_SPO2.G_LED);\r
+// TYHX_LOG("R_LED:%d \r\n",hx3695_read_reg(0X45));\r
+ \r
+ hx3695_write_reg(0X43, phase4_mux_sel); \r
+ hx3695_write_reg(0X45, calReg_SPO2.R_LED);\r
+// TYHX_LOG("IR_LED:%d \r\n",hx3695_read_reg(0X45));\r
+ \r
+ hx3695_write_reg(0X43, phase6_mux_sel); \r
+ hx3695_write_reg(0X45, calReg_SPO2.IR_LED1); \r
+ }\r
+ \r
+ if (calReg_SPO2.flag & CAL_FLG_LED_DAC) \r
+ {\r
+ //AGC_LOG("CAL_FLG_LED_DAC\r\n");\r
+ hx3695_write_reg(0X43, phase2_mux_sel);\r
+ hx3695_write_reg(0X48, calReg_SPO2.G_LEDDAC);\r
+ \r
+ hx3695_write_reg(0X43, phase4_mux_sel);\r
+ hx3695_write_reg(0X48, calReg_SPO2.R_LEDDAC);\r
+ \r
+ hx3695_write_reg(0X43, phase6_mux_sel);\r
+ hx3695_write_reg(0X48, calReg_SPO2.IR_LEDDAC1);\r
+ // AGC_LOG("IR_LEDDAC:%d \r\n",hx3695_read_reg(0X47));\r
+\r
+ }\r
+ \r
+ if (calReg_SPO2.flag & CAL_FLG_AMB_DAC) \r
+ {\r
+ //AGC_LOG("CAL_FLG_AMB_DAC\r\n");\r
+ hx3695_write_reg(0X43, phase1_mux_sel);\r
+ hx3695_write_reg(0X48, calReg_SPO2.GREEN_AMBDAC); \r
+ \r
+ hx3695_write_reg(0X43, phase3_mux_sel);\r
+ hx3695_write_reg(0X48, calReg_SPO2.RED_AMBDAC); \r
+\r
+ hx3695_write_reg(0X43, phase5_mux_sel);\r
+ hx3695_write_reg(0X48, calReg_SPO2.IR_AMBDAC1); \r
+ \r
+// hx3695_write_reg(0X43, phase6_mux_sel);\r
+// hx3695_write_reg(0X48, calReg_SPO2.IR_AMBDAC1); \r
+\r
+ }\r
+ \r
+ if (calReg_SPO2.flag & CAL_FLG_RF) \r
+ {\r
+ //AGC_LOG("CAL_FLG_RF\r\n");\r
+ hx3695_write_reg(0X43, phase1_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | calReg_SPO2.G_RF));\r
+ //AGC_LOG("RF:%x \r\n",hx3695_read_reg(0X44));\r
+// hx3695_write_reg(0X44, (hx3695_read_reg(0X44)| 0x07)&(calReg_SPO2.R_RF|0xff)); \r
+ hx3695_write_reg(0X43, phase2_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | calReg_SPO2.G_RF));\r
+ //AGC_LOG("RF:%x \r\n",hx3695_read_reg(0X44));\r
+// hx3695_write_reg(0X44, (hx3695_read_reg(0X44)| 0x07)&(calReg_SPO2.G_RF|0xff));\r
+ hx3695_write_reg(0X43, phase3_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | calReg_SPO2.R_RF));\r
+ //AGC_LOG("RF:%x \r\n",hx3695_read_reg(0X44));\r
+// hx3695_write_reg(0X44, (hx3695_read_reg(0X44)| 0x07)&(calReg_SPO2.R_RF|0xff));\r
+ hx3695_write_reg(0X43, phase4_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | calReg_SPO2.R_RF));\r
+ //AGC_LOG("RF:%x \r\n",hx3695_read_reg(0X44));\r
+// hx3695_write_reg(0X44, (hx3695_read_reg(0X44)| 0x07)&(calReg_SPO2.IR_RF|0xff));\r
+ \r
+// hx3695_write_reg(0X43, phase3_mux_sel); \r
+// hx3695_write_reg(0X44, (0x40 | calReg_SPO2.R_RF));\r
+// hx3695_write_reg(0X43, phase4_mux_sel); \r
+// hx3695_write_reg(0X44, (0x40 | calReg_SPO2.R_RF));\r
+ \r
+ hx3695_write_reg(0X43, phase5_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | calReg_SPO2.IR_RF1));\r
+ \r
+ hx3695_write_reg(0X43, phase6_mux_sel); \r
+ hx3695_write_reg(0X44, (0x40 | calReg_SPO2.IR_RF1));\r
+ \r
+ }\r
+ \r
+}\r
+void hx3695_spo2_set_mode(uint8_t mode_cmd)\r
+{\r
+ switch (mode_cmd)\r
+ {\r
+ case PPG_INIT:\r
+ hx3695_spo2_ppg_init();\r
+#if defined(TIMMER_MODE)\r
+ hx3695_320ms_timer_cfg(true);\r
+#if defined(GSEN_40MS_TIMMER)\r
+ hx3695_40ms_timer_cfg(true);\r
+#endif\r
+#else\r
+ hx3695_gpioint_cfg(true);\r
+#endif\r
+ s_ppg_state = 1;\r
+ AGC_LOG("ppg init mode\r\n");\r
+ break;\r
+\r
+ case PPG_OFF:\r
+ hx3695_ppg_off();\r
+ s_ppg_state = 0;\r
+ AGC_LOG("ppg off mode\r\n");\r
+ break;\r
+\r
+ case PPG_LED_OFF:\r
+ hx3695_spo2_low_power();\r
+ \r
+ s_ppg_state = 0;\r
+ AGC_LOG("ppg led off mode\r\n");\r
+ break;\r
+\r
+ case CAL_INIT:\r
+ Init_Spo2_PPG_Calibration_Routine(&calReg_SPO2,64);\r
+ hx3695_spo2_cal_init();\r
+ hx3695_spo2_updata_reg();\r
+#if defined(TIMMER_MODE)\r
+#if defined(GSEN_40MS_TIMMER)\r
+#else\r
+ hx3695_40ms_timer_cfg(true);\r
+#endif\r
+#endif\r
+ s_cal_state = 1;\r
+ AGC_LOG("cal init mode\r\n");\r
+ break;\r
+\r
+ case RECAL_INIT:\r
+ Restart_Spo2_PPG_Calibration_Routine(&calReg_SPO2);\r
+ hx3695_spo2_cal_init();\r
+ hx3695_spo2_updata_reg();\r
+#if defined(TIMMER_MODE)\r
+#if defined(GSEN_40MS_TIMMER)\r
+#else\r
+ hx3695_40ms_timer_cfg(true);\r
+#endif\r
+#endif\r
+ s_cal_state = 1;\r
+ AGC_LOG("recal init mode\r\n");\r
+ break;\r
+\r
+ case CAL_OFF:\r
+#if defined(TIMMER_MODE)\r
+#if defined(GSEN_40MS_TIMMER)\r
+#else\r
+ hx3695_40ms_timer_cfg(false);\r
+#endif\r
+#endif\r
+ hx3695_spo2_cal_off();\r
+ s_cal_state = 0;\r
+ AGC_LOG("cal off mode\r\n");\r
+ break;\r
+\r
+ default:\r
+ break;\r
+ }\r
+}\r
+\r
+SENSOR_ERROR_T hx3695_spo2_enable(void)\r
+{\r
+ if (!hx3695_chip_check())\r
+ {\r
+ AGC_LOG("hx3695 check id failed!\r\n");\r
+ return SENSOR_OP_FAILED;\r
+ }\r
+\r
+ AGC_LOG("hx3695 check id success!\r\n");\r
+\r
+ if (s_ppg_state)\r
+ {\r
+ AGC_LOG("ppg already on!\r\n");\r
+ return SENSOR_OP_FAILED;\r
+ }\r
+\r
+ if(!tyhx_spo2_alg_open())\r
+ {\r
+ AGC_LOG("spo2 alg open fail,or dynamic ram not enough!\r\n");\r
+ return SENSOR_OP_FAILED;\r
+ }\r
+ spo2_wear_status = MSG_SPO2_NO_WEAR;\r
+ spo2_wear_status_pre = MSG_SPO2_NO_WEAR;\r
+ hx3695_spo2_set_mode(PPG_INIT);\r
+\r
+ AGC_LOG("hx3695 enable!\r\n");\r
+\r
+ return SENSOR_OK;\r
+}\r
+\r
+SENSOR_ERROR_T hx3695_hrspo2_enable(void)\r
+{\r
+ if (!hx3695_chip_check())\r
+ {\r
+ AGC_LOG("hx3695 check id failed!\r\n");\r
+ return SENSOR_OP_FAILED;\r
+ }\r
+\r
+ AGC_LOG("hx3695 check id success!\r\n");\r
+\r
+ if (s_ppg_state)\r
+ {\r
+ AGC_LOG("ppg already on!\r\n");\r
+ return SENSOR_OP_FAILED;\r
+ }\r
+\r
+ if(!tyhx_spo2_alg_open())\r
+ {\r
+ AGC_LOG("spo2 alg open fail,or dynamic ram not enough!\r\n");\r
+ return SENSOR_OP_FAILED;\r
+ }\r
+ if(!tyhx_hrs_alg_open())\r
+ {\r
+ AGC_LOG("spo2 alg open fail,or dynamic ram not enough!\r\n");\r
+ return SENSOR_OP_FAILED;\r
+ }\r
+ spo2_wear_status = MSG_SPO2_NO_WEAR;\r
+ spo2_wear_status_pre = MSG_SPO2_NO_WEAR;\r
+ hx3695_spo2_set_mode(PPG_INIT);\r
+\r
+ AGC_LOG("hx3695 enable!\r\n");\r
+\r
+ return SENSOR_OK;\r
+}\r
+\r
+void hx3695_spo2_disable(void)\r
+{\r
+#if defined(TIMMER_MODE)\r
+ hx3695_320ms_timer_cfg(false);\r
+ hx3695_40ms_timer_cfg(false);\r
+#elif defined(INT_MODE)\r
+ hx3695_gpioint_cfg(false);\r
+#endif\r
+ hx3695_spo2_set_mode(PPG_OFF);\r
+ s_ppg_state = 0;\r
+ s_cal_state = 0;\r
+ tyhx_spo2_alg_close();\r
+\r
+ AGC_LOG("hx3695 disable!\r\n");\r
+}\r
+\r
+void hx3695_spo2_data_reset(void)\r
+{\r
+ s_ppg_state = 0;\r
+ s_cal_state = 0;\r
+ tyhx_spo2_alg_close();\r
+}\r
+\r
+spo2_wear_msg_code_t hx3695_spo2_get_wear_status(void)\r
+{\r
+ return spo2_wear_status;\r
+}\r
+\r
+SPO2_CAL_SET_T get_spo2_agc_status(void)\r
+{\r
+ SPO2_CAL_SET_T cal;\r
+\r
+// cal.flag = calReg_SPO2.flag;\r
+// cal.int_cnt = calReg_SPO2.int_cnt;\r
+// cal.G_LED = calReg_SPO2.G_LED;\r
+// cal.R_LED = calReg_SPO2.R_LED;\r
+// cal.IR_LED1 = calReg_SPO2.IR_LED1;\r
+// cal.R_LEDDAC = calReg_SPO2.R_LEDDAC;\r
+// cal.IR_LEDDAC1 = calReg_SPO2.IR_LEDDAC1;\r
+// cal.G_LEDDAC = calReg_SPO2.G_LEDDAC;\r
+// cal.AMBDAC = calReg_SPO2.AMBDAC;\r
+// cal.G_RF = calReg_SPO2.G_RF;\r
+// cal.R_RF = calReg_SPO2.R_RF;\r
+// cal.IR_RF1 = calReg_SPO2.IR_RF1;\r
+// cal.G_led_step = calReg_SPO2.G_led_step;\r
+// cal.R_led_step = calReg_SPO2.R_led_step;\r
+// cal.IR_led_step1 = calReg_SPO2.IR_led_step1;\r
+// cal.state = calReg_SPO2.state;\r
+// cal.green_idac = calReg_SPO2.green_idac;\r
+// cal.red_idac = calReg_SPO2.red_idac;\r
+// cal.ir_idac1 = calReg_SPO2.ir_idac1;\r
+\r
+ cal = calReg_SPO2;\r
+\r
+ return cal;\r
+}\r
+\r
+//void hx3695_spo2_read_fifo_data(uint8_t read_fifo_size,int32_t *buf)\r
+//{\r
+// uint8_t data_flg = 127;\r
+// int32_t data;\r
+// uint8_t databuf[3];\r
+// uint8_t ii=0;\r
+// uint8_t data_size_all = 0;\r
+// data_size_all = hx3695_read_fifo_size();\r
+// for(ii=0; ii<read_fifo_size; ii++)\r
+// {\r
+// hx3695_write_reg(0x17, 0x00); // write any walue to 0x17 will update a new data\r
+// hx3695_delay_us(100);\r
+\r
+// databuf[2]=hx3695_read_reg(0x17);\r
+// databuf[1]=hx3695_read_reg(0x16);\r
+// databuf[0]=hx3695_read_reg(0x15);\r
+// data_flg = databuf[2]>>5;\r
+// data = (int32_t)(databuf[0]|(databuf[1]<<8)|((databuf[2]&0x1f)<<16));\r
+\r
+// if(ii==0)\r
+// {\r
+// if(data_flg ==3)\r
+// {\r
+// ii=3;\r
+// buf[0] = 0;\r
+// buf[1] = 0;\r
+// buf[2] = 0;\r
+// }\r
+// if(data_flg ==2)\r
+// {\r
+// ii=2;\r
+// buf[0] = 0;\r
+// buf[1] = 0;\r
+// }\r
+// if(data_flg ==1)\r
+// {\r
+// ii=1;\r
+// buf[0] = 0;\r
+// }\r
+// }\r
+\r
+// if(data_flg == 0)\r
+// {\r
+// buf[ii]= data;\r
+// }\r
+// else if(data_flg == 1)\r
+// {\r
+// buf[ii]= data;\r
+// }\r
+// else if(data_flg == 2)\r
+// {\r
+// buf[ii]= data;\r
+// }\r
+// else if(data_flg == 3)\r
+// {\r
+// buf[ii]= data;\r
+// }\r
+// }\r
+\r
+// if(data_size_all==64)\r
+// {\r
+// hx3695_write_reg(0X13, 0x30);\r
+// hx3695_delay_ms(5);\r
+// hx3695_write_reg(0X13, 0x31);\r
+// hx3695_delay_ms(5);\r
+// }\r
+//}\r
+\r
+uint8_t hx3695_spo2_read(spo2_sensor_data_t * s_dat)\r
+{\r
+ int32_t Red_src_data;\r
+ int32_t Ir_src_data1, Ir_src_data2;\r
+ int32_t Green_src_data;\r
+ int32_t Ir_wear_value;\r
+ bool recal = false;\r
+ uint8_t size = 0;\r
+ uint8_t size_byte = 0;\r
+ uint8_t i;\r
+ int32_t *red_buf = &(s_dat->red_data[0]);\r
+ int32_t *green_buf = &(s_dat->green_data[0]);\r
+ int32_t *ir_buf1 = &(s_dat->ir_data1[0]); \r
+ int32_t *ir_buf2 = &(s_dat->ir_data2[0]); \r
+ int32_t *s_buf = &(s_dat->s_buf[0]); \r
+ s_dat->agc_green = calReg_SPO2.G_LED; \r
+ s_dat->agc_red = calReg_SPO2.R_LED;\r
+ s_dat->agc_ir1 = calReg_SPO2.IR_LED1;\r
+ s_dat->agc_ir2 = calReg_SPO2.IR_LED2;\r
+ uint8_t data_count = 0;\r
+ //AGC_LOG("s_ppg_state: %d,s_cal_state: %d\r\n",s_ppg_state,s_cal_state);\r
+ if (!s_ppg_state || s_cal_state) \r
+ {\r
+ return NULL;\r
+ } \r
+\r
+ data_count = hx3695_read_fifo_data(s_buf,spo2_phase_num,1); \r
+ s_dat->count = data_count; \r
+\r
+ hx3695_spo2_read_data( agc_buf );\r
+ Ir_wear_value = agc_buf[7]- agc_buf[6];\r
+ TYHX_LOG("Ir_wear_value: %d \r\n",Ir_wear_value);\r
+ for (i=0; i<data_count; i++) \r
+ {\r
+// Red_src_data = s_buf[i*4+2] - s_buf[i*4];\r
+ Green_src_data = s_buf[i*4];\r
+ Red_src_data = s_buf[i*4+1]; // - s_buf[i*4];\r
+ Ir_src_data1 = s_buf[i*4+2]; // - s_buf[i*4];\r
+ Ir_src_data2 = s_buf[i*4+3]; // - s_buf[i*4];\r
+\r
+// if((Green_src_data < 400000 ||Green_src_data > 750000)||( Red_src_data < 400000 || Red_src_data > 750000)\r
+// ||(Ir_src_data1 < 400000 ||Ir_src_data1 > 750000)) \r
+ if((agc_buf[1] < 300000 ||agc_buf[1] > 750000)||( agc_buf[3] < 300000 || agc_buf[3] > 750000)\r
+ ||(agc_buf[5] < 300000 ||agc_buf[5] > 750000))\r
+ \r
+ {\r
+ recal = true; \r
+ if(spo2_wear_status==MSG_SPO2_NO_WEAR)\r
+ {\r
+ recal = false;\r
+ }\r
+ } \r
+ green_buf[i] = Green_src_data;\r
+ red_buf[i] = Red_src_data;\r
+ ir_buf1[i] = Ir_src_data1;\r
+ ir_buf2[i] = Ir_src_data2;\r
+ \r
+ //SEGGER_RTT_printf(0,"G_LEDDAC: %d,R_LEDDAC: %d\r\n", calReg_SPO2.R_LEDDAC,cal.R_LEDDAC);\r
+ //DEBUG_PRINTF(0,"%d/%d %d %d %d %d %d %d %d %d\r\n" ,1+i,data_count,\\r
+ green_buf[i],red_buf[i],ir_buf[i],s_buf[i*4],s_buf[i*4+1],s_buf[i*4+2],s_buf[i*4+3],spo2_wear_status);\r
+\r
+// SEGGER_RTT_printf(0,"fifo_data: %d/%d %d %d %d %d\r\n", i+1,data_count,s_buf[i*4],\\r
+// s_buf[i*4+1],s_buf[i*4+2],s_buf[i*4+3]);\r
+\r
+ \r
+ if(spo2_wear_status==MSG_SPO2_WEAR)\r
+ {\r
+ if(hx3695_spo2_check_unwear(Ir_wear_value)) //Ir_src_data2\r
+ {\r
+ return NULL;\r
+ }\r
+ }\r
+ else\r
+ {\r
+ if(hx3695_spo2_check_wear(Ir_wear_value))\r
+ {\r
+ return NULL;\r
+ }\r
+ }\r
+ }\r
+\r
+ if (recal) \r
+ //if (0)\r
+ {\r
+ cal_delay--;\r
+ if (cal_delay <= 0) \r
+ {\r
+ cal_delay = SPO2_CAL_DELAY_COUNT;\r
+ hx3695_spo2_set_mode(RECAL_INIT);\r
+ }\r
+ } \r
+ else \r
+ {\r
+ cal_delay = SPO2_CAL_DELAY_COUNT;\r
+ } \r
+ \r
+ return 1;\r
+}\r
+\r
+#endif\r
--- /dev/null
+#ifndef _HX3695_SPO2_AGC_H_\r
+#define _HX3695_SPO2_AGC_H_\r
+#include <stdint.h>\r
+#include <stdbool.h>\r
+#include "hx3695.h"\r
+\r
+#define CAL_FLG_LED_DR 0x01\r
+#define CAL_FLG_LED_DAC 0x02 \r
+#define CAL_FLG_AMB_DAC 0x04\r
+#define CAL_FLG_RF 0x08\r
+\r
+#define SPO2_CAL_INIT_LED_RED 32\r
+#define SPO2_CAL_INIT_LED_IR 32\r
+#define SPO2_CAL_INIT_LED_GREEN 64\r
+\r
+#define SPO2_CAL_DELAY_COUNT 8\r
+#define SPO2_NO_TOUCH_CHECK_NUM 2\r
+\r
+\r
+//typedef enum { \r
+// sCalStart,\r
+// sCalLedCur, \r
+// sCalLed,\r
+// sCalLed2,\r
+// sCalLed3,\r
+// sCalFinish, \r
+//} SPO2_STATE_T;\r
+\r
+typedef enum { \r
+ \r
+ sCalStart,\r
+ sCalStart1, \r
+ sCalLed,\r
+ sCalLed2,\r
+ sCalLed3,\r
+ sCalRf,\r
+ sCalRfEnd,\r
+ sCalFinish, \r
+} SPO2_STATE_T;\r
+\r
+typedef struct {\r
+ uint8_t count;\r
+ int32_t red_data[16];\r
+ int32_t green_data[16];\r
+ int32_t ir_data1[16]; \r
+ int32_t ir_data2[16];\r
+ int32_t s_buf[64];\r
+// int32_t red_amb_buf[64];\r
+ \r
+ uint8_t agc_green;\r
+ uint8_t agc_red; \r
+ uint8_t agc_ir1;\r
+ uint8_t agc_ir2; \r
+ \r
+}spo2_sensor_data_t;\r
+\r
+typedef enum {\r
+ MSG_SPO2_NO_WEAR,\r
+ MSG_SPO2_WEAR\r
+} spo2_wear_msg_code_t;\r
+\r
+typedef struct {\r
+ uint8_t flag;\r
+ bool work;\r
+ uint8_t int_cnt;\r
+ uint8_t cur255_cnt;\r
+ uint8_t green_idac;\r
+ uint8_t red_idac;\r
+ uint8_t ir_idac1;\r
+ uint8_t ir_idac2;\r
+ uint16_t G_LED; \r
+ uint16_t R_LED; \r
+ uint16_t IR_LED1; \r
+ uint16_t IR_LED2; \r
+ uint8_t G_LEDDAC;\r
+ uint8_t R_LEDDAC; \r
+ uint8_t IR_LEDDAC1;\r
+ uint8_t IR_LEDDAC2; \r
+ uint8_t AMBDAC;\r
+ uint8_t GREEN_AMBDAC;\r
+ uint8_t RED_AMBDAC; \r
+ uint8_t IR_AMBDAC1; \r
+ uint8_t IR_AMBDAC2;\r
+ uint8_t G_RF;\r
+ uint8_t R_RF; \r
+ uint8_t IR_RF1;\r
+ uint8_t IR_RF2;\r
+ uint32_t G_led_step;\r
+ uint32_t R_led_step;\r
+ uint32_t IR_led_step1;\r
+ uint32_t IR_led_step2;\r
+ uint8_t state;\r
+ uint8_t green_max_cur;\r
+ uint8_t red_max_cur;\r
+ uint8_t ir_max_cur;\r
+} SPO2_CAL_SET_T;\r
+\r
+void Init_Spo2_PPG_Calibration_Routine(SPO2_CAL_SET_T *calR,uint8_t led); \r
+void Restart_spo2_PPG_Calibration_Routine(SPO2_CAL_SET_T *calR);\r
+//void PPG_Spo2_Calibration_Routine(SPO2_CAL_SET_T *calR, int32_t g_led, int32_t r_led, int32_t amb, int32_t ir_led);\r
+//void PPG_Spo2_Calibration_Routine(SPO2_CAL_SET_T *calRS, int32_t r_led, int32_t ir_led1, int32_t red_amb, int32_t ir_amb1);\r
+void PPG_Spo2_Calibration_Routine(SPO2_CAL_SET_T *calRS, int32_t g_led, int32_t r_led, int32_t ir_led1, int32_t g_amb, int32_t red_amb, int32_t ir_amb1);\r
+\r
+void hx3695_spo2_cal_init(void);\r
+void hx3695_spo2_cal_off(void); \r
+void hx3695_spo2_read_data(int32_t *s_buf);\r
+void hx3695_spo2_low_power(void);\r
+void hx3695_spo2_normal_power(void); \r
+void hx3695_spo2_updata_reg(void);\r
+void hx3695_spo2_set_mode(uint8_t mode_cmd);\r
+SENSOR_ERROR_T hx3695_spo2_enable(void);\r
+void hx3695_spo2_disable(void);\r
+spo2_wear_msg_code_t hx3695_spo2_get_wear_status(void);\r
+uint8_t hx3695_spo2_read(spo2_sensor_data_t * s_dat);\r
+bool hx3695_spo2_check_unwear(int32_t infrared_data);\r
+bool hx3695_spo2_check_wear(int32_t infrared_data);\r
+SPO2_CAL_SET_T get_spo2_agc_status(void);\r
+SPO2_CAL_SET_T PPG_spo2_agc(void);\r
+void hx3695_spo2_data_reset(void);\r
+void hx3695_spo2_read_data(int32_t *s_buf);\r
+\r
+#endif\r
--- /dev/null
+//vesion3.1.35\r
+#ifndef _TYHX_HRS_ALG_H_\r
+#define _TYHX_HRS_ALG_H_\r
+\r
+#include <stdint.h>\r
+\r
+/* portable 8-bit unsigned integer */\r
+typedef unsigned char uint8_t;\r
+/* portable 8-bit signed integer */\r
+typedef signed char int8_t;\r
+/* portable 16-bit unsigned integer */\r
+typedef unsigned short int uint16_t;\r
+/* portable 16-bit signed integer */\r
+typedef signed short int int16_t;\r
+/* portable 32-bit unsigned integer */\r
+typedef unsigned int uint32_t;\r
+/* portable 32-bit signed integer */\r
+typedef signed int int32_t;\r
+\r
+#ifndef bool\r
+#define bool unsigned char\r
+#endif\r
+\r
+#ifndef true\r
+#define true 1\r
+#endif\r
+#ifndef false\r
+#define false 0\r
+#endif\r
+\r
+#ifdef HRS_ALG_LIB\r
+\r
+typedef enum {\r
+ NORMAL_MODE,\r
+ RIDE_MODE,\r
+ WALK_MODE,\r
+ JUMP_MODE,\r
+ ALLDAY_HR_MODE,\r
+ HIGH_POW_MODE\r
+} hrs_sports_mode_t;\r
+\r
+typedef enum {\r
+ MSG_HRS_ALG_NOT_OPEN,\r
+ MSG_HRS_ALG_OPEN,\r
+ MSG_HRS_READY,\r
+ MSG_HRS_ALG_TIMEOUT\r
+} hrs_alg_msg_code_t;\r
+\r
+typedef enum {\r
+ MSG_LIVING_INITIAL,\r
+ MSG_LIVING_TRUE,\r
+ MSG_LIVING_FAIL\r
+} living_msg_code_t;\r
+\r
+typedef struct {\r
+ hrs_alg_msg_code_t hrs_alg_status;\r
+ living_msg_code_t living_status;\r
+ uint32_t data_cnt;\r
+ uint8_t hr_result;\r
+ uint16_t cal_result;\r
+ uint8_t hr_result_qual;\r
+ uint32_t hr_result_std;\r
+} hrs_results_t;\r
+\r
+#ifdef BP_CUSTDOWN_ALG_LIB\r
+typedef enum {\r
+ MSG_BP_ALG_NOT_OPEN = 0x01,\r
+ MSG_BP_NO_TOUCH = 0x02,\r
+ MSG_BP_PPG_LEN_TOO_SHORT = 0x03,\r
+ MSG_BP_READY = 0x04,\r
+ MSG_BP_ALG_TIMEOUT = 0x05,\r
+ MSG_BP_SETTLE = 0x06\r
+} bp_msg_code_t;\r
+\r
+typedef struct {\r
+ uint8_t age;\r
+ uint8_t height;\r
+ uint8_t weight;\r
+ uint8_t gender;\r
+ uint8_t ref_sbp;\r
+ uint8_t ref_dbp;\r
+} bp_exinf_t;\r
+\r
+typedef struct {\r
+ bp_msg_code_t bp_alg_status;\r
+ uint8_t sbp;\r
+ uint8_t dbp; \r
+ uint32_t data_cnt;\r
+ uint8_t hr_result;\r
+ bool object_flg;\r
+} bp_results_t;\r
+\r
+void tyhx_bp_set_exinf(uint8_t age, uint8_t height, uint8_t weight, uint8_t gender, uint8_t ref_sbp, uint8_t ref_dbp);\r
+void tyhx_bp_age_fn(uint8_t hr_result, bp_exinf_t body_s);\r
+void tyhx_restart_bp_cal(void);\r
+bp_results_t tyhx_alg_get_bp_results(void);\r
+#endif //BP_CUSTDOWN_ALG_LIB\r
+\r
+bool tyhx_hrs_alg_open(void);\r
+bool tyhx_hrs_alg_open_deep(void);\r
+void tyhx_hrs_alg_close(void);\r
+bool tyhx_hrs_alg_send_data(int32_t *new_raw_data,uint8_t dat_len, int16_t *gsen_data_x, int16_t *gsen_data_y, int16_t *gsen_data_z, uint8_t green_offset);\r
+bool tyhx_hrs_alg(int32_t new_raw_data, int16_t gsen_data_x, int16_t gsen_data_y, int16_t gsen_data_z, uint8_t offset);\r
+bool tyhx_motion_pedometer(int16_t gsen_data_x, int16_t gsen_data_y, int16_t gsen_data_z);\r
+hrs_results_t tyhx_hrs_alg_get_results(void);\r
+void tyhx_hrs_set_alg_para(hrs_sports_mode_t sports_mode, uint16_t static_thre_val, uint8_t gsen_fun_lv_val);\r
+void tyhx_hrs_set_living(uint8_t mode, uint8_t qu_thre, uint8_t st_thre);\r
+#endif //HRS_ALG_LIB\r
+\r
+#endif\r
+\r
+\r
--- /dev/null
+#ifndef _TYHX_HRV_ALG_H_\r
+#define _TYHX_HRV_ALG_H_\r
+#endif\r
+ \r
+#include <stdint.h>\r
+\r
+/* portable 8-bit unsigned integer */\r
+typedef unsigned char uint8_t;\r
+/* portable 8-bit signed integer */\r
+typedef signed char int8_t;\r
+/* portable 16-bit unsigned integer */\r
+typedef unsigned short int uint16_t;\r
+/* portable 16-bit signed integer */\r
+typedef signed short int int16_t;\r
+/* portable 32-bit unsigned integer */\r
+typedef unsigned int uint32_t;\r
+/* portable 32-bit signed integer */\r
+typedef signed int int32_t;\r
+\r
+#ifndef bool\r
+#define bool unsigned char\r
+#endif\r
+#ifndef true\r
+#define true 1\r
+#endif\r
+#ifndef false\r
+#define false 0\r
+#endif\r
+\r
+#define HRV_GLITCH_THRES 20000 \r
+#define HRV_GSEN_POW_THRE 150\r
+\r
+#ifdef HRV_ALG_LIB\r
+\r
+typedef enum {\r
+ MSG_HRV_ALG_NOT_OPEN,\r
+ MSG_HRV_ALG_OPEN,\r
+ MSG_HRV_READY,\r
+ MSG_HRV_ALG_TIMEOUT,\r
+} hrv_alg_msg_code_t;\r
+\r
+typedef struct {\r
+ hrv_alg_msg_code_t hrv_alg_status;\r
+ uint32_t data_cnt;\r
+ uint8_t hrv_result;\r
+ uint32_t hrv_peak; \r
+ uint8_t spirit_pressure;\r
+ uint8_t p_m;\r
+ uint8_t screen_up;\r
+ uint8_t motion;\r
+ uint8_t signal_quality;\r
+} hrv_results_t;\r
+\r
+\r
+void tyhx_hrv_alg(int32_t new_raw_data);\r
+bool tyhx_hrv_alg_open(void);\r
+bool tyhx_hrv_alg_open_deep(void);\r
+void tyhx_hrv_alg_close(void);\r
+void kfft(double *pr,double *pi,int n,int k,double *fr,double *fi);\r
+\r
+hrv_results_t tyhx_hrv_alg_send_data(int32_t new_raw_data, int32_t green_data_als, int32_t infrared_data);\r
+hrv_results_t tyhx_hrv_alg_send_bufdata(int32_t *new_raw_data, uint8_t count, int16_t *gsen_data_x, int16_t *gsen_data_y, int16_t *gsen_data_z);\r
+#endif //HRV_ALG_LIB\r
+ \r
--- /dev/null
+#ifndef _SPO2_ALG_H_\r
+#define _SPO2_ALG_H_\r
+#endif\r
+#include <stdint.h>\r
+\r
+//version:3.3.17\r
+\r
+//#include "tyhx_spo2_alg_para.h"\r
+\r
+\r
+/* portable 8-bit unsigned integer */\r
+typedef unsigned char uint8_t;\r
+/* portable 8-bit signed integer */\r
+typedef signed char int8_t;\r
+/* portable 16-bit unsigned integer */\r
+typedef unsigned short int uint16_t;\r
+/* portable 16-bit signed integer */\r
+typedef signed short int int16_t;\r
+/* portable 32-bit unsigned integer */\r
+typedef unsigned int uint32_t;\r
+/* portable 32-bit signed integer */\r
+typedef signed int int32_t;\r
+\r
+#ifndef bool\r
+#define bool unsigned char\r
+#endif\r
+\r
+#ifndef true\r
+#define true 1\r
+#endif\r
+#ifndef false\r
+#define false 0\r
+#endif\r
+\r
+\r
+#ifdef SPO2_ALG_LIB\r
+\r
+typedef enum {\r
+ MSG_SPO2_ALG_NOT_OPEN,\r
+ MSG_SPO2_ALG_OPEN,\r
+ MSG_SPO2_READY,\r
+ MSG_SPO2_ALG_TIMEOUT,\r
+ MSG_SPO2_END\r
+} spo2_alg_msg_code_t;\r
+\r
+typedef enum {\r
+ MSG_SPO2_LIVING_INITIAL,\r
+ MSG_SPO2_LIVING_TRUE,\r
+ MSG_SPO2_LIVING_FAIL\r
+} spo2_living_code_t;\r
+\r
+typedef enum {\r
+ SPO2_NORMAL_MODE,\r
+ SPO2_ALLDAY_MODE\r
+} spo2_mode_t;\r
+\r
+typedef struct {\r
+ spo2_alg_msg_code_t spo2_alg_status;\r
+ spo2_living_code_t spo2_living_status;\r
+ uint32_t data_cnt;\r
+ uint8_t spo2_result;\r
+ uint8_t hr_result;\r
+ uint8_t block_cnt;\r
+ uint8_t ir_quality;\r
+ uint16_t reliable_score_result;\r
+\r
+ uint8_t screen_up;\r
+ uint8_t motion;\r
+ uint8_t poor_signal;\r
+ \r
+ uint8_t signal_snr;\r
+ uint32_t signal_std;\r
+ \r
+} spo2_results_t;\r
+\r
+typedef struct {\r
+ uint8_t screen_up;\r
+ uint8_t motion;\r
+ uint8_t poor_signal;\r
+} spo2_gesture_recognize_t;\r
+\r
+typedef struct {\r
+ uint32_t data_cnt;\r
+ int32_t red_new_raw_data;\r
+ int32_t ir_new_raw_data;\r
+ int32_t green_new_raw_data;\r
+ int32_t ir_iir_data_filter_out;\r
+ int32_t ir_data_smooth;\r
+ int32_t red_iir_data_filter_out;\r
+ int32_t red_data_smooth;\r
+ uint8_t ir_offset_50;\r
+ uint8_t red_offset_50;\r
+ uint8_t green_offset_50;\r
+ int32_t ir_dc;\r
+ int32_t red_dc;\r
+ int32_t green_dc;\r
+ int32_t ir_data_o2_128;\r
+ int32_t red_data_o2_128;\r
+ int32_t green_data_o2_128;\r
+ int16_t red_ir_dc;\r
+ int16_t red_green_dc;\r
+ int16_t ir_green_dc;\r
+ int16_t ir_fft_snr;\r
+ int8_t motion_status;\r
+ uint8_t xcorr_max;\r
+ int16_t COUNT_IN_judge;\r
+ uint8_t spo2_result;\r
+ uint8_t count_block;\r
+ int32_t SaO2_data_temp;\r
+} spo2_debug_t;\r
+\r
+typedef struct {\r
+ uint8_t red_offset_idac;\r
+ uint8_t ir_offset_idac; \r
+ uint8_t green_offset_idac; \r
+ uint16_t spo2_start_cnt;\r
+} spo2_agcpara_t;\r
+\r
+typedef struct {\r
+ uint8_t XCORR_MODE;\r
+ uint8_t QUICK_RESULT;\r
+} spo2_switch_t;\r
+\r
+typedef struct {\r
+ uint8_t SPO2_LOW_XCORR_THRE;\r
+ uint8_t SPO2_LOW_SNR_THRE;\r
+ uint8_t COUNT_BLOCK_NUM;\r
+ uint32_t SPO2_BASE_LINE_INIT;\r
+ uint32_t SPO2_SLOPE;\r
+ uint16_t SPO2_GSEN_POW_THRE;\r
+} spo2_usuallyadjust_t;\r
+\r
+typedef struct {\r
+ uint16_t MEAN_NUM;\r
+ int32_t SOP2_DEGLITCH_THRE;\r
+ int32_t SPO2_REMOVE_JUMP_THRE;\r
+ uint16_t SPO2_LOW_CLIP_END_TIME;\r
+ uint16_t SPO2_LOW_CLIP_DN;\r
+ uint16_t SPO2_NORMAL_CLIP_DN;\r
+ uint16_t IR_AC_TOUCH_THRE;\r
+ uint16_t IR_FFT_POW_THRE;\r
+ uint8_t SPO2_CALI;\r
+ uint8_t SLOPE_PARA_MAX;\r
+ uint8_t SLOPE_PARA_MIN;\r
+} spo2_barelychange_t;\r
+\r
+void tyhx_spo2_set_switch(uint8_t XCORR_MODE,uint8_t QUICK_RESULT);\r
+void tyhx_spo2_para_usuallyadjust(uint8_t SPO2_LOW_XCORR_THRE,uint8_t SPO2_LOW_SNR_THRE,uint8_t COUNT_BLOCK_NUM,uint32_t SPO2_BASE_LINE_INIT,uint32_t SPO2_SLOPE,uint16_t SPO2_GSEN_POW_THRE);\r
+void tyhx_spo2_para_barelychange(uint16_t MEAN_NUM,int32_t SOP2_DEGLITCH_THRE,int32_t SPO2_REMOVE_JUMP_THRE, \\r
+ uint16_t SPO2_LOW_CLIP_END_TIME,uint16_t SPO2_LOW_CLIP_DN,uint16_t SPO2_NORMAL_CLIP_DN, \\r
+ uint16_t IR_AC_TOUCH_THRE,uint16_t IR_FFT_POW_THRE,uint8_t SPO2_CALI,uint8_t SLOPE_PARA_MAX,uint8_t SLOPE_PARA_MIN);\r
+\r
+void tyhx_spo2_set_living(uint8_t living_mode, uint8_t qu_thre, uint8_t st_thre);\r
+void tyhx_spo2_set_mode(spo2_mode_t mode);\r
+bool tyhx_spo2_alg_send_data(int32_t *red_new_raw_data,int32_t *ir_new_raw_data,int32_t *green_new_raw_data,uint8_t R_LEDDAC,uint8_t IR_LEDDAC,uint8_t G_LEDDAC, int16_t *gsen_data_x, int16_t *gsen_data_y, int16_t *gsen_data_z, uint8_t dat_len);\r
+void tyhx_spo2_alg(int32_t red_new_raw_data , int32_t ir_new_raw_data, int32_t green_new_raw_data,uint8_t R_LEDDAC,uint8_t IR_LEDDAC,uint8_t G_LEDDAC);\r
+void tyhx_spo2_alg_close(void);\r
+bool tyhx_spo2_alg_open(void);\r
+bool tyhx_spo2_alg_open_deep(void);\r
+spo2_results_t tyhx_spo2_alg_get_results(void);\r
+spo2_debug_t tyhx_spo2_alg_debug_results(void);\r
+\r
+#endif \r
+\r
ext_errno ret;
- //tp_err("ztw523_register_handle*****************888888888");
+ //tp_err("ft6x46_register_handle*****************888888888");
g_ztw523_callback = func;
/* register int io interrupt handler */
uapi_gpio_init();
uapi_gpio_set_dir(ZTW523_INT_GPIO, GPIO_DIRECTION_INPUT);
ret = uapi_gpio_register_isr_func(ZTW523_INT_GPIO, GPIO_INTERRUPT_FALLING_EDGE, ztw523_gpio_isr_handle);
if (ret != 0) {
- tp_err("ztw523 int callback register fail! ret=0x%x", ret);
+ tp_err("ft6x46 int callback register fail! ret=0x%x", ret);
return ret;
}
ext_errno ret;
if (attr == NULL) {
- tp_err("ztw523 communication interface cfg is empty!");
+ tp_err("ft6x46 communication interface cfg is empty!");
return EXT_ERR_FAILURE;
}
ret = ztw523_ctrl_attr_check(attr);
ext_errno ztw523_host_init_sample(void)
{
ext_errno ret;
- PRINT("**********ztw523_host_init_sample**********\r\n");
+ PRINT("**********ft6x46_host_init_sample**********\r\n");
ret = ztw523_host_peripheral_init(&g_ctrl_attr);
ret = ztw523_init();
if (ret != EXT_ERR_SUCCESS) {
+++ /dev/null
-/*
- * Copyright (c) @CompanyNameMagicTag 2022-2023. All rights reserved.
- * Description: pm lp stub code
- */
-
-#include "chip_io.h"
-#include "platform.h"
-#include "flash.h"
-#include "hal_xip.h"
-#include "touch_screen_def.h"
-#include "lcd_bus.h"
-#include "pmu_ldo.h"
-#include "hal_pmu_ldo.h"
-#include "pm_control.h"
-#include "i2c_porting.h"
-#include "spi_porting.h"
-#include "uart_porting.h"
-#ifdef CFG_DRIVERS_MMC
-#include "soc_mmc.h"
-#endif
-#include "chip_io.h"
-
-#define UART_SUSPEND_REGS_NUM 8
-#define QSPI0_FLASH_D0_PIN 0xA3005000
-#define QSPI0_FLASH_D1_PIN 0xA3005004
-#define QSPI0_FLASH_D2_PIN 0xA3005008
-#define QSPI0_FLASH_D3_PIN 0xA300500C
-#define QSPI0_FLASH_CLK_PIN 0xA3005010
-#define QSPI0_FLASH_CS0_PIN 0xA3005014
-#define PIN_FUNC_QSPI0 0x1
-#define QSPI0_FLASH_D0_PAD 0x5700CE00
-#define QSPI0_FLASH_D1_PAD 0x5700CE04
-#define QSPI0_FLASH_D2_PAD 0x5700CE08
-#define QSPI0_FLASH_D3_PAD 0x5700CE0C
-#define QSPI0_FLASH_CLK_PAD 0x5700CE10
-#define QSPI0_FLASH_CS0_PAD 0x5700CE14
-#define PAD_IE_BIT 0x1
-#define PAD_PE_BIT 0x0
-#define PAD_PS_BIT 0X2
-#define OPI_PSRAM_CE_PAD 0x5700CE5c
-#define QSPI1_NANDFLASH_CS0_PAD 0x5700DA2C
-#define QSPI1_NANDFLASH_CS1_PAD 0x5700DA30
-#define PM_EMMC_CCLK_DIV_REG 0x52000100
-#define PM_SD_HOST_CCLK_DIV_REG 0x52000110
-#define RC_CLK_VALUE 49152000
-#define XO_CLK_VALUE 32000000
-#define XO_DLL2_CLK_VALUE 64000000
-#define PLL_CLK_VALUE 884736000
-#define PM_SDIOM_CLK_REG 0x55000628
-#define PM_EMMC_DIV_REG 0x52000120
-
-static uint32_t g_uart_h0_regs_tmp[UART_SUSPEND_REGS_NUM];
-static uint32_t g_uart_h1_regs_tmp[UART_SUSPEND_REGS_NUM];
-static bool g_display_pwr_on_for_pm = true;
-static uint8_t g_resume_touch_flag = 1;
-
-void set_touch_resume_flag(uint8_t flag)
-{
- g_resume_touch_flag = flag;
-}
-
-static void mem_retention_config(switch_type_t on)
-{
- if (on != 0) {
- // l2m_gmmu
- writel(0x57004040, 0);
-
- // l2m_dsp
- writel(0x57004050, 0);
-
- // com_mem
- reg16_clrbit(0x57004074, 0);
- // xip mem
- reg16_clrbit(0x57004900, 0);
- reg16_clrbit(0x57004900, 4);
- } else {
- // l2m_gmmu
- writel(0x57004040, 0xfff);
-
- // l2m_dsp
- writel(0x57004050, 0x3ff);
-
- // com_mem
- reg16_setbit(0x57004074, 0);
- // xip mem
- reg16_setbit(0x57004900, 0);
- reg16_setbit(0x57004900, 4);
- }
-}
-
-void pin_of_poweroff_suspend(void)
-{
- uint32_t base_addr = 0;
- // egpio
- for (base_addr = 0x5700ce00; base_addr <= 0x5700ce64; base_addr += 4) {
- reg16_clrbit(base_addr, 1);
- }
- // hgpio
- for (base_addr = 0x5700d200; base_addr <= 0x5700d23c; base_addr += 4) {
- reg16_clrbit(base_addr, 1);
- }
- // mgpio
- for (base_addr = 0x5700ca00; base_addr <= 0x5700ca98; base_addr += 4) {
- if (base_addr == 0x5700ca50 || base_addr == 0x5700ca88) {
- continue;
- }
- reg16_clrbit(base_addr, 1);
- }
-}
-
-void pin_of_poweroff_resume(void)
-{
- size_t pin_num;
- hal_pio_config_t *pio_func = NULL;
- get_pio_func_config(&pin_num, &pio_func);
-
- for (pin_t i = S_EGPIO0; i < S_MGPIO38; i++) {
- if (pio_func[i].ie != HAL_PIO_IE_MAX) {
- uapi_pin_set_ie(i, (pin_input_enable_t)pio_func[i].ie);
- }
- }
-}
-
-void pin_of_poweron_suspend(void)
-{
- uint32_t base_addr = 0;
- // agpio l
- for (base_addr = 0x5700c600; base_addr <= 0x5700c680; base_addr += 4) {
- if (base_addr == 0x5700c60c || base_addr == 0x5700c610 || base_addr == 0x5700c628) {
- continue;
- }
- reg16_clrbit(base_addr, 1);
- }
- // agpio r
- for (base_addr = 0x5700da00; base_addr <= 0x5700da28; base_addr += 4) {
- if (base_addr == 0x5700da14) { // S_AGPIO_R5 touch int
- continue;
- }
- reg16_clrbit(base_addr, 1);
- }
-
- // ulp gpio
- for (base_addr = 0x5702c200; base_addr <= 0x5702c210; base_addr += 4) {
- reg16_clrbit(base_addr, 1);
- }
-}
-
-static void clk_pll_en_tmp(void)
-{
- // pll_clk_en
- writew(0x57008020, 0x1);
- // select fbdiv_man
- writew(0x57008620, 0x1);
- // set pll fbdiv man
- writew(0x57008610, 0x37);
- // sel frac man
- writew(0x57008624, 0x1);
- // set PLL_FRAC_MAN_H
- writew(0x57008614, 0x4b);
- // set PLL_FRAC_MAN_L
- writew(0x57008618, 0xc6ab);
- // set POSTDIV
- writew(0x570082c4, 0xa);
- // pull pd
- writew(0x570082C8, 0x0);
- // readback lock stat: 0x1 is stable
- while (regw_getbits(0x57008000, 0x2d8, 0, 0x1) != 1) {
- };
-}
-
-void clk_switch_to_rc(void)
-{
- // disable GLB_CLKEN
- writew(0x55000608, 0x0);
-
- if (reg16_getbit(0x520003e0, 0x6) == 0x0) {
- // mcu ch1 to xo
- writew(0x55000610, 0x1);
- // mcu core switch to ch1
- reg16_setbit(0x520003e0, 0x6);
- // mcu ch0 to xo
- writew(0x5500060c, 0x1);
- } else {
- // mcu ch0 to xo
- writew(0x5500060c, 0x1);
- // mcu core switch to ch0
- reg16_clrbit(0x520003e0, 0x6);
- // mcu ch1 to xo
- writew(0x55000610, 0x1);
- }
-
- // set mcu_bus_div is no div
- writew(0x55000604, 0x0);
- writew(0x55000604, 0x3);
-
- // clk_mcu_perp_ls=clk_rc
- writew(0x55000614, 0x3);
- // clk_mcu_perp_uart=clk_rc
- writew(0x55000618, 0x3);
- // clk_mcu_perp_spi=clk_rc
- writew(0x5500061c, 0x1);
-
- if (reg16_getbit(0x55000af0, 0x0) == 0x1) {
- // set com bus ch0 to rc
- writew(0x55000620, 0x1);
- // com bus switch to ch0
- reg16_clrbit(0x55000af0, 0x0);
- // set com bus ch1 to rc
- writew(0x55000624, 0x1);
- } else {
- // set com bus ch1 to rc
- writew(0x55000624, 0x1);
- // com bus switch to ch1
- reg16_setbit(0x55000af0, 0x0);
- // set com bus ch0 to rc
- writew(0x55000620, 0x1);
- }
-
- // set clk_sdiom=clk_rc
- writew(0x55000628, 0x1);
- // clk_mem_bus=clk_rc
- writew(0x5500062C, 0x1);
- // clk_xip_opi=clk_rc
- writew(0x55000630, 0x1);
- // clk_xip_qspi=clk_rc
- writew(0x55000634, 0x1);
- // clk_gpu=clk_rc
- writew(0x55000638, 0x1);
-
- if (reg16_getbit(0x55000af0, 0x1) == 0x1) {
- // set hifi ch0 to rc
- writew(0x5500063c, 0x1);
- // hifi switch to ch0
- reg16_clrbit(0x55000af0, 0x1);
- // set com bus ch1 to rc
- writew(0x55000640, 0x1);
- } else {
- // set hifi bus ch1 to rc
- writew(0x55000640, 0x1);
- // hifi switch to ch1
- reg16_setbit(0x55000af0, 0x1);
- // set hifi bus ch0 to rc
- writew(0x5500063c, 0x1);
- }
-
- if (reg16_getbit(0x55000af0, 0x2) == 0x1) {
- // set codec ch0 to rc
- writew(0x55000644, 0x1);
- // codec switch to ch0
- reg16_clrbit(0x55000af0, 0x2);
- // set codec ch1 to rc
- writew(0x55000648, 0x1);
- } else {
- // set codec ch1 to rc
- writew(0x55000648, 0x1);
- // codec switch to ch1
- reg16_setbit(0x55000af0, 0x2);
- // set codec ch0 to rc
- writew(0x55000644, 0x1);
- }
-
- // enable GLB_CLKEN
- writew(0x55000608, 0x3ffe);
-}
-
-void clocks_switch_case_09v(void)
-{
- writew(0x55000608, 0x0); // close C_CRG(except clk_mcu_core)
- writew(0x55000604, 0x0); // mcu_bus div en = 0
- writew(0x55000604, 0x5); // mcu bus 2 分频 div_en=1
- if (reg16_getbit(0x520003e0, 0x6) == 0x0) {
- // mcu ch1 to xo
- writew(0x55000610, 0x97);
- // mcu core switch to ch1
- reg16_setbit(0x520003e0, 0x6);
- // mcu ch0 to xo
- writew(0x5500060c, 0x3);
- } else {
- // mcu ch0 to xo
- writew(0x5500060c, 0x97);
- // mcu core switch to ch0
- reg16_clrbit(0x520003e0, 0x6);
- // mcu ch1 to xo
- writew(0x55000610, 0x3);
- }
-
- writew(0x55000614, 0x3); // clk_mcu_perp_ls = clk_xo
- writew(0x5500061C, 0x97); // clk_mcu_perp_spi=clk_pll/11
- if (reg16_getbit(0x55000af0, 0x0) == 0x0) {
- // set combus ch1 to xo
- writew(0x55000624, 0xf7);
- // combus switch to ch1
- reg16_setbit(0x55000af0, 0x0);
- // set combus ch0 to xo
- writew(0x55000620, 0x3);
- } else {
- // set combus bus ch0 to xo
- writew(0x55000620, 0xf7);
- // combus switch to ch0
- reg16_clrbit(0x55000af0, 0x0);
- // set combus bus ch0 to xo
- writew(0x55000624, 0x3);
- }
- writew(0x55000628, 0x77); // clk_sdiom=clk_pll/3
- writew(0x5500062C, 0xB7); // clk_mem_bus=clk_pll/5
- writew(0x55000630, 0x77); // clk_xip_opi=clk_pll/3
- writew(0x55000634, 0x97); // clk_xip_qspi=clk_pll/4
- writew(0x55000638, 0xD7); // clk_gpu=clk_pll/6
- if (reg16_getbit(0x55000af0, 0x1) == 0x0) {
- // set hifi ch1 to xo
- writew(0x55000640, 0x77);
- // hifi switch to ch1
- reg16_setbit(0x55000af0, 0x1);
- // set hifi ch0 to xo
- writew(0x5500063c, 0x3);
- } else {
- // set hifi bus ch0 to xo
- writew(0x5500063c, 0x77);
- // hifi switch to ch0
- reg16_clrbit(0x55000af0, 0x1);
- // set hifi bus ch0 to xo
- writew(0x55000640, 0x3);
- }
- if (reg16_getbit(0x55000af0, 0x2) == 0x0) {
- // set codec ch1 to xo
- writew(0x55000648, 0x497);
- // codec switch to ch1
- reg16_setbit(0x55000af0, 0x2);
- // set codec ch0 to xo
- writew(0x55000644, 0x3);
- } else {
- // set codec bus ch0 to xo
- writew(0x55000644, 0x497);
- // codec switch to ch0
- reg16_clrbit(0x55000af0, 0x2);
- // set codec bus ch0 to xo
- writew(0x55000648, 0x3);
- }
- writew(0x55000608, 0x3FFE); // open C_CRG clock output
-}
-
-static void clock_gpu_hifi_to_xo_dll2(void)
-{
- // 动态调频,必须保证两路channel都必须有时钟,要不就出现挂死
- if (reg16_getbit(0x55000af0, 0x1) == 0x1) {
- // set hifi ch0 to xo
- writew(0x5500063c, 0x5);
- // hifi switch to ch0
- reg16_clrbit(0x55000af0, 0x1);
- // set hifi ch1 to xo
- writew(0x55000640, 0x5);
- } else {
- // set hifi bus ch1 to xo
- writew(0x55000640, 0x5);
- // hifi switch to ch1
- reg16_setbit(0x55000af0, 0x1);
- // set hifi bus ch0 to xo
- writew(0x5500063c, 0x5);
- }
-
- if (reg16_getbit(0x55000af0, 0x2) == 0x1) {
- // set codec ch0 to xo
- writew(0x55000644, 0x5);
- // codec switch to ch0
- reg16_clrbit(0x55000af0, 0x2);
- // set codec ch1 to xo
- writew(0x55000648, 0x5);
- } else {
- // set codec ch1 to xo
- writew(0x55000648, 0x5);
- // codec switch to ch1
- reg16_setbit(0x55000af0, 0x2);
- // set codec ch0 to xo
- writew(0x55000644, 0x5);
- }
-}
-
-void clk_switch_to_xo_dll2(void)
-{
- // disable GLB_CLKEN
- writew(0x55000608, 0x0);
- writew(0x520003f0, 0x1); // config to switch the channel of mcu
- if (reg16_getbit(0x520003e0, 0x6) == 0x0) {
- // mcu ch1 to xo
- writew(0x55000610, 0x5);
- // mcu core switch to ch1
- reg16_setbit(0x520003e0, 0x6);
- // mcu ch0 to xo
- writew(0x5500060c, 0x5);
- } else {
- // mcu ch0 to xo
- writew(0x5500060c, 0x5);
- // mcu core switch to ch0
- reg16_clrbit(0x520003e0, 0x6);
- // mcu ch1 to xo
- writew(0x55000610, 0x5);
- }
-
- // set mcu_bus_div is no div
- writew(0x55000604, 0x0);
- writew(0x55000604, 0x3);
-
- // clk_mcu_perp_ls=clk_xo_dll2
- writew(0x55000614, 0x3);
- // clk_mcu_perp_uart=clk_xo_dll2
- writew(0x55000618, 0x3);
- // clk_mcu_perp_spi=clk_xo_dll2
- writew(0x5500061c, 0x5);
-
- if (reg16_getbit(0x55000af0, 0x0) == 0x0) {
- // set com bus ch1 to xo(32M)
- writew(0x55000624, 0x5);
- // switch com bus ch1
- reg16_setbit(0x55000af0, 0x0);
- // set com bus ch0 to xo
- writew(0x55000620, 0x5);
- } else {
- // set com bus ch0 to xo(32M)
- writew(0x55000620, 0x5);
- // switch com bus ch1
- reg16_clrbit(0x55000af0, 0x0);
- // set com bus ch0 to xo
- writew(0x55000624, 0x5);
- }
-
- // set clk_sdiom=clk_xo 默认就是0
- writew(0x55000628, 0x5);
- // clk_mem_bus=clk_xo
- writew(0x5500062C, 0x5);
- // clk_xip_opi=clk_xo
- writew(0x55000630, 0x5);
- // clk_xip_qspi=clk_xo
- writew(0x55000634, 0x5);
- clock_gpu_hifi_to_xo_dll2();
- // enable GLB_CLKEN
- writew(0x55000608, 0x3ffe);
- // tcxo cnt enable, 是否睡眠自己掉电
- reg16_setbit(0x55000580, 2); // enable tcxo
-}
-
-void uart_h0_suspend_tmp(void)
-{
- uart_save_reg(UART_BUS_0);
-}
-
-void uart_h0_resume_tmp(void)
-{
- uart_recovery_reg(UART_BUS_0);
-}
-
-void uart_h1_suspend_tmp(void)
-{
- uart_save_reg(UART_BUS_1);
-}
-
-void uart_h1_resume_tmp(void)
-{
- uart_recovery_reg(UART_BUS_1);
-}
-
-void qspi0_suspend_tmp(void)
-{
- uapi_flash_exit_from_xip_mode(FLASH_1);
- hal_xip_set_cur_mode((xip_id_t)FLASH_1, XIP_MODE_DISABLE);
- spi_save_reg(SPI_BUS_3); // QSPI0 for norflash
- uapi_flash_switch_to_deeppower(FLASH_1);
- reg16_setbit(QSPI0_FLASH_CS0_PAD, PAD_PE_BIT);
- reg16_setbit(QSPI0_FLASH_CS0_PAD, PAD_PS_BIT); // make CS to high in deepsleep.
-}
-
-void qspi0_resume_tmp(void)
-{
- // qspi0 pinmux restore
- writew(QSPI0_FLASH_D0_PIN, PIN_FUNC_QSPI0);
- writew(QSPI0_FLASH_D1_PIN, PIN_FUNC_QSPI0);
- writew(QSPI0_FLASH_D2_PIN, PIN_FUNC_QSPI0);
- writew(QSPI0_FLASH_D3_PIN, PIN_FUNC_QSPI0);
- writew(QSPI0_FLASH_CLK_PIN, PIN_FUNC_QSPI0);
- writew(QSPI0_FLASH_CS0_PIN, PIN_FUNC_QSPI0);
- reg16_setbit(QSPI0_FLASH_D0_PAD, PAD_IE_BIT);
- reg16_setbit(QSPI0_FLASH_D1_PAD, PAD_IE_BIT);
- reg16_setbit(QSPI0_FLASH_D2_PAD, PAD_IE_BIT);
- reg16_setbit(QSPI0_FLASH_D3_PAD, PAD_IE_BIT);
- reg16_setbit(QSPI0_FLASH_CLK_PAD, PAD_IE_BIT);
- reg16_setbit(QSPI0_FLASH_CS0_PAD, PAD_IE_BIT);
- reg16_clrbit(QSPI0_FLASH_CS0_PAD, PAD_PS_BIT);
- reg16_clrbit(QSPI0_FLASH_CS0_PAD, PAD_PE_BIT); // make CS to pull none in normal.
-
- spi_recovery_reg(SPI_BUS_3); // QSPI0 for norflash
- uapi_flash_resume_from_deeppower(FLASH_1);
- uapi_flash_switch_to_cache_mode(0);
- if (readb(FLASH_START) != 0x6f) {
- PRINT("Enter XIP with value: 0x%x failed\r\n", readw(FLASH_START) == 0x6f);
- }
-}
-
-void storage_device_suspend(void)
-{
-#ifdef CFG_DRIVERS_NANDFLASH
- reg16_setbit(QSPI1_NANDFLASH_CS0_PAD, PAD_PS_BIT);
- reg16_setbit(QSPI1_NANDFLASH_CS0_PAD, PAD_PE_BIT); // make CS1 to high in deepsleep.
-#elif defined (CFG_DRIVERS_MMC)
- emmc_save_info();
-#endif
-}
-
-void storage_device_resume(void)
-{
-#ifdef CFG_DRIVERS_NANDFLASH
- nandflash_qspi_resume();
- reg16_clrbit(QSPI1_NANDFLASH_CS0_PAD, PAD_PS_BIT);
- reg16_clrbit(QSPI1_NANDFLASH_CS0_PAD, PAD_PE_BIT); // make CS1 to pull none in normal.
-#endif
-}
-
-void opi_psram_suspend_tmp(void)
-{
-#ifdef CONFIG_PSRAM_SUPPORT
- uapi_psram_exit_xip();
- uapi_psram_enter_sleep();
- spi_save_reg(SPI_BUS_6); // QSPI0 for norflash
- reg16_setbit(OPI_PSRAM_CE_PAD, PAD_PE_BIT);
- reg16_setbit(OPI_PSRAM_CE_PAD, PAD_PS_BIT); // make CS to high in deepsleep.
-#endif
-}
-
-void opi_psram_resume_tmp(void)
-{
-#ifdef CONFIG_PSRAM_SUPPORT
- spi_recovery_reg(SPI_BUS_6); // QSPI0 for norflash
- uapi_psram_exit_sleep();
- uapi_psram_enter_xip();
- reg16_clrbit(OPI_PSRAM_CE_PAD, PAD_PS_BIT);
- reg16_clrbit(OPI_PSRAM_CE_PAD, PAD_PE_BIT); // make CS to pull none in normal.
-#endif
-}
-
-void touch_suspend_tmp(void)
-{
- touch_peripheral_api *touch_ptr = touch_screen_get_api();
- ext_errno ret = touch_ptr->touch_sleep();
- if (ret != EXT_ERR_SUCCESS) { PRINT("touch sleep ret=0x%x", ret); }
- i2c_save_reg(I2C_BUS_1);
- uapi_gpio_disable_interrupt(S_AGPIO_R5); // close tp_int gpio interrupt
-}
-
-void touch_resume_tmp(void)
-{
- uapi_gpio_disable_interrupt(S_AGPIO_R5); // close tp_int gpio interrupt
- i2c_recovery_reg(I2C_BUS_1);
- writew(0x5700da14, 0x2); // open touch int ie(s_agpio_r5)
-#if defined(TPTYPE_TMA525B)
- tma525b_init();
- touch_peripheral_api *touch_ptr = (touch_peripheral_api*)touch_screen_get_api();
- ext_errno ret = touch_ptr->touch_resume();
- if (ret != EXT_ERR_SUCCESS) { PRINT("touch resume ret=0x%x", ret); }
-#elif defined(TPTYPE_ZTW523)
- ztw523_resume();
-#elif defined(TPTYPE_FT6X46)
- ztw523_init();
-#else
- ztw523_resume();
-#endif
- uapi_gpio_enable_interrupt(S_AGPIO_R5); // open tp_int gpio interrupt
-}
-
-void touch_suspend_for_i2c(void)
-{
- i2c_save_reg(I2C_BUS_1);
-}
-
-static void touch_resume_for_i2c(void)
-{
- i2c_recovery_reg(I2C_BUS_1);
- writew(0x5700da14, 0x2); // open touch int ie(s_agpio_r5)
-}
-
-void touch_restart(void)
-{
- uapi_i2c_deinit(I2C_BUS_1);
- uapi_i2c_master_init(I2C_BUS_1, 400000, 0); /* 400000: 400KHz */
- writew(0x5700da14, 0x2); // open touch int ie(s_agpio_r5)
-#if defined(TPTYPE_TMA525B)
- tma525b_resume();
-#elif defined(TPTYPE_ZTW523)
- ztw523_resume();
-#else
- ztw523_resume();
-#endif
- uapi_gpio_enable_interrupt(S_AGPIO_R5); // open tp_int gpio interrupt
-}
-
-void dsp_resume_tmp(void)
-{
- reg16_setbit(0x5700c634, 0x1);
- reg16_setbit(0x5700c638, 0x1);
- reg16_setbit(0x5700c63c, 0x1);
- reg16_setbit(0x5700c640, 0x1);
- reg16_setbit(0x5700c604, 0x1); // pdm amic ie enable
- reg16_setbit(0x5700c608, 0x1); // pdm dmic ie enable
-#if (defined BRANDY_PRODUCT_EVB4) // i2c pinmux config
- reg16_setbit(0x5700ca44, 0x1);
- reg16_setbit(0x5700ca48, 0x1);
-#else
- reg16_setbit(0x5700ca2c, 0x1);
- reg16_setbit(0x5700ca30, 0x1);
-#endif
- pmu1_dsp_l2ram_config(DSP_L2RAM_AREA_SIZE); // set l2ram for dsp
- reg16_setbit(0x52000020, 0x3); // enable dsp to mcu ipc int0&int1
-}
-
-void display_resume_power_on(void)
-{
- if (g_display_pwr_on_for_pm == false) {
- uapi_pm_control(PM_DISPLAY_POWER_UP_AND_RUN);
- g_display_pwr_on_for_pm = true;
- }
-}
-
-void display_suspend_power_off(void)
-{
- g_display_pwr_on_for_pm = false;
-}
-
-void display_suspend_tmp(void)
-{
- if (g_resume_touch_flag != 0) { touch_suspend_for_i2c(); }
- int ret = drv_vau_suspend(NULL);
- if (ret != 0) { PRINT("drv vau suspend ret =%d\n", ret); }
-#ifndef QSPI_DISPLAY
- ret = drv_dpu_suspend(NULL);
- if (ret != 0) { PRINT("drv dpu suspend ret =%d\n", ret); }
-#endif
-#ifdef SUPPORT_GPU_GMMU
- ret = drv_gmmu_suspend(NULL);
- if (ret != 0) { PRINT("drv_gmmu_suspend ret =%d\n", ret); }
-#endif
- lcd_bus_api *bus_api = lcd_get_bus_api();
- ret = bus_api->bus_suspend();
- if (ret != 0) { PRINT("bus suspend ret =%d\n", ret); }
-#ifndef QSPI_DISPLAY
- pmu_ldo_power_on(PMU_LDO_AUXLDO3, TURN_OFF);
- hal_pmu_auxldo_enable_high_resistance(HAL_PMU_AUXLDO3, TURN_ON);
-#endif
- writew(0x570000c0, 0); // display logic crg reset
- writew(0x57004034, 0x100); // display close power
-}
-
-void display_resume_tmp(void)
-{
-#ifndef QSPI_DISPLAY
- pmu_ldo_power_on(PMU_LDO_AUXLDO3, TURN_ON);
-#endif
- display_resume_power_on();
- writew(0x5700c658, 0x2); // sagpio_l22 open ie
- lcd_bus_api *bus_api = lcd_get_bus_api();
- int ret = bus_api->bus_resume();
- if (ret != 0) { PRINT("bus resume ret =%d\n", ret); }
-#ifndef QSPI_DISPLAY
- ret = drv_dpu_resume(NULL);
- if (ret != 0) { PRINT("drv dpu resume ret =%d\n", ret); }
-#endif
- ret = drv_vau_resume(NULL);
- if (ret != 0) { PRINT("drv vau resume ret =%d\n", ret); }
-#ifdef SUPPORT_GPU_GMMU
- ret = drv_gmmu_resume(NULL);
- if (ret != 0) { PRINT("drv_gmmu_resume ret =%d\n", ret); }
-#endif
- if (g_resume_touch_flag != 0) { touch_resume_for_i2c(); }
-}
-
-void pm_misc_regs_resume(void)
-{
-#ifdef CFG_DRIVERS_NANDFLASH
- reg16_clrbit(PM_SD_HOST_CCLK_DIV_REG, 0); // close sd host clock enable.
- reg16_clrbit(PM_EMMC_CCLK_DIV_REG, 0); // close sd mmc clock enable.
-#endif
-#ifdef CFG_DRIVERS_MMC
- reg16_clrbit(PM_SD_HOST_CCLK_DIV_REG, 0); // close sd host clock enable.
-#endif
-}
\ No newline at end of file