110 lines
2.7 KiB
Go
110 lines
2.7 KiB
Go
package uart
|
|
|
|
import (
|
|
"encoding/binary"
|
|
"fmt"
|
|
"log"
|
|
"math"
|
|
|
|
"alox.tool/api"
|
|
)
|
|
|
|
func ParseFrameVersion(frame api.Frame) (api.PayloadVersion, error) {
|
|
if len(frame.Data) != 10 {
|
|
return api.PayloadVersion{}, fmt.Errorf("payload wrong size: got %d bytes, want 10", len(frame.Data))
|
|
}
|
|
|
|
v := api.PayloadVersion{
|
|
Version: binary.LittleEndian.Uint16(frame.Data[0:2]),
|
|
Buildhash: [7]uint8(frame.Data[2:10])}
|
|
return v, nil
|
|
}
|
|
|
|
func parseFrameClientInfoPart(data []byte) (api.PayloadClientInfo, error) {
|
|
if len(data) != 19 {
|
|
return api.PayloadClientInfo{}, fmt.Errorf("payload wrong size: got %d bytes, want 19", len(data))
|
|
}
|
|
|
|
v := api.PayloadClientInfo{
|
|
ClientID: data[0],
|
|
IsAvailable: data[1],
|
|
SlotIsUsed: data[2],
|
|
MACAddr: [6]uint8(data[3:9]),
|
|
LastPing: binary.LittleEndian.Uint32(data[9:13]),
|
|
LastSuccessfulPing: binary.LittleEndian.Uint32(data[13:17]),
|
|
Version: binary.LittleEndian.Uint16(data[17:19]),
|
|
}
|
|
|
|
return v, nil
|
|
}
|
|
|
|
func ParseFrameClientInfo(frame api.Frame) ([]api.PayloadClientInfo, error) {
|
|
if len(frame.Data) == 0 {
|
|
return nil, fmt.Errorf("empty frame data")
|
|
}
|
|
|
|
clientCount := int(frame.Data[0])
|
|
|
|
log.Printf("Clients %d", clientCount)
|
|
|
|
expectedLen := 1 + (clientCount * 19)
|
|
|
|
if len(frame.Data) < expectedLen {
|
|
return nil, fmt.Errorf("frame data too short: got %d, want %d", len(frame.Data), expectedLen)
|
|
}
|
|
|
|
clientList := make([]api.PayloadClientInfo, 0, clientCount)
|
|
|
|
for i := 0; i < clientCount; i++ {
|
|
start := 1 + (i * 19)
|
|
end := start + 19
|
|
|
|
client, err := parseFrameClientInfoPart(frame.Data[start:end])
|
|
if err != nil {
|
|
log.Printf("Could not parse client part %d: %v", i, err)
|
|
continue
|
|
}
|
|
clientList = append(clientList, client)
|
|
}
|
|
|
|
return clientList, nil
|
|
}
|
|
|
|
func parse_uart_client_input(payloadBuffer []byte, payload_len int) {
|
|
|
|
clientCount := payloadBuffer[1]
|
|
fmt.Printf("Client Count %d\n", clientCount)
|
|
clientInputLen := 13
|
|
|
|
for i := 0; i < int(clientCount); i++ {
|
|
offset := 2 + (i * clientInputLen)
|
|
|
|
// --- Client ID (uint8) ---
|
|
clientID := payloadBuffer[offset]
|
|
offset += 1
|
|
|
|
fmt.Printf("Client: %d\n", clientID)
|
|
|
|
// --- Lage X (float32) ---
|
|
xBits := binary.LittleEndian.Uint32(payloadBuffer[offset : offset+4])
|
|
lageX := math.Float32frombits(xBits)
|
|
offset += 4
|
|
|
|
fmt.Printf("\tLAGE_X: %f\n", lageX)
|
|
|
|
// --- Lage Y (float32) ---
|
|
yBits := binary.LittleEndian.Uint32(payloadBuffer[offset : offset+4])
|
|
lageY := math.Float32frombits(yBits)
|
|
offset += 4
|
|
|
|
fmt.Printf("\tLAGE_Y: %f\n", lageY)
|
|
|
|
// --- Bitmask (int32) ---
|
|
maskBits := binary.LittleEndian.Uint32(payloadBuffer[offset : offset+4])
|
|
bitmask := uint32(maskBits)
|
|
offset += 4
|
|
|
|
fmt.Printf("\tBITMASK: %032b\n", bitmask)
|
|
}
|
|
}
|