diff options
| author | Sam Anthony <sam@samanthony.xyz> | 2025-11-08 08:41:34 -0500 |
|---|---|---|
| committer | Sam Anthony <sam@samanthony.xyz> | 2025-11-08 08:41:34 -0500 |
| commit | 413d894d0637d7a4e55025664043ffa1c29e9bbb (patch) | |
| tree | cc8a5674c13ee04d39d1e7e4b363bdff1ad47c27 /sw/cal/can.go | |
| parent | b9ad4f9701304cd616337fd6df21f6442de743bd (diff) | |
| download | can-gauge-interface-413d894d0637d7a4e55025664043ffa1c29e9bbb.zip | |
cal: wash
Diffstat (limited to 'sw/cal/can.go')
| -rw-r--r-- | sw/cal/can.go | 25 |
1 files changed, 16 insertions, 9 deletions
diff --git a/sw/cal/can.go b/sw/cal/can.go index e47a42c..751ffd9 100644 --- a/sw/cal/can.go +++ b/sw/cal/can.go @@ -17,25 +17,31 @@ const ( timeout = 5 * time.Second ) -// Write a calibration table to the EEPROM. -func writeTable(tx *socketcan.Transmitter, tbl Table, sig int) error { +// Transmit a table in Table Control frames so the Interface can store it in its EEPROM. +func sendTable(tx *socketcan.Transmitter, tbl Table, sig int) error { + // Send populated rows var i int for i = 0; i < len(tbl.keys); i++ { - err := writeRow(tx, tbl.keys[i], tbl.vals[i], sig, i) + err := sendRow(tx, tbl.keys[i], tbl.vals[i], sig, i) if err != nil { return err } } + + // Fill rest of table with last row for ; i < tabRows; i++ { - err := writeRow(tx, tbl.keys[len(tbl.keys)-1], tbl.vals[len(tbl.keys)-1], sig, i) + err := sendRow(tx, tbl.keys[len(tbl.keys)-1], tbl.vals[len(tbl.keys)-1], sig, i) if err != nil { return err } } + return nil } -func writeRow(tx *socketcan.Transmitter, key int32, val uint16, sig int, row int) error { +// Transmit a Table Control frame containing one row of a table. +func sendRow(tx *socketcan.Transmitter, key int32, val uint16, sig int, row int) error { + // Serialize DATA FIELD var data [8]byte _, err := bin.Encode(data[0:4], bin.BigEndian, key) if err != nil { @@ -46,6 +52,7 @@ func writeRow(tx *socketcan.Transmitter, key int32, val uint16, sig int, row int return err } + // Construct ID and send frame frame := can.Frame{ ID: uint32(tblCtrlId) | uint32((sig<<5)&0xE0) | uint32(row&0x1F), Length: 6, @@ -54,18 +61,18 @@ func writeRow(tx *socketcan.Transmitter, key int32, val uint16, sig int, row int } ctx, _ := context.WithTimeout(context.Background(), timeout) return transmit(tx, frame, ctx) - } +// Transmit a CAN frame to the bus, retrying if the buffer is full. func transmit(tx *socketcan.Transmitter, frame can.Frame, ctx context.Context) error { for { err := tx.TransmitFrame(ctx, frame) if err == nil { - return nil + return nil // success } else if strings.HasSuffix(err.Error(), "no buffer space available") { - continue + continue // retry } else { - return err + return err // error, abort } } } |