patrick/zephyr
1
0
Fork 0
Code Issues Pull requests Actions 7 Packages Projects Releases Wiki Activity

sample: board: sensortile_box_pro: add stts22h sensor support

Browse source 
Extend sensor sample reading also stts22h temperature data.

Signed-off-by: Armando Visconti <armando.visconti@st.com>
This commit is contained in:
Armando Visconti 2024-01-30 17:06:18 +01:00 committed by Anas Nashif
parent 2001142bf0
commit b929cf94e7
1 changed files with 56 additions and 0 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

56
samples/boards/sensortile_box_pro/sensors-on-board/src/main.c
View file

@ -75,6 +75,16 @@ static void lis2du12_trigger_handler(const struct device *dev,
} }
#endif #endif
#ifdef CONFIG_STTS22H_TRIGGER
static int stts22h_trig_cnt;
static void stts22h_trigger_handler(const struct device *dev,
const struct sensor_trigger *trig)
{
stts22h_trig_cnt++;
}
#endif
static void lps22df_config(const struct device *lps22df) static void lps22df_config(const struct device *lps22df)
{ {
struct sensor_value odr_attr; struct sensor_value odr_attr;
@ -201,6 +211,29 @@ static void lis2du12_config(const struct device *lis2du12)
#endif #endif
} }
static void stts22h_config(const struct device *stts22h)
{
struct sensor_value odr_attr;
/* set STTS22H sampling frequency to 100 Hz */
odr_attr.val1 = 100;
odr_attr.val2 = 0;
if (sensor_attr_set(stts22h, SENSOR_CHAN_AMBIENT_TEMP,
SENSOR_ATTR_SAMPLING_FREQUENCY, &odr_attr) < 0) {
printk("Cannot set sampling frequency for STTS22H\n");
return;
}
#ifdef CONFIG_STTS22H_TRIGGER
struct sensor_trigger trig;
trig.type = SENSOR_TRIG_DATA_READY;
trig.chan = SENSOR_CHAN_AMBIENT_TEMP;
sensor_trigger_set(stts22h, &trig, stts22h_trigger_handler);
#endif
}
static int led_pattern_out(void) static int led_pattern_out(void)
{ {
const struct gpio_dt_spec led0_gpio = GPIO_DT_SPEC_GET(DT_ALIAS(led0), gpios); const struct gpio_dt_spec led0_gpio = GPIO_DT_SPEC_GET(DT_ALIAS(led0), gpios);
@ -271,6 +304,7 @@ int main(void)
const struct device *const lsm6dsv16x = DEVICE_DT_GET_ONE(st_lsm6dsv16x); const struct device *const lsm6dsv16x = DEVICE_DT_GET_ONE(st_lsm6dsv16x);
const struct device *const lis2mdl = DEVICE_DT_GET_ONE(st_lis2mdl); const struct device *const lis2mdl = DEVICE_DT_GET_ONE(st_lis2mdl);
const struct device *const lis2du12 = DEVICE_DT_GET_ONE(st_lis2du12); const struct device *const lis2du12 = DEVICE_DT_GET_ONE(st_lis2du12);
const struct device *const stts22h = DEVICE_DT_GET_ONE(st_stts22h);
if (!device_is_ready(hts221)) { if (!device_is_ready(hts221)) {
printk("%s: device not ready.\n", hts221->name); printk("%s: device not ready.\n", hts221->name);
@ -292,7 +326,12 @@ int main(void)
printk("%s: device not ready.\n", lis2du12->name); printk("%s: device not ready.\n", lis2du12->name);
return 0; return 0;
} }
if (!device_is_ready(stts22h)) {
printk("%s: device not ready.\n", stts22h->name);
return 0;
}
stts22h_config(stts22h);
lis2du12_config(lis2du12); lis2du12_config(lis2du12);
lis2mdl_config(lis2mdl); lis2mdl_config(lis2mdl);
lps22df_config(lps22df); lps22df_config(lps22df);
@ -305,6 +344,7 @@ int main(void)
struct sensor_value lis2mdl_magn[3]; struct sensor_value lis2mdl_magn[3];
struct sensor_value lis2mdl_temp; struct sensor_value lis2mdl_temp;
struct sensor_value lis2du12_accel[3]; struct sensor_value lis2du12_accel[3];
struct sensor_value stts22h_temp;
/* handle HTS221 sensor */ /* handle HTS221 sensor */
if (sensor_sample_fetch(hts221) < 0) { if (sensor_sample_fetch(hts221) < 0) {
@ -340,6 +380,13 @@ int main(void)
} }
#endif #endif
#ifndef CONFIG_STTS22H_TRIGGER
if (sensor_sample_fetch(stts22h) < 0) {
printf("STTS22H Sensor sample update error\n");
return 0;
}
#endif
sensor_channel_get(hts221, SENSOR_CHAN_HUMIDITY, &hts221_hum); sensor_channel_get(hts221, SENSOR_CHAN_HUMIDITY, &hts221_hum);
sensor_channel_get(hts221, SENSOR_CHAN_AMBIENT_TEMP, &hts221_temp); sensor_channel_get(hts221, SENSOR_CHAN_AMBIENT_TEMP, &hts221_temp);
sensor_channel_get(lps22df, SENSOR_CHAN_AMBIENT_TEMP, &lps22df_temp); sensor_channel_get(lps22df, SENSOR_CHAN_AMBIENT_TEMP, &lps22df_temp);
@ -349,6 +396,7 @@ int main(void)
sensor_channel_get(lis2mdl, SENSOR_CHAN_MAGN_XYZ, lis2mdl_magn); sensor_channel_get(lis2mdl, SENSOR_CHAN_MAGN_XYZ, lis2mdl_magn);
sensor_channel_get(lis2mdl, SENSOR_CHAN_DIE_TEMP, &lis2mdl_temp); sensor_channel_get(lis2mdl, SENSOR_CHAN_DIE_TEMP, &lis2mdl_temp);
sensor_channel_get(lis2du12, SENSOR_CHAN_ACCEL_XYZ, lis2du12_accel); sensor_channel_get(lis2du12, SENSOR_CHAN_ACCEL_XYZ, lis2du12_accel);
sensor_channel_get(stts22h, SENSOR_CHAN_AMBIENT_TEMP, &stts22h_temp);
/* Display sensor data */ /* Display sensor data */
@ -397,6 +445,10 @@ int main(void)
sensor_value_to_double(&lis2du12_accel[1]), sensor_value_to_double(&lis2du12_accel[1]),
sensor_value_to_double(&lis2du12_accel[2])); sensor_value_to_double(&lis2du12_accel[2]));
/* STTS22H temperature */
printf("STTS22H: Temperature: %.1f C\n",
sensor_value_to_double(&stts22h_temp));
#ifdef CONFIG_LPS2XDF_TRIGGER #ifdef CONFIG_LPS2XDF_TRIGGER
printk("%d:: lps22df trig %d\n", cnt, lps22df_trig_cnt); printk("%d:: lps22df trig %d\n", cnt, lps22df_trig_cnt);
#endif #endif
@ -414,6 +466,10 @@ int main(void)
printk("%d:: lis2du12 trig %d\n", cnt, lis2du12_trig_cnt); printk("%d:: lis2du12 trig %d\n", cnt, lis2du12_trig_cnt);
#endif #endif
#ifdef CONFIG_STTS22H_TRIGGER
printk("%d:: stts22h trig %d\n", cnt, stts22h_trig_cnt);
#endif
k_sleep(K_MSEC(2000)); k_sleep(K_MSEC(2000));
} }
} }