address.go 4.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183
  1. package protocol
  2. import (
  3. "io"
  4. "v2ray.com/core/common/buf"
  5. "v2ray.com/core/common/net"
  6. )
  7. type AddressOption func(*AddressParser)
  8. func PortThenAddress() AddressOption {
  9. return func(p *AddressParser) {
  10. p.portFirst = true
  11. }
  12. }
  13. func AddressFamilyByte(b byte, f net.AddressFamily) AddressOption {
  14. return func(p *AddressParser) {
  15. p.addrTypeMap[b] = f
  16. p.addrByteMap[f] = b
  17. }
  18. }
  19. type AddressTypeParser func(byte) byte
  20. func WithAddressTypeParser(atp AddressTypeParser) AddressOption {
  21. return func(p *AddressParser) {
  22. p.typeParser = atp
  23. }
  24. }
  25. type AddressParser struct {
  26. addrTypeMap map[byte]net.AddressFamily
  27. addrByteMap map[net.AddressFamily]byte
  28. portFirst bool
  29. typeParser AddressTypeParser
  30. }
  31. func NewAddressParser(options ...AddressOption) *AddressParser {
  32. p := &AddressParser{
  33. addrTypeMap: make(map[byte]net.AddressFamily, 8),
  34. addrByteMap: make(map[net.AddressFamily]byte, 8),
  35. }
  36. for _, opt := range options {
  37. opt(p)
  38. }
  39. return p
  40. }
  41. func (p *AddressParser) readPort(b *buf.Buffer, reader io.Reader) (net.Port, error) {
  42. if err := b.AppendSupplier(buf.ReadFullFrom(reader, 2)); err != nil {
  43. return 0, err
  44. }
  45. return net.PortFromBytes(b.BytesFrom(-2)), nil
  46. }
  47. func (p *AddressParser) readAddress(b *buf.Buffer, reader io.Reader) (net.Address, error) {
  48. if err := b.AppendSupplier(buf.ReadFullFrom(reader, 1)); err != nil {
  49. return nil, err
  50. }
  51. addrType := b.Byte(b.Len() - 1)
  52. if p.typeParser != nil {
  53. addrType = p.typeParser(addrType)
  54. }
  55. addrFamily, valid := p.addrTypeMap[addrType]
  56. if !valid {
  57. return nil, newError("unknown address type: ", addrType)
  58. }
  59. switch addrFamily {
  60. case net.AddressFamilyIPv4:
  61. if err := b.AppendSupplier(buf.ReadFullFrom(reader, 4)); err != nil {
  62. return nil, err
  63. }
  64. return net.IPAddress(b.BytesFrom(-4)), nil
  65. case net.AddressFamilyIPv6:
  66. if err := b.AppendSupplier(buf.ReadFullFrom(reader, 16)); err != nil {
  67. return nil, err
  68. }
  69. return net.IPAddress(b.BytesFrom(-16)), nil
  70. case net.AddressFamilyDomain:
  71. if err := b.AppendSupplier(buf.ReadFullFrom(reader, 1)); err != nil {
  72. return nil, err
  73. }
  74. domainLength := int(b.Byte(b.Len() - 1))
  75. if err := b.AppendSupplier(buf.ReadFullFrom(reader, domainLength)); err != nil {
  76. return nil, err
  77. }
  78. return net.DomainAddress(string(b.BytesFrom(-domainLength))), nil
  79. default:
  80. panic("impossible case")
  81. }
  82. }
  83. func (p *AddressParser) ReadAddressPort(buffer *buf.Buffer, input io.Reader) (net.Address, net.Port, error) {
  84. if buffer == nil {
  85. buffer = buf.New()
  86. defer buffer.Release()
  87. }
  88. if p.portFirst {
  89. port, err := p.readPort(buffer, input)
  90. if err != nil {
  91. return nil, 0, err
  92. }
  93. addr, err := p.readAddress(buffer, input)
  94. if err != nil {
  95. return nil, 0, err
  96. }
  97. return addr, port, nil
  98. }
  99. addr, err := p.readAddress(buffer, input)
  100. if err != nil {
  101. return nil, 0, err
  102. }
  103. port, err := p.readPort(buffer, input)
  104. if err != nil {
  105. return nil, 0, err
  106. }
  107. return addr, port, nil
  108. }
  109. func (p *AddressParser) writePort(writer io.Writer, port net.Port) error {
  110. if _, err := writer.Write(port.Bytes(nil)); err != nil {
  111. return err
  112. }
  113. return nil
  114. }
  115. func (p *AddressParser) writeAddress(writer io.Writer, address net.Address) error {
  116. tb, valid := p.addrByteMap[address.Family()]
  117. if !valid {
  118. return newError("unknown address family", address.Family())
  119. }
  120. switch address.Family() {
  121. case net.AddressFamilyIPv4, net.AddressFamilyIPv6:
  122. if _, err := writer.Write([]byte{tb}); err != nil {
  123. return err
  124. }
  125. if _, err := writer.Write(address.IP()); err != nil {
  126. return err
  127. }
  128. case net.AddressFamilyDomain:
  129. domain := address.Domain()
  130. if IsDomainTooLong(domain) {
  131. return newError("Super long domain is not supported: ", domain)
  132. }
  133. if _, err := writer.Write([]byte{tb, byte(len(domain))}); err != nil {
  134. return err
  135. }
  136. if _, err := writer.Write([]byte(domain)); err != nil {
  137. return err
  138. }
  139. }
  140. return nil
  141. }
  142. func (p *AddressParser) WriteAddressPort(writer io.Writer, addr net.Address, port net.Port) error {
  143. if p.portFirst {
  144. if err := p.writePort(writer, port); err != nil {
  145. return err
  146. }
  147. if err := p.writeAddress(writer, addr); err != nil {
  148. return err
  149. }
  150. return nil
  151. }
  152. if err := p.writeAddress(writer, addr); err != nil {
  153. return err
  154. }
  155. if err := p.writePort(writer, port); err != nil {
  156. return err
  157. }
  158. return nil
  159. }