展锐平台实现前后双光距感功能

#include "sensors.h" #include "sensors_i2c_operate.h" #include "ltr553_light_driver.h" #include "dual_light_interface.h" #include "sensor_driver_light_common.h" #include "sensor_manager.h" #include "error_type.h" #include "sensor_hub_ap_core.h" #include <stdint.h> #include "gpio_drvapi.h" static float sensitivity_coef = 1; static int8_t light_cali_cmd_flag = NON_CALI_CMD; static int8_t light_cali_status_flag = CALI_STATUS_NON; static const float LIGHT_CALI_MIN = 280; static const float LIGHT_CALI_MAX = 520; static const float LIGHT_CALI_STANDARD = 400; static const uint8_t LTR553_LIGHT_INIT_REG1 = 0x82; static const uint8_t LTR553_LIGHT_INIT_REG2 = 0x83; static const uint8_t LTR553_LIGHT_INIT_REG3 = 0x85; static const uint8_t LTR553_LIGHT_INIT_REG4 = 0x9E; static const uint8_t LTR553_LIGHT_INIT_VALUE1 = 0x7A; static const uint8_t LTR553_LIGHT_INIT_VALUE2 = 0x01; static const uint8_t LTR553_LIGHT_INIT_VALUE3 = 0x33; static const uint8_t LTR553_LIGHT_INIT_VALUE4 = 0x11; static const uint8_t LTR553_LIGHT_CONTR_REG = 0x80; static const uint8_t LTR553_LIGHT_ENABLE_VALUE = 0x0D; static const uint8_t LTR553_LIGHT_DISABLE_VALUE = 0x00; static const uint8_t LTR553_LIGHT_DATA_STATUS_REG = 0x8C; static const uint8_t LTR553_LIGHT_DATA_STATUS_VALUE = 0x04; static const uint8_t LTR553_LIGHT_RAW_CH1_REG_L = 0x88; static const uint8_t LTR553_LIGHT_RAW_CH1_REG_H = 0x89; static const uint8_t LTR553_LIGHT_RAW_CH0_REG_L = 0x8A; static const uint8_t LTR553_LIGHT_RAW_CH0_REG_H = 0x8B; static const uint8_t LTR553_LIGHT_DATA_RATE_REG = 0x85; static const uint8_t LTR553_LIGHT_DATA_RATE_10HZ = 0x01; static const uint8_t LTR553_LIGHT_CHECK_ID_REG = 0x86; static const uint8_t LTR553_LIGHT_CHECK_ID_DATA = 0x92; static int ltr553_sensor_check_id(); static int ltr553_sensor_hw_init(); static struct phy_light_interface *ltr553_sensor_init(); static int ltr553_sensor_set_cali_data(void *cali_data); static int ltr553_sensor_rate(int32_t sampling_period_us); static int ltr553_sensor_enable(); static int ltr553_sensor_disable(); static int ltr553_sensor_set_status(); static int ltr553_sensor_get_status(); static void ltr553_sensor_cali_cmd_handle(int cal_cmd, int cali_type, int golden_sample); static void ltr553_sensor_get_cali_data(); static int ltr553_sensor_read_data(struct sensor_data *sensor_data, uint64_t timestamp); static int ltr553_sensor_set_mode(int mode); static int ltr553_sensor_get_fifo_data(struct sensor_data *sensor_data); static int ltr553_sensor_flush(int sensor); static int ltr553_sensor_selftest(); sensor_info_t ltr553_light_info = { .name = "ltr553 light sensor", .vendor = "liteon", .version = 0, .sensor_type = DUAL_LIGHT_SECOND, .maxrange = 65535, .resolution = 1.0f, .power = 0.15f, .mindelay_us = 0, .fifo_reserved_event_count = 0, .fifo_max_event_count = 0, .maxdelay_us = 0, }; struct sensor_hw_info ltr553_light_hw_info_t = { .position = 0, .i2c_info = { .interface_freq = 400, .interface_num = 0, .slave_addr = 0x23, .reg_addr_len = 1 }, }; static struct phy_light_interface ltr553_sensor_interface = { .sensor_data = {0}, .sensor_driver_handle = DRV_PHY2_LIGHT, .enabled = 0, .sampling_period_us = 320000, .init = ltr553_sensor_init, .set_cali_data = ltr553_sensor_set_cali_data, .set_rate = ltr553_sensor_rate, .activate = ltr553_sensor_enable, .deactivate = ltr553_sensor_disable, .set_status = ltr553_sensor_set_status, .get_status = ltr553_sensor_get_status, .get_data = ltr553_sensor_read_data, .set_mode = ltr553_sensor_set_mode, .get_fifo_data = ltr553_sensor_get_fifo_data, .self_test = ltr553_sensor_selftest, .flush = ltr553_sensor_flush, .cali_cmd = ltr553_sensor_cali_cmd_handle, .get_cali_data = ltr553_sensor_get_cali_data, }; static float last_luxdata = -1.0f; static uint8_t enable_state; static uint8_t reject_frames_num; static int ltr553_sensor_check_id() { int ret = FAIL; uint8_t reg_addr = LTR553_LIGHT_CHECK_ID_REG, reg_data = LTR553_LIGHT_CHECK_ID_DATA; ret = sensor_i2c_check_reg_data(&ltr553_light_hw_info_t.i2c_info, &reg_addr, &reg_data, 0xff); if (ret != NO_ERROR) SENSORHUB_TRACE("light sensor check id failed!"); else SENSORHUB_TRACE("light sensor check id successed!"); return ret; } static int ltr553_sensor_hw_init() { int i, ret = FAIL; uint8_t reg_addr[4] = {LTR553_LIGHT_INIT_REG1, LTR553_LIGHT_INIT_REG2, LTR553_LIGHT_INIT_REG3, LTR553_LIGHT_INIT_REG4}; uint8_t reg_data[4] = {LTR553_LIGHT_INIT_VALUE1, LTR553_LIGHT_INIT_VALUE2, LTR553_LIGHT_INIT_VALUE3, LTR553_LIGHT_INIT_VALUE4}; for (i = 0; i < sizeof(reg_data); i++) { ret = sensors_i2c_reg_write(&ltr553_light_hw_info_t.i2c_info, &reg_addr[i], &reg_data[i], 1, 0xff); if (ret < 0) { SENSORHUB_TRACE("light init%d failed!", i); return FAIL; } } SENSORHUB_TRACE("init success!"); return NO_ERROR; } static struct phy_light_interface *ltr553_sensor_init() { int ret = FAIL; ret = sensor_property_parse(ltr553_light_info.name, &ltr553_light_hw_info_t); if (ret < NO_ERROR) SENSORHUB_TRACE("not match sensor name, config default property"); ret = ltr553_sensor_check_id(); if (ret < NO_ERROR) { SENSORHUB_TRACE_ERR("light check id error ret = %d!", ret); return 0; } ret = ltr553_sensor_hw_init(); if (ret < NO_ERROR) { SENSORHUB_TRACE_ERR("light hw init error ret = %d!", ret); return 0; } return &ltr553_sensor_interface; } static int ltr553_sensor_set_cali_data(void *cali_data) { int als_cali_data; memcpy(&als_cali_data, cali_data, sizeof(als_cali_data)); if (als_cali_data <= 0) { sensitivity_coef = 1; } else { sensitivity_coef = (float)als_cali_data / 10000.0f; } SENSORHUB_TRACE("cali_data = %d sensitivity_coef = %f\n", als_cali_data, sensitivity_coef); return NO_ERROR; } static int ltr553_sensor_rate(int32_t sampling_period_us) { int ret = FAIL; uint8_t reg_addr = LTR553_LIGHT_DATA_RATE_REG, temp_value = LTR553_LIGHT_DATA_RATE_10HZ; ret = sensors_i2c_reg_write(&ltr553_light_hw_info_t.i2c_info, &reg_addr, &temp_value, 1, 0xff); if (ret >= 0) ret = NO_ERROR; return ret; } static int ltr553_sensor_enable() { int ret = FAIL; uint8_t reg_addr = LTR553_LIGHT_CONTR_REG, temp_value = LTR553_LIGHT_ENABLE_VALUE; if (enable_state != 1) { ret = sensors_i2c_reg_write(&ltr553_light_hw_info_t.i2c_info, &reg_addr, &temp_value, 1, 0xff); if (ret >= 0) { enable_state = 1; ret = NO_ERROR; SENSORHUB_TRACE("light enable sensor successed!\n"); } else { SENSORHUB_TRACE_ERR("light enable sensor failed! error! ret=%d\n", ret); return ret; } } else { ret = NO_ERROR; SENSORHUB_TRACE("already enabled!"); } reject_frames_num = 0; return ret; } static int ltr553_sensor_disable() { int ret = FAIL; uint8_t reg_addr = LTR553_LIGHT_CONTR_REG, temp_value = LTR553_LIGHT_DISABLE_VALUE; if (enable_state != 0) { ret = sensors_i2c_reg_write(&ltr553_light_hw_info_t.i2c_info, &reg_addr, &temp_value, 1, 0xff); if (ret >= 0) { enable_state = 0; ret = NO_ERROR; SENSORHUB_TRACE("light disable sensor successed!\n"); } else { SENSORHUB_TRACE_ERR("light disable sensor failed! error! ret=%d\n", ret); return ret; } } else { ret = NO_ERROR; SENSORHUB_TRACE("already disabled!"); } last_luxdata = -1.0f; return ret; } static int ltr553_sensor_set_status() { return NO_ERROR; } static int ltr553_sensor_get_status() { uint8_t reg_addr = LTR553_LIGHT_DATA_STATUS_REG; uint8_t reg_data = LTR553_LIGHT_DATA_STATUS_VALUE; return share_ic_sensor_i2c_check_data_status(PROX_AND_LIGHT, &ltr553_light_hw_info_t.i2c_info, &reg_addr, &reg_data, 0x04); } static void ltr553_sensor_cali_cmd_handle(int cal_cmd, int cali_type, int golden_sample) { light_cali_cmd_flag = cal_cmd; if (light_cali_cmd_flag