81 lines
1.4 KiB
Go
81 lines
1.4 KiB
Go
package main
|
|
|
|
import (
|
|
"os"
|
|
"strconv"
|
|
"time"
|
|
|
|
"gobot.io/x/gobot"
|
|
"gobot.io/x/gobot/platforms/ble"
|
|
"gobot.io/x/gobot/platforms/mqtt"
|
|
"gobot.io/x/gobot/platforms/sphero/ollie"
|
|
)
|
|
|
|
const (
|
|
FRENTE = 0
|
|
DERECHA = 90
|
|
ATRAS = 180
|
|
IZQUIERDA = 270
|
|
)
|
|
|
|
func main() {
|
|
bleAdaptor := ble.NewClientAdaptor(os.Args[1])
|
|
ollie := ollie.NewDriver(bleAdaptor)
|
|
|
|
mqttAdaptor := mqtt.NewAdaptor("tcp://iot.eclipse.org:1883", "ollie")
|
|
|
|
work := func() {
|
|
ollie.SetRGB(255, 0, 255)
|
|
|
|
mqttAdaptor.On("sensores/dial", func(data []byte) {
|
|
val, _ := strconv.Atoi(string(data))
|
|
|
|
if val > 2000 {
|
|
ollie.SetRGB(0, 255, 0)
|
|
return
|
|
}
|
|
if val > 1000 {
|
|
ollie.SetRGB(255, 255, 0)
|
|
return
|
|
}
|
|
ollie.SetRGB(255, 0, 0)
|
|
})
|
|
|
|
mqttAdaptor.On("rover/frente", func(data []byte) {
|
|
ollie.Roll(40, FRENTE)
|
|
gobot.After(1*time.Second, func() {
|
|
ollie.Stop()
|
|
})
|
|
})
|
|
|
|
mqttAdaptor.On("rover/derecha", func(data []byte) {
|
|
ollie.Roll(40, DERECHA)
|
|
gobot.After(1*time.Second, func() {
|
|
ollie.Stop()
|
|
})
|
|
})
|
|
|
|
mqttAdaptor.On("rover/atras", func(data []byte) {
|
|
ollie.Roll(40, ATRAS)
|
|
gobot.After(1*time.Second, func() {
|
|
ollie.Stop()
|
|
})
|
|
})
|
|
|
|
mqttAdaptor.On("rover/izquierda", func(data []byte) {
|
|
ollie.Roll(40, IZQUIERDA)
|
|
gobot.After(1*time.Second, func() {
|
|
ollie.Stop()
|
|
})
|
|
})
|
|
}
|
|
|
|
robot := gobot.NewRobot("ollieBot",
|
|
[]gobot.Connection{bleAdaptor, mqttAdaptor},
|
|
[]gobot.Device{ollie},
|
|
work,
|
|
)
|
|
|
|
robot.Start()
|
|
}
|