add support for PWM balanced mode

This commit is contained in:
youngkin 2021-11-03 17:44:36 +00:00
parent 2ab4c0432c
commit 02c0360e26

28
rpio.go
View File

@ -146,6 +146,12 @@ const (
High
)
// Which PWM algorithm to use, Balanced or Mark/Space
const (
Balanced = iota
MarkSpace
)
// Pull Up / Down / Off
const (
PullOff Pull = iota
@ -222,6 +228,11 @@ func (pin Pin) DutyCycle(dutyLen, cycleLen uint32) {
SetDutyCycle(pin, dutyLen, cycleLen)
}
// DutyCycleMsen: Set duty cycle for Pwm pin (see doc of SetDutyCycle)
func (pin Pin) DutyCycleMsen(dutyLen, cycleLen, msen uint32) {
SetDutyCycleMsen(pin, dutyLen, cycleLen, msen)
}
// Mode: Set pin Mode
func (pin Pin) Mode(mode Mode) {
PinMode(pin, mode)
@ -497,7 +508,7 @@ func PullMode(pin Pin, pull Pull) {
case PullUp:
p = 1
case PullDown:
p = 2;
p = 2
}
// This is verbatim C code from raspi-gpio.c
@ -628,11 +639,22 @@ func SetFreq(pin Pin, freq int) {
// channel 1 (pwm0) for pins 12, 18, 40
// channel 2 (pwm1) for pins 13, 19, 41, 45.
func SetDutyCycle(pin Pin, dutyLen, cycleLen uint32) {
SetDutyCycleMsen(pin, dutyLen, cycleLen, 1) // Default PWM algorithm is Mark/Space, msen = 1
}
// SetDutyCycleMsen extends SetDutyCycle to allow for the specification of the PWM
// algorithm to be used, Balanced or Mark/Space. 'msen' is used to indicate which
// PWM algorithm to use. The constants Balanced or Markspace should be used as the
// value. See 'SetDutyCycle(pin, dutyLen, cycleLen)' above for more information
// regarding how to use 'SetDutyCycleMsen()'
func SetDutyCycleMsen(pin Pin, dutyLen, cycleLen, msen uint32) {
const pwmCtlReg = 0
var (
pwmDatReg uint
pwmRngReg uint
shift uint // offset inside ctlReg
)
switch pin {
@ -646,11 +668,12 @@ func SetDutyCycle(pin Pin, dutyLen, cycleLen uint32) {
shift = 8
default:
return
}
const ctlMask = 255 // ctl setting has 8 bits for each channel
const pwen = 1 << 0 // enable pwm
const msen = 1 << 7 // use M/S transition instead of pwm algorithm
msen = msen << 7
// reset settings
pwmMem[pwmCtlReg] = pwmMem[pwmCtlReg]&^(ctlMask<<shift) | msen<<shift | pwen<<shift
@ -660,6 +683,7 @@ func SetDutyCycle(pin Pin, dutyLen, cycleLen uint32) {
time.Sleep(time.Microsecond * 10)
// NOTE without root permission this changes will simply do nothing successfully
}
// StopPwm: Stop pwm for both channels