robocars/robocar-pca9685
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

Use channel to exit start loop

Browse Source
This commit is contained in:
Cyrille Nofficial 2020-01-01 20:43:13 +01:00
parent 3b228216fa
commit 6157e27850
1 changed files with 16 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

23
part/part.go
View File

@ -26,6 +26,8 @@ type Pca9685Part struct {
throttleTopic string
steeringTopic string
cancel chan interface{}
}
func NewPca9685Part(client MQTT.Client, throttleCtrl *actuator.Throttle, steeringCtrl *actuator.Steering, updateFrequency int, throttleTopic, steeringTopic string) *Pca9685Part {
@ -36,6 +38,7 @@ func NewPca9685Part(client MQTT.Client, throttleCtrl *actuator.Throttle, steerin
updateFrequency: updateFrequency,
throttleTopic: throttleTopic,
steeringTopic: steeringTopic,
cancel: make(chan interface{}),
}
}
@ -43,22 +46,28 @@ func (p *Pca9685Part) Start() error {
if err := p.registerCallbacks(); err != nil {
return fmt.Errorf("unable to start service: %v", err)
}
defer p.Stop()
ticker := time.NewTicker(time.Second / time.Duration(p.updateFrequency))
for {
time.Sleep(time.Second / time.Duration(p.updateFrequency))
p.updateCtrl()
select {
case <-ticker.C:
p.updateCtrl()
case <-p.cancel:
return nil
}
}
}
func (p *Pca9685Part) Stop() {
close(p.cancel)
service.StopService("pca9685", p.client, p.throttleTopic, p.steeringTopic)
}
func (p *Pca9685Part) onThrottleChange(_ MQTT.Client, message MQTT.Message) {
var throttle types.Throttle
err := json.Unmarshal(message.Payload(), throttle)
err := json.Unmarshal(message.Payload(), &throttle)
if err != nil {
log.Printf("[%v] unable to unmarshall throttle msg: %v",message.Topic(), err)
log.Printf("[%v] unable to unmarshall throttle msg: %v", message.Topic(), err)
return
}
p.muThrottle.Lock()
@ -68,9 +77,9 @@ func (p *Pca9685Part) onThrottleChange(_ MQTT.Client, message MQTT.Message) {
func (p *Pca9685Part) onSteeringChange(_ MQTT.Client, message MQTT.Message) {
var steering types.Steering
err := json.Unmarshal(message.Payload(), steering)
err := json.Unmarshal(message.Payload(), &steering)
if err != nil {
log.Printf("[%v] unable to unmarshall steering msg: %v",message.Topic(), err)
log.Printf("[%v] unable to unmarshall steering msg: %v", message.Topic(), err)
return
}
p.muSteering.Lock()