mirror of https://github.com/kidoman/embd
37 lines
530 B
Go
37 lines
530 B
Go
package main
|
|
|
|
import (
|
|
"log"
|
|
"time"
|
|
|
|
"github.com/kid0m4n/go-rpi/i2c"
|
|
"github.com/kid0m4n/go-rpi/sensor/l3gd20"
|
|
)
|
|
|
|
func main() {
|
|
bus, err := i2c.NewBus(1)
|
|
if err != nil {
|
|
log.Panic(err)
|
|
}
|
|
gyro := l3gd20.New(bus, l3gd20.R250DPS)
|
|
defer gyro.Close()
|
|
|
|
x, y, z := 0.0, 0.0, 0.0
|
|
dt := 0.1 // Seconds
|
|
|
|
for {
|
|
dx, dy, dz, err := gyro.OrientationDelta()
|
|
if err != nil {
|
|
log.Panic(err)
|
|
}
|
|
|
|
x += dx * dt
|
|
y += dy * dt
|
|
z += dz * dt
|
|
|
|
log.Printf("%v", z)
|
|
|
|
time.Sleep(time.Duration(dt*1000) * time.Millisecond)
|
|
}
|
|
}
|