hub.go 3.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181
  1. package udp
  2. import (
  3. "context"
  4. "github.com/v2fly/v2ray-core/v5/common/environment"
  5. "github.com/v2fly/v2ray-core/v5/common/environment/envctx"
  6. "github.com/v2fly/v2ray-core/v5/common/buf"
  7. "github.com/v2fly/v2ray-core/v5/common/net"
  8. "github.com/v2fly/v2ray-core/v5/common/protocol/udp"
  9. "github.com/v2fly/v2ray-core/v5/transport/internet"
  10. )
  11. type HubOption func(h *Hub)
  12. func HubCapacity(capacity int) HubOption {
  13. return func(h *Hub) {
  14. h.capacity = capacity
  15. }
  16. }
  17. func HubReceiveOriginalDestination(r bool) HubOption {
  18. return func(h *Hub) {
  19. h.recvOrigDest = r
  20. }
  21. }
  22. type Hub struct {
  23. conn *net.UDPConn
  24. connPacket net.PacketConn
  25. cache chan *udp.Packet
  26. capacity int
  27. recvOrigDest bool
  28. }
  29. func ListenUDP(ctx context.Context, address net.Address, port net.Port, streamSettings *internet.MemoryStreamConfig, options ...HubOption) (*Hub, error) {
  30. hub := &Hub{
  31. capacity: 256,
  32. recvOrigDest: false,
  33. }
  34. for _, opt := range options {
  35. opt(hub)
  36. }
  37. var sockopt *internet.SocketConfig
  38. if streamSettings != nil {
  39. sockopt = streamSettings.SocketSettings
  40. }
  41. if sockopt != nil && sockopt.ReceiveOriginalDestAddress {
  42. hub.recvOrigDest = true
  43. }
  44. transportEnvironment := envctx.EnvironmentFromContext(ctx).(environment.TransportEnvironment)
  45. listener := transportEnvironment.Listener()
  46. udpConn, err := listener.ListenPacket(ctx, &net.UDPAddr{
  47. IP: address.IP(),
  48. Port: int(port),
  49. }, sockopt)
  50. if err != nil {
  51. return nil, err
  52. }
  53. newError("listening UDP on ", address, ":", port).WriteToLog()
  54. if udpConnDirect, ok := udpConn.(*net.UDPConn); ok {
  55. hub.conn = udpConnDirect
  56. } else {
  57. hub.connPacket = udpConn
  58. }
  59. hub.cache = make(chan *udp.Packet, hub.capacity)
  60. go hub.start()
  61. return hub, nil
  62. }
  63. // Close implements net.Listener.
  64. func (h *Hub) Close() error {
  65. if h.connPacket != nil {
  66. h.connPacket.Close()
  67. return nil
  68. }
  69. h.conn.Close()
  70. return nil
  71. }
  72. func (h *Hub) WriteTo(payload []byte, dest net.Destination) (int, error) {
  73. if h.connPacket != nil {
  74. return h.connPacket.WriteTo(payload, &net.UDPAddr{
  75. IP: dest.Address.IP(),
  76. Port: int(dest.Port),
  77. })
  78. }
  79. return h.conn.WriteToUDP(payload, &net.UDPAddr{
  80. IP: dest.Address.IP(),
  81. Port: int(dest.Port),
  82. })
  83. }
  84. func (h *Hub) start() {
  85. c := h.cache
  86. defer close(c)
  87. oobBytes := make([]byte, 256)
  88. for {
  89. buffer := buf.New()
  90. if h.conn != nil {
  91. var noob int
  92. var addr *net.UDPAddr
  93. rawBytes := buffer.Extend(buf.Size)
  94. n, noob, _, addr, err := ReadUDPMsg(h.conn, rawBytes, oobBytes)
  95. if err != nil {
  96. newError("failed to read UDP msg").Base(err).WriteToLog()
  97. buffer.Release()
  98. break
  99. }
  100. buffer.Resize(0, int32(n))
  101. if buffer.IsEmpty() {
  102. buffer.Release()
  103. continue
  104. }
  105. payload := &udp.Packet{
  106. Payload: buffer,
  107. Source: net.UDPDestination(net.IPAddress(addr.IP), net.Port(addr.Port)),
  108. }
  109. if h.recvOrigDest && noob > 0 {
  110. payload.Target = RetrieveOriginalDest(oobBytes[:noob])
  111. if payload.Target.IsValid() {
  112. newError("UDP original destination: ", payload.Target).AtDebug().WriteToLog()
  113. } else {
  114. newError("failed to read UDP original destination").WriteToLog()
  115. }
  116. }
  117. select {
  118. case c <- payload:
  119. default:
  120. buffer.Release()
  121. payload.Payload = nil
  122. }
  123. } else {
  124. rawBytes := buffer.Extend(buf.Size)
  125. n, addr, err := h.connPacket.ReadFrom(rawBytes)
  126. if err != nil {
  127. newError("failed to read UDP msg").Base(err).WriteToLog()
  128. buffer.Release()
  129. break
  130. }
  131. buffer.Resize(0, int32(n))
  132. if buffer.IsEmpty() {
  133. buffer.Release()
  134. continue
  135. }
  136. payload := &udp.Packet{
  137. Payload: buffer,
  138. Source: net.DestinationFromAddr(addr),
  139. }
  140. select {
  141. case c <- payload:
  142. default:
  143. buffer.Release()
  144. payload.Payload = nil
  145. }
  146. }
  147. }
  148. }
  149. // Addr implements net.Listener.
  150. func (h *Hub) Addr() net.Addr {
  151. if h.conn == nil {
  152. return h.connPacket.LocalAddr()
  153. }
  154. return h.conn.LocalAddr()
  155. }
  156. func (h *Hub) Receive() <-chan *udp.Packet {
  157. return h.cache
  158. }