//go:build with_gvisor package tun import ( "context" "math" "net/netip" "os" "sync" "github.com/sagernet/gvisor/pkg/buffer" "github.com/sagernet/gvisor/pkg/tcpip" "github.com/sagernet/gvisor/pkg/tcpip/adapters/gonet" "github.com/sagernet/gvisor/pkg/tcpip/checksum" "github.com/sagernet/gvisor/pkg/tcpip/header" "github.com/sagernet/gvisor/pkg/tcpip/stack" "github.com/sagernet/sing/common/buf" E "github.com/sagernet/sing/common/exceptions" M "github.com/sagernet/sing/common/metadata" N "github.com/sagernet/sing/common/network" "github.com/sagernet/sing/common/udpnat" ) type UDPForwarder struct { ctx context.Context stack *stack.Stack udpNat *udpnat.Service[netip.AddrPort] // cache cacheProto tcpip.NetworkProtocolNumber cacheID stack.TransportEndpointID } func NewUDPForwarder(ctx context.Context, stack *stack.Stack, handler Handler, udpTimeout int64) *UDPForwarder { return &UDPForwarder{ ctx: ctx, stack: stack, udpNat: udpnat.NewEx[netip.AddrPort](udpTimeout, handler), } } func (f *UDPForwarder) HandlePacket(id stack.TransportEndpointID, pkt *stack.PacketBuffer) bool { source := M.SocksaddrFrom(AddrFromAddress(id.RemoteAddress), id.RemotePort) destination := M.SocksaddrFrom(AddrFromAddress(id.LocalAddress), id.LocalPort) if source.IsIPv4() { f.cacheProto = header.IPv4ProtocolNumber } else { f.cacheProto = header.IPv6ProtocolNumber } gBuffer := pkt.Data().ToBuffer() sBuffer := buf.NewSize(int(gBuffer.Size())) gBuffer.Apply(func(view *buffer.View) { sBuffer.Write(view.AsSlice()) }) f.cacheID = id f.udpNat.NewPacketEx( f.ctx, source.AddrPort(), sBuffer, source, destination, f.newUDPConn, ) return true } func (f *UDPForwarder) newUDPConn(natConn N.PacketConn) N.PacketWriter { return &UDPBackWriter{ stack: f.stack, source: f.cacheID.RemoteAddress, sourcePort: f.cacheID.RemotePort, sourceNetwork: f.cacheProto, } } type UDPBackWriter struct { access sync.Mutex stack *stack.Stack source tcpip.Address sourcePort uint16 sourceNetwork tcpip.NetworkProtocolNumber } func (w *UDPBackWriter) WritePacket(packetBuffer *buf.Buffer, destination M.Socksaddr) error { if !destination.IsIP() { return E.Cause(os.ErrInvalid, "invalid destination") } else if destination.IsIPv4() && w.sourceNetwork == header.IPv6ProtocolNumber { destination = M.SocksaddrFrom(netip.AddrFrom16(destination.Addr.As16()), destination.Port) } else if destination.IsIPv6() && (w.sourceNetwork == header.IPv4ProtocolNumber) { return E.New("send IPv6 packet to IPv4 connection") } defer packetBuffer.Release() route, err := w.stack.FindRoute( defaultNIC, AddressFromAddr(destination.Addr), w.source, w.sourceNetwork, false, ) if err != nil { return gonet.TranslateNetstackError(err) } defer route.Release() packet := stack.NewPacketBuffer(stack.PacketBufferOptions{ ReserveHeaderBytes: header.UDPMinimumSize + int(route.MaxHeaderLength()), Payload: buffer.MakeWithData(packetBuffer.Bytes()), }) defer packet.DecRef() packet.TransportProtocolNumber = header.UDPProtocolNumber udpHdr := header.UDP(packet.TransportHeader().Push(header.UDPMinimumSize)) pLen := uint16(packet.Size()) udpHdr.Encode(&header.UDPFields{ SrcPort: destination.Port, DstPort: w.sourcePort, Length: pLen, }) if route.RequiresTXTransportChecksum() && w.sourceNetwork == header.IPv6ProtocolNumber { xsum := udpHdr.CalculateChecksum(checksum.Combine( route.PseudoHeaderChecksum(header.UDPProtocolNumber, pLen), packet.Data().Checksum(), )) if xsum != math.MaxUint16 { xsum = ^xsum } udpHdr.SetChecksum(xsum) } err = route.WritePacket(stack.NetworkHeaderParams{ Protocol: header.UDPProtocolNumber, TTL: route.DefaultTTL(), TOS: 0, }, packet) if err != nil { route.Stats().UDP.PacketSendErrors.Increment() return gonet.TranslateNetstackError(err) } route.Stats().UDP.PacketsSent.Increment() return nil }