542 lines
13 KiB
C
542 lines
13 KiB
C
/*
|
|
* Copyright (c) 2017 Intel Corporation
|
|
* Copyright (c) 2018 Phytec Messtechnik GmbH
|
|
*
|
|
*SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
/* @file
|
|
* @brief driver for APDS9960 ALS/RGB/gesture/proximity sensor
|
|
*/
|
|
|
|
#include <device.h>
|
|
#include <drivers/sensor.h>
|
|
#include <drivers/i2c.h>
|
|
#include <sys/__assert.h>
|
|
#include <sys/byteorder.h>
|
|
#include <init.h>
|
|
#include <kernel.h>
|
|
#include <string.h>
|
|
#include <logging/log.h>
|
|
|
|
#include "apds9960.h"
|
|
|
|
#define LOG_LEVEL CONFIG_SENSOR_LOG_LEVEL
|
|
LOG_MODULE_REGISTER(APDS9960);
|
|
|
|
static void apds9960_gpio_callback(struct device *dev,
|
|
struct gpio_callback *cb, u32_t pins)
|
|
{
|
|
struct apds9960_data *drv_data =
|
|
CONTAINER_OF(cb, struct apds9960_data, gpio_cb);
|
|
|
|
gpio_pin_disable_callback(dev, drv_data->gpio_pin);
|
|
|
|
#ifdef CONFIG_APDS9960_TRIGGER
|
|
k_work_submit(&drv_data->work);
|
|
#else
|
|
k_sem_give(&drv_data->data_sem);
|
|
#endif
|
|
}
|
|
|
|
static int apds9960_sample_fetch(struct device *dev, enum sensor_channel chan)
|
|
{
|
|
const struct apds9960_config *config = dev->config->config_info;
|
|
struct apds9960_data *data = dev->driver_data;
|
|
u8_t tmp;
|
|
|
|
if (chan != SENSOR_CHAN_ALL) {
|
|
LOG_ERR("Unsupported sensor channel");
|
|
return -ENOTSUP;
|
|
}
|
|
|
|
#ifndef CONFIG_APDS9960_TRIGGER
|
|
gpio_pin_enable_callback(data->gpio, config->gpio_pin);
|
|
|
|
#ifdef CONFIG_APDS9960_ENABLE_ALS
|
|
tmp = APDS9960_ENABLE_PON | APDS9960_ENABLE_AIEN;
|
|
#else
|
|
tmp = APDS9960_ENABLE_PON | APDS9960_ENABLE_PIEN;
|
|
#endif
|
|
if (i2c_reg_update_byte(data->i2c, config->i2c_address,
|
|
APDS9960_ENABLE_REG, tmp, tmp)) {
|
|
LOG_ERR("Power on bit not set.");
|
|
return -EIO;
|
|
}
|
|
|
|
k_sem_take(&data->data_sem, K_FOREVER);
|
|
#endif
|
|
|
|
if (i2c_reg_read_byte(data->i2c, config->i2c_address,
|
|
APDS9960_STATUS_REG, &tmp)) {
|
|
return -EIO;
|
|
}
|
|
|
|
LOG_DBG("status: 0x%x", tmp);
|
|
if (tmp & APDS9960_STATUS_PINT) {
|
|
if (i2c_reg_read_byte(data->i2c, config->i2c_address,
|
|
APDS9960_PDATA_REG, &data->pdata)) {
|
|
return -EIO;
|
|
}
|
|
}
|
|
|
|
if (tmp & APDS9960_STATUS_AINT) {
|
|
if (i2c_burst_read(data->i2c, config->i2c_address,
|
|
APDS9960_CDATAL_REG,
|
|
(u8_t *)&data->sample_crgb,
|
|
sizeof(data->sample_crgb))) {
|
|
return -EIO;
|
|
}
|
|
|
|
}
|
|
|
|
#ifndef CONFIG_APDS9960_TRIGGER
|
|
if (i2c_reg_update_byte(data->i2c, config->i2c_address,
|
|
APDS9960_ENABLE_REG,
|
|
APDS9960_ENABLE_PON,
|
|
0)) {
|
|
return -EIO;
|
|
}
|
|
#endif
|
|
|
|
if (i2c_reg_write_byte(data->i2c, config->i2c_address,
|
|
APDS9960_AICLEAR_REG, 0)) {
|
|
return -EIO;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int apds9960_channel_get(struct device *dev,
|
|
enum sensor_channel chan,
|
|
struct sensor_value *val)
|
|
{
|
|
struct apds9960_data *data = dev->driver_data;
|
|
|
|
switch (chan) {
|
|
#ifdef CONFIG_APDS9960_ENABLE_ALS
|
|
case SENSOR_CHAN_LIGHT:
|
|
val->val1 = sys_le16_to_cpu(data->sample_crgb[0]);
|
|
val->val2 = 0;
|
|
break;
|
|
case SENSOR_CHAN_RED:
|
|
val->val1 = sys_le16_to_cpu(data->sample_crgb[1]);
|
|
val->val2 = 0;
|
|
break;
|
|
case SENSOR_CHAN_GREEN:
|
|
val->val1 = sys_le16_to_cpu(data->sample_crgb[2]);
|
|
val->val2 = 0;
|
|
break;
|
|
case SENSOR_CHAN_BLUE:
|
|
val->val1 = sys_le16_to_cpu(data->sample_crgb[3]);
|
|
val->val2 = 0;
|
|
break;
|
|
#endif
|
|
case SENSOR_CHAN_PROX:
|
|
val->val1 = data->pdata;
|
|
val->val2 = 0;
|
|
break;
|
|
default:
|
|
return -ENOTSUP;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int apds9960_proxy_setup(struct device *dev)
|
|
{
|
|
const struct apds9960_config *config = dev->config->config_info;
|
|
struct apds9960_data *data = dev->driver_data;
|
|
|
|
if (i2c_reg_write_byte(data->i2c, config->i2c_address,
|
|
APDS9960_POFFSET_UR_REG,
|
|
APDS9960_DEFAULT_POFFSET_UR)) {
|
|
LOG_ERR("Default offset UR not set ");
|
|
return -EIO;
|
|
}
|
|
|
|
if (i2c_reg_write_byte(data->i2c, config->i2c_address,
|
|
APDS9960_POFFSET_DL_REG,
|
|
APDS9960_DEFAULT_POFFSET_DL)) {
|
|
LOG_ERR("Default offset DL not set ");
|
|
return -EIO;
|
|
}
|
|
|
|
if (i2c_reg_write_byte(data->i2c, config->i2c_address,
|
|
APDS9960_PPULSE_REG,
|
|
config->ppcount)) {
|
|
LOG_ERR("Default pulse count not set ");
|
|
return -EIO;
|
|
}
|
|
|
|
if (i2c_reg_update_byte(data->i2c, config->i2c_address,
|
|
APDS9960_CONTROL_REG,
|
|
APDS9960_CONTROL_LDRIVE,
|
|
APDS9960_DEFAULT_LDRIVE)) {
|
|
LOG_ERR("LED Drive Strength not set");
|
|
return -EIO;
|
|
}
|
|
|
|
if (i2c_reg_update_byte(data->i2c, config->i2c_address,
|
|
APDS9960_CONFIG2_REG,
|
|
APDS9960_PLED_BOOST_300,
|
|
config->pled_boost)) {
|
|
LOG_ERR("LED Drive Strength not set");
|
|
return -EIO;
|
|
}
|
|
|
|
if (i2c_reg_update_byte(data->i2c, config->i2c_address,
|
|
APDS9960_CONTROL_REG, APDS9960_CONTROL_PGAIN,
|
|
(config->pgain & APDS9960_PGAIN_8X))) {
|
|
LOG_ERR("Gain is not set");
|
|
return -EIO;
|
|
}
|
|
|
|
if (i2c_reg_write_byte(data->i2c, config->i2c_address,
|
|
APDS9960_PILT_REG, APDS9960_DEFAULT_PILT)) {
|
|
LOG_ERR("Low threshold not set");
|
|
return -EIO;
|
|
}
|
|
|
|
if (i2c_reg_write_byte(data->i2c, config->i2c_address,
|
|
APDS9960_PIHT_REG, APDS9960_DEFAULT_PIHT)) {
|
|
LOG_ERR("High threshold not set");
|
|
return -EIO;
|
|
}
|
|
|
|
if (i2c_reg_update_byte(data->i2c, config->i2c_address,
|
|
APDS9960_ENABLE_REG, APDS9960_ENABLE_PEN,
|
|
APDS9960_ENABLE_PEN)) {
|
|
LOG_ERR("Proximity mode is not enabled");
|
|
return -EIO;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_APDS9960_ENABLE_ALS
|
|
static int apds9960_ambient_setup(struct device *dev)
|
|
{
|
|
const struct apds9960_config *config = dev->config->config_info;
|
|
struct apds9960_data *data = dev->driver_data;
|
|
u16_t th;
|
|
|
|
/* ADC value */
|
|
if (i2c_reg_write_byte(data->i2c, config->i2c_address,
|
|
APDS9960_ATIME_REG, APDS9960_DEFAULT_ATIME)) {
|
|
LOG_ERR("Default integration time not set for ADC");
|
|
return -EIO;
|
|
}
|
|
|
|
/* ALS Gain */
|
|
if (i2c_reg_update_byte(data->i2c, config->i2c_address,
|
|
APDS9960_CONTROL_REG,
|
|
APDS9960_CONTROL_AGAIN,
|
|
(config->again & APDS9960_AGAIN_64X))) {
|
|
LOG_ERR("Ambient Gain is not set");
|
|
return -EIO;
|
|
}
|
|
|
|
th = sys_cpu_to_le16(APDS9960_DEFAULT_AILT);
|
|
if (i2c_burst_write(data->i2c, config->i2c_address,
|
|
APDS9960_INT_AILTL_REG,
|
|
(u8_t *)&th, sizeof(th))) {
|
|
LOG_ERR("ALS low threshold not set");
|
|
return -EIO;
|
|
}
|
|
|
|
th = sys_cpu_to_le16(APDS9960_DEFAULT_AIHT);
|
|
if (i2c_burst_write(data->i2c, config->i2c_address,
|
|
APDS9960_INT_AIHTL_REG,
|
|
(u8_t *)&th, sizeof(th))) {
|
|
LOG_ERR("ALS low threshold not set");
|
|
return -EIO;
|
|
}
|
|
|
|
/* Enable ALS */
|
|
if (i2c_reg_update_byte(data->i2c, config->i2c_address,
|
|
APDS9960_ENABLE_REG, APDS9960_ENABLE_AEN,
|
|
APDS9960_ENABLE_AEN)) {
|
|
LOG_ERR("ALS is not enabled");
|
|
return -EIO;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
#endif
|
|
|
|
static int apds9960_sensor_setup(struct device *dev)
|
|
{
|
|
const struct apds9960_config *config = dev->config->config_info;
|
|
struct apds9960_data *data = dev->driver_data;
|
|
u8_t chip_id;
|
|
|
|
if (i2c_reg_read_byte(data->i2c, config->i2c_address,
|
|
APDS9960_ID_REG, &chip_id)) {
|
|
LOG_ERR("Failed reading chip id");
|
|
return -EIO;
|
|
}
|
|
|
|
if (!((chip_id == APDS9960_ID_1) || (chip_id == APDS9960_ID_2))) {
|
|
LOG_ERR("Invalid chip id 0x%x", chip_id);
|
|
return -EIO;
|
|
}
|
|
|
|
/* Disable all functions and interrupts */
|
|
if (i2c_reg_write_byte(data->i2c, config->i2c_address,
|
|
APDS9960_ENABLE_REG, 0)) {
|
|
LOG_ERR("ENABLE register is not cleared");
|
|
return -EIO;
|
|
}
|
|
|
|
if (i2c_reg_write_byte(data->i2c, config->i2c_address,
|
|
APDS9960_AICLEAR_REG, 0)) {
|
|
return -EIO;
|
|
}
|
|
|
|
/* Disable gesture interrupt */
|
|
if (i2c_reg_write_byte(data->i2c, config->i2c_address,
|
|
APDS9960_GCONFIG4_REG, 0)) {
|
|
LOG_ERR("GCONFIG4 register is not cleared");
|
|
return -EIO;
|
|
}
|
|
|
|
if (i2c_reg_write_byte(data->i2c, config->i2c_address,
|
|
APDS9960_WTIME_REG, APDS9960_DEFAULT_WTIME)) {
|
|
LOG_ERR("Default wait time not set");
|
|
return -EIO;
|
|
}
|
|
|
|
if (i2c_reg_write_byte(data->i2c, config->i2c_address,
|
|
APDS9960_CONFIG1_REG,
|
|
APDS9960_DEFAULT_CONFIG1)) {
|
|
LOG_ERR("Default WLONG not set");
|
|
return -EIO;
|
|
}
|
|
|
|
if (i2c_reg_write_byte(data->i2c, config->i2c_address,
|
|
APDS9960_CONFIG2_REG,
|
|
APDS9960_DEFAULT_CONFIG2)) {
|
|
LOG_ERR("Configuration Register Two not set");
|
|
return -EIO;
|
|
}
|
|
|
|
if (i2c_reg_write_byte(data->i2c, config->i2c_address,
|
|
APDS9960_CONFIG3_REG,
|
|
APDS9960_DEFAULT_CONFIG3)) {
|
|
LOG_ERR("Configuration Register Three not set");
|
|
return -EIO;
|
|
}
|
|
|
|
if (i2c_reg_write_byte(data->i2c, config->i2c_address,
|
|
APDS9960_PERS_REG,
|
|
APDS9960_DEFAULT_PERS)) {
|
|
LOG_ERR("Interrupt persistence not set");
|
|
return -EIO;
|
|
}
|
|
|
|
if (apds9960_proxy_setup(dev)) {
|
|
LOG_ERR("Failed to setup proximity functionality");
|
|
return -EIO;
|
|
}
|
|
|
|
#ifdef CONFIG_APDS9960_ENABLE_ALS
|
|
if (apds9960_ambient_setup(dev)) {
|
|
LOG_ERR("Failed to setup ambient light functionality");
|
|
return -EIO;
|
|
}
|
|
#endif
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int apds9960_init_interrupt(struct device *dev)
|
|
{
|
|
const struct apds9960_config *config = dev->config->config_info;
|
|
struct apds9960_data *drv_data = dev->driver_data;
|
|
|
|
/* setup gpio interrupt */
|
|
drv_data->gpio = device_get_binding(config->gpio_name);
|
|
if (drv_data->gpio == NULL) {
|
|
LOG_ERR("Failed to get pointer to %s device!",
|
|
config->gpio_name);
|
|
return -EINVAL;
|
|
}
|
|
|
|
drv_data->gpio_pin = config->gpio_pin;
|
|
|
|
gpio_pin_configure(drv_data->gpio, config->gpio_pin,
|
|
GPIO_DIR_IN | GPIO_INT | GPIO_INT_EDGE |
|
|
GPIO_INT_ACTIVE_LOW | GPIO_INT_DEBOUNCE |
|
|
GPIO_PUD_PULL_UP);
|
|
|
|
gpio_init_callback(&drv_data->gpio_cb,
|
|
apds9960_gpio_callback,
|
|
BIT(config->gpio_pin));
|
|
|
|
if (gpio_add_callback(drv_data->gpio, &drv_data->gpio_cb) < 0) {
|
|
LOG_DBG("Failed to set gpio callback!");
|
|
return -EIO;
|
|
}
|
|
|
|
#ifdef CONFIG_APDS9960_TRIGGER
|
|
drv_data->work.handler = apds9960_work_cb;
|
|
drv_data->dev = dev;
|
|
if (i2c_reg_update_byte(drv_data->i2c, config->i2c_address,
|
|
APDS9960_ENABLE_REG,
|
|
APDS9960_ENABLE_PON,
|
|
APDS9960_ENABLE_PON)) {
|
|
LOG_ERR("Power on bit not set.");
|
|
return -EIO;
|
|
}
|
|
|
|
#else
|
|
k_sem_init(&drv_data->data_sem, 0, UINT_MAX);
|
|
#endif
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_DEVICE_POWER_MANAGEMENT
|
|
static int apds9960_device_ctrl(struct device *dev, u32_t ctrl_command,
|
|
void *context, device_pm_cb cb, void *arg)
|
|
{
|
|
const struct apds9960_config *config = dev->config->config_info;
|
|
struct apds9960_data *data = dev->driver_data;
|
|
int ret = 0;
|
|
|
|
if (ctrl_command == DEVICE_PM_SET_POWER_STATE) {
|
|
u32_t device_pm_state = *(u32_t *)context;
|
|
|
|
if (device_pm_state == DEVICE_PM_ACTIVE_STATE) {
|
|
if (i2c_reg_update_byte(data->i2c, config->i2c_address,
|
|
APDS9960_ENABLE_REG,
|
|
APDS9960_ENABLE_PON,
|
|
APDS9960_ENABLE_PON)) {
|
|
ret = -EIO;
|
|
}
|
|
|
|
} else {
|
|
|
|
if (i2c_reg_update_byte(data->i2c, config->i2c_address,
|
|
APDS9960_ENABLE_REG,
|
|
APDS9960_ENABLE_PON, 0)) {
|
|
ret = -EIO;
|
|
}
|
|
|
|
if (i2c_reg_write_byte(data->i2c, config->i2c_address,
|
|
APDS9960_AICLEAR_REG, 0)) {
|
|
ret = -EIO;
|
|
}
|
|
}
|
|
|
|
} else if (ctrl_command == DEVICE_PM_GET_POWER_STATE) {
|
|
*((u32_t *)context) = DEVICE_PM_ACTIVE_STATE;
|
|
}
|
|
|
|
if (cb) {
|
|
cb(dev, ret, context, arg);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
#endif
|
|
|
|
static int apds9960_init(struct device *dev)
|
|
{
|
|
const struct apds9960_config *config = dev->config->config_info;
|
|
struct apds9960_data *data = dev->driver_data;
|
|
|
|
/* Initialize time 5.7ms */
|
|
k_sleep(6);
|
|
data->i2c = device_get_binding(config->i2c_name);
|
|
|
|
if (data->i2c == NULL) {
|
|
LOG_ERR("Failed to get pointer to %s device!",
|
|
config->i2c_name);
|
|
return -EINVAL;
|
|
}
|
|
|
|
(void)memset(data->sample_crgb, 0, sizeof(data->sample_crgb));
|
|
data->pdata = 0U;
|
|
|
|
if (apds9960_sensor_setup(dev) < 0) {
|
|
LOG_ERR("Failed to setup device!");
|
|
return -EIO;
|
|
}
|
|
|
|
if (apds9960_init_interrupt(dev) < 0) {
|
|
LOG_ERR("Failed to initialize interrupt!");
|
|
return -EIO;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct sensor_driver_api apds9960_driver_api = {
|
|
.sample_fetch = &apds9960_sample_fetch,
|
|
.channel_get = &apds9960_channel_get,
|
|
#ifdef CONFIG_APDS9960_TRIGGER
|
|
.attr_set = apds9960_attr_set,
|
|
.trigger_set = apds9960_trigger_set,
|
|
#endif
|
|
};
|
|
|
|
static const struct apds9960_config apds9960_config = {
|
|
.i2c_name = DT_INST_0_AVAGO_APDS9960_BUS_NAME,
|
|
.i2c_address = DT_INST_0_AVAGO_APDS9960_BASE_ADDRESS,
|
|
.gpio_name = DT_INST_0_AVAGO_APDS9960_INT_GPIOS_CONTROLLER,
|
|
.gpio_pin = DT_INST_0_AVAGO_APDS9960_INT_GPIOS_PIN,
|
|
#if CONFIG_APDS9960_PGAIN_8X
|
|
.pgain = APDS9960_PGAIN_8X,
|
|
#elif CONFIG_APDS9960_PGAIN_4X
|
|
.pgain = APDS9960_PGAIN_4X,
|
|
#elif CONFIG_APDS9960_PGAIN_2X
|
|
.pgain = APDS9960_PGAIN_2X,
|
|
#else
|
|
.pgain = APDS9960_PGAIN_1X,
|
|
#endif
|
|
#if CONFIG_APDS9960_AGAIN_64X
|
|
.again = APDS9960_AGAIN_64X,
|
|
#elif CONFIG_APDS9960_AGAIN_16X
|
|
.again = APDS9960_AGAIN_16X,
|
|
#elif CONFIG_APDS9960_AGAIN_4X
|
|
.again = APDS9960_AGAIN_4X,
|
|
#else
|
|
.again = APDS9960_AGAIN_1X,
|
|
#endif
|
|
#if CONFIG_APDS9960_PPULSE_LENGTH_32US
|
|
.ppcount = APDS9960_PPULSE_LENGTH_32US |
|
|
(CONFIG_APDS9960_PPULSE_COUNT - 1),
|
|
#elif CONFIG_APDS9960_PPULSE_LENGTH_16US
|
|
.ppcount = APDS9960_PPULSE_LENGTH_16US |
|
|
(CONFIG_APDS9960_PPULSE_COUNT - 1),
|
|
#elif CONFIG_APDS9960_PPULSE_LENGTH_8US
|
|
.ppcount = APDS9960_PPULSE_LENGTH_8US |
|
|
(CONFIG_APDS9960_PPULSE_COUNT - 1),
|
|
#else
|
|
.ppcount = APDS9960_PPULSE_LENGTH_4US |
|
|
(CONFIG_APDS9960_PPULSE_COUNT - 1),
|
|
#endif
|
|
#if CONFIG_APDS9960_PLED_BOOST_300PCT
|
|
.pled_boost = APDS9960_PLED_BOOST_300,
|
|
#elif CONFIG_APDS9960_PLED_BOOST_200PCT
|
|
.pled_boost = APDS9960_PLED_BOOST_200,
|
|
#elif CONFIG_APDS9960_PLED_BOOST_150PCT
|
|
.pled_boost = APDS9960_PLED_BOOST_150,
|
|
#else
|
|
.pled_boost = APDS9960_PLED_BOOST_100,
|
|
#endif
|
|
};
|
|
|
|
static struct apds9960_data apds9960_data;
|
|
|
|
#ifndef CONFIG_DEVICE_POWER_MANAGEMENT
|
|
DEVICE_AND_API_INIT(apds9960, DT_INST_0_AVAGO_APDS9960_LABEL, &apds9960_init,
|
|
&apds9960_data, &apds9960_config, POST_KERNEL,
|
|
CONFIG_SENSOR_INIT_PRIORITY, &apds9960_driver_api);
|
|
#else
|
|
DEVICE_DEFINE(apds9960, DT_INST_0_AVAGO_APDS9960_LABEL, apds9960_init,
|
|
apds9960_device_ctrl, &apds9960_data, &apds9960_config,
|
|
POST_KERNEL, CONFIG_SENSOR_INIT_PRIORITY, &apds9960_driver_api);
|
|
#endif
|