aboutsummaryrefslogtreecommitdiffstats
path: root/sw/cal/main.go
blob: 98e021c7b40f36a16a8bece8cf8f2bd9ced1c53d (plain) (blame)
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
94
95
package main

import (
	"flag"
	"fmt"
	"os"

	"go.einride.tech/can/pkg/dbc"
)

const dev = "can0"

type Signals struct {
	tach, speed, an1, an2, an3, an4 *dbc.SignalDef
}

// Flags
var (
	// DBC file
	dbcFilenameFlag = "dbc"
	dbcFilename = flag.String(dbcFilenameFlag, "", "DBC file name")

	// Signal names
	tachSigFlag = "tachSig"
	speedSigFlag = "speedSig"
	an1SigFlag = "an1Sig"
	an2SigFlag = "an2Sig"
	an3SigFlag = "an3Sig"
	an4SigFlag = "an4Sig"
	tachSig = flag.String(tachSigFlag, "", "tachometer signal name")
	speedSig = flag.String(speedSigFlag, "", "speedometer signal name")
	an1Sig = flag.String(an1SigFlag, "", "analog channel 1 signal name")
	an2Sig = flag.String(an2SigFlag, "", "analog channel 2 signal name")
	an3Sig = flag.String(an3SigFlag, "", "analog channel 3 signal name")
	an4Sig = flag.String(an4SigFlag, "", "analog channel 4 signal name")

	// Calibration tables
	// TODO
)

func main() {
	// Parse command line args
	flag.Parse()
	if *dbcFilename == "" {
		weprintf("Missing '%s' flag.\n", dbcFilenameFlag)
		flag.Usage()
		os.Exit(1)
	}

	// Parse DBC file
	msgDefs, err := parseDbcFile(*dbcFilename)
	if err != nil {
		eprintf("Error parsing %s: %v\n", *dbcFilename, err)
	}


	for _, msg := range msgDefs {
		for _, sig := range msg.Signals {
			fmt.Println(sig)
		}
	}
}

func parseDbcFile(filename string) ([]*dbc.MessageDef, error) {
	// Read file
	buf, err := os.ReadFile(filename)
	if err != nil {
		return nil, err
	}

	// Parse file
	parser := dbc.NewParser(filename, buf)
	if err := parser.Parse(); err != nil {
		return nil, err
	}

	// Filter message definitions
	defs := parser.Defs()
	msgDefs := make([]*dbc.MessageDef, 0, len(defs))
	for _, def := range defs {
		if msg, ok := def.(*dbc.MessageDef); ok {
			msgDefs = append(msgDefs, msg)
		}
	}
	return msgDefs, nil
}

func eprintf(format string, a ...any) {
	weprintf(format, a...)
	os.Exit(1)
}

func weprintf(format string, a ...any) {
	fmt.Fprintf(os.Stderr, format, a...)
}