telem3-fw/drivers/sensor/examplesensor/examplesensor.c
Gerard Marull-Paretas d1c935e55c app: initial application skeleton
initial application skeleton demonstrating:

- custom boards
- custom DT bindings
- Out-of-tree drivers

Signed-off-by: Gerard Marull-Paretas <gerard.marull@nordicsemi.no>
2021-05-07 10:04:22 -04:00

87 lines
2.1 KiB
C

/*
* Copyright (c) 2021 Nordic Semiconductor ASA
* SPDX-License-Identifier: Apache-2.0
*/
#define DT_DRV_COMPAT zephyr_examplesensor
#include <device.h>
#include <drivers/gpio.h>
#include <drivers/sensor.h>
#include <logging/log.h>
LOG_MODULE_REGISTER(examplesensor, CONFIG_SENSOR_LOG_LEVEL);
struct examplesensor_data {
int state;
};
struct examplesensor_config {
struct gpio_dt_spec input;
};
static int examplesensor_sample_fetch(const struct device *dev,
enum sensor_channel chan)
{
const struct examplesensor_config *config = dev->config;
struct examplesensor_data *data = dev->data;
data->state = gpio_pin_get(config->input.port, config->input.pin);
return 0;
}
static int examplesensor_channel_get(const struct device *dev,
enum sensor_channel chan,
struct sensor_value *val)
{
struct examplesensor_data *data = dev->data;
if (chan != SENSOR_CHAN_PROX) {
return -ENOTSUP;
}
val->val1 = data->state;
return 0;
}
static const struct sensor_driver_api examplesensor_api = {
.sample_fetch = &examplesensor_sample_fetch,
.channel_get = &examplesensor_channel_get,
};
static int examplesensor_init(const struct device *dev)
{
const struct examplesensor_config *config = dev->config;
int ret;
if (!device_is_ready(config->input.port)) {
LOG_ERR("Input GPIO not ready");
return -ENODEV;
}
ret = gpio_pin_configure_dt(&config->input, GPIO_INPUT);
if (ret < 0) {
LOG_ERR("Could not configure input GPIO (%d)", ret);
return ret;
}
return 0;
}
#define EXAMPLESENSOR_INIT(i) \
static struct examplesensor_data examplesensor_data_##i; \
\
static const struct examplesensor_config examplesensor_config_##i = { \
.input = GPIO_DT_SPEC_GET(DT_DRV_INST(i), input_gpios), \
}; \
\
DEVICE_DT_INST_DEFINE(i, examplesensor_init, NULL, \
&examplesensor_data_##i, \
&examplesensor_config_##i, POST_KERNEL, \
CONFIG_SENSOR_INIT_PRIORITY, &examplesensor_api);
DT_INST_FOREACH_STATUS_OKAY(EXAMPLESENSOR_INIT)