/*
* Copyright (c) 2016 Freescale Semiconductor, Inc.
*
* SPDX-License-Identifier: Apache-2.0
*/
#include <fxos8700.h>
static void fxos8700_gpio_callback(struct device *dev,
struct gpio_callback *cb,
u32_t pin_mask)
{
struct fxos8700_data *data =
CONTAINER_OF(cb, struct fxos8700_data, gpio_cb);
if ((pin_mask & BIT(data->gpio_pin)) == 0) {
return;
}
gpio_pin_disable_callback(dev, data->gpio_pin);
#if defined(CONFIG_FXOS8700_TRIGGER_OWN_THREAD)
k_sem_give(&data->trig_sem);
#elif defined(CONFIG_FXOS8700_TRIGGER_GLOBAL_THREAD)
k_work_submit(&data->work);
#endif
}
static int fxos8700_handle_drdy_int(struct device *dev)
{
struct fxos8700_data *data = dev->driver_data;
struct sensor_trigger drdy_trig = {
.type = SENSOR_TRIG_DATA_READY,
.chan = SENSOR_CHAN_ALL,
};
if (data->drdy_handler) {
data->drdy_handler(dev, &drdy_trig);
}
return 0;
}
#ifdef CONFIG_FXOS8700_PULSE
static int fxos8700_handle_pulse_int(struct device *dev)
{
const struct fxos8700_config *config = dev->config->config_info;
struct fxos8700_data *data = dev->driver_data;
sensor_trigger_handler_t handler = NULL;
u8_t pulse_source;
struct sensor_trigger pulse_trig = {
.chan = SENSOR_CHAN_ALL,
};
k_sem_take(&data->sem, K_FOREVER);
if (i2c_reg_read_byte(data->i2c, config->i2c_address,
FXOS8700_REG_PULSE_SRC,
&pulse_source)) {
SYS_LOG_ERR("Could not read pulse source");
}
k_sem_give(&data->sem);
if (pulse_source & FXOS8700_PULSE_SRC_DPE) {
pulse_trig.type = SENSOR_TRIG_DOUBLE_TAP;
handler = data->double_tap_handler;
} else {
pulse_trig.type = SENSOR_TRIG_TAP;
handler = data->tap_handler;
}
if (handler) {
handler(dev, &pulse_trig);
}
return 0;
}
#endif
static void fxos8700_handle_int(void *arg)
{
struct device *dev = (struct device *)arg;
const struct fxos8700_config *config = dev->config->config_info;
struct fxos8700_data *data = dev->driver_data;
u8_t int_source;
k_sem_take(&data->sem, K_FOREVER);
if (i2c_reg_read_byte(data->i2c, config->i2c_address,
FXOS8700_REG_INT_SOURCE,
&int_source)) {
SYS_LOG_ERR("Could not read interrupt source");
int_source = 0;
}
k_sem_give(&data->sem);
if (int_source & FXOS8700_DRDY_MASK) {
fxos8700_handle_drdy_int(dev);
}
#ifdef CONFIG_FXOS8700_PULSE
if (int_source & FXOS8700_PULSE_MASK) {
fxos8700_handle_pulse_int(dev);
}
#endif
gpio_pin_enable_callback(data->gpio, config->gpio_pin);
}
#ifdef CONFIG_FXOS8700_TRIGGER_OWN_THREAD
static void fxos8700_thread_main(void *arg1, void *unused1, void *unused2)
{
struct device *dev = (struct device *)arg1;
struct fxos8700_data *data = dev->driver_data;
ARG_UNUSED(unused1);
ARG_UNUSED(unused2);
while (true) {
k_sem_take(&data->trig_sem, K_FOREVER);
fxos8700_handle_int(dev);
}
}
#endif
#ifdef CONFIG_FXOS8700_TRIGGER_GLOBAL_THREAD
static void fxos8700_work_handler(struct k_work *work)
{
struct fxos8700_data *data =
CONTAINER_OF(work, struct fxos8700_data, work);
fxos8700_handle_int(data->dev);
}
#endif
int fxos8700_trigger_set(struct device *dev,
const struct sensor_trigger *trig,
sensor_trigger_handler_t handler)
{
const struct fxos8700_config *config = dev->config->config_info;
struct fxos8700_data *data = dev->driver_data;
enum fxos8700_power power = FXOS8700_POWER_STANDBY;
u8_t mask;
int ret = 0;
k_sem_take(&data->sem, K_FOREVER);
switch (trig->type) {
case SENSOR_TRIG_DATA_READY:
mask = FXOS8700_DRDY_MASK;
data->drdy_handler = handler;
break;
#ifdef CONFIG_FXOS8700_PULSE
case SENSOR_TRIG_TAP:
mask = FXOS8700_PULSE_MASK;
data->tap_handler = handler;
break;
case SENSOR_TRIG_DOUBLE_TAP:
mask = FXOS8700_PULSE_MASK;
data->double_tap_handler = handler;
break;
#endif
default:
SYS_LOG_ERR("Unsupported sensor trigger");
ret = -ENOTSUP;
goto exit;
}
/* The sensor must be in standby mode when writing the configuration
* registers, therefore get the current power mode so we can restore it
* later.
*/
if (fxos8700_get_power(dev, &power)) {
SYS_LOG_ERR("Could not get power mode");
ret = -EIO;
goto exit;
}
/* Put the sensor in standby mode */
if (fxos8700_set_power(dev, FXOS8700_POWER_STANDBY)) {
SYS_LOG_ERR("Could not set standby mode");
ret = -EIO;
goto exit;
}
/* Configure the sensor interrupt */
if (i2c_reg_update_byte(data->i2c, config->i2c_address,
FXOS8700_REG_CTRLREG4,
mask,
handler ? mask : 0)) {
SYS_LOG_ERR("Could not configure interrupt");
ret = -EIO;
goto exit;
}
/* Restore the previous power mode */
if (fxos8700_set_power(dev, power)) {
SYS_LOG_ERR("Could not restore power mode");
ret = -EIO;
goto exit;
}
exit:
k_sem_give(&data->sem);
return ret;
}
#ifdef CONFIG_FXOS8700_PULSE
static int fxos8700_pulse_init(struct device *dev)
{
const struct fxos8700_config *config = dev->config->config_info;
struct fxos8700_data *data = dev->driver_data;
if (i2c_reg_write_byte(data->i2c, config->i2c_address,
FXOS8700_REG_PULSE_CFG, config->pulse_cfg)) {
return -EIO;
}
if (i2c_reg_write_byte(data->i2c, config->i2c_address,
FXOS8700_REG_PULSE_THSX, config->pulse_ths[0])) {
return -EIO;
}
if (i2c_reg_write_byte(data->i2c, config->i2c_address,
FXOS8700_REG_PULSE_THSY, config->pulse_ths[1])) {
return -EIO;
}
if (i2c_reg_write_byte(data->i2c, config->i2c_address,
FXOS8700_REG_PULSE_THSZ, config->pulse_ths[2])) {
return -EIO;
}
if (i2c_reg_write_byte(data->i2c, config->i2c_address,
FXOS8700_REG_PULSE_TMLT, config->pulse_tmlt)) {
return -EIO;
}
if (i2c_reg_write_byte(data->i2c, config->i2c_address,
FXOS8700_REG_PULSE_LTCY, config->pulse_ltcy)) {
return -EIO;
}
if (i2c_reg_write_byte(data->i2c, config->i2c_address,
FXOS8700_REG_PULSE_WIND, config->pulse_wind)) {
return -EIO;
}
return 0;
}
#endif
int fxos8700_trigger_init(struct device *dev)
{
const struct fxos8700_config *config = dev->config->config_info;
struct fxos8700_data *data = dev->driver_data;
u8_t ctrl_reg5;
#if defined(CONFIG_FXOS8700_TRIGGER_OWN_THREAD)
k_sem_init(&data->trig_sem, 0, UINT_MAX);
k_thread_create(&data->thread, data->thread_stack,
CONFIG_FXOS8700_THREAD_STACK_SIZE,
fxos8700_thread_main, dev, 0, NULL,
K_PRIO_COOP(CONFIG_FXOS8700_THREAD_PRIORITY), 0, 0);
#elif defined(CONFIG_FXOS8700_TRIGGER_GLOBAL_THREAD)
data->work.handler = fxos8700_work_handler;
data->dev = dev;
#endif
/* Route the interrupts to INT1/INT2 pins */
ctrl_reg5 = 0;
#if CONFIG_FXOS8700_DRDY_INT1
ctrl_reg5 |= FXOS8700_DRDY_MASK;
#endif
#if CONFIG_FXOS8700_PULSE_INT1
ctrl_reg5 |= FXOS8700_PULSE_MASK;
#endif
if (i2c_reg_write_byte(data->i2c, config->i2c_address,
FXOS8700_REG_CTRLREG5, ctrl_reg5)) {
SYS_LOG_ERR("Could not configure interrupt pin routing");
return -EIO;
}
#ifdef CONFIG_FXOS8700_PULSE
if (fxos8700_pulse_init(dev)) {
SYS_LOG_ERR("Could not configure pulse");
return -EIO;
}
#endif
/* Get the GPIO device */
data->gpio = device_get_binding(config->gpio_name);
if (data->gpio == NULL) {
SYS_LOG_ERR("Could not find GPIO device");
return -EINVAL;
}
data->gpio_pin = config->gpio_pin;
gpio_pin_configure(data->gpio, config->gpio_pin,
GPIO_DIR_IN | GPIO_INT | GPIO_INT_EDGE |
GPIO_INT_ACTIVE_LOW | GPIO_INT_DEBOUNCE);
gpio_init_callback(&data->gpio_cb, fxos8700_gpio_callback,
BIT(config->gpio_pin));
gpio_add_callback(data->gpio, &data->gpio_cb);
gpio_pin_enable_callback(data->gpio, config->gpio_pin);
return 0;
}