1
0
mirror of https://github.com/kidoman/embd synced 2024-12-23 05:10:05 +01:00
embd/samples/servo.go

57 lines
820 B
Go
Raw Normal View History

2014-03-02 12:36:34 +05:30
// +build ignore
package main
import (
"os"
"os/signal"
"time"
2014-03-03 00:51:23 +05:30
"github.com/kidoman/embd"
2014-02-10 05:05:41 +05:30
"github.com/kidoman/embd/controller/pca9685"
"github.com/kidoman/embd/motion/servo"
)
func main() {
2014-03-03 00:51:23 +05:30
if err := embd.InitI2C(); err != nil {
panic(err)
}
2014-03-03 00:51:23 +05:30
defer embd.CloseI2C()
2014-03-03 00:51:23 +05:30
bus := embd.NewI2CBus(1)
pwm := pca9685.New(bus, 0x41)
pwm.Freq = 50
2014-01-08 02:49:34 +05:30
pwm.Debug = true
defer pwm.Close()
servo := servo.New(pwm, 0)
2014-01-08 02:49:34 +05:30
servo.Debug = true
c := make(chan os.Signal, 1)
signal.Notify(c, os.Interrupt, os.Kill)
turnTimer := time.Tick(500 * time.Millisecond)
left := true
servo.SetAngle(90)
defer func() {
servo.SetAngle(90)
}()
for {
select {
case <-turnTimer:
left = !left
switch left {
case true:
servo.SetAngle(70)
case false:
servo.SetAngle(110)
}
case <-c:
return
}
}
}