aboutsummaryrefslogtreecommitdiff
path: root/car/elegoo/main.go
blob: e73b73169ab67927d7340717c96832ca61664cda (plain)
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
package main

//go:generate sh -c "protoc --go_out=. *.proto"
//go:generate sh -c "protoc --nanopb_out=.. *.proto"

import (
	"bufio"
	"io"
	"log"
	"time"

	"github.com/dim13/cobs"
	"github.com/golang/protobuf/proto"
	"github.com/tarm/serial"
)

func Write(w io.Writer, pb proto.Message) error {
	buf := new(proto.Buffer)
	err := buf.EncodeMessage(pb)
	if err != nil {
		return err
	}
	log.Printf("write: % x", buf.Bytes()) // DEBUG
	block := cobs.Encode(buf.Bytes())
	_, err = w.Write(block)
	return err
}

func Read(buf *bufio.Reader, pb proto.Message) error {
	block, err := buf.ReadBytes(0)
	if err != nil {
		return err
	}
	block = cobs.Decode(block)
	return proto.NewBuffer(block).DecodeMessage(pb)
}

// /dev/cu.Elegoo-DevB
// /dev/cu.usbmodem1421

func main() {
	c := &serial.Config{
		Name: "/dev/tty.usbmodem1411",
		Baud: 57600,
	}
	s, err := serial.OpenPort(c)
	if err != nil {
		log.Fatal(err)
	}
	defer s.Close()

	go func() {
		cmd := &Command{}
		for i := -45; i < 45; i += 5 {
			cmd.TurnHead = int32(i)
			Write(s, cmd)
			time.Sleep(time.Second / 2)
		}
		cmd.TurnHead = 0
		cmd.Center = true
		Write(s, cmd)
	}()

	buf := bufio.NewReader(s)
	for {
		evt := &Event{}
		if err := Read(buf, evt); err != nil {
			log.Println("ERR", err)
		}
		log.Println(evt)
	}
}