| /* |
| * Copyright (c) 2016 Intel Corporation |
| * |
| * SPDX-License-Identifier: Apache-2.0 |
| */ |
| |
| #include <device.h> |
| #include <gpio.h> |
| #include <misc/util.h> |
| #include <kernel.h> |
| #include <sensor.h> |
| |
| #include "bmc150_magn.h" |
| |
| int bmc150_magn_trigger_set(struct device *dev, |
| const struct sensor_trigger *trig, |
| sensor_trigger_handler_t handler) |
| { |
| struct bmc150_magn_data *data = dev->driver_data; |
| const struct bmc150_magn_config * const config = |
| dev->config->config_info; |
| u8_t state; |
| |
| #if defined(CONFIG_BMC150_MAGN_TRIGGER_DRDY) |
| if (trig->type == SENSOR_TRIG_DATA_READY) { |
| gpio_pin_disable_callback(data->gpio_drdy, |
| config->gpio_drdy_int_pin); |
| |
| state = 0; |
| if (handler) { |
| state = 1; |
| } |
| |
| data->handler_drdy = handler; |
| data->trigger_drdy = *trig; |
| |
| if (i2c_reg_update_byte(data->i2c_master, |
| config->i2c_slave_addr, |
| BMC150_MAGN_REG_INT_DRDY, |
| BMC150_MAGN_MASK_DRDY_EN, |
| state << BMC150_MAGN_SHIFT_DRDY_EN) |
| < 0) { |
| SYS_LOG_DBG("failed to set DRDY interrupt"); |
| return -EIO; |
| } |
| |
| gpio_pin_enable_callback(data->gpio_drdy, |
| config->gpio_drdy_int_pin); |
| } |
| #endif |
| |
| return 0; |
| } |
| |
| static void bmc150_magn_gpio_drdy_callback(struct device *dev, |
| struct gpio_callback *cb, |
| u32_t pins) |
| { |
| struct bmc150_magn_data *data = |
| CONTAINER_OF(cb, struct bmc150_magn_data, gpio_cb); |
| const struct bmc150_magn_config * const config = |
| data->dev->config->config_info; |
| |
| ARG_UNUSED(pins); |
| |
| gpio_pin_disable_callback(dev, config->gpio_drdy_int_pin); |
| |
| k_sem_give(&data->sem); |
| } |
| |
| static void bmc150_magn_thread_main(void *arg1, void *arg2, void *arg3) |
| { |
| struct device *dev = (struct device *) arg1; |
| struct bmc150_magn_data *data = dev->driver_data; |
| const struct bmc150_magn_config *config = dev->config->config_info; |
| u8_t reg_val; |
| |
| int gpio_pin = config->gpio_drdy_int_pin; |
| |
| while (1) { |
| k_sem_take(&data->sem, K_FOREVER); |
| |
| while (i2c_reg_read_byte(data->i2c_master, |
| config->i2c_slave_addr, |
| BMC150_MAGN_REG_INT_STATUS, |
| ®_val) < 0) { |
| SYS_LOG_DBG("failed to clear data ready interrupt"); |
| } |
| |
| if (data->handler_drdy) { |
| data->handler_drdy(dev, &data->trigger_drdy); |
| } |
| |
| gpio_pin_enable_callback(data->gpio_drdy, gpio_pin); |
| } |
| } |
| |
| static int bmc150_magn_set_drdy_polarity(struct device *dev, int state) |
| { |
| struct bmc150_magn_data *data = dev->driver_data; |
| const struct bmc150_magn_config *config = dev->config->config_info; |
| |
| if (state) { |
| state = 1; |
| } |
| |
| return i2c_reg_update_byte(data->i2c_master, config->i2c_slave_addr, |
| BMC150_MAGN_REG_INT_DRDY, |
| BMC150_MAGN_MASK_DRDY_DR_POLARITY, |
| state << BMC150_MAGN_SHIFT_DRDY_DR_POLARITY); |
| } |
| |
| int bmc150_magn_init_interrupt(struct device *dev) |
| { |
| const struct bmc150_magn_config * const config = |
| dev->config->config_info; |
| struct bmc150_magn_data *data = dev->driver_data; |
| |
| |
| #if defined(CONFIG_BMC150_MAGN_TRIGGER_DRDY) |
| if (bmc150_magn_set_drdy_polarity(dev, 0) < 0) { |
| SYS_LOG_DBG("failed to set DR polarity"); |
| return -EIO; |
| } |
| |
| if (i2c_reg_update_byte(data->i2c_master, config->i2c_slave_addr, |
| BMC150_MAGN_REG_INT_DRDY, |
| BMC150_MAGN_MASK_DRDY_EN, |
| 0 << BMC150_MAGN_SHIFT_DRDY_EN) < 0) { |
| SYS_LOG_DBG("failed to set data ready interrupt enabled bit"); |
| return -EIO; |
| } |
| #endif |
| |
| data->handler_drdy = NULL; |
| |
| k_sem_init(&data->sem, 0, UINT_MAX); |
| |
| k_thread_create(&data->thread, data->thread_stack, |
| CONFIG_BMC150_MAGN_TRIGGER_THREAD_STACK, |
| bmc150_magn_thread_main, dev, NULL, NULL, |
| K_PRIO_COOP(10), 0, 0); |
| |
| data->gpio_drdy = device_get_binding(config->gpio_drdy_dev_name); |
| if (!data->gpio_drdy) { |
| SYS_LOG_DBG("gpio controller %s not found", |
| config->gpio_drdy_dev_name); |
| return -EINVAL; |
| } |
| |
| gpio_pin_configure(data->gpio_drdy, config->gpio_drdy_int_pin, |
| GPIO_DIR_IN | GPIO_INT | GPIO_INT_EDGE | |
| GPIO_INT_ACTIVE_LOW | GPIO_INT_DEBOUNCE); |
| |
| gpio_init_callback(&data->gpio_cb, |
| bmc150_magn_gpio_drdy_callback, |
| BIT(config->gpio_drdy_int_pin)); |
| |
| if (gpio_add_callback(data->gpio_drdy, &data->gpio_cb) < 0) { |
| SYS_LOG_DBG("failed to set gpio callback"); |
| return -EIO; |
| } |
| |
| data->dev = dev; |
| |
| return 0; |
| } |