|
|
@@ -28,6 +28,13 @@ const (
|
|
|
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
|
|
|
2 bytes - length
|
|
|
@@ -48,88 +55,55 @@ type FrameMetadata struct {
|
|
|
SessionStatus SessionStatus
|
|
|
}
|
|
|
|
|
|
-func (f FrameMetadata) AsSupplier() buf.Supplier {
|
|
|
- return func(b []byte) (int, error) {
|
|
|
- lengthBytes := b
|
|
|
- b = serial.Uint16ToBytes(uint16(0), b[:0]) // place holder for length
|
|
|
-
|
|
|
- b = serial.Uint16ToBytes(f.SessionID, b)
|
|
|
- b = append(b, byte(f.SessionStatus), byte(f.Option))
|
|
|
- length := 4
|
|
|
-
|
|
|
- if f.SessionStatus == SessionStatusNew {
|
|
|
- switch f.Target.Network {
|
|
|
- case net.Network_TCP:
|
|
|
- b = append(b, byte(TargetNetworkTCP))
|
|
|
- case net.Network_UDP:
|
|
|
- b = append(b, 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))
|
|
|
- b = append(b, domain...)
|
|
|
- length += nDomain + 2
|
|
|
- }
|
|
|
+func (f FrameMetadata) WriteTo(b *buf.Buffer) error {
|
|
|
+ lenBytes := b.Bytes()
|
|
|
+ b.AppendBytes(0x00, 0x00)
|
|
|
+
|
|
|
+ len0 := b.Len()
|
|
|
+ if err := b.AppendSupplier(serial.WriteUint16(f.SessionID)); err != nil {
|
|
|
+ return err
|
|
|
+ }
|
|
|
+
|
|
|
+ b.AppendBytes(byte(f.SessionStatus), byte(f.Option))
|
|
|
+
|
|
|
+ if f.SessionStatus == SessionStatusNew {
|
|
|
+ switch f.Target.Network {
|
|
|
+ case net.Network_TCP:
|
|
|
+ b.AppendBytes(byte(TargetNetworkTCP))
|
|
|
+ case net.Network_UDP:
|
|
|
+ b.AppendBytes(byte(TargetNetworkUDP))
|
|
|
}
|
|
|
|
|
|
- serial.Uint16ToBytes(uint16(length), lengthBytes[:0])
|
|
|
- return length + 2, nil
|
|
|
+ if err := addrParser.WriteAddressPort(b, f.Target.Address, f.Target.Port); err != nil {
|
|
|
+ return err
|
|
|
+ }
|
|
|
}
|
|
|
+
|
|
|
+ len1 := b.Len()
|
|
|
+ serial.Uint16ToBytes(uint16(len1-len0), lenBytes)
|
|
|
+ return nil
|
|
|
}
|
|
|
|
|
|
-func ReadFrameFrom(b []byte) (*FrameMetadata, error) {
|
|
|
- if len(b) < 4 {
|
|
|
- return nil, newError("insufficient buffer: ", len(b))
|
|
|
+func ReadFrameFrom(b *buf.Buffer) (*FrameMetadata, error) {
|
|
|
+ if b.Len() < 4 {
|
|
|
+ return nil, newError("insufficient buffer: ", b.Len())
|
|
|
}
|
|
|
|
|
|
f := &FrameMetadata{
|
|
|
- SessionID: serial.BytesToUint16(b[:2]),
|
|
|
- SessionStatus: SessionStatus(b[2]),
|
|
|
- Option: bitmask.Byte(b[3]),
|
|
|
+ SessionID: serial.BytesToUint16(b.BytesTo(2)),
|
|
|
+ SessionStatus: SessionStatus(b.Byte(2)),
|
|
|
+ Option: bitmask.Byte(b.Byte(3)),
|
|
|
}
|
|
|
|
|
|
- b = b[4:]
|
|
|
-
|
|
|
if f.SessionStatus == SessionStatusNew {
|
|
|
- network := TargetNetwork(b[0])
|
|
|
- port := net.PortFromBytes(b[1:3])
|
|
|
- addrType := protocol.AddressType(b[3])
|
|
|
- b = b[4:]
|
|
|
-
|
|
|
- var addr net.Address
|
|
|
- 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)
|
|
|
+ network := TargetNetwork(b.Byte(4))
|
|
|
+ b.SliceFrom(5)
|
|
|
+
|
|
|
+ addr, port, err := addrParser.ReadAddressPort(nil, b)
|
|
|
+ if err != nil {
|
|
|
+ return nil, newError("failed to parse address and port").Base(err)
|
|
|
}
|
|
|
+
|
|
|
switch network {
|
|
|
case TargetNetworkTCP:
|
|
|
f.Target = net.TCPDestination(addr, port)
|