forked from hybridgroup/gobot
-
Notifications
You must be signed in to change notification settings - Fork 0
/
pwm_pin.go
93 lines (74 loc) · 2 KB
/
pwm_pin.go
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
package raspi
import (
"errors"
"fmt"
"os"
"gobot.io/x/gobot"
"gobot.io/x/gobot/sysfs"
)
const piBlasterPeriod = 10000000
// PWMPin is the Raspberry Pi implementation of the PWMPinner interface.
// It uses Pi Blaster.
type PWMPin struct {
pin string
dc uint32
}
// NewPwmPin returns a new PWMPin
func NewPWMPin(pin string) *PWMPin {
return &PWMPin{
pin: pin}
}
// Export exports the pin for use by the Raspberry Pi
func (p *PWMPin) Export() error {
return nil
}
// Unexport unexports the pin and releases the pin from the operating system
func (p *PWMPin) Unexport() error {
return p.piBlaster(fmt.Sprintf("release %v\n", p.pin))
}
// Enable enables/disables the PWM pin
func (p *PWMPin) Enable(e bool) (err error) {
return nil
}
// Polarity returns the polarity either normal or inverted
func (p *PWMPin) Polarity() (polarity string, err error) {
return "normal", nil
}
// InvertPolarity does not do anything when using PiBlaster
func (p *PWMPin) InvertPolarity(invert bool) (err error) {
return nil
}
// Period returns the current PWM period for pin
func (p *PWMPin) Period() (period uint32, err error) {
return piBlasterPeriod, nil
}
// SetPeriod does not do anything when using PiBlaster
func (p *PWMPin) SetPeriod(period uint32) (err error) {
return nil
}
// DutyCycle returns the duty cycle for the pin
func (p *PWMPin) DutyCycle() (duty uint32, err error) {
return p.dc, nil
}
// SetDutyCycle writes the duty cycle to the pin
func (p *PWMPin) SetDutyCycle(duty uint32) (err error) {
if duty > piBlasterPeriod {
return errors.New("Duty cycle exceeds period.")
}
p.dc = duty
val := gobot.FromScale(float64(p.dc), 0, piBlasterPeriod)
// never go below minimum allowed duty for pi blaster
if val < 0.05 {
val = 0.05
}
return p.piBlaster(fmt.Sprintf("%v=%v\n", p.pin, val))
}
func (p *PWMPin) piBlaster(data string) (err error) {
fi, err := sysfs.OpenFile("/dev/pi-blaster", os.O_WRONLY|os.O_APPEND, 0644)
defer fi.Close()
if err != nil {
return err
}
_, err = fi.WriteString(data)
return
}