2014-01-02 02:20:57 +01:00
|
|
|
package main
|
|
|
|
|
|
|
|
import (
|
|
|
|
"log"
|
2014-01-07 17:41:41 +01:00
|
|
|
"os"
|
|
|
|
"os/signal"
|
2014-01-02 02:20:57 +01:00
|
|
|
|
|
|
|
"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)
|
2014-01-08 15:14:56 +01:00
|
|
|
gyro.Poll = 50
|
2014-01-02 02:20:57 +01:00
|
|
|
defer gyro.Close()
|
|
|
|
|
2014-01-07 17:41:41 +01:00
|
|
|
gyro.Start()
|
2014-01-02 02:20:57 +01:00
|
|
|
|
2014-01-07 17:41:41 +01:00
|
|
|
quit := make(chan os.Signal, 1)
|
|
|
|
signal.Notify(quit, os.Interrupt, os.Kill)
|
2014-01-02 02:20:57 +01:00
|
|
|
|
2014-01-07 17:41:41 +01:00
|
|
|
orientations, err := gyro.Orientations()
|
|
|
|
if err != nil {
|
|
|
|
log.Panic(err)
|
|
|
|
}
|
2014-01-02 02:20:57 +01:00
|
|
|
|
2014-01-07 17:41:41 +01:00
|
|
|
for {
|
|
|
|
select {
|
|
|
|
case orientation := <-orientations:
|
|
|
|
log.Printf("x: %v, y: %v, z: %v", orientation.X, orientation.Y, orientation.Z)
|
|
|
|
case <-quit:
|
|
|
|
return
|
|
|
|
}
|
2014-01-02 02:20:57 +01:00
|
|
|
}
|
|
|
|
}
|