2015-08-16 23:33:34 +00:00
|
|
|
package main
|
|
|
|
|
|
|
|
import (
|
2016-07-14 00:49:07 +00:00
|
|
|
"../mpu"
|
2015-08-16 23:33:34 +00:00
|
|
|
"fmt"
|
|
|
|
"net"
|
2015-08-20 20:47:05 +00:00
|
|
|
"time"
|
2015-08-16 23:33:34 +00:00
|
|
|
)
|
|
|
|
|
2016-07-13 22:42:25 +00:00
|
|
|
var attSensor mpu.MPU
|
2015-08-16 23:33:34 +00:00
|
|
|
|
|
|
|
func readMPU6050() (float64, float64) {
|
2016-07-13 20:36:33 +00:00
|
|
|
pitch, _ := attSensor.Pitch()
|
|
|
|
roll, _ := attSensor.Roll()
|
2015-08-16 23:33:34 +00:00
|
|
|
|
|
|
|
return pitch, roll
|
|
|
|
}
|
|
|
|
|
|
|
|
func initMPU6050() {
|
2016-07-13 22:42:25 +00:00
|
|
|
attSensor = mpu.NewMPU6050()
|
2015-08-16 23:33:34 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
func main() {
|
|
|
|
initMPU6050()
|
|
|
|
addr, err := net.ResolveUDPAddr("udp", "192.168.1.255:49002")
|
|
|
|
if err != nil {
|
|
|
|
panic(err)
|
|
|
|
}
|
|
|
|
outConn, err := net.DialUDP("udp", nil, addr)
|
|
|
|
for {
|
|
|
|
pitch, roll := readMPU6050()
|
2016-07-13 20:36:33 +00:00
|
|
|
heading, _ := attSensor.Heading()
|
|
|
|
s := fmt.Sprintf("XATTMy Sim,%f,%f,%f", heading, pitch, roll)
|
2015-08-16 23:33:34 +00:00
|
|
|
fmt.Printf("%f, %f\n", pitch, roll)
|
|
|
|
outConn.Write([]byte(s))
|
|
|
|
time.Sleep(50 * time.Millisecond)
|
|
|
|
}
|
2015-08-20 20:47:05 +00:00
|
|
|
}
|