You cannot select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

90 lines
2.0 KiB
Go

package lc
import (
"fmt"
dmr "github.com/pd0mz/go-dmr"
)
// Data Format
// ref: ETSI TS 102 361-2 7.2.18
const (
Format7Bit uint8 = iota
FormatISO8Bit
FormatUTF8
FormatUTF16BE
)
// DataFormatName is a map of data format to string.
var DataFormatName = map[uint8]string{
Format7Bit: "7 bit",
FormatISO8Bit: "ISO 8 bit",
FormatUTF8: "unicode utf-8",
FormatUTF16BE: "unicode utf-16be",
}
// TalkerAliasHeaderPDU Conforms to ETSI TS 102 361-2 7.1.1.4
type TalkerAliasHeaderPDU struct {
DataFormat uint8
Length uint8
Data []byte
}
// TalkerAliasBlockPDU Conforms to ETSI TS 102 361-2 7.1.1.5
type TalkerAliasBlockPDU struct {
Data []byte
}
// ParseTalkerAliasHeaderPDU parses TalkerAliasHeader PDU from bytes
func ParseTalkerAliasHeaderPDU(data []byte) (*TalkerAliasHeaderPDU, error) {
if len(data) != 7 {
return nil, fmt.Errorf("dmr/lc/talkeralias: expected 7 bytes, got %d", len(data))
}
// TODO parse bit 49
return &TalkerAliasHeaderPDU{
DataFormat: (data[0] & dmr.B11000000) >> 6,
Length: (data[0] & dmr.B00111110) >> 1,
Data: data[1:6],
}, nil
}
// Bytes returns object as bytes
func (t *TalkerAliasHeaderPDU) Bytes() []byte {
return []byte{
((t.DataFormat << 6) & dmr.B11000000) | ((t.Length << 1) & dmr.B00111110), // TODO bit 49
t.Data[0],
t.Data[1],
t.Data[2],
t.Data[3],
t.Data[4],
t.Data[5],
}
}
func (t *TalkerAliasHeaderPDU) String() string {
return fmt.Sprintf("TalkerAliasHeader: [ format: %s, length: %d, data: \"%s\" ]",
DataFormatName[t.DataFormat], t.Length, string(t.Data))
}
// ParseTalkerAliasBlockPDU parse talker alias block pdu
func ParseTalkerAliasBlockPDU(data []byte) (*TalkerAliasBlockPDU, error) {
if len(data) != 7 {
return nil, fmt.Errorf("dmr/lc/talkeralias: expected 7 bytes, got %d", len(data))
}
return &TalkerAliasBlockPDU{
Data: data[0:6],
}, nil
}
// Bytes returns object as bytes
func (t *TalkerAliasBlockPDU) Bytes() []byte {
return t.Data
}
func (t *TalkerAliasBlockPDU) String() string {
return fmt.Sprintf("TalkerAliasBlock: [ data: \"%s\" ]", string(t.Data))
}