socks_edge.py 29 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624
  1. from __future__ import annotations
  2. import asyncio
  3. import contextlib
  4. import itertools
  5. import socket
  6. import struct
  7. from dataclasses import dataclass, field
  8. from typing import Dict
  9. from .config import Config, RelayNode
  10. from .protocol import AUTH, STATUS_OK, TCP_CLOSE, TCP_DATA, TCP_OPEN, TCP_STATUS, UDP_RECV, UDP_SEND, Frame, decode_json, encode_json, read_frame, write_frame
  11. from .scheduler import Scheduler
  12. SOCKS_VERSION = 5
  13. async def read_exact(reader: asyncio.StreamReader, size: int) -> bytes:
  14. return await reader.readexactly(size)
  15. @dataclass(eq=False)
  16. class RelayLink:
  17. node: RelayNode
  18. reader: asyncio.StreamReader
  19. writer: asyncio.StreamWriter
  20. pump: asyncio.Task | None = None
  21. closed_event: asyncio.Event = field(default_factory=asyncio.Event)
  22. maintain_task: asyncio.Task | None = None
  23. tcp_sessions: Dict[tuple[int, int], "TcpRaceSession"] = field(default_factory=dict)
  24. udp_server: "UdpAssociateServer | None" = None
  25. closed: bool = False
  26. async def start(self) -> None:
  27. await write_frame(self.writer, Frame(AUTH, 0, 0, 0, 0, encode_json({"token": self.node.token})))
  28. frame = await read_frame(self.reader)
  29. if frame.kind != AUTH or frame.packet_id != STATUS_OK:
  30. raise ConnectionError(f"relay auth failed: {self.node.name}")
  31. self.closed = False
  32. self.closed_event.clear()
  33. self.pump = asyncio.create_task(self._pump())
  34. async def _pump(self) -> None:
  35. try:
  36. while True:
  37. frame = await read_frame(self.reader)
  38. key = (frame.session_id, frame.stream_id)
  39. if frame.kind in (TCP_STATUS, TCP_DATA, TCP_CLOSE):
  40. session = self.tcp_sessions.get(key)
  41. if session:
  42. await session.handle_frame(self, frame)
  43. elif frame.kind == UDP_RECV and self.udp_server:
  44. await self.udp_server.handle_from_relay(frame, self)
  45. except (asyncio.IncompleteReadError, ConnectionResetError, BrokenPipeError, OSError):
  46. pass
  47. except Exception:
  48. pass
  49. finally:
  50. await self.close()
  51. async def send(self, frame: Frame) -> None:
  52. if self.closed:
  53. raise ConnectionError(f"relay closed: {self.node.name}")
  54. try:
  55. await write_frame(self.writer, frame)
  56. except (BrokenPipeError, ConnectionResetError, RuntimeError, OSError, asyncio.CancelledError) as exc:
  57. await self.close()
  58. raise ConnectionError(f"relay closed: {self.node.name}") from exc
  59. async def close(self) -> None:
  60. if self.closed:
  61. return
  62. self.closed = True
  63. self.closed_event.set()
  64. if self.pump and self.pump is not asyncio.current_task():
  65. self.pump.cancel()
  66. with contextlib.suppress(Exception):
  67. await self.pump
  68. self.writer.close()
  69. with contextlib.suppress(Exception):
  70. await self.writer.wait_closed()
  71. @dataclass
  72. class UdpFlowState:
  73. flow_id: int
  74. client_addr: tuple[str, int]
  75. target_host: str
  76. target_port: int
  77. created_at: float
  78. last_activity: float
  79. packets_sent: int = 0
  80. packets_received: int = 0
  81. duplicate_responses: int = 0
  82. winner_name: str | None = None
  83. candidate_names: tuple[str, ...] = ()
  84. link_streams: dict[str, int] = field(default_factory=dict)
  85. initialized_links: set[str] = field(default_factory=set)
  86. direct_sockets: dict[str, socket.socket] = field(default_factory=dict)
  87. direct_tasks: dict[str, asyncio.Task] = field(default_factory=dict)
  88. direct_failures: set[str] = field(default_factory=set)
  89. relay_failures: dict[str, int] = field(default_factory=dict)
  90. relay_error_seen: set[str] = field(default_factory=set)
  91. path_last_seen: dict[str, float] = field(default_factory=dict)
  92. def touch(self, now: float) -> None:
  93. self.last_activity = now
  94. @dataclass
  95. class TcpRaceSession:
  96. session_id: int
  97. stream_id: int
  98. target_host: str
  99. target_port: int
  100. local_reader: asyncio.StreamReader
  101. local_writer: asyncio.StreamWriter
  102. links: list[RelayLink]
  103. warmup_bytes: int
  104. winning_link: RelayLink | None = None
  105. winner_name: str | None = None
  106. opened: int = 0
  107. open_errors: list[str] = field(default_factory=list)
  108. uplink_bytes: int = 0
  109. closed: bool = False
  110. open_event: asyncio.Event = field(default_factory=asyncio.Event)
  111. winner_event: asyncio.Event = field(default_factory=asyncio.Event)
  112. pump_task: asyncio.Task | None = None
  113. win_counts: Dict[str, int] = field(default_factory=dict)
  114. async def start(self) -> None:
  115. meta = encode_json({"host": self.target_host, "port": self.target_port})
  116. for link in self.links:
  117. link.tcp_sessions[(self.session_id, self.stream_id)] = self
  118. await link.send(Frame(TCP_OPEN, self.session_id, self.stream_id, 0, 0, meta))
  119. await asyncio.wait_for(self.open_event.wait(), timeout=10)
  120. if self.opened == 0:
  121. raise ConnectionError(self.open_errors[0] if self.open_errors else "all relays failed")
  122. self.pump_task = asyncio.create_task(self._pump_local())
  123. async def _pump_local(self) -> None:
  124. try:
  125. while True:
  126. chunk = await self.local_reader.read(65536)
  127. if not chunk:
  128. break
  129. self.uplink_bytes += len(chunk)
  130. if self.winning_link is None and self.uplink_bytes <= self.warmup_bytes:
  131. await asyncio.gather(*(link.send(Frame(TCP_DATA, self.session_id, self.stream_id, 0, 0, chunk)) for link in self.links if not link.closed), return_exceptions=True)
  132. else:
  133. if self.winning_link is None:
  134. await self.winner_event.wait()
  135. if self.winning_link:
  136. await self.winning_link.send(Frame(TCP_DATA, self.session_id, self.stream_id, 0, 0, chunk))
  137. except Exception:
  138. pass
  139. finally:
  140. await self.close()
  141. async def handle_frame(self, link: RelayLink, frame: Frame) -> None:
  142. if self.closed:
  143. return
  144. if frame.kind == TCP_STATUS:
  145. if frame.packet_id == STATUS_OK:
  146. self.opened += 1
  147. else:
  148. self.open_errors.append(frame.payload.decode("utf-8", errors="replace"))
  149. if self.opened > 0 or len(self.open_errors) == len(self.links):
  150. self.open_event.set()
  151. return
  152. if frame.kind == TCP_DATA:
  153. if self.winning_link is None:
  154. self.winning_link = link
  155. self.winner_name = link.node.name
  156. self.win_counts[link.node.name] = self.win_counts.get(link.node.name, 0) + 1
  157. node_total = self.win_counts[link.node.name]
  158. relay_detail = ", ".join(f"{name}={count}" for name, count in sorted(self.win_counts.items())) or "none"
  159. print(f"[edge] tcp win session={self.session_id} target={self.target_host}:{self.target_port} winner={link.node.name} node_total={node_total} win_breakdown={relay_detail}")
  160. self.winner_event.set()
  161. await self._close_losers(except_link=link)
  162. if link is self.winning_link:
  163. self.local_writer.write(frame.payload)
  164. await self.local_writer.drain()
  165. return
  166. if frame.kind == TCP_CLOSE:
  167. if self.winning_link is None:
  168. self.winning_link = link
  169. self.winner_event.set()
  170. if link is self.winning_link:
  171. await self.close()
  172. async def _close_losers(self, except_link: RelayLink) -> None:
  173. await asyncio.gather(*(link.send(Frame(TCP_CLOSE, self.session_id, self.stream_id, 0, 0, b"")) for link in self.links if link is not except_link and not link.closed), return_exceptions=True)
  174. async def close(self) -> None:
  175. if self.closed:
  176. return
  177. self.closed = True
  178. if self.pump_task and self.pump_task is not asyncio.current_task():
  179. self.pump_task.cancel()
  180. with contextlib.suppress(Exception):
  181. await self.pump_task
  182. await asyncio.gather(*(link.send(Frame(TCP_CLOSE, self.session_id, self.stream_id, 0, 0, b"")) for link in self.links if not link.closed), return_exceptions=True)
  183. for link in self.links:
  184. link.tcp_sessions.pop((self.session_id, self.stream_id), None)
  185. self.local_writer.close()
  186. with contextlib.suppress(Exception):
  187. await self.local_writer.wait_closed()
  188. class UdpAssociateServer(asyncio.DatagramProtocol):
  189. def __init__(self, edge: "SocksEdge") -> None:
  190. self.edge = edge
  191. self.transport: asyncio.DatagramTransport | None = None
  192. self.client_addr = None
  193. self.associate_peer = None
  194. self.packet_counter = itertools.count(1)
  195. self.client_flows: dict[tuple[tuple[str, int], str, int], UdpFlowState] = {}
  196. self.flow_counter = itertools.count(1)
  197. self.last_summary_at = 0.0
  198. self.win_counts: Dict[str, int] = {}
  199. self.relay_error_counts: Dict[str, int] = {}
  200. def connection_made(self, transport) -> None:
  201. self.transport = transport
  202. def register_associate(self, peer) -> None:
  203. peer_text = f"{peer[0]}:{peer[1]}" if isinstance(peer, tuple) and len(peer) >= 2 else str(peer)
  204. if self.associate_peer != peer_text:
  205. print(f"[edge] udp associate peer={peer_text}")
  206. self.associate_peer = peer_text
  207. def _client_flow_key(self, addr, host: str, port: int) -> tuple[tuple[str, int], str, int]:
  208. # Treat port rebinding from the same client IP as the same logical UDP client.
  209. return ((addr[0], 0), host, port)
  210. def datagram_received(self, data: bytes, addr) -> None:
  211. if len(data) < 10:
  212. return
  213. if self.client_addr is None:
  214. self.client_addr = addr
  215. print(f"[edge] udp client bound addr={addr[0]}:{addr[1]}")
  216. elif addr != self.client_addr:
  217. if addr[0] == self.client_addr[0]:
  218. print(f"[edge] udp client port update host={addr[0]} old_port={self.client_addr[1]} new_port={addr[1]}")
  219. self.client_addr = addr
  220. else:
  221. print(f"[edge] udp client rebound old={self.client_addr[0]}:{self.client_addr[1]} new={addr[0]}:{addr[1]}")
  222. self._reset_client_state(addr)
  223. host, port, payload = self._parse_socks_udp(data)
  224. loop = asyncio.get_running_loop()
  225. now = loop.time()
  226. flow_key = self._client_flow_key(addr, host, port)
  227. flow = self.client_flows.get(flow_key)
  228. if flow is None:
  229. flow = UdpFlowState(
  230. flow_id=next(self.flow_counter),
  231. client_addr=(addr[0], addr[1]),
  232. target_host=host,
  233. target_port=port,
  234. created_at=now,
  235. last_activity=now,
  236. )
  237. self.client_flows[flow_key] = flow
  238. flow.touch(now)
  239. flow.packets_sent += 1
  240. packet_id = next(self.packet_counter)
  241. asyncio.create_task(self.edge.forward_udp(flow, payload, packet_id, self))
  242. self._log_udp_summary()
  243. def _reset_client_state(self, addr) -> None:
  244. old_addr = self.client_addr
  245. remapped_flows: dict[tuple[tuple[str, int], str, int], UdpFlowState] = {}
  246. for flow in list(self.client_flows.values()):
  247. flow.client_addr = (addr[0], addr[1])
  248. remapped_flows[self._client_flow_key(addr, flow.target_host, flow.target_port)] = flow
  249. self.client_flows = remapped_flows
  250. self.client_addr = addr
  251. print(f"[edge] udp client rebound migrated old={old_addr[0]}:{old_addr[1]} new={addr[0]}:{addr[1]} flows={len(self.client_flows)}")
  252. async def handle_from_relay(self, frame: Frame, link: RelayLink) -> None:
  253. if self.transport is None or self.client_addr is None:
  254. return
  255. flow = self.edge.udp_flow_sessions.get((frame.session_id, frame.stream_id))
  256. if flow is None:
  257. return
  258. await self._deliver_flow_packet(flow, frame.packet_id, frame.payload, link.node.name)
  259. async def handle_from_direct(self, flow: UdpFlowState, path_name: str, payload: bytes) -> None:
  260. if self.transport is None or self.client_addr is None:
  261. return
  262. await self._deliver_flow_packet(flow, 0, payload, path_name)
  263. async def _deliver_flow_packet(self, flow: UdpFlowState, packet_id: int, payload: bytes, source_name: str) -> None:
  264. if self.transport is None or self.client_addr is None:
  265. return
  266. packet = self._build_socks_udp(flow.target_host, flow.target_port, payload)
  267. now = asyncio.get_running_loop().time()
  268. flow.touch(now)
  269. flow.path_last_seen[source_name] = now
  270. flow.packets_received += 1
  271. if flow.winner_name is None:
  272. flow.winner_name = source_name
  273. self.win_counts[source_name] = self.win_counts.get(source_name, 0) + 1
  274. self._log_udp_summary(force=True)
  275. elif flow.winner_name != source_name:
  276. flow.duplicate_responses += 1
  277. winner_last_seen = flow.path_last_seen.get(flow.winner_name, 0.0)
  278. if winner_last_seen and now - winner_last_seen >= (self.edge.config.udp_failover_idle_ms / 1000):
  279. flow.winner_name = source_name
  280. self.win_counts[source_name] = self.win_counts.get(source_name, 0) + 1
  281. self._log_udp_summary(force=True)
  282. if flow.winner_name == source_name:
  283. self.transport.sendto(packet, self.client_addr)
  284. def set_flow_candidates(self, flow: UdpFlowState, candidate_names: tuple[str, ...]) -> None:
  285. if not flow.candidate_names:
  286. flow.candidate_names = candidate_names
  287. def note_unsent(self, flow: UdpFlowState, packet_id: int) -> None:
  288. flow.touch(asyncio.get_running_loop().time())
  289. flow.relay_failures["unsent"] = flow.relay_failures.get("unsent", 0) + 1
  290. self._log_udp_summary(force=True)
  291. def _log_udp_summary(self, force: bool = False) -> None:
  292. now = asyncio.get_running_loop().time()
  293. if not force and now - self.last_summary_at < 10:
  294. return
  295. self.last_summary_at = now
  296. active_flows = len(self.client_flows)
  297. winners = sum(1 for flow in self.client_flows.values() if flow.winner_name)
  298. packets_sent = sum(flow.packets_sent for flow in self.client_flows.values())
  299. packets_received = sum(flow.packets_received for flow in self.client_flows.values())
  300. duplicates = sum(flow.duplicate_responses for flow in self.client_flows.values())
  301. direct_paths = sum(len(flow.direct_sockets) for flow in self.client_flows.values())
  302. relay_candidates = sum(len(flow.link_streams) for flow in self.client_flows.values())
  303. candidate_names: list[str] = []
  304. seen_candidates: set[str] = set()
  305. for flow in sorted(self.client_flows.values(), key=lambda item: item.flow_id):
  306. for name in flow.candidate_names:
  307. if name in seen_candidates:
  308. continue
  309. seen_candidates.add(name)
  310. candidate_names.append(name)
  311. direct_wins = sum(1 for flow in self.client_flows.values() if flow.winner_name and flow.winner_name.startswith("direct"))
  312. relay_wins = winners - direct_wins
  313. sample_flows = [
  314. f"{flow.flow_id}:{flow.winner_name or 'pending'}"
  315. for flow in sorted(self.client_flows.values(), key=lambda item: item.flow_id)
  316. if flow.winner_name
  317. ][:5]
  318. winner_detail = ", ".join(sample_flows) or "none"
  319. relay_errors: list[str] = []
  320. for flow in self.client_flows.values():
  321. for name, count in flow.relay_failures.items():
  322. relay_errors.append(f"{name}={count}")
  323. relay_error_detail = ", ".join(sorted(relay_errors)) or "none"
  324. if self.client_addr:
  325. print(
  326. f"[edge] udp summary bind={self.client_addr[0]}:{self.client_addr[1]} flows={active_flows} winners={winners} "
  327. f"winner_breakdown=direct={direct_wins},relay={relay_wins} sample={winner_detail} "
  328. f"candidates={candidate_names or ['none']} "
  329. f"sent={packets_sent} recv={packets_received} dup={duplicates} "
  330. f"direct_paths={direct_paths} relay_paths={relay_candidates} relay_errors={relay_error_detail}"
  331. )
  332. else:
  333. print(
  334. f"[edge] udp summary bind=unbound flows={active_flows} winners={winners} "
  335. f"winner_breakdown=direct={direct_wins},relay={relay_wins} sample={winner_detail} "
  336. f"candidates={candidate_names or ['none']} "
  337. f"sent={packets_sent} recv={packets_received} dup={duplicates} "
  338. f"direct_paths={direct_paths} relay_paths={relay_candidates} relay_errors={relay_error_detail}"
  339. )
  340. def _parse_socks_udp(self, packet: bytes) -> tuple[str, int, bytes]:
  341. atyp = packet[3]
  342. offset = 4
  343. if atyp == 1:
  344. host = socket.inet_ntoa(packet[offset:offset + 4])
  345. offset += 4
  346. elif atyp == 3:
  347. size = packet[offset]
  348. offset += 1
  349. host = packet[offset:offset + size].decode()
  350. offset += size
  351. else:
  352. raise ValueError("unsupported udp atyp")
  353. port = struct.unpack("!H", packet[offset:offset + 2])[0]
  354. offset += 2
  355. return host, port, packet[offset:]
  356. def _build_socks_udp(self, host: str, port: int, payload: bytes) -> bytes:
  357. try:
  358. addr = socket.inet_aton(host)
  359. header = b"\x00\x00\x00\x01" + addr + struct.pack("!H", port)
  360. except OSError:
  361. raw = host.encode()
  362. header = b"\x00\x00\x00\x03" + bytes([len(raw)]) + raw + struct.pack("!H", port)
  363. return header + payload
  364. class SocksEdge:
  365. def __init__(self, listen_host: str, listen_port: int, config: Config) -> None:
  366. self.listen_host = listen_host
  367. self.listen_port = listen_port
  368. self.config = config
  369. self.scheduler = Scheduler(config)
  370. self.links: list[RelayLink] = []
  371. self.session_ids = itertools.count(1)
  372. self.udp_stream_ids = itertools.count(1)
  373. self.udp_flow_sessions: dict[tuple[int, int], UdpFlowState] = {}
  374. self.udp_server: UdpAssociateServer | None = None
  375. async def start(self) -> None:
  376. await self.scheduler.start()
  377. await self._connect_relays()
  378. server = await asyncio.start_server(self._accept, self.listen_host, self.listen_port)
  379. sockets = ", ".join(str(sock.getsockname()) for sock in server.sockets or [])
  380. print(f"[edge] socks5 listening on {sockets}")
  381. async with server:
  382. await server.serve_forever()
  383. async def _connect_relays(self) -> None:
  384. loop = asyncio.get_running_loop()
  385. transport, protocol = await loop.create_datagram_endpoint(lambda: UdpAssociateServer(self), local_addr=(self.listen_host, 0))
  386. self.udp_server = protocol
  387. self.udp_transport = transport
  388. for node in self.config.relays:
  389. link = RelayLink(node=node, reader=None, writer=None) # type: ignore[arg-type]
  390. link.udp_server = protocol
  391. self.links.append(link)
  392. link.maintain_task = asyncio.create_task(self._maintain_link(link))
  393. async def _maintain_link(self, link: RelayLink) -> None:
  394. backoff = 1.0
  395. while True:
  396. try:
  397. reader, writer = await asyncio.open_connection(link.node.host, link.node.port)
  398. sock = writer.get_extra_info("socket")
  399. if sock is not None:
  400. with contextlib.suppress(OSError):
  401. sock.setsockopt(socket.IPPROTO_TCP, socket.TCP_NODELAY, 1)
  402. link.reader = reader
  403. link.writer = writer
  404. await link.start()
  405. backoff = 1.0
  406. await link.closed_event.wait()
  407. except asyncio.CancelledError:
  408. raise
  409. except Exception:
  410. await asyncio.sleep(backoff)
  411. backoff = min(10.0, backoff * 2)
  412. async def _accept(self, reader: asyncio.StreamReader, writer: asyncio.StreamWriter) -> None:
  413. try:
  414. peer = writer.get_extra_info("peername")
  415. _host, _port, udp_mode = await self._handshake(reader, writer, peer)
  416. if udp_mode:
  417. return
  418. except Exception:
  419. writer.close()
  420. with contextlib.suppress(Exception):
  421. await writer.wait_closed()
  422. def _selected_links(self) -> list[RelayLink]:
  423. chosen = {node.name for node in self.scheduler.choose()}
  424. links = [link for link in self.links if link.node.name in chosen and not link.closed]
  425. return links or [link for link in self.links if not link.closed][:1]
  426. def _selected_udp_links(self) -> list[RelayLink]:
  427. online = [link for link in self.links if not link.closed and link.writer is not None]
  428. if not online:
  429. return []
  430. ordered = sorted(online, key=lambda link: self.scheduler.scores.get(link.node.name).score if link.node.name in self.scheduler.scores else 999999.0)
  431. return ordered
  432. def _udp_direct_redundancy_for_target(self, target_host: str) -> int:
  433. base = self.config.udp_direct_redundancy
  434. if ":" in target_host and self.config.udp_direct_redundancy_v6 is not None:
  435. base = self.config.udp_direct_redundancy_v6
  436. elif ":" not in target_host and self.config.udp_direct_redundancy_v4 is not None:
  437. base = self.config.udp_direct_redundancy_v4
  438. return max(1, base)
  439. async def _ensure_udp_direct_paths(self, flow: UdpFlowState, udp_server: UdpAssociateServer) -> None:
  440. target_count = self._udp_direct_redundancy_for_target(flow.target_host)
  441. for index in range(target_count):
  442. name = f"direct-{index + 1}" if target_count > 1 else "direct"
  443. if name in flow.direct_sockets or name in flow.direct_failures:
  444. continue
  445. try:
  446. family = socket.AF_INET6 if ":" in flow.target_host else socket.AF_INET
  447. sock = socket.socket(family, socket.SOCK_DGRAM)
  448. sock.setblocking(False)
  449. await asyncio.get_running_loop().sock_connect(sock, (flow.target_host, flow.target_port))
  450. flow.direct_sockets[name] = sock
  451. flow.direct_tasks[name] = asyncio.create_task(self._pump_udp_direct(flow, name, sock, udp_server))
  452. except Exception as exc:
  453. flow.direct_failures.add(name)
  454. print(f"[edge] udp direct open error flow={flow.flow_id} path={name} target={flow.target_host}:{flow.target_port} error={exc!r}")
  455. async def _pump_udp_direct(self, flow: UdpFlowState, path_name: str, sock: socket.socket, udp_server: UdpAssociateServer) -> None:
  456. loop = asyncio.get_running_loop()
  457. try:
  458. while True:
  459. data = await loop.sock_recv(sock, 65535)
  460. if not data:
  461. break
  462. await udp_server.handle_from_direct(flow, path_name, data)
  463. except Exception:
  464. pass
  465. finally:
  466. flow.direct_tasks.pop(path_name, None)
  467. flow.direct_sockets.pop(path_name, None)
  468. with contextlib.suppress(Exception):
  469. sock.close()
  470. async def forward_udp(self, flow: UdpFlowState, payload: bytes, packet_id: int, udp_server: UdpAssociateServer) -> None:
  471. await self._ensure_udp_direct_paths(flow, udp_server)
  472. meta = encode_json({"host": flow.target_host, "port": flow.target_port})
  473. links = self._selected_udp_links()
  474. direct_names = tuple(name for name in sorted(flow.direct_sockets))
  475. relay_names = tuple(link.node.name for link in links)
  476. candidate_names = direct_names + relay_names
  477. udp_server.set_flow_candidates(flow, candidate_names)
  478. if not candidate_names:
  479. udp_server.note_unsent(flow, packet_id)
  480. return
  481. active_direct_names = list(direct_names)
  482. active_links = links
  483. if not (self.config.udp_always_broadcast or flow.winner_name is None):
  484. winner_last_seen = flow.path_last_seen.get(flow.winner_name, 0.0) if flow.winner_name else 0.0
  485. if winner_last_seen and asyncio.get_running_loop().time() - winner_last_seen >= (self.config.udp_failover_idle_ms / 1000):
  486. flow.winner_name = None
  487. active_direct_names = [name for name in active_direct_names if name == flow.winner_name]
  488. active_links = [link for link in active_links if link.node.name == flow.winner_name]
  489. if not active_direct_names and not active_links:
  490. if direct_names:
  491. active_direct_names = [direct_names[0]]
  492. elif links:
  493. active_links = links[:1]
  494. copies = max(1, self.config.udp_redundancy + 1)
  495. sent_any = False
  496. for attempt in range(copies):
  497. for path_name in active_direct_names:
  498. sock = flow.direct_sockets.get(path_name)
  499. if sock is None:
  500. continue
  501. try:
  502. await asyncio.get_running_loop().sock_sendall(sock, payload)
  503. sent_any = True
  504. except Exception as exc:
  505. flow.direct_failures.add(path_name)
  506. flow.direct_sockets.pop(path_name, None)
  507. task = flow.direct_tasks.pop(path_name, None)
  508. if task is not None:
  509. task.cancel()
  510. with contextlib.suppress(Exception):
  511. sock.close()
  512. flow.relay_failures[path_name] = flow.relay_failures.get(path_name, 0) + 1
  513. if path_name not in flow.relay_error_seen:
  514. flow.relay_error_seen.add(path_name)
  515. print(
  516. f"[edge] udp relay error flow={flow.flow_id} relay={path_name} error={exc!r}"
  517. )
  518. for link in active_links:
  519. stream_id = flow.link_streams.get(link.node.name)
  520. if stream_id is None:
  521. stream_id = next(self.udp_stream_ids)
  522. flow.link_streams[link.node.name] = stream_id
  523. self.udp_flow_sessions[(flow.flow_id, stream_id)] = flow
  524. include_meta = link.node.name not in flow.initialized_links
  525. body = (meta + payload) if include_meta else payload
  526. meta_len = len(meta) if include_meta else 0
  527. try:
  528. await link.send(Frame(UDP_SEND, flow.flow_id, stream_id, 0, meta_len, body))
  529. flow.initialized_links.add(link.node.name)
  530. sent_any = True
  531. except Exception as exc:
  532. flow.link_streams.pop(link.node.name, None)
  533. self.udp_flow_sessions.pop((flow.flow_id, stream_id), None)
  534. flow.relay_failures[link.node.name] = flow.relay_failures.get(link.node.name, 0) + 1
  535. if link.node.name not in flow.relay_error_seen:
  536. flow.relay_error_seen.add(link.node.name)
  537. print(
  538. f"[edge] udp relay error flow={flow.flow_id} relay={link.node.name} error={exc!r}"
  539. )
  540. if attempt + 1 < copies and self.config.udp_copy_interval_ms > 0:
  541. await asyncio.sleep(self.config.udp_copy_interval_ms / 1000)
  542. if not sent_any:
  543. udp_server.note_unsent(flow, packet_id)
  544. async def _handshake(self, reader: asyncio.StreamReader, writer: asyncio.StreamWriter, peer) -> tuple[str, int, bool]:
  545. version, methods_len = (await read_exact(reader, 2))
  546. if version != SOCKS_VERSION:
  547. raise ValueError("unsupported socks version")
  548. await read_exact(reader, methods_len)
  549. writer.write(b"\x05\x00")
  550. await writer.drain()
  551. version, command, _, atyp = await read_exact(reader, 4)
  552. if version != SOCKS_VERSION:
  553. raise ValueError("unsupported socks version")
  554. if atyp == 1:
  555. host = socket.inet_ntoa(await read_exact(reader, 4))
  556. elif atyp == 3:
  557. size = (await read_exact(reader, 1))[0]
  558. host = (await read_exact(reader, size)).decode()
  559. else:
  560. raise ValueError("unsupported atyp")
  561. port = struct.unpack("!H", await read_exact(reader, 2))[0]
  562. peer_text = f"{peer[0]}:{peer[1]}" if isinstance(peer, tuple) and len(peer) >= 2 else str(peer)
  563. if command == 1:
  564. print(f"[edge] socks handshake peer={peer_text} command=connect target={host}:{port}")
  565. writer.write(b"\x05\x00\x00\x01\x00\x00\x00\x00\x00\x00")
  566. await writer.drain()
  567. return host, port, False
  568. if command == 3 and self.udp_server and self.udp_server.transport:
  569. bind_host, bind_port = self.udp_server.transport.get_extra_info("sockname")[:2]
  570. self.udp_server.register_associate(peer)
  571. print(f"[edge] socks handshake peer={peer_text} command=udp_associate target={host}:{port} bind={bind_host}:{bind_port}")
  572. writer.write(b"\x05\x00\x00\x01" + socket.inet_aton(bind_host) + struct.pack("!H", bind_port))
  573. await writer.drain()
  574. return host, port, True
  575. raise ValueError("unsupported socks command")