Hunter0x7c7
2022-08-11 b8230139fb40edea387617b6accd8371e37eda58
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
package packetaddr
 
import (
    "bytes"
    gonet "net"
 
    "github.com/v2fly/v2ray-core/v5/common/buf"
    "github.com/v2fly/v2ray-core/v5/common/net"
    "github.com/v2fly/v2ray-core/v5/common/protocol"
)
 
var addrParser = protocol.NewAddressParser(
    protocol.AddressFamilyByte(0x01, net.AddressFamilyIPv4),
    protocol.AddressFamilyByte(0x02, net.AddressFamilyIPv6),
)
 
// AttachAddressToPacket
// relinquish ownership of data
// gain ownership of the returning value
func AttachAddressToPacket(data *buf.Buffer, address gonet.Addr) (*buf.Buffer, error) {
    packetBuf := buf.New()
    udpaddr := address.(*gonet.UDPAddr)
    port, err := net.PortFromInt(uint32(udpaddr.Port))
    if err != nil {
        return nil, err
    }
    err = addrParser.WriteAddressPort(packetBuf, net.IPAddress(udpaddr.IP), port)
    if err != nil {
        return nil, err
    }
    _, err = packetBuf.Write(data.Bytes())
    if err != nil {
        return nil, err
    }
    data.Release()
    return packetBuf, nil
}
 
// ExtractAddressFromPacket
// relinquish ownership of data
// gain ownership of the returning value
func ExtractAddressFromPacket(data *buf.Buffer) (*buf.Buffer, gonet.Addr, error) {
    packetBuf := buf.StackNew()
    address, port, err := addrParser.ReadAddressPort(&packetBuf, bytes.NewReader(data.Bytes()))
    if err != nil {
        return nil, nil, err
    }
    addr := &gonet.UDPAddr{
        IP:   address.IP(),
        Port: int(port.Value()),
        Zone: "",
    }
    data.Advance(packetBuf.Len())
    packetBuf.Release()
    return data, addr, nil
}