michaelh/zephyr
1
0
Fork 0
Code Releases Activity

drivers: stts22h: Add attr_lower/high_tresh

Browse source 
Add threshold attribute handling to set low and high
temperature at runtime and validation for runtime changes

Signed-off-by: Tobias Meyer <tobiuhg@gmail.com>
This commit is contained in:
Tobias Meyer 2025-05-06 18:49:03 +02:00 • committed by Benjamin Cabé
commit 713fc17a26
1 changed files with 55 additions and 1 deletions
Download patch file Download diff file Expand all files Collapse all files

56
drivers/sensor/st/stts22h/stts22h.c
View file

@ -22,6 +22,9 @@
LOG_MODULE_REGISTER(STTS22H, CONFIG_SENSOR_LOG_LEVEL); LOG_MODULE_REGISTER(STTS22H, CONFIG_SENSOR_LOG_LEVEL);
#define ST22H_RANGE_LOWEST_TEMP -40
#define ST22H_RANGE_HIGHEST_TEMP 127
static inline int stts22h_set_odr_raw(const struct device *dev, stts22h_odr_temp_t odr) static inline int stts22h_set_odr_raw(const struct device *dev, stts22h_odr_temp_t odr)
{ {
const struct stts22h_config *cfg = dev->config; const struct stts22h_config *cfg = dev->config;
@ -105,6 +108,26 @@ static int stts22h_odr_set(const struct device *dev,
return -EINVAL; return -EINVAL;
} }
} }
#if CONFIG_STTS22H_TRIGGER
static inline uint32_t stts22h_val_to_threshold(const struct sensor_value *val)
{
if (val->val1 < ST22H_RANGE_LOWEST_TEMP || val->val1 > ST22H_RANGE_HIGHEST_TEMP) {
LOG_ERR("Invalid value: %d", val->val1);
return UINT32_MAX;
}
/* The conversion formula is: (degC / 0.64) + 63, we multiply by 100*/
int32_t temperature_degree_times100 = val->val1 * 100 + val->val2 / 10000;
uint32_t raw_value = (temperature_degree_times100 / 64) + 63;
if (raw_value > 0xFF) {
LOG_ERR("Invalid value: %d", raw_value);
return UINT32_MAX;
}
return raw_value;
}
#endif
static int stts22h_attr_set(const struct device *dev, static int stts22h_attr_set(const struct device *dev,
enum sensor_channel chan, enum sensor_channel chan,
@ -115,10 +138,41 @@ static int stts22h_attr_set(const struct device *dev,
LOG_ERR("Invalid channel: %d", chan); LOG_ERR("Invalid channel: %d", chan);
return -ENOTSUP; return -ENOTSUP;
} }
switch (attr) { switch (attr) {
case SENSOR_ATTR_SAMPLING_FREQUENCY: case SENSOR_ATTR_SAMPLING_FREQUENCY:
return stts22h_odr_set(dev, val); return stts22h_odr_set(dev, val);
#if CONFIG_STTS22H_TRIGGER
case SENSOR_ATTR_UPPER_THRESH: {
const struct stts22h_config *cfg = dev->config;
stmdev_ctx_t *ctx = (stmdev_ctx_t *)&cfg->ctx;
uint32_t raw_value = stts22h_val_to_threshold(val);
if (raw_value == UINT32_MAX) {
return -EINVAL;
}
if (stts22h_temp_trshld_high_set(ctx, (uint8_t)raw_value) < 0) {
LOG_DBG("Could not set high threshold");
return -EIO;
}
return 0;
}
case SENSOR_ATTR_LOWER_THRESH: {
const struct stts22h_config *cfg = dev->config;
stmdev_ctx_t *ctx = (stmdev_ctx_t *)&cfg->ctx;
uint32_t raw_value = stts22h_val_to_threshold(val);
if (raw_value == UINT32_MAX) {
return -EINVAL;
}
if (stts22h_temp_trshld_low_set(ctx, (uint8_t)raw_value) < 0) {
LOG_DBG("Could not set low threshold ");
return -EIO;
}
return 0;
}
#endif
default: default:
LOG_ERR("Attribute %d not supported.", attr); LOG_ERR("Attribute %d not supported.", attr);
return -ENOTSUP; return -ENOTSUP;