/* * Copyright (c) 2021 Linumiz * * SPDX-License-Identifier: Apache-2.0 */ #define DT_DRV_COMPAT hzgrow_r502a #include #include #include #include #include #include #include "grow_r502a.h" LOG_MODULE_DECLARE(GROW_R502A, CONFIG_SENSOR_LOG_LEVEL); static void setup_int(const struct device *dev, bool enable) { const struct grow_r502a_config *cfg = dev->config; gpio_flags_t flags = enable ? GPIO_INT_EDGE_TO_ACTIVE : GPIO_INT_DISABLE; gpio_pin_interrupt_configure_dt(&cfg->int_gpios, flags); } static void process_int(const struct device *dev) { struct grow_r502a_data *drv_data = dev->data; if (drv_data->th_handler != NULL) { drv_data->th_handler(dev, drv_data->th_trigger); } setup_int(dev, true); } int grow_r502a_trigger_set(const struct device *dev, const struct sensor_trigger *trig, sensor_trigger_handler_t handler) { struct grow_r502a_data *drv_data = dev->data; if ((enum sensor_trigger_type_grow_r502a)trig->type == SENSOR_TRIG_TOUCH) { drv_data->th_handler = handler; drv_data->th_trigger = trig; setup_int(dev, true); } else { LOG_ERR("Unsupported sensor trigger"); return -ENOTSUP; } return 0; } static void grow_r502a_gpio_callback(const struct device *dev, struct gpio_callback *cb, uint32_t pins) { struct grow_r502a_data *drv_data = CONTAINER_OF(cb, struct grow_r502a_data, gpio_cb); setup_int(drv_data->gpio_dev, false); #if defined(CONFIG_GROW_R502A_TRIGGER_OWN_THREAD) k_sem_give(&drv_data->gpio_sem); #elif defined(CONFIG_GROW_R502A_TRIGGER_GLOBAL_THREAD) k_work_submit(&drv_data->work); #endif } #if defined(CONFIG_GROW_R502A_TRIGGER_OWN_THREAD) static void grow_r502a_thread(struct grow_r502a_data *drv_data) { while (true) { k_sem_take(&drv_data->gpio_sem, K_FOREVER); process_int(drv_data->gpio_dev); } } #elif defined(CONFIG_GROW_R502A_TRIGGER_GLOBAL_THREAD) static void grow_r502a_work_cb(struct k_work *work) { struct grow_r502a_data *drv_data = CONTAINER_OF(work, struct grow_r502a_data, work); process_int(drv_data->gpio_dev); } #endif int grow_r502a_init_interrupt(const struct device *dev) { struct grow_r502a_data *drv_data = dev->data; const struct grow_r502a_config *cfg = dev->config; int rc; if (!gpio_is_ready_dt(&cfg->int_gpios)) { LOG_ERR("GPIO port %s not ready", cfg->int_gpios.port->name); return -ENODEV; } rc = gpio_pin_configure_dt(&cfg->int_gpios, GPIO_INPUT); if (rc < 0) { return rc; } drv_data->gpio_dev = dev; #if defined(CONFIG_GROW_R502A_TRIGGER_OWN_THREAD) k_sem_init(&drv_data->gpio_sem, 0, K_SEM_MAX_LIMIT); k_thread_create(&drv_data->thread, drv_data->thread_stack, CONFIG_GROW_R502A_THREAD_STACK_SIZE, (k_thread_entry_t)grow_r502a_thread, drv_data, NULL, NULL, K_PRIO_COOP(CONFIG_GROW_R502A_THREAD_PRIORITY), 0, K_NO_WAIT); #elif defined(CONFIG_GROW_R502A_TRIGGER_GLOBAL_THREAD) drv_data->work.handler = grow_r502a_work_cb; #endif gpio_init_callback(&drv_data->gpio_cb, grow_r502a_gpio_callback, BIT(cfg->int_gpios.pin)); rc = gpio_add_callback(cfg->int_gpios.port, &drv_data->gpio_cb); if (rc < 0) { LOG_ERR("Could not set gpio callback."); return rc; } return 0; }