mirror of
https://github.com/kidoman/embd
synced 2024-06-26 13:42:56 +02:00
51 lines
744 B
Go
51 lines
744 B
Go
|
package main
|
||
|
|
||
|
import (
|
||
|
"log"
|
||
|
"os"
|
||
|
"os/signal"
|
||
|
"time"
|
||
|
|
||
|
"github.com/kid0m4n/go-rpi/controller/servoblaster"
|
||
|
"github.com/kid0m4n/go-rpi/motion/servo"
|
||
|
)
|
||
|
|
||
|
func main() {
|
||
|
sb := servoblaster.New()
|
||
|
sb.Debug = true
|
||
|
defer sb.Close()
|
||
|
|
||
|
servo := servo.New(sb, 0, 500, 2500)
|
||
|
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
|
||
|
var err error
|
||
|
switch left {
|
||
|
case true:
|
||
|
err = servo.SetAngle(45)
|
||
|
case false:
|
||
|
err = servo.SetAngle(135)
|
||
|
}
|
||
|
if err != nil {
|
||
|
log.Panic(err)
|
||
|
}
|
||
|
case <-c:
|
||
|
return
|
||
|
}
|
||
|
}
|
||
|
}
|