Skip to content
Permalink
Browse files

driver/sensor: add LPS22HH sensor support

Add support to STM LPS22HH pressure and temperature sensor.
The driver support I2C and SPI bus communication and both
polling and drdy trigger mode.

Signed-off-by: Armando Visconti <armando.visconti@st.com>
  • Loading branch information...
avisconti authored and MaureenHelm committed Jan 29, 2019
1 parent 1ee8e0b commit 9dbdd81abe22dcbc671ea066cfdfc041d71f3c83
@@ -197,6 +197,7 @@
/ext/hal/atmel/asf/sam/include/same70*/ @aurel32
/ext/hal/atmel/asf/sam0/include/samr21/ @benpicco
/dts/bindings/sensor/*bme680* @BoschSensortec
/dts/bindings/sensor/st,* @avisconti
/ext/hal/cmsis/ @MaureenHelm @galak
/ext/hal/microchip/ @franciscomunoz @albertofloyd @scottwcpg
/ext/hal/nordic/ @carlescufi @anangl
@@ -31,6 +31,7 @@ add_subdirectory_ifdef(CONFIG_LIS2DW12 lis2dw12)
add_subdirectory_ifdef(CONFIG_LIS2MDL lis2mdl)
add_subdirectory_ifdef(CONFIG_LIS3MDL lis3mdl)
add_subdirectory_ifdef(CONFIG_LPS22HB lps22hb)
add_subdirectory_ifdef(CONFIG_LPS22HH lps22hh)
add_subdirectory_ifdef(CONFIG_LPS25HB lps25hb)
add_subdirectory_ifdef(CONFIG_LSM303DLHC_MAGN lsm303dlhc_magn)
add_subdirectory_ifdef(CONFIG_LSM6DS0 lsm6ds0)
@@ -87,6 +87,8 @@ source "drivers/sensor/lis3mdl/Kconfig"

source "drivers/sensor/lps22hb/Kconfig"

source "drivers/sensor/lps22hh/Kconfig"

source "drivers/sensor/lps25hb/Kconfig"

source "drivers/sensor/lsm303dlhc_magn/Kconfig"
@@ -0,0 +1,12 @@
# ST Microelectronics LPS22HH pressure and temperature sensor
#
# Copyright (c) 2019 STMicroelectronics
#
# SPDX-License-Identifier: Apache-2.0
#
zephyr_library()

zephyr_library_sources_ifdef(CONFIG_LPS22HH lps22hh.c)
zephyr_library_sources_ifdef(CONFIG_LPS22HH lps22hh_i2c.c)
zephyr_library_sources_ifdef(CONFIG_LPS22HH lps22hh_spi.c)
zephyr_library_sources_ifdef(CONFIG_LPS22HH_TRIGGER lps22hh_trigger.c)
@@ -0,0 +1,77 @@
# ST Microelectronics LPS22HH pressure and temperature sensor
#
# Copyright (c) 2019 STMicroelectronics
#
# SPDX-License-Identifier: Apache-2.0
#

menuconfig LPS22HH
bool "LPS22HH pressure and temperature"
depends on (I2C && HAS_DTS_I2C) || (SPI && HAS_DTS_SPI)
select HAS_STMEMSC
select USE_STDC_LPS22HH
help
Enable driver for LPS22HH I2C-based pressure and temperature
sensor.

if LPS22HH

choice LPS22HH_TRIGGER_MODE
prompt "Trigger mode"
default LPS22HH_TRIGGER_GLOBAL_THREAD
help
Specify the type of triggering to be used by the driver.

config LPS22HH_TRIGGER_NONE
bool "No trigger"

config LPS22HH_TRIGGER_GLOBAL_THREAD
bool "Use global thread"
depends on GPIO
select LPS22HH_TRIGGER

config LPS22HH_TRIGGER_OWN_THREAD
bool "Use own thread"
depends on GPIO
select LPS22HH_TRIGGER

endchoice # LPS22HH_TRIGGER_MODE

config LPS22HH_TRIGGER
bool

config LPS22HH_THREAD_PRIORITY
int "Thread priority"
depends on LPS22HH_TRIGGER_OWN_THREAD
default 10
help
Priority of thread used by the driver to handle interrupts.

config LPS22HH_THREAD_STACK_SIZE
int "Thread stack size"
depends on LPS22HH_TRIGGER_OWN_THREAD
default 1024
help
Stack size of thread used by the driver to handle interrupts.

menu "Attributes"

config LPS22HH_SAMPLING_RATE
int "Output data rate"
range 0 7
default 0
help
Sensor output data rate expressed in samples per second.
Data rates supported by the chip are:
0: ODR selected at runtime
1: 1Hz
2: 10Hz
3: 25Hz
4: 50Hz
5: 75Hz
6: 100Hz
7: 200Hz

endmenu

endif # LPS22HH
@@ -0,0 +1,233 @@
/* 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
*/

#include <sensor.h>
#include <kernel.h>
#include <device.h>
#include <init.h>
#include <sys/byteorder.h>
#include <sys/__assert.h>
#include <logging/log.h>

#include "lps22hh.h"

#define LOG_LEVEL CONFIG_SENSOR_LOG_LEVEL
LOG_MODULE_REGISTER(LPS22HH);

