333 lines
8.0 KiB
C
333 lines
8.0 KiB
C
/* ST Microelectronics LPS22HH pressure and temperature sensor
|
|
*
|
|
* Copyright (c) 2019 STMicroelectronics
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*
|
|
* Datasheet:
|
|
* https://www.st.com/resource/en/datasheet/lps22hh.pdf
|
|
*/
|
|
|
|
#define DT_DRV_COMPAT st_lps22hh
|
|
|
|
#include <zephyr/drivers/sensor.h>
|
|
#include <zephyr/kernel.h>
|
|
#include <zephyr/device.h>
|
|
#include <zephyr/init.h>
|
|
#include <zephyr/sys/byteorder.h>
|
|
#include <zephyr/sys/__assert.h>
|
|
#include <zephyr/logging/log.h>
|
|
|
|
#include "lps22hh.h"
|
|
|
|
LOG_MODULE_REGISTER(LPS22HH, CONFIG_SENSOR_LOG_LEVEL);
|
|
|
|
static inline int lps22hh_set_odr_raw(const struct device *dev, uint8_t odr)
|
|
{
|
|
const struct lps22hh_config * const cfg = dev->config;
|
|
stmdev_ctx_t *ctx = (stmdev_ctx_t *)&cfg->ctx;
|
|
|
|
return lps22hh_data_rate_set(ctx, odr);
|
|
}
|
|
|
|
static int lps22hh_sample_fetch(const struct device *dev,
|
|
enum sensor_channel chan)
|
|
{
|
|
struct lps22hh_data *data = dev->data;
|
|
const struct lps22hh_config * const cfg = dev->config;
|
|
stmdev_ctx_t *ctx = (stmdev_ctx_t *)&cfg->ctx;
|
|
uint32_t raw_press;
|
|
int16_t raw_temp;
|
|
|
|
__ASSERT_NO_MSG(chan == SENSOR_CHAN_ALL);
|
|
|
|
if (lps22hh_pressure_raw_get(ctx, &raw_press) < 0) {
|
|
LOG_DBG("Failed to read sample");
|
|
return -EIO;
|
|
}
|
|
if (lps22hh_temperature_raw_get(ctx, &raw_temp) < 0) {
|
|
LOG_DBG("Failed to read sample");
|
|
return -EIO;
|
|
}
|
|
|
|
data->sample_press = raw_press;
|
|
data->sample_temp = raw_temp;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static inline void lps22hh_press_convert(struct sensor_value *val,
|
|
int32_t raw_val)
|
|
{
|
|
int32_t press_tmp = raw_val >> 8; /* raw value is left aligned (24 msb) */
|
|
|
|
/* Pressure sensitivity is 4096 LSB/hPa */
|
|
/* Also convert hPa into kPa */
|
|
|
|
val->val1 = press_tmp / 40960;
|
|
|
|
/* For the decimal part use (3125 / 128) as a factor instead of
|
|
* (1000000 / 40960) to avoid int32 overflow
|
|
*/
|
|
val->val2 = (press_tmp % 40960) * 3125 / 128;
|
|
}
|
|
|
|
static inline void lps22hh_temp_convert(struct sensor_value *val,
|
|
int16_t raw_val)
|
|
{
|
|
/* Temperature sensitivity is 100 LSB/deg C */
|
|
val->val1 = raw_val / 100;
|
|
val->val2 = ((int32_t)raw_val % 100) * 10000;
|
|
}
|
|
|
|
static int lps22hh_channel_get(const struct device *dev,
|
|
enum sensor_channel chan,
|
|
struct sensor_value *val)
|
|
{
|
|
struct lps22hh_data *data = dev->data;
|
|
|
|
if (chan == SENSOR_CHAN_PRESS) {
|
|
lps22hh_press_convert(val, data->sample_press);
|
|
} else if (chan == SENSOR_CHAN_AMBIENT_TEMP) {
|
|
lps22hh_temp_convert(val, data->sample_temp);
|
|
} else {
|
|
return -ENOTSUP;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const uint16_t lps22hh_map[] = {0, 1, 10, 25, 50, 75, 100, 200};
|
|
|
|
static int lps22hh_odr_set(const struct device *dev, uint16_t freq)
|
|
{
|
|
int odr;
|
|
|
|
for (odr = 0; odr < ARRAY_SIZE(lps22hh_map); odr++) {
|
|
if (freq == lps22hh_map[odr]) {
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (odr == ARRAY_SIZE(lps22hh_map)) {
|
|
LOG_DBG("bad frequency");
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (lps22hh_set_odr_raw(dev, odr) < 0) {
|
|
LOG_DBG("failed to set sampling rate");
|
|
return -EIO;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int lps22hh_attr_set(const struct device *dev,
|
|
enum sensor_channel chan,
|
|
enum sensor_attribute attr,
|
|
const struct sensor_value *val)
|
|
{
|
|
if (chan != SENSOR_CHAN_ALL) {
|
|
LOG_WRN("attr_set() not supported on this channel.");
|
|
return -ENOTSUP;
|
|
}
|
|
|
|
switch (attr) {
|
|
case SENSOR_ATTR_SAMPLING_FREQUENCY:
|
|
return lps22hh_odr_set(dev, val->val1);
|
|
default:
|
|
LOG_DBG("operation not supported.");
|
|
return -ENOTSUP;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct sensor_driver_api lps22hh_driver_api = {
|
|
.attr_set = lps22hh_attr_set,
|
|
.sample_fetch = lps22hh_sample_fetch,
|
|
.channel_get = lps22hh_channel_get,
|
|
#if CONFIG_LPS22HH_TRIGGER
|
|
.trigger_set = lps22hh_trigger_set,
|
|
#endif
|
|
};
|
|
|
|
static int lps22hh_init_chip(const struct device *dev)
|
|
{
|
|
const struct lps22hh_config * const cfg = dev->config;
|
|
struct lps22hh_data *data = dev->data;
|
|
stmdev_ctx_t *ctx = (stmdev_ctx_t *)&cfg->ctx;
|
|
uint8_t chip_id;
|
|
int ret;
|
|
|
|
#if DT_ANY_INST_ON_BUS_STATUS_OKAY(i3c)
|
|
if (cfg->i3c.bus != NULL) {
|
|
/*
|
|
* Need to grab the pointer to the I3C device descriptor
|
|
* before we can talk to the sensor.
|
|
*/
|
|
data->i3c_dev = i3c_device_find(cfg->i3c.bus, &cfg->i3c.dev_id);
|
|
if (data->i3c_dev == NULL) {
|
|
LOG_ERR("Cannot find I3C device descriptor");
|
|
return -ENODEV;
|
|
}
|
|
}
|
|
#endif
|
|
|
|
if (lps22hh_device_id_get(ctx, &chip_id) < 0) {
|
|
LOG_ERR("%s: Not able to read dev id", dev->name);
|
|
return -EIO;
|
|
}
|
|
|
|
if (chip_id != LPS22HH_ID) {
|
|
LOG_ERR("%s: Invalid chip ID 0x%02x", dev->name, chip_id);
|
|
return -EIO;
|
|
}
|
|
|
|
LOG_DBG("%s: chip id 0x%x", dev->name, chip_id);
|
|
|
|
#if DT_ANY_INST_ON_BUS_STATUS_OKAY(i3c)
|
|
if (cfg->i3c.bus != NULL) {
|
|
/*
|
|
* Enabling I3C and disabling I2C are required
|
|
* for I3C IBI to work, or else the sensor will not
|
|
* send any IBIs.
|
|
*/
|
|
|
|
ret = lps22hh_i3c_interface_set(ctx, LPS22HH_I3C_ENABLE);
|
|
if (ret < 0) {
|
|
LOG_ERR("Cannot enable I3C interface");
|
|
return ret;
|
|
}
|
|
|
|
ret = lps22hh_i2c_interface_set(ctx, LPS22HH_I2C_DISABLE);
|
|
if (ret < 0) {
|
|
LOG_ERR("Cannot disable I2C interface");
|
|
return ret;
|
|
}
|
|
}
|
|
#else
|
|
ARG_UNUSED(data);
|
|
#endif
|
|
|
|
/* set sensor default odr */
|
|
LOG_DBG("%s: odr: %d", dev->name, cfg->odr);
|
|
ret = lps22hh_set_odr_raw(dev, cfg->odr);
|
|
if (ret < 0) {
|
|
LOG_ERR("%s: Failed to set odr %d", dev->name, cfg->odr);
|
|
return ret;
|
|
}
|
|
|
|
if (lps22hh_block_data_update_set(ctx, PROPERTY_ENABLE) < 0) {
|
|
LOG_ERR("%s: Failed to set BDU", dev->name);
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int lps22hh_init(const struct device *dev)
|
|
{
|
|
if (lps22hh_init_chip(dev) < 0) {
|
|
LOG_DBG("Failed to initialize chip");
|
|
return -EIO;
|
|
}
|
|
|
|
#ifdef CONFIG_LPS22HH_TRIGGER
|
|
if (lps22hh_init_interrupt(dev) < 0) {
|
|
LOG_ERR("Failed to initialize interrupt.");
|
|
return -EIO;
|
|
}
|
|
#endif
|
|
|
|
return 0;
|
|
}
|
|
|
|
#if DT_NUM_INST_STATUS_OKAY(DT_DRV_COMPAT) == 0
|
|
#warning "LPS22HH driver enabled without any devices"
|
|
#endif
|
|
|
|
/*
|
|
* Instantiation macros used when a device is on a SPI bus.
|
|
*/
|
|
|
|
#ifdef CONFIG_LPS22HH_TRIGGER
|
|
#define LPS22HH_CFG_IRQ(inst) \
|
|
.gpio_int = GPIO_DT_SPEC_INST_GET(inst, drdy_gpios),
|
|
#else
|
|
#define LPS22HH_CFG_IRQ(inst)
|
|
#endif /* CONFIG_LPS22HH_TRIGGER */
|
|
|
|
#define LPS22HH_CONFIG_COMMON(inst) \
|
|
.odr = DT_INST_PROP(inst, odr), \
|
|
COND_CODE_1(DT_INST_NODE_HAS_PROP(inst, drdy_gpios), \
|
|
(LPS22HH_CFG_IRQ(inst)), ())
|
|
|
|
#define LPS22HH_SPI_OPERATION (SPI_WORD_SET(8) | \
|
|
SPI_OP_MODE_MASTER | \
|
|
SPI_MODE_CPOL | \
|
|
SPI_MODE_CPHA) \
|
|
|
|
#define LPS22HH_CONFIG_SPI(inst) \
|
|
{ \
|
|
STMEMSC_CTX_SPI(&lps22hh_config_##inst.stmemsc_cfg), \
|
|
.stmemsc_cfg = { \
|
|
.spi = SPI_DT_SPEC_INST_GET(inst, \
|
|
LPS22HH_SPI_OPERATION, \
|
|
0), \
|
|
}, \
|
|
LPS22HH_CONFIG_COMMON(inst) \
|
|
}
|
|
|
|
/*
|
|
* Instantiation macros used when a device is on an I2C bus.
|
|
*/
|
|
|
|
#define LPS22HH_CONFIG_I2C(inst) \
|
|
{ \
|
|
STMEMSC_CTX_I2C(&lps22hh_config_##inst.stmemsc_cfg), \
|
|
.stmemsc_cfg = { \
|
|
.i2c = I2C_DT_SPEC_INST_GET(inst), \
|
|
}, \
|
|
LPS22HH_CONFIG_COMMON(inst) \
|
|
}
|
|
|
|
/*
|
|
* Instantiation macros used when a device is on an I#C bus.
|
|
*/
|
|
|
|
#define LPS22HH_CONFIG_I3C(inst) \
|
|
{ \
|
|
STMEMSC_CTX_I3C(&lps22hh_config_##inst.stmemsc_cfg), \
|
|
.stmemsc_cfg = { \
|
|
.i3c = &lps22hh_data_##inst.i3c_dev, \
|
|
}, \
|
|
.i3c.bus = DEVICE_DT_GET(DT_INST_BUS(inst)), \
|
|
.i3c.dev_id = I3C_DEVICE_ID_DT_INST(inst), \
|
|
LPS22HH_CONFIG_COMMON(inst) \
|
|
}
|
|
|
|
#define LPS22HH_CONFIG_I3C_OR_I2C(inst) \
|
|
COND_CODE_0(DT_INST_PROP_BY_IDX(inst, reg, 1), \
|
|
(LPS22HH_CONFIG_I2C(inst)), \
|
|
(LPS22HH_CONFIG_I3C(inst)))
|
|
|
|
/*
|
|
* Main instantiation macro. Use of COND_CODE_1() selects the right
|
|
* bus-specific macro at preprocessor time.
|
|
*/
|
|
|
|
#define LPS22HH_DEFINE(inst) \
|
|
static struct lps22hh_data lps22hh_data_##inst; \
|
|
static const struct lps22hh_config lps22hh_config_##inst = \
|
|
COND_CODE_1(DT_INST_ON_BUS(inst, spi), \
|
|
(LPS22HH_CONFIG_SPI(inst)), \
|
|
(COND_CODE_1(DT_INST_ON_BUS(inst, i3c), \
|
|
(LPS22HH_CONFIG_I3C_OR_I2C(inst)), \
|
|
(LPS22HH_CONFIG_I2C(inst))))); \
|
|
SENSOR_DEVICE_DT_INST_DEFINE(inst, lps22hh_init, NULL, &lps22hh_data_##inst, \
|
|
&lps22hh_config_##inst, POST_KERNEL, \
|
|
CONFIG_SENSOR_INIT_PRIORITY, &lps22hh_driver_api);
|
|
|
|
DT_INST_FOREACH_STATUS_OKAY(LPS22HH_DEFINE)
|