1 /*
2 * Copyright (c) 2020 arithmetics.io
3 *
4 * SPDX-License-Identifier: Apache-2.0
5 */
6
7 #define DT_DRV_COMPAT ti_fdc2x1x
8
9 #include <zephyr/device.h>
10 #include <zephyr/drivers/gpio.h>
11 #include <zephyr/sys/util.h>
12 #include <zephyr/kernel.h>
13 #include <zephyr/drivers/sensor.h>
14 #include "fdc2x1x.h"
15
16 #include <stdio.h>
17
18 #include <zephyr/logging/log.h>
19 LOG_MODULE_DECLARE(FDC2X1X, CONFIG_SENSOR_LOG_LEVEL);
20
fdc2x1x_thread_cb(const struct device * dev)21 static void fdc2x1x_thread_cb(const struct device *dev)
22 {
23 struct fdc2x1x_data *drv_data = dev->data;
24 uint16_t status;
25
26 /* Clear the status */
27 if (fdc2x1x_get_status(dev, &status) < 0) {
28 LOG_ERR("Unable to get status.");
29 return;
30 }
31
32 k_mutex_lock(&drv_data->trigger_mutex, K_FOREVER);
33 if ((drv_data->drdy_handler != NULL) && FDC2X1X_STATUS_DRDY(status)) {
34 drv_data->drdy_handler(dev, drv_data->drdy_trigger);
35 }
36 k_mutex_unlock(&drv_data->trigger_mutex);
37 }
38
fdc2x1x_gpio_callback(const struct device * dev,struct gpio_callback * cb,uint32_t pins)39 static void fdc2x1x_gpio_callback(const struct device *dev,
40 struct gpio_callback *cb, uint32_t pins)
41 {
42 struct fdc2x1x_data *drv_data =
43 CONTAINER_OF(cb, struct fdc2x1x_data, gpio_cb);
44
45 #ifdef CONFIG_FDC2X1X_TRIGGER_OWN_THREAD
46 k_sem_give(&drv_data->gpio_sem);
47 #elif CONFIG_FDC2X1X_TRIGGER_GLOBAL_THREAD
48 k_work_submit(&drv_data->work);
49 #endif
50 }
51
52 #ifdef CONFIG_FDC2X1X_TRIGGER_OWN_THREAD
fdc2x1x_thread(void * p1,void * p2,void * p3)53 static void fdc2x1x_thread(void *p1, void *p2, void *p3)
54 {
55 ARG_UNUSED(p2);
56 ARG_UNUSED(p3);
57
58 struct fdc2x1x_data *drv_data = p1;
59
60 while (true) {
61 k_sem_take(&drv_data->gpio_sem, K_FOREVER);
62 fdc2x1x_thread_cb(drv_data->dev);
63 }
64 }
65
66 #elif CONFIG_FDC2X1X_TRIGGER_GLOBAL_THREAD
fdc2x1x_work_cb(struct k_work * work)67 static void fdc2x1x_work_cb(struct k_work *work)
68 {
69 struct fdc2x1x_data *drv_data =
70 CONTAINER_OF(work, struct fdc2x1x_data, work);
71
72 fdc2x1x_thread_cb(drv_data->dev);
73 }
74 #endif
75
fdc2x1x_trigger_set(const struct device * dev,const struct sensor_trigger * trig,sensor_trigger_handler_t handler)76 int fdc2x1x_trigger_set(const struct device *dev,
77 const struct sensor_trigger *trig,
78 sensor_trigger_handler_t handler)
79 {
80 struct fdc2x1x_data *drv_data = dev->data;
81 const struct fdc2x1x_config *cfg = dev->config;
82 uint16_t status, int_mask, int_en;
83 int ret;
84
85 gpio_pin_interrupt_configure_dt(&cfg->intb_gpio, GPIO_INT_DISABLE);
86
87 switch (trig->type) {
88 case SENSOR_TRIG_DATA_READY:
89 k_mutex_lock(&drv_data->trigger_mutex, K_FOREVER);
90 drv_data->drdy_handler = handler;
91 drv_data->drdy_trigger = trig;
92 k_mutex_unlock(&drv_data->trigger_mutex);
93
94 int_mask = FDC2X1X_ERROR_CONFIG_DRDY_2INT_MSK;
95 break;
96 default:
97 LOG_ERR("Unsupported sensor trigger");
98 ret = -ENOTSUP;
99 goto out;
100 }
101
102 if (handler) {
103 int_en = int_mask;
104 drv_data->int_config |= int_mask;
105 } else {
106 int_en = 0U;
107 }
108
109 ret = fdc2x1x_reg_write_mask(dev,
110 FDC2X1X_ERROR_CONFIG, int_mask, int_en);
111
112 /* Clear INTB pin by reading STATUS register */
113 fdc2x1x_get_status(dev, &status);
114 out:
115 gpio_pin_interrupt_configure_dt(&cfg->intb_gpio, GPIO_INT_EDGE_TO_ACTIVE);
116
117 return ret;
118 }
119
fdc2x1x_init_interrupt(const struct device * dev)120 int fdc2x1x_init_interrupt(const struct device *dev)
121 {
122 struct fdc2x1x_data *drv_data = dev->data;
123 const struct fdc2x1x_config *cfg = dev->config;
124 int ret;
125
126 k_mutex_init(&drv_data->trigger_mutex);
127
128 if (!gpio_is_ready_dt(&cfg->intb_gpio)) {
129 LOG_ERR("%s: intb_gpio device not ready", cfg->intb_gpio.port->name);
130 return -ENODEV;
131 }
132
133 ret = fdc2x1x_set_interrupt_pin(dev, true);
134 if (ret) {
135 return ret;
136 }
137
138 gpio_pin_configure_dt(&cfg->intb_gpio, GPIO_INPUT);
139
140 gpio_init_callback(&drv_data->gpio_cb,
141 fdc2x1x_gpio_callback,
142 BIT(cfg->intb_gpio.pin));
143
144 if (gpio_add_callback(cfg->intb_gpio.port, &drv_data->gpio_cb) < 0) {
145 LOG_ERR("Failed to set gpio callback!");
146 return -EIO;
147 }
148
149 drv_data->dev = dev;
150
151 #ifdef CONFIG_FDC2X1X_TRIGGER_OWN_THREAD
152 k_sem_init(&drv_data->gpio_sem, 0, UINT_MAX);
153
154 k_thread_create(&drv_data->thread, drv_data->thread_stack,
155 CONFIG_FDC2X1X_THREAD_STACK_SIZE,
156 fdc2x1x_thread,
157 drv_data, 0, NULL,
158 K_PRIO_COOP(CONFIG_FDC2X1X_THREAD_PRIORITY),
159 0, K_NO_WAIT);
160 #elif CONFIG_FDC2X1X_TRIGGER_GLOBAL_THREAD
161 drv_data->work.handler = fdc2x1x_work_cb;
162 #endif
163
164 return 0;
165 }
166