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
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
|
/*
* This file is part of the Nice GLib ICE library.
*
* (C) 2008-2009 Collabora Ltd.
* Contact: Youness Alaoui
* (C) 2007-2009 Nokia Corporation. All rights reserved.
* Contact: Rémi Denis-Courmont
*
* The contents of this file are subject to the Mozilla Public License Version
* 1.1 (the "License"); you may not use this file except in compliance with
* the License. You may obtain a copy of the License at
* http://www.mozilla.org/MPL/
*
* Software distributed under the License is distributed on an "AS IS" basis,
* WITHOUT WARRANTY OF ANY KIND, either express or implied. See the License
* for the specific language governing rights and limitations under the
* License.
*
* The Original Code is the Nice GLib ICE library.
*
* The Initial Developers of the Original Code are Collabora Ltd and Nokia
* Corporation. All Rights Reserved.
*
* Contributors:
* Youness Alaoui, Collabora Ltd.
* Olivier Crete, Collabora Ltd.
* Kai Vehmanen, Nokia
*
* Alternatively, the contents of this file may be used under the terms of the
* the GNU Lesser General Public License Version 2.1 (the "LGPL"), in which
* case the provisions of LGPL are applicable instead of those above. If you
* wish to allow use of your version of this file only under the terms of the
* LGPL and not to allow others to use your version of this file under the
* MPL, indicate your decision by deleting the provisions above and replace
* them with the notice and other provisions required by the LGPL. If you do
* not delete the provisions above, a recipient may use your version of this
* file under either the MPL or the LGPL.
*/
#ifdef HAVE_CONFIG_H
# include <config.h>
#endif
#include <string.h>
#include <stdlib.h>
#include <stdio.h>
#include <stdarg.h>
#include "utils.h"
size_t stun_padding (size_t l)
{
return (4 - (l & 3)) & 3;
}
size_t stun_align (size_t l)
{
return (l + 3) & ~3;
}
uint16_t stun_getw (const uint8_t *ptr)
{
return ((ptr)[0] << 8) | ptr[1];
}
void *stun_setw (uint8_t *ptr, uint16_t value)
{
*ptr++ = value >> 8;
*ptr++ = value & 0xff;
return ptr;
}
void stun_set_type (uint8_t *h, StunClass c, StunMethod m)
{
/* assert (c < 4); */
/* assert (m < (1 << 12)); */
h[0] = (c >> 1) | ((m >> 6) & 0x3e);
h[1] = ((c << 4) & 0x10) | ((m << 1) & 0xe0) | (m & 0x0f);
/* assert (stun_getw (h) < (1 << 14)); */
/* assert (stun_get_class (h) == c); */
/* assert (stun_get_method (h) == m); */
}
StunMessageReturn stun_xor_address (const StunMessage *msg,
struct sockaddr_storage *addr, socklen_t addrlen,
uint32_t magic_cookie)
{
union {
struct sockaddr_storage *addr;
struct sockaddr_in *in;
struct sockaddr_in6 *in6;
} addr_ptr;
addr_ptr.addr = addr;
switch (addr->ss_family)
{
case AF_INET:
{
struct sockaddr_in *ip4 = addr_ptr.in;
if ((size_t) addrlen < sizeof (*ip4))
return STUN_MESSAGE_RETURN_INVALID;
ip4->sin_port ^= htons (magic_cookie >> 16);
ip4->sin_addr.s_addr ^= htonl (magic_cookie);
return STUN_MESSAGE_RETURN_SUCCESS;
}
case AF_INET6:
{
struct sockaddr_in6 *ip6 = addr_ptr.in6;
unsigned short i;
if ((size_t) addrlen < sizeof (*ip6))
return STUN_MESSAGE_RETURN_INVALID;
ip6->sin6_port ^= htons (magic_cookie >> 16);
for (i = 0; i < 16; i++)
ip6->sin6_addr.s6_addr[i] ^= msg->buffer[4 + i];
return STUN_MESSAGE_RETURN_SUCCESS;
}
default:
return STUN_MESSAGE_RETURN_UNSUPPORTED_ADDRESS;
}
}
|
