main.c
2.53 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
/*
* 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 "xtimer.h"
#include "lsm6dsl.h"
#include "lsm6dsl_params.h"
#define SLEEP (500UL * US_PER_MS)
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");
xtimer_sleep(1);
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("");
xtimer_usleep(SLEEP);
}
return 0;
}