-
Notifications
You must be signed in to change notification settings - Fork 11
/
Copy pathReadSensorConfiguration.ino
60 lines (44 loc) · 1.68 KB
/
ReadSensorConfiguration.ino
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
/*
This sketch shows how to retrieve actual configuration
- sample rate and latency – from sensors.
*/
#include "Arduino_BHY2.h"
SensorXYZ accel(SENSOR_ID_ACC);
SensorXYZ gyro(SENSOR_ID_GYRO);
Sensor temp(SENSOR_ID_TEMP);
Sensor gas(SENSOR_ID_GAS);
SensorQuaternion rotation(SENSOR_ID_RV);
SensorConfig cfg;
void setup()
{
Serial.begin(115200);
while (!Serial);
BHY2.begin();
accel.begin();
gyro.begin();
temp.begin();
gas.begin();
rotation.begin();
}
void loop()
{
static auto printTime = millis();
// Update function should be continuously polled
BHY2.update();
if (millis() - printTime >= 1000) {
printTime = millis();
static float rate;
static uint32_t latency;
cfg = accel.getConfiguration();
Serial.println(String("acceleration configuration - rate: ") + cfg.sample_rate + String("Hz - latency: ") + cfg.latency + String("ms - range: ") + cfg.range);
cfg = gyro.getConfiguration();
Serial.println(String("gyro configuration - rate: ") + cfg.sample_rate + String(" - latency: ") + cfg.latency + String("ms - range: ") + cfg.range);
cfg = temp.getConfiguration();
Serial.println(String("temperature configuration - rate: ") + cfg.sample_rate + String(" - latency: ") + cfg.latency + String("ms - range: ") + cfg.range);
cfg = gas.getConfiguration();
Serial.println(String("gas configuration - rate: ") + cfg.sample_rate + String(" - latency: ") + cfg.latency + String("ms - range: ") + cfg.range);
cfg = rotation.getConfiguration();
Serial.println(String("rotation configuration - rate: ") + cfg.sample_rate + String(" - latency: ") + cfg.latency + String("ms - range: ") + cfg.range);
Serial.println();
}
}