87 lines
2.3 KiB
Go
87 lines
2.3 KiB
Go
package gpio
|
|
|
|
import "github.com/hybridgroup/gobot"
|
|
|
|
var _ gobot.Driver = (*ServoDriver)(nil)
|
|
|
|
// Represents a Servo
|
|
type ServoDriver struct {
|
|
name string
|
|
pin string
|
|
connection ServoWriter
|
|
gobot.Commander
|
|
CurrentAngle byte
|
|
}
|
|
|
|
// NewSerovDriver return a new ServoDriver given a Servo, name and pin.
|
|
//
|
|
// Adds the following API Commands:
|
|
// "Move" - See ServoDriver.Move
|
|
// "Min" - See ServoDriver.Min
|
|
// "Center" - See ServoDriver.Center
|
|
// "Max" - See ServoDriver.Max
|
|
func NewServoDriver(a ServoWriter, name string, pin string) *ServoDriver {
|
|
s := &ServoDriver{
|
|
name: name,
|
|
connection: a,
|
|
pin: pin,
|
|
Commander: gobot.NewCommander(),
|
|
CurrentAngle: 0,
|
|
}
|
|
|
|
s.AddCommand("Move", func(params map[string]interface{}) interface{} {
|
|
angle := byte(params["angle"].(float64))
|
|
return s.Move(angle)
|
|
})
|
|
s.AddCommand("Min", func(params map[string]interface{}) interface{} {
|
|
return s.Min()
|
|
})
|
|
s.AddCommand("Center", func(params map[string]interface{}) interface{} {
|
|
return s.Center()
|
|
})
|
|
s.AddCommand("Max", func(params map[string]interface{}) interface{} {
|
|
return s.Max()
|
|
})
|
|
|
|
return s
|
|
|
|
}
|
|
|
|
func (s *ServoDriver) Name() string { return s.name }
|
|
func (s *ServoDriver) Pin() string { return s.pin }
|
|
func (s *ServoDriver) Connection() gobot.Connection { return s.connection.(gobot.Connection) }
|
|
|
|
// Start starts the ServoDriver. Returns true on successful start of the driver.
|
|
func (s *ServoDriver) Start() (errs []error) { return }
|
|
|
|
// Halt halts the ServoDriver. Returns true on successful halt of the driver.
|
|
func (s *ServoDriver) Halt() (errs []error) { return }
|
|
|
|
// Move sets the servo to the specified angle
|
|
func (s *ServoDriver) Move(angle uint8) (err error) {
|
|
if !(angle >= 0 && angle <= 180) {
|
|
return ErrServoOutOfRange
|
|
}
|
|
s.CurrentAngle = angle
|
|
return s.connection.ServoWrite(s.Pin(), s.angleToSpan(angle))
|
|
}
|
|
|
|
// Min sets the servo to it's minimum position
|
|
func (s *ServoDriver) Min() (err error) {
|
|
return s.Move(0)
|
|
}
|
|
|
|
// Center sets the servo to it's center position
|
|
func (s *ServoDriver) Center() (err error) {
|
|
return s.Move(90)
|
|
}
|
|
|
|
// Max sets the servo to its maximum position
|
|
func (s *ServoDriver) Max() (err error) {
|
|
return s.Move(180)
|
|
}
|
|
|
|
func (s *ServoDriver) angleToSpan(angle byte) byte {
|
|
return byte(angle * (255 / 180))
|
|
}
|