Line | |
---|
1 | #include <Wire.h>
|
---|
2 | #include <LSM303.h>
|
---|
3 |
|
---|
4 | LSM303 compass;
|
---|
5 | LSM303::vector running_min = {2047, 2047, 2047}, running_max = {-2048, -2048, -2048};
|
---|
6 |
|
---|
7 | void setup() {
|
---|
8 | Serial.begin(9600);
|
---|
9 | Serial.println("Starting ...");
|
---|
10 | Wire.begin();
|
---|
11 | Serial.println("Ini Wire");
|
---|
12 | compass.init();
|
---|
13 | Serial.println("Ini compass ...");
|
---|
14 | compass.enableDefault();
|
---|
15 | }
|
---|
16 |
|
---|
17 | void loop() {
|
---|
18 | compass.read();
|
---|
19 |
|
---|
20 | running_min.x = min(running_min.x, compass.m.x);
|
---|
21 | running_min.y = min(running_min.y, compass.m.y);
|
---|
22 | running_min.z = min(running_min.z, compass.m.z);
|
---|
23 |
|
---|
24 | running_max.x = max(running_max.x, compass.m.x);
|
---|
25 | running_max.y = max(running_max.y, compass.m.y);
|
---|
26 | running_max.z = max(running_max.z, compass.m.z);
|
---|
27 |
|
---|
28 | Serial.print("M min ");
|
---|
29 | Serial.print("X: ");
|
---|
30 | Serial.print((int)running_min.x);
|
---|
31 | Serial.print(" Y: ");
|
---|
32 | Serial.print((int)running_min.y);
|
---|
33 | Serial.print(" Z: ");
|
---|
34 | Serial.print((int)running_min.z);
|
---|
35 |
|
---|
36 | Serial.print(" M max ");
|
---|
37 | Serial.print("X: ");
|
---|
38 | Serial.print((int)running_max.x);
|
---|
39 | Serial.print(" Y: ");
|
---|
40 | Serial.print((int)running_max.y);
|
---|
41 | Serial.print(" Z: ");
|
---|
42 | Serial.println((int)running_max.z);
|
---|
43 |
|
---|
44 | delay(100);
|
---|
45 | }
|
---|
Note:
See
TracBrowser
for help on using the repository browser.