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#include <linux/types.h>
46#include <linux/sched.h>
47#include <linux/in.h>
48#include <net/sock.h>
49#include <net/ipv6.h>
50#include <net/if_inet6.h>
51#include <net/sctp/sctp.h>
52#include <net/sctp/sm.h>
53
54
55static int sctp_copy_one_addr(struct sctp_bind_addr *, union sctp_addr *,
56 sctp_scope_t scope, int gfp, int flags);
57static void sctp_bind_addr_clean(struct sctp_bind_addr *);
58
59
60
61
62
63
64int sctp_bind_addr_copy(struct sctp_bind_addr *dest,
65 const struct sctp_bind_addr *src,
66 sctp_scope_t scope, int gfp, int flags)
67{
68 struct sctp_sockaddr_entry *addr;
69 struct list_head *pos;
70 int error = 0;
71
72
73 dest->port = src->port;
74
75
76 list_for_each(pos, &src->address_list) {
77 addr = list_entry(pos, struct sctp_sockaddr_entry, list);
78 error = sctp_copy_one_addr(dest, &addr->a, scope,
79 gfp, flags);
80 if (error < 0)
81 goto out;
82 }
83
84
85
86
87
88 if (list_empty(&dest->address_list) && (SCTP_SCOPE_GLOBAL == scope)) {
89 list_for_each(pos, &src->address_list) {
90 addr = list_entry(pos, struct sctp_sockaddr_entry,
91 list);
92 error = sctp_copy_one_addr(dest, &addr->a,
93 SCTP_SCOPE_LINK, gfp,
94 flags);
95 if (error < 0)
96 goto out;
97 }
98 }
99
100out:
101 if (error)
102 sctp_bind_addr_clean(dest);
103
104 return error;
105}
106
107
108
109
110void sctp_bind_addr_init(struct sctp_bind_addr *bp, __u16 port)
111{
112 bp->malloced = 0;
113
114 INIT_LIST_HEAD(&bp->address_list);
115 bp->port = port;
116}
117
118
119static void sctp_bind_addr_clean(struct sctp_bind_addr *bp)
120{
121 struct sctp_sockaddr_entry *addr;
122 struct list_head *pos, *temp;
123
124
125 list_for_each_safe(pos, temp, &bp->address_list) {
126 addr = list_entry(pos, struct sctp_sockaddr_entry, list);
127 list_del(pos);
128 kfree(addr);
129 SCTP_DBG_OBJCNT_DEC(addr);
130 }
131}
132
133
134void sctp_bind_addr_free(struct sctp_bind_addr *bp)
135{
136
137 sctp_bind_addr_clean(bp);
138
139 if (bp->malloced) {
140 kfree(bp);
141 SCTP_DBG_OBJCNT_DEC(bind_addr);
142 }
143}
144
145
146int sctp_add_bind_addr(struct sctp_bind_addr *bp, union sctp_addr *new,
147 int gfp)
148{
149 struct sctp_sockaddr_entry *addr;
150
151
152 addr = t_new(struct sctp_sockaddr_entry, gfp);
153 if (!addr)
154 return -ENOMEM;
155
156 memcpy(&addr->a, new, sizeof(*new));
157
158
159
160
161 if (!addr->a.v4.sin_port)
162 addr->a.v4.sin_port = bp->port;
163
164 INIT_LIST_HEAD(&addr->list);
165 list_add_tail(&addr->list, &bp->address_list);
166 SCTP_DBG_OBJCNT_INC(addr);
167
168 return 0;
169}
170
171
172
173
174int sctp_del_bind_addr(struct sctp_bind_addr *bp, union sctp_addr *del_addr)
175{
176 struct list_head *pos, *temp;
177 struct sctp_sockaddr_entry *addr;
178
179 list_for_each_safe(pos, temp, &bp->address_list) {
180 addr = list_entry(pos, struct sctp_sockaddr_entry, list);
181 if (sctp_cmp_addr_exact(&addr->a, del_addr)) {
182
183 list_del(pos);
184 kfree(addr);
185 SCTP_DBG_OBJCNT_DEC(addr);
186
187 return 0;
188 }
189 }
190
191 return -EINVAL;
192}
193
194
195
196
197
198
199union sctp_params sctp_bind_addrs_to_raw(const struct sctp_bind_addr *bp,
200 int *addrs_len, int gfp)
201{
202 union sctp_params addrparms;
203 union sctp_params retval;
204 int addrparms_len;
205 union sctp_addr_param rawaddr;
206 int len;
207 struct sctp_sockaddr_entry *addr;
208 struct list_head *pos;
209 struct sctp_af *af;
210
211 addrparms_len = 0;
212 len = 0;
213
214
215 list_for_each(pos, &bp->address_list) {
216 len += sizeof(union sctp_addr_param);
217 }
218
219
220
221
222 if (len == sizeof(union sctp_addr_param)) {
223 retval.v = NULL;
224 goto end_raw;
225 }
226
227 retval.v = kmalloc(len, gfp);
228 if (!retval.v)
229 goto end_raw;
230
231 addrparms = retval;
232
233 list_for_each(pos, &bp->address_list) {
234 addr = list_entry(pos, struct sctp_sockaddr_entry, list);
235 af = sctp_get_af_specific(addr->a.v4.sin_family);
236 len = af->to_addr_param(&addr->a, &rawaddr);
237 memcpy(addrparms.v, &rawaddr, len);
238 addrparms.v += len;
239 addrparms_len += len;
240 }
241
242end_raw:
243 *addrs_len = addrparms_len;
244 return retval;
245}
246
247
248
249
250
251int sctp_raw_to_bind_addrs(struct sctp_bind_addr *bp, __u8 *raw_addr_list,
252 int addrs_len, __u16 port, int gfp)
253{
254 union sctp_addr_param *rawaddr;
255 struct sctp_paramhdr *param;
256 union sctp_addr addr;
257 int retval = 0;
258 int len;
259 struct sctp_af *af;
260
261
262 while (addrs_len) {
263 param = (struct sctp_paramhdr *)raw_addr_list;
264 rawaddr = (union sctp_addr_param *)raw_addr_list;
265
266 af = sctp_get_af_specific(param_type2af(param->type));
267 if (unlikely(!af)) {
268 retval = -EINVAL;
269 sctp_bind_addr_clean(bp);
270 break;
271 }
272
273 af->from_addr_param(&addr, rawaddr, port, 0);
274 retval = sctp_add_bind_addr(bp, &addr, gfp);
275 if (retval) {
276
277 sctp_bind_addr_clean(bp);
278 break;;
279 }
280
281 len = ntohs(param->length);
282 addrs_len -= len;
283 raw_addr_list += len;
284 }
285
286 return retval;
287}
288
289
290
291
292
293
294int sctp_bind_addr_match(struct sctp_bind_addr *bp,
295 const union sctp_addr *addr,
296 struct sctp_opt *opt)
297{
298 struct sctp_sockaddr_entry *laddr;
299 struct list_head *pos;
300
301 list_for_each(pos, &bp->address_list) {
302 laddr = list_entry(pos, struct sctp_sockaddr_entry, list);
303 if (opt->pf->cmp_addr(&laddr->a, addr, opt))
304 return 1;
305 }
306
307 return 0;
308}
309
310
311
312
313union sctp_addr *sctp_find_unmatch_addr(struct sctp_bind_addr *bp,
314 const union sctp_addr *addrs,
315 int addrcnt,
316 struct sctp_opt *opt)
317{
318 struct sctp_sockaddr_entry *laddr;
319 union sctp_addr *addr;
320 void *addr_buf;
321 struct sctp_af *af;
322 struct list_head *pos;
323 int i;
324
325 list_for_each(pos, &bp->address_list) {
326 laddr = list_entry(pos, struct sctp_sockaddr_entry, list);
327
328 addr_buf = (union sctp_addr *)addrs;
329 for (i = 0; i < addrcnt; i++) {
330 addr = (union sctp_addr *)addr_buf;
331 af = sctp_get_af_specific(addr->v4.sin_family);
332 if (!af)
333 return NULL;
334
335 if (opt->pf->cmp_addr(&laddr->a, addr, opt))
336 break;
337
338 addr_buf += af->sockaddr_len;
339 }
340 if (i == addrcnt)
341 return &laddr->a;
342 }
343
344 return NULL;
345}
346
347
348static int sctp_copy_one_addr(struct sctp_bind_addr *dest,
349 union sctp_addr *addr,
350 sctp_scope_t scope, int gfp, int flags)
351{
352 int error = 0;
353
354 if (sctp_is_any(addr)) {
355 error = sctp_copy_local_addr_list(dest, scope, gfp, flags);
356 } else if (sctp_in_scope(addr, scope)) {
357
358
359
360
361 if ((((AF_INET == addr->sa.sa_family) &&
362 (flags & SCTP_ADDR4_PEERSUPP))) ||
363 (((AF_INET6 == addr->sa.sa_family) &&
364 (flags & SCTP_ADDR6_ALLOWED) &&
365 (flags & SCTP_ADDR6_PEERSUPP))))
366 error = sctp_add_bind_addr(dest, addr, gfp);
367 }
368
369 return error;
370}
371
372
373int sctp_is_any(const union sctp_addr *addr)
374{
375 struct sctp_af *af = sctp_get_af_specific(addr->sa.sa_family);
376 if (!af)
377 return 0;
378 return af->is_any(addr);
379}
380
381
382int sctp_in_scope(const union sctp_addr *addr, sctp_scope_t scope)
383{
384 sctp_scope_t addr_scope = sctp_scope(addr);
385
386
387
388
389 if (SCTP_SCOPE_UNUSABLE == addr_scope)
390 return 0;
391
392
393
394
395
396
397 if (addr_scope <= scope)
398 return 1;
399
400 return 0;
401}
402
403
404
405
406
407
408sctp_scope_t sctp_scope(const union sctp_addr *addr)
409{
410 struct sctp_af *af;
411
412 af = sctp_get_af_specific(addr->sa.sa_family);
413 if (!af)
414 return SCTP_SCOPE_UNUSABLE;
415
416 return af->scope((union sctp_addr *)addr);
417}
418