0b90fd5adf
As both C and C++ standards require applications running under an OS to
return 'int', adapt that for Zephyr to align with those standard. This also
eliminates errors when building with clang when not using -ffreestanding,
and reduces the need for compiler flags to silence warnings for both clang
and gcc.
Most of these changes were automated using coccinelle with the following
script:
@@
@@
- void
+ int
main(...) {
...
- return;
+ return 0;
...
}
Approximately 40 files had to be edited by hand as coccinelle was unable to
fix them.
Signed-off-by: Keith Packard <keithp@keithp.com>
121 lines
2.6 KiB
C
121 lines
2.6 KiB
C
/*
|
|
* Copyright (c) 2019 Nordic Semiconductor ASA
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#include <stdio.h>
|
|
#include <zephyr/kernel.h>
|
|
#include <zephyr/device.h>
|
|
#include <zephyr/drivers/sensor.h>
|
|
|
|
static void fetch_and_display(const struct device *sensor)
|
|
{
|
|
static unsigned int count;
|
|
struct sensor_value accel[3];
|
|
struct sensor_value temperature;
|
|
const char *overrun = "";
|
|
int rc = sensor_sample_fetch(sensor);
|
|
|
|
++count;
|
|
if (rc == -EBADMSG) {
|
|
/* Sample overrun. Ignore in polled mode. */
|
|
if (IS_ENABLED(CONFIG_LIS2DH_TRIGGER)) {
|
|
overrun = "[OVERRUN] ";
|
|
}
|
|
rc = 0;
|
|
}
|
|
if (rc == 0) {
|
|
rc = sensor_channel_get(sensor,
|
|
SENSOR_CHAN_ACCEL_XYZ,
|
|
accel);
|
|
}
|
|
if (rc < 0) {
|
|
printf("ERROR: Update failed: %d\n", rc);
|
|
} else {
|
|
printf("#%u @ %u ms: %sx %f , y %f , z %f",
|
|
count, k_uptime_get_32(), overrun,
|
|
sensor_value_to_double(&accel[0]),
|
|
sensor_value_to_double(&accel[1]),
|
|
sensor_value_to_double(&accel[2]));
|
|
}
|
|
|
|
if (IS_ENABLED(CONFIG_LIS2DH_MEASURE_TEMPERATURE)) {
|
|
if (rc == 0) {
|
|
rc = sensor_channel_get(sensor, SENSOR_CHAN_DIE_TEMP, &temperature);
|
|
if (rc < 0) {
|
|
printf("\nERROR: Unable to read temperature:%d\n", rc);
|
|
} else {
|
|
printf(", t %f\n", sensor_value_to_double(&temperature));
|
|
}
|
|
}
|
|
|
|
} else {
|
|
printf("\n");
|
|
}
|
|
}
|
|
|
|
#ifdef CONFIG_LIS2DH_TRIGGER
|
|
static void trigger_handler(const struct device *dev,
|
|
const struct sensor_trigger *trig)
|
|
{
|
|
fetch_and_display(dev);
|
|
}
|
|
#endif
|
|
|
|
int main(void)
|
|
{
|
|
const struct device *const sensor = DEVICE_DT_GET_ANY(st_lis2dh);
|
|
|
|
if (sensor == NULL) {
|
|
printf("No device found\n");
|
|
return 0;
|
|
}
|
|
if (!device_is_ready(sensor)) {
|
|
printf("Device %s is not ready\n", sensor->name);
|
|
return 0;
|
|
}
|
|
|
|
#if CONFIG_LIS2DH_TRIGGER
|
|
{
|
|
struct sensor_trigger trig;
|
|
int rc;
|
|
|
|
trig.type = SENSOR_TRIG_DATA_READY;
|
|
trig.chan = SENSOR_CHAN_ACCEL_XYZ;
|
|
|
|
if (IS_ENABLED(CONFIG_LIS2DH_ODR_RUNTIME)) {
|
|
struct sensor_value odr = {
|
|
.val1 = 1,
|
|
};
|
|
|
|
rc = sensor_attr_set(sensor, trig.chan,
|
|
SENSOR_ATTR_SAMPLING_FREQUENCY,
|
|
&odr);
|
|
if (rc != 0) {
|
|
printf("Failed to set odr: %d\n", rc);
|
|
return 0;
|
|
}
|
|
printf("Sampling at %u Hz\n", odr.val1);
|
|
}
|
|
|
|
rc = sensor_trigger_set(sensor, &trig, trigger_handler);
|
|
if (rc != 0) {
|
|
printf("Failed to set trigger: %d\n", rc);
|
|
return 0;
|
|
}
|
|
|
|
printf("Waiting for triggers\n");
|
|
while (true) {
|
|
k_sleep(K_MSEC(2000));
|
|
}
|
|
}
|
|
#else /* CONFIG_LIS2DH_TRIGGER */
|
|
printf("Polling at 0.5 Hz\n");
|
|
while (true) {
|
|
fetch_and_display(sensor);
|
|
k_sleep(K_MSEC(2000));
|
|
}
|
|
#endif /* CONFIG_LIS2DH_TRIGGER */
|
|
}
|