transport.go 26 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934
  1. package ike
  2. import (
  3. "context"
  4. "encoding/binary"
  5. "errors"
  6. "fmt"
  7. "io"
  8. "net"
  9. "strconv"
  10. "strings"
  11. "sync"
  12. "time"
  13. "vocat/internal/vowifi"
  14. )
  15. type datagramTransport interface {
  16. LocalAddr() *net.UDPAddr
  17. RemoteAddr() *net.UDPAddr
  18. Float(context.Context) error
  19. RoundTrip(context.Context, []byte) ([]byte, error)
  20. SendESP(context.Context, []byte) error
  21. ReceiveESP(context.Context, []byte) (int, error)
  22. SendSessionPacket(context.Context, []byte, bool) error
  23. ReceiveSessionPacket(context.Context, []byte) (int, bool, error)
  24. Close() error
  25. }
  26. type transportConfig struct {
  27. Resolver *net.Resolver
  28. Dialer *net.Dialer
  29. Timeout time.Duration
  30. }
  31. func newDatagramTransport(
  32. ctx context.Context,
  33. config transportConfig,
  34. route vowifi.ProxyRoute,
  35. host string,
  36. ) (datagramTransport, error) {
  37. if config.Resolver == nil {
  38. config.Resolver = net.DefaultResolver
  39. }
  40. if config.Dialer == nil {
  41. config.Dialer = &net.Dialer{}
  42. }
  43. if config.Timeout <= 0 {
  44. config.Timeout = 12 * time.Second
  45. }
  46. addresses, err := resolveEPDG(ctx, config.Resolver, host)
  47. if err != nil {
  48. return nil, fmt.Errorf("ike: resolve ePDG: %w", err)
  49. }
  50. var remoteIPs []net.IP
  51. for _, address := range addresses {
  52. candidate := address.IP.To4()
  53. if candidate == nil {
  54. candidate = address.IP.To16()
  55. }
  56. if candidate == nil {
  57. continue
  58. }
  59. duplicate := false
  60. for _, existing := range remoteIPs {
  61. if existing.Equal(candidate) {
  62. duplicate = true
  63. break
  64. }
  65. }
  66. if !duplicate {
  67. remoteIPs = append(remoteIPs, append(net.IP(nil), candidate...))
  68. }
  69. }
  70. if len(remoteIPs) == 0 {
  71. return nil, errors.New("ike: ePDG did not resolve to an IP address")
  72. }
  73. remotes := make([]*net.UDPAddr, 0, len(remoteIPs))
  74. for _, remoteIP := range remoteIPs {
  75. remotes = append(remotes, &net.UDPAddr{IP: remoteIP, Port: 500})
  76. }
  77. switch route.Mode {
  78. case "", vowifi.ProxyModeDirect:
  79. return newDirectUDP(ctx, config, remotes[0])
  80. case vowifi.ProxyModeSOCKS5:
  81. return newSOCKS5UDP(ctx, config, route, remotes)
  82. default:
  83. return nil, fmt.Errorf("ike: unsupported proxy mode %q", route.Mode)
  84. }
  85. }
  86. func roundTripDatagram(
  87. ctx context.Context,
  88. timeout time.Duration,
  89. write func([]byte) error,
  90. read func([]byte, time.Time) (int, error),
  91. packet []byte,
  92. ) ([]byte, error) {
  93. if ctx == nil {
  94. ctx = context.Background()
  95. }
  96. deadline := time.Now().Add(timeout)
  97. if callerDeadline, ok := ctx.Deadline(); ok && callerDeadline.Before(deadline) {
  98. deadline = callerDeadline
  99. }
  100. retransmit := []time.Duration{500 * time.Millisecond, time.Second, 2 * time.Second, 4 * time.Second}
  101. buffer := make([]byte, 65535)
  102. var lastErr error
  103. for _, interval := range retransmit {
  104. if err := ctx.Err(); err != nil {
  105. return nil, err
  106. }
  107. if err := write(packet); err != nil {
  108. return nil, err
  109. }
  110. attemptDeadline := time.Now().Add(interval)
  111. if deadline.Before(attemptDeadline) {
  112. attemptDeadline = deadline
  113. }
  114. for time.Now().Before(attemptDeadline) {
  115. if err := ctx.Err(); err != nil {
  116. return nil, err
  117. }
  118. n, err := read(buffer, attemptDeadline)
  119. if err == nil {
  120. return append([]byte(nil), buffer[:n]...), nil
  121. }
  122. if timeoutError, ok := err.(net.Error); ok && timeoutError.Timeout() {
  123. lastErr = err
  124. break
  125. }
  126. return nil, err
  127. }
  128. if !time.Now().Before(deadline) {
  129. break
  130. }
  131. }
  132. if lastErr == nil {
  133. lastErr = context.DeadlineExceeded
  134. }
  135. return nil, fmt.Errorf("ike: UDP exchange timed out: %w", lastErr)
  136. }
  137. type directUDP struct {
  138. mu sync.Mutex
  139. readMu sync.Mutex
  140. writeMu sync.Mutex
  141. config transportConfig
  142. conn *net.UDPConn
  143. remote *net.UDPAddr
  144. floated bool
  145. }
  146. func newDirectUDP(ctx context.Context, config transportConfig, remote *net.UDPAddr) (*directUDP, error) {
  147. transport := &directUDP{config: config, remote: cloneUDPAddr(remote)}
  148. if err := transport.dial(ctx, false); err != nil {
  149. return nil, err
  150. }
  151. return transport, nil
  152. }
  153. func (transport *directUDP) dial(ctx context.Context, bind4500 bool) error {
  154. dialer := *transport.config.Dialer
  155. if bind4500 {
  156. localIP := net.IP(nil)
  157. if transport.conn != nil {
  158. if current, ok := transport.conn.LocalAddr().(*net.UDPAddr); ok {
  159. localIP = append(net.IP(nil), current.IP...)
  160. }
  161. }
  162. dialer.LocalAddr = &net.UDPAddr{IP: localIP, Port: 4500}
  163. }
  164. connection, err := dialer.DialContext(ctx, "udp", transport.remote.String())
  165. if err != nil && bind4500 {
  166. dialer.LocalAddr = nil
  167. connection, err = dialer.DialContext(ctx, "udp", transport.remote.String())
  168. }
  169. if err != nil {
  170. return fmt.Errorf("ike: dial ePDG UDP: %w", err)
  171. }
  172. udp, ok := connection.(*net.UDPConn)
  173. if !ok {
  174. _ = connection.Close()
  175. return errors.New("ike: UDP dialer returned a non-UDP connection")
  176. }
  177. old := transport.conn
  178. transport.conn = udp
  179. if old != nil {
  180. _ = old.Close()
  181. }
  182. return nil
  183. }
  184. func (transport *directUDP) LocalAddr() *net.UDPAddr {
  185. transport.mu.Lock()
  186. defer transport.mu.Unlock()
  187. if transport.conn == nil {
  188. return nil
  189. }
  190. address, _ := transport.conn.LocalAddr().(*net.UDPAddr)
  191. return cloneUDPAddr(address)
  192. }
  193. func (transport *directUDP) RemoteAddr() *net.UDPAddr {
  194. transport.mu.Lock()
  195. defer transport.mu.Unlock()
  196. return cloneUDPAddr(transport.remote)
  197. }
  198. func (transport *directUDP) Float(ctx context.Context) error {
  199. transport.mu.Lock()
  200. defer transport.mu.Unlock()
  201. if transport.floated {
  202. return nil
  203. }
  204. transport.remote.Port = 4500
  205. if err := transport.dial(ctx, true); err != nil {
  206. return err
  207. }
  208. transport.floated = true
  209. return nil
  210. }
  211. func (transport *directUDP) RoundTrip(ctx context.Context, packet []byte) ([]byte, error) {
  212. transport.mu.Lock()
  213. defer transport.mu.Unlock()
  214. if transport.conn == nil {
  215. return nil, errors.New("ike: UDP transport is closed")
  216. }
  217. requestHeader, _, err := parseIKEPacket(packet)
  218. if err != nil {
  219. return nil, fmt.Errorf("ike: invalid outbound packet: %w", err)
  220. }
  221. wirePacket := packet
  222. if transport.floated {
  223. wirePacket = append([]byte{0, 0, 0, 0}, packet...)
  224. }
  225. write := func(value []byte) error {
  226. if err := transport.conn.SetWriteDeadline(deadlineFor(ctx, transport.config.Timeout)); err != nil {
  227. return err
  228. }
  229. _, err := transport.conn.Write(value)
  230. return err
  231. }
  232. read := func(buffer []byte, attemptDeadline time.Time) (int, error) {
  233. for {
  234. if err := transport.conn.SetReadDeadline(attemptDeadline); err != nil {
  235. return 0, err
  236. }
  237. n, err := transport.conn.Read(buffer)
  238. if err != nil {
  239. return 0, err
  240. }
  241. if transport.floated {
  242. // IKE and ESP legitimately share UDP/4500. An ESP packet can
  243. // arrive immediately before the IKE response that completes
  244. // CHILD_SA setup; discard it here and keep the same absolute
  245. // attempt deadline while waiting for marked IKE.
  246. if !hasNonESPMarker(buffer[:n]) {
  247. continue
  248. }
  249. copy(buffer, buffer[4:n])
  250. n -= 4
  251. }
  252. if !ikeResponseMatchesRequest(buffer[:n], requestHeader) {
  253. continue
  254. }
  255. return n, nil
  256. }
  257. }
  258. return roundTripDatagram(ctx, transport.config.Timeout, write, read, wirePacket)
  259. }
  260. func (transport *directUDP) SendESP(ctx context.Context, packet []byte) error {
  261. transport.mu.Lock()
  262. defer transport.mu.Unlock()
  263. if transport.conn == nil || !transport.floated {
  264. return errors.New("ike: ESP relay requires an active UDP/4500 transport")
  265. }
  266. if len(packet) < 8 {
  267. return errors.New("ike: ESP packet is too short")
  268. }
  269. if err := transport.conn.SetWriteDeadline(deadlineFor(ctx, transport.config.Timeout)); err != nil {
  270. return err
  271. }
  272. _, err := transport.conn.Write(packet)
  273. return err
  274. }
  275. func (transport *directUDP) ReceiveESP(ctx context.Context, buffer []byte) (int, error) {
  276. transport.mu.Lock()
  277. defer transport.mu.Unlock()
  278. if transport.conn == nil || !transport.floated {
  279. return 0, errors.New("ike: ESP relay requires an active UDP/4500 transport")
  280. }
  281. if err := transport.conn.SetReadDeadline(deadlineFor(ctx, transport.config.Timeout)); err != nil {
  282. return 0, err
  283. }
  284. n, err := transport.conn.Read(buffer)
  285. if err != nil {
  286. return 0, err
  287. }
  288. if n >= 4 && buffer[0] == 0 && buffer[1] == 0 && buffer[2] == 0 && buffer[3] == 0 {
  289. return 0, errors.New("ike: received an IKE packet on the ESP relay")
  290. }
  291. return n, nil
  292. }
  293. func (transport *directUDP) SendSessionPacket(ctx context.Context, packet []byte, ike bool) error {
  294. transport.mu.Lock()
  295. connection := transport.conn
  296. floated := transport.floated
  297. transport.mu.Unlock()
  298. if connection == nil {
  299. return errors.New("ike: UDP transport is closed")
  300. }
  301. wire := packet
  302. if floated {
  303. if ike {
  304. wire = append([]byte{0, 0, 0, 0}, packet...)
  305. }
  306. } else if !ike {
  307. return errors.New("ike: ESP is not UDP encapsulated on an un-floated transport")
  308. }
  309. transport.writeMu.Lock()
  310. defer transport.writeMu.Unlock()
  311. if err := connection.SetWriteDeadline(deadlineFor(ctx, transport.config.Timeout)); err != nil {
  312. return err
  313. }
  314. _, err := connection.Write(wire)
  315. return err
  316. }
  317. func (transport *directUDP) ReceiveSessionPacket(ctx context.Context, buffer []byte) (int, bool, error) {
  318. transport.mu.Lock()
  319. connection := transport.conn
  320. floated := transport.floated
  321. transport.mu.Unlock()
  322. if connection == nil {
  323. return 0, false, errors.New("ike: UDP transport is closed")
  324. }
  325. transport.readMu.Lock()
  326. defer transport.readMu.Unlock()
  327. if err := connection.SetReadDeadline(deadlineFor(ctx, time.Second)); err != nil {
  328. return 0, false, err
  329. }
  330. n, err := connection.Read(buffer)
  331. if err != nil {
  332. return 0, false, err
  333. }
  334. if !floated {
  335. return n, true, nil
  336. }
  337. if n >= 4 && buffer[0] == 0 && buffer[1] == 0 && buffer[2] == 0 && buffer[3] == 0 {
  338. copy(buffer, buffer[4:n])
  339. return n - 4, true, nil
  340. }
  341. return n, false, nil
  342. }
  343. func (transport *directUDP) Close() error {
  344. transport.mu.Lock()
  345. defer transport.mu.Unlock()
  346. if transport.conn == nil {
  347. return nil
  348. }
  349. err := transport.conn.Close()
  350. transport.conn = nil
  351. return err
  352. }
  353. type socks5UDP struct {
  354. mu sync.Mutex
  355. readMu sync.Mutex
  356. writeMu sync.Mutex
  357. config transportConfig
  358. control net.Conn
  359. udp *net.UDPConn
  360. relay *net.UDPAddr
  361. remote *net.UDPAddr
  362. remotes []*net.UDPAddr
  363. floated bool
  364. }
  365. func newSOCKS5UDP(
  366. ctx context.Context,
  367. config transportConfig,
  368. route vowifi.ProxyRoute,
  369. remotes []*net.UDPAddr,
  370. ) (*socks5UDP, error) {
  371. if len(remotes) == 0 || remotes[0] == nil {
  372. return nil, errors.New("ike: SOCKS5 transport requires an ePDG destination")
  373. }
  374. proxyAddress := strings.TrimSpace(route.Address)
  375. if _, _, err := net.SplitHostPort(proxyAddress); err != nil {
  376. return nil, fmt.Errorf("ike: invalid SOCKS5 proxy address: %w", err)
  377. }
  378. control, err := config.Dialer.DialContext(ctx, "tcp", proxyAddress)
  379. if err != nil {
  380. return nil, fmt.Errorf("ike: connect SOCKS5 proxy %s: %w", proxyAddress, err)
  381. }
  382. fail := func(cause error) (*socks5UDP, error) {
  383. _ = control.Close()
  384. return nil, cause
  385. }
  386. if err := control.SetDeadline(deadlineFor(ctx, config.Timeout)); err != nil {
  387. return fail(err)
  388. }
  389. methods := []byte{0}
  390. if route.Username != "" {
  391. methods = append(methods, 2)
  392. }
  393. greeting := append([]byte{5, byte(len(methods))}, methods...)
  394. if _, err := control.Write(greeting); err != nil {
  395. return fail(fmt.Errorf("ike: SOCKS5 greeting: %w", err))
  396. }
  397. var selection [2]byte
  398. if _, err := io.ReadFull(control, selection[:]); err != nil {
  399. return fail(fmt.Errorf("ike: SOCKS5 method selection: %w", err))
  400. }
  401. if selection[0] != 5 {
  402. return fail(errors.New("ike: SOCKS5 proxy returned an invalid version"))
  403. }
  404. switch selection[1] {
  405. case 0:
  406. case 2:
  407. if err := socksUserPassword(control, route.Username, route.Password); err != nil {
  408. return fail(err)
  409. }
  410. default:
  411. return fail(fmt.Errorf("ike: SOCKS5 proxy selected unsupported authentication method %d", selection[1]))
  412. }
  413. if _, err := control.Write([]byte{5, 3, 0, 1, 0, 0, 0, 0, 0, 0}); err != nil {
  414. return fail(fmt.Errorf("ike: SOCKS5 UDP ASSOCIATE request: %w", err))
  415. }
  416. relay, err := readSOCKS5Reply(ctx, control, config.Resolver)
  417. if err != nil {
  418. return fail(err)
  419. }
  420. if relay.IP == nil || relay.IP.IsUnspecified() {
  421. if peer, ok := control.RemoteAddr().(*net.TCPAddr); ok {
  422. relay.IP = append(net.IP(nil), peer.IP...)
  423. }
  424. }
  425. udpConnection, err := net.DialUDP("udp", nil, relay)
  426. if err != nil {
  427. return fail(fmt.Errorf("ike: dial SOCKS5 UDP relay: %w", err))
  428. }
  429. _ = control.SetDeadline(time.Time{})
  430. return &socks5UDP{
  431. config: config,
  432. control: control,
  433. udp: udpConnection,
  434. relay: relay,
  435. remote: cloneUDPAddr(remotes[0]),
  436. remotes: cloneUDPAddrs(remotes),
  437. }, nil
  438. }
  439. func socksUserPassword(connection net.Conn, username, password string) error {
  440. if len(username) > 255 || len(password) > 255 {
  441. return errors.New("ike: SOCKS5 username or password exceeds 255 bytes")
  442. }
  443. request := []byte{1, byte(len(username))}
  444. request = append(request, username...)
  445. request = append(request, byte(len(password)))
  446. request = append(request, password...)
  447. if _, err := connection.Write(request); err != nil {
  448. return fmt.Errorf("ike: SOCKS5 credential exchange: %w", err)
  449. }
  450. var response [2]byte
  451. if _, err := io.ReadFull(connection, response[:]); err != nil {
  452. return fmt.Errorf("ike: SOCKS5 credential response: %w", err)
  453. }
  454. if response[0] != 1 || response[1] != 0 {
  455. return errors.New("ike: SOCKS5 authentication failed")
  456. }
  457. return nil
  458. }
  459. func readSOCKS5Reply(ctx context.Context, connection net.Conn, resolver *net.Resolver) (*net.UDPAddr, error) {
  460. var header [4]byte
  461. if _, err := io.ReadFull(connection, header[:]); err != nil {
  462. return nil, fmt.Errorf("ike: SOCKS5 UDP ASSOCIATE response: %w", err)
  463. }
  464. if header[0] != 5 || header[1] != 0 || header[2] != 0 {
  465. return nil, fmt.Errorf("ike: SOCKS5 UDP ASSOCIATE rejected with code %d", header[1])
  466. }
  467. ip, name, err := readSOCKSAddress(connection, header[3])
  468. if err != nil {
  469. return nil, err
  470. }
  471. var encodedPort [2]byte
  472. if _, err := io.ReadFull(connection, encodedPort[:]); err != nil {
  473. return nil, fmt.Errorf("ike: SOCKS5 relay port: %w", err)
  474. }
  475. if ip == nil && name != "" {
  476. if resolver == nil {
  477. resolver = net.DefaultResolver
  478. }
  479. addresses, err := resolver.LookupIPAddr(ctx, name)
  480. if err != nil || len(addresses) == 0 {
  481. return nil, fmt.Errorf("ike: resolve SOCKS5 UDP relay domain %q: %w", name, err)
  482. }
  483. ip = addresses[0].IP
  484. }
  485. return &net.UDPAddr{IP: ip, Port: int(binary.BigEndian.Uint16(encodedPort[:]))}, nil
  486. }
  487. func readSOCKSAddress(reader io.Reader, kind byte) (net.IP, string, error) {
  488. switch kind {
  489. case 1:
  490. ip := make(net.IP, net.IPv4len)
  491. if _, err := io.ReadFull(reader, ip); err != nil {
  492. return nil, "", err
  493. }
  494. return ip, "", nil
  495. case 4:
  496. ip := make(net.IP, net.IPv6len)
  497. if _, err := io.ReadFull(reader, ip); err != nil {
  498. return nil, "", err
  499. }
  500. return ip, "", nil
  501. case 3:
  502. var length [1]byte
  503. if _, err := io.ReadFull(reader, length[:]); err != nil {
  504. return nil, "", err
  505. }
  506. name := make([]byte, int(length[0]))
  507. if _, err := io.ReadFull(reader, name); err != nil {
  508. return nil, "", err
  509. }
  510. return nil, string(name), nil
  511. default:
  512. return nil, "", fmt.Errorf("ike: unsupported SOCKS5 address type %d", kind)
  513. }
  514. }
  515. func (transport *socks5UDP) LocalAddr() *net.UDPAddr {
  516. transport.mu.Lock()
  517. defer transport.mu.Unlock()
  518. if transport.udp == nil {
  519. return nil
  520. }
  521. address, _ := transport.udp.LocalAddr().(*net.UDPAddr)
  522. return cloneUDPAddr(address)
  523. }
  524. func (transport *socks5UDP) RemoteAddr() *net.UDPAddr {
  525. transport.mu.Lock()
  526. defer transport.mu.Unlock()
  527. return cloneUDPAddr(transport.remote)
  528. }
  529. func (transport *socks5UDP) Float(_ context.Context) error {
  530. transport.mu.Lock()
  531. defer transport.mu.Unlock()
  532. transport.remote.Port = 4500
  533. transport.floated = true
  534. return nil
  535. }
  536. func (transport *socks5UDP) RoundTrip(ctx context.Context, packet []byte) ([]byte, error) {
  537. transport.mu.Lock()
  538. defer transport.mu.Unlock()
  539. if transport.udp == nil {
  540. return nil, errors.New("ike: SOCKS5 UDP transport is closed")
  541. }
  542. requestHeader, _, err := parseIKEPacket(packet)
  543. if err != nil {
  544. return nil, fmt.Errorf("ike: invalid outbound packet: %w", err)
  545. }
  546. // Carrier ePDG hostnames commonly return several gateways. A SOCKS5
  547. // egress can reach a different subset than the local host, so an initial
  548. // timeout on one address must not make the entire hostname unavailable.
  549. // Once a gateway answers, keep it pinned for the lifetime of the IKE SA.
  550. if !transport.floated && requestHeader.Exchange == exchangeIKEInit && requestHeader.MessageID == 0 && len(transport.remotes) > 1 {
  551. var lastErr error
  552. for _, candidate := range transport.remotes {
  553. transport.remote = cloneUDPAddr(candidate)
  554. response, attemptErr := transport.roundTripLocked(ctx, packet, requestHeader)
  555. if attemptErr == nil {
  556. return response, nil
  557. }
  558. lastErr = attemptErr
  559. if ctx.Err() != nil || !isNetworkTimeout(attemptErr) {
  560. return nil, attemptErr
  561. }
  562. }
  563. return nil, fmt.Errorf("ike: all %d resolved ePDG addresses timed out: %w", len(transport.remotes), lastErr)
  564. }
  565. return transport.roundTripLocked(ctx, packet, requestHeader)
  566. }
  567. func (transport *socks5UDP) roundTripLocked(ctx context.Context, packet []byte, requestHeader ikeHeader) ([]byte, error) {
  568. wireIKE := packet
  569. if transport.floated {
  570. wireIKE = append([]byte{0, 0, 0, 0}, packet...)
  571. }
  572. datagram, err := marshalSOCKS5Datagram(transport.remote, wireIKE)
  573. if err != nil {
  574. return nil, err
  575. }
  576. write := func(value []byte) error {
  577. if err := transport.udp.SetWriteDeadline(deadlineFor(ctx, transport.config.Timeout)); err != nil {
  578. return err
  579. }
  580. _, err := transport.udp.Write(value)
  581. return err
  582. }
  583. read := func(buffer []byte, attemptDeadline time.Time) (int, error) {
  584. for {
  585. payload, err := readExpectedSOCKS5Datagram(
  586. transport.udp,
  587. transport.remote,
  588. buffer,
  589. attemptDeadline,
  590. )
  591. if err != nil {
  592. return 0, err
  593. }
  594. if transport.floated {
  595. // The relay can deliver ESP before the marked IKE response on
  596. // the same UDP/4500 association. Do not accept it as IKE, and
  597. // do not abort the exchange; keep waiting within the original
  598. // deadline.
  599. if !hasNonESPMarker(payload) {
  600. continue
  601. }
  602. payload = payload[4:]
  603. }
  604. if !ikeResponseMatchesRequest(payload, requestHeader) {
  605. continue
  606. }
  607. copy(buffer, payload)
  608. return len(payload), nil
  609. }
  610. }
  611. return roundTripDatagram(ctx, transport.config.Timeout, write, read, datagram)
  612. }
  613. func isNetworkTimeout(err error) bool {
  614. var networkError net.Error
  615. return errors.As(err, &networkError) && networkError.Timeout()
  616. }
  617. func (transport *socks5UDP) SendESP(ctx context.Context, packet []byte) error {
  618. transport.mu.Lock()
  619. defer transport.mu.Unlock()
  620. if transport.udp == nil || !transport.floated {
  621. return errors.New("ike: SOCKS5 ESP relay requires an active UDP/4500 association")
  622. }
  623. if len(packet) < 8 {
  624. return errors.New("ike: ESP packet is too short")
  625. }
  626. datagram, err := marshalSOCKS5Datagram(transport.remote, packet)
  627. if err != nil {
  628. return err
  629. }
  630. if err := transport.udp.SetWriteDeadline(deadlineFor(ctx, transport.config.Timeout)); err != nil {
  631. return err
  632. }
  633. _, err = transport.udp.Write(datagram)
  634. return err
  635. }
  636. func (transport *socks5UDP) ReceiveESP(ctx context.Context, buffer []byte) (int, error) {
  637. transport.mu.Lock()
  638. defer transport.mu.Unlock()
  639. if transport.udp == nil || !transport.floated {
  640. return 0, errors.New("ike: SOCKS5 ESP relay requires an active UDP/4500 association")
  641. }
  642. wire := make([]byte, len(buffer)+32)
  643. payload, err := readExpectedSOCKS5Datagram(
  644. transport.udp,
  645. transport.remote,
  646. wire,
  647. deadlineFor(ctx, transport.config.Timeout),
  648. )
  649. if err != nil {
  650. return 0, err
  651. }
  652. if len(payload) >= 4 && payload[0] == 0 && payload[1] == 0 && payload[2] == 0 && payload[3] == 0 {
  653. return 0, errors.New("ike: received an IKE packet on the SOCKS5 ESP relay")
  654. }
  655. if len(payload) > len(buffer) {
  656. return 0, io.ErrShortBuffer
  657. }
  658. copy(buffer, payload)
  659. return len(payload), nil
  660. }
  661. func (transport *socks5UDP) SendSessionPacket(ctx context.Context, packet []byte, ike bool) error {
  662. transport.mu.Lock()
  663. connection := transport.udp
  664. floated := transport.floated
  665. remote := cloneUDPAddr(transport.remote)
  666. transport.mu.Unlock()
  667. if connection == nil || !floated {
  668. return errors.New("ike: SOCKS5 session transport is not on UDP/4500")
  669. }
  670. wire := packet
  671. if ike {
  672. wire = append([]byte{0, 0, 0, 0}, packet...)
  673. }
  674. datagram, err := marshalSOCKS5Datagram(remote, wire)
  675. if err != nil {
  676. return err
  677. }
  678. transport.writeMu.Lock()
  679. defer transport.writeMu.Unlock()
  680. if err := connection.SetWriteDeadline(deadlineFor(ctx, transport.config.Timeout)); err != nil {
  681. return err
  682. }
  683. _, err = connection.Write(datagram)
  684. return err
  685. }
  686. func (transport *socks5UDP) ReceiveSessionPacket(ctx context.Context, buffer []byte) (int, bool, error) {
  687. transport.mu.Lock()
  688. connection := transport.udp
  689. floated := transport.floated
  690. remote := cloneUDPAddr(transport.remote)
  691. transport.mu.Unlock()
  692. if connection == nil || !floated {
  693. return 0, false, errors.New("ike: SOCKS5 session transport is not on UDP/4500")
  694. }
  695. wire := make([]byte, len(buffer)+32)
  696. transport.readMu.Lock()
  697. defer transport.readMu.Unlock()
  698. payload, err := readExpectedSOCKS5Datagram(
  699. connection,
  700. remote,
  701. wire,
  702. deadlineFor(ctx, time.Second),
  703. )
  704. if err != nil {
  705. return 0, false, err
  706. }
  707. isIKE := len(payload) >= 4 && payload[0] == 0 && payload[1] == 0 && payload[2] == 0 && payload[3] == 0
  708. if isIKE {
  709. payload = payload[4:]
  710. }
  711. if len(payload) > len(buffer) {
  712. return 0, false, io.ErrShortBuffer
  713. }
  714. copy(buffer, payload)
  715. return len(payload), isIKE, nil
  716. }
  717. func (transport *socks5UDP) Close() error {
  718. transport.mu.Lock()
  719. defer transport.mu.Unlock()
  720. var errs []error
  721. if transport.udp != nil {
  722. if err := transport.udp.Close(); err != nil {
  723. errs = append(errs, err)
  724. }
  725. transport.udp = nil
  726. }
  727. if transport.control != nil {
  728. if err := transport.control.Close(); err != nil {
  729. errs = append(errs, err)
  730. }
  731. transport.control = nil
  732. }
  733. return errors.Join(errs...)
  734. }
  735. // readExpectedSOCKS5Datagram discards valid datagrams attributed to a
  736. // different destination until the caller's deadline. A retransmitted
  737. // IKE_SA_INIT response from UDP/500 can legitimately remain queued after the
  738. // transport floats to UDP/4500; it must not be accepted as the current
  739. // exchange, but it is not a reason to abort the authenticated session either.
  740. func readExpectedSOCKS5Datagram(
  741. connection *net.UDPConn,
  742. remote *net.UDPAddr,
  743. wire []byte,
  744. deadline time.Time,
  745. ) ([]byte, error) {
  746. if connection == nil || remote == nil {
  747. return nil, errors.New("ike: SOCKS5 UDP transport is closed")
  748. }
  749. for {
  750. if err := connection.SetReadDeadline(deadline); err != nil {
  751. return nil, err
  752. }
  753. n, err := connection.Read(wire)
  754. if err != nil {
  755. return nil, err
  756. }
  757. payload, source, err := parseSOCKS5Datagram(wire[:n])
  758. if err != nil {
  759. return nil, err
  760. }
  761. if source.IP.Equal(remote.IP) && source.Port == remote.Port {
  762. return payload, nil
  763. }
  764. }
  765. }
  766. func hasNonESPMarker(packet []byte) bool {
  767. return len(packet) >= 4 &&
  768. packet[0] == 0 &&
  769. packet[1] == 0 &&
  770. packet[2] == 0 &&
  771. packet[3] == 0
  772. }
  773. func ikeResponseMatchesRequest(
  774. packet []byte,
  775. request ikeHeader,
  776. ) bool {
  777. response, _, err := parseIKEPacket(packet)
  778. if err != nil {
  779. return false
  780. }
  781. if response.InitiatorSPI != request.InitiatorSPI ||
  782. response.Exchange != request.Exchange ||
  783. response.MessageID != request.MessageID ||
  784. response.Flags&flagResponse == 0 ||
  785. response.Flags&flagInitiator != 0 {
  786. return false
  787. }
  788. var zeroSPI [8]byte
  789. if request.ResponderSPI == zeroSPI {
  790. return response.ResponderSPI != zeroSPI
  791. }
  792. return response.ResponderSPI == request.ResponderSPI
  793. }
  794. func marshalSOCKS5Datagram(remote *net.UDPAddr, payload []byte) ([]byte, error) {
  795. if remote == nil || remote.IP == nil || remote.Port < 1 || remote.Port > 65535 {
  796. return nil, errors.New("ike: invalid SOCKS5 UDP destination")
  797. }
  798. result := []byte{0, 0, 0}
  799. if ip4 := remote.IP.To4(); ip4 != nil {
  800. result = append(result, 1)
  801. result = append(result, ip4...)
  802. } else if ip16 := remote.IP.To16(); ip16 != nil {
  803. result = append(result, 4)
  804. result = append(result, ip16...)
  805. } else {
  806. return nil, errors.New("ike: SOCKS5 UDP destination is not an IP address")
  807. }
  808. var port [2]byte
  809. binary.BigEndian.PutUint16(port[:], uint16(remote.Port))
  810. result = append(result, port[:]...)
  811. result = append(result, payload...)
  812. return result, nil
  813. }
  814. func parseSOCKS5Datagram(encoded []byte) ([]byte, *net.UDPAddr, error) {
  815. if len(encoded) < 4 || encoded[0] != 0 || encoded[1] != 0 {
  816. return nil, nil, errors.New("ike: malformed SOCKS5 UDP datagram")
  817. }
  818. if encoded[2] != 0 {
  819. return nil, nil, errors.New("ike: fragmented SOCKS5 UDP datagrams are unsupported")
  820. }
  821. offset := 4
  822. var ip net.IP
  823. switch encoded[3] {
  824. case 1:
  825. if offset+4 > len(encoded) {
  826. return nil, nil, errors.New("ike: truncated SOCKS5 IPv4 address")
  827. }
  828. ip = append(net.IP(nil), encoded[offset:offset+4]...)
  829. offset += 4
  830. case 4:
  831. if offset+16 > len(encoded) {
  832. return nil, nil, errors.New("ike: truncated SOCKS5 IPv6 address")
  833. }
  834. ip = append(net.IP(nil), encoded[offset:offset+16]...)
  835. offset += 16
  836. case 3:
  837. if offset >= len(encoded) {
  838. return nil, nil, errors.New("ike: truncated SOCKS5 domain length")
  839. }
  840. length := int(encoded[offset])
  841. offset++
  842. if offset+length > len(encoded) {
  843. return nil, nil, errors.New("ike: truncated SOCKS5 domain")
  844. }
  845. addresses, err := net.LookupIP(string(encoded[offset : offset+length]))
  846. if err != nil || len(addresses) == 0 {
  847. return nil, nil, errors.New("ike: cannot resolve SOCKS5 UDP response domain")
  848. }
  849. ip = addresses[0]
  850. offset += length
  851. default:
  852. return nil, nil, errors.New("ike: unsupported SOCKS5 UDP address type")
  853. }
  854. if offset+2 > len(encoded) {
  855. return nil, nil, errors.New("ike: truncated SOCKS5 UDP port")
  856. }
  857. port := int(binary.BigEndian.Uint16(encoded[offset : offset+2]))
  858. offset += 2
  859. return append([]byte(nil), encoded[offset:]...), &net.UDPAddr{IP: ip, Port: port}, nil
  860. }
  861. func deadlineFor(ctx context.Context, maximum time.Duration) time.Time {
  862. deadline := time.Now().Add(maximum)
  863. if ctx != nil {
  864. if caller, ok := ctx.Deadline(); ok && caller.Before(deadline) {
  865. return caller
  866. }
  867. }
  868. return deadline
  869. }
  870. func cloneUDPAddr(address *net.UDPAddr) *net.UDPAddr {
  871. if address == nil {
  872. return nil
  873. }
  874. return &net.UDPAddr{IP: append(net.IP(nil), address.IP...), Port: address.Port, Zone: address.Zone}
  875. }
  876. func cloneUDPAddrs(addresses []*net.UDPAddr) []*net.UDPAddr {
  877. result := make([]*net.UDPAddr, 0, len(addresses))
  878. for _, address := range addresses {
  879. if address != nil {
  880. result = append(result, cloneUDPAddr(address))
  881. }
  882. }
  883. return result
  884. }
  885. func parsePort(value string) (int, error) {
  886. port, err := strconv.Atoi(value)
  887. if err != nil || port < 1 || port > 65535 {
  888. return 0, errors.New("ike: invalid UDP port")
  889. }
  890. return port, nil
  891. }