89 lines
1.7 KiB
Go
89 lines
1.7 KiB
Go
package main
|
|
|
|
import (
|
|
"fmt"
|
|
"io"
|
|
"log"
|
|
"net"
|
|
"sync"
|
|
"time"
|
|
)
|
|
|
|
type PacketWithData struct {
|
|
MessageType uint16
|
|
Added time.Time
|
|
Data []byte
|
|
}
|
|
|
|
type PacketQueue struct {
|
|
mu sync.RWMutex
|
|
Packets []PacketWithData
|
|
connection net.Conn
|
|
}
|
|
|
|
func NewPacketQueue(connection net.Conn) *PacketQueue {
|
|
|
|
queue := &PacketQueue{
|
|
Packets: make([]PacketWithData, 0),
|
|
connection: connection,
|
|
}
|
|
go func() {
|
|
defer connection.Close()
|
|
for {
|
|
messageType, data, err := ReceivePacket(queue.connection)
|
|
ts := time.Now()
|
|
if err != nil {
|
|
log.Printf("Error receiving packet: %v\n", err)
|
|
if err == io.EOF {
|
|
return
|
|
}
|
|
|
|
//return
|
|
}
|
|
|
|
queue.mu.Lock()
|
|
now := time.Now().Add(-time.Millisecond * 500)
|
|
keepIndex := -1
|
|
for i, packet := range queue.Packets {
|
|
if packet.Added.After(now) {
|
|
keepIndex = i
|
|
break
|
|
}
|
|
}
|
|
if keepIndex == -1 {
|
|
queue.Packets = queue.Packets[:0]
|
|
} else {
|
|
queue.Packets = queue.Packets[keepIndex:]
|
|
}
|
|
queue.Packets = append(queue.Packets, PacketWithData{
|
|
MessageType: messageType,
|
|
Added: ts,
|
|
Data: data,
|
|
})
|
|
queue.mu.Unlock()
|
|
packetsReceived.Inc()
|
|
packetQueue.Set(float64(len(queue.Packets)))
|
|
}
|
|
}()
|
|
return queue
|
|
}
|
|
|
|
func (p *PacketQueue) Expect(messageType uint16, timeToWait time.Duration) (*PacketWithData, error) {
|
|
start := time.Now().Add(-time.Millisecond)
|
|
|
|
for {
|
|
if time.Since(start) > timeToWait {
|
|
return nil, fmt.Errorf("timeout waiting for message type %d", messageType)
|
|
}
|
|
p.mu.RLock()
|
|
for _, packet := range p.Packets {
|
|
if packet.MessageType == messageType && packet.Added.After(start) {
|
|
p.mu.RUnlock()
|
|
return &packet, nil
|
|
}
|
|
}
|
|
p.mu.RUnlock()
|
|
time.Sleep(time.Millisecond * 2)
|
|
}
|
|
}
|