-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathsensor_raw.go
53 lines (46 loc) · 926 Bytes
/
sensor_raw.go
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
package main
import (
"fmt"
"git.sapienzaapps.it/SeismoCloud/seismocloud-sensor-raspberrypi/accelero"
"time"
)
func rawLogMain(absolute bool) {
a, err := accelero.NewADXL345Accelerometer()
if err != nil {
panic(err)
}
err = a.Start()
if err != nil {
panic(err)
}
t := time.NewTicker(50 * time.Millisecond)
avgX := NewRunningAvgFloat64()
avgY := NewRunningAvgFloat64()
avgZ := NewRunningAvgFloat64()
if absolute {
for i := 0; i < 100; i++ {
probe, _ := a.ProbeValue()
avgX.AddValue(probe.X)
avgY.AddValue(probe.Y)
avgZ.AddValue(probe.Z)
<-t.C
}
}
for {
probe, err := a.ProbeValue()
if err != nil {
panic(err)
}
if absolute {
probe.X = probe.X - avgX.GetAverage()
probe.Y = probe.Y - avgY.GetAverage()
probe.Z = probe.Z - avgZ.GetAverage()
}
fmt.Printf("%f\t%f\t%f\n", probe.X, probe.Y, probe.Z)
<-t.C
}
err = a.Stop()
if err != nil {
panic(err)
}
}