egress.go 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652
  1. package amneziawgnet
  2. import (
  3. "context"
  4. "crypto/hmac"
  5. "encoding/binary"
  6. "fmt"
  7. "io"
  8. "net"
  9. "net/netip"
  10. "sync"
  11. "time"
  12. "gvisor.dev/gvisor/pkg/tcpip"
  13. "gvisor.dev/gvisor/pkg/tcpip/adapters/gonet"
  14. "github.com/mhsanaei/3x-ui/v3/internal/logger"
  15. )
  16. // EgressBasePort is the fixed loopback port of the panel's SOCKS5 egress
  17. // server; it appears in every generated amneziawg socks bridge.
  18. const EgressBasePort = 64900
  19. // socks5EgressServer is a minimal loopback SOCKS5 server routing Xray's
  20. // bridged amneziawg outbounds into their embedded devices' netstacks.
  21. type socks5EgressServer struct {
  22. mu sync.Mutex
  23. stacks map[string]*Device // outbound tag -> its device
  24. dns map[string]string // outbound tag -> its DNS server
  25. tracked map[net.Conn]struct{}
  26. // dnsServer resolves domain targets through the outbound netstack.
  27. dnsServer string
  28. listener net.Listener // nil when stopped; acceptLoop takes it as an arg
  29. closing chan struct{} // per-listener lifetime signal, rearmed by Listen
  30. wg sync.WaitGroup
  31. }
  32. var (
  33. egressOnce sync.Once
  34. egressServer *socks5EgressServer
  35. )
  36. // GetEgressServer returns the process-wide SOCKS5 egress server singleton.
  37. func GetEgressServer() *socks5EgressServer {
  38. egressOnce.Do(func() {
  39. egressServer = &socks5EgressServer{
  40. stacks: map[string]*Device{},
  41. dns: map[string]string{},
  42. tracked: map[net.Conn]struct{}{},
  43. }
  44. })
  45. return egressServer
  46. }
  47. // currentDNSServer reads dnsServer under lock -- custom per-tag DNS preferred.
  48. func (s *socks5EgressServer) currentDNSServer(tag ...string) string {
  49. s.mu.Lock()
  50. defer s.mu.Unlock()
  51. if len(tag) > 0 && tag[0] != "" {
  52. if custom, ok := s.dns[tag[0]]; ok && custom != "" {
  53. return custom
  54. }
  55. }
  56. return s.dnsServer
  57. }
  58. // SetDNSServer overrides the domain-target resolver (tests).
  59. func (s *socks5EgressServer) SetDNSServer(addr string) {
  60. s.mu.Lock()
  61. defer s.mu.Unlock()
  62. s.dnsServer = addr
  63. }
  64. // SetStack registers or replaces the device backing an outbound tag.
  65. func (s *socks5EgressServer) SetStack(tag string, dev *Device, dnsServer ...string) {
  66. norm := ""
  67. if len(dnsServer) > 0 && dnsServer[0] != "" {
  68. norm = normalizeDNSServer(dnsServer[0])
  69. }
  70. s.mu.Lock()
  71. prevDev := s.stacks[tag]
  72. prevDNS := s.dns[tag]
  73. s.stacks[tag] = dev
  74. if norm != "" {
  75. s.dns[tag] = norm
  76. } else {
  77. delete(s.dns, tag)
  78. }
  79. changed := prevDev != dev || prevDNS != norm
  80. s.mu.Unlock()
  81. if changed {
  82. flushTunnelDNSCacheForTag(tag)
  83. }
  84. }
  85. // DeleteStack drops an outbound tag's registration (outbound removed).
  86. func (s *socks5EgressServer) DeleteStack(tag string) {
  87. s.mu.Lock()
  88. delete(s.stacks, tag)
  89. delete(s.dns, tag)
  90. s.mu.Unlock()
  91. flushTunnelDNSCacheForTag(tag)
  92. }
  93. // Listen starts accepting on the loopback listener. Idempotent; a bind
  94. // failure is returned and retried by the caller's reconcile tick.
  95. func (s *socks5EgressServer) Listen() error {
  96. s.mu.Lock()
  97. defer s.mu.Unlock()
  98. if s.listener != nil {
  99. return nil
  100. }
  101. ln, err := (&net.ListenConfig{}).Listen(context.Background(), "tcp", fmt.Sprintf("127.0.0.1:%d", EgressBasePort))
  102. if err != nil {
  103. return fmt.Errorf("amneziawgnet: egress listen: %w", err)
  104. }
  105. s.listener = ln
  106. s.closing = make(chan struct{})
  107. logger.Infof("amneziawgnet: egress socks listening on %s", ln.Addr())
  108. s.wg.Add(1)
  109. go s.acceptLoop(ln, s.closing)
  110. return nil
  111. }
  112. // Close stops the listener and in-flight handlers; signal first so an accept
  113. // error always observes closing.
  114. func (s *socks5EgressServer) Close() {
  115. s.mu.Lock()
  116. ln := s.listener
  117. s.listener = nil
  118. if ln == nil {
  119. s.mu.Unlock()
  120. return
  121. }
  122. close(s.closing)
  123. tracked := s.tracked
  124. s.tracked = map[net.Conn]struct{}{}
  125. s.mu.Unlock()
  126. ln.Close()
  127. for conn := range tracked {
  128. conn.Close()
  129. }
  130. s.wg.Wait()
  131. }
  132. func (s *socks5EgressServer) acceptLoop(ln net.Listener, closing chan struct{}) {
  133. defer s.wg.Done()
  134. for {
  135. conn, err := ln.Accept()
  136. if err != nil {
  137. select {
  138. case <-closing:
  139. return
  140. default:
  141. }
  142. logger.Warningf("amneziawgnet: egress accept: %v", err)
  143. continue
  144. }
  145. select {
  146. case <-closing:
  147. conn.Close()
  148. return
  149. default:
  150. }
  151. s.mu.Lock()
  152. if s.listener == nil {
  153. s.mu.Unlock()
  154. conn.Close()
  155. return
  156. }
  157. s.tracked[conn] = struct{}{}
  158. s.wg.Add(1)
  159. s.mu.Unlock()
  160. go func(c net.Conn) {
  161. defer s.wg.Done()
  162. defer func() {
  163. s.mu.Lock()
  164. delete(s.tracked, c)
  165. s.mu.Unlock()
  166. }()
  167. s.handleConn(c)
  168. }(conn)
  169. }
  170. }
  171. // stackFor resolves a tag to its live device at use time, so rebuilds take
  172. // effect for new connections without touching the listener.
  173. func (s *socks5EgressServer) stackFor(tag string) (*Device, bool) {
  174. s.mu.Lock()
  175. defer s.mu.Unlock()
  176. dev, ok := s.stacks[tag]
  177. return dev, ok
  178. }
  179. func (s *socks5EgressServer) handleConn(conn net.Conn) {
  180. defer conn.Close()
  181. // Bound the pre-auth handshake so a silent client never pins a handler
  182. // indefinitely across Close() and wg.Wait().
  183. _ = conn.SetDeadline(time.Now().Add(portForwardDialTimeout))
  184. method, err := socks5Greeting(conn)
  185. if err != nil || method == 0xFF {
  186. return
  187. }
  188. user := ""
  189. if method == 0x02 {
  190. // RFC 1929 sub-negotiation: VER(1) | ULEN(1) | UNAME | PLEN(1) |
  191. // PASSWD -- the leading 0x01 version byte must be consumed first.
  192. var ver [1]byte
  193. if _, err := io.ReadFull(conn, ver[:]); err != nil {
  194. return
  195. }
  196. var ulen [1]byte
  197. if _, err := io.ReadFull(conn, ulen[:]); err != nil {
  198. return
  199. }
  200. uname := make([]byte, ulen[0])
  201. if _, err := io.ReadFull(conn, uname); err != nil {
  202. return
  203. }
  204. user = string(uname)
  205. var plen [1]byte
  206. if _, err := io.ReadFull(conn, plen[:]); err != nil {
  207. return
  208. }
  209. pass := make([]byte, plen[0])
  210. if _, err := io.ReadFull(conn, pass); err != nil {
  211. return
  212. }
  213. if !hmac.Equal(pass, []byte(SocksPassword())) {
  214. _, _ = conn.Write([]byte{0x01, 0x01})
  215. return
  216. }
  217. if _, err := conn.Write([]byte{0x01, 0x00}); err != nil {
  218. return
  219. }
  220. }
  221. var req [4]byte
  222. if _, err := io.ReadFull(conn, req[:]); err != nil {
  223. return
  224. }
  225. // Handshake complete: clear deadline for the relay phase.
  226. _ = conn.SetDeadline(time.Time{})
  227. target, err := readSocksRequestTarget(conn, req[3])
  228. if err != nil {
  229. writeSocksReply(conn, 0x01, netip.AddrPort{})
  230. return
  231. }
  232. switch req[1] {
  233. case 0x01: // CONNECT
  234. dev, ok := s.stackFor(user)
  235. if !ok {
  236. writeSocksReply(conn, 0x05, netip.AddrPort{})
  237. return
  238. }
  239. dest, err := target.resolveTunnelVia(s.currentDNSServer(user), user, dev)
  240. if err != nil {
  241. logger.Warningf("amneziawgnet: egress %q: resolve %s: %v", user, target, err)
  242. writeSocksReply(conn, 0x04, netip.AddrPort{})
  243. return
  244. }
  245. s.relayTCP(dev, user, conn, dest)
  246. case 0x03: // UDP ASSOCIATE
  247. dev, ok := s.stackFor(user)
  248. if !ok {
  249. writeSocksReply(conn, 0x05, netip.AddrPort{})
  250. return
  251. }
  252. s.relayUDP(dev, user, udpControl{conn: conn}, target)
  253. default:
  254. writeSocksReply(conn, 0x07, netip.AddrPort{})
  255. }
  256. }
  257. // socks5Greeting requires RFC 1929 username/password auth (0x02).
  258. // Returns 0xFF when unauthenticated or unsupported.
  259. func socks5Greeting(conn net.Conn) (byte, error) {
  260. var hdr [2]byte
  261. if _, err := io.ReadFull(conn, hdr[:]); err != nil {
  262. return 0xFF, err
  263. }
  264. methods := make([]byte, hdr[1])
  265. if _, err := io.ReadFull(conn, methods); err != nil {
  266. return 0xFF, err
  267. }
  268. hasUserPass := false
  269. for _, m := range methods {
  270. if m == 0x02 {
  271. hasUserPass = true
  272. break
  273. }
  274. }
  275. if !hasUserPass {
  276. _, _ = conn.Write([]byte{0x05, 0xFF})
  277. return 0xFF, nil
  278. }
  279. if _, err := conn.Write([]byte{0x05, 0x02}); err != nil {
  280. return 0xFF, err
  281. }
  282. return 0x02, nil
  283. }
  284. // socksTarget is a parsed SOCKS5 request address: an IP, or the raw hostname
  285. // for ATYP 0x03 (resolved through the outbound's tunnel, never host-side).
  286. type socksTarget struct {
  287. host string
  288. ip netip.Addr
  289. port uint16
  290. }
  291. func readSocksRequestTarget(r io.Reader, atyp byte) (socksTarget, error) {
  292. var t socksTarget
  293. switch atyp {
  294. case 0x01:
  295. var b [4]byte
  296. if _, err := io.ReadFull(r, b[:]); err != nil {
  297. return t, err
  298. }
  299. t.ip = netip.AddrFrom4(b)
  300. case 0x04:
  301. var b [16]byte
  302. if _, err := io.ReadFull(r, b[:]); err != nil {
  303. return t, err
  304. }
  305. t.ip = netip.AddrFrom16(b)
  306. case 0x03:
  307. var l [1]byte
  308. if _, err := io.ReadFull(r, l[:]); err != nil {
  309. return t, err
  310. }
  311. name := make([]byte, l[0])
  312. if _, err := io.ReadFull(r, name); err != nil {
  313. return t, err
  314. }
  315. t.host = string(name)
  316. default:
  317. return t, fmt.Errorf("unsupported SOCKS5 request address type %d", atyp)
  318. }
  319. var portBytes [2]byte
  320. if _, err := io.ReadFull(r, portBytes[:]); err != nil {
  321. return t, err
  322. }
  323. t.port = binary.BigEndian.Uint16(portBytes[:])
  324. return t, nil
  325. }
  326. func (t socksTarget) String() string {
  327. if t.ip.IsValid() {
  328. return netip.AddrPortFrom(t.ip, t.port).String()
  329. }
  330. return fmt.Sprintf("%s:%d", t.host, t.port)
  331. }
  332. // Domain targets resolve via the tunnel; reply-side helper must not be used here.
  333. func (t socksTarget) resolveTunnelVia(dnsServer, tag string, dev *Device) (netip.AddrPort, error) {
  334. if t.ip.IsValid() {
  335. return netip.AddrPortFrom(t.ip, t.port), nil
  336. }
  337. ctx, cancel := context.WithTimeout(context.Background(), tunnelResolveTimeout)
  338. defer cancel()
  339. addr, err := resolveTunnelVia(ctx, dev, tag, dnsServer, t.host)
  340. if err != nil {
  341. return netip.AddrPort{}, err
  342. }
  343. return netip.AddrPortFrom(addr, t.port), nil
  344. }
  345. // writeSocksReply emits a reply with an empty v4 bind address; Xray only
  346. // reads the code byte.
  347. func writeSocksReply(w io.Writer, code byte, _ netip.AddrPort) {
  348. out := []byte{0x05, code, 0x00, 0x01, 0, 0, 0, 0, 0, 0}
  349. _, _ = w.Write(out)
  350. }
  351. // relayTCP dials dest inside the tagged outbound's netstack and pipes both
  352. // directions until either side closes.
  353. func (s *socks5EgressServer) relayTCP(dev *Device, tag string, upstream net.Conn, dest netip.AddrPort) {
  354. fa := tcpip.FullAddress{
  355. NIC: 1,
  356. Addr: tcpip.AddrFromSlice(dest.Addr().AsSlice()),
  357. Port: dest.Port(),
  358. }
  359. // Bound dial with portForwardDialTimeout so unreachable peers do not
  360. // pin goroutines and netstack endpoints in s.tracked.
  361. dctx, dcancel := context.WithTimeout(context.Background(), portForwardDialTimeout)
  362. defer dcancel()
  363. tunnelConn, err := gonet.DialContextTCP(dctx, dev.Stack, fa, tunnelNetwork(dest.Addr()))
  364. if err != nil {
  365. logger.Warningf("amneziawgnet: egress %q: dial tunnel %s: %v", tag, dest, err)
  366. writeSocksReply(upstream, 0x01, netip.AddrPort{})
  367. return
  368. }
  369. defer tunnelConn.Close()
  370. if _, err := upstream.Write([]byte{0x05, 0x00, 0x00, 0x01, 0, 0, 0, 0, 0, 0}); err != nil {
  371. return
  372. }
  373. done := make(chan struct{}, 2)
  374. go func() { _, _ = io.Copy(tunnelConn, upstream); done <- struct{}{} }()
  375. go func() { _, _ = io.Copy(upstream, tunnelConn); done <- struct{}{} }()
  376. <-done
  377. }
  378. // udpControl is the control half of one UDP ASSOCIATE: the TCP connection
  379. // whose lifetime bounds the association (RFC 1928).
  380. type udpControl struct{ conn net.Conn }
  381. // egressUDPSession is one UDP ASSOCIATE flow: host-facing socket plus a
  382. // connected tunnel endpoint whose source port makes replies answerable.
  383. type egressUDPSession struct {
  384. dst netip.AddrPort
  385. conn *gonet.UDPConn
  386. }
  387. // relayUDP answers the associate request and relays datagrams to
  388. // per-destination tunnel endpoints until the control connection closes.
  389. func (s *socks5EgressServer) relayUDP(dev *Device, tag string, ctl udpControl, _ socksTarget) {
  390. udpConn, err := net.ListenUDP("udp", &net.UDPAddr{IP: net.IPv4(127, 0, 0, 1)})
  391. if err != nil {
  392. logger.Warningf("amneziawgnet: egress %q: udp bind: %v", tag, err)
  393. writeSocksReply(ctl.conn, 0x01, netip.AddrPort{})
  394. return
  395. }
  396. defer udpConn.Close()
  397. local := udpConn.LocalAddr().(*net.UDPAddr)
  398. ip4 := local.IP.To4()
  399. reply := []byte{
  400. 0x05, 0x00, 0x00, 0x01, ip4[0], ip4[1], ip4[2], ip4[3],
  401. byte(local.Port >> 8), byte(local.Port),
  402. }
  403. if _, err := ctl.conn.Write(reply); err != nil {
  404. return
  405. }
  406. sessions := &udpEgressSessions{m: map[netip.AddrPort]*egressUDPSession{}}
  407. // Reader: strip per-datagram SOCKS5 headers and forward into the tunnel;
  408. // only the associated client's address is accepted.
  409. go func() {
  410. var client netip.AddrPort
  411. buf := make([]byte, 65536)
  412. for {
  413. n, from, err := udpConn.ReadFrom(buf)
  414. if err != nil {
  415. return
  416. }
  417. if src, ok := udpAddrPort(from); ok {
  418. if client.IsValid() && src != client {
  419. continue // RFC 1928: only the associated client may send
  420. }
  421. client = src
  422. }
  423. data := buf[:n]
  424. if len(data) < 4 {
  425. continue
  426. }
  427. atyp := data[3]
  428. var dst netip.AddrPort
  429. var payloadOff int
  430. if atyp == 0x03 {
  431. name, port, hdrLen, perr := parseDatagramDomainHeader(data)
  432. if perr != nil {
  433. continue
  434. }
  435. // Resolve off reader loop so slow tunnel DNS lookups do not
  436. // stall other destinations on this association.
  437. go func(client netip.AddrPort, name string, port uint16, hdrLen int, datagram []byte) {
  438. dnsSrv := s.currentDNSServer(tag)
  439. rctx, rcancel := context.WithTimeout(context.Background(), tunnelResolveTimeout)
  440. daddr, rerr := resolveTunnelVia(rctx, dev, tag, dnsSrv, name)
  441. rcancel()
  442. if rerr != nil {
  443. logger.Warningf("amneziawgnet: egress %q: resolve udp %q (dns=%s): %v", tag, name, dnsSrv, rerr)
  444. return
  445. }
  446. s.deliverUDPDatagram(dev, tag, udpConn, client, sessions, netip.AddrPortFrom(daddr, port), datagram[hdrLen:])
  447. }(client, name, port, hdrLen, append([]byte(nil), data...))
  448. continue
  449. } else {
  450. hdrLen := 4 + addrLen(atyp) + 2
  451. if hdrLen <= 6 || len(data) < hdrLen {
  452. continue
  453. }
  454. d, derr := parseDatagramHeader(data[:hdrLen])
  455. if derr != nil {
  456. logger.Warningf("amneziawgnet: egress %q: udp header: %v", tag, derr)
  457. continue
  458. }
  459. dst = d
  460. payloadOff = hdrLen
  461. }
  462. s.deliverUDPDatagram(dev, tag, udpConn, client, sessions, dst, data[payloadOff:])
  463. }
  464. }()
  465. // Control-conn close tears down relaying -- relay.go UDPRelay contract.
  466. buf := make([]byte, 512)
  467. for {
  468. if _, err := ctl.conn.Read(buf); err != nil {
  469. sessions.closeAll()
  470. return
  471. }
  472. }
  473. }
  474. // udpEgressSessions guards the association's session map: the reader
  475. // goroutine inserts while the control-conn teardown iterates.
  476. type udpEgressSessions struct {
  477. mu sync.Mutex
  478. m map[netip.AddrPort]*egressUDPSession
  479. }
  480. func (s *udpEgressSessions) getOrDial(dev *Device, tag string, udpConn *net.UDPConn, client netip.AddrPort, dst netip.AddrPort) *egressUDPSession {
  481. s.mu.Lock()
  482. defer s.mu.Unlock()
  483. if sess, ok := s.m[dst]; ok {
  484. return sess
  485. }
  486. raddr := tcpip.FullAddress{
  487. NIC: 1,
  488. Addr: tcpip.AddrFromSlice(dst.Addr().AsSlice()),
  489. Port: dst.Port(),
  490. }
  491. conn, err := gonet.DialUDP(dev.Stack, nil, &raddr, tunnelNetwork(dst.Addr()))
  492. if err != nil {
  493. logger.Warningf("amneziawgnet: egress %q: dial udp %s: %v", tag, dst, err)
  494. return nil
  495. }
  496. sess := &egressUDPSession{dst: dst, conn: conn}
  497. s.m[dst] = sess
  498. go pumpUDPEgress(udpConn, client, sess, s)
  499. return sess
  500. }
  501. func (s *udpEgressSessions) closeAll() {
  502. s.mu.Lock()
  503. defer s.mu.Unlock()
  504. for _, sess := range s.m {
  505. sess.conn.Close()
  506. }
  507. }
  508. // deliverUDPDatagram forwards one payload to dst through the tunnel endpoint.
  509. // Safe for concurrent use across resolver and direct-path goroutines.
  510. func (s *socks5EgressServer) deliverUDPDatagram(dev *Device, tag string, udpConn *net.UDPConn, client netip.AddrPort, sessions *udpEgressSessions, dst netip.AddrPort, payload []byte) {
  511. if !client.IsValid() {
  512. return // nothing to reply to yet
  513. }
  514. sess := sessions.getOrDial(dev, tag, udpConn, client, dst)
  515. if sess == nil {
  516. return
  517. }
  518. if _, werr := sess.conn.Write(payload); werr != nil {
  519. logger.Warningf("amneziawgnet: egress %q: send udp to %s: %v", tag, dst, werr)
  520. }
  521. }
  522. // pumpUDPEgress reads replies from one connected tunnel endpoint and writes
  523. // them back to the associated client as SOCKS5 UDP datagrams.
  524. func pumpUDPEgress(udpConn *net.UDPConn, client netip.AddrPort, sess *egressUDPSession, sessions *udpEgressSessions) {
  525. defer func() {
  526. sessions.mu.Lock()
  527. delete(sessions.m, sess.dst)
  528. sessions.mu.Unlock()
  529. sess.conn.Close()
  530. }()
  531. buf := make([]byte, 65536)
  532. for {
  533. // Reap idle egress sessions to avoid holding them indefinitely.
  534. _ = sess.conn.SetReadDeadline(time.Now().Add(portForwardUDPIdleTimeout))
  535. n, err := sess.conn.Read(buf)
  536. if err != nil {
  537. return
  538. }
  539. hdr := make([]byte, 0, 3+1+16+2+n)
  540. hdr = append(hdr, 0x00, 0x00, 0x00) // RSV RSV FRAG(=0)
  541. if sess.dst.Addr().Is4() {
  542. b := sess.dst.Addr().As4()
  543. hdr = append(hdr, 0x01)
  544. hdr = append(hdr, b[:]...)
  545. } else {
  546. b := sess.dst.Addr().As16()
  547. hdr = append(hdr, 0x04)
  548. hdr = append(hdr, b[:]...)
  549. }
  550. var portBytes [2]byte
  551. binary.BigEndian.PutUint16(portBytes[:], sess.dst.Port())
  552. hdr = append(hdr, portBytes[:]...)
  553. hdr = append(hdr, buf[:n]...)
  554. if _, err := udpConn.WriteTo(hdr, net.UDPAddrFromAddrPort(client)); err != nil {
  555. return
  556. }
  557. }
  558. }
  559. // parseDatagramDomainHeader decodes a domain SOCKS5 UDP header (RSV RSV FRAG
  560. // 0x03 LEN NAME PORT) into name, port, and header length.
  561. func parseDatagramDomainHeader(data []byte) (name string, port uint16, hdrLen int, err error) {
  562. if len(data) < 5 {
  563. return "", 0, 0, fmt.Errorf("short domain header")
  564. }
  565. l := int(data[4])
  566. hdrLen = 4 + 1 + l + 2
  567. if l == 0 || len(data) < hdrLen {
  568. return "", 0, 0, fmt.Errorf("short domain payload")
  569. }
  570. name = string(data[5 : 5+l])
  571. port = binary.BigEndian.Uint16(data[5+l : 7+l])
  572. return name, port, hdrLen, nil
  573. }
  574. // addrLen returns the wire length of a SOCKS5 address of the given ATYP.
  575. func addrLen(atyp byte) int {
  576. switch atyp {
  577. case 0x01:
  578. return 4
  579. case 0x04:
  580. return 16
  581. default:
  582. return -1
  583. }
  584. }
  585. // parseDatagramHeader decodes the destination from the front of a SOCKS5 UDP
  586. // datagram header block (RSV RSV FRAG ATYP ADDR PORT).
  587. func parseDatagramHeader(hdr []byte) (netip.AddrPort, error) {
  588. if len(hdr) < 4 {
  589. return netip.AddrPort{}, fmt.Errorf("short header")
  590. }
  591. atyp := hdr[3]
  592. body := hdr[4:]
  593. switch atyp {
  594. case 0x01:
  595. if len(body) < 6 {
  596. return netip.AddrPort{}, fmt.Errorf("short v4")
  597. }
  598. return netip.AddrPortFrom(netip.AddrFrom4([4]byte(body[:4])), binary.BigEndian.Uint16(body[4:6])), nil
  599. case 0x04:
  600. if len(body) < 18 {
  601. return netip.AddrPort{}, fmt.Errorf("short v6")
  602. }
  603. return netip.AddrPortFrom(netip.AddrFrom16([16]byte(body[:16])), binary.BigEndian.Uint16(body[16:18])), nil
  604. default:
  605. return netip.AddrPort{}, fmt.Errorf("unsupported atyp %d", atyp)
  606. }
  607. }