]> CyberLeo.Net >> Repos - FreeBSD/FreeBSD.git/blob - sys/netinet/sctp_asconf.c
MFS r353395:
[FreeBSD/FreeBSD.git] / sys / netinet / sctp_asconf.c
1 /*-
2  * SPDX-License-Identifier: BSD-3-Clause
3  *
4  * Copyright (c) 2001-2007, by Cisco Systems, Inc. All rights reserved.
5  * Copyright (c) 2008-2012, by Randall Stewart. All rights reserved.
6  * Copyright (c) 2008-2012, by Michael Tuexen. All rights reserved.
7  *
8  * Redistribution and use in source and binary forms, with or without
9  * modification, are permitted provided that the following conditions are met:
10  *
11  * a) Redistributions of source code must retain the above copyright notice,
12  *    this list of conditions and the following disclaimer.
13  *
14  * b) Redistributions in binary form must reproduce the above copyright
15  *    notice, this list of conditions and the following disclaimer in
16  *    the documentation and/or other materials provided with the distribution.
17  *
18  * c) Neither the name of Cisco Systems, Inc. nor the names of its
19  *    contributors may be used to endorse or promote products derived
20  *    from this software without specific prior written permission.
21  *
22  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
23  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
24  * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
25  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
26  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
27  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
28  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
29  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
30  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
31  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
32  * THE POSSIBILITY OF SUCH DAMAGE.
33  */
34
35 #include <sys/cdefs.h>
36 __FBSDID("$FreeBSD$");
37
38 #include <netinet/sctp_os.h>
39 #include <netinet/sctp_var.h>
40 #include <netinet/sctp_sysctl.h>
41 #include <netinet/sctp_pcb.h>
42 #include <netinet/sctp_header.h>
43 #include <netinet/sctputil.h>
44 #include <netinet/sctp_output.h>
45 #include <netinet/sctp_asconf.h>
46 #include <netinet/sctp_timer.h>
47
48 /*
49  * debug flags:
50  * SCTP_DEBUG_ASCONF1: protocol info, general info and errors
51  * SCTP_DEBUG_ASCONF2: detailed info
52  */
53
54
55 /*
56  * RFC 5061
57  *
58  * An ASCONF parameter queue exists per asoc which holds the pending address
59  * operations.  Lists are updated upon receipt of ASCONF-ACK.
60  *
61  * A restricted_addrs list exists per assoc to hold local addresses that are
62  * not (yet) usable by the assoc as a source address.  These addresses are
63  * either pending an ASCONF operation (and exist on the ASCONF parameter
64  * queue), or they are permanently restricted (the peer has returned an
65  * ERROR indication to an ASCONF(ADD), or the peer does not support ASCONF).
66  *
67  * Deleted addresses are always immediately removed from the lists as they will
68  * (shortly) no longer exist in the kernel.  We send ASCONFs as a courtesy,
69  * only if allowed.
70  */
71
72 /*
73  * ASCONF parameter processing.
74  * response_required: set if a reply is required (eg. SUCCESS_REPORT).
75  * returns a mbuf to an "error" response parameter or NULL/"success" if ok.
76  * FIX: allocating this many mbufs on the fly is pretty inefficient...
77  */
78 static struct mbuf *
79 sctp_asconf_success_response(uint32_t id)
80 {
81         struct mbuf *m_reply = NULL;
82         struct sctp_asconf_paramhdr *aph;
83
84         m_reply = sctp_get_mbuf_for_msg(sizeof(struct sctp_asconf_paramhdr),
85             0, M_NOWAIT, 1, MT_DATA);
86         if (m_reply == NULL) {
87                 SCTPDBG(SCTP_DEBUG_ASCONF1,
88                     "asconf_success_response: couldn't get mbuf!\n");
89                 return (NULL);
90         }
91         aph = mtod(m_reply, struct sctp_asconf_paramhdr *);
92         aph->correlation_id = id;
93         aph->ph.param_type = htons(SCTP_SUCCESS_REPORT);
94         aph->ph.param_length = sizeof(struct sctp_asconf_paramhdr);
95         SCTP_BUF_LEN(m_reply) = aph->ph.param_length;
96         aph->ph.param_length = htons(aph->ph.param_length);
97
98         return (m_reply);
99 }
100
101 static struct mbuf *
102 sctp_asconf_error_response(uint32_t id, uint16_t cause, uint8_t *error_tlv,
103     uint16_t tlv_length)
104 {
105         struct mbuf *m_reply = NULL;
106         struct sctp_asconf_paramhdr *aph;
107         struct sctp_error_cause *error;
108         size_t buf_len;
109         uint16_t i, param_length, cause_length, padding_length;
110         uint8_t *tlv;
111
112         if (error_tlv == NULL) {
113                 tlv_length = 0;
114         }
115         cause_length = sizeof(struct sctp_error_cause) + tlv_length;
116         param_length = sizeof(struct sctp_asconf_paramhdr) + cause_length;
117         padding_length = tlv_length % 4;
118         if (padding_length != 0) {
119                 padding_length = 4 - padding_length;
120         }
121         buf_len = param_length + padding_length;
122         if (buf_len > MLEN) {
123                 SCTPDBG(SCTP_DEBUG_ASCONF1,
124                     "asconf_error_response: tlv_length (%xh) too big\n",
125                     tlv_length);
126                 return (NULL);
127         }
128         m_reply = sctp_get_mbuf_for_msg(buf_len, 0, M_NOWAIT, 1, MT_DATA);
129         if (m_reply == NULL) {
130                 SCTPDBG(SCTP_DEBUG_ASCONF1,
131                     "asconf_error_response: couldn't get mbuf!\n");
132                 return (NULL);
133         }
134         aph = mtod(m_reply, struct sctp_asconf_paramhdr *);
135         aph->ph.param_type = htons(SCTP_ERROR_CAUSE_IND);
136         aph->ph.param_length = htons(param_length);
137         aph->correlation_id = id;
138         error = (struct sctp_error_cause *)(aph + 1);
139         error->code = htons(cause);
140         error->length = htons(cause_length);
141         if (error_tlv != NULL) {
142                 tlv = (uint8_t *)(error + 1);
143                 memcpy(tlv, error_tlv, tlv_length);
144                 for (i = 0; i < padding_length; i++) {
145                         tlv[tlv_length + i] = 0;
146                 }
147         }
148         SCTP_BUF_LEN(m_reply) = buf_len;
149         return (m_reply);
150 }
151
152 static struct mbuf *
153 sctp_process_asconf_add_ip(struct sockaddr *src, struct sctp_asconf_paramhdr *aph,
154     struct sctp_tcb *stcb, int send_hb, int response_required)
155 {
156         struct sctp_nets *net;
157         struct mbuf *m_reply = NULL;
158         union sctp_sockstore store;
159         struct sctp_paramhdr *ph;
160         uint16_t param_type, aparam_length;
161 #if defined(INET) || defined(INET6)
162         uint16_t param_length;
163 #endif
164         struct sockaddr *sa;
165         int zero_address = 0;
166         int bad_address = 0;
167 #ifdef INET
168         struct sockaddr_in *sin;
169         struct sctp_ipv4addr_param *v4addr;
170 #endif
171 #ifdef INET6
172         struct sockaddr_in6 *sin6;
173         struct sctp_ipv6addr_param *v6addr;
174 #endif
175
176         aparam_length = ntohs(aph->ph.param_length);
177         if (aparam_length < sizeof(struct sctp_asconf_paramhdr) + sizeof(struct sctp_paramhdr)) {
178                 return (NULL);
179         }
180         ph = (struct sctp_paramhdr *)(aph + 1);
181         param_type = ntohs(ph->param_type);
182 #if defined(INET) || defined(INET6)
183         param_length = ntohs(ph->param_length);
184         if (param_length + sizeof(struct sctp_asconf_paramhdr) != aparam_length) {
185                 return (NULL);
186         }
187 #endif
188         sa = &store.sa;
189         switch (param_type) {
190 #ifdef INET
191         case SCTP_IPV4_ADDRESS:
192                 if (param_length != sizeof(struct sctp_ipv4addr_param)) {
193                         /* invalid param size */
194                         return (NULL);
195                 }
196                 v4addr = (struct sctp_ipv4addr_param *)ph;
197                 sin = &store.sin;
198                 memset(sin, 0, sizeof(*sin));
199                 sin->sin_family = AF_INET;
200                 sin->sin_len = sizeof(struct sockaddr_in);
201                 sin->sin_port = stcb->rport;
202                 sin->sin_addr.s_addr = v4addr->addr;
203                 if ((sin->sin_addr.s_addr == INADDR_BROADCAST) ||
204                     IN_MULTICAST(ntohl(sin->sin_addr.s_addr))) {
205                         bad_address = 1;
206                 }
207                 if (sin->sin_addr.s_addr == INADDR_ANY)
208                         zero_address = 1;
209                 SCTPDBG(SCTP_DEBUG_ASCONF1, "process_asconf_add_ip: adding ");
210                 SCTPDBG_ADDR(SCTP_DEBUG_ASCONF1, sa);
211                 break;
212 #endif
213 #ifdef INET6
214         case SCTP_IPV6_ADDRESS:
215                 if (param_length != sizeof(struct sctp_ipv6addr_param)) {
216                         /* invalid param size */
217                         return (NULL);
218                 }
219                 v6addr = (struct sctp_ipv6addr_param *)ph;
220                 sin6 = &store.sin6;
221                 memset(sin6, 0, sizeof(*sin6));
222                 sin6->sin6_family = AF_INET6;
223                 sin6->sin6_len = sizeof(struct sockaddr_in6);
224                 sin6->sin6_port = stcb->rport;
225                 memcpy((caddr_t)&sin6->sin6_addr, v6addr->addr,
226                     sizeof(struct in6_addr));
227                 if (IN6_IS_ADDR_MULTICAST(&sin6->sin6_addr)) {
228                         bad_address = 1;
229                 }
230                 if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr))
231                         zero_address = 1;
232                 SCTPDBG(SCTP_DEBUG_ASCONF1, "process_asconf_add_ip: adding ");
233                 SCTPDBG_ADDR(SCTP_DEBUG_ASCONF1, sa);
234                 break;
235 #endif
236         default:
237                 m_reply = sctp_asconf_error_response(aph->correlation_id,
238                     SCTP_CAUSE_INVALID_PARAM, (uint8_t *)aph,
239                     aparam_length);
240                 return (m_reply);
241         }                       /* end switch */
242
243         /* if 0.0.0.0/::0, add the source address instead */
244         if (zero_address && SCTP_BASE_SYSCTL(sctp_nat_friendly)) {
245                 sa = src;
246                 SCTPDBG(SCTP_DEBUG_ASCONF1,
247                     "process_asconf_add_ip: using source addr ");
248                 SCTPDBG_ADDR(SCTP_DEBUG_ASCONF1, src);
249         }
250         net = NULL;
251         /* add the address */
252         if (bad_address) {
253                 m_reply = sctp_asconf_error_response(aph->correlation_id,
254                     SCTP_CAUSE_INVALID_PARAM, (uint8_t *)aph,
255                     aparam_length);
256         } else if (sctp_add_remote_addr(stcb, sa, &net, stcb->asoc.port,
257                     SCTP_DONOT_SETSCOPE,
258             SCTP_ADDR_DYNAMIC_ADDED) != 0) {
259                 SCTPDBG(SCTP_DEBUG_ASCONF1,
260                     "process_asconf_add_ip: error adding address\n");
261                 m_reply = sctp_asconf_error_response(aph->correlation_id,
262                     SCTP_CAUSE_RESOURCE_SHORTAGE, (uint8_t *)aph,
263                     aparam_length);
264         } else {
265                 if (response_required) {
266                         m_reply =
267                             sctp_asconf_success_response(aph->correlation_id);
268                 }
269                 if (net != NULL) {
270                         /* notify upper layer */
271                         sctp_ulp_notify(SCTP_NOTIFY_ASCONF_ADD_IP, stcb, 0, sa, SCTP_SO_NOT_LOCKED);
272                         sctp_timer_start(SCTP_TIMER_TYPE_PATHMTURAISE, stcb->sctp_ep, stcb, net);
273                         sctp_timer_start(SCTP_TIMER_TYPE_HEARTBEAT, stcb->sctp_ep,
274                             stcb, net);
275                         if (send_hb) {
276                                 sctp_send_hb(stcb, net, SCTP_SO_NOT_LOCKED);
277                         }
278                 }
279         }
280         return (m_reply);
281 }
282
283 static int
284 sctp_asconf_del_remote_addrs_except(struct sctp_tcb *stcb, struct sockaddr *src)
285 {
286         struct sctp_nets *src_net, *net, *nnet;
287
288         /* make sure the source address exists as a destination net */
289         src_net = sctp_findnet(stcb, src);
290         if (src_net == NULL) {
291                 /* not found */
292                 return (-1);
293         }
294
295         /* delete all destination addresses except the source */
296         TAILQ_FOREACH_SAFE(net, &stcb->asoc.nets, sctp_next, nnet) {
297                 if (net != src_net) {
298                         /* delete this address */
299                         SCTPDBG(SCTP_DEBUG_ASCONF1,
300                             "asconf_del_remote_addrs_except: deleting ");
301                         SCTPDBG_ADDR(SCTP_DEBUG_ASCONF1,
302                             (struct sockaddr *)&net->ro._l_addr);
303                         /* notify upper layer */
304                         sctp_ulp_notify(SCTP_NOTIFY_ASCONF_DELETE_IP, stcb, 0,
305                             (struct sockaddr *)&net->ro._l_addr, SCTP_SO_NOT_LOCKED);
306                         sctp_remove_net(stcb, net);
307                 }
308         }
309         return (0);
310 }
311
312 static struct mbuf *
313 sctp_process_asconf_delete_ip(struct sockaddr *src,
314     struct sctp_asconf_paramhdr *aph,
315     struct sctp_tcb *stcb, int response_required)
316 {
317         struct mbuf *m_reply = NULL;
318         union sctp_sockstore store;
319         struct sctp_paramhdr *ph;
320         uint16_t param_type, aparam_length;
321 #if defined(INET) || defined(INET6)
322         uint16_t param_length;
323 #endif
324         struct sockaddr *sa;
325         int zero_address = 0;
326         int result;
327 #ifdef INET
328         struct sockaddr_in *sin;
329         struct sctp_ipv4addr_param *v4addr;
330 #endif
331 #ifdef INET6
332         struct sockaddr_in6 *sin6;
333         struct sctp_ipv6addr_param *v6addr;
334 #endif
335
336         aparam_length = ntohs(aph->ph.param_length);
337         if (aparam_length < sizeof(struct sctp_asconf_paramhdr) + sizeof(struct sctp_paramhdr)) {
338                 return (NULL);
339         }
340         ph = (struct sctp_paramhdr *)(aph + 1);
341         param_type = ntohs(ph->param_type);
342 #if defined(INET) || defined(INET6)
343         param_length = ntohs(ph->param_length);
344         if (param_length + sizeof(struct sctp_asconf_paramhdr) != aparam_length) {
345                 return (NULL);
346         }
347 #endif
348         sa = &store.sa;
349         switch (param_type) {
350 #ifdef INET
351         case SCTP_IPV4_ADDRESS:
352                 if (param_length != sizeof(struct sctp_ipv4addr_param)) {
353                         /* invalid param size */
354                         return (NULL);
355                 }
356                 v4addr = (struct sctp_ipv4addr_param *)ph;
357                 sin = &store.sin;
358                 memset(sin, 0, sizeof(*sin));
359                 sin->sin_family = AF_INET;
360                 sin->sin_len = sizeof(struct sockaddr_in);
361                 sin->sin_port = stcb->rport;
362                 sin->sin_addr.s_addr = v4addr->addr;
363                 if (sin->sin_addr.s_addr == INADDR_ANY)
364                         zero_address = 1;
365                 SCTPDBG(SCTP_DEBUG_ASCONF1,
366                     "process_asconf_delete_ip: deleting ");
367                 SCTPDBG_ADDR(SCTP_DEBUG_ASCONF1, sa);
368                 break;
369 #endif
370 #ifdef INET6
371         case SCTP_IPV6_ADDRESS:
372                 if (param_length != sizeof(struct sctp_ipv6addr_param)) {
373                         /* invalid param size */
374                         return (NULL);
375                 }
376                 v6addr = (struct sctp_ipv6addr_param *)ph;
377                 sin6 = &store.sin6;
378                 memset(sin6, 0, sizeof(*sin6));
379                 sin6->sin6_family = AF_INET6;
380                 sin6->sin6_len = sizeof(struct sockaddr_in6);
381                 sin6->sin6_port = stcb->rport;
382                 memcpy(&sin6->sin6_addr, v6addr->addr,
383                     sizeof(struct in6_addr));
384                 if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr))
385                         zero_address = 1;
386                 SCTPDBG(SCTP_DEBUG_ASCONF1,
387                     "process_asconf_delete_ip: deleting ");
388                 SCTPDBG_ADDR(SCTP_DEBUG_ASCONF1, sa);
389                 break;
390 #endif
391         default:
392                 m_reply = sctp_asconf_error_response(aph->correlation_id,
393                     SCTP_CAUSE_UNRESOLVABLE_ADDR, (uint8_t *)aph,
394                     aparam_length);
395                 return (m_reply);
396         }
397
398         /* make sure the source address is not being deleted */
399         if (sctp_cmpaddr(sa, src)) {
400                 /* trying to delete the source address! */
401                 SCTPDBG(SCTP_DEBUG_ASCONF1, "process_asconf_delete_ip: tried to delete source addr\n");
402                 m_reply = sctp_asconf_error_response(aph->correlation_id,
403                     SCTP_CAUSE_DELETING_SRC_ADDR, (uint8_t *)aph,
404                     aparam_length);
405                 return (m_reply);
406         }
407
408         /* if deleting 0.0.0.0/::0, delete all addresses except src addr */
409         if (zero_address && SCTP_BASE_SYSCTL(sctp_nat_friendly)) {
410                 result = sctp_asconf_del_remote_addrs_except(stcb, src);
411
412                 if (result) {
413                         /* src address did not exist? */
414                         SCTPDBG(SCTP_DEBUG_ASCONF1, "process_asconf_delete_ip: src addr does not exist?\n");
415                         /* what error to reply with?? */
416                         m_reply =
417                             sctp_asconf_error_response(aph->correlation_id,
418                             SCTP_CAUSE_REQUEST_REFUSED, (uint8_t *)aph,
419                             aparam_length);
420                 } else if (response_required) {
421                         m_reply =
422                             sctp_asconf_success_response(aph->correlation_id);
423                 }
424                 return (m_reply);
425         }
426
427         /* delete the address */
428         result = sctp_del_remote_addr(stcb, sa);
429         /*
430          * note if result == -2, the address doesn't exist in the asoc but
431          * since it's being deleted anyways, we just ack the delete -- but
432          * this probably means something has already gone awry
433          */
434         if (result == -1) {
435                 /* only one address in the asoc */
436                 SCTPDBG(SCTP_DEBUG_ASCONF1, "process_asconf_delete_ip: tried to delete last IP addr!\n");
437                 m_reply = sctp_asconf_error_response(aph->correlation_id,
438                     SCTP_CAUSE_DELETING_LAST_ADDR, (uint8_t *)aph,
439                     aparam_length);
440         } else {
441                 if (response_required) {
442                         m_reply = sctp_asconf_success_response(aph->correlation_id);
443                 }
444                 /* notify upper layer */
445                 sctp_ulp_notify(SCTP_NOTIFY_ASCONF_DELETE_IP, stcb, 0, sa, SCTP_SO_NOT_LOCKED);
446         }
447         return (m_reply);
448 }
449
450 static struct mbuf *
451 sctp_process_asconf_set_primary(struct sockaddr *src,
452     struct sctp_asconf_paramhdr *aph,
453     struct sctp_tcb *stcb, int response_required)
454 {
455         struct mbuf *m_reply = NULL;
456         union sctp_sockstore store;
457         struct sctp_paramhdr *ph;
458         uint16_t param_type, aparam_length;
459 #if defined(INET) || defined(INET6)
460         uint16_t param_length;
461 #endif
462         struct sockaddr *sa;
463         int zero_address = 0;
464 #ifdef INET
465         struct sockaddr_in *sin;
466         struct sctp_ipv4addr_param *v4addr;
467 #endif
468 #ifdef INET6
469         struct sockaddr_in6 *sin6;
470         struct sctp_ipv6addr_param *v6addr;
471 #endif
472
473         aparam_length = ntohs(aph->ph.param_length);
474         if (aparam_length < sizeof(struct sctp_asconf_paramhdr) + sizeof(struct sctp_paramhdr)) {
475                 return (NULL);
476         }
477         ph = (struct sctp_paramhdr *)(aph + 1);
478         param_type = ntohs(ph->param_type);
479 #if defined(INET) || defined(INET6)
480         param_length = ntohs(ph->param_length);
481         if (param_length + sizeof(struct sctp_asconf_paramhdr) != aparam_length) {
482                 return (NULL);
483         }
484 #endif
485         sa = &store.sa;
486         switch (param_type) {
487 #ifdef INET
488         case SCTP_IPV4_ADDRESS:
489                 if (param_length != sizeof(struct sctp_ipv4addr_param)) {
490                         /* invalid param size */
491                         return (NULL);
492                 }
493                 v4addr = (struct sctp_ipv4addr_param *)ph;
494                 sin = &store.sin;
495                 memset(sin, 0, sizeof(*sin));
496                 sin->sin_family = AF_INET;
497                 sin->sin_len = sizeof(struct sockaddr_in);
498                 sin->sin_addr.s_addr = v4addr->addr;
499                 if (sin->sin_addr.s_addr == INADDR_ANY)
500                         zero_address = 1;
501                 SCTPDBG(SCTP_DEBUG_ASCONF1, "process_asconf_set_primary: ");
502                 SCTPDBG_ADDR(SCTP_DEBUG_ASCONF1, sa);
503                 break;
504 #endif
505 #ifdef INET6
506         case SCTP_IPV6_ADDRESS:
507                 if (param_length != sizeof(struct sctp_ipv6addr_param)) {
508                         /* invalid param size */
509                         return (NULL);
510                 }
511                 v6addr = (struct sctp_ipv6addr_param *)ph;
512                 sin6 = &store.sin6;
513                 memset(sin6, 0, sizeof(*sin6));
514                 sin6->sin6_family = AF_INET6;
515                 sin6->sin6_len = sizeof(struct sockaddr_in6);
516                 memcpy((caddr_t)&sin6->sin6_addr, v6addr->addr,
517                     sizeof(struct in6_addr));
518                 if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr))
519                         zero_address = 1;
520                 SCTPDBG(SCTP_DEBUG_ASCONF1, "process_asconf_set_primary: ");
521                 SCTPDBG_ADDR(SCTP_DEBUG_ASCONF1, sa);
522                 break;
523 #endif
524         default:
525                 m_reply = sctp_asconf_error_response(aph->correlation_id,
526                     SCTP_CAUSE_UNRESOLVABLE_ADDR, (uint8_t *)aph,
527                     aparam_length);
528                 return (m_reply);
529         }
530
531         /* if 0.0.0.0/::0, use the source address instead */
532         if (zero_address && SCTP_BASE_SYSCTL(sctp_nat_friendly)) {
533                 sa = src;
534                 SCTPDBG(SCTP_DEBUG_ASCONF1,
535                     "process_asconf_set_primary: using source addr ");
536                 SCTPDBG_ADDR(SCTP_DEBUG_ASCONF1, src);
537         }
538         /* set the primary address */
539         if (sctp_set_primary_addr(stcb, sa, NULL) == 0) {
540                 SCTPDBG(SCTP_DEBUG_ASCONF1,
541                     "process_asconf_set_primary: primary address set\n");
542                 /* notify upper layer */
543                 sctp_ulp_notify(SCTP_NOTIFY_ASCONF_SET_PRIMARY, stcb, 0, sa, SCTP_SO_NOT_LOCKED);
544                 if ((stcb->asoc.primary_destination->dest_state & SCTP_ADDR_REACHABLE) &&
545                     (!(stcb->asoc.primary_destination->dest_state & SCTP_ADDR_PF)) &&
546                     (stcb->asoc.alternate)) {
547                         sctp_free_remote_addr(stcb->asoc.alternate);
548                         stcb->asoc.alternate = NULL;
549                 }
550                 if (response_required) {
551                         m_reply = sctp_asconf_success_response(aph->correlation_id);
552                 }
553                 /*
554                  * Mobility adaptation. Ideally, when the reception of SET
555                  * PRIMARY with DELETE IP ADDRESS of the previous primary
556                  * destination, unacknowledged DATA are retransmitted
557                  * immediately to the new primary destination for seamless
558                  * handover. If the destination is UNCONFIRMED and marked to
559                  * REQ_PRIM, The retransmission occur when reception of the
560                  * HEARTBEAT-ACK.  (See sctp_handle_heartbeat_ack in
561                  * sctp_input.c) Also, when change of the primary
562                  * destination, it is better that all subsequent new DATA
563                  * containing already queued DATA are transmitted to the new
564                  * primary destination. (by micchie)
565                  */
566                 if ((sctp_is_mobility_feature_on(stcb->sctp_ep,
567                     SCTP_MOBILITY_BASE) ||
568                     sctp_is_mobility_feature_on(stcb->sctp_ep,
569                     SCTP_MOBILITY_FASTHANDOFF)) &&
570                     sctp_is_mobility_feature_on(stcb->sctp_ep,
571                     SCTP_MOBILITY_PRIM_DELETED) &&
572                     (stcb->asoc.primary_destination->dest_state &
573                     SCTP_ADDR_UNCONFIRMED) == 0) {
574
575                         sctp_timer_stop(SCTP_TIMER_TYPE_PRIM_DELETED,
576                             stcb->sctp_ep, stcb, NULL,
577                             SCTP_FROM_SCTP_ASCONF + SCTP_LOC_1);
578                         if (sctp_is_mobility_feature_on(stcb->sctp_ep,
579                             SCTP_MOBILITY_FASTHANDOFF)) {
580                                 sctp_assoc_immediate_retrans(stcb,
581                                     stcb->asoc.primary_destination);
582                         }
583                         if (sctp_is_mobility_feature_on(stcb->sctp_ep,
584                             SCTP_MOBILITY_BASE)) {
585                                 sctp_move_chunks_from_net(stcb,
586                                     stcb->asoc.deleted_primary);
587                         }
588                         sctp_delete_prim_timer(stcb->sctp_ep, stcb,
589                             stcb->asoc.deleted_primary);
590                 }
591         } else {
592                 /* couldn't set the requested primary address! */
593                 SCTPDBG(SCTP_DEBUG_ASCONF1,
594                     "process_asconf_set_primary: set primary failed!\n");
595                 /* must have been an invalid address, so report */
596                 m_reply = sctp_asconf_error_response(aph->correlation_id,
597                     SCTP_CAUSE_UNRESOLVABLE_ADDR, (uint8_t *)aph,
598                     aparam_length);
599         }
600
601         return (m_reply);
602 }
603
604 /*
605  * handles an ASCONF chunk.
606  * if all parameters are processed ok, send a plain (empty) ASCONF-ACK
607  */
608 void
609 sctp_handle_asconf(struct mbuf *m, unsigned int offset,
610     struct sockaddr *src,
611     struct sctp_asconf_chunk *cp, struct sctp_tcb *stcb,
612     int first)
613 {
614         struct sctp_association *asoc;
615         uint32_t serial_num;
616         struct mbuf *n, *m_ack, *m_result, *m_tail;
617         struct sctp_asconf_ack_chunk *ack_cp;
618         struct sctp_asconf_paramhdr *aph;
619         struct sctp_ipv6addr_param *p_addr;
620         unsigned int asconf_limit, cnt;
621         int error = 0;          /* did an error occur? */
622
623         /* asconf param buffer */
624         uint8_t aparam_buf[SCTP_PARAM_BUFFER_SIZE];
625         struct sctp_asconf_ack *ack, *ack_next;
626
627         /* verify minimum length */
628         if (ntohs(cp->ch.chunk_length) < sizeof(struct sctp_asconf_chunk)) {
629                 SCTPDBG(SCTP_DEBUG_ASCONF1,
630                     "handle_asconf: chunk too small = %xh\n",
631                     ntohs(cp->ch.chunk_length));
632                 return;
633         }
634         asoc = &stcb->asoc;
635         serial_num = ntohl(cp->serial_number);
636
637         if (SCTP_TSN_GE(asoc->asconf_seq_in, serial_num)) {
638                 /* got a duplicate ASCONF */
639                 SCTPDBG(SCTP_DEBUG_ASCONF1,
640                     "handle_asconf: got duplicate serial number = %xh\n",
641                     serial_num);
642                 return;
643         } else if (serial_num != (asoc->asconf_seq_in + 1)) {
644                 SCTPDBG(SCTP_DEBUG_ASCONF1, "handle_asconf: incorrect serial number = %xh (expected next = %xh)\n",
645                     serial_num, asoc->asconf_seq_in + 1);
646                 return;
647         }
648
649         /* it's the expected "next" sequence number, so process it */
650         asoc->asconf_seq_in = serial_num;       /* update sequence */
651         /* get length of all the param's in the ASCONF */
652         asconf_limit = offset + ntohs(cp->ch.chunk_length);
653         SCTPDBG(SCTP_DEBUG_ASCONF1,
654             "handle_asconf: asconf_limit=%u, sequence=%xh\n",
655             asconf_limit, serial_num);
656
657         if (first) {
658                 /* delete old cache */
659                 SCTPDBG(SCTP_DEBUG_ASCONF1, "handle_asconf: Now processing first ASCONF. Try to delete old cache\n");
660
661                 TAILQ_FOREACH_SAFE(ack, &asoc->asconf_ack_sent, next, ack_next) {
662                         if (ack->serial_number == serial_num)
663                                 break;
664                         SCTPDBG(SCTP_DEBUG_ASCONF1, "handle_asconf: delete old(%u) < first(%u)\n",
665                             ack->serial_number, serial_num);
666                         TAILQ_REMOVE(&asoc->asconf_ack_sent, ack, next);
667                         if (ack->data != NULL) {
668                                 sctp_m_freem(ack->data);
669                         }
670                         SCTP_ZONE_FREE(SCTP_BASE_INFO(ipi_zone_asconf_ack), ack);
671                 }
672         }
673
674         m_ack = sctp_get_mbuf_for_msg(sizeof(struct sctp_asconf_ack_chunk), 0,
675             M_NOWAIT, 1, MT_DATA);
676         if (m_ack == NULL) {
677                 SCTPDBG(SCTP_DEBUG_ASCONF1,
678                     "handle_asconf: couldn't get mbuf!\n");
679                 return;
680         }
681         m_tail = m_ack;         /* current reply chain's tail */
682
683         /* fill in ASCONF-ACK header */
684         ack_cp = mtod(m_ack, struct sctp_asconf_ack_chunk *);
685         ack_cp->ch.chunk_type = SCTP_ASCONF_ACK;
686         ack_cp->ch.chunk_flags = 0;
687         ack_cp->serial_number = htonl(serial_num);
688         /* set initial lengths (eg. just an ASCONF-ACK), ntohx at the end! */
689         SCTP_BUF_LEN(m_ack) = sizeof(struct sctp_asconf_ack_chunk);
690         ack_cp->ch.chunk_length = sizeof(struct sctp_asconf_ack_chunk);
691
692         /* skip the lookup address parameter */
693         offset += sizeof(struct sctp_asconf_chunk);
694         p_addr = (struct sctp_ipv6addr_param *)sctp_m_getptr(m, offset, sizeof(struct sctp_paramhdr), (uint8_t *)&aparam_buf);
695         if (p_addr == NULL) {
696                 SCTPDBG(SCTP_DEBUG_ASCONF1,
697                     "handle_asconf: couldn't get lookup addr!\n");
698                 /* respond with a missing/invalid mandatory parameter error */
699                 sctp_m_freem(m_ack);
700                 return;
701         }
702         /* skip lookup addr */
703         offset += SCTP_SIZE32(ntohs(p_addr->ph.param_length));
704         /* get pointer to first asconf param in ASCONF */
705         aph = (struct sctp_asconf_paramhdr *)sctp_m_getptr(m, offset, sizeof(struct sctp_asconf_paramhdr), (uint8_t *)&aparam_buf);
706         if (aph == NULL) {
707                 SCTPDBG(SCTP_DEBUG_ASCONF1, "Empty ASCONF received?\n");
708                 goto send_reply;
709         }
710         /* process through all parameters */
711         cnt = 0;
712         while (aph != NULL) {
713                 unsigned int param_length, param_type;
714
715                 param_type = ntohs(aph->ph.param_type);
716                 param_length = ntohs(aph->ph.param_length);
717                 if (offset + param_length > asconf_limit) {
718                         /* parameter goes beyond end of chunk! */
719                         sctp_m_freem(m_ack);
720                         return;
721                 }
722                 m_result = NULL;
723
724                 if (param_length > sizeof(aparam_buf)) {
725                         SCTPDBG(SCTP_DEBUG_ASCONF1, "handle_asconf: param length (%u) larger than buffer size!\n", param_length);
726                         sctp_m_freem(m_ack);
727                         return;
728                 }
729                 if (param_length <= sizeof(struct sctp_paramhdr)) {
730                         SCTPDBG(SCTP_DEBUG_ASCONF1, "handle_asconf: param length (%u) too short\n", param_length);
731                         sctp_m_freem(m_ack);
732                         return;
733                 }
734                 /* get the entire parameter */
735                 aph = (struct sctp_asconf_paramhdr *)sctp_m_getptr(m, offset, param_length, aparam_buf);
736                 if (aph == NULL) {
737                         SCTPDBG(SCTP_DEBUG_ASCONF1, "handle_asconf: couldn't get entire param\n");
738                         sctp_m_freem(m_ack);
739                         return;
740                 }
741                 switch (param_type) {
742                 case SCTP_ADD_IP_ADDRESS:
743                         m_result = sctp_process_asconf_add_ip(src, aph, stcb,
744                             (cnt < SCTP_BASE_SYSCTL(sctp_hb_maxburst)), error);
745                         cnt++;
746                         break;
747                 case SCTP_DEL_IP_ADDRESS:
748                         m_result = sctp_process_asconf_delete_ip(src, aph, stcb,
749                             error);
750                         break;
751                 case SCTP_ERROR_CAUSE_IND:
752                         /* not valid in an ASCONF chunk */
753                         break;
754                 case SCTP_SET_PRIM_ADDR:
755                         m_result = sctp_process_asconf_set_primary(src, aph,
756                             stcb, error);
757                         break;
758                 case SCTP_NAT_VTAGS:
759                         SCTPDBG(SCTP_DEBUG_ASCONF1, "handle_asconf: sees a NAT VTAG state parameter\n");
760                         break;
761                 case SCTP_SUCCESS_REPORT:
762                         /* not valid in an ASCONF chunk */
763                         break;
764                 case SCTP_ULP_ADAPTATION:
765                         /* FIX */
766                         break;
767                 default:
768                         if ((param_type & 0x8000) == 0) {
769                                 /* Been told to STOP at this param */
770                                 asconf_limit = offset;
771                                 /*
772                                  * FIX FIX - We need to call
773                                  * sctp_arethere_unrecognized_parameters()
774                                  * to get a operr and send it for any
775                                  * param's with the 0x4000 bit set OR do it
776                                  * here ourselves... note we still must STOP
777                                  * if the 0x8000 bit is clear.
778                                  */
779                         }
780                         /* unknown/invalid param type */
781                         break;
782                 }               /* switch */
783
784                 /* add any (error) result to the reply mbuf chain */
785                 if (m_result != NULL) {
786                         SCTP_BUF_NEXT(m_tail) = m_result;
787                         m_tail = m_result;
788                         ack_cp->ch.chunk_length += SCTP_BUF_LEN(m_result);
789                         /* set flag to force success reports */
790                         error = 1;
791                 }
792                 offset += SCTP_SIZE32(param_length);
793                 /* update remaining ASCONF message length to process */
794                 if (offset >= asconf_limit) {
795                         /* no more data in the mbuf chain */
796                         break;
797                 }
798                 /* get pointer to next asconf param */
799                 aph = (struct sctp_asconf_paramhdr *)sctp_m_getptr(m, offset,
800                     sizeof(struct sctp_asconf_paramhdr),
801                     (uint8_t *)&aparam_buf);
802                 if (aph == NULL) {
803                         /* can't get an asconf paramhdr */
804                         SCTPDBG(SCTP_DEBUG_ASCONF1, "handle_asconf: can't get asconf param hdr!\n");
805                         /* FIX ME - add error here... */
806                 }
807         }
808
809 send_reply:
810         ack_cp->ch.chunk_length = htons(ack_cp->ch.chunk_length);
811         /* save the ASCONF-ACK reply */
812         ack = SCTP_ZONE_GET(SCTP_BASE_INFO(ipi_zone_asconf_ack),
813             struct sctp_asconf_ack);
814         if (ack == NULL) {
815                 sctp_m_freem(m_ack);
816                 return;
817         }
818         ack->serial_number = serial_num;
819         ack->last_sent_to = NULL;
820         ack->data = m_ack;
821         ack->len = 0;
822         for (n = m_ack; n != NULL; n = SCTP_BUF_NEXT(n)) {
823                 ack->len += SCTP_BUF_LEN(n);
824         }
825         TAILQ_INSERT_TAIL(&stcb->asoc.asconf_ack_sent, ack, next);
826
827         /* see if last_control_chunk_from is set properly (use IP src addr) */
828         if (stcb->asoc.last_control_chunk_from == NULL) {
829                 /*
830                  * this could happen if the source address was just newly
831                  * added
832                  */
833                 SCTPDBG(SCTP_DEBUG_ASCONF1, "handle_asconf: looking up net for IP source address\n");
834                 SCTPDBG(SCTP_DEBUG_ASCONF1, "Looking for IP source: ");
835                 SCTPDBG_ADDR(SCTP_DEBUG_ASCONF1, src);
836                 /* look up the from address */
837                 stcb->asoc.last_control_chunk_from = sctp_findnet(stcb, src);
838 #ifdef SCTP_DEBUG
839                 if (stcb->asoc.last_control_chunk_from == NULL) {
840                         SCTPDBG(SCTP_DEBUG_ASCONF1, "handle_asconf: IP source address not found?!\n");
841                 }
842 #endif
843         }
844 }
845
846 /*
847  * does the address match? returns 0 if not, 1 if so
848  */
849 static uint32_t
850 sctp_asconf_addr_match(struct sctp_asconf_addr *aa, struct sockaddr *sa)
851 {
852         switch (sa->sa_family) {
853 #ifdef INET6
854         case AF_INET6:
855                 {
856                         /* XXX scopeid */
857                         struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)sa;
858
859                         if ((aa->ap.addrp.ph.param_type == SCTP_IPV6_ADDRESS) &&
860                             (memcmp(&aa->ap.addrp.addr, &sin6->sin6_addr,
861                             sizeof(struct in6_addr)) == 0)) {
862                                 return (1);
863                         }
864                         break;
865                 }
866 #endif
867 #ifdef INET
868         case AF_INET:
869                 {
870                         struct sockaddr_in *sin = (struct sockaddr_in *)sa;
871
872                         if ((aa->ap.addrp.ph.param_type == SCTP_IPV4_ADDRESS) &&
873                             (memcmp(&aa->ap.addrp.addr, &sin->sin_addr,
874                             sizeof(struct in_addr)) == 0)) {
875                                 return (1);
876                         }
877                         break;
878                 }
879 #endif
880         default:
881                 break;
882         }
883         return (0);
884 }
885
886 /*
887  * does the address match? returns 0 if not, 1 if so
888  */
889 static uint32_t
890 sctp_addr_match(struct sctp_paramhdr *ph, struct sockaddr *sa)
891 {
892 #if defined(INET) || defined(INET6)
893         uint16_t param_type, param_length;
894
895         param_type = ntohs(ph->param_type);
896         param_length = ntohs(ph->param_length);
897 #endif
898         switch (sa->sa_family) {
899 #ifdef INET6
900         case AF_INET6:
901                 {
902                         /* XXX scopeid */
903                         struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)sa;
904                         struct sctp_ipv6addr_param *v6addr;
905
906                         v6addr = (struct sctp_ipv6addr_param *)ph;
907                         if ((param_type == SCTP_IPV6_ADDRESS) &&
908                             (param_length == sizeof(struct sctp_ipv6addr_param)) &&
909                             (memcmp(&v6addr->addr, &sin6->sin6_addr,
910                             sizeof(struct in6_addr)) == 0)) {
911                                 return (1);
912                         }
913                         break;
914                 }
915 #endif
916 #ifdef INET
917         case AF_INET:
918                 {
919                         struct sockaddr_in *sin = (struct sockaddr_in *)sa;
920                         struct sctp_ipv4addr_param *v4addr;
921
922                         v4addr = (struct sctp_ipv4addr_param *)ph;
923                         if ((param_type == SCTP_IPV4_ADDRESS) &&
924                             (param_length == sizeof(struct sctp_ipv4addr_param)) &&
925                             (memcmp(&v4addr->addr, &sin->sin_addr,
926                             sizeof(struct in_addr)) == 0)) {
927                                 return (1);
928                         }
929                         break;
930                 }
931 #endif
932         default:
933                 break;
934         }
935         return (0);
936 }
937
938 /*
939  * Cleanup for non-responded/OP ERR'd ASCONF
940  */
941 void
942 sctp_asconf_cleanup(struct sctp_tcb *stcb, struct sctp_nets *net)
943 {
944         /*
945          * clear out any existing asconfs going out
946          */
947         sctp_timer_stop(SCTP_TIMER_TYPE_ASCONF, stcb->sctp_ep, stcb, net,
948             SCTP_FROM_SCTP_ASCONF + SCTP_LOC_2);
949         stcb->asoc.asconf_seq_out_acked = stcb->asoc.asconf_seq_out;
950         /* remove the old ASCONF on our outbound queue */
951         sctp_toss_old_asconf(stcb);
952 }
953
954 /*
955  * cleanup any cached source addresses that may be topologically
956  * incorrect after a new address has been added to this interface.
957  */
958 static void
959 sctp_asconf_nets_cleanup(struct sctp_tcb *stcb, struct sctp_ifn *ifn)
960 {
961         struct sctp_nets *net;
962
963         /*
964          * Ideally, we want to only clear cached routes and source addresses
965          * that are topologically incorrect.  But since there is no easy way
966          * to know whether the newly added address on the ifn would cause a
967          * routing change (i.e. a new egress interface would be chosen)
968          * without doing a new routing lookup and source address selection,
969          * we will (for now) just flush any cached route using a different
970          * ifn (and cached source addrs) and let output re-choose them
971          * during the next send on that net.
972          */
973         TAILQ_FOREACH(net, &stcb->asoc.nets, sctp_next) {
974                 /*
975                  * clear any cached route (and cached source address) if the
976                  * route's interface is NOT the same as the address change.
977                  * If it's the same interface, just clear the cached source
978                  * address.
979                  */
980                 if (SCTP_ROUTE_HAS_VALID_IFN(&net->ro) &&
981                     ((ifn == NULL) ||
982                     (SCTP_GET_IF_INDEX_FROM_ROUTE(&net->ro) != ifn->ifn_index))) {
983                         /* clear any cached route */
984                         RTFREE(net->ro.ro_rt);
985                         net->ro.ro_rt = NULL;
986                 }
987                 /* clear any cached source address */
988                 if (net->src_addr_selected) {
989                         sctp_free_ifa(net->ro._s_addr);
990                         net->ro._s_addr = NULL;
991                         net->src_addr_selected = 0;
992                 }
993         }
994 }
995
996
997 void
998 sctp_assoc_immediate_retrans(struct sctp_tcb *stcb, struct sctp_nets *dstnet)
999 {
1000         int error;
1001
1002         if (dstnet->dest_state & SCTP_ADDR_UNCONFIRMED) {
1003                 return;
1004         }
1005         if (stcb->asoc.deleted_primary == NULL) {
1006                 return;
1007         }
1008
1009         if (!TAILQ_EMPTY(&stcb->asoc.sent_queue)) {
1010                 SCTPDBG(SCTP_DEBUG_ASCONF1, "assoc_immediate_retrans: Deleted primary is ");
1011                 SCTPDBG_ADDR(SCTP_DEBUG_ASCONF1, &stcb->asoc.deleted_primary->ro._l_addr.sa);
1012                 SCTPDBG(SCTP_DEBUG_ASCONF1, "Current Primary is ");
1013                 SCTPDBG_ADDR(SCTP_DEBUG_ASCONF1, &stcb->asoc.primary_destination->ro._l_addr.sa);
1014                 sctp_timer_stop(SCTP_TIMER_TYPE_SEND, stcb->sctp_ep, stcb,
1015                     stcb->asoc.deleted_primary,
1016                     SCTP_FROM_SCTP_ASCONF + SCTP_LOC_3);
1017                 stcb->asoc.num_send_timers_up--;
1018                 if (stcb->asoc.num_send_timers_up < 0) {
1019                         stcb->asoc.num_send_timers_up = 0;
1020                 }
1021                 SCTP_TCB_LOCK_ASSERT(stcb);
1022                 error = sctp_t3rxt_timer(stcb->sctp_ep, stcb,
1023                     stcb->asoc.deleted_primary);
1024                 if (error) {
1025                         SCTP_INP_DECR_REF(stcb->sctp_ep);
1026                         return;
1027                 }
1028                 SCTP_TCB_LOCK_ASSERT(stcb);
1029 #ifdef SCTP_AUDITING_ENABLED
1030                 sctp_auditing(4, stcb->sctp_ep, stcb, stcb->asoc.deleted_primary);
1031 #endif
1032                 sctp_chunk_output(stcb->sctp_ep, stcb, SCTP_OUTPUT_FROM_T3, SCTP_SO_NOT_LOCKED);
1033                 if ((stcb->asoc.num_send_timers_up == 0) &&
1034                     (stcb->asoc.sent_queue_cnt > 0)) {
1035                         struct sctp_tmit_chunk *chk;
1036
1037                         chk = TAILQ_FIRST(&stcb->asoc.sent_queue);
1038                         sctp_timer_start(SCTP_TIMER_TYPE_SEND, stcb->sctp_ep,
1039                             stcb, chk->whoTo);
1040                 }
1041         }
1042         return;
1043 }
1044
1045 static int
1046     sctp_asconf_queue_mgmt(struct sctp_tcb *, struct sctp_ifa *, uint16_t);
1047
1048 void
1049 sctp_net_immediate_retrans(struct sctp_tcb *stcb, struct sctp_nets *net)
1050 {
1051         struct sctp_tmit_chunk *chk;
1052
1053         SCTPDBG(SCTP_DEBUG_ASCONF1, "net_immediate_retrans: RTO is %d\n", net->RTO);
1054         sctp_timer_stop(SCTP_TIMER_TYPE_SEND, stcb->sctp_ep, stcb, net,
1055             SCTP_FROM_SCTP_ASCONF + SCTP_LOC_4);
1056         stcb->asoc.cc_functions.sctp_set_initial_cc_param(stcb, net);
1057         net->error_count = 0;
1058         TAILQ_FOREACH(chk, &stcb->asoc.sent_queue, sctp_next) {
1059                 if (chk->whoTo == net) {
1060                         if (chk->sent < SCTP_DATAGRAM_RESEND) {
1061                                 chk->sent = SCTP_DATAGRAM_RESEND;
1062                                 sctp_ucount_incr(stcb->asoc.sent_queue_retran_cnt);
1063                                 sctp_flight_size_decrease(chk);
1064                                 sctp_total_flight_decrease(stcb, chk);
1065                                 net->marked_retrans++;
1066                                 stcb->asoc.marked_retrans++;
1067                         }
1068                 }
1069         }
1070         if (net->marked_retrans) {
1071                 sctp_chunk_output(stcb->sctp_ep, stcb, SCTP_OUTPUT_FROM_T3, SCTP_SO_NOT_LOCKED);
1072         }
1073 }
1074
1075 static void
1076 sctp_path_check_and_react(struct sctp_tcb *stcb, struct sctp_ifa *newifa)
1077 {
1078         struct sctp_nets *net;
1079         int addrnum, changed;
1080
1081         /*
1082          * If number of local valid addresses is 1, the valid address is
1083          * probably newly added address. Several valid addresses in this
1084          * association.  A source address may not be changed.  Additionally,
1085          * they can be configured on a same interface as "alias" addresses.
1086          * (by micchie)
1087          */
1088         addrnum = sctp_local_addr_count(stcb);
1089         SCTPDBG(SCTP_DEBUG_ASCONF1, "p_check_react(): %d local addresses\n",
1090             addrnum);
1091         if (addrnum == 1) {
1092                 TAILQ_FOREACH(net, &stcb->asoc.nets, sctp_next) {
1093                         /* clear any cached route and source address */
1094                         if (net->ro.ro_rt) {
1095                                 RTFREE(net->ro.ro_rt);
1096                                 net->ro.ro_rt = NULL;
1097                         }
1098                         if (net->src_addr_selected) {
1099                                 sctp_free_ifa(net->ro._s_addr);
1100                                 net->ro._s_addr = NULL;
1101                                 net->src_addr_selected = 0;
1102                         }
1103                         /* Retransmit unacknowledged DATA chunks immediately */
1104                         if (sctp_is_mobility_feature_on(stcb->sctp_ep,
1105                             SCTP_MOBILITY_FASTHANDOFF)) {
1106                                 sctp_net_immediate_retrans(stcb, net);
1107                         }
1108                         /* also, SET PRIMARY is maybe already sent */
1109                 }
1110                 return;
1111         }
1112
1113         /* Multiple local addresses exsist in the association.  */
1114         TAILQ_FOREACH(net, &stcb->asoc.nets, sctp_next) {
1115                 /* clear any cached route and source address */
1116                 if (net->ro.ro_rt) {
1117                         RTFREE(net->ro.ro_rt);
1118                         net->ro.ro_rt = NULL;
1119                 }
1120                 if (net->src_addr_selected) {
1121                         sctp_free_ifa(net->ro._s_addr);
1122                         net->ro._s_addr = NULL;
1123                         net->src_addr_selected = 0;
1124                 }
1125                 /*
1126                  * Check if the nexthop is corresponding to the new address.
1127                  * If the new address is corresponding to the current
1128                  * nexthop, the path will be changed. If the new address is
1129                  * NOT corresponding to the current nexthop, the path will
1130                  * not be changed.
1131                  */
1132                 SCTP_RTALLOC((sctp_route_t *)&net->ro,
1133                     stcb->sctp_ep->def_vrf_id,
1134                     stcb->sctp_ep->fibnum);
1135                 if (net->ro.ro_rt == NULL)
1136                         continue;
1137
1138                 changed = 0;
1139                 switch (net->ro._l_addr.sa.sa_family) {
1140 #ifdef INET
1141                 case AF_INET:
1142                         if (sctp_v4src_match_nexthop(newifa, (sctp_route_t *)&net->ro)) {
1143                                 changed = 1;
1144                         }
1145                         break;
1146 #endif
1147 #ifdef INET6
1148                 case AF_INET6:
1149                         if (sctp_v6src_match_nexthop(
1150                             &newifa->address.sin6, (sctp_route_t *)&net->ro)) {
1151                                 changed = 1;
1152                         }
1153                         break;
1154 #endif
1155                 default:
1156                         break;
1157                 }
1158                 /*
1159                  * if the newly added address does not relate routing
1160                  * information, we skip.
1161                  */
1162                 if (changed == 0)
1163                         continue;
1164                 /* Retransmit unacknowledged DATA chunks immediately */
1165                 if (sctp_is_mobility_feature_on(stcb->sctp_ep,
1166                     SCTP_MOBILITY_FASTHANDOFF)) {
1167                         sctp_net_immediate_retrans(stcb, net);
1168                 }
1169                 /* Send SET PRIMARY for this new address */
1170                 if (net == stcb->asoc.primary_destination) {
1171                         (void)sctp_asconf_queue_mgmt(stcb, newifa,
1172                             SCTP_SET_PRIM_ADDR);
1173                 }
1174         }
1175 }
1176
1177 /*
1178  * process an ADD/DELETE IP ack from peer.
1179  * addr: corresponding sctp_ifa to the address being added/deleted.
1180  * type: SCTP_ADD_IP_ADDRESS or SCTP_DEL_IP_ADDRESS.
1181  * flag: 1=success, 0=failure.
1182  */
1183 static void
1184 sctp_asconf_addr_mgmt_ack(struct sctp_tcb *stcb, struct sctp_ifa *addr, uint32_t flag)
1185 {
1186         /*
1187          * do the necessary asoc list work- if we get a failure indication,
1188          * leave the address on the assoc's restricted list.  If we get a
1189          * success indication, remove the address from the restricted list.
1190          */
1191         /*
1192          * Note: this will only occur for ADD_IP_ADDRESS, since
1193          * DEL_IP_ADDRESS is never actually added to the list...
1194          */
1195         if (flag) {
1196                 /* success case, so remove from the restricted list */
1197                 sctp_del_local_addr_restricted(stcb, addr);
1198
1199                 if (sctp_is_mobility_feature_on(stcb->sctp_ep,
1200                     SCTP_MOBILITY_BASE) ||
1201                     sctp_is_mobility_feature_on(stcb->sctp_ep,
1202                     SCTP_MOBILITY_FASTHANDOFF)) {
1203                         sctp_path_check_and_react(stcb, addr);
1204                         return;
1205                 }
1206                 /* clear any cached/topologically incorrect source addresses */
1207                 sctp_asconf_nets_cleanup(stcb, addr->ifn_p);
1208         }
1209         /* else, leave it on the list */
1210 }
1211
1212 /*
1213  * add an asconf add/delete/set primary IP address parameter to the queue.
1214  * type = SCTP_ADD_IP_ADDRESS, SCTP_DEL_IP_ADDRESS, SCTP_SET_PRIM_ADDR.
1215  * returns 0 if queued, -1 if not queued/removed.
1216  * NOTE: if adding, but a delete for the same address is already scheduled
1217  * (and not yet sent out), simply remove it from queue.  Same for deleting
1218  * an address already scheduled for add.  If a duplicate operation is found,
1219  * ignore the new one.
1220  */
1221 static int
1222 sctp_asconf_queue_mgmt(struct sctp_tcb *stcb, struct sctp_ifa *ifa,
1223     uint16_t type)
1224 {
1225         struct sctp_asconf_addr *aa, *aa_next;
1226
1227         /* make sure the request isn't already in the queue */
1228         TAILQ_FOREACH_SAFE(aa, &stcb->asoc.asconf_queue, next, aa_next) {
1229                 /* address match? */
1230                 if (sctp_asconf_addr_match(aa, &ifa->address.sa) == 0)
1231                         continue;
1232                 /*
1233                  * is the request already in queue but not sent? pass the
1234                  * request already sent in order to resolve the following
1235                  * case: 1. arrival of ADD, then sent 2. arrival of DEL. we
1236                  * can't remove the ADD request already sent 3. arrival of
1237                  * ADD
1238                  */
1239                 if (aa->ap.aph.ph.param_type == type && aa->sent == 0) {
1240                         return (-1);
1241                 }
1242                 /* is the negative request already in queue, and not sent */
1243                 if ((aa->sent == 0) && (type == SCTP_ADD_IP_ADDRESS) &&
1244                     (aa->ap.aph.ph.param_type == SCTP_DEL_IP_ADDRESS)) {
1245                         /* add requested, delete already queued */
1246                         TAILQ_REMOVE(&stcb->asoc.asconf_queue, aa, next);
1247                         /* remove the ifa from the restricted list */
1248                         sctp_del_local_addr_restricted(stcb, ifa);
1249                         /* free the asconf param */
1250                         SCTP_FREE(aa, SCTP_M_ASC_ADDR);
1251                         SCTPDBG(SCTP_DEBUG_ASCONF2, "asconf_queue_mgmt: add removes queued entry\n");
1252                         return (-1);
1253                 }
1254                 if ((aa->sent == 0) && (type == SCTP_DEL_IP_ADDRESS) &&
1255                     (aa->ap.aph.ph.param_type == SCTP_ADD_IP_ADDRESS)) {
1256                         /* delete requested, add already queued */
1257                         TAILQ_REMOVE(&stcb->asoc.asconf_queue, aa, next);
1258                         /* remove the aa->ifa from the restricted list */
1259                         sctp_del_local_addr_restricted(stcb, aa->ifa);
1260                         /* free the asconf param */
1261                         SCTP_FREE(aa, SCTP_M_ASC_ADDR);
1262                         SCTPDBG(SCTP_DEBUG_ASCONF2, "asconf_queue_mgmt: delete removes queued entry\n");
1263                         return (-1);
1264                 }
1265         }                       /* for each aa */
1266
1267         /* adding new request to the queue */
1268         SCTP_MALLOC(aa, struct sctp_asconf_addr *, sizeof(*aa),
1269             SCTP_M_ASC_ADDR);
1270         if (aa == NULL) {
1271                 /* didn't get memory */
1272                 SCTPDBG(SCTP_DEBUG_ASCONF1, "asconf_queue_mgmt: failed to get memory!\n");
1273                 return (-1);
1274         }
1275         aa->special_del = 0;
1276         /* fill in asconf address parameter fields */
1277         /* top level elements are "networked" during send */
1278         aa->ap.aph.ph.param_type = type;
1279         aa->ifa = ifa;
1280         atomic_add_int(&ifa->refcount, 1);
1281         /* correlation_id filled in during send routine later... */
1282         switch (ifa->address.sa.sa_family) {
1283 #ifdef INET6
1284         case AF_INET6:
1285                 {
1286                         struct sockaddr_in6 *sin6;
1287
1288                         sin6 = &ifa->address.sin6;
1289                         aa->ap.addrp.ph.param_type = SCTP_IPV6_ADDRESS;
1290                         aa->ap.addrp.ph.param_length = (sizeof(struct sctp_ipv6addr_param));
1291                         aa->ap.aph.ph.param_length = sizeof(struct sctp_asconf_paramhdr) +
1292                             sizeof(struct sctp_ipv6addr_param);
1293                         memcpy(&aa->ap.addrp.addr, &sin6->sin6_addr,
1294                             sizeof(struct in6_addr));
1295                         break;
1296                 }
1297 #endif
1298 #ifdef INET
1299         case AF_INET:
1300                 {
1301                         struct sockaddr_in *sin;
1302
1303                         sin = &ifa->address.sin;
1304                         aa->ap.addrp.ph.param_type = SCTP_IPV4_ADDRESS;
1305                         aa->ap.addrp.ph.param_length = (sizeof(struct sctp_ipv4addr_param));
1306                         aa->ap.aph.ph.param_length = sizeof(struct sctp_asconf_paramhdr) +
1307                             sizeof(struct sctp_ipv4addr_param);
1308                         memcpy(&aa->ap.addrp.addr, &sin->sin_addr,
1309                             sizeof(struct in_addr));
1310                         break;
1311                 }
1312 #endif
1313         default:
1314                 /* invalid family! */
1315                 SCTP_FREE(aa, SCTP_M_ASC_ADDR);
1316                 sctp_free_ifa(ifa);
1317                 return (-1);
1318         }
1319         aa->sent = 0;           /* clear sent flag */
1320
1321         TAILQ_INSERT_TAIL(&stcb->asoc.asconf_queue, aa, next);
1322 #ifdef SCTP_DEBUG
1323         if (SCTP_BASE_SYSCTL(sctp_debug_on) & SCTP_DEBUG_ASCONF2) {
1324                 if (type == SCTP_ADD_IP_ADDRESS) {
1325                         SCTP_PRINTF("asconf_queue_mgmt: inserted asconf ADD_IP_ADDRESS: ");
1326                         SCTPDBG_ADDR(SCTP_DEBUG_ASCONF2, &ifa->address.sa);
1327                 } else if (type == SCTP_DEL_IP_ADDRESS) {
1328                         SCTP_PRINTF("asconf_queue_mgmt: appended asconf DEL_IP_ADDRESS: ");
1329                         SCTPDBG_ADDR(SCTP_DEBUG_ASCONF2, &ifa->address.sa);
1330                 } else {
1331                         SCTP_PRINTF("asconf_queue_mgmt: appended asconf SET_PRIM_ADDR: ");
1332                         SCTPDBG_ADDR(SCTP_DEBUG_ASCONF2, &ifa->address.sa);
1333                 }
1334         }
1335 #endif
1336
1337         return (0);
1338 }
1339
1340
1341 /*
1342  * add an asconf operation for the given ifa and type.
1343  * type = SCTP_ADD_IP_ADDRESS, SCTP_DEL_IP_ADDRESS, SCTP_SET_PRIM_ADDR.
1344  * returns 0 if completed, -1 if not completed, 1 if immediate send is
1345  * advisable.
1346  */
1347 static int
1348 sctp_asconf_queue_add(struct sctp_tcb *stcb, struct sctp_ifa *ifa,
1349     uint16_t type)
1350 {
1351         uint32_t status;
1352         int pending_delete_queued = 0;
1353         int last;
1354
1355         /* see if peer supports ASCONF */
1356         if (stcb->asoc.asconf_supported == 0) {
1357                 return (-1);
1358         }
1359
1360         /*
1361          * if this is deleting the last address from the assoc, mark it as
1362          * pending.
1363          */
1364         if ((type == SCTP_DEL_IP_ADDRESS) && !stcb->asoc.asconf_del_pending) {
1365                 if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_BOUNDALL) {
1366                         last = (sctp_local_addr_count(stcb) == 0);
1367                 } else {
1368                         last = (sctp_local_addr_count(stcb) == 1);
1369                 }
1370                 if (last) {
1371                         /* set the pending delete info only */
1372                         stcb->asoc.asconf_del_pending = 1;
1373                         stcb->asoc.asconf_addr_del_pending = ifa;
1374                         atomic_add_int(&ifa->refcount, 1);
1375                         SCTPDBG(SCTP_DEBUG_ASCONF2,
1376                             "asconf_queue_add: mark delete last address pending\n");
1377                         return (-1);
1378                 }
1379         }
1380
1381         /* queue an asconf parameter */
1382         status = sctp_asconf_queue_mgmt(stcb, ifa, type);
1383
1384         /*
1385          * if this is an add, and there is a delete also pending (i.e. the
1386          * last local address is being changed), queue the pending delete
1387          * too.
1388          */
1389         if ((type == SCTP_ADD_IP_ADDRESS) && stcb->asoc.asconf_del_pending && (status == 0)) {
1390                 /* queue in the pending delete */
1391                 if (sctp_asconf_queue_mgmt(stcb,
1392                     stcb->asoc.asconf_addr_del_pending,
1393                     SCTP_DEL_IP_ADDRESS) == 0) {
1394                         SCTPDBG(SCTP_DEBUG_ASCONF2, "asconf_queue_add: queuing pending delete\n");
1395                         pending_delete_queued = 1;
1396                         /* clear out the pending delete info */
1397                         stcb->asoc.asconf_del_pending = 0;
1398                         sctp_free_ifa(stcb->asoc.asconf_addr_del_pending);
1399                         stcb->asoc.asconf_addr_del_pending = NULL;
1400                 }
1401         }
1402
1403         if (pending_delete_queued) {
1404                 struct sctp_nets *net;
1405
1406                 /*
1407                  * since we know that the only/last address is now being
1408                  * changed in this case, reset the cwnd/rto on all nets to
1409                  * start as a new address and path.  Also clear the error
1410                  * counts to give the assoc the best chance to complete the
1411                  * address change.
1412                  */
1413                 TAILQ_FOREACH(net, &stcb->asoc.nets, sctp_next) {
1414                         stcb->asoc.cc_functions.sctp_set_initial_cc_param(stcb,
1415                             net);
1416                         net->RTO = 0;
1417                         net->error_count = 0;
1418                 }
1419                 stcb->asoc.overall_error_count = 0;
1420                 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_THRESHOLD_LOGGING) {
1421                         sctp_misc_ints(SCTP_THRESHOLD_CLEAR,
1422                             stcb->asoc.overall_error_count,
1423                             0,
1424                             SCTP_FROM_SCTP_ASCONF,
1425                             __LINE__);
1426                 }
1427
1428                 /* queue in an advisory set primary too */
1429                 (void)sctp_asconf_queue_mgmt(stcb, ifa, SCTP_SET_PRIM_ADDR);
1430                 /* let caller know we should send this out immediately */
1431                 status = 1;
1432         }
1433         return (status);
1434 }
1435
1436 /*-
1437  * add an asconf delete IP address parameter to the queue by sockaddr and
1438  * possibly with no sctp_ifa available.  This is only called by the routine
1439  * that checks the addresses in an INIT-ACK against the current address list.
1440  * returns 0 if completed, non-zero if not completed.
1441  * NOTE: if an add is already scheduled (and not yet sent out), simply
1442  * remove it from queue.  If a duplicate operation is found, ignore the
1443  * new one.
1444  */
1445 static int
1446 sctp_asconf_queue_sa_delete(struct sctp_tcb *stcb, struct sockaddr *sa)
1447 {
1448         struct sctp_ifa *ifa;
1449         struct sctp_asconf_addr *aa, *aa_next;
1450
1451         if (stcb == NULL) {
1452                 return (-1);
1453         }
1454         /* see if peer supports ASCONF */
1455         if (stcb->asoc.asconf_supported == 0) {
1456                 return (-1);
1457         }
1458         /* make sure the request isn't already in the queue */
1459         TAILQ_FOREACH_SAFE(aa, &stcb->asoc.asconf_queue, next, aa_next) {
1460                 /* address match? */
1461                 if (sctp_asconf_addr_match(aa, sa) == 0)
1462                         continue;
1463                 /* is the request already in queue (sent or not) */
1464                 if (aa->ap.aph.ph.param_type == SCTP_DEL_IP_ADDRESS) {
1465                         return (-1);
1466                 }
1467                 /* is the negative request already in queue, and not sent */
1468                 if (aa->sent == 1)
1469                         continue;
1470                 if (aa->ap.aph.ph.param_type == SCTP_ADD_IP_ADDRESS) {
1471                         /* add already queued, so remove existing entry */
1472                         TAILQ_REMOVE(&stcb->asoc.asconf_queue, aa, next);
1473                         sctp_del_local_addr_restricted(stcb, aa->ifa);
1474                         /* free the entry */
1475                         SCTP_FREE(aa, SCTP_M_ASC_ADDR);
1476                         return (-1);
1477                 }
1478         }                       /* for each aa */
1479
1480         /* find any existing ifa-- NOTE ifa CAN be allowed to be NULL */
1481         ifa = sctp_find_ifa_by_addr(sa, stcb->asoc.vrf_id, SCTP_ADDR_NOT_LOCKED);
1482
1483         /* adding new request to the queue */
1484         SCTP_MALLOC(aa, struct sctp_asconf_addr *, sizeof(*aa),
1485             SCTP_M_ASC_ADDR);
1486         if (aa == NULL) {
1487                 /* didn't get memory */
1488                 SCTPDBG(SCTP_DEBUG_ASCONF1,
1489                     "sctp_asconf_queue_sa_delete: failed to get memory!\n");
1490                 return (-1);
1491         }
1492         aa->special_del = 0;
1493         /* fill in asconf address parameter fields */
1494         /* top level elements are "networked" during send */
1495         aa->ap.aph.ph.param_type = SCTP_DEL_IP_ADDRESS;
1496         aa->ifa = ifa;
1497         if (ifa)
1498                 atomic_add_int(&ifa->refcount, 1);
1499         /* correlation_id filled in during send routine later... */
1500         switch (sa->sa_family) {
1501 #ifdef INET6
1502         case AF_INET6:
1503                 {
1504                         /* IPv6 address */
1505                         struct sockaddr_in6 *sin6;
1506
1507                         sin6 = (struct sockaddr_in6 *)sa;
1508                         aa->ap.addrp.ph.param_type = SCTP_IPV6_ADDRESS;
1509                         aa->ap.addrp.ph.param_length = (sizeof(struct sctp_ipv6addr_param));
1510                         aa->ap.aph.ph.param_length = sizeof(struct sctp_asconf_paramhdr) + sizeof(struct sctp_ipv6addr_param);
1511                         memcpy(&aa->ap.addrp.addr, &sin6->sin6_addr,
1512                             sizeof(struct in6_addr));
1513                         break;
1514                 }
1515 #endif
1516 #ifdef INET
1517         case AF_INET:
1518                 {
1519                         /* IPv4 address */
1520                         struct sockaddr_in *sin = (struct sockaddr_in *)sa;
1521
1522                         aa->ap.addrp.ph.param_type = SCTP_IPV4_ADDRESS;
1523                         aa->ap.addrp.ph.param_length = (sizeof(struct sctp_ipv4addr_param));
1524                         aa->ap.aph.ph.param_length = sizeof(struct sctp_asconf_paramhdr) + sizeof(struct sctp_ipv4addr_param);
1525                         memcpy(&aa->ap.addrp.addr, &sin->sin_addr,
1526                             sizeof(struct in_addr));
1527                         break;
1528                 }
1529 #endif
1530         default:
1531                 /* invalid family! */
1532                 SCTP_FREE(aa, SCTP_M_ASC_ADDR);
1533                 if (ifa)
1534                         sctp_free_ifa(ifa);
1535                 return (-1);
1536         }
1537         aa->sent = 0;           /* clear sent flag */
1538
1539         /* delete goes to the back of the queue */
1540         TAILQ_INSERT_TAIL(&stcb->asoc.asconf_queue, aa, next);
1541
1542         /* sa_ignore MEMLEAK {memory is put on the tailq} */
1543         return (0);
1544 }
1545
1546 /*
1547  * find a specific asconf param on our "sent" queue
1548  */
1549 static struct sctp_asconf_addr *
1550 sctp_asconf_find_param(struct sctp_tcb *stcb, uint32_t correlation_id)
1551 {
1552         struct sctp_asconf_addr *aa;
1553
1554         TAILQ_FOREACH(aa, &stcb->asoc.asconf_queue, next) {
1555                 if (aa->ap.aph.correlation_id == correlation_id &&
1556                     aa->sent == 1) {
1557                         /* found it */
1558                         return (aa);
1559                 }
1560         }
1561         /* didn't find it */
1562         return (NULL);
1563 }
1564
1565 /*
1566  * process an SCTP_ERROR_CAUSE_IND for a ASCONF-ACK parameter and do
1567  * notifications based on the error response
1568  */
1569 static void
1570 sctp_asconf_process_error(struct sctp_tcb *stcb SCTP_UNUSED,
1571     struct sctp_asconf_paramhdr *aph)
1572 {
1573         struct sctp_error_cause *eh;
1574         struct sctp_paramhdr *ph;
1575         uint16_t param_type;
1576         uint16_t error_code;
1577
1578         eh = (struct sctp_error_cause *)(aph + 1);
1579         ph = (struct sctp_paramhdr *)(eh + 1);
1580         /* validate lengths */
1581         if (htons(eh->length) + sizeof(struct sctp_error_cause) >
1582             htons(aph->ph.param_length)) {
1583                 /* invalid error cause length */
1584                 SCTPDBG(SCTP_DEBUG_ASCONF1,
1585                     "asconf_process_error: cause element too long\n");
1586                 return;
1587         }
1588         if (htons(ph->param_length) + sizeof(struct sctp_paramhdr) >
1589             htons(eh->length)) {
1590                 /* invalid included TLV length */
1591                 SCTPDBG(SCTP_DEBUG_ASCONF1,
1592                     "asconf_process_error: included TLV too long\n");
1593                 return;
1594         }
1595         /* which error code ? */
1596         error_code = ntohs(eh->code);
1597         param_type = ntohs(aph->ph.param_type);
1598         /* FIX: this should go back up the REMOTE_ERROR ULP notify */
1599         switch (error_code) {
1600         case SCTP_CAUSE_RESOURCE_SHORTAGE:
1601                 /* we allow ourselves to "try again" for this error */
1602                 break;
1603         default:
1604                 /* peer can't handle it... */
1605                 switch (param_type) {
1606                 case SCTP_ADD_IP_ADDRESS:
1607                 case SCTP_DEL_IP_ADDRESS:
1608                 case SCTP_SET_PRIM_ADDR:
1609                         break;
1610                 default:
1611                         break;
1612                 }
1613         }
1614 }
1615
1616 /*
1617  * process an asconf queue param.
1618  * aparam: parameter to process, will be removed from the queue.
1619  * flag: 1=success case, 0=failure case
1620  */
1621 static void
1622 sctp_asconf_process_param_ack(struct sctp_tcb *stcb,
1623     struct sctp_asconf_addr *aparam, uint32_t flag)
1624 {
1625         uint16_t param_type;
1626
1627         /* process this param */
1628         param_type = aparam->ap.aph.ph.param_type;
1629         switch (param_type) {
1630         case SCTP_ADD_IP_ADDRESS:
1631                 SCTPDBG(SCTP_DEBUG_ASCONF1,
1632                     "process_param_ack: added IP address\n");
1633                 sctp_asconf_addr_mgmt_ack(stcb, aparam->ifa, flag);
1634                 break;
1635         case SCTP_DEL_IP_ADDRESS:
1636                 SCTPDBG(SCTP_DEBUG_ASCONF1,
1637                     "process_param_ack: deleted IP address\n");
1638                 /* nothing really to do... lists already updated */
1639                 break;
1640         case SCTP_SET_PRIM_ADDR:
1641                 SCTPDBG(SCTP_DEBUG_ASCONF1,
1642                     "process_param_ack: set primary IP address\n");
1643                 /* nothing to do... peer may start using this addr */
1644                 break;
1645         default:
1646                 /* should NEVER happen */
1647                 break;
1648         }
1649
1650         /* remove the param and free it */
1651         TAILQ_REMOVE(&stcb->asoc.asconf_queue, aparam, next);
1652         if (aparam->ifa)
1653                 sctp_free_ifa(aparam->ifa);
1654         SCTP_FREE(aparam, SCTP_M_ASC_ADDR);
1655 }
1656
1657 /*
1658  * cleanup from a bad asconf ack parameter
1659  */
1660 static void
1661 sctp_asconf_ack_clear(struct sctp_tcb *stcb SCTP_UNUSED)
1662 {
1663         /* assume peer doesn't really know how to do asconfs */
1664         /* XXX we could free the pending queue here */
1665
1666 }
1667
1668 void
1669 sctp_handle_asconf_ack(struct mbuf *m, int offset,
1670     struct sctp_asconf_ack_chunk *cp, struct sctp_tcb *stcb,
1671     struct sctp_nets *net, int *abort_no_unlock)
1672 {
1673         struct sctp_association *asoc;
1674         uint32_t serial_num;
1675         uint16_t ack_length;
1676         struct sctp_asconf_paramhdr *aph;
1677         struct sctp_asconf_addr *aa, *aa_next;
1678         uint32_t last_error_id = 0;     /* last error correlation id */
1679         uint32_t id;
1680         struct sctp_asconf_addr *ap;
1681
1682         /* asconf param buffer */
1683         uint8_t aparam_buf[SCTP_PARAM_BUFFER_SIZE];
1684
1685         /* verify minimum length */
1686         if (ntohs(cp->ch.chunk_length) < sizeof(struct sctp_asconf_ack_chunk)) {
1687                 SCTPDBG(SCTP_DEBUG_ASCONF1,
1688                     "handle_asconf_ack: chunk too small = %xh\n",
1689                     ntohs(cp->ch.chunk_length));
1690                 return;
1691         }
1692         asoc = &stcb->asoc;
1693         serial_num = ntohl(cp->serial_number);
1694
1695         /*
1696          * NOTE: we may want to handle this differently- currently, we will
1697          * abort when we get an ack for the expected serial number + 1 (eg.
1698          * we didn't send it), process an ack normally if it is the expected
1699          * serial number, and re-send the previous ack for *ALL* other
1700          * serial numbers
1701          */
1702
1703         /*
1704          * if the serial number is the next expected, but I didn't send it,
1705          * abort the asoc, since someone probably just hijacked us...
1706          */
1707         if (serial_num == (asoc->asconf_seq_out + 1)) {
1708                 struct mbuf *op_err;
1709                 char msg[SCTP_DIAG_INFO_LEN];
1710
1711                 SCTPDBG(SCTP_DEBUG_ASCONF1, "handle_asconf_ack: got unexpected next serial number! Aborting asoc!\n");
1712                 snprintf(msg, sizeof(msg), "Never sent serial number %8.8x",
1713                     serial_num);
1714                 op_err = sctp_generate_cause(SCTP_CAUSE_PROTOCOL_VIOLATION, msg);
1715                 sctp_abort_an_association(stcb->sctp_ep, stcb, op_err, SCTP_SO_NOT_LOCKED);
1716                 *abort_no_unlock = 1;
1717                 return;
1718         }
1719         if (serial_num != asoc->asconf_seq_out_acked + 1) {
1720                 /* got a duplicate/unexpected ASCONF-ACK */
1721                 SCTPDBG(SCTP_DEBUG_ASCONF1, "handle_asconf_ack: got duplicate/unexpected serial number = %xh (expected = %xh)\n",
1722                     serial_num, asoc->asconf_seq_out_acked + 1);
1723                 return;
1724         }
1725
1726         if (serial_num == asoc->asconf_seq_out - 1) {
1727                 /* stop our timer */
1728                 sctp_timer_stop(SCTP_TIMER_TYPE_ASCONF, stcb->sctp_ep, stcb, net,
1729                     SCTP_FROM_SCTP_ASCONF + SCTP_LOC_5);
1730         }
1731
1732         /* process the ASCONF-ACK contents */
1733         ack_length = ntohs(cp->ch.chunk_length) -
1734             sizeof(struct sctp_asconf_ack_chunk);
1735         offset += sizeof(struct sctp_asconf_ack_chunk);
1736         /* process through all parameters */
1737         while (ack_length >= sizeof(struct sctp_asconf_paramhdr)) {
1738                 unsigned int param_length, param_type;
1739
1740                 /* get pointer to next asconf parameter */
1741                 aph = (struct sctp_asconf_paramhdr *)sctp_m_getptr(m, offset,
1742                     sizeof(struct sctp_asconf_paramhdr), aparam_buf);
1743                 if (aph == NULL) {
1744                         /* can't get an asconf paramhdr */
1745                         sctp_asconf_ack_clear(stcb);
1746                         return;
1747                 }
1748                 param_type = ntohs(aph->ph.param_type);
1749                 param_length = ntohs(aph->ph.param_length);
1750                 if (param_length > ack_length) {
1751                         sctp_asconf_ack_clear(stcb);
1752                         return;
1753                 }
1754                 if (param_length < sizeof(struct sctp_paramhdr)) {
1755                         sctp_asconf_ack_clear(stcb);
1756                         return;
1757                 }
1758                 /* get the complete parameter... */
1759                 if (param_length > sizeof(aparam_buf)) {
1760                         SCTPDBG(SCTP_DEBUG_ASCONF1,
1761                             "param length (%u) larger than buffer size!\n", param_length);
1762                         sctp_asconf_ack_clear(stcb);
1763                         return;
1764                 }
1765                 aph = (struct sctp_asconf_paramhdr *)sctp_m_getptr(m, offset, param_length, aparam_buf);
1766                 if (aph == NULL) {
1767                         sctp_asconf_ack_clear(stcb);
1768                         return;
1769                 }
1770                 /* correlation_id is transparent to peer, no ntohl needed */
1771                 id = aph->correlation_id;
1772
1773                 switch (param_type) {
1774                 case SCTP_ERROR_CAUSE_IND:
1775                         last_error_id = id;
1776                         /* find the corresponding asconf param in our queue */
1777                         ap = sctp_asconf_find_param(stcb, id);
1778                         if (ap == NULL) {
1779                                 /* hmm... can't find this in our queue! */
1780                                 break;
1781                         }
1782                         /* process the parameter, failed flag */
1783                         sctp_asconf_process_param_ack(stcb, ap, 0);
1784                         /* process the error response */
1785                         sctp_asconf_process_error(stcb, aph);
1786                         break;
1787                 case SCTP_SUCCESS_REPORT:
1788                         /* find the corresponding asconf param in our queue */
1789                         ap = sctp_asconf_find_param(stcb, id);
1790                         if (ap == NULL) {
1791                                 /* hmm... can't find this in our queue! */
1792                                 break;
1793                         }
1794                         /* process the parameter, success flag */
1795                         sctp_asconf_process_param_ack(stcb, ap, 1);
1796                         break;
1797                 default:
1798                         break;
1799                 }               /* switch */
1800
1801                 /* update remaining ASCONF-ACK message length to process */
1802                 ack_length -= SCTP_SIZE32(param_length);
1803                 if (ack_length <= 0) {
1804                         /* no more data in the mbuf chain */
1805                         break;
1806                 }
1807                 offset += SCTP_SIZE32(param_length);
1808         }                       /* while */
1809
1810         /*
1811          * if there are any "sent" params still on the queue, these are
1812          * implicitly "success", or "failed" (if we got an error back) ...
1813          * so process these appropriately
1814          *
1815          * we assume that the correlation_id's are monotonically increasing
1816          * beginning from 1 and that we don't have *that* many outstanding
1817          * at any given time
1818          */
1819         if (last_error_id == 0)
1820                 last_error_id--;        /* set to "max" value */
1821         TAILQ_FOREACH_SAFE(aa, &stcb->asoc.asconf_queue, next, aa_next) {
1822                 if (aa->sent == 1) {
1823                         /*
1824                          * implicitly successful or failed if correlation_id
1825                          * < last_error_id, then success else, failure
1826                          */
1827                         if (aa->ap.aph.correlation_id < last_error_id)
1828                                 sctp_asconf_process_param_ack(stcb, aa, 1);
1829                         else
1830                                 sctp_asconf_process_param_ack(stcb, aa, 0);
1831                 } else {
1832                         /*
1833                          * since we always process in order (FIFO queue) if
1834                          * we reach one that hasn't been sent, the rest
1835                          * should not have been sent either. so, we're
1836                          * done...
1837                          */
1838                         break;
1839                 }
1840         }
1841
1842         /* update the next sequence number to use */
1843         asoc->asconf_seq_out_acked++;
1844         /* remove the old ASCONF on our outbound queue */
1845         sctp_toss_old_asconf(stcb);
1846         if (!TAILQ_EMPTY(&stcb->asoc.asconf_queue)) {
1847 #ifdef SCTP_TIMER_BASED_ASCONF
1848                 /* we have more params, so restart our timer */
1849                 sctp_timer_start(SCTP_TIMER_TYPE_ASCONF, stcb->sctp_ep,
1850                     stcb, net);
1851 #else
1852                 /* we have more params, so send out more */
1853                 sctp_send_asconf(stcb, net, SCTP_ADDR_NOT_LOCKED);
1854 #endif
1855         }
1856 }
1857
1858 #ifdef INET6
1859 static uint32_t
1860 sctp_is_scopeid_in_nets(struct sctp_tcb *stcb, struct sockaddr *sa)
1861 {
1862         struct sockaddr_in6 *sin6, *net6;
1863         struct sctp_nets *net;
1864
1865         if (sa->sa_family != AF_INET6) {
1866                 /* wrong family */
1867                 return (0);
1868         }
1869         sin6 = (struct sockaddr_in6 *)sa;
1870         if (IN6_IS_ADDR_LINKLOCAL(&sin6->sin6_addr) == 0) {
1871                 /* not link local address */
1872                 return (0);
1873         }
1874         /* hunt through our destination nets list for this scope_id */
1875         TAILQ_FOREACH(net, &stcb->asoc.nets, sctp_next) {
1876                 if (((struct sockaddr *)(&net->ro._l_addr))->sa_family !=
1877                     AF_INET6)
1878                         continue;
1879                 net6 = (struct sockaddr_in6 *)&net->ro._l_addr;
1880                 if (IN6_IS_ADDR_LINKLOCAL(&net6->sin6_addr) == 0)
1881                         continue;
1882                 if (sctp_is_same_scope(sin6, net6)) {
1883                         /* found one */
1884                         return (1);
1885                 }
1886         }
1887         /* didn't find one */
1888         return (0);
1889 }
1890 #endif
1891
1892 /*
1893  * address management functions
1894  */
1895 static void
1896 sctp_addr_mgmt_assoc(struct sctp_inpcb *inp, struct sctp_tcb *stcb,
1897     struct sctp_ifa *ifa, uint16_t type, int addr_locked)
1898 {
1899         int status;
1900
1901         if ((inp->sctp_flags & SCTP_PCB_FLAGS_BOUNDALL) == 0 ||
1902             sctp_is_feature_off(inp, SCTP_PCB_FLAGS_DO_ASCONF)) {
1903                 /* subset bound, no ASCONF allowed case, so ignore */
1904                 return;
1905         }
1906         /*
1907          * note: we know this is not the subset bound, no ASCONF case eg.
1908          * this is boundall or subset bound w/ASCONF allowed
1909          */
1910
1911         /* first, make sure that the address is IPv4 or IPv6 and not jailed */
1912         switch (ifa->address.sa.sa_family) {
1913 #ifdef INET6
1914         case AF_INET6:
1915                 if (prison_check_ip6(inp->ip_inp.inp.inp_cred,
1916                     &ifa->address.sin6.sin6_addr) != 0) {
1917                         return;
1918                 }
1919                 break;
1920 #endif
1921 #ifdef INET
1922         case AF_INET:
1923                 if (prison_check_ip4(inp->ip_inp.inp.inp_cred,
1924                     &ifa->address.sin.sin_addr) != 0) {
1925                         return;
1926                 }
1927                 break;
1928 #endif
1929         default:
1930                 return;
1931         }
1932 #ifdef INET6
1933         /* make sure we're "allowed" to add this type of addr */
1934         if (ifa->address.sa.sa_family == AF_INET6) {
1935                 /* invalid if we're not a v6 endpoint */
1936                 if ((inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) == 0)
1937                         return;
1938                 /* is the v6 addr really valid ? */
1939                 if (ifa->localifa_flags & SCTP_ADDR_IFA_UNUSEABLE) {
1940                         return;
1941                 }
1942         }
1943 #endif
1944         /* put this address on the "pending/do not use yet" list */
1945         sctp_add_local_addr_restricted(stcb, ifa);
1946         /*
1947          * check address scope if address is out of scope, don't queue
1948          * anything... note: this would leave the address on both inp and
1949          * asoc lists
1950          */
1951         switch (ifa->address.sa.sa_family) {
1952 #ifdef INET6
1953         case AF_INET6:
1954                 {
1955                         struct sockaddr_in6 *sin6;
1956
1957                         sin6 = &ifa->address.sin6;
1958                         if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr)) {
1959                                 /* we skip unspecifed addresses */
1960                                 return;
1961                         }
1962                         if (IN6_IS_ADDR_LINKLOCAL(&sin6->sin6_addr)) {
1963                                 if (stcb->asoc.scope.local_scope == 0) {
1964                                         return;
1965                                 }
1966                                 /* is it the right link local scope? */
1967                                 if (sctp_is_scopeid_in_nets(stcb, &ifa->address.sa) == 0) {
1968                                         return;
1969                                 }
1970                         }
1971                         if (stcb->asoc.scope.site_scope == 0 &&
1972                             IN6_IS_ADDR_SITELOCAL(&sin6->sin6_addr)) {
1973                                 return;
1974                         }
1975                         break;
1976                 }
1977 #endif
1978 #ifdef INET
1979         case AF_INET:
1980                 {
1981                         struct sockaddr_in *sin;
1982                         struct in6pcb *inp6;
1983
1984                         inp6 = (struct in6pcb *)&inp->ip_inp.inp;
1985                         /* invalid if we are a v6 only endpoint */
1986                         if ((inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) &&
1987                             SCTP_IPV6_V6ONLY(inp6))
1988                                 return;
1989
1990                         sin = &ifa->address.sin;
1991                         if (sin->sin_addr.s_addr == 0) {
1992                                 /* we skip unspecifed addresses */
1993                                 return;
1994                         }
1995                         if (stcb->asoc.scope.ipv4_local_scope == 0 &&
1996                             IN4_ISPRIVATE_ADDRESS(&sin->sin_addr)) {
1997                                 return;
1998                         }
1999                         break;
2000                 }
2001 #endif
2002         default:
2003                 /* else, not AF_INET or AF_INET6, so skip */
2004                 return;
2005         }
2006
2007         /* queue an asconf for this address add/delete */
2008         if (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_DO_ASCONF)) {
2009                 /* does the peer do asconf? */
2010                 if (stcb->asoc.asconf_supported) {
2011                         /* queue an asconf for this addr */
2012                         status = sctp_asconf_queue_add(stcb, ifa, type);
2013
2014                         /*
2015                          * if queued ok, and in the open state, send out the
2016                          * ASCONF.  If in the non-open state, these will be
2017                          * sent when the state goes open.
2018                          */
2019                         if (status == 0 &&
2020                             ((SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) ||
2021                             (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED))) {
2022 #ifdef SCTP_TIMER_BASED_ASCONF
2023                                 sctp_timer_start(SCTP_TIMER_TYPE_ASCONF, inp,
2024                                     stcb, stcb->asoc.primary_destination);
2025 #else
2026                                 sctp_send_asconf(stcb, NULL, addr_locked);
2027 #endif
2028                         }
2029                 }
2030         }
2031 }
2032
2033
2034 int
2035 sctp_asconf_iterator_ep(struct sctp_inpcb *inp, void *ptr, uint32_t val SCTP_UNUSED)
2036 {
2037         struct sctp_asconf_iterator *asc;
2038         struct sctp_ifa *ifa;
2039         struct sctp_laddr *l;
2040         int cnt_invalid = 0;
2041
2042         asc = (struct sctp_asconf_iterator *)ptr;
2043         LIST_FOREACH(l, &asc->list_of_work, sctp_nxt_addr) {
2044                 ifa = l->ifa;
2045                 switch (ifa->address.sa.sa_family) {
2046 #ifdef INET6
2047                 case AF_INET6:
2048                         /* invalid if we're not a v6 endpoint */
2049                         if ((inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) == 0) {
2050                                 cnt_invalid++;
2051                                 if (asc->cnt == cnt_invalid)
2052                                         return (1);
2053                         }
2054                         break;
2055 #endif
2056 #ifdef INET
2057                 case AF_INET:
2058                         {
2059                                 /* invalid if we are a v6 only endpoint */
2060                                 struct in6pcb *inp6;
2061
2062                                 inp6 = (struct in6pcb *)&inp->ip_inp.inp;
2063                                 if ((inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) &&
2064                                     SCTP_IPV6_V6ONLY(inp6)) {
2065                                         cnt_invalid++;
2066                                         if (asc->cnt == cnt_invalid)
2067                                                 return (1);
2068                                 }
2069                                 break;
2070                         }
2071 #endif
2072                 default:
2073                         /* invalid address family */
2074                         cnt_invalid++;
2075                         if (asc->cnt == cnt_invalid)
2076                                 return (1);
2077                 }
2078         }
2079         return (0);
2080 }
2081
2082 static int
2083 sctp_asconf_iterator_ep_end(struct sctp_inpcb *inp, void *ptr, uint32_t val SCTP_UNUSED)
2084 {
2085         struct sctp_ifa *ifa;
2086         struct sctp_asconf_iterator *asc;
2087         struct sctp_laddr *laddr, *nladdr, *l;
2088
2089         /* Only for specific case not bound all */
2090         asc = (struct sctp_asconf_iterator *)ptr;
2091         LIST_FOREACH(l, &asc->list_of_work, sctp_nxt_addr) {
2092                 ifa = l->ifa;
2093                 if (l->action == SCTP_ADD_IP_ADDRESS) {
2094                         LIST_FOREACH(laddr, &inp->sctp_addr_list,
2095                             sctp_nxt_addr) {
2096                                 if (laddr->ifa == ifa) {
2097                                         laddr->action = 0;
2098                                         break;
2099                                 }
2100
2101                         }
2102                 } else if (l->action == SCTP_DEL_IP_ADDRESS) {
2103                         LIST_FOREACH_SAFE(laddr, &inp->sctp_addr_list, sctp_nxt_addr, nladdr) {
2104                                 /* remove only after all guys are done */
2105                                 if (laddr->ifa == ifa) {
2106                                         sctp_del_local_addr_ep(inp, ifa);
2107                                 }
2108                         }
2109                 }
2110         }
2111         return (0);
2112 }
2113
2114 void
2115 sctp_asconf_iterator_stcb(struct sctp_inpcb *inp, struct sctp_tcb *stcb,
2116     void *ptr, uint32_t val SCTP_UNUSED)
2117 {
2118         struct sctp_asconf_iterator *asc;
2119         struct sctp_ifa *ifa;
2120         struct sctp_laddr *l;
2121         int cnt_invalid = 0;
2122         int type, status;
2123         int num_queued = 0;
2124
2125         asc = (struct sctp_asconf_iterator *)ptr;
2126         LIST_FOREACH(l, &asc->list_of_work, sctp_nxt_addr) {
2127                 ifa = l->ifa;
2128                 type = l->action;
2129
2130                 /* address's vrf_id must be the vrf_id of the assoc */
2131                 if (ifa->vrf_id != stcb->asoc.vrf_id) {
2132                         continue;
2133                 }
2134
2135                 /* Same checks again for assoc */
2136                 switch (ifa->address.sa.sa_family) {
2137 #ifdef INET6
2138                 case AF_INET6:
2139                         {
2140                                 /* invalid if we're not a v6 endpoint */
2141                                 struct sockaddr_in6 *sin6;
2142
2143                                 if ((inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) == 0) {
2144                                         cnt_invalid++;
2145                                         if (asc->cnt == cnt_invalid)
2146                                                 return;
2147                                         else
2148                                                 continue;
2149                                 }
2150                                 sin6 = &ifa->address.sin6;
2151                                 if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr)) {
2152                                         /* we skip unspecifed addresses */
2153                                         continue;
2154                                 }
2155                                 if (prison_check_ip6(inp->ip_inp.inp.inp_cred,
2156                                     &sin6->sin6_addr) != 0) {
2157                                         continue;
2158                                 }
2159                                 if (IN6_IS_ADDR_LINKLOCAL(&sin6->sin6_addr)) {
2160                                         if (stcb->asoc.scope.local_scope == 0) {
2161                                                 continue;
2162                                         }
2163                                         /* is it the right link local scope? */
2164                                         if (sctp_is_scopeid_in_nets(stcb, &ifa->address.sa) == 0) {
2165                                                 continue;
2166                                         }
2167                                 }
2168                                 break;
2169                         }
2170 #endif
2171 #ifdef INET
2172                 case AF_INET:
2173                         {
2174                                 /* invalid if we are a v6 only endpoint */
2175                                 struct in6pcb *inp6;
2176                                 struct sockaddr_in *sin;
2177
2178                                 inp6 = (struct in6pcb *)&inp->ip_inp.inp;
2179                                 /* invalid if we are a v6 only endpoint */
2180                                 if ((inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) &&
2181                                     SCTP_IPV6_V6ONLY(inp6))
2182                                         continue;
2183
2184                                 sin = &ifa->address.sin;
2185                                 if (sin->sin_addr.s_addr == 0) {
2186                                         /* we skip unspecifed addresses */
2187                                         continue;
2188                                 }
2189                                 if (prison_check_ip4(inp->ip_inp.inp.inp_cred,
2190                                     &sin->sin_addr) != 0) {
2191                                         continue;
2192                                 }
2193                                 if (stcb->asoc.scope.ipv4_local_scope == 0 &&
2194                                     IN4_ISPRIVATE_ADDRESS(&sin->sin_addr)) {
2195                                         continue;
2196                                 }
2197                                 if ((inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) &&
2198                                     SCTP_IPV6_V6ONLY(inp6)) {
2199                                         cnt_invalid++;
2200                                         if (asc->cnt == cnt_invalid)
2201                                                 return;
2202                                         else
2203                                                 continue;
2204                                 }
2205                                 break;
2206                         }
2207 #endif
2208                 default:
2209                         /* invalid address family */
2210                         cnt_invalid++;
2211                         if (asc->cnt == cnt_invalid)
2212                                 return;
2213                         else
2214                                 continue;
2215                         break;
2216                 }
2217
2218                 if (type == SCTP_ADD_IP_ADDRESS) {
2219                         /* prevent this address from being used as a source */
2220                         sctp_add_local_addr_restricted(stcb, ifa);
2221                 } else if (type == SCTP_DEL_IP_ADDRESS) {
2222                         struct sctp_nets *net;
2223
2224                         TAILQ_FOREACH(net, &stcb->asoc.nets, sctp_next) {
2225                                 sctp_rtentry_t *rt;
2226
2227                                 /* delete this address if cached */
2228                                 if (net->ro._s_addr == ifa) {
2229                                         sctp_free_ifa(net->ro._s_addr);
2230                                         net->ro._s_addr = NULL;
2231                                         net->src_addr_selected = 0;
2232                                         rt = net->ro.ro_rt;
2233                                         if (rt) {
2234                                                 RTFREE(rt);
2235                                                 net->ro.ro_rt = NULL;
2236                                         }
2237                                         /*
2238                                          * Now we deleted our src address,
2239                                          * should we not also now reset the
2240                                          * cwnd/rto to start as if its a new
2241                                          * address?
2242                                          */
2243                                         stcb->asoc.cc_functions.sctp_set_initial_cc_param(stcb, net);
2244                                         net->RTO = 0;
2245
2246                                 }
2247                         }
2248                 } else if (type == SCTP_SET_PRIM_ADDR) {
2249                         if ((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_BOUNDALL) == 0) {
2250                                 /* must validate the ifa is in the ep */
2251                                 if (sctp_is_addr_in_ep(stcb->sctp_ep, ifa) == 0) {
2252                                         continue;
2253                                 }
2254                         } else {
2255                                 /* Need to check scopes for this guy */
2256                                 if (sctp_is_address_in_scope(ifa, &stcb->asoc.scope, 0) == 0) {
2257                                         continue;
2258                                 }
2259                         }
2260                 }
2261                 /* queue an asconf for this address add/delete */
2262                 if (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_DO_ASCONF) &&
2263                     stcb->asoc.asconf_supported == 1) {
2264                         /* queue an asconf for this addr */
2265                         status = sctp_asconf_queue_add(stcb, ifa, type);
2266                         /*
2267                          * if queued ok, and in the open state, update the
2268                          * count of queued params.  If in the non-open
2269                          * state, these get sent when the assoc goes open.
2270                          */
2271                         if ((SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) ||
2272                             (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED)) {
2273                                 if (status >= 0) {
2274                                         num_queued++;
2275                                 }
2276                         }
2277                 }
2278         }
2279         /*
2280          * If we have queued params in the open state, send out an ASCONF.
2281          */
2282         if (num_queued > 0) {
2283                 sctp_send_asconf(stcb, NULL, SCTP_ADDR_NOT_LOCKED);
2284         }
2285 }
2286
2287 void
2288 sctp_asconf_iterator_end(void *ptr, uint32_t val SCTP_UNUSED)
2289 {
2290         struct sctp_asconf_iterator *asc;
2291         struct sctp_ifa *ifa;
2292         struct sctp_laddr *l, *nl;
2293
2294         asc = (struct sctp_asconf_iterator *)ptr;
2295         LIST_FOREACH_SAFE(l, &asc->list_of_work, sctp_nxt_addr, nl) {
2296                 ifa = l->ifa;
2297                 if (l->action == SCTP_ADD_IP_ADDRESS) {
2298                         /* Clear the defer use flag */
2299                         ifa->localifa_flags &= ~SCTP_ADDR_DEFER_USE;
2300                 }
2301                 sctp_free_ifa(ifa);
2302                 SCTP_ZONE_FREE(SCTP_BASE_INFO(ipi_zone_laddr), l);
2303                 SCTP_DECR_LADDR_COUNT();
2304         }
2305         SCTP_FREE(asc, SCTP_M_ASC_IT);
2306 }
2307
2308 /*
2309  * sa is the sockaddr to ask the peer to set primary to.
2310  * returns: 0 = completed, -1 = error
2311  */
2312 int32_t
2313 sctp_set_primary_ip_address_sa(struct sctp_tcb *stcb, struct sockaddr *sa)
2314 {
2315         uint32_t vrf_id;
2316         struct sctp_ifa *ifa;
2317
2318         /* find the ifa for the desired set primary */
2319         vrf_id = stcb->asoc.vrf_id;
2320         ifa = sctp_find_ifa_by_addr(sa, vrf_id, SCTP_ADDR_NOT_LOCKED);
2321         if (ifa == NULL) {
2322                 /* Invalid address */
2323                 return (-1);
2324         }
2325
2326         /* queue an ASCONF:SET_PRIM_ADDR to be sent */
2327         if (!sctp_asconf_queue_add(stcb, ifa, SCTP_SET_PRIM_ADDR)) {
2328                 /* set primary queuing succeeded */
2329                 SCTPDBG(SCTP_DEBUG_ASCONF1,
2330                     "set_primary_ip_address_sa: queued on tcb=%p, ",
2331                     (void *)stcb);
2332                 SCTPDBG_ADDR(SCTP_DEBUG_ASCONF1, sa);
2333                 if ((SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) ||
2334                     (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED)) {
2335 #ifdef SCTP_TIMER_BASED_ASCONF
2336                         sctp_timer_start(SCTP_TIMER_TYPE_ASCONF,
2337                             stcb->sctp_ep, stcb,
2338                             stcb->asoc.primary_destination);
2339 #else
2340                         sctp_send_asconf(stcb, NULL, SCTP_ADDR_NOT_LOCKED);
2341 #endif
2342                 }
2343         } else {
2344                 SCTPDBG(SCTP_DEBUG_ASCONF1, "set_primary_ip_address_sa: failed to add to queue on tcb=%p, ",
2345                     (void *)stcb);
2346                 SCTPDBG_ADDR(SCTP_DEBUG_ASCONF1, sa);
2347                 return (-1);
2348         }
2349         return (0);
2350 }
2351
2352 int
2353 sctp_is_addr_pending(struct sctp_tcb *stcb, struct sctp_ifa *sctp_ifa)
2354 {
2355         struct sctp_tmit_chunk *chk, *nchk;
2356         unsigned int offset, asconf_limit;
2357         struct sctp_asconf_chunk *acp;
2358         struct sctp_asconf_paramhdr *aph;
2359         uint8_t aparam_buf[SCTP_PARAM_BUFFER_SIZE];
2360         struct sctp_paramhdr *ph;
2361         int add_cnt, del_cnt;
2362         uint16_t last_param_type;
2363
2364         add_cnt = del_cnt = 0;
2365         last_param_type = 0;
2366         TAILQ_FOREACH_SAFE(chk, &stcb->asoc.asconf_send_queue, sctp_next, nchk) {
2367                 if (chk->data == NULL) {
2368                         SCTPDBG(SCTP_DEBUG_ASCONF1, "is_addr_pending: No mbuf data?\n");
2369                         continue;
2370                 }
2371                 offset = 0;
2372                 acp = mtod(chk->data, struct sctp_asconf_chunk *);
2373                 offset += sizeof(struct sctp_asconf_chunk);
2374                 asconf_limit = ntohs(acp->ch.chunk_length);
2375                 ph = (struct sctp_paramhdr *)sctp_m_getptr(chk->data, offset, sizeof(struct sctp_paramhdr), aparam_buf);
2376                 if (ph == NULL) {
2377                         SCTPDBG(SCTP_DEBUG_ASCONF1, "is_addr_pending: couldn't get lookup addr!\n");
2378                         continue;
2379                 }
2380                 offset += ntohs(ph->param_length);
2381
2382                 aph = (struct sctp_asconf_paramhdr *)sctp_m_getptr(chk->data, offset, sizeof(struct sctp_asconf_paramhdr), aparam_buf);
2383                 if (aph == NULL) {
2384                         SCTPDBG(SCTP_DEBUG_ASCONF1, "is_addr_pending: Empty ASCONF will be sent?\n");
2385                         continue;
2386                 }
2387                 while (aph != NULL) {
2388                         unsigned int param_length, param_type;
2389
2390                         param_type = ntohs(aph->ph.param_type);
2391                         param_length = ntohs(aph->ph.param_length);
2392                         if (offset + param_length > asconf_limit) {
2393                                 /* parameter goes beyond end of chunk! */
2394                                 break;
2395                         }
2396                         if (param_length > sizeof(aparam_buf)) {
2397                                 SCTPDBG(SCTP_DEBUG_ASCONF1, "is_addr_pending: param length (%u) larger than buffer size!\n", param_length);
2398                                 break;
2399                         }
2400                         if (param_length <= sizeof(struct sctp_paramhdr)) {
2401                                 SCTPDBG(SCTP_DEBUG_ASCONF1, "is_addr_pending: param length(%u) too short\n", param_length);
2402                                 break;
2403                         }
2404
2405                         aph = (struct sctp_asconf_paramhdr *)sctp_m_getptr(chk->data, offset, param_length, aparam_buf);
2406                         if (aph == NULL) {
2407                                 SCTPDBG(SCTP_DEBUG_ASCONF1, "is_addr_pending: couldn't get entire param\n");
2408                                 break;
2409                         }
2410
2411                         ph = (struct sctp_paramhdr *)(aph + 1);
2412                         if (sctp_addr_match(ph, &sctp_ifa->address.sa) != 0) {
2413                                 switch (param_type) {
2414                                 case SCTP_ADD_IP_ADDRESS:
2415                                         add_cnt++;
2416                                         break;
2417                                 case SCTP_DEL_IP_ADDRESS:
2418                                         del_cnt++;
2419                                         break;
2420                                 default:
2421                                         break;
2422                                 }
2423                                 last_param_type = param_type;
2424                         }
2425
2426                         offset += SCTP_SIZE32(param_length);
2427                         if (offset >= asconf_limit) {
2428                                 /* no more data in the mbuf chain */
2429                                 break;
2430                         }
2431                         /* get pointer to next asconf param */
2432                         aph = (struct sctp_asconf_paramhdr *)sctp_m_getptr(chk->data, offset, sizeof(struct sctp_asconf_paramhdr), aparam_buf);
2433                 }
2434         }
2435
2436         /*
2437          * we want to find the sequences which consist of ADD -> DEL -> ADD
2438          * or DEL -> ADD
2439          */
2440         if (add_cnt > del_cnt ||
2441             (add_cnt == del_cnt && last_param_type == SCTP_ADD_IP_ADDRESS)) {
2442                 return (1);
2443         }
2444         return (0);
2445 }
2446
2447 static struct sockaddr *
2448 sctp_find_valid_localaddr(struct sctp_tcb *stcb, int addr_locked)
2449 {
2450         struct sctp_vrf *vrf = NULL;
2451         struct sctp_ifn *sctp_ifn;
2452         struct sctp_ifa *sctp_ifa;
2453
2454         if (addr_locked == SCTP_ADDR_NOT_LOCKED)
2455                 SCTP_IPI_ADDR_RLOCK();
2456         vrf = sctp_find_vrf(stcb->asoc.vrf_id);
2457         if (vrf == NULL) {
2458                 if (addr_locked == SCTP_ADDR_NOT_LOCKED)
2459                         SCTP_IPI_ADDR_RUNLOCK();
2460                 return (NULL);
2461         }
2462         LIST_FOREACH(sctp_ifn, &vrf->ifnlist, next_ifn) {
2463                 if (stcb->asoc.scope.loopback_scope == 0 &&
2464                     SCTP_IFN_IS_IFT_LOOP(sctp_ifn)) {
2465                         /* Skip if loopback_scope not set */
2466                         continue;
2467                 }
2468                 LIST_FOREACH(sctp_ifa, &sctp_ifn->ifalist, next_ifa) {
2469                         switch (sctp_ifa->address.sa.sa_family) {
2470 #ifdef INET
2471                         case AF_INET:
2472                                 if (stcb->asoc.scope.ipv4_addr_legal) {
2473                                         struct sockaddr_in *sin;
2474
2475                                         sin = &sctp_ifa->address.sin;
2476                                         if (sin->sin_addr.s_addr == 0) {
2477                                                 /* skip unspecifed addresses */
2478                                                 continue;
2479                                         }
2480                                         if (prison_check_ip4(stcb->sctp_ep->ip_inp.inp.inp_cred,
2481                                             &sin->sin_addr) != 0) {
2482                                                 continue;
2483                                         }
2484                                         if (stcb->asoc.scope.ipv4_local_scope == 0 &&
2485                                             IN4_ISPRIVATE_ADDRESS(&sin->sin_addr))
2486                                                 continue;
2487
2488                                         if (sctp_is_addr_restricted(stcb, sctp_ifa) &&
2489                                             (!sctp_is_addr_pending(stcb, sctp_ifa)))
2490                                                 continue;
2491                                         /*
2492                                          * found a valid local v4 address to
2493                                          * use
2494                                          */
2495                                         if (addr_locked == SCTP_ADDR_NOT_LOCKED)
2496                                                 SCTP_IPI_ADDR_RUNLOCK();
2497                                         return (&sctp_ifa->address.sa);
2498                                 }
2499                                 break;
2500 #endif
2501 #ifdef INET6
2502                         case AF_INET6:
2503                                 if (stcb->asoc.scope.ipv6_addr_legal) {
2504                                         struct sockaddr_in6 *sin6;
2505
2506                                         if (sctp_ifa->localifa_flags & SCTP_ADDR_IFA_UNUSEABLE) {
2507                                                 continue;
2508                                         }
2509
2510                                         sin6 = &sctp_ifa->address.sin6;
2511                                         if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr)) {
2512                                                 /*
2513                                                  * we skip unspecifed
2514                                                  * addresses
2515                                                  */
2516                                                 continue;
2517                                         }
2518                                         if (prison_check_ip6(stcb->sctp_ep->ip_inp.inp.inp_cred,
2519                                             &sin6->sin6_addr) != 0) {
2520                                                 continue;
2521                                         }
2522                                         if (stcb->asoc.scope.local_scope == 0 &&
2523                                             IN6_IS_ADDR_LINKLOCAL(&sin6->sin6_addr))
2524                                                 continue;
2525                                         if (stcb->asoc.scope.site_scope == 0 &&
2526                                             IN6_IS_ADDR_SITELOCAL(&sin6->sin6_addr))
2527                                                 continue;
2528
2529                                         if (sctp_is_addr_restricted(stcb, sctp_ifa) &&
2530                                             (!sctp_is_addr_pending(stcb, sctp_ifa)))
2531                                                 continue;
2532                                         /*
2533                                          * found a valid local v6 address to
2534                                          * use
2535                                          */
2536                                         if (addr_locked == SCTP_ADDR_NOT_LOCKED)
2537                                                 SCTP_IPI_ADDR_RUNLOCK();
2538                                         return (&sctp_ifa->address.sa);
2539                                 }
2540                                 break;
2541 #endif
2542                         default:
2543                                 break;
2544                         }
2545                 }
2546         }
2547         /* no valid addresses found */
2548         if (addr_locked == SCTP_ADDR_NOT_LOCKED)
2549                 SCTP_IPI_ADDR_RUNLOCK();
2550         return (NULL);
2551 }
2552
2553 static struct sockaddr *
2554 sctp_find_valid_localaddr_ep(struct sctp_tcb *stcb)
2555 {
2556         struct sctp_laddr *laddr;
2557
2558         LIST_FOREACH(laddr, &stcb->sctp_ep->sctp_addr_list, sctp_nxt_addr) {
2559                 if (laddr->ifa == NULL) {
2560                         continue;
2561                 }
2562                 /* is the address restricted ? */
2563                 if (sctp_is_addr_restricted(stcb, laddr->ifa) &&
2564                     (!sctp_is_addr_pending(stcb, laddr->ifa)))
2565                         continue;
2566
2567                 /* found a valid local address to use */
2568                 return (&laddr->ifa->address.sa);
2569         }
2570         /* no valid addresses found */
2571         return (NULL);
2572 }
2573
2574 /*
2575  * builds an ASCONF chunk from queued ASCONF params.
2576  * returns NULL on error (no mbuf, no ASCONF params queued, etc).
2577  */
2578 struct mbuf *
2579 sctp_compose_asconf(struct sctp_tcb *stcb, int *retlen, int addr_locked)
2580 {
2581         struct mbuf *m_asconf, *m_asconf_chk;
2582         struct sctp_asconf_addr *aa;
2583         struct sctp_asconf_chunk *acp;
2584         struct sctp_asconf_paramhdr *aph;
2585         struct sctp_asconf_addr_param *aap;
2586         uint32_t p_length;
2587         uint32_t correlation_id = 1;    /* 0 is reserved... */
2588         caddr_t ptr, lookup_ptr;
2589         uint8_t lookup_used = 0;
2590
2591         /* are there any asconf params to send? */
2592         TAILQ_FOREACH(aa, &stcb->asoc.asconf_queue, next) {
2593                 if (aa->sent == 0)
2594                         break;
2595         }
2596         if (aa == NULL)
2597                 return (NULL);
2598
2599         /*
2600          * get a chunk header mbuf and a cluster for the asconf params since
2601          * it's simpler to fill in the asconf chunk header lookup address on
2602          * the fly
2603          */
2604         m_asconf_chk = sctp_get_mbuf_for_msg(sizeof(struct sctp_asconf_chunk), 0, M_NOWAIT, 1, MT_DATA);
2605         if (m_asconf_chk == NULL) {
2606                 /* no mbuf's */
2607                 SCTPDBG(SCTP_DEBUG_ASCONF1,
2608                     "compose_asconf: couldn't get chunk mbuf!\n");
2609                 return (NULL);
2610         }
2611         m_asconf = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
2612         if (m_asconf == NULL) {
2613                 /* no mbuf's */
2614                 SCTPDBG(SCTP_DEBUG_ASCONF1,
2615                     "compose_asconf: couldn't get mbuf!\n");
2616                 sctp_m_freem(m_asconf_chk);
2617                 return (NULL);
2618         }
2619         SCTP_BUF_LEN(m_asconf_chk) = sizeof(struct sctp_asconf_chunk);
2620         SCTP_BUF_LEN(m_asconf) = 0;
2621         acp = mtod(m_asconf_chk, struct sctp_asconf_chunk *);
2622         memset(acp, 0, sizeof(struct sctp_asconf_chunk));
2623         /* save pointers to lookup address and asconf params */
2624         lookup_ptr = (caddr_t)(acp + 1);        /* after the header */
2625         ptr = mtod(m_asconf, caddr_t);  /* beginning of cluster */
2626
2627         /* fill in chunk header info */
2628         acp->ch.chunk_type = SCTP_ASCONF;
2629         acp->ch.chunk_flags = 0;
2630         acp->serial_number = htonl(stcb->asoc.asconf_seq_out);
2631         stcb->asoc.asconf_seq_out++;
2632
2633         /* add parameters... up to smallest MTU allowed */
2634         TAILQ_FOREACH(aa, &stcb->asoc.asconf_queue, next) {
2635                 if (aa->sent)
2636                         continue;
2637                 /* get the parameter length */
2638                 p_length = SCTP_SIZE32(aa->ap.aph.ph.param_length);
2639                 /* will it fit in current chunk? */
2640                 if ((SCTP_BUF_LEN(m_asconf) + p_length > stcb->asoc.smallest_mtu) ||
2641                     (SCTP_BUF_LEN(m_asconf) + p_length > MCLBYTES)) {
2642                         /* won't fit, so we're done with this chunk */
2643                         break;
2644                 }
2645                 /* assign (and store) a correlation id */
2646                 aa->ap.aph.correlation_id = correlation_id++;
2647
2648                 /*
2649                  * fill in address if we're doing a delete this is a simple
2650                  * way for us to fill in the correlation address, which
2651                  * should only be used by the peer if we're deleting our
2652                  * source address and adding a new address (e.g. renumbering
2653                  * case)
2654                  */
2655                 if (lookup_used == 0 &&
2656                     (aa->special_del == 0) &&
2657                     aa->ap.aph.ph.param_type == SCTP_DEL_IP_ADDRESS) {
2658                         struct sctp_ipv6addr_param *lookup;
2659                         uint16_t p_size, addr_size;
2660
2661                         lookup = (struct sctp_ipv6addr_param *)lookup_ptr;
2662                         lookup->ph.param_type =
2663                             htons(aa->ap.addrp.ph.param_type);
2664                         if (aa->ap.addrp.ph.param_type == SCTP_IPV6_ADDRESS) {
2665                                 /* copy IPv6 address */
2666                                 p_size = sizeof(struct sctp_ipv6addr_param);
2667                                 addr_size = sizeof(struct in6_addr);
2668                         } else {
2669                                 /* copy IPv4 address */
2670                                 p_size = sizeof(struct sctp_ipv4addr_param);
2671                                 addr_size = sizeof(struct in_addr);
2672                         }
2673                         lookup->ph.param_length = htons(SCTP_SIZE32(p_size));
2674                         memcpy(lookup->addr, &aa->ap.addrp.addr, addr_size);
2675                         SCTP_BUF_LEN(m_asconf_chk) += SCTP_SIZE32(p_size);
2676                         lookup_used = 1;
2677                 }
2678                 /* copy into current space */
2679                 memcpy(ptr, &aa->ap, p_length);
2680
2681                 /* network elements and update lengths */
2682                 aph = (struct sctp_asconf_paramhdr *)ptr;
2683                 aap = (struct sctp_asconf_addr_param *)ptr;
2684                 /* correlation_id is transparent to peer, no htonl needed */
2685                 aph->ph.param_type = htons(aph->ph.param_type);
2686                 aph->ph.param_length = htons(aph->ph.param_length);
2687                 aap->addrp.ph.param_type = htons(aap->addrp.ph.param_type);
2688                 aap->addrp.ph.param_length = htons(aap->addrp.ph.param_length);
2689
2690                 SCTP_BUF_LEN(m_asconf) += SCTP_SIZE32(p_length);
2691                 ptr += SCTP_SIZE32(p_length);
2692
2693                 /*
2694                  * these params are removed off the pending list upon
2695                  * getting an ASCONF-ACK back from the peer, just set flag
2696                  */
2697                 aa->sent = 1;
2698         }
2699         /* check to see if the lookup addr has been populated yet */
2700         if (lookup_used == 0) {
2701                 /* NOTE: if the address param is optional, can skip this... */
2702                 /* add any valid (existing) address... */
2703                 struct sctp_ipv6addr_param *lookup;
2704                 uint16_t p_size, addr_size;
2705                 struct sockaddr *found_addr;
2706                 caddr_t addr_ptr;
2707
2708                 if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_BOUNDALL)
2709                         found_addr = sctp_find_valid_localaddr(stcb,
2710                             addr_locked);
2711                 else
2712                         found_addr = sctp_find_valid_localaddr_ep(stcb);
2713
2714                 lookup = (struct sctp_ipv6addr_param *)lookup_ptr;
2715                 if (found_addr != NULL) {
2716                         switch (found_addr->sa_family) {
2717 #ifdef INET6
2718                         case AF_INET6:
2719                                 /* copy IPv6 address */
2720                                 lookup->ph.param_type =
2721                                     htons(SCTP_IPV6_ADDRESS);
2722                                 p_size = sizeof(struct sctp_ipv6addr_param);
2723                                 addr_size = sizeof(struct in6_addr);
2724                                 addr_ptr = (caddr_t)&((struct sockaddr_in6 *)
2725                                     found_addr)->sin6_addr;
2726                                 break;
2727 #endif
2728 #ifdef INET
2729                         case AF_INET:
2730                                 /* copy IPv4 address */
2731                                 lookup->ph.param_type =
2732                                     htons(SCTP_IPV4_ADDRESS);
2733                                 p_size = sizeof(struct sctp_ipv4addr_param);
2734                                 addr_size = sizeof(struct in_addr);
2735                                 addr_ptr = (caddr_t)&((struct sockaddr_in *)
2736                                     found_addr)->sin_addr;
2737                                 break;
2738 #endif
2739                         default:
2740                                 p_size = 0;
2741                                 addr_size = 0;
2742                                 addr_ptr = NULL;
2743                                 break;
2744                         }
2745                         lookup->ph.param_length = htons(SCTP_SIZE32(p_size));
2746                         memcpy(lookup->addr, addr_ptr, addr_size);
2747                         SCTP_BUF_LEN(m_asconf_chk) += SCTP_SIZE32(p_size);
2748                 } else {
2749                         /* uh oh... don't have any address?? */
2750                         SCTPDBG(SCTP_DEBUG_ASCONF1,
2751                             "compose_asconf: no lookup addr!\n");
2752                         /* XXX for now, we send a IPv4 address of 0.0.0.0 */
2753                         lookup->ph.param_type = htons(SCTP_IPV4_ADDRESS);
2754                         lookup->ph.param_length = htons(SCTP_SIZE32(sizeof(struct sctp_ipv4addr_param)));
2755                         memset(lookup->addr, 0, sizeof(struct in_addr));
2756                         SCTP_BUF_LEN(m_asconf_chk) += SCTP_SIZE32(sizeof(struct sctp_ipv4addr_param));
2757                 }
2758         }
2759         /* chain it all together */
2760         SCTP_BUF_NEXT(m_asconf_chk) = m_asconf;
2761         *retlen = SCTP_BUF_LEN(m_asconf_chk) + SCTP_BUF_LEN(m_asconf);
2762         acp->ch.chunk_length = htons(*retlen);
2763
2764         return (m_asconf_chk);
2765 }
2766
2767 /*
2768  * section to handle address changes before an association is up eg. changes
2769  * during INIT/INIT-ACK/COOKIE-ECHO handshake
2770  */
2771
2772 /*
2773  * processes the (local) addresses in the INIT-ACK chunk
2774  */
2775 static void
2776 sctp_process_initack_addresses(struct sctp_tcb *stcb, struct mbuf *m,
2777     unsigned int offset, unsigned int length)
2778 {
2779         struct sctp_paramhdr tmp_param, *ph;
2780         uint16_t plen, ptype;
2781         struct sctp_ifa *sctp_ifa;
2782         union sctp_sockstore store;
2783 #ifdef INET6
2784         struct sctp_ipv6addr_param addr6_store;
2785 #endif
2786 #ifdef INET
2787         struct sctp_ipv4addr_param addr4_store;
2788 #endif
2789
2790         SCTPDBG(SCTP_DEBUG_ASCONF2, "processing init-ack addresses\n");
2791         if (stcb == NULL)       /* Un-needed check for SA */
2792                 return;
2793
2794         /* convert to upper bound */
2795         length += offset;
2796
2797         if ((offset + sizeof(struct sctp_paramhdr)) > length) {
2798                 return;
2799         }
2800         /* go through the addresses in the init-ack */
2801         ph = (struct sctp_paramhdr *)
2802             sctp_m_getptr(m, offset, sizeof(struct sctp_paramhdr),
2803             (uint8_t *)&tmp_param);
2804         while (ph != NULL) {
2805                 ptype = ntohs(ph->param_type);
2806                 plen = ntohs(ph->param_length);
2807                 switch (ptype) {
2808 #ifdef INET6
2809                 case SCTP_IPV6_ADDRESS:
2810                         {
2811                                 struct sctp_ipv6addr_param *a6p;
2812
2813                                 /* get the entire IPv6 address param */
2814                                 a6p = (struct sctp_ipv6addr_param *)
2815                                     sctp_m_getptr(m, offset,
2816                                     sizeof(struct sctp_ipv6addr_param),
2817                                     (uint8_t *)&addr6_store);
2818                                 if (plen != sizeof(struct sctp_ipv6addr_param) ||
2819                                     a6p == NULL) {
2820                                         return;
2821                                 }
2822                                 memset(&store, 0, sizeof(union sctp_sockstore));
2823                                 store.sin6.sin6_family = AF_INET6;
2824                                 store.sin6.sin6_len = sizeof(struct sockaddr_in6);
2825                                 store.sin6.sin6_port = stcb->rport;
2826                                 memcpy(&store.sin6.sin6_addr, a6p->addr, sizeof(struct in6_addr));
2827                                 break;
2828                         }
2829 #endif
2830 #ifdef INET
2831                 case SCTP_IPV4_ADDRESS:
2832                         {
2833                                 struct sctp_ipv4addr_param *a4p;
2834
2835                                 /* get the entire IPv4 address param */
2836                                 a4p = (struct sctp_ipv4addr_param *)sctp_m_getptr(m, offset,
2837                                     sizeof(struct sctp_ipv4addr_param),
2838                                     (uint8_t *)&addr4_store);
2839                                 if (plen != sizeof(struct sctp_ipv4addr_param) ||
2840                                     a4p == NULL) {
2841                                         return;
2842                                 }
2843                                 memset(&store, 0, sizeof(union sctp_sockstore));
2844                                 store.sin.sin_family = AF_INET;
2845                                 store.sin.sin_len = sizeof(struct sockaddr_in);
2846                                 store.sin.sin_port = stcb->rport;
2847                                 store.sin.sin_addr.s_addr = a4p->addr;
2848                                 break;
2849                         }
2850 #endif
2851                 default:
2852                         goto next_addr;
2853                 }
2854
2855                 /* see if this address really (still) exists */
2856                 sctp_ifa = sctp_find_ifa_by_addr(&store.sa, stcb->asoc.vrf_id,
2857                     SCTP_ADDR_NOT_LOCKED);
2858                 if (sctp_ifa == NULL) {
2859                         /* address doesn't exist anymore */
2860                         int status;
2861
2862                         /* are ASCONFs allowed ? */
2863                         if ((sctp_is_feature_on(stcb->sctp_ep,
2864                             SCTP_PCB_FLAGS_DO_ASCONF)) &&
2865                             stcb->asoc.asconf_supported) {
2866                                 /* queue an ASCONF DEL_IP_ADDRESS */
2867                                 status = sctp_asconf_queue_sa_delete(stcb, &store.sa);
2868                                 /*
2869                                  * if queued ok, and in correct state, send
2870                                  * out the ASCONF.
2871                                  */
2872                                 if (status == 0 &&
2873                                     SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) {
2874 #ifdef SCTP_TIMER_BASED_ASCONF
2875                                         sctp_timer_start(SCTP_TIMER_TYPE_ASCONF,
2876                                             stcb->sctp_ep, stcb,
2877                                             stcb->asoc.primary_destination);
2878 #else
2879                                         sctp_send_asconf(stcb, NULL, SCTP_ADDR_NOT_LOCKED);
2880 #endif
2881                                 }
2882                         }
2883                 }
2884
2885 next_addr:
2886                 /*
2887                  * Sanity check:  Make sure the length isn't 0, otherwise
2888                  * we'll be stuck in this loop for a long time...
2889                  */
2890                 if (SCTP_SIZE32(plen) == 0) {
2891                         SCTP_PRINTF("process_initack_addrs: bad len (%d) type=%xh\n",
2892                             plen, ptype);
2893                         return;
2894                 }
2895                 /* get next parameter */
2896                 offset += SCTP_SIZE32(plen);
2897                 if ((offset + sizeof(struct sctp_paramhdr)) > length)
2898                         return;
2899                 ph = (struct sctp_paramhdr *)sctp_m_getptr(m, offset,
2900                     sizeof(struct sctp_paramhdr), (uint8_t *)&tmp_param);
2901         }                       /* while */
2902 }
2903
2904 /* FIX ME: need to verify return result for v6 address type if v6 disabled */
2905 /*
2906  * checks to see if a specific address is in the initack address list returns
2907  * 1 if found, 0 if not
2908  */
2909 static uint32_t
2910 sctp_addr_in_initack(struct mbuf *m, uint32_t offset, uint32_t length, struct sockaddr *sa)
2911 {
2912         struct sctp_paramhdr tmp_param, *ph;
2913         uint16_t plen, ptype;
2914 #ifdef INET
2915         struct sockaddr_in *sin;
2916         struct sctp_ipv4addr_param *a4p;
2917         struct sctp_ipv6addr_param addr4_store;
2918 #endif
2919 #ifdef INET6
2920         struct sockaddr_in6 *sin6;
2921         struct sctp_ipv6addr_param *a6p;
2922         struct sctp_ipv6addr_param addr6_store;
2923         struct sockaddr_in6 sin6_tmp;
2924 #endif
2925
2926         switch (sa->sa_family) {
2927 #ifdef INET
2928         case AF_INET:
2929                 break;
2930 #endif
2931 #ifdef INET6
2932         case AF_INET6:
2933                 break;
2934 #endif
2935         default:
2936                 return (0);
2937         }
2938
2939         SCTPDBG(SCTP_DEBUG_ASCONF2, "find_initack_addr: starting search for ");
2940         SCTPDBG_ADDR(SCTP_DEBUG_ASCONF2, sa);
2941         /* convert to upper bound */
2942         length += offset;
2943
2944         if ((offset + sizeof(struct sctp_paramhdr)) > length) {
2945                 SCTPDBG(SCTP_DEBUG_ASCONF1,
2946                     "find_initack_addr: invalid offset?\n");
2947                 return (0);
2948         }
2949         /* go through the addresses in the init-ack */
2950         ph = (struct sctp_paramhdr *)sctp_m_getptr(m, offset,
2951             sizeof(struct sctp_paramhdr), (uint8_t *)&tmp_param);
2952         while (ph != NULL) {
2953                 ptype = ntohs(ph->param_type);
2954                 plen = ntohs(ph->param_length);
2955                 switch (ptype) {
2956 #ifdef INET6
2957                 case SCTP_IPV6_ADDRESS:
2958                         if (sa->sa_family == AF_INET6) {
2959                                 /* get the entire IPv6 address param */
2960                                 if (plen != sizeof(struct sctp_ipv6addr_param)) {
2961                                         break;
2962                                 }
2963                                 /* get the entire IPv6 address param */
2964                                 a6p = (struct sctp_ipv6addr_param *)
2965                                     sctp_m_getptr(m, offset,
2966                                     sizeof(struct sctp_ipv6addr_param),
2967                                     (uint8_t *)&addr6_store);
2968                                 if (a6p == NULL) {
2969                                         return (0);
2970                                 }
2971                                 sin6 = (struct sockaddr_in6 *)sa;
2972                                 if (IN6_IS_SCOPE_LINKLOCAL(&sin6->sin6_addr)) {
2973                                         /* create a copy and clear scope */
2974                                         memcpy(&sin6_tmp, sin6,
2975                                             sizeof(struct sockaddr_in6));
2976                                         sin6 = &sin6_tmp;
2977                                         in6_clearscope(&sin6->sin6_addr);
2978                                 }
2979                                 if (memcmp(&sin6->sin6_addr, a6p->addr,
2980                                     sizeof(struct in6_addr)) == 0) {
2981                                         /* found it */
2982                                         return (1);
2983                                 }
2984                         }
2985                         break;
2986 #endif                          /* INET6 */
2987 #ifdef INET
2988                 case SCTP_IPV4_ADDRESS:
2989                         if (sa->sa_family == AF_INET) {
2990                                 if (plen != sizeof(struct sctp_ipv4addr_param)) {
2991                                         break;
2992                                 }
2993                                 /* get the entire IPv4 address param */
2994                                 a4p = (struct sctp_ipv4addr_param *)
2995                                     sctp_m_getptr(m, offset,
2996                                     sizeof(struct sctp_ipv4addr_param),
2997                                     (uint8_t *)&addr4_store);
2998                                 if (a4p == NULL) {
2999                                         return (0);
3000                                 }
3001                                 sin = (struct sockaddr_in *)sa;
3002                                 if (sin->sin_addr.s_addr == a4p->addr) {
3003                                         /* found it */
3004                                         return (1);
3005                                 }
3006                         }
3007                         break;
3008 #endif
3009                 default:
3010                         break;
3011                 }
3012                 /* get next parameter */
3013                 offset += SCTP_SIZE32(plen);
3014                 if (offset + sizeof(struct sctp_paramhdr) > length) {
3015                         return (0);
3016                 }
3017                 ph = (struct sctp_paramhdr *)
3018                     sctp_m_getptr(m, offset, sizeof(struct sctp_paramhdr),
3019                     (uint8_t *)&tmp_param);
3020         }                       /* while */
3021         /* not found! */
3022         return (0);
3023 }
3024
3025 /*
3026  * makes sure that the current endpoint local addr list is consistent with
3027  * the new association (eg. subset bound, asconf allowed) adds addresses as
3028  * necessary
3029  */
3030 static void
3031 sctp_check_address_list_ep(struct sctp_tcb *stcb, struct mbuf *m, int offset,
3032     int length, struct sockaddr *init_addr)
3033 {
3034         struct sctp_laddr *laddr;
3035
3036         /* go through the endpoint list */
3037         LIST_FOREACH(laddr, &stcb->sctp_ep->sctp_addr_list, sctp_nxt_addr) {
3038                 /* be paranoid and validate the laddr */
3039                 if (laddr->ifa == NULL) {
3040                         SCTPDBG(SCTP_DEBUG_ASCONF1,
3041                             "check_addr_list_ep: laddr->ifa is NULL");
3042                         continue;
3043                 }
3044                 if (laddr->ifa == NULL) {
3045                         SCTPDBG(SCTP_DEBUG_ASCONF1, "check_addr_list_ep: laddr->ifa->ifa_addr is NULL");
3046                         continue;
3047                 }
3048                 /* do i have it implicitly? */
3049                 if (sctp_cmpaddr(&laddr->ifa->address.sa, init_addr)) {
3050                         continue;
3051                 }
3052                 /* check to see if in the init-ack */
3053                 if (!sctp_addr_in_initack(m, offset, length, &laddr->ifa->address.sa)) {
3054                         /* try to add it */
3055                         sctp_addr_mgmt_assoc(stcb->sctp_ep, stcb, laddr->ifa,
3056                             SCTP_ADD_IP_ADDRESS, SCTP_ADDR_NOT_LOCKED);
3057                 }
3058         }
3059 }
3060
3061 /*
3062  * makes sure that the current kernel address list is consistent with the new
3063  * association (with all addrs bound) adds addresses as necessary
3064  */
3065 static void
3066 sctp_check_address_list_all(struct sctp_tcb *stcb, struct mbuf *m, int offset,
3067     int length, struct sockaddr *init_addr,
3068     uint16_t local_scope, uint16_t site_scope,
3069     uint16_t ipv4_scope, uint16_t loopback_scope)
3070 {
3071         struct sctp_vrf *vrf = NULL;
3072         struct sctp_ifn *sctp_ifn;
3073         struct sctp_ifa *sctp_ifa;
3074         uint32_t vrf_id;
3075 #ifdef INET
3076         struct sockaddr_in *sin;
3077 #endif
3078 #ifdef INET6
3079         struct sockaddr_in6 *sin6;
3080 #endif
3081
3082         if (stcb) {
3083                 vrf_id = stcb->asoc.vrf_id;
3084         } else {
3085                 return;
3086         }
3087         SCTP_IPI_ADDR_RLOCK();
3088         vrf = sctp_find_vrf(vrf_id);
3089         if (vrf == NULL) {
3090                 SCTP_IPI_ADDR_RUNLOCK();
3091                 return;
3092         }
3093         /* go through all our known interfaces */
3094         LIST_FOREACH(sctp_ifn, &vrf->ifnlist, next_ifn) {
3095                 if (loopback_scope == 0 && SCTP_IFN_IS_IFT_LOOP(sctp_ifn)) {
3096                         /* skip loopback interface */
3097                         continue;
3098                 }
3099                 /* go through each interface address */
3100                 LIST_FOREACH(sctp_ifa, &sctp_ifn->ifalist, next_ifa) {
3101                         /* do i have it implicitly? */
3102                         if (sctp_cmpaddr(&sctp_ifa->address.sa, init_addr)) {
3103                                 continue;
3104                         }
3105                         switch (sctp_ifa->address.sa.sa_family) {
3106 #ifdef INET
3107                         case AF_INET:
3108                                 sin = &sctp_ifa->address.sin;
3109                                 if (prison_check_ip4(stcb->sctp_ep->ip_inp.inp.inp_cred,
3110                                     &sin->sin_addr) != 0) {
3111                                         continue;
3112                                 }
3113                                 if ((ipv4_scope == 0) &&
3114                                     (IN4_ISPRIVATE_ADDRESS(&sin->sin_addr))) {
3115                                         /* private address not in scope */
3116                                         continue;
3117                                 }
3118                                 break;
3119 #endif
3120 #ifdef INET6
3121                         case AF_INET6:
3122                                 sin6 = &sctp_ifa->address.sin6;
3123                                 if (prison_check_ip6(stcb->sctp_ep->ip_inp.inp.inp_cred,
3124                                     &sin6->sin6_addr) != 0) {
3125                                         continue;
3126                                 }
3127                                 if ((local_scope == 0) &&
3128                                     (IN6_IS_ADDR_LINKLOCAL(&sin6->sin6_addr))) {
3129                                         continue;
3130                                 }
3131                                 if ((site_scope == 0) &&
3132                                     (IN6_IS_ADDR_SITELOCAL(&sin6->sin6_addr))) {
3133                                         continue;
3134                                 }
3135                                 break;
3136 #endif
3137                         default:
3138                                 break;
3139                         }
3140                         /* check to see if in the init-ack */
3141                         if (!sctp_addr_in_initack(m, offset, length, &sctp_ifa->address.sa)) {
3142                                 /* try to add it */
3143                                 sctp_addr_mgmt_assoc(stcb->sctp_ep, stcb,
3144                                     sctp_ifa, SCTP_ADD_IP_ADDRESS,
3145                                     SCTP_ADDR_LOCKED);
3146                         }
3147                 }               /* end foreach ifa */
3148         }                       /* end foreach ifn */
3149         SCTP_IPI_ADDR_RUNLOCK();
3150 }
3151
3152 /*
3153  * validates an init-ack chunk (from a cookie-echo) with current addresses
3154  * adds addresses from the init-ack into our local address list, if needed
3155  * queues asconf adds/deletes addresses as needed and makes appropriate list
3156  * changes for source address selection m, offset: points to the start of the
3157  * address list in an init-ack chunk length: total length of the address
3158  * params only init_addr: address where my INIT-ACK was sent from
3159  */
3160 void
3161 sctp_check_address_list(struct sctp_tcb *stcb, struct mbuf *m, int offset,
3162     int length, struct sockaddr *init_addr,
3163     uint16_t local_scope, uint16_t site_scope,
3164     uint16_t ipv4_scope, uint16_t loopback_scope)
3165 {
3166         /* process the local addresses in the initack */
3167         sctp_process_initack_addresses(stcb, m, offset, length);
3168
3169         if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_BOUNDALL) {
3170                 /* bound all case */
3171                 sctp_check_address_list_all(stcb, m, offset, length, init_addr,
3172                     local_scope, site_scope, ipv4_scope, loopback_scope);
3173         } else {
3174                 /* subset bound case */
3175                 if (sctp_is_feature_on(stcb->sctp_ep,
3176                     SCTP_PCB_FLAGS_DO_ASCONF)) {
3177                         /* asconf's allowed */
3178                         sctp_check_address_list_ep(stcb, m, offset, length,
3179                             init_addr);
3180                 }
3181                 /* else, no asconfs allowed, so what we sent is what we get */
3182         }
3183 }
3184
3185 /*
3186  * sctp_bindx() support
3187  */
3188 uint32_t
3189 sctp_addr_mgmt_ep_sa(struct sctp_inpcb *inp, struct sockaddr *sa,
3190     uint32_t type, uint32_t vrf_id, struct sctp_ifa *sctp_ifap)
3191 {
3192         struct sctp_ifa *ifa;
3193         struct sctp_laddr *laddr, *nladdr;
3194
3195         if (sa->sa_len == 0) {
3196                 SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTP_ASCONF, EINVAL);
3197                 return (EINVAL);
3198         }
3199         if (sctp_ifap) {
3200                 ifa = sctp_ifap;
3201         } else if (type == SCTP_ADD_IP_ADDRESS) {
3202                 /* For an add the address MUST be on the system */
3203                 ifa = sctp_find_ifa_by_addr(sa, vrf_id, SCTP_ADDR_NOT_LOCKED);
3204         } else if (type == SCTP_DEL_IP_ADDRESS) {
3205                 /* For a delete we need to find it in the inp */
3206                 ifa = sctp_find_ifa_in_ep(inp, sa, SCTP_ADDR_NOT_LOCKED);
3207         } else {
3208                 ifa = NULL;
3209         }
3210         if (ifa != NULL) {
3211                 if (type == SCTP_ADD_IP_ADDRESS) {
3212                         sctp_add_local_addr_ep(inp, ifa, type);
3213                 } else if (type == SCTP_DEL_IP_ADDRESS) {
3214                         if (inp->laddr_count < 2) {
3215                                 /* can't delete the last local address */
3216                                 SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTP_ASCONF, EINVAL);
3217                                 return (EINVAL);
3218                         }
3219                         LIST_FOREACH(laddr, &inp->sctp_addr_list,
3220                             sctp_nxt_addr) {
3221                                 if (ifa == laddr->ifa) {
3222                                         /* Mark in the delete */
3223                                         laddr->action = type;
3224                                 }
3225                         }
3226                 }
3227                 if (LIST_EMPTY(&inp->sctp_asoc_list)) {
3228                         /*
3229                          * There is no need to start the iterator if the inp
3230                          * has no associations.
3231                          */
3232                         if (type == SCTP_DEL_IP_ADDRESS) {
3233                                 LIST_FOREACH_SAFE(laddr, &inp->sctp_addr_list, sctp_nxt_addr, nladdr) {
3234                                         if (laddr->ifa == ifa) {
3235                                                 sctp_del_local_addr_ep(inp, ifa);
3236                                         }
3237                                 }
3238                         }
3239                 } else {
3240                         struct sctp_asconf_iterator *asc;
3241                         struct sctp_laddr *wi;
3242                         int ret;
3243
3244                         SCTP_MALLOC(asc, struct sctp_asconf_iterator *,
3245                             sizeof(struct sctp_asconf_iterator),
3246                             SCTP_M_ASC_IT);
3247                         if (asc == NULL) {
3248                                 SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTP_ASCONF, ENOMEM);
3249                                 return (ENOMEM);
3250                         }
3251                         wi = SCTP_ZONE_GET(SCTP_BASE_INFO(ipi_zone_laddr), struct sctp_laddr);
3252                         if (wi == NULL) {
3253                                 SCTP_FREE(asc, SCTP_M_ASC_IT);
3254                                 SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTP_ASCONF, ENOMEM);
3255                                 return (ENOMEM);
3256                         }
3257                         LIST_INIT(&asc->list_of_work);
3258                         asc->cnt = 1;
3259                         SCTP_INCR_LADDR_COUNT();
3260                         wi->ifa = ifa;
3261                         wi->action = type;
3262                         atomic_add_int(&ifa->refcount, 1);
3263                         LIST_INSERT_HEAD(&asc->list_of_work, wi, sctp_nxt_addr);
3264                         ret = sctp_initiate_iterator(sctp_asconf_iterator_ep,
3265                             sctp_asconf_iterator_stcb,
3266                             sctp_asconf_iterator_ep_end,
3267                             SCTP_PCB_ANY_FLAGS,
3268                             SCTP_PCB_ANY_FEATURES,
3269                             SCTP_ASOC_ANY_STATE,
3270                             (void *)asc, 0,
3271                             sctp_asconf_iterator_end, inp, 0);
3272                         if (ret) {
3273                                 SCTP_PRINTF("Failed to initiate iterator for addr_mgmt_ep_sa\n");
3274                                 SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTP_ASCONF, EFAULT);
3275                                 sctp_asconf_iterator_end(asc, 0);
3276                                 return (EFAULT);
3277                         }
3278                 }
3279                 return (0);
3280         } else {
3281                 /* invalid address! */
3282                 SCTP_LTRACE_ERR_RET(NULL, NULL, NULL, SCTP_FROM_SCTP_ASCONF, EADDRNOTAVAIL);
3283                 return (EADDRNOTAVAIL);
3284         }
3285 }
3286
3287 void
3288 sctp_asconf_send_nat_state_update(struct sctp_tcb *stcb,
3289     struct sctp_nets *net)
3290 {
3291         struct sctp_asconf_addr *aa;
3292         struct sctp_ifa *sctp_ifap;
3293         struct sctp_asconf_tag_param *vtag;
3294 #ifdef INET
3295         struct sockaddr_in *to;
3296 #endif
3297 #ifdef INET6
3298         struct sockaddr_in6 *to6;
3299 #endif
3300         if (net == NULL) {
3301                 SCTPDBG(SCTP_DEBUG_ASCONF1, "sctp_asconf_send_nat_state_update: Missing net\n");
3302                 return;
3303         }
3304         if (stcb == NULL) {
3305                 SCTPDBG(SCTP_DEBUG_ASCONF1, "sctp_asconf_send_nat_state_update: Missing stcb\n");
3306                 return;
3307         }
3308         /*
3309          * Need to have in the asconf: - vtagparam(my_vtag/peer_vtag) -
3310          * add(0.0.0.0) - del(0.0.0.0) - Any global addresses add(addr)
3311          */
3312         SCTP_MALLOC(aa, struct sctp_asconf_addr *, sizeof(*aa),
3313             SCTP_M_ASC_ADDR);
3314         if (aa == NULL) {
3315                 /* didn't get memory */
3316                 SCTPDBG(SCTP_DEBUG_ASCONF1,
3317                     "sctp_asconf_send_nat_state_update: failed to get memory!\n");
3318                 return;
3319         }
3320         aa->special_del = 0;
3321         /* fill in asconf address parameter fields */
3322         /* top level elements are "networked" during send */
3323         aa->ifa = NULL;
3324         aa->sent = 0;           /* clear sent flag */
3325         vtag = (struct sctp_asconf_tag_param *)&aa->ap.aph;
3326         vtag->aph.ph.param_type = SCTP_NAT_VTAGS;
3327         vtag->aph.ph.param_length = sizeof(struct sctp_asconf_tag_param);
3328         vtag->local_vtag = htonl(stcb->asoc.my_vtag);
3329         vtag->remote_vtag = htonl(stcb->asoc.peer_vtag);
3330         TAILQ_INSERT_TAIL(&stcb->asoc.asconf_queue, aa, next);
3331
3332         SCTP_MALLOC(aa, struct sctp_asconf_addr *, sizeof(*aa),
3333             SCTP_M_ASC_ADDR);
3334         if (aa == NULL) {
3335                 /* didn't get memory */
3336                 SCTPDBG(SCTP_DEBUG_ASCONF1,
3337                     "sctp_asconf_send_nat_state_update: failed to get memory!\n");
3338                 return;
3339         }
3340         memset(aa, 0, sizeof(struct sctp_asconf_addr));
3341         /* fill in asconf address parameter fields */
3342         /* ADD(0.0.0.0) */
3343         switch (net->ro._l_addr.sa.sa_family) {
3344 #ifdef INET
3345         case AF_INET:
3346                 aa->ap.aph.ph.param_type = SCTP_ADD_IP_ADDRESS;
3347                 aa->ap.aph.ph.param_length = sizeof(struct sctp_asconf_addrv4_param);
3348                 aa->ap.addrp.ph.param_type = SCTP_IPV4_ADDRESS;
3349                 aa->ap.addrp.ph.param_length = sizeof(struct sctp_ipv4addr_param);
3350                 /* No need to add an address, we are using 0.0.0.0 */
3351                 TAILQ_INSERT_TAIL(&stcb->asoc.asconf_queue, aa, next);
3352                 break;
3353 #endif
3354 #ifdef INET6
3355         case AF_INET6:
3356                 aa->ap.aph.ph.param_type = SCTP_ADD_IP_ADDRESS;
3357                 aa->ap.aph.ph.param_length = sizeof(struct sctp_asconf_addr_param);
3358                 aa->ap.addrp.ph.param_type = SCTP_IPV6_ADDRESS;
3359                 aa->ap.addrp.ph.param_length = sizeof(struct sctp_ipv6addr_param);
3360                 /* No need to add an address, we are using 0.0.0.0 */
3361                 TAILQ_INSERT_TAIL(&stcb->asoc.asconf_queue, aa, next);
3362                 break;
3363 #endif
3364         default:
3365                 SCTPDBG(SCTP_DEBUG_ASCONF1,
3366                     "sctp_asconf_send_nat_state_update: unknown address family\n");
3367                 SCTP_FREE(aa, SCTP_M_ASC_ADDR);
3368                 return;
3369         }
3370         SCTP_MALLOC(aa, struct sctp_asconf_addr *, sizeof(*aa),
3371             SCTP_M_ASC_ADDR);
3372         if (aa == NULL) {
3373                 /* didn't get memory */
3374                 SCTPDBG(SCTP_DEBUG_ASCONF1,
3375                     "sctp_asconf_send_nat_state_update: failed to get memory!\n");
3376                 return;
3377         }
3378         memset(aa, 0, sizeof(struct sctp_asconf_addr));
3379         /* fill in asconf address parameter fields */
3380         /* ADD(0.0.0.0) */
3381         switch (net->ro._l_addr.sa.sa_family) {
3382 #ifdef INET
3383         case AF_INET:
3384                 aa->ap.aph.ph.param_type = SCTP_ADD_IP_ADDRESS;
3385                 aa->ap.aph.ph.param_length = sizeof(struct sctp_asconf_addrv4_param);
3386                 aa->ap.addrp.ph.param_type = SCTP_IPV4_ADDRESS;
3387                 aa->ap.addrp.ph.param_length = sizeof(struct sctp_ipv4addr_param);
3388                 /* No need to add an address, we are using 0.0.0.0 */
3389                 TAILQ_INSERT_TAIL(&stcb->asoc.asconf_queue, aa, next);
3390                 break;
3391 #endif
3392 #ifdef INET6
3393         case AF_INET6:
3394                 aa->ap.aph.ph.param_type = SCTP_DEL_IP_ADDRESS;
3395                 aa->ap.aph.ph.param_length = sizeof(struct sctp_asconf_addr_param);
3396                 aa->ap.addrp.ph.param_type = SCTP_IPV6_ADDRESS;
3397                 aa->ap.addrp.ph.param_length = sizeof(struct sctp_ipv6addr_param);
3398                 /* No need to add an address, we are using 0.0.0.0 */
3399                 TAILQ_INSERT_TAIL(&stcb->asoc.asconf_queue, aa, next);
3400                 break;
3401 #endif
3402         default:
3403                 SCTPDBG(SCTP_DEBUG_ASCONF1,
3404                     "sctp_asconf_send_nat_state_update: unknown address family\n");
3405                 SCTP_FREE(aa, SCTP_M_ASC_ADDR);
3406                 return;
3407         }
3408         /* Now we must hunt the addresses and add all global addresses */
3409         if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_BOUNDALL) {
3410                 struct sctp_vrf *vrf = NULL;
3411                 struct sctp_ifn *sctp_ifnp;
3412                 uint32_t vrf_id;
3413
3414                 vrf_id = stcb->sctp_ep->def_vrf_id;
3415                 vrf = sctp_find_vrf(vrf_id);
3416                 if (vrf == NULL) {
3417                         goto skip_rest;
3418                 }
3419
3420                 SCTP_IPI_ADDR_RLOCK();
3421                 LIST_FOREACH(sctp_ifnp, &vrf->ifnlist, next_ifn) {
3422                         LIST_FOREACH(sctp_ifap, &sctp_ifnp->ifalist, next_ifa) {
3423                                 switch (sctp_ifap->address.sa.sa_family) {
3424 #ifdef INET
3425                                 case AF_INET:
3426                                         to = &sctp_ifap->address.sin;
3427                                         if (prison_check_ip4(stcb->sctp_ep->ip_inp.inp.inp_cred,
3428                                             &to->sin_addr) != 0) {
3429                                                 continue;
3430                                         }
3431                                         if (IN4_ISPRIVATE_ADDRESS(&to->sin_addr)) {
3432                                                 continue;
3433                                         }
3434                                         if (IN4_ISLOOPBACK_ADDRESS(&to->sin_addr)) {
3435                                                 continue;
3436                                         }
3437                                         break;
3438 #endif
3439 #ifdef INET6
3440                                 case AF_INET6:
3441                                         to6 = &sctp_ifap->address.sin6;
3442                                         if (prison_check_ip6(stcb->sctp_ep->ip_inp.inp.inp_cred,
3443                                             &to6->sin6_addr) != 0) {
3444                                                 continue;
3445                                         }
3446                                         if (IN6_IS_ADDR_LOOPBACK(&to6->sin6_addr)) {
3447                                                 continue;
3448                                         }
3449                                         if (IN6_IS_ADDR_LINKLOCAL(&to6->sin6_addr)) {
3450                                                 continue;
3451                                         }
3452                                         break;
3453 #endif
3454                                 default:
3455                                         continue;
3456                                 }
3457                                 sctp_asconf_queue_mgmt(stcb, sctp_ifap, SCTP_ADD_IP_ADDRESS);
3458                         }
3459                 }
3460                 SCTP_IPI_ADDR_RUNLOCK();
3461         } else {
3462                 struct sctp_laddr *laddr;
3463
3464                 LIST_FOREACH(laddr, &stcb->sctp_ep->sctp_addr_list, sctp_nxt_addr) {
3465                         if (laddr->ifa == NULL) {
3466                                 continue;
3467                         }
3468                         if (laddr->ifa->localifa_flags & SCTP_BEING_DELETED)
3469                                 /*
3470                                  * Address being deleted by the system, dont
3471                                  * list.
3472                                  */
3473                                 continue;
3474                         if (laddr->action == SCTP_DEL_IP_ADDRESS) {
3475                                 /*
3476                                  * Address being deleted on this ep don't
3477                                  * list.
3478                                  */
3479                                 continue;
3480                         }
3481                         sctp_ifap = laddr->ifa;
3482                         switch (sctp_ifap->address.sa.sa_family) {
3483 #ifdef INET
3484                         case AF_INET:
3485                                 to = &sctp_ifap->address.sin;
3486                                 if (IN4_ISPRIVATE_ADDRESS(&to->sin_addr)) {
3487                                         continue;
3488                                 }
3489                                 if (IN4_ISLOOPBACK_ADDRESS(&to->sin_addr)) {
3490                                         continue;
3491                                 }
3492                                 break;
3493 #endif
3494 #ifdef INET6
3495                         case AF_INET6:
3496                                 to6 = &sctp_ifap->address.sin6;
3497                                 if (IN6_IS_ADDR_LOOPBACK(&to6->sin6_addr)) {
3498                                         continue;
3499                                 }
3500                                 if (IN6_IS_ADDR_LINKLOCAL(&to6->sin6_addr)) {
3501                                         continue;
3502                                 }
3503                                 break;
3504 #endif
3505                         default:
3506                                 continue;
3507                         }
3508                         sctp_asconf_queue_mgmt(stcb, sctp_ifap, SCTP_ADD_IP_ADDRESS);
3509                 }
3510         }
3511 skip_rest:
3512         /* Now we must send the asconf into the queue */
3513         sctp_send_asconf(stcb, net, SCTP_ADDR_NOT_LOCKED);
3514 }