go-embedded/embd
go-embedded/embd
1
0
Fork 0
mirror of https://github.com/kidoman/embd synced 2024-12-22 04:40:04 +01:00
Code Issues Releases Wiki Activity

l3gd20: its actually the orientation delta

Browse Source
This commit is contained in:
Karan Misra 2014-01-07 20:53:41 +05:30
parent 236cd2fd33
commit 58a1eb5a56
2 changed files with 12 additions and 19 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

13
samples/l3gd20.go
View File

@ -17,10 +17,10 @@ func main() {
defer gyro.Close()
x, y, z := 0.0, 0.0, 0.0
dt := 0.02
dt := 0.1 // Seconds
for {
dx, dy, dz, err := gyro.Orientation()
dx, dy, dz, err := gyro.OrientationDelta()
if err != nil {
log.Panic(err)
}
@ -29,14 +29,7 @@ func main() {
y += dy * dt
z += dz * dt
log.Printf("Orientation is (%v, %v, %v)", x, y, z)
temp, err := gyro.Temperature()
if err != nil {
log.Panic(err)
}
log.Printf("Temperature is %v", temp)
log.Printf("%v", z)
time.Sleep(time.Duration(dt*1000) * time.Millisecond)
}

18
sensor/l3gd20/l3gd20.go
View File

@ -90,7 +90,7 @@ var (
// A L3GD20 implements access to the L3GD20 sensor.
type L3GD20 interface {
// Orientation returns the current orientation reading.
Orientation() (x, y, z float64, err error)
OrientationDelta() (x, y, z float64, err error)
// Temperature returns the current temperature reading.
Temperature() (temp int, err error)
@ -114,7 +114,7 @@ func (ac axisCalibration) String() string {
}
type data struct {
x, y, z float64
dx, dy, dz float64
}
type l3gd20 struct {
@ -290,28 +290,28 @@ func (d *l3gd20) calibratedOrientation(a *axis) (value float64, err error) {
return
}
func (d *l3gd20) measureOrientation() (x, y, z float64, err error) {
func (d *l3gd20) measureOrientation() (dx, dy, dz float64, err error) {
if err = d.setup(); err != nil {
return
}
if x, err = d.calibratedOrientation(ax); err != nil {
if dx, err = d.calibratedOrientation(ax); err != nil {
return
}
if y, err = d.calibratedOrientation(ay); err != nil {
if dy, err = d.calibratedOrientation(ay); err != nil {
return
}
if z, err = d.calibratedOrientation(az); err != nil {
if dz, err = d.calibratedOrientation(az); err != nil {
return
}
return
}
func (d *l3gd20) Orientation() (x, y, z float64, err error) {
func (d *l3gd20) OrientationDelta() (dx, dy, dz float64, err error) {
select {
case data := <-d.orientations:
x, y, z = data.x, data.y, data.z
dx, dy, dz = data.dx, data.dy, data.dz
return
default:
if d.debug {
@ -350,7 +350,7 @@ func (d *l3gd20) Run() (err error) {
select {
case <-timer:
var err error
dt.x, dt.y, dt.z, err = d.measureOrientation()
dt.dx, dt.dy, dt.dz, err = d.measureOrientation()
if err == nil && d.orientations == nil {
d.orientations = make(chan data)
}