/* * Copyright (c) 2016 Intel Corporation * * SPDX-License-Identifier: Apache-2.0 */ #include #include #include #include #include #include #include "sx9500.h" #ifdef CONFIG_SX9500_TRIGGER_OWN_THREAD static K_THREAD_STACK_DEFINE(sx9500_thread_stack, CONFIG_SX9500_THREAD_STACK_SIZE); static struct k_thread sx9500_thread; #endif int sx9500_trigger_set(struct device *dev, const struct sensor_trigger *trig, sensor_trigger_handler_t handler) { struct sx9500_data *data = dev->driver_data; switch (trig->type) { case SENSOR_TRIG_DATA_READY: if (i2c_reg_update_byte(data->i2c_master, data->i2c_slave_addr, SX9500_REG_IRQ_MSK, SX9500_CONV_DONE_IRQ, SX9500_CONV_DONE_IRQ) < 0) { return -EIO; } data->handler_drdy = handler; data->trigger_drdy = *trig; break; case SENSOR_TRIG_NEAR_FAR: if (i2c_reg_update_byte(data->i2c_master, data->i2c_slave_addr, SX9500_REG_IRQ_MSK, SX9500_NEAR_FAR_IRQ, SX9500_NEAR_FAR_IRQ) < 0) { return -EIO; } data->handler_near_far = handler; data->trigger_near_far = *trig; break; default: return -EINVAL; } return 0; } #ifdef CONFIG_SX9500_TRIGGER_OWN_THREAD static void sx9500_gpio_cb(struct device *port, struct gpio_callback *cb, u32_t pins) { struct sx9500_data *data = CONTAINER_OF(cb, struct sx9500_data, gpio_cb); ARG_UNUSED(pins); k_sem_give(&data->sem); } static void sx9500_thread_main(int arg1, int unused) { struct device *dev = INT_TO_POINTER(arg1); struct sx9500_data *data = dev->driver_data; u8_t reg_val; ARG_UNUSED(unused); while (1) { k_sem_take(&data->sem, K_FOREVER); if (i2c_reg_read_byte(data->i2c_master, data->i2c_slave_addr, SX9500_REG_IRQ_SRC, ®_val) < 0) { SYS_LOG_DBG("sx9500: error reading IRQ source register"); continue; } if ((reg_val & SX9500_CONV_DONE_IRQ) && data->handler_drdy) { data->handler_drdy(dev, &data->trigger_drdy); } if ((reg_val & SX9500_NEAR_FAR_IRQ) && data->handler_near_far) { data->handler_near_far(dev, &data->trigger_near_far); } } } #else /* CONFIG_SX9500_TRIGGER_GLOBAL_THREAD */ static void sx9500_gpio_cb(struct device *port, struct gpio_callback *cb, u32_t pins) { struct sx9500_data *data = CONTAINER_OF(cb, struct sx9500_data, gpio_cb); ARG_UNUSED(pins); k_work_submit(&data->work); } static void sx9500_gpio_thread_cb(void *arg) { struct device *dev = arg; struct sx9500_data *data = dev->driver_data; u8_t reg_val; if (i2c_reg_read_byte(data->i2c_master, data->i2c_slave_addr, SX9500_REG_IRQ_SRC, ®_val) < 0) { SYS_LOG_DBG("sx9500: error reading IRQ source register"); return; } if ((reg_val & SX9500_CONV_DONE_IRQ) && data->handler_drdy) { data->handler_drdy(dev, &data->trigger_drdy); } if ((reg_val & SX9500_NEAR_FAR_IRQ) && data->handler_near_far) { data->handler_near_far(dev, &data->trigger_near_far); } } #endif /* CONFIG_SX9500_TRIGGER_GLOBAL_THREAD */ #ifdef CONFIG_SX9500_TRIGGER_GLOBAL_THREAD static void sx9500_work_cb(struct k_work *work) { struct sx9500_data *data = CONTAINER_OF(work, struct sx9500_data, work); sx9500_gpio_thread_cb(data->dev); } #endif int sx9500_setup_interrupt(struct device *dev) { struct sx9500_data *data = dev->driver_data; struct device *gpio; #ifdef CONFIG_SX9500_TRIGGER_OWN_THREAD k_sem_init(&data->sem, 0, UINT_MAX); #else data->work.handler = sx9500_work_cb; data->dev = dev; #endif gpio = device_get_binding(CONFIG_SX9500_GPIO_CONTROLLER); if (!gpio) { SYS_LOG_DBG("sx9500: gpio controller %s not found", CONFIG_SX9500_GPIO_CONTROLLER); return -EINVAL; } gpio_pin_configure(gpio, CONFIG_SX9500_GPIO_PIN, GPIO_DIR_IN | GPIO_INT | GPIO_INT_EDGE | GPIO_INT_ACTIVE_LOW | GPIO_INT_DEBOUNCE); gpio_init_callback(&data->gpio_cb, sx9500_gpio_cb, BIT(CONFIG_SX9500_GPIO_PIN)); gpio_add_callback(gpio, &data->gpio_cb); gpio_pin_enable_callback(gpio, CONFIG_SX9500_GPIO_PIN); #ifdef CONFIG_SX9500_TRIGGER_OWN_THREAD k_thread_create(&sx9500_thread, sx9500_thread_stack, CONFIG_SX9500_THREAD_STACK_SIZE, sx9500_thread_main, POINTER_TO_INT(dev), 0, NULL, K_PRIO_COOP(CONFIG_SX9500_THREAD_PRIORITY), 0, 0); #endif return 0; }