refactor: move led and part modules to pkg
This commit is contained in:
112
pkg/part/part.go
Normal file
112
pkg/part/part.go
Normal file
@ -0,0 +1,112 @@
|
||||
package part
|
||||
|
||||
import (
|
||||
"fmt"
|
||||
"github.com/cyrilix/robocar-base/service"
|
||||
"github.com/cyrilix/robocar-led/pkg/led"
|
||||
"github.com/cyrilix/robocar-protobuf/go/events"
|
||||
mqtt "github.com/eclipse/paho.mqtt.golang"
|
||||
"github.com/golang/protobuf/proto"
|
||||
"go.uber.org/zap"
|
||||
"sync"
|
||||
"time"
|
||||
)
|
||||
|
||||
func NewPart(client mqtt.Client, driveModeTopic, recordTopic string) *LedPart {
|
||||
return &LedPart{
|
||||
led: led.New(),
|
||||
client: client,
|
||||
onDriveModeTopic: driveModeTopic,
|
||||
onRecordTopic: recordTopic,
|
||||
muDriveMode: sync.Mutex{},
|
||||
m: events.DriveMode_INVALID,
|
||||
muRecord: sync.Mutex{},
|
||||
recordEnabled: false,
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
type LedPart struct {
|
||||
led led.ColoredLed
|
||||
client mqtt.Client
|
||||
onDriveModeTopic string
|
||||
onRecordTopic string
|
||||
|
||||
muDriveMode sync.Mutex
|
||||
m events.DriveMode
|
||||
muRecord sync.Mutex
|
||||
recordEnabled bool
|
||||
}
|
||||
|
||||
func (p *LedPart) Start() error {
|
||||
if err := p.registerCallbacks(); err != nil {
|
||||
return fmt.Errorf("unable to start service: %v", err)
|
||||
}
|
||||
for {
|
||||
time.Sleep(1 * time.Hour)
|
||||
}
|
||||
}
|
||||
|
||||
func (p *LedPart) Stop() {
|
||||
defer p.led.SetBlink(0)
|
||||
defer p.led.SetGreen(0)
|
||||
defer p.led.SetBlue(0)
|
||||
defer p.led.SetRed(0)
|
||||
service.StopService("led", p.client, p.onDriveModeTopic, p.onRecordTopic)
|
||||
}
|
||||
|
||||
func (p *LedPart) onDriveMode(_ mqtt.Client, message mqtt.Message) {
|
||||
var driveModeMessage events.DriveModeMessage
|
||||
err := proto.Unmarshal(message.Payload(), &driveModeMessage)
|
||||
if err != nil {
|
||||
zap.S().Errorf("unable to unmarshal %T message: %v", driveModeMessage, err)
|
||||
return
|
||||
}
|
||||
switch driveModeMessage.GetDriveMode() {
|
||||
case events.DriveMode_USER:
|
||||
p.led.SetRed(0)
|
||||
p.led.SetGreen(255)
|
||||
p.led.SetBlue(0)
|
||||
case events.DriveMode_PILOT:
|
||||
p.led.SetRed(0)
|
||||
p.led.SetGreen(0)
|
||||
p.led.SetBlue(255)
|
||||
}
|
||||
}
|
||||
|
||||
func (p *LedPart) onRecord(client mqtt.Client, message mqtt.Message) {
|
||||
var switchRecord events.SwitchRecordMessage
|
||||
err := proto.Unmarshal(message.Payload(), &switchRecord)
|
||||
if err != nil {
|
||||
zap.S().Errorf("unable to unmarchal %T message: %v", switchRecord, err)
|
||||
return
|
||||
}
|
||||
|
||||
p.muRecord.Lock()
|
||||
defer p.muRecord.Unlock()
|
||||
if p.recordEnabled == switchRecord.GetEnabled() {
|
||||
return
|
||||
}
|
||||
p.recordEnabled = switchRecord.GetEnabled()
|
||||
|
||||
if switchRecord.GetEnabled() {
|
||||
zap.S().Info("record mode enabled")
|
||||
p.led.SetBlink(2)
|
||||
} else {
|
||||
zap.S().Info("record mode disabled")
|
||||
p.led.SetBlink(0)
|
||||
}
|
||||
}
|
||||
|
||||
func (p *LedPart) registerCallbacks() error {
|
||||
err := service.RegisterCallback(p.client, p.onDriveModeTopic, p.onDriveMode)
|
||||
if err != nil {
|
||||
return err
|
||||
}
|
||||
|
||||
err = service.RegisterCallback(p.client, p.onRecordTopic, p.onRecord)
|
||||
if err != nil {
|
||||
return err
|
||||
}
|
||||
return nil
|
||||
}
|
||||
104
pkg/part/part_test.go
Normal file
104
pkg/part/part_test.go
Normal file
@ -0,0 +1,104 @@
|
||||
package part
|
||||
|
||||
import (
|
||||
"github.com/cyrilix/robocar-base/testtools"
|
||||
"github.com/cyrilix/robocar-protobuf/go/events"
|
||||
mqtt "github.com/eclipse/paho.mqtt.golang"
|
||||
"github.com/golang/protobuf/proto"
|
||||
"testing"
|
||||
"time"
|
||||
)
|
||||
|
||||
type fakeLed struct {
|
||||
red, green, blue int
|
||||
blink bool
|
||||
}
|
||||
|
||||
func (f *fakeLed) SetBlink(freq float64) {
|
||||
if freq > 0 {
|
||||
f.blink = true
|
||||
} else {
|
||||
f.blink = false
|
||||
}
|
||||
}
|
||||
|
||||
func (f *fakeLed) SetRed(value int) {
|
||||
f.red = value
|
||||
}
|
||||
|
||||
func (f *fakeLed) SetGreen(value int) {
|
||||
f.green = value
|
||||
}
|
||||
|
||||
func (f *fakeLed) SetBlue(value int) {
|
||||
f.blue = value
|
||||
}
|
||||
|
||||
func TestLedPart_OnDriveMode(t *testing.T) {
|
||||
led := fakeLed{}
|
||||
p := LedPart{led: &led}
|
||||
|
||||
cases := []struct {
|
||||
msg mqtt.Message
|
||||
red, green, blue int
|
||||
}{
|
||||
{testtools.NewFakeMessageFromProtobuf("drive", &events.DriveModeMessage{DriveMode: events.DriveMode_USER}), 0, 255, 0},
|
||||
{testtools.NewFakeMessageFromProtobuf("drive", &events.DriveModeMessage{DriveMode: events.DriveMode_PILOT}), 0, 0, 255},
|
||||
{testtools.NewFakeMessageFromProtobuf("drive", &events.DriveModeMessage{DriveMode: events.DriveMode_INVALID}), 0, 0, 255},
|
||||
}
|
||||
|
||||
for _, c := range cases {
|
||||
p.onDriveMode(nil, c.msg)
|
||||
time.Sleep(1 * time.Millisecond)
|
||||
var msg events.DriveModeMessage
|
||||
err := proto.Unmarshal(c.msg.Payload(), &msg)
|
||||
if err != nil {
|
||||
t.Errorf("unable to unmarshal drive mode message: %v", err)
|
||||
}
|
||||
value := msg.DriveMode
|
||||
if led.red != c.red {
|
||||
t.Errorf("driveMode(%v)=invalid value for red channel: %v, wants %v", value, led.red, c.red)
|
||||
}
|
||||
if led.green != c.green {
|
||||
if err != nil {
|
||||
t.Errorf("payload isn't a led value: %v", err)
|
||||
}
|
||||
t.Errorf("driveMode(%v)=invalid value for green channel: %v, wants %v", value, led.green, c.green)
|
||||
}
|
||||
if led.blue != c.blue {
|
||||
if err != nil {
|
||||
t.Errorf("payload isn't a led value: %v", err)
|
||||
}
|
||||
t.Errorf("driveMode(%v)=invalid value for blue channel: %v, wants %v", value, led.blue, c.blue)
|
||||
}
|
||||
}
|
||||
}
|
||||
func TestLedPart_OnRecord(t *testing.T) {
|
||||
led := fakeLed{}
|
||||
p := LedPart{led: &led}
|
||||
|
||||
cases := []struct {
|
||||
msg mqtt.Message
|
||||
record bool
|
||||
blink bool
|
||||
}{
|
||||
{testtools.NewFakeMessageFromProtobuf("record", &events.SwitchRecordMessage{Enabled: false}), true, false},
|
||||
{testtools.NewFakeMessageFromProtobuf("record", &events.SwitchRecordMessage{Enabled: true}), false, true},
|
||||
{testtools.NewFakeMessageFromProtobuf("record", &events.SwitchRecordMessage{Enabled: false}), true, false},
|
||||
{testtools.NewFakeMessageFromProtobuf("record", &events.SwitchRecordMessage{Enabled: true}), false, true},
|
||||
}
|
||||
|
||||
for _, c := range cases {
|
||||
p.onRecord(nil, c.msg)
|
||||
if led.blink != c.blink {
|
||||
var msg events.SwitchRecordMessage
|
||||
err := proto.Unmarshal(c.msg.Payload(), &msg)
|
||||
if err != nil {
|
||||
t.Errorf("unable to unmarshal %T message: %v", msg, err)
|
||||
}
|
||||
|
||||
value := msg.Enabled
|
||||
t.Errorf("onRecord(%v): %v, wants %v", value, c.record, led.blink)
|
||||
}
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user