mirror of
https://github.com/RIOT-OS/RIOT.git
synced 2024-12-29 04:50:03 +01:00
103 lines
2.6 KiB
C
103 lines
2.6 KiB
C
/*
|
|
* Copyright (C) 2017 OTA keys S.A.
|
|
* 2017 HAW Hamburg
|
|
*
|
|
* This file is subject to the terms and conditions of the GNU Lesser
|
|
* General Public License v2.1. See the file LICENSE in the top level
|
|
* directory for more details.
|
|
*/
|
|
|
|
/**
|
|
* @ingroup tests
|
|
* @{
|
|
*
|
|
* @file
|
|
* @brief Test application for the LSM6DSL accelerometer/gyroscope driver.
|
|
*
|
|
* @author Vincent Dupont <vincent@otakeys.com>
|
|
* @author Sebastian Meiling <s@mlng.net>
|
|
*
|
|
* @}
|
|
*/
|
|
|
|
#include <stdio.h>
|
|
|
|
#include "ztimer.h"
|
|
#include "lsm6dsl.h"
|
|
#include "lsm6dsl_params.h"
|
|
|
|
#define SLEEP_MSEC (500UL)
|
|
|
|
int main(void)
|
|
{
|
|
lsm6dsl_t dev;
|
|
int16_t temp_value;
|
|
lsm6dsl_3d_data_t mag_value;
|
|
lsm6dsl_3d_data_t acc_value;
|
|
|
|
puts("LSM6DSL test application");
|
|
printf("Initializing LSM6DSL sensor at I2C_%i... ", lsm6dsl_params->i2c);
|
|
|
|
if (lsm6dsl_init(&dev, lsm6dsl_params) != LSM6DSL_OK) {
|
|
puts("[ERROR]");
|
|
return 1;
|
|
}
|
|
puts("[SUCCESS]\n");
|
|
|
|
puts("Powering down LSM6DSL sensor...");
|
|
if (lsm6dsl_acc_power_down(&dev) != LSM6DSL_OK) {
|
|
puts("[ERROR]");
|
|
return 1;
|
|
}
|
|
if (lsm6dsl_gyro_power_down(&dev) != LSM6DSL_OK) {
|
|
puts("[ERROR]");
|
|
return 1;
|
|
}
|
|
puts("[SUCCESS]\n");
|
|
|
|
ztimer_sleep(ZTIMER_MSEC, 1 * 1000);
|
|
|
|
puts("Powering up LSM6DSL sensor...");
|
|
if (lsm6dsl_acc_power_up(&dev) != LSM6DSL_OK) {
|
|
puts("[ERROR]");
|
|
return 1;
|
|
}
|
|
if (lsm6dsl_gyro_power_up(&dev) != LSM6DSL_OK) {
|
|
puts("[ERROR]");
|
|
return 1;
|
|
}
|
|
puts("[SUCCESS]\n");
|
|
|
|
while (1) {
|
|
if (lsm6dsl_read_acc(&dev, &acc_value) == LSM6DSL_OK) {
|
|
printf("Accelerometer x: %i y: %i z: %i\n", acc_value.x,
|
|
acc_value.y,
|
|
acc_value.z);
|
|
}
|
|
else {
|
|
puts("[ERROR] reading accelerometer!\n");
|
|
}
|
|
|
|
if (lsm6dsl_read_gyro(&dev, &mag_value) == LSM6DSL_OK) {
|
|
printf("Gyroscope x: %i y: %i z: %i\n", mag_value.x,
|
|
mag_value.y,
|
|
mag_value.z);
|
|
}
|
|
else {
|
|
puts("[ERROR] reading gyroscope!\n");
|
|
}
|
|
|
|
if (lsm6dsl_read_temp(&dev, &temp_value) == LSM6DSL_OK) {
|
|
printf("Temperature [in °C x 100]: %i \n", temp_value);
|
|
}
|
|
else {
|
|
puts("[ERROR] reading temperature!\n");
|
|
}
|
|
|
|
puts("");
|
|
ztimer_sleep(ZTIMER_MSEC, SLEEP_MSEC);
|
|
}
|
|
|
|
return 0;
|
|
}
|