|
|
@ -28,6 +28,13 @@ const (
|
|
|
|
TargetNetworkUDP TargetNetwork = 0x02
|
|
|
|
TargetNetworkUDP TargetNetwork = 0x02
|
|
|
|
)
|
|
|
|
)
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
var addrParser = protocol.NewAddressParser(
|
|
|
|
|
|
|
|
protocol.AddressFamilyByte(byte(protocol.AddressTypeIPv4), net.AddressFamilyIPv4),
|
|
|
|
|
|
|
|
protocol.AddressFamilyByte(byte(protocol.AddressTypeDomain), net.AddressFamilyDomain),
|
|
|
|
|
|
|
|
protocol.AddressFamilyByte(byte(protocol.AddressTypeIPv6), net.AddressFamilyIPv6),
|
|
|
|
|
|
|
|
protocol.PortThenAddress(),
|
|
|
|
|
|
|
|
)
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
/*
|
|
|
|
Frame format
|
|
|
|
Frame format
|
|
|
|
2 bytes - length
|
|
|
|
2 bytes - length
|
|
|
@ -48,88 +55,55 @@ type FrameMetadata struct {
|
|
|
|
SessionStatus SessionStatus
|
|
|
|
SessionStatus SessionStatus
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
func (f FrameMetadata) AsSupplier() buf.Supplier {
|
|
|
|
func (f FrameMetadata) WriteTo(b *buf.Buffer) error {
|
|
|
|
return func(b []byte) (int, error) {
|
|
|
|
lenBytes := b.Bytes()
|
|
|
|
lengthBytes := b
|
|
|
|
b.AppendBytes(0x00, 0x00)
|
|
|
|
b = serial.Uint16ToBytes(uint16(0), b[:0]) // place holder for length
|
|
|
|
|
|
|
|
|
|
|
|
len0 := b.Len()
|
|
|
|
|
|
|
|
if err := b.AppendSupplier(serial.WriteUint16(f.SessionID)); err != nil {
|
|
|
|
|
|
|
|
return err
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
b = serial.Uint16ToBytes(f.SessionID, b)
|
|
|
|
b.AppendBytes(byte(f.SessionStatus), byte(f.Option))
|
|
|
|
b = append(b, byte(f.SessionStatus), byte(f.Option))
|
|
|
|
|
|
|
|
length := 4
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if f.SessionStatus == SessionStatusNew {
|
|
|
|
if f.SessionStatus == SessionStatusNew {
|
|
|
|
switch f.Target.Network {
|
|
|
|
switch f.Target.Network {
|
|
|
|
case net.Network_TCP:
|
|
|
|
case net.Network_TCP:
|
|
|
|
b = append(b, byte(TargetNetworkTCP))
|
|
|
|
b.AppendBytes(byte(TargetNetworkTCP))
|
|
|
|
case net.Network_UDP:
|
|
|
|
case net.Network_UDP:
|
|
|
|
b = append(b, byte(TargetNetworkUDP))
|
|
|
|
b.AppendBytes(byte(TargetNetworkUDP))
|
|
|
|
}
|
|
|
|
|
|
|
|
length++
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
b = serial.Uint16ToBytes(f.Target.Port.Value(), b)
|
|
|
|
|
|
|
|
length += 2
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
addr := f.Target.Address
|
|
|
|
|
|
|
|
switch addr.Family() {
|
|
|
|
|
|
|
|
case net.AddressFamilyIPv4:
|
|
|
|
|
|
|
|
b = append(b, byte(protocol.AddressTypeIPv4))
|
|
|
|
|
|
|
|
b = append(b, addr.IP()...)
|
|
|
|
|
|
|
|
length += 5
|
|
|
|
|
|
|
|
case net.AddressFamilyIPv6:
|
|
|
|
|
|
|
|
b = append(b, byte(protocol.AddressTypeIPv6))
|
|
|
|
|
|
|
|
b = append(b, addr.IP()...)
|
|
|
|
|
|
|
|
length += 17
|
|
|
|
|
|
|
|
case net.AddressFamilyDomain:
|
|
|
|
|
|
|
|
domain := addr.Domain()
|
|
|
|
|
|
|
|
if protocol.IsDomainTooLong(domain) {
|
|
|
|
|
|
|
|
return 0, newError("domain name too long: ", domain)
|
|
|
|
|
|
|
|
}
|
|
|
|
}
|
|
|
|
nDomain := len(domain)
|
|
|
|
|
|
|
|
b = append(b, byte(protocol.AddressTypeDomain), byte(nDomain))
|
|
|
|
if err := addrParser.WriteAddressPort(b, f.Target.Address, f.Target.Port); err != nil {
|
|
|
|
b = append(b, domain...)
|
|
|
|
return err
|
|
|
|
length += nDomain + 2
|
|
|
|
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
serial.Uint16ToBytes(uint16(length), lengthBytes[:0])
|
|
|
|
len1 := b.Len()
|
|
|
|
return length + 2, nil
|
|
|
|
serial.Uint16ToBytes(uint16(len1-len0), lenBytes)
|
|
|
|
}
|
|
|
|
return nil
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
func ReadFrameFrom(b []byte) (*FrameMetadata, error) {
|
|
|
|
func ReadFrameFrom(b *buf.Buffer) (*FrameMetadata, error) {
|
|
|
|
if len(b) < 4 {
|
|
|
|
if b.Len() < 4 {
|
|
|
|
return nil, newError("insufficient buffer: ", len(b))
|
|
|
|
return nil, newError("insufficient buffer: ", b.Len())
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
f := &FrameMetadata{
|
|
|
|
f := &FrameMetadata{
|
|
|
|
SessionID: serial.BytesToUint16(b[:2]),
|
|
|
|
SessionID: serial.BytesToUint16(b.BytesTo(2)),
|
|
|
|
SessionStatus: SessionStatus(b[2]),
|
|
|
|
SessionStatus: SessionStatus(b.Byte(2)),
|
|
|
|
Option: bitmask.Byte(b[3]),
|
|
|
|
Option: bitmask.Byte(b.Byte(3)),
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
b = b[4:]
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if f.SessionStatus == SessionStatusNew {
|
|
|
|
if f.SessionStatus == SessionStatusNew {
|
|
|
|
network := TargetNetwork(b[0])
|
|
|
|
network := TargetNetwork(b.Byte(4))
|
|
|
|
port := net.PortFromBytes(b[1:3])
|
|
|
|
b.SliceFrom(5)
|
|
|
|
addrType := protocol.AddressType(b[3])
|
|
|
|
|
|
|
|
b = b[4:]
|
|
|
|
addr, port, err := addrParser.ReadAddressPort(nil, b)
|
|
|
|
|
|
|
|
if err != nil {
|
|
|
|
var addr net.Address
|
|
|
|
return nil, newError("failed to parse address and port").Base(err)
|
|
|
|
switch addrType {
|
|
|
|
|
|
|
|
case protocol.AddressTypeIPv4:
|
|
|
|
|
|
|
|
addr = net.IPAddress(b[0:4])
|
|
|
|
|
|
|
|
b = b[4:]
|
|
|
|
|
|
|
|
case protocol.AddressTypeIPv6:
|
|
|
|
|
|
|
|
addr = net.IPAddress(b[0:16])
|
|
|
|
|
|
|
|
b = b[16:]
|
|
|
|
|
|
|
|
case protocol.AddressTypeDomain:
|
|
|
|
|
|
|
|
nDomain := int(b[0])
|
|
|
|
|
|
|
|
addr = net.DomainAddress(string(b[1 : 1+nDomain]))
|
|
|
|
|
|
|
|
b = b[nDomain+1:]
|
|
|
|
|
|
|
|
default:
|
|
|
|
|
|
|
|
return nil, newError("unknown address type: ", addrType)
|
|
|
|
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
switch network {
|
|
|
|
switch network {
|
|
|
|
case TargetNetworkTCP:
|
|
|
|
case TargetNetworkTCP:
|
|
|
|
f.Target = net.TCPDestination(addr, port)
|
|
|
|
f.Target = net.TCPDestination(addr, port)
|
|
|
|