v2fly/proxy/socks/protocol/udp.go

package protocol

import (
	"encoding/binary"
	"errors"

	"github.com/v2ray/v2ray-core/common/log"
	v2net "github.com/v2ray/v2ray-core/common/net"
)

var (
	ErrorUnknownAddressType = errors.New("Unknown Address Type.")
)

type Socks5UDPRequest struct {
	Fragment byte
	Address  v2net.Address
	Data     []byte
}

func (request *Socks5UDPRequest) Destination() v2net.Destination {
	return v2net.NewUDPDestination(request.Address)
}

func (request *Socks5UDPRequest) Bytes(buffer []byte) []byte {
  if buffer == nil {
    buffer = make([]byte, 0, 2*1024)
  }
  buffer = append(buffer, 0, 0, request.Fragment)
  switch {
    case request.Address.IsIPv4():
    buffer = append(buffer, AddrTypeIPv4)
    buffer = append(buffer, request.Address.IP()...)
    case request.Address.IsIPv6():
    buffer = append(buffer, AddrTypeIPv6)
    buffer = append(buffer, request.Address.IP()...)
    case request.Address.IsDomain():
    buffer = append(buffer, AddrTypeDomain)
    buffer = append(buffer, byte(len(request.Address.Domain())))
    buffer = append(buffer, []byte(request.Address.Domain())...)
  }
  buffer = append(buffer, request.Address.PortBytes()...)
  buffer = append(buffer, request.Data...)
  return buffer
}

func ReadUDPRequest(packet []byte) (request Socks5UDPRequest, err error) {
	// packet[0] and packet[1] are reserved
	request.Fragment = packet[2]

	addrType := packet[3]
	var dataBegin int

	switch addrType {
	case AddrTypeIPv4:
		ip := packet[4:8]
		port := binary.BigEndian.Uint16(packet[8:10])
		request.Address = v2net.IPAddress(ip, port)
		dataBegin = 10
	case AddrTypeIPv6:
		ip := packet[4:20]
		port := binary.BigEndian.Uint16(packet[20:22])
		request.Address = v2net.IPAddress(ip, port)
		dataBegin = 22
	case AddrTypeDomain:
		domainLength := int(packet[4])
		domain := string(packet[5 : 5+domainLength])
		port := binary.BigEndian.Uint16(packet[5+domainLength : 5+domainLength+2])
		request.Address = v2net.DomainAddress(domain, port)
		dataBegin = 5 + domainLength + 2
	default:
		log.Warning("Unknown address type %d", addrType)
		err = ErrorUnknownAddressType
		return
	}

	request.Data = make([]byte, len(packet)-dataBegin)
	copy(request.Data, packet[dataBegin:])

	return
}