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) } }