v2fly/app/tun/packetparse/udp.go

package packetparse

import (
	"github.com/google/gopacket"
	"github.com/google/gopacket/layers"
	"github.com/v2fly/v2ray-core/v5/common/net"
)

var errNotIPPacket = newError("not an IP packet")
var errNotUDPPacket = newError("not a UDP packet")

var nullDestination = net.UnixDestination(net.DomainAddress("null"))

func TryParseAsUDPPacket(packet []byte) (src, dst net.Destination, data []byte, err error) {
	parsedPacket := gopacket.NewPacket(packet, layers.LayerTypeIPv4, gopacket.DecodeOptions{
		Lazy:                     true,
		NoCopy:                   false,
		SkipDecodeRecovery:       false,
		DecodeStreamsAsDatagrams: false,
	})

	var srcIP net.Address
	var dstIP net.Address
	ipv4Layer := parsedPacket.Layer(layers.LayerTypeIPv4)

	if ipv4Layer == nil {
		parsedPacketAsIPv6 := gopacket.NewPacket(packet, layers.LayerTypeIPv6, gopacket.DecodeOptions{
			Lazy:                     true,
			NoCopy:                   false,
			SkipDecodeRecovery:       false,
			DecodeStreamsAsDatagrams: false,
		})
		ipv6Layer := parsedPacketAsIPv6.Layer(layers.LayerTypeIPv6)
		if ipv6Layer == nil {
			return nullDestination, nullDestination, nil, errNotIPPacket
		}
		ipv6 := ipv6Layer.(*layers.IPv6)
		srcIP = net.IPAddress(ipv6.SrcIP)
		dstIP = net.IPAddress(ipv6.DstIP)

		parsedPacket = parsedPacketAsIPv6
	} else {
		ipv4 := ipv4Layer.(*layers.IPv4)
		srcIP = net.IPAddress(ipv4.SrcIP)
		dstIP = net.IPAddress(ipv4.DstIP)
	}

	udpLayer := parsedPacket.Layer(layers.LayerTypeUDP)
	if udpLayer == nil {
		return nullDestination, nullDestination, nil, errNotUDPPacket
	}
	udp := udpLayer.(*layers.UDP)
	srcPort := net.Port(udp.SrcPort)
	dstPort := net.Port(udp.DstPort)

	src = net.UDPDestination(srcIP, srcPort)
	dst = net.UDPDestination(dstIP, dstPort)
	data = udp.Payload
	return
}

func TryConstructUDPPacket(src, dst net.Destination, data []byte) ([]byte, error) {
	if src.Address.Family().IsIPv4() && dst.Address.Family().IsIPv4() {
		return constructIPv4UDPPacket(src, dst, data)
	}
	if src.Address.Family().IsIPv6() && dst.Address.Family().IsIPv6() {
		return constructIPv6UDPPacket(src, dst, data)
	}
	return nil, newError("not supported")
}

func constructIPv4UDPPacket(src, dst net.Destination, data []byte) ([]byte, error) {
	ipv4 := &layers.IPv4{
		Version:  4,
		Protocol: layers.IPProtocolUDP,
		SrcIP:    src.Address.IP(),
		DstIP:    dst.Address.IP(),
	}
	udp := &layers.UDP{
		SrcPort: layers.UDPPort(src.Port),
		DstPort: layers.UDPPort(dst.Port),
	}
	err := udp.SetNetworkLayerForChecksum(ipv4)
	if err != nil {
		return nil, err
	}
	buffer := gopacket.NewSerializeBuffer()
	if err := gopacket.SerializeLayers(buffer, gopacket.SerializeOptions{
		FixLengths:       true,
		ComputeChecksums: true,
	}, ipv4, udp, gopacket.Payload(data)); err != nil {
		return nil, err
	}
	return buffer.Bytes(), nil
}

func constructIPv6UDPPacket(src, dst net.Destination, data []byte) ([]byte, error) {
	ipv6 := &layers.IPv6{
		Version:    6,
		NextHeader: layers.IPProtocolUDP,
		SrcIP:      src.Address.IP(),
		DstIP:      dst.Address.IP(),
	}
	udp := &layers.UDP{
		SrcPort: layers.UDPPort(src.Port),
		DstPort: layers.UDPPort(dst.Port),
	}
	err := udp.SetNetworkLayerForChecksum(ipv6)
	if err != nil {
		return nil, err
	}
	buffer := gopacket.NewSerializeBuffer()
	if err := gopacket.SerializeLayers(buffer, gopacket.SerializeOptions{
		FixLengths:       true,
		ComputeChecksums: true,
	}, ipv6, udp, gopacket.Payload(data)); err != nil {
		return nil, err
	}
	return buffer.Bytes(), nil
}