blob: 8012ec617d366d019ec2c81a9a6c7db716d8dee9 [file] [log] [blame]
/*
* Copyright (c) 2018, Yannis Damigos
*
* SPDX-License-Identifier: Apache-2.0
*/
#include <zephyr/kernel.h>
#include <zephyr/device.h>
#include <zephyr/drivers/sensor.h>
#include <stdio.h>
#include <zephyr/sys/util.h>
static int32_t read_sensor(const struct device *sensor,
enum sensor_channel channel)
{
struct sensor_value val[3];
int32_t ret = 0;
ret = sensor_sample_fetch(sensor);
if (ret < 0 && ret != -EBADMSG) {
printf("Sensor sample update error\n");
goto end;
}
ret = sensor_channel_get(sensor, channel, val);
if (ret < 0) {
printf("Cannot read sensor channels\n");
goto end;
}
printf("( x y z ) = ( %f %f %f )\n", sensor_value_to_double(&val[0]),
sensor_value_to_double(&val[1]),
sensor_value_to_double(&val[2]));
end:
return ret;
}
int main(void)
{
const struct device *const accelerometer = DEVICE_DT_GET_ONE(st_lis2dh);
const struct device *const magnetometer = DEVICE_DT_GET_ONE(st_lsm303dlhc_magn);
if (!device_is_ready(accelerometer)) {
printf("Device %s is not ready\n", accelerometer->name);
return 0;
}
if (!device_is_ready(magnetometer)) {
printf("Device %s is not ready\n", magnetometer->name);
return 0;
}
while (1) {
printf("Magnetometer data:\n");
if (read_sensor(magnetometer, SENSOR_CHAN_MAGN_XYZ) < 0) {
printf("Failed to read magnetometer data\n");
}
printf("Accelerometer data:\n");
if (read_sensor(accelerometer, SENSOR_CHAN_ACCEL_XYZ) < 0) {
printf("Failed to read accelerometer data\n");
}
k_sleep(K_MSEC(2000));
}
return 0;
}