mirror of
https://github.com/kidoman/embd
synced 2024-12-22 12:50:19 +01:00
49 lines
835 B
Go
49 lines
835 B
Go
// Package servo allows control of servos using a PWM controller.
|
|
package servo
|
|
|
|
import (
|
|
"log"
|
|
|
|
"github.com/kidoman/embd/util"
|
|
)
|
|
|
|
const (
|
|
minus = 544
|
|
maxus = 2400
|
|
)
|
|
|
|
// A PWM interface implements access to a pwm controller.
|
|
type PWM interface {
|
|
SetMicroseconds(channel int, us int) error
|
|
}
|
|
|
|
type Servo struct {
|
|
PWM PWM
|
|
Channel int
|
|
|
|
Minus, Maxus int
|
|
|
|
Debug bool
|
|
}
|
|
|
|
// New creates a new Servo interface.
|
|
func New(pwm PWM, channel int) *Servo {
|
|
return &Servo{
|
|
PWM: pwm,
|
|
Channel: channel,
|
|
Minus: minus,
|
|
Maxus: maxus,
|
|
}
|
|
}
|
|
|
|
// SetAngle sets the servo angle.
|
|
func (s *Servo) SetAngle(angle int) error {
|
|
us := util.Map(int64(angle), 0, 180, int64(s.Minus), int64(s.Maxus))
|
|
|
|
if s.Debug {
|
|
log.Printf("servo: given angle %v calculated %v us", angle, us)
|
|
}
|
|
|
|
return s.PWM.SetMicroseconds(s.Channel, int(us))
|
|
}
|