|
|
|
@ -6,28 +6,45 @@
|
|
|
|
|
package stun
|
|
|
|
|
|
|
|
|
|
import (
|
|
|
|
|
"bytes"
|
|
|
|
|
crand "crypto/rand"
|
|
|
|
|
"errors"
|
|
|
|
|
"hash/crc32"
|
|
|
|
|
)
|
|
|
|
|
|
|
|
|
|
var (
|
|
|
|
|
bindingRequest = []byte{0x00, 0x01}
|
|
|
|
|
magicCookie = []byte{0x21, 0x12, 0xa4, 0x42}
|
|
|
|
|
attrSoftware = append([]byte{
|
|
|
|
|
attrSoftware = append([]byte{
|
|
|
|
|
0x80, 0x22, // software header
|
|
|
|
|
0x00, byte(len("tailnode")), // attr length
|
|
|
|
|
}, "tailnode"...)
|
|
|
|
|
lenMsg = byte(len(attrSoftware) + lenFingerprint) // number of bytes following header
|
|
|
|
|
)
|
|
|
|
|
|
|
|
|
|
const lenFingerprint = 8 // 2+byte header + 2-byte length + 4-byte crc32
|
|
|
|
|
const (
|
|
|
|
|
bindingRequest = "\x00\x01"
|
|
|
|
|
magicCookie = "\x21\x12\xa4\x42"
|
|
|
|
|
lenFingerprint = 8 // 2+byte header + 2-byte length + 4-byte crc32
|
|
|
|
|
ipv4Len = 4
|
|
|
|
|
ipv6Len = 16
|
|
|
|
|
headerLen = 20
|
|
|
|
|
)
|
|
|
|
|
|
|
|
|
|
// TxID is a transaction ID.
|
|
|
|
|
type TxID [12]byte
|
|
|
|
|
|
|
|
|
|
// NewTxID returns a new random TxID.
|
|
|
|
|
func NewTxID() TxID {
|
|
|
|
|
var tx TxID
|
|
|
|
|
if _, err := crand.Read(tx[:]); err != nil {
|
|
|
|
|
panic(err)
|
|
|
|
|
}
|
|
|
|
|
return tx
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// Request generates a binding request STUN packet.
|
|
|
|
|
// The transaction ID, tID, should be a random sequence of bytes.
|
|
|
|
|
func Request(tID [12]byte) []byte {
|
|
|
|
|
func Request(tID TxID) []byte {
|
|
|
|
|
// STUN header, RFC5389 Section 6.
|
|
|
|
|
b := make([]byte, 0, 20+len(attrSoftware)+lenFingerprint)
|
|
|
|
|
b := make([]byte, 0, headerLen+len(attrSoftware)+lenFingerprint)
|
|
|
|
|
b = append(b, bindingRequest...)
|
|
|
|
|
b = append(b, 0x00, lenMsg)
|
|
|
|
|
b = append(b, magicCookie...)
|
|
|
|
@ -58,16 +75,17 @@ var (
|
|
|
|
|
|
|
|
|
|
// ParseResponse parses a successful binding response STUN packet.
|
|
|
|
|
// The IP address is extracted from the XOR-MAPPED-ADDRESS attribute.
|
|
|
|
|
func ParseResponse(b []byte) (tID [12]byte, addr []byte, port uint16, err error) {
|
|
|
|
|
// The returned addr slice is owned by the caller and does not alias b.
|
|
|
|
|
func ParseResponse(b []byte) (tID TxID, addr []byte, port uint16, err error) {
|
|
|
|
|
if !Is(b) {
|
|
|
|
|
return tID, nil, 0, ErrNotSTUN
|
|
|
|
|
}
|
|
|
|
|
copy(tID[:], b[8:20])
|
|
|
|
|
copy(tID[:], b[8:headerLen])
|
|
|
|
|
if b[0] != 0x01 || b[1] != 0x01 {
|
|
|
|
|
return tID, nil, 0, ErrNotSuccessResponse
|
|
|
|
|
}
|
|
|
|
|
attrsLen := int(b[2])<<8 | int(b[3])
|
|
|
|
|
b = b[20:] // remove STUN header
|
|
|
|
|
b = b[headerLen:] // remove STUN header
|
|
|
|
|
if attrsLen > len(b) {
|
|
|
|
|
return tID, nil, 0, ErrMalformedAttrs
|
|
|
|
|
} else if len(b) > attrsLen {
|
|
|
|
@ -143,64 +161,66 @@ func ParseResponse(b []byte) (tID [12]byte, addr []byte, port uint16, err error)
|
|
|
|
|
return tID, nil, 0, ErrMalformedAttrs
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
func xorMappedAddress(tID [12]byte, b []byte) (addr []byte, port uint16, err error) {
|
|
|
|
|
func xorMappedAddress(tID TxID, b []byte) (addr []byte, port uint16, err error) {
|
|
|
|
|
// XOR-MAPPED-ADDRESS attribute, RFC5389 Section 15.2
|
|
|
|
|
if len(b) < 8 {
|
|
|
|
|
if len(b) < 4 {
|
|
|
|
|
return nil, 0, ErrMalformedAttrs
|
|
|
|
|
}
|
|
|
|
|
xorPort := uint16(b[2])<<8 | uint16(b[3])
|
|
|
|
|
addrField := b[4:]
|
|
|
|
|
port = xorPort ^ 0x2112 // first half of magicCookie
|
|
|
|
|
|
|
|
|
|
switch ipFamily := b[1]; ipFamily { // RFC5389 Section 15.1
|
|
|
|
|
case 0x01: // IPv4
|
|
|
|
|
addr = make([]byte, 4)
|
|
|
|
|
xorAddr := b[4 : 4+len(addr)]
|
|
|
|
|
for i := range xorAddr {
|
|
|
|
|
addrLen := familyAddrLen(b[1])
|
|
|
|
|
if addrLen == 0 {
|
|
|
|
|
return nil, 0, ErrMalformedAttrs
|
|
|
|
|
}
|
|
|
|
|
if len(addrField) < addrLen {
|
|
|
|
|
return nil, 0, ErrMalformedAttrs
|
|
|
|
|
}
|
|
|
|
|
xorAddr := addrField[:addrLen]
|
|
|
|
|
addr = make([]byte, addrLen)
|
|
|
|
|
for i := range xorAddr {
|
|
|
|
|
if i < len(magicCookie) {
|
|
|
|
|
addr[i] = xorAddr[i] ^ magicCookie[i]
|
|
|
|
|
} else {
|
|
|
|
|
addr[i] = xorAddr[i] ^ tID[i-len(magicCookie)]
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
return addr, port, nil
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
func familyAddrLen(fam byte) int {
|
|
|
|
|
switch fam {
|
|
|
|
|
case 0x01: // IPv4
|
|
|
|
|
return ipv4Len
|
|
|
|
|
case 0x02: // IPv6
|
|
|
|
|
addr = make([]byte, 16)
|
|
|
|
|
xorAddr := b[4 : 4+len(addr)]
|
|
|
|
|
for i := range xorAddr {
|
|
|
|
|
addr[i] = xorAddr[i] ^ magicCookie[i]
|
|
|
|
|
}
|
|
|
|
|
for i := 4; i < len(addr); i++ {
|
|
|
|
|
addr[i] = xorAddr[i] ^ tID[4-i]
|
|
|
|
|
}
|
|
|
|
|
return ipv6Len
|
|
|
|
|
default:
|
|
|
|
|
return nil, 0, ErrMalformedAttrs
|
|
|
|
|
return 0
|
|
|
|
|
}
|
|
|
|
|
if len(b) < 4+len(addr) {
|
|
|
|
|
return nil, 0, ErrMalformedAttrs
|
|
|
|
|
}
|
|
|
|
|
return addr, port, err
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
func mappedAddress(b []byte) (addr []byte, port uint16, err error) {
|
|
|
|
|
if len(b) < 8 {
|
|
|
|
|
if len(b) < 4 {
|
|
|
|
|
return nil, 0, ErrMalformedAttrs
|
|
|
|
|
}
|
|
|
|
|
port = uint16(b[2])<<8 | uint16(b[3])
|
|
|
|
|
|
|
|
|
|
switch ipFamily := b[1]; ipFamily { // RFC5389 Section 15.1
|
|
|
|
|
case 0x01: // IPv4
|
|
|
|
|
addr = b[4 : 4+4]
|
|
|
|
|
case 0x02: // IPv6
|
|
|
|
|
addr = b[4 : 4+16]
|
|
|
|
|
default:
|
|
|
|
|
addrField := b[4:]
|
|
|
|
|
addrLen := familyAddrLen(b[1])
|
|
|
|
|
if addrLen == 0 {
|
|
|
|
|
return nil, 0, ErrMalformedAttrs
|
|
|
|
|
}
|
|
|
|
|
return addr, port, err
|
|
|
|
|
if len(addrField) < addrLen {
|
|
|
|
|
return nil, 0, ErrMalformedAttrs
|
|
|
|
|
}
|
|
|
|
|
return append([]byte(nil), addrField[:addrLen]...), port, nil
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// Is reports whether b is a STUN message.
|
|
|
|
|
func Is(b []byte) bool {
|
|
|
|
|
if len(b) < 20 {
|
|
|
|
|
if len(b) < headerLen {
|
|
|
|
|
return false // every STUN message must have a 20-byte header
|
|
|
|
|
}
|
|
|
|
|
// TODO RFC5389 suggests checking the first 2 bits of the header are zero.
|
|
|
|
|
if !bytes.Equal(b[4:8], magicCookie) {
|
|
|
|
|
return false
|
|
|
|
|
}
|
|
|
|
|
return true
|
|
|
|
|
return string(b[4:8]) == magicCookie
|
|
|
|
|
}
|
|
|
|
|