mirror of
https://github.com/nonoo/kappanhang.git
synced 2026-01-21 16:10:16 +01:00
Make opening serial/audio stream consistent
This commit is contained in:
Nonoo
parent
aad9b54e3d
commit
91b3eb7358
|
|
@ -10,7 +10,7 @@ type audioStream struct {
|
|||
common streamCommon
|
||||
}
|
||||
|
||||
func (s *audioStream) Start() {
|
||||
func (s *audioStream) start() {
|
||||
s.common.open("audio", 50003)
|
||||
|
||||
s.common.sendPkt3()
|
||||
|
|
|
|||
|
|
@ -15,38 +15,11 @@ type controlStream struct {
|
|||
authSendSeq uint16
|
||||
authInnerSendSeq uint16
|
||||
authID [6]byte
|
||||
randIDByteForPktSeven [1]byte
|
||||
expectedPkt7ReplySeq uint16
|
||||
serialAndAudioStreamOpened bool
|
||||
requestSerialAndAudioTimeout *time.Timer
|
||||
}
|
||||
|
||||
func (s *controlStream) sendPkt7(replyID []byte, seq uint16) {
|
||||
// Example request from PC: 0x15, 0x00, 0x00, 0x00, 0x07, 0x00, 0x09, 0x00, 0xbe, 0xd9, 0xf2, 0x63, 0xe4, 0x35, 0xdd, 0x72, 0x00, 0x78, 0x40, 0xf6, 0x02
|
||||
// Example reply from radio: 0x00, 0x00, 0x00, 0x00, 0x07, 0x00, 0x09, 0x00, 0xe4, 0x35, 0xdd, 0x72, 0xbe, 0xd9, 0xf2, 0x63, 0x01, 0x78, 0x40, 0xf6, 0x02
|
||||
var replyFlag byte
|
||||
if replyID == nil {
|
||||
replyID = make([]byte, 4)
|
||||
var randID [2]byte
|
||||
_, err := rand.Read(randID[:])
|
||||
if err != nil {
|
||||
log.Fatal(err)
|
||||
}
|
||||
replyID[0] = randID[0]
|
||||
replyID[1] = randID[1]
|
||||
replyID[2] = s.randIDByteForPktSeven[0]
|
||||
replyID[3] = 0x03
|
||||
|
||||
s.expectedPkt7ReplySeq = s.common.sendSeq
|
||||
} else {
|
||||
replyFlag = 0x01
|
||||
}
|
||||
|
||||
s.common.send([]byte{0x15, 0x00, 0x00, 0x00, 0x07, 0x00, byte(seq), byte(seq >> 8),
|
||||
byte(s.common.localSID >> 24), byte(s.common.localSID >> 16), byte(s.common.localSID >> 8), byte(s.common.localSID),
|
||||
byte(s.common.remoteSID >> 24), byte(s.common.remoteSID >> 16), byte(s.common.remoteSID >> 8), byte(s.common.remoteSID),
|
||||
replyFlag, replyID[0], replyID[1], replyID[2], replyID[3]})
|
||||
}
|
||||
|
||||
func (s *controlStream) sendPktLogin() {
|
||||
// The reply to the login packet will contain a 6 bytes long auth ID with the first 2 bytes set to our randID.
|
||||
var randID [2]byte
|
||||
|
|
@ -54,7 +27,7 @@ func (s *controlStream) sendPktLogin() {
|
|||
if err != nil {
|
||||
log.Fatal(err)
|
||||
}
|
||||
s.common.send([]byte{0x80, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, 0x00,
|
||||
s.common.send([]byte{0x80, 0x00, 0x00, 0x00, 0x00, 0x00, byte(s.authSendSeq), byte(s.authSendSeq >> 8),
|
||||
byte(s.common.localSID >> 24), byte(s.common.localSID >> 16), byte(s.common.localSID >> 8), byte(s.common.localSID),
|
||||
byte(s.common.remoteSID >> 24), byte(s.common.remoteSID >> 16), byte(s.common.remoteSID >> 8), byte(s.common.remoteSID),
|
||||
0x00, 0x00, 0x00, 0x70, 0x01, 0x00, 0x00, byte(s.authInnerSendSeq),
|
||||
|
|
@ -71,6 +44,7 @@ func (s *controlStream) sendPktLogin() {
|
|||
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
|
||||
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
|
||||
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00})
|
||||
|
||||
s.authSendSeq++
|
||||
s.authInnerSendSeq++
|
||||
}
|
||||
|
|
@ -109,12 +83,13 @@ func (s *controlStream) sendPktReauth(firstReauthSend bool) {
|
|||
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
|
||||
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
|
||||
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00})
|
||||
|
||||
s.authSendSeq++
|
||||
s.authInnerSendSeq++
|
||||
}
|
||||
|
||||
func (s *controlStream) SendDisconnect() {
|
||||
s.common.send([]byte{0x40, 0x00, 0x00, 0x00, 0x00, 0x00, byte(s.common.sendSeq), byte(s.common.sendSeq >> 8),
|
||||
func (s *controlStream) sendDisconnect() {
|
||||
s.common.send([]byte{0x40, 0x00, 0x00, 0x00, 0x00, 0x00, byte(s.authSendSeq), byte(s.authSendSeq >> 8),
|
||||
byte(s.common.localSID >> 24), byte(s.common.localSID >> 16), byte(s.common.localSID >> 8), byte(s.common.localSID),
|
||||
byte(s.common.remoteSID >> 24), byte(s.common.remoteSID >> 16), byte(s.common.remoteSID >> 8), byte(s.common.remoteSID),
|
||||
0x00, 0x00, 0x00, 0x30, 0x01, 0x01, 0x00, byte(s.authInnerSendSeq),
|
||||
|
|
@ -128,6 +103,14 @@ func (s *controlStream) SendDisconnect() {
|
|||
byte(s.common.remoteSID >> 24), byte(s.common.remoteSID >> 16), byte(s.common.remoteSID >> 8), byte(s.common.remoteSID)})
|
||||
}
|
||||
|
||||
func (s *controlStream) sendPkt0() {
|
||||
s.common.send([]byte{0x10, 0x00, 0x00, 0x00, 0x00, 0x00, byte(s.authSendSeq), byte(s.authSendSeq >> 8),
|
||||
byte(s.common.localSID >> 24), byte(s.common.localSID >> 16), byte(s.common.localSID >> 8), byte(s.common.localSID),
|
||||
byte(s.common.remoteSID >> 24), byte(s.common.remoteSID >> 16), byte(s.common.remoteSID >> 8), byte(s.common.remoteSID)})
|
||||
|
||||
s.authSendSeq++
|
||||
}
|
||||
|
||||
func (s *controlStream) sendRequestSerialAndAudio() {
|
||||
log.Print("requesting serial and audio stream")
|
||||
s.common.send([]byte{0x90, 0x00, 0x00, 0x00, 0x00, 0x00, byte(s.authSendSeq), byte(s.authSendSeq >> 8),
|
||||
|
|
@ -149,6 +132,7 @@ func (s *controlStream) sendRequestSerialAndAudio() {
|
|||
0x00, 0x00, 0xbb, 0x80, 0x00, 0x00, 0xc3, 0x52,
|
||||
0x00, 0x00, 0xc3, 0x53, 0x00, 0x00, 0x00, 0x64,
|
||||
0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00})
|
||||
|
||||
s.authSendSeq++
|
||||
s.authInnerSendSeq++
|
||||
|
||||
|
|
@ -166,7 +150,7 @@ func (s *controlStream) handleRead(r []byte) {
|
|||
// Replying to the radio.
|
||||
// Example request from radio: 0x00, 0x00, 0x00, 0x00, 0x07, 0x00, 0x1c, 0x0e, 0xe4, 0x35, 0xdd, 0x72, 0xbe, 0xd9, 0xf2, 0x63, 0x00, 0x57, 0x2b, 0x12, 0x00
|
||||
// Example answer from PC: 0x15, 0x00, 0x00, 0x00, 0x07, 0x00, 0x1c, 0x0e, 0xbe, 0xd9, 0xf2, 0x63, 0xe4, 0x35, 0xdd, 0x72, 0x01, 0x57, 0x2b, 0x12, 0x00
|
||||
s.sendPkt7(r[17:21], gotSeq)
|
||||
s.common.sendPkt7Reply(r[17:21], gotSeq)
|
||||
} else { // This is a pkt7 reply to our request.
|
||||
if s.expectedPkt7ReplySeq != gotSeq {
|
||||
var missingPkts int
|
||||
|
|
@ -207,7 +191,7 @@ func (s *controlStream) handleRead(r []byte) {
|
|||
exit(errors.New("reauth failed"))
|
||||
}
|
||||
case 144:
|
||||
if bytes.Equal(r[:6], []byte{0x90, 0x00, 0x00, 0x00, 0x00, 0x00}) && r[96] == 1 {
|
||||
if !s.serialAndAudioStreamOpened && bytes.Equal(r[:6], []byte{0x90, 0x00, 0x00, 0x00, 0x00, 0x00}) && r[96] == 1 {
|
||||
// Example answer:
|
||||
// 0x90, 0x00, 0x00, 0x00, 0x00, 0x00, 0x19, 0x00,
|
||||
// 0xc6, 0x5f, 0x6f, 0x0c, 0x5f, 0x8b, 0x1e, 0x89,
|
||||
|
|
@ -228,39 +212,42 @@ func (s *controlStream) handleRead(r []byte) {
|
|||
// 0x00, 0x00, 0x00, 0x00, 0xc0, 0xa8, 0x03, 0x03,
|
||||
// 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
|
||||
log.Print("serial and audio request success")
|
||||
s.requestSerialAndAudioTimeout.Stop()
|
||||
s.requestSerialAndAudioTimeout = nil
|
||||
go streams.audio.Start()
|
||||
if s.requestSerialAndAudioTimeout != nil {
|
||||
s.requestSerialAndAudioTimeout.Stop()
|
||||
s.requestSerialAndAudioTimeout = nil
|
||||
}
|
||||
go streams.audio.start()
|
||||
s.serialAndAudioStreamOpened = true
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
func (s *controlStream) Start() {
|
||||
func (s *controlStream) start() {
|
||||
s.common.open("control", 50001)
|
||||
|
||||
s.common.sendPkt3()
|
||||
s.common.sendSeq = 1
|
||||
s.sendPkt7(nil, s.common.sendSeq)
|
||||
s.common.sendSeq = 0
|
||||
s.common.pkt7.sendSeq = 1
|
||||
s.common.sendPkt7()
|
||||
s.common.sendPkt3()
|
||||
|
||||
// Expecting a Pkt4 answer.
|
||||
log.Debug("expecting a pkt4 answer")
|
||||
// Example answer from radio: 0x10, 0x00, 0x00, 0x00, 0x04, 0x00, 0x00, 0x00, 0x8c, 0x7d, 0x45, 0x7a, 0x1d, 0xf6, 0xe9, 0x0b
|
||||
r := s.common.expect(16, []byte{0x10, 0x00, 0x00, 0x00, 0x04, 0x00, 0x00, 0x00})
|
||||
s.common.remoteSID = binary.BigEndian.Uint32(r[8:12])
|
||||
|
||||
log.Debugf("got remote session id %.8x", s.common.remoteSID)
|
||||
|
||||
s.authSendSeq = 1
|
||||
s.authInnerSendSeq = 0x50
|
||||
s.common.sendPkt6()
|
||||
|
||||
// Expecting a Pkt6 answer.
|
||||
log.Debug("expecting pkt6 answer")
|
||||
r = s.common.expect(16, []byte{0x10, 0x00, 0x00, 0x00, 0x06, 0x00, 0x01, 0x00})
|
||||
s.common.remoteSID = binary.BigEndian.Uint32(r[8:12]) // TODO
|
||||
// Example answer from radio: 0x10, 0x00, 0x00, 0x00, 0x06, 0x00, 0x01, 0x00, 0xe8, 0xd0, 0x44, 0x50, 0xa0, 0x61, 0x39, 0xbe
|
||||
s.common.remoteSID = binary.BigEndian.Uint32(r[8:12])
|
||||
|
||||
s.authSendSeq = 1
|
||||
s.authInnerSendSeq = 0x50
|
||||
s.sendPktLogin()
|
||||
s.common.sendSeq = 5
|
||||
s.common.pkt7.sendSeq = 5
|
||||
|
||||
// Example success auth packet: 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, 0x00,
|
||||
// 0xe6, 0xb2, 0x7b, 0x7b, 0xbb, 0x41, 0x3f, 0x2b,
|
||||
|
|
@ -282,11 +269,8 @@ func (s *controlStream) Start() {
|
|||
copy(s.authID[:], r[26:32])
|
||||
log.Print("auth ok")
|
||||
s.sendPktReauth(true)
|
||||
|
||||
_, err := rand.Read(s.randIDByteForPktSeven[:])
|
||||
if err != nil {
|
||||
log.Fatal(err)
|
||||
}
|
||||
s.sendPkt0()
|
||||
s.sendRequestSerialAndAudio()
|
||||
|
||||
readChan := make(chan []byte)
|
||||
go s.common.reader(readChan)
|
||||
|
|
@ -295,16 +279,14 @@ func (s *controlStream) Start() {
|
|||
reauthTicker := time.NewTicker(60 * time.Second)
|
||||
statusLogTicker := time.NewTicker(10 * time.Second)
|
||||
|
||||
time.AfterFunc(time.Second*2, s.sendRequestSerialAndAudio)
|
||||
|
||||
for {
|
||||
select {
|
||||
case r = <-readChan:
|
||||
s.handleRead(r)
|
||||
case <-pingTicker.C:
|
||||
s.sendPkt7(nil, s.common.sendSeq)
|
||||
s.common.sendPkt3()
|
||||
s.common.sendSeq++
|
||||
s.expectedPkt7ReplySeq = s.common.pkt7.sendSeq
|
||||
s.common.sendPkt7()
|
||||
s.sendPkt0()
|
||||
case <-reauthTicker.C:
|
||||
s.sendPktReauth(false)
|
||||
case <-statusLogTicker.C:
|
||||
|
|
|
|||
6
main.go
6
main.go
|
|
@ -14,7 +14,8 @@ var streams struct {
|
|||
}
|
||||
|
||||
func exit(err error) {
|
||||
streams.control.SendDisconnect()
|
||||
log.Print("disconnecting")
|
||||
streams.control.sendDisconnect()
|
||||
if err == nil {
|
||||
os.Exit(0)
|
||||
} else {
|
||||
|
|
@ -28,7 +29,6 @@ func setupCloseHandler() {
|
|||
signal.Notify(c, os.Interrupt, syscall.SIGTERM)
|
||||
go func() {
|
||||
<-c
|
||||
log.Print("disconnecting")
|
||||
exit(nil)
|
||||
}()
|
||||
}
|
||||
|
|
@ -38,5 +38,5 @@ func main() {
|
|||
parseArgs()
|
||||
setupCloseHandler()
|
||||
|
||||
streams.control.Start()
|
||||
streams.control.start()
|
||||
}
|
||||
|
|
|
|||
|
|
@ -2,6 +2,8 @@ package main
|
|||
|
||||
import (
|
||||
"bytes"
|
||||
"crypto/rand"
|
||||
"encoding/binary"
|
||||
"fmt"
|
||||
"net"
|
||||
"time"
|
||||
|
|
@ -14,7 +16,11 @@ type streamCommon struct {
|
|||
conn *net.UDPConn
|
||||
localSID uint32
|
||||
remoteSID uint32
|
||||
sendSeq uint16
|
||||
|
||||
pkt7 struct {
|
||||
sendSeq uint16
|
||||
randIDByte [1]byte
|
||||
}
|
||||
}
|
||||
|
||||
func (s *streamCommon) send(d []byte) {
|
||||
|
|
@ -64,7 +70,7 @@ func (s *streamCommon) expect(packetLength int, b []byte) []byte {
|
|||
break
|
||||
}
|
||||
if time.Since(expectStart) > time.Second {
|
||||
log.Fatal("expect timeout")
|
||||
log.Fatal(s.name + "/expect timeout")
|
||||
}
|
||||
}
|
||||
return r
|
||||
|
|
@ -78,26 +84,64 @@ func (s *streamCommon) open(name string, portNumber int) {
|
|||
if err != nil {
|
||||
log.Fatal(err)
|
||||
}
|
||||
laddr := net.UDPAddr{
|
||||
Port: portNumber,
|
||||
}
|
||||
s.conn, err = net.DialUDP("udp", &laddr, raddr)
|
||||
s.conn, err = net.DialUDP("udp", nil, raddr)
|
||||
if err != nil {
|
||||
log.Fatal(err)
|
||||
}
|
||||
|
||||
s.localSID = uint32(time.Now().Unix())
|
||||
// Constructing the local session ID by combining the local IP address and port.
|
||||
laddr := s.conn.LocalAddr().(*net.UDPAddr)
|
||||
s.localSID = binary.BigEndian.Uint32(laddr.IP[len(laddr.IP)-4:])<<16 | uint32(laddr.Port&0xffff)
|
||||
log.Debugf(s.name+"/using session id %.8x", s.localSID)
|
||||
|
||||
_, err = rand.Read(s.pkt7.randIDByte[:])
|
||||
if err != nil {
|
||||
log.Fatal(err)
|
||||
}
|
||||
}
|
||||
|
||||
func (p *streamCommon) sendPkt3() {
|
||||
p.send([]byte{0x10, 0x00, 0x00, 0x00, 0x03, 0x00, byte(p.sendSeq), byte(p.sendSeq >> 8),
|
||||
byte(p.localSID >> 24), byte(p.localSID >> 16), byte(p.localSID >> 8), byte(p.localSID),
|
||||
byte(p.remoteSID >> 24), byte(p.remoteSID >> 16), byte(p.remoteSID >> 8), byte(p.remoteSID)})
|
||||
func (s *streamCommon) sendPkt3() {
|
||||
s.send([]byte{0x10, 0x00, 0x00, 0x00, 0x03, 0x00, 0x00, 0x00,
|
||||
byte(s.localSID >> 24), byte(s.localSID >> 16), byte(s.localSID >> 8), byte(s.localSID),
|
||||
byte(s.remoteSID >> 24), byte(s.remoteSID >> 16), byte(s.remoteSID >> 8), byte(s.remoteSID)})
|
||||
}
|
||||
|
||||
func (p *streamCommon) sendPkt6() {
|
||||
p.send([]byte{0x10, 0x00, 0x00, 0x00, 0x06, 0x00, 0x01, 0x00,
|
||||
byte(p.localSID >> 24), byte(p.localSID >> 16), byte(p.localSID >> 8), byte(p.localSID),
|
||||
byte(p.remoteSID >> 24), byte(p.remoteSID >> 16), byte(p.remoteSID >> 8), byte(p.remoteSID)})
|
||||
func (s *streamCommon) sendPkt6() {
|
||||
s.send([]byte{0x10, 0x00, 0x00, 0x00, 0x06, 0x00, 0x01, 0x00,
|
||||
byte(s.localSID >> 24), byte(s.localSID >> 16), byte(s.localSID >> 8), byte(s.localSID),
|
||||
byte(s.remoteSID >> 24), byte(s.remoteSID >> 16), byte(s.remoteSID >> 8), byte(s.remoteSID)})
|
||||
}
|
||||
|
||||
func (s *streamCommon) sendPkt7Do(replyID []byte, seq uint16) {
|
||||
// Example request from PC: 0x15, 0x00, 0x00, 0x00, 0x07, 0x00, 0x09, 0x00, 0xbe, 0xd9, 0xf2, 0x63, 0xe4, 0x35, 0xdd, 0x72, 0x00, 0x78, 0x40, 0xf6, 0x02
|
||||
// Example reply from radio: 0x00, 0x00, 0x00, 0x00, 0x07, 0x00, 0x09, 0x00, 0xe4, 0x35, 0xdd, 0x72, 0xbe, 0xd9, 0xf2, 0x63, 0x01, 0x78, 0x40, 0xf6, 0x02
|
||||
var replyFlag byte
|
||||
if replyID == nil {
|
||||
replyID = make([]byte, 4)
|
||||
var randID [2]byte
|
||||
_, err := rand.Read(randID[:])
|
||||
if err != nil {
|
||||
log.Fatal(err)
|
||||
}
|
||||
replyID[0] = randID[0]
|
||||
replyID[1] = randID[1]
|
||||
replyID[2] = s.pkt7.randIDByte[0]
|
||||
replyID[3] = 0x03
|
||||
} else {
|
||||
replyFlag = 0x01
|
||||
}
|
||||
|
||||
s.send([]byte{0x15, 0x00, 0x00, 0x00, 0x07, 0x00, byte(seq), byte(seq >> 8),
|
||||
byte(s.localSID >> 24), byte(s.localSID >> 16), byte(s.localSID >> 8), byte(s.localSID),
|
||||
byte(s.remoteSID >> 24), byte(s.remoteSID >> 16), byte(s.remoteSID >> 8), byte(s.remoteSID),
|
||||
replyFlag, replyID[0], replyID[1], replyID[2], replyID[3]})
|
||||
}
|
||||
|
||||
func (s *streamCommon) sendPkt7() {
|
||||
s.sendPkt7Do(nil, s.pkt7.sendSeq)
|
||||
s.pkt7.sendSeq++
|
||||
}
|
||||
|
||||
func (s *streamCommon) sendPkt7Reply(replyID []byte, seq uint16) {
|
||||
s.sendPkt7Do(replyID, seq)
|
||||
}
|
||||
|
|
|
|||
Loading…
Reference in a new issue