package can import ( "errors" "fmt" "os" "github.com/bettercap/bettercap/v2/network" "github.com/bettercap/bettercap/v2/session" "github.com/evilsocket/islazy/str" "github.com/evilsocket/islazy/tui" "github.com/hashicorp/go-bexpr" "go.einride.tech/can" "go.einride.tech/can/pkg/socketcan" ) type Message struct { Frame can.Frame Name string Source *network.CANDevice Signals map[string]string } func (mod *CANModule) compileDBC() error { input, err := os.ReadFile(mod.dbcPath) if err != nil { return fmt.Errorf("can't read %s: %v", mod.dbcPath, err) } mod.Info("compiling %s ...", mod.dbcPath) result, err := dbcCompile(mod.dbcPath, input) if err != nil { return fmt.Errorf("can't compile %s: %v", mod.dbcPath, err) } for _, warning := range result.Warnings { mod.Warning("%v", warning) } mod.dbc = result.Database return nil } func (mod *CANModule) Configure() error { var err error if mod.Running() { return session.ErrAlreadyStarted(mod.Name()) } else if err, mod.deviceName = mod.StringParam("can.device"); err != nil { return err } else if err, mod.transport = mod.StringParam("can.transport"); err != nil { return err } else if mod.transport != "can" && mod.transport != "udp" { return errors.New("invalid transport") } else if err, mod.dbcPath = mod.StringParam("can.dbc_path"); err != nil { return err } else if err, mod.filter = mod.StringParam("can.filter"); err != nil { return err } if mod.dbcPath != "" { if err := mod.compileDBC(); err != nil { return err } } else { mod.Warning("no can.dbc_path specified, messages won't be parsed") } if mod.filter != "" { if mod.filterExpr, err = bexpr.CreateEvaluator(mod.filter); err != nil { return err } mod.Warning("filtering frames with expression %s", tui.Bold(mod.filter)) } if mod.conn, err = socketcan.Dial(mod.transport, mod.deviceName); err != nil { return err } mod.recv = socketcan.NewReceiver(mod.conn) mod.send = socketcan.NewTransmitter(mod.conn) return nil } func (mod *CANModule) onFrame(frame can.Frame) { msg := Message{ Frame: frame, } // if we have a DBC database if mod.dbc != nil { // if the database contains this message id if message, found := mod.dbc.Message(frame.ID); found { msg.Name = message.Name // find source full info in DBC nodes sourceName := message.SenderNode sourceDesc := "" if sender, found := mod.dbc.Node(message.SenderNode); found { sourceName = sender.Name sourceDesc = sender.Description } // add CAN source if new _, msg.Source = mod.Session.CAN.AddIfNew(sourceName, sourceDesc, frame.Data[:]) msg.Signals = make(map[string]string) // parse signals for _, signal := range message.Signals { var value string if signal.Length <= 32 && signal.IsFloat { value = fmt.Sprintf("%f", signal.UnmarshalFloat(frame.Data)) } else if signal.Length == 1 { value = fmt.Sprintf("%v", signal.UnmarshalBool(frame.Data)) } else if signal.IsSigned { value = fmt.Sprintf("%d", signal.UnmarshalSigned(frame.Data)) } else { value = fmt.Sprintf("%d", signal.UnmarshalUnsigned(frame.Data)) } msg.Signals[signal.Name] = str.Trim(fmt.Sprintf("%s %s", value, signal.Unit)) } } } // if we have an active filter if mod.filter != "" { if res, err := mod.filterExpr.Evaluate(map[string]interface{}{ "message": msg, "frame": frame, }); err != nil { mod.Error("error evaluating '%s': %v", mod.filter, err) } else if !res { mod.Debug("skipping can message %+v", msg) return } } mod.Session.Events.Add("can.message", msg) } const canPrompt = "{br}{fw}{env.can.device} {fb}{reset} {bold}ยป {reset}" func (mod *CANModule) Start() error { if err := mod.Configure(); err != nil { return err } mod.SetPrompt(canPrompt) return mod.SetRunning(true, func() { mod.Info("started on %s ...", mod.deviceName) for mod.recv.Receive() { frame := mod.recv.Frame() mod.onFrame(frame) } }) } func (mod *CANModule) Stop() error { mod.SetPrompt(session.DefaultPrompt) return mod.SetRunning(false, func() { if mod.conn != nil { mod.recv.Close() mod.conn.Close() mod.conn = nil mod.recv = nil mod.send = nil mod.dbc = nil mod.dbcPath = "" mod.filter = "" } }) }