40 lines
822 B
Go
40 lines
822 B
Go
|
package actuator
|
||
|
|
|
||
|
|
import (
|
||
|
|
"log"
|
||
|
|
"periph.io/x/periph/conn/i2c/i2creg"
|
||
|
|
"periph.io/x/periph/conn/physic"
|
||
|
|
"periph.io/x/periph/experimental/devices/pca9685"
|
||
|
|
"periph.io/x/periph/host"
|
||
|
|
)
|
||
|
|
|
||
|
|
var (
|
||
|
|
device *pca9685.Dev
|
||
|
|
)
|
||
|
|
|
||
|
|
func init() {
|
||
|
|
log.Print("init pca9685 controller")
|
||
|
|
_, err := host.Init()
|
||
|
|
if err != nil {
|
||
|
|
log.Fatalf("unable to init host: %v", err)
|
||
|
|
}
|
||
|
|
|
||
|
|
log.Print("open i2c bus")
|
||
|
|
bus, err := i2creg.Open("")
|
||
|
|
if err != nil {
|
||
|
|
log.Fatalf("unable to init i2c bus: %v", err)
|
||
|
|
}
|
||
|
|
log.Print("i2c bus opened")
|
||
|
|
|
||
|
|
device, err = pca9685.NewI2C(bus, pca9685.I2CAddr)
|
||
|
|
if err != nil {
|
||
|
|
log.Fatalf("unable to init pca9685 bus: %v", err)
|
||
|
|
}
|
||
|
|
log.Printf("set pwm frequency to %d", 60)
|
||
|
|
err = device.SetPwmFreq(60 * physic.Hertz)
|
||
|
|
if err != nil {
|
||
|
|
log.Fatalf("unable to set pwm frequency: %v", err)
|
||
|
|
}
|
||
|
|
log.Print("init done")
|
||
|
|
}
|