static inline int lps22hh_set_odr_raw(struct device *dev, u8_t odr)
{
struct lps22hh_data *data = dev->driver_data;

return lps22hh_data_rate_set(data->ctx, odr);
}

static int lps22hh_sample_fetch(struct device *dev,
enum sensor_channel chan)
{
struct lps22hh_data *data = dev->driver_data;
axis1bit32_t raw_press;
axis1bit16_t raw_temp;

__ASSERT_NO_MSG(chan == SENSOR_CHAN_ALL);

if (lps22hh_pressure_raw_get(data->ctx, raw_press.u8bit) < 0) {
LOG_DBG("Failed to read sample");
return -EIO;
}
if (lps22hh_temperature_raw_get(data->ctx, raw_temp.u8bit) < 0) {
LOG_DBG("Failed to read sample");
return -EIO;
}

data->sample_press = raw_press.i32bit;
data->sample_temp = raw_temp.i16bit;

return 0;
}

static inline void lps22hh_press_convert(struct sensor_value *val,
s32_t raw_val)
{
/* Pressure sensitivity is 4096 LSB/hPa */
/* Convert raw_val to val in kPa */
val->val1 = (raw_val >> 12) / 10;
val->val2 = (raw_val >> 12) % 10 * 100000 +
(((s32_t)((raw_val) & 0x0FFF) * 100000L) >> 12);
}

static inline void lps22hh_temp_convert(struct sensor_value *val,
s16_t raw_val)
{
/* Temperature sensitivity is 100 LSB/deg C */
val->val1 = raw_val / 100;
val->val2 = ((s32_t)raw_val % 100) * 10000;
}

static int lps22hh_channel_get(struct device *dev,
enum sensor_channel chan,
struct sensor_value *val)
{
struct lps22hh_data *data = dev->driver_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 u16_t lps22hh_map[] = {0, 1, 10, 25, 50, 75, 100, 200};

static int lps22hh_odr_set(struct device *dev, u16_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(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_api_funcs = {
.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(struct device *dev)
{
struct lps22hh_data *data = dev->driver_data;
u8_t chip_id;

if (lps22hh_device_id_get(data->ctx, &chip_id) < 0) {
LOG_DBG("Failed reading chip id");
return -EIO;
}

if (chip_id != LPS22HH_ID) {
LOG_DBG("Invalid chip id 0x%x", chip_id);
return -EIO;
}

if (lps22hh_set_odr_raw(dev, CONFIG_LPS22HH_SAMPLING_RATE) < 0) {
LOG_DBG("Failed to set sampling rate");
return -EIO;
}

if (lps22hh_block_data_update_set(data->ctx, PROPERTY_ENABLE) < 0) {
LOG_DBG("Failed to set BDU");
return -EIO;
}

return 0;
}

static int lps22hh_init(struct device *dev)
{
const struct lps22hh_config * const config = dev->config->config_info;
struct lps22hh_data *data = dev->driver_data;

data->bus = device_get_binding(config->master_dev_name);
if (!data->bus) {
LOG_DBG("bus master not found: %s", config->master_dev_name);
return -EINVAL;
}

config->bus_init(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;
}

static struct lps22hh_data lps22hh_data;

static const struct lps22hh_config lps22hh_config = {
.master_dev_name = DT_INST_0_ST_LPS22HH_BUS_NAME,
#ifdef CONFIG_LPS22HH_TRIGGER
.drdy_port = DT_INST_0_ST_LPS22HH_DRDY_GPIOS_CONTROLLER,
.drdy_pin = DT_INST_0_ST_LPS22HH_DRDY_GPIOS_PIN,
#endif
#if defined(DT_ST_LPS22HH_BUS_SPI)
.bus_init = lps22hh_spi_init,
.spi_conf.frequency = DT_INST_0_ST_LPS22HH_SPI_MAX_FREQUENCY,
.spi_conf.operation = (SPI_OP_MODE_MASTER | SPI_MODE_CPOL |
SPI_MODE_CPHA | SPI_WORD_SET(8) |
SPI_LINES_SINGLE),
.spi_conf.slave = DT_INST_0_ST_LPS22HH_BASE_ADDRESS,
#if defined(DT_INST_0_ST_LPS22HH_CS_GPIO_CONTROLLER)
.gpio_cs_port = DT_INST_0_ST_LPS22HH_CS_GPIO_CONTROLLER,
.cs_gpio = DT_INST_0_ST_LPS22HH_CS_GPIO_PIN,

.spi_conf.cs = &lps22hh_data.cs_ctrl,
#else
.spi_conf.cs = NULL,
#endif
#elif defined(DT_ST_LPS22HH_BUS_I2C)
.bus_init = lps22hh_i2c_init,
.i2c_slv_addr = DT_INST_0_ST_LPS22HH_BASE_ADDRESS,
#else
#error "BUS MACRO NOT DEFINED IN DTS"
#endif
};

DEVICE_AND_API_INIT(lps22hh, DT_INST_0_ST_LPS22HH_LABEL, lps22hh_init,
&lps22hh_data, &lps22hh_config, POST_KERNEL,
CONFIG_SENSOR_INIT_PRIORITY, &lps22hh_api_funcs);

0 comments on commit 9dbdd81

Please sign in to comment.
You can’t perform that action at this time.