1 /*
2 * Copyright (c) 2024 Bosch Sensortec GmbH
3 *
4 * SPDX-License-Identifier: Apache-2.0
5 */
6
7 /*
8 * Bus-specific functionality for BMM350s accessed via I2C.
9 */
10 #include <zephyr/kernel.h>
11 #include <zephyr/pm/device.h>
12 #include <zephyr/logging/log.h>
13
14 #include "bmm350.h"
15
16 LOG_MODULE_DECLARE(BMM350, CONFIG_SENSOR_LOG_LEVEL);
17
bmm350_handle_interrupts(const void * arg)18 static int bmm350_handle_interrupts(const void *arg)
19 {
20 const struct device *dev = (const struct device *)arg;
21 struct bmm350_data *data = dev->data;
22 uint8_t intr_status;
23 int ret;
24
25 /* Read interrupt status to clear interrupt */
26 ret = bmm350_reg_read(dev, BMM350_REG_INT_STATUS, &intr_status, sizeof(intr_status));
27 if (ret < 0) {
28 LOG_ERR("%s: failed to read interrupt status", dev->name);
29 return ret;
30 }
31
32 if (data->drdy_handler) {
33 data->drdy_handler(dev, data->drdy_trigger);
34 }
35
36 return 0;
37 }
38
39 #ifdef CONFIG_BMM350_TRIGGER_OWN_THREAD
40 static K_THREAD_STACK_DEFINE(bmm350_thread_stack, CONFIG_BMM350_THREAD_STACK_SIZE);
41 static struct k_thread bmm350_thread;
42
bmm350_thread_main(void * arg1,void * unused1,void * unused2)43 static void bmm350_thread_main(void *arg1, void *unused1, void *unused2)
44 {
45 ARG_UNUSED(unused1);
46 ARG_UNUSED(unused2);
47 const struct device *dev = (const struct device *)arg1;
48 struct bmm350_data *data = dev->data;
49
50 while (1) {
51 k_sem_take(&data->sem, K_FOREVER);
52 (void)bmm350_handle_interrupts(dev);
53 }
54 }
55 #endif
56
57 #ifdef CONFIG_BMM350_TRIGGER_GLOBAL_THREAD
bmm350_work_handler(struct k_work * work)58 static void bmm350_work_handler(struct k_work *work)
59 {
60 struct bmm350_data *data = CONTAINER_OF(work, struct bmm350_data, work);
61
62 (void)bmm350_handle_interrupts(data->dev);
63 }
64 #endif
65
bmm350_gpio_callback(const struct device * port,struct gpio_callback * cb,uint32_t pin)66 static void bmm350_gpio_callback(const struct device *port, struct gpio_callback *cb, uint32_t pin)
67 {
68 struct bmm350_data *data = CONTAINER_OF(cb, struct bmm350_data, gpio_cb);
69
70 ARG_UNUSED(port);
71 ARG_UNUSED(pin);
72
73 #if defined(CONFIG_BMM350_TRIGGER_OWN_THREAD)
74 k_sem_give(&data->sem);
75 #elif defined(CONFIG_BMM350_TRIGGER_GLOBAL_THREAD)
76 k_work_submit(&data->work);
77 #endif
78 }
79
bmm350_trigger_set(const struct device * dev,const struct sensor_trigger * trig,sensor_trigger_handler_t handler)80 int bmm350_trigger_set(const struct device *dev, const struct sensor_trigger *trig,
81 sensor_trigger_handler_t handler)
82 {
83 const struct bmm350_config *cfg = dev->config;
84 struct bmm350_data *data = dev->data;
85 int ret = 0;
86
87 if (trig->type != SENSOR_TRIG_DATA_READY) {
88 return -ENOTSUP;
89 }
90
91 data->drdy_trigger = trig;
92 data->drdy_handler = handler;
93
94 /* Set PMU command configuration */
95 ret = bmm350_reg_write(dev, BMM350_REG_INT_CTRL, cfg->int_flags);
96 if (ret < 0) {
97 return ret;
98 }
99 return 0;
100 }
101
bmm350_trigger_mode_init(const struct device * dev)102 int bmm350_trigger_mode_init(const struct device *dev)
103 {
104 struct bmm350_data *data = dev->data;
105 const struct bmm350_config *cfg = dev->config;
106 int ret;
107
108 if (!device_is_ready(cfg->drdy_int.port)) {
109 LOG_ERR("INT device is not ready");
110 return -ENODEV;
111 }
112
113 #if defined(CONFIG_BMM350_TRIGGER_OWN_THREAD)
114 k_sem_init(&data->sem, 0, 1);
115 k_thread_create(&bmm350_thread, bmm350_thread_stack, CONFIG_BMM350_THREAD_STACK_SIZE,
116 bmm350_thread_main, (void *)dev, NULL, NULL,
117 K_PRIO_COOP(CONFIG_BMM350_THREAD_PRIORITY), 0, K_NO_WAIT);
118 #elif defined(CONFIG_BMM350_TRIGGER_GLOBAL_THREAD)
119 k_work_init(&data->work, bmm350_work_handler);
120 #endif
121
122 #if defined(CONFIG_BMM350_TRIGGER_GLOBAL_THREAD)
123 data->dev = dev;
124 #endif
125
126 ret = gpio_pin_configure_dt(&cfg->drdy_int, GPIO_INPUT);
127 if (ret < 0) {
128 return ret;
129 }
130
131 gpio_init_callback(&data->gpio_cb, bmm350_gpio_callback, BIT(cfg->drdy_int.pin));
132
133 ret = gpio_add_callback(cfg->drdy_int.port, &data->gpio_cb);
134 if (ret < 0) {
135 return ret;
136 }
137
138 ret = gpio_pin_interrupt_configure_dt(&cfg->drdy_int, GPIO_INT_EDGE_TO_ACTIVE);
139 if (ret < 0) {
140 return ret;
141 }
142
143 return 0;
144 }
145