sctp_output.c revision 1.1.2.2
1 1.1.2.2 skrll /* $NetBSD: sctp_output.c,v 1.1.2.2 2015/12/27 12:10:07 skrll Exp $ */ 2 1.1.2.2 skrll /* $KAME: sctp_output.c,v 1.48 2005/06/16 18:29:24 jinmei Exp $ */ 3 1.1.2.2 skrll 4 1.1.2.2 skrll /* 5 1.1.2.2 skrll * Copyright (C) 2002, 2003, 2004 Cisco Systems Inc, 6 1.1.2.2 skrll * All rights reserved. 7 1.1.2.2 skrll * 8 1.1.2.2 skrll * Redistribution and use in source and binary forms, with or without 9 1.1.2.2 skrll * modification, are permitted provided that the following conditions 10 1.1.2.2 skrll * are met: 11 1.1.2.2 skrll * 1. Redistributions of source code must retain the above copyright 12 1.1.2.2 skrll * notice, this list of conditions and the following disclaimer. 13 1.1.2.2 skrll * 2. Redistributions in binary form must reproduce the above copyright 14 1.1.2.2 skrll * notice, this list of conditions and the following disclaimer in the 15 1.1.2.2 skrll * documentation and/or other materials provided with the distribution. 16 1.1.2.2 skrll * 3. Neither the name of the project nor the names of its contributors 17 1.1.2.2 skrll * may be used to endorse or promote products derived from this software 18 1.1.2.2 skrll * without specific prior written permission. 19 1.1.2.2 skrll * 20 1.1.2.2 skrll * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND 21 1.1.2.2 skrll * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 22 1.1.2.2 skrll * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 23 1.1.2.2 skrll * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE 24 1.1.2.2 skrll * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 25 1.1.2.2 skrll * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 26 1.1.2.2 skrll * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 27 1.1.2.2 skrll * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 28 1.1.2.2 skrll * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 29 1.1.2.2 skrll * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 30 1.1.2.2 skrll * SUCH DAMAGE. 31 1.1.2.2 skrll */ 32 1.1.2.2 skrll #include <sys/cdefs.h> 33 1.1.2.2 skrll __KERNEL_RCSID(0, "$NetBSD: sctp_output.c,v 1.1.2.2 2015/12/27 12:10:07 skrll Exp $"); 34 1.1.2.2 skrll 35 1.1.2.2 skrll #ifdef _KERNEL_OPT 36 1.1.2.2 skrll #include "opt_ipsec.h" 37 1.1.2.2 skrll #include "opt_inet.h" 38 1.1.2.2 skrll #include "opt_sctp.h" 39 1.1.2.2 skrll #endif /* _KERNEL_OPT */ 40 1.1.2.2 skrll 41 1.1.2.2 skrll #include <sys/param.h> 42 1.1.2.2 skrll #include <sys/systm.h> 43 1.1.2.2 skrll #include <sys/malloc.h> 44 1.1.2.2 skrll #include <sys/mbuf.h> 45 1.1.2.2 skrll #include <sys/domain.h> 46 1.1.2.2 skrll #include <sys/protosw.h> 47 1.1.2.2 skrll #include <sys/socket.h> 48 1.1.2.2 skrll #include <sys/socketvar.h> 49 1.1.2.2 skrll #include <sys/proc.h> 50 1.1.2.2 skrll #include <sys/kernel.h> 51 1.1.2.2 skrll #include <sys/sysctl.h> 52 1.1.2.2 skrll #include <sys/resourcevar.h> 53 1.1.2.2 skrll #include <sys/uio.h> 54 1.1.2.2 skrll #ifdef INET6 55 1.1.2.2 skrll #include <sys/domain.h> 56 1.1.2.2 skrll #endif 57 1.1.2.2 skrll 58 1.1.2.2 skrll #include <machine/limits.h> 59 1.1.2.2 skrll #include <machine/cpu.h> 60 1.1.2.2 skrll 61 1.1.2.2 skrll #include <net/if.h> 62 1.1.2.2 skrll #include <net/if_types.h> 63 1.1.2.2 skrll 64 1.1.2.2 skrll #include <net/route.h> 65 1.1.2.2 skrll 66 1.1.2.2 skrll #include <netinet/in.h> 67 1.1.2.2 skrll #include <netinet/in_systm.h> 68 1.1.2.2 skrll #include <netinet/ip.h> 69 1.1.2.2 skrll #include <netinet/in_pcb.h> 70 1.1.2.2 skrll #include <netinet/in_var.h> 71 1.1.2.2 skrll #include <netinet/ip_var.h> 72 1.1.2.2 skrll 73 1.1.2.2 skrll #ifdef INET6 74 1.1.2.2 skrll #include <netinet/ip6.h> 75 1.1.2.2 skrll #include <netinet6/ip6_var.h> 76 1.1.2.2 skrll #include <netinet6/scope6_var.h> 77 1.1.2.2 skrll #include <netinet6/nd6.h> 78 1.1.2.2 skrll 79 1.1.2.2 skrll #include <netinet6/in6_pcb.h> 80 1.1.2.2 skrll 81 1.1.2.2 skrll #include <netinet/icmp6.h> 82 1.1.2.2 skrll 83 1.1.2.2 skrll #endif /* INET6 */ 84 1.1.2.2 skrll 85 1.1.2.2 skrll #include <net/net_osdep.h> 86 1.1.2.2 skrll 87 1.1.2.2 skrll #if defined(HAVE_NRL_INPCB) || defined(__FreeBSD__) 88 1.1.2.2 skrll #ifndef in6pcb 89 1.1.2.2 skrll #define in6pcb inpcb 90 1.1.2.2 skrll #endif 91 1.1.2.2 skrll #endif 92 1.1.2.2 skrll 93 1.1.2.2 skrll #include <netinet/sctp_pcb.h> 94 1.1.2.2 skrll 95 1.1.2.2 skrll #ifdef IPSEC 96 1.1.2.2 skrll #include <netinet6/ipsec.h> 97 1.1.2.2 skrll #include <netkey/key.h> 98 1.1.2.2 skrll #endif /* IPSEC */ 99 1.1.2.2 skrll 100 1.1.2.2 skrll #include <netinet/sctp_var.h> 101 1.1.2.2 skrll #include <netinet/sctp_header.h> 102 1.1.2.2 skrll #include <netinet/sctputil.h> 103 1.1.2.2 skrll #include <netinet/sctp_pcb.h> 104 1.1.2.2 skrll #include <netinet/sctp_output.h> 105 1.1.2.2 skrll #include <netinet/sctp_uio.h> 106 1.1.2.2 skrll #include <netinet/sctputil.h> 107 1.1.2.2 skrll #include <netinet/sctp_hashdriver.h> 108 1.1.2.2 skrll #include <netinet/sctp_timer.h> 109 1.1.2.2 skrll #include <netinet/sctp_asconf.h> 110 1.1.2.2 skrll #include <netinet/sctp_indata.h> 111 1.1.2.2 skrll 112 1.1.2.2 skrll #ifdef SCTP_DEBUG 113 1.1.2.2 skrll extern uint32_t sctp_debug_on; 114 1.1.2.2 skrll #endif 115 1.1.2.2 skrll 116 1.1.2.2 skrll extern int sctp_peer_chunk_oh; 117 1.1.2.2 skrll 118 1.1.2.2 skrll static int 119 1.1.2.2 skrll sctp_find_cmsg(int c_type, void *data, struct mbuf *control, int cpsize) 120 1.1.2.2 skrll { 121 1.1.2.2 skrll struct cmsghdr cmh; 122 1.1.2.2 skrll int tlen, at; 123 1.1.2.2 skrll 124 1.1.2.2 skrll tlen = control->m_len; 125 1.1.2.2 skrll at = 0; 126 1.1.2.2 skrll /* 127 1.1.2.2 skrll * Independent of how many mbufs, find the c_type inside the control 128 1.1.2.2 skrll * structure and copy out the data. 129 1.1.2.2 skrll */ 130 1.1.2.2 skrll while (at < tlen) { 131 1.1.2.2 skrll if ((tlen-at) < (int)CMSG_ALIGN(sizeof(cmh))) { 132 1.1.2.2 skrll /* not enough room for one more we are done. */ 133 1.1.2.2 skrll return (0); 134 1.1.2.2 skrll } 135 1.1.2.2 skrll m_copydata(control, at, sizeof(cmh), (void *)&cmh); 136 1.1.2.2 skrll if ((cmh.cmsg_len + at) > tlen) { 137 1.1.2.2 skrll /* 138 1.1.2.2 skrll * this is real messed up since there is not enough 139 1.1.2.2 skrll * data here to cover the cmsg header. We are done. 140 1.1.2.2 skrll */ 141 1.1.2.2 skrll return (0); 142 1.1.2.2 skrll } 143 1.1.2.2 skrll if ((cmh.cmsg_level == IPPROTO_SCTP) && 144 1.1.2.2 skrll (c_type == cmh.cmsg_type)) { 145 1.1.2.2 skrll /* found the one we want, copy it out */ 146 1.1.2.2 skrll at += CMSG_ALIGN(sizeof(struct cmsghdr)); 147 1.1.2.2 skrll if ((int)(cmh.cmsg_len - CMSG_ALIGN(sizeof(struct cmsghdr))) < cpsize) { 148 1.1.2.2 skrll /* 149 1.1.2.2 skrll * space of cmsg_len after header not 150 1.1.2.2 skrll * big enough 151 1.1.2.2 skrll */ 152 1.1.2.2 skrll return (0); 153 1.1.2.2 skrll } 154 1.1.2.2 skrll m_copydata(control, at, cpsize, data); 155 1.1.2.2 skrll return (1); 156 1.1.2.2 skrll } else { 157 1.1.2.2 skrll at += CMSG_ALIGN(cmh.cmsg_len); 158 1.1.2.2 skrll if (cmh.cmsg_len == 0) { 159 1.1.2.2 skrll break; 160 1.1.2.2 skrll } 161 1.1.2.2 skrll } 162 1.1.2.2 skrll } 163 1.1.2.2 skrll /* not found */ 164 1.1.2.2 skrll return (0); 165 1.1.2.2 skrll } 166 1.1.2.2 skrll 167 1.1.2.2 skrll static struct mbuf * 168 1.1.2.2 skrll sctp_add_addr_to_mbuf(struct mbuf *m, struct ifaddr *ifa) 169 1.1.2.2 skrll { 170 1.1.2.2 skrll struct sctp_paramhdr *parmh; 171 1.1.2.2 skrll struct mbuf *mret; 172 1.1.2.2 skrll int len; 173 1.1.2.2 skrll if (ifa->ifa_addr->sa_family == AF_INET) { 174 1.1.2.2 skrll len = sizeof(struct sctp_ipv4addr_param); 175 1.1.2.2 skrll } else if (ifa->ifa_addr->sa_family == AF_INET6) { 176 1.1.2.2 skrll len = sizeof(struct sctp_ipv6addr_param); 177 1.1.2.2 skrll } else { 178 1.1.2.2 skrll /* unknown type */ 179 1.1.2.2 skrll return (m); 180 1.1.2.2 skrll } 181 1.1.2.2 skrll 182 1.1.2.2 skrll if (M_TRAILINGSPACE(m) >= len) { 183 1.1.2.2 skrll /* easy side we just drop it on the end */ 184 1.1.2.2 skrll parmh = (struct sctp_paramhdr *)(m->m_data + m->m_len); 185 1.1.2.2 skrll mret = m; 186 1.1.2.2 skrll } else { 187 1.1.2.2 skrll /* Need more space */ 188 1.1.2.2 skrll mret = m; 189 1.1.2.2 skrll while (mret->m_next != NULL) { 190 1.1.2.2 skrll mret = mret->m_next; 191 1.1.2.2 skrll } 192 1.1.2.2 skrll MGET(mret->m_next, M_DONTWAIT, MT_DATA); 193 1.1.2.2 skrll if (mret->m_next == NULL) { 194 1.1.2.2 skrll /* We are hosed, can't add more addresses */ 195 1.1.2.2 skrll return (m); 196 1.1.2.2 skrll } 197 1.1.2.2 skrll mret = mret->m_next; 198 1.1.2.2 skrll parmh = mtod(mret, struct sctp_paramhdr *); 199 1.1.2.2 skrll } 200 1.1.2.2 skrll /* now add the parameter */ 201 1.1.2.2 skrll if (ifa->ifa_addr->sa_family == AF_INET) { 202 1.1.2.2 skrll struct sctp_ipv4addr_param *ipv4p; 203 1.1.2.2 skrll struct sockaddr_in *sin; 204 1.1.2.2 skrll sin = (struct sockaddr_in *)ifa->ifa_addr; 205 1.1.2.2 skrll ipv4p = (struct sctp_ipv4addr_param *)parmh; 206 1.1.2.2 skrll parmh->param_type = htons(SCTP_IPV4_ADDRESS); 207 1.1.2.2 skrll parmh->param_length = htons(len); 208 1.1.2.2 skrll ipv4p->addr = sin->sin_addr.s_addr; 209 1.1.2.2 skrll mret->m_len += len; 210 1.1.2.2 skrll } else if (ifa->ifa_addr->sa_family == AF_INET6) { 211 1.1.2.2 skrll struct sctp_ipv6addr_param *ipv6p; 212 1.1.2.2 skrll struct sockaddr_in6 *sin6; 213 1.1.2.2 skrll sin6 = (struct sockaddr_in6 *)ifa->ifa_addr; 214 1.1.2.2 skrll ipv6p = (struct sctp_ipv6addr_param *)parmh; 215 1.1.2.2 skrll parmh->param_type = htons(SCTP_IPV6_ADDRESS); 216 1.1.2.2 skrll parmh->param_length = htons(len); 217 1.1.2.2 skrll memcpy(ipv6p->addr, &sin6->sin6_addr, 218 1.1.2.2 skrll sizeof(ipv6p->addr)); 219 1.1.2.2 skrll /* clear embedded scope in the address */ 220 1.1.2.2 skrll in6_clearscope((struct in6_addr *)ipv6p->addr); 221 1.1.2.2 skrll mret->m_len += len; 222 1.1.2.2 skrll } else { 223 1.1.2.2 skrll return (m); 224 1.1.2.2 skrll } 225 1.1.2.2 skrll return (mret); 226 1.1.2.2 skrll } 227 1.1.2.2 skrll 228 1.1.2.2 skrll 229 1.1.2.2 skrll 230 1.1.2.2 skrll static struct mbuf * 231 1.1.2.2 skrll sctp_add_cookie(struct sctp_inpcb *inp, struct mbuf *init, int init_offset, 232 1.1.2.2 skrll struct mbuf *initack, int initack_offset, struct sctp_state_cookie *stc_in) 233 1.1.2.2 skrll { 234 1.1.2.2 skrll struct mbuf *copy_init, *copy_initack, *m_at, *sig, *mret; 235 1.1.2.2 skrll struct sctp_state_cookie *stc; 236 1.1.2.2 skrll struct sctp_paramhdr *ph; 237 1.1.2.2 skrll uint8_t *signature; 238 1.1.2.2 skrll int sig_offset; 239 1.1.2.2 skrll uint16_t cookie_sz; 240 1.1.2.2 skrll 241 1.1.2.2 skrll mret = NULL; 242 1.1.2.2 skrll 243 1.1.2.2 skrll MGET(mret, M_DONTWAIT, MT_DATA); 244 1.1.2.2 skrll if (mret == NULL) { 245 1.1.2.2 skrll return (NULL); 246 1.1.2.2 skrll } 247 1.1.2.2 skrll copy_init = sctp_m_copym(init, init_offset, M_COPYALL, M_DONTWAIT); 248 1.1.2.2 skrll if (copy_init == NULL) { 249 1.1.2.2 skrll sctp_m_freem(mret); 250 1.1.2.2 skrll return (NULL); 251 1.1.2.2 skrll } 252 1.1.2.2 skrll copy_initack = sctp_m_copym(initack, initack_offset, M_COPYALL, 253 1.1.2.2 skrll M_DONTWAIT); 254 1.1.2.2 skrll if (copy_initack == NULL) { 255 1.1.2.2 skrll sctp_m_freem(mret); 256 1.1.2.2 skrll sctp_m_freem(copy_init); 257 1.1.2.2 skrll return (NULL); 258 1.1.2.2 skrll } 259 1.1.2.2 skrll /* easy side we just drop it on the end */ 260 1.1.2.2 skrll ph = mtod(mret, struct sctp_paramhdr *); 261 1.1.2.2 skrll mret->m_len = sizeof(struct sctp_state_cookie) + 262 1.1.2.2 skrll sizeof(struct sctp_paramhdr); 263 1.1.2.2 skrll stc = (struct sctp_state_cookie *)((vaddr_t)ph + 264 1.1.2.2 skrll sizeof(struct sctp_paramhdr)); 265 1.1.2.2 skrll ph->param_type = htons(SCTP_STATE_COOKIE); 266 1.1.2.2 skrll ph->param_length = 0; /* fill in at the end */ 267 1.1.2.2 skrll /* Fill in the stc cookie data */ 268 1.1.2.2 skrll *stc = *stc_in; 269 1.1.2.2 skrll 270 1.1.2.2 skrll /* tack the INIT and then the INIT-ACK onto the chain */ 271 1.1.2.2 skrll cookie_sz = 0; 272 1.1.2.2 skrll m_at = mret; 273 1.1.2.2 skrll for (m_at = mret; m_at; m_at = m_at->m_next) { 274 1.1.2.2 skrll cookie_sz += m_at->m_len; 275 1.1.2.2 skrll if (m_at->m_next == NULL) { 276 1.1.2.2 skrll m_at->m_next = copy_init; 277 1.1.2.2 skrll break; 278 1.1.2.2 skrll } 279 1.1.2.2 skrll } 280 1.1.2.2 skrll 281 1.1.2.2 skrll for (m_at = copy_init; m_at; m_at = m_at->m_next) { 282 1.1.2.2 skrll cookie_sz += m_at->m_len; 283 1.1.2.2 skrll if (m_at->m_next == NULL) { 284 1.1.2.2 skrll m_at->m_next = copy_initack; 285 1.1.2.2 skrll break; 286 1.1.2.2 skrll } 287 1.1.2.2 skrll } 288 1.1.2.2 skrll 289 1.1.2.2 skrll for (m_at = copy_initack; m_at; m_at = m_at->m_next) { 290 1.1.2.2 skrll cookie_sz += m_at->m_len; 291 1.1.2.2 skrll if (m_at->m_next == NULL) { 292 1.1.2.2 skrll break; 293 1.1.2.2 skrll } 294 1.1.2.2 skrll } 295 1.1.2.2 skrll MGET(sig, M_DONTWAIT, MT_DATA); 296 1.1.2.2 skrll if (sig == NULL) { 297 1.1.2.2 skrll /* no space */ 298 1.1.2.2 skrll sctp_m_freem(mret); 299 1.1.2.2 skrll sctp_m_freem(copy_init); 300 1.1.2.2 skrll sctp_m_freem(copy_initack); 301 1.1.2.2 skrll return (NULL); 302 1.1.2.2 skrll } 303 1.1.2.2 skrll sig->m_len = 0; 304 1.1.2.2 skrll m_at->m_next = sig; 305 1.1.2.2 skrll sig_offset = 0; 306 1.1.2.2 skrll signature = (uint8_t *)(mtod(sig, vaddr_t) + sig_offset); 307 1.1.2.2 skrll /* Time to sign the cookie */ 308 1.1.2.2 skrll sctp_hash_digest_m((char *)inp->sctp_ep.secret_key[ 309 1.1.2.2 skrll (int)(inp->sctp_ep.current_secret_number)], 310 1.1.2.2 skrll SCTP_SECRET_SIZE, mret, sizeof(struct sctp_paramhdr), 311 1.1.2.2 skrll (uint8_t *)signature); 312 1.1.2.2 skrll sig->m_len += SCTP_SIGNATURE_SIZE; 313 1.1.2.2 skrll cookie_sz += SCTP_SIGNATURE_SIZE; 314 1.1.2.2 skrll 315 1.1.2.2 skrll ph->param_length = htons(cookie_sz); 316 1.1.2.2 skrll return (mret); 317 1.1.2.2 skrll } 318 1.1.2.2 skrll 319 1.1.2.2 skrll 320 1.1.2.2 skrll static struct sockaddr_in * 321 1.1.2.2 skrll sctp_is_v4_ifa_addr_prefered (struct ifaddr *ifa, uint8_t loopscope, uint8_t ipv4_scope, uint8_t *sin_loop, uint8_t *sin_local) 322 1.1.2.2 skrll { 323 1.1.2.2 skrll struct sockaddr_in *sin; 324 1.1.2.2 skrll /* 325 1.1.2.2 skrll * Here we determine if its a prefered address. A 326 1.1.2.2 skrll * prefered address means it is the same scope or 327 1.1.2.2 skrll * higher scope then the destination. 328 1.1.2.2 skrll * L = loopback, P = private, G = global 329 1.1.2.2 skrll * ----------------------------------------- 330 1.1.2.2 skrll * src | dest | result 331 1.1.2.2 skrll *----------------------------------------- 332 1.1.2.2 skrll * L | L | yes 333 1.1.2.2 skrll *----------------------------------------- 334 1.1.2.2 skrll * P | L | yes 335 1.1.2.2 skrll *----------------------------------------- 336 1.1.2.2 skrll * G | L | yes 337 1.1.2.2 skrll *----------------------------------------- 338 1.1.2.2 skrll * L | P | no 339 1.1.2.2 skrll *----------------------------------------- 340 1.1.2.2 skrll * P | P | yes 341 1.1.2.2 skrll *----------------------------------------- 342 1.1.2.2 skrll * G | P | no 343 1.1.2.2 skrll *----------------------------------------- 344 1.1.2.2 skrll * L | G | no 345 1.1.2.2 skrll *----------------------------------------- 346 1.1.2.2 skrll * P | G | no 347 1.1.2.2 skrll *----------------------------------------- 348 1.1.2.2 skrll * G | G | yes 349 1.1.2.2 skrll *----------------------------------------- 350 1.1.2.2 skrll */ 351 1.1.2.2 skrll 352 1.1.2.2 skrll if (ifa->ifa_addr->sa_family != AF_INET) { 353 1.1.2.2 skrll /* forget non-v4 */ 354 1.1.2.2 skrll return (NULL); 355 1.1.2.2 skrll } 356 1.1.2.2 skrll /* Ok the address may be ok */ 357 1.1.2.2 skrll sin = (struct sockaddr_in *)ifa->ifa_addr; 358 1.1.2.2 skrll if (sin->sin_addr.s_addr == 0) { 359 1.1.2.2 skrll return (NULL); 360 1.1.2.2 skrll } 361 1.1.2.2 skrll *sin_local = *sin_loop = 0; 362 1.1.2.2 skrll if ((ifa->ifa_ifp->if_type == IFT_LOOP) || 363 1.1.2.2 skrll (IN4_ISLOOPBACK_ADDRESS(&sin->sin_addr))) { 364 1.1.2.2 skrll *sin_loop = 1; 365 1.1.2.2 skrll *sin_local = 1; 366 1.1.2.2 skrll } 367 1.1.2.2 skrll if ((IN4_ISPRIVATE_ADDRESS(&sin->sin_addr))) { 368 1.1.2.2 skrll *sin_local = 1; 369 1.1.2.2 skrll } 370 1.1.2.2 skrll if (!loopscope && *sin_loop) { 371 1.1.2.2 skrll /* Its a loopback address and we don't have loop scope */ 372 1.1.2.2 skrll return (NULL); 373 1.1.2.2 skrll } 374 1.1.2.2 skrll if (!ipv4_scope && *sin_local) { 375 1.1.2.2 skrll /* Its a private address, and we don't have private address scope */ 376 1.1.2.2 skrll return (NULL); 377 1.1.2.2 skrll } 378 1.1.2.2 skrll if (((ipv4_scope == 0) && (loopscope == 0)) && (*sin_local)) { 379 1.1.2.2 skrll /* its a global src and a private dest */ 380 1.1.2.2 skrll return (NULL); 381 1.1.2.2 skrll } 382 1.1.2.2 skrll /* its a prefered address */ 383 1.1.2.2 skrll return (sin); 384 1.1.2.2 skrll } 385 1.1.2.2 skrll 386 1.1.2.2 skrll static struct sockaddr_in * 387 1.1.2.2 skrll sctp_is_v4_ifa_addr_acceptable (struct ifaddr *ifa, uint8_t loopscope, uint8_t ipv4_scope, uint8_t *sin_loop, uint8_t *sin_local) 388 1.1.2.2 skrll { 389 1.1.2.2 skrll struct sockaddr_in *sin; 390 1.1.2.2 skrll /* 391 1.1.2.2 skrll * Here we determine if its a acceptable address. A 392 1.1.2.2 skrll * acceptable address means it is the same scope or 393 1.1.2.2 skrll * higher scope but we can allow for NAT which means 394 1.1.2.2 skrll * its ok to have a global dest and a private src. 395 1.1.2.2 skrll * 396 1.1.2.2 skrll * L = loopback, P = private, G = global 397 1.1.2.2 skrll * ----------------------------------------- 398 1.1.2.2 skrll * src | dest | result 399 1.1.2.2 skrll *----------------------------------------- 400 1.1.2.2 skrll * L | L | yes 401 1.1.2.2 skrll *----------------------------------------- 402 1.1.2.2 skrll * P | L | yes 403 1.1.2.2 skrll *----------------------------------------- 404 1.1.2.2 skrll * G | L | yes 405 1.1.2.2 skrll *----------------------------------------- 406 1.1.2.2 skrll * L | P | no 407 1.1.2.2 skrll *----------------------------------------- 408 1.1.2.2 skrll * P | P | yes 409 1.1.2.2 skrll *----------------------------------------- 410 1.1.2.2 skrll * G | P | yes - probably this won't work. 411 1.1.2.2 skrll *----------------------------------------- 412 1.1.2.2 skrll * L | G | no 413 1.1.2.2 skrll *----------------------------------------- 414 1.1.2.2 skrll * P | G | yes 415 1.1.2.2 skrll *----------------------------------------- 416 1.1.2.2 skrll * G | G | yes 417 1.1.2.2 skrll *----------------------------------------- 418 1.1.2.2 skrll */ 419 1.1.2.2 skrll 420 1.1.2.2 skrll if (ifa->ifa_addr->sa_family != AF_INET) { 421 1.1.2.2 skrll /* forget non-v4 */ 422 1.1.2.2 skrll return (NULL); 423 1.1.2.2 skrll } 424 1.1.2.2 skrll /* Ok the address may be ok */ 425 1.1.2.2 skrll sin = (struct sockaddr_in *)ifa->ifa_addr; 426 1.1.2.2 skrll if (sin->sin_addr.s_addr == 0) { 427 1.1.2.2 skrll return (NULL); 428 1.1.2.2 skrll } 429 1.1.2.2 skrll *sin_local = *sin_loop = 0; 430 1.1.2.2 skrll if ((ifa->ifa_ifp->if_type == IFT_LOOP) || 431 1.1.2.2 skrll (IN4_ISLOOPBACK_ADDRESS(&sin->sin_addr))) { 432 1.1.2.2 skrll *sin_loop = 1; 433 1.1.2.2 skrll *sin_local = 1; 434 1.1.2.2 skrll } 435 1.1.2.2 skrll if ((IN4_ISPRIVATE_ADDRESS(&sin->sin_addr))) { 436 1.1.2.2 skrll *sin_local = 1; 437 1.1.2.2 skrll } 438 1.1.2.2 skrll if (!loopscope && *sin_loop) { 439 1.1.2.2 skrll /* Its a loopback address and we don't have loop scope */ 440 1.1.2.2 skrll return (NULL); 441 1.1.2.2 skrll } 442 1.1.2.2 skrll /* its an acceptable address */ 443 1.1.2.2 skrll return (sin); 444 1.1.2.2 skrll } 445 1.1.2.2 skrll 446 1.1.2.2 skrll /* 447 1.1.2.2 skrll * This treats the address list on the ep as a restricted list 448 1.1.2.2 skrll * (negative list). If a the passed address is listed, then 449 1.1.2.2 skrll * the address is NOT allowed on the association. 450 1.1.2.2 skrll */ 451 1.1.2.2 skrll int 452 1.1.2.2 skrll sctp_is_addr_restricted(struct sctp_tcb *stcb, struct sockaddr *addr) 453 1.1.2.2 skrll { 454 1.1.2.2 skrll struct sctp_laddr *laddr; 455 1.1.2.2 skrll #ifdef SCTP_DEBUG 456 1.1.2.2 skrll int cnt=0; 457 1.1.2.2 skrll #endif 458 1.1.2.2 skrll if (stcb == NULL) { 459 1.1.2.2 skrll /* There are no restrictions, no TCB :-) */ 460 1.1.2.2 skrll return (0); 461 1.1.2.2 skrll } 462 1.1.2.2 skrll #ifdef SCTP_DEBUG 463 1.1.2.2 skrll LIST_FOREACH(laddr, &stcb->asoc.sctp_local_addr_list, sctp_nxt_addr) { 464 1.1.2.2 skrll cnt++; 465 1.1.2.2 skrll } 466 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT4) { 467 1.1.2.2 skrll printf("There are %d addresses on the restricted list\n", cnt); 468 1.1.2.2 skrll } 469 1.1.2.2 skrll cnt = 0; 470 1.1.2.2 skrll #endif 471 1.1.2.2 skrll LIST_FOREACH(laddr, &stcb->asoc.sctp_local_addr_list, sctp_nxt_addr) { 472 1.1.2.2 skrll if (laddr->ifa == NULL) { 473 1.1.2.2 skrll #ifdef SCTP_DEBUG 474 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 475 1.1.2.2 skrll printf("Help I have fallen and I can't get up!\n"); 476 1.1.2.2 skrll } 477 1.1.2.2 skrll #endif 478 1.1.2.2 skrll continue; 479 1.1.2.2 skrll } 480 1.1.2.2 skrll #ifdef SCTP_DEBUG 481 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT4) { 482 1.1.2.2 skrll cnt++; 483 1.1.2.2 skrll printf("Restricted address[%d]:", cnt); 484 1.1.2.2 skrll sctp_print_address(laddr->ifa->ifa_addr); 485 1.1.2.2 skrll } 486 1.1.2.2 skrll #endif 487 1.1.2.2 skrll if (sctp_cmpaddr(addr, laddr->ifa->ifa_addr) == 1) { 488 1.1.2.2 skrll /* Yes it is on the list */ 489 1.1.2.2 skrll return (1); 490 1.1.2.2 skrll } 491 1.1.2.2 skrll } 492 1.1.2.2 skrll return (0); 493 1.1.2.2 skrll } 494 1.1.2.2 skrll 495 1.1.2.2 skrll static int 496 1.1.2.2 skrll sctp_is_addr_in_ep(struct sctp_inpcb *inp, struct ifaddr *ifa) 497 1.1.2.2 skrll { 498 1.1.2.2 skrll struct sctp_laddr *laddr; 499 1.1.2.2 skrll 500 1.1.2.2 skrll if (ifa == NULL) 501 1.1.2.2 skrll return (0); 502 1.1.2.2 skrll LIST_FOREACH(laddr, &inp->sctp_addr_list, sctp_nxt_addr) { 503 1.1.2.2 skrll if (laddr->ifa == NULL) { 504 1.1.2.2 skrll #ifdef SCTP_DEBUG 505 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 506 1.1.2.2 skrll printf("Help I have fallen and I can't get up!\n"); 507 1.1.2.2 skrll } 508 1.1.2.2 skrll #endif 509 1.1.2.2 skrll continue; 510 1.1.2.2 skrll } 511 1.1.2.2 skrll if (laddr->ifa->ifa_addr == NULL) 512 1.1.2.2 skrll continue; 513 1.1.2.2 skrll if (laddr->ifa == ifa) 514 1.1.2.2 skrll /* same pointer */ 515 1.1.2.2 skrll return (1); 516 1.1.2.2 skrll if (laddr->ifa->ifa_addr->sa_family != ifa->ifa_addr->sa_family) { 517 1.1.2.2 skrll /* skip non compatible address comparison */ 518 1.1.2.2 skrll continue; 519 1.1.2.2 skrll } 520 1.1.2.2 skrll if (sctp_cmpaddr(ifa->ifa_addr, laddr->ifa->ifa_addr) == 1) { 521 1.1.2.2 skrll /* Yes it is restricted */ 522 1.1.2.2 skrll return (1); 523 1.1.2.2 skrll } 524 1.1.2.2 skrll } 525 1.1.2.2 skrll return (0); 526 1.1.2.2 skrll } 527 1.1.2.2 skrll 528 1.1.2.2 skrll 529 1.1.2.2 skrll 530 1.1.2.2 skrll static struct in_addr 531 1.1.2.2 skrll sctp_choose_v4_boundspecific_inp(struct sctp_inpcb *inp, 532 1.1.2.2 skrll struct rtentry *rt, 533 1.1.2.2 skrll uint8_t ipv4_scope, 534 1.1.2.2 skrll uint8_t loopscope) 535 1.1.2.2 skrll { 536 1.1.2.2 skrll struct in_addr ans; 537 1.1.2.2 skrll struct sctp_laddr *laddr; 538 1.1.2.2 skrll struct sockaddr_in *sin; 539 1.1.2.2 skrll struct ifnet *ifn; 540 1.1.2.2 skrll struct ifaddr *ifa; 541 1.1.2.2 skrll uint8_t sin_loop, sin_local; 542 1.1.2.2 skrll 543 1.1.2.2 skrll /* first question, is the ifn we will emit on 544 1.1.2.2 skrll * in our list, if so, we want that one. 545 1.1.2.2 skrll */ 546 1.1.2.2 skrll ifn = rt->rt_ifp; 547 1.1.2.2 skrll if (ifn) { 548 1.1.2.2 skrll /* is a prefered one on the interface we route out? */ 549 1.1.2.2 skrll TAILQ_FOREACH(ifa, &ifn->if_addrlist, ifa_list) { 550 1.1.2.2 skrll sin = sctp_is_v4_ifa_addr_prefered (ifa, loopscope, ipv4_scope, &sin_loop, &sin_local); 551 1.1.2.2 skrll if (sin == NULL) 552 1.1.2.2 skrll continue; 553 1.1.2.2 skrll if (sctp_is_addr_in_ep(inp, ifa)) { 554 1.1.2.2 skrll return (sin->sin_addr); 555 1.1.2.2 skrll } 556 1.1.2.2 skrll } 557 1.1.2.2 skrll /* is an acceptable one on the interface we route out? */ 558 1.1.2.2 skrll TAILQ_FOREACH(ifa, &ifn->if_addrlist, ifa_list) { 559 1.1.2.2 skrll sin = sctp_is_v4_ifa_addr_acceptable (ifa, loopscope, ipv4_scope, &sin_loop, &sin_local); 560 1.1.2.2 skrll if (sin == NULL) 561 1.1.2.2 skrll continue; 562 1.1.2.2 skrll if (sctp_is_addr_in_ep(inp, ifa)) { 563 1.1.2.2 skrll return (sin->sin_addr); 564 1.1.2.2 skrll } 565 1.1.2.2 skrll } 566 1.1.2.2 skrll } 567 1.1.2.2 skrll /* ok, what about a prefered address in the inp */ 568 1.1.2.2 skrll for (laddr = LIST_FIRST(&inp->sctp_addr_list); 569 1.1.2.2 skrll laddr && (laddr != inp->next_addr_touse); 570 1.1.2.2 skrll laddr = LIST_NEXT(laddr, sctp_nxt_addr)) { 571 1.1.2.2 skrll if (laddr->ifa == NULL) { 572 1.1.2.2 skrll /* address has been removed */ 573 1.1.2.2 skrll continue; 574 1.1.2.2 skrll } 575 1.1.2.2 skrll sin = sctp_is_v4_ifa_addr_prefered (laddr->ifa, loopscope, ipv4_scope, &sin_loop, &sin_local); 576 1.1.2.2 skrll if (sin == NULL) 577 1.1.2.2 skrll continue; 578 1.1.2.2 skrll return (sin->sin_addr); 579 1.1.2.2 skrll 580 1.1.2.2 skrll } 581 1.1.2.2 skrll /* ok, what about an acceptable address in the inp */ 582 1.1.2.2 skrll for (laddr = LIST_FIRST(&inp->sctp_addr_list); 583 1.1.2.2 skrll laddr && (laddr != inp->next_addr_touse); 584 1.1.2.2 skrll laddr = LIST_NEXT(laddr, sctp_nxt_addr)) { 585 1.1.2.2 skrll if (laddr->ifa == NULL) { 586 1.1.2.2 skrll /* address has been removed */ 587 1.1.2.2 skrll continue; 588 1.1.2.2 skrll } 589 1.1.2.2 skrll sin = sctp_is_v4_ifa_addr_acceptable (laddr->ifa, loopscope, ipv4_scope, &sin_loop, &sin_local); 590 1.1.2.2 skrll if (sin == NULL) 591 1.1.2.2 skrll continue; 592 1.1.2.2 skrll return (sin->sin_addr); 593 1.1.2.2 skrll 594 1.1.2.2 skrll } 595 1.1.2.2 skrll 596 1.1.2.2 skrll /* no address bound can be a source for the destination we are in trouble */ 597 1.1.2.2 skrll #ifdef SCTP_DEBUG 598 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 599 1.1.2.2 skrll printf("Src address selection for EP, no acceptable src address found for address\n"); 600 1.1.2.2 skrll } 601 1.1.2.2 skrll #endif 602 1.1.2.2 skrll memset(&ans, 0, sizeof(ans)); 603 1.1.2.2 skrll return (ans); 604 1.1.2.2 skrll } 605 1.1.2.2 skrll 606 1.1.2.2 skrll 607 1.1.2.2 skrll 608 1.1.2.2 skrll static struct in_addr 609 1.1.2.2 skrll sctp_choose_v4_boundspecific_stcb(struct sctp_inpcb *inp, 610 1.1.2.2 skrll struct sctp_tcb *stcb, 611 1.1.2.2 skrll struct sctp_nets *net, 612 1.1.2.2 skrll struct rtentry *rt, 613 1.1.2.2 skrll uint8_t ipv4_scope, 614 1.1.2.2 skrll uint8_t loopscope, 615 1.1.2.2 skrll int non_asoc_addr_ok) 616 1.1.2.2 skrll { 617 1.1.2.2 skrll /* 618 1.1.2.2 skrll * Here we have two cases, bound all asconf 619 1.1.2.2 skrll * allowed. bound all asconf not allowed. 620 1.1.2.2 skrll * 621 1.1.2.2 skrll */ 622 1.1.2.2 skrll struct sctp_laddr *laddr, *starting_point; 623 1.1.2.2 skrll struct in_addr ans; 624 1.1.2.2 skrll struct ifnet *ifn; 625 1.1.2.2 skrll struct ifaddr *ifa; 626 1.1.2.2 skrll uint8_t sin_loop, sin_local, start_at_beginning=0; 627 1.1.2.2 skrll struct sockaddr_in *sin; 628 1.1.2.2 skrll 629 1.1.2.2 skrll /* first question, is the ifn we will emit on 630 1.1.2.2 skrll * in our list, if so, we want that one. 631 1.1.2.2 skrll */ 632 1.1.2.2 skrll ifn = rt->rt_ifp; 633 1.1.2.2 skrll 634 1.1.2.2 skrll if (inp->sctp_flags & SCTP_PCB_FLAGS_DO_ASCONF) { 635 1.1.2.2 skrll /* 636 1.1.2.2 skrll * Here we use the list of addresses on the endpoint. Then 637 1.1.2.2 skrll * the addresses listed on the "restricted" list is just that, 638 1.1.2.2 skrll * address that have not been added and can't be used (unless 639 1.1.2.2 skrll * the non_asoc_addr_ok is set). 640 1.1.2.2 skrll */ 641 1.1.2.2 skrll #ifdef SCTP_DEBUG 642 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 643 1.1.2.2 skrll printf("Have a STCB - asconf allowed, not bound all have a netgative list\n"); 644 1.1.2.2 skrll } 645 1.1.2.2 skrll #endif 646 1.1.2.2 skrll /* first question, is the ifn we will emit on 647 1.1.2.2 skrll * in our list, if so, we want that one. 648 1.1.2.2 skrll */ 649 1.1.2.2 skrll if (ifn) { 650 1.1.2.2 skrll /* first try for an prefered address on the ep */ 651 1.1.2.2 skrll TAILQ_FOREACH(ifa, &ifn->if_addrlist, ifa_list) { 652 1.1.2.2 skrll if (sctp_is_addr_in_ep(inp, ifa)) { 653 1.1.2.2 skrll sin = sctp_is_v4_ifa_addr_prefered (ifa, loopscope, ipv4_scope, &sin_loop, &sin_local); 654 1.1.2.2 skrll if (sin == NULL) 655 1.1.2.2 skrll continue; 656 1.1.2.2 skrll if ((non_asoc_addr_ok == 0) && 657 1.1.2.2 skrll (sctp_is_addr_restricted(stcb, (struct sockaddr *)sin))) { 658 1.1.2.2 skrll /* on the no-no list */ 659 1.1.2.2 skrll continue; 660 1.1.2.2 skrll } 661 1.1.2.2 skrll return (sin->sin_addr); 662 1.1.2.2 skrll } 663 1.1.2.2 skrll } 664 1.1.2.2 skrll /* next try for an acceptable address on the ep */ 665 1.1.2.2 skrll TAILQ_FOREACH(ifa, &ifn->if_addrlist, ifa_list) { 666 1.1.2.2 skrll if (sctp_is_addr_in_ep(inp, ifa)) { 667 1.1.2.2 skrll sin = sctp_is_v4_ifa_addr_acceptable (ifa, loopscope, ipv4_scope, &sin_loop, &sin_local); 668 1.1.2.2 skrll if (sin == NULL) 669 1.1.2.2 skrll continue; 670 1.1.2.2 skrll if ((non_asoc_addr_ok == 0) && 671 1.1.2.2 skrll (sctp_is_addr_restricted(stcb, (struct sockaddr *)sin))) { 672 1.1.2.2 skrll /* on the no-no list */ 673 1.1.2.2 skrll continue; 674 1.1.2.2 skrll } 675 1.1.2.2 skrll return (sin->sin_addr); 676 1.1.2.2 skrll } 677 1.1.2.2 skrll } 678 1.1.2.2 skrll 679 1.1.2.2 skrll } 680 1.1.2.2 skrll /* if we can't find one like that then we must 681 1.1.2.2 skrll * look at all addresses bound to pick one at 682 1.1.2.2 skrll * first prefereable then secondly acceptable. 683 1.1.2.2 skrll */ 684 1.1.2.2 skrll starting_point = stcb->asoc.last_used_address; 685 1.1.2.2 skrll sctpv4_from_the_top: 686 1.1.2.2 skrll if (stcb->asoc.last_used_address == NULL) { 687 1.1.2.2 skrll start_at_beginning=1; 688 1.1.2.2 skrll stcb->asoc.last_used_address = LIST_FIRST(&inp->sctp_addr_list); 689 1.1.2.2 skrll } 690 1.1.2.2 skrll /* search beginning with the last used address */ 691 1.1.2.2 skrll for (laddr = stcb->asoc.last_used_address; laddr; 692 1.1.2.2 skrll laddr = LIST_NEXT(laddr, sctp_nxt_addr)) { 693 1.1.2.2 skrll if (laddr->ifa == NULL) { 694 1.1.2.2 skrll /* address has been removed */ 695 1.1.2.2 skrll continue; 696 1.1.2.2 skrll } 697 1.1.2.2 skrll sin = sctp_is_v4_ifa_addr_prefered (laddr->ifa, loopscope, ipv4_scope, &sin_loop, &sin_local); 698 1.1.2.2 skrll if (sin == NULL) 699 1.1.2.2 skrll continue; 700 1.1.2.2 skrll if ((non_asoc_addr_ok == 0) && 701 1.1.2.2 skrll (sctp_is_addr_restricted(stcb, (struct sockaddr *)sin))) { 702 1.1.2.2 skrll /* on the no-no list */ 703 1.1.2.2 skrll continue; 704 1.1.2.2 skrll } 705 1.1.2.2 skrll return (sin->sin_addr); 706 1.1.2.2 skrll 707 1.1.2.2 skrll } 708 1.1.2.2 skrll if (start_at_beginning == 0) { 709 1.1.2.2 skrll stcb->asoc.last_used_address = NULL; 710 1.1.2.2 skrll goto sctpv4_from_the_top; 711 1.1.2.2 skrll } 712 1.1.2.2 skrll /* now try for any higher scope than the destination */ 713 1.1.2.2 skrll stcb->asoc.last_used_address = starting_point; 714 1.1.2.2 skrll start_at_beginning = 0; 715 1.1.2.2 skrll sctpv4_from_the_top2: 716 1.1.2.2 skrll if (stcb->asoc.last_used_address == NULL) { 717 1.1.2.2 skrll start_at_beginning=1; 718 1.1.2.2 skrll stcb->asoc.last_used_address = LIST_FIRST(&inp->sctp_addr_list); 719 1.1.2.2 skrll } 720 1.1.2.2 skrll /* search beginning with the last used address */ 721 1.1.2.2 skrll for (laddr = stcb->asoc.last_used_address; laddr; 722 1.1.2.2 skrll laddr = LIST_NEXT(laddr, sctp_nxt_addr)) { 723 1.1.2.2 skrll if (laddr->ifa == NULL) { 724 1.1.2.2 skrll /* address has been removed */ 725 1.1.2.2 skrll continue; 726 1.1.2.2 skrll } 727 1.1.2.2 skrll sin = sctp_is_v4_ifa_addr_acceptable (laddr->ifa, loopscope, ipv4_scope, &sin_loop, &sin_local); 728 1.1.2.2 skrll if (sin == NULL) 729 1.1.2.2 skrll continue; 730 1.1.2.2 skrll if ((non_asoc_addr_ok == 0) && 731 1.1.2.2 skrll (sctp_is_addr_restricted(stcb, (struct sockaddr *)sin))) { 732 1.1.2.2 skrll /* on the no-no list */ 733 1.1.2.2 skrll continue; 734 1.1.2.2 skrll } 735 1.1.2.2 skrll return (sin->sin_addr); 736 1.1.2.2 skrll } 737 1.1.2.2 skrll if (start_at_beginning == 0) { 738 1.1.2.2 skrll stcb->asoc.last_used_address = NULL; 739 1.1.2.2 skrll goto sctpv4_from_the_top2; 740 1.1.2.2 skrll } 741 1.1.2.2 skrll } else { 742 1.1.2.2 skrll /* 743 1.1.2.2 skrll * Here we have an address list on the association, thats the 744 1.1.2.2 skrll * only valid source addresses that we can use. 745 1.1.2.2 skrll */ 746 1.1.2.2 skrll #ifdef SCTP_DEBUG 747 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 748 1.1.2.2 skrll printf("Have a STCB - no asconf allowed, not bound all have a postive list\n"); 749 1.1.2.2 skrll } 750 1.1.2.2 skrll #endif 751 1.1.2.2 skrll /* First look at all addresses for one that is on 752 1.1.2.2 skrll * the interface we route out 753 1.1.2.2 skrll */ 754 1.1.2.2 skrll LIST_FOREACH(laddr, &stcb->asoc.sctp_local_addr_list, 755 1.1.2.2 skrll sctp_nxt_addr) { 756 1.1.2.2 skrll if (laddr->ifa == NULL) { 757 1.1.2.2 skrll /* address has been removed */ 758 1.1.2.2 skrll continue; 759 1.1.2.2 skrll } 760 1.1.2.2 skrll sin = sctp_is_v4_ifa_addr_prefered (laddr->ifa, loopscope, ipv4_scope, &sin_loop, &sin_local); 761 1.1.2.2 skrll if (sin == NULL) 762 1.1.2.2 skrll continue; 763 1.1.2.2 skrll /* first question, is laddr->ifa an address associated with the emit interface */ 764 1.1.2.2 skrll if (ifn) { 765 1.1.2.2 skrll TAILQ_FOREACH(ifa, &ifn->if_addrlist, ifa_list) { 766 1.1.2.2 skrll if (laddr->ifa == ifa) { 767 1.1.2.2 skrll sin = (struct sockaddr_in *)laddr->ifa->ifa_addr; 768 1.1.2.2 skrll return (sin->sin_addr); 769 1.1.2.2 skrll } 770 1.1.2.2 skrll if (sctp_cmpaddr(ifa->ifa_addr, laddr->ifa->ifa_addr) == 1) { 771 1.1.2.2 skrll sin = (struct sockaddr_in *)laddr->ifa->ifa_addr; 772 1.1.2.2 skrll return (sin->sin_addr); 773 1.1.2.2 skrll } 774 1.1.2.2 skrll } 775 1.1.2.2 skrll } 776 1.1.2.2 skrll } 777 1.1.2.2 skrll /* what about an acceptable one on the interface? */ 778 1.1.2.2 skrll LIST_FOREACH(laddr, &stcb->asoc.sctp_local_addr_list, 779 1.1.2.2 skrll sctp_nxt_addr) { 780 1.1.2.2 skrll if (laddr->ifa == NULL) { 781 1.1.2.2 skrll /* address has been removed */ 782 1.1.2.2 skrll continue; 783 1.1.2.2 skrll } 784 1.1.2.2 skrll sin = sctp_is_v4_ifa_addr_acceptable (laddr->ifa, loopscope, ipv4_scope, &sin_loop, &sin_local); 785 1.1.2.2 skrll if (sin == NULL) 786 1.1.2.2 skrll continue; 787 1.1.2.2 skrll /* first question, is laddr->ifa an address associated with the emit interface */ 788 1.1.2.2 skrll if (ifn) { 789 1.1.2.2 skrll TAILQ_FOREACH(ifa, &ifn->if_addrlist, ifa_list) { 790 1.1.2.2 skrll if (laddr->ifa == ifa) { 791 1.1.2.2 skrll sin = (struct sockaddr_in *)laddr->ifa->ifa_addr; 792 1.1.2.2 skrll return (sin->sin_addr); 793 1.1.2.2 skrll } 794 1.1.2.2 skrll if (sctp_cmpaddr(ifa->ifa_addr, laddr->ifa->ifa_addr) == 1) { 795 1.1.2.2 skrll sin = (struct sockaddr_in *)laddr->ifa->ifa_addr; 796 1.1.2.2 skrll return (sin->sin_addr); 797 1.1.2.2 skrll } 798 1.1.2.2 skrll } 799 1.1.2.2 skrll } 800 1.1.2.2 skrll } 801 1.1.2.2 skrll /* ok, next one that is preferable in general */ 802 1.1.2.2 skrll LIST_FOREACH(laddr, &stcb->asoc.sctp_local_addr_list, 803 1.1.2.2 skrll sctp_nxt_addr) { 804 1.1.2.2 skrll if (laddr->ifa == NULL) { 805 1.1.2.2 skrll /* address has been removed */ 806 1.1.2.2 skrll continue; 807 1.1.2.2 skrll } 808 1.1.2.2 skrll sin = sctp_is_v4_ifa_addr_prefered (laddr->ifa, loopscope, ipv4_scope, &sin_loop, &sin_local); 809 1.1.2.2 skrll if (sin == NULL) 810 1.1.2.2 skrll continue; 811 1.1.2.2 skrll return (sin->sin_addr); 812 1.1.2.2 skrll } 813 1.1.2.2 skrll 814 1.1.2.2 skrll /* last, what about one that is acceptable */ 815 1.1.2.2 skrll LIST_FOREACH(laddr, &stcb->asoc.sctp_local_addr_list, 816 1.1.2.2 skrll sctp_nxt_addr) { 817 1.1.2.2 skrll if (laddr->ifa == NULL) { 818 1.1.2.2 skrll /* address has been removed */ 819 1.1.2.2 skrll continue; 820 1.1.2.2 skrll } 821 1.1.2.2 skrll sin = sctp_is_v4_ifa_addr_acceptable (laddr->ifa, loopscope, ipv4_scope, &sin_loop, &sin_local); 822 1.1.2.2 skrll if (sin == NULL) 823 1.1.2.2 skrll continue; 824 1.1.2.2 skrll return (sin->sin_addr); 825 1.1.2.2 skrll } 826 1.1.2.2 skrll } 827 1.1.2.2 skrll memset(&ans, 0, sizeof(ans)); 828 1.1.2.2 skrll return (ans); 829 1.1.2.2 skrll } 830 1.1.2.2 skrll 831 1.1.2.2 skrll static struct sockaddr_in * 832 1.1.2.2 skrll sctp_select_v4_nth_prefered_addr_from_ifn_boundall (struct ifnet *ifn, struct sctp_tcb *stcb, int non_asoc_addr_ok, 833 1.1.2.2 skrll uint8_t loopscope, uint8_t ipv4_scope, int cur_addr_num) 834 1.1.2.2 skrll { 835 1.1.2.2 skrll struct ifaddr *ifa; 836 1.1.2.2 skrll struct sockaddr_in *sin; 837 1.1.2.2 skrll uint8_t sin_loop, sin_local; 838 1.1.2.2 skrll int num_eligible_addr = 0; 839 1.1.2.2 skrll TAILQ_FOREACH(ifa, &ifn->if_addrlist, ifa_list) { 840 1.1.2.2 skrll sin = sctp_is_v4_ifa_addr_prefered (ifa, loopscope, ipv4_scope, &sin_loop, &sin_local); 841 1.1.2.2 skrll if (sin == NULL) 842 1.1.2.2 skrll continue; 843 1.1.2.2 skrll if (stcb) { 844 1.1.2.2 skrll if ((non_asoc_addr_ok == 0) && sctp_is_addr_restricted(stcb, (struct sockaddr *)sin)) { 845 1.1.2.2 skrll /* It is restricted for some reason.. probably 846 1.1.2.2 skrll * not yet added. 847 1.1.2.2 skrll */ 848 1.1.2.2 skrll continue; 849 1.1.2.2 skrll } 850 1.1.2.2 skrll } 851 1.1.2.2 skrll if (cur_addr_num == num_eligible_addr) { 852 1.1.2.2 skrll return (sin); 853 1.1.2.2 skrll } 854 1.1.2.2 skrll } 855 1.1.2.2 skrll return (NULL); 856 1.1.2.2 skrll } 857 1.1.2.2 skrll 858 1.1.2.2 skrll 859 1.1.2.2 skrll static int 860 1.1.2.2 skrll sctp_count_v4_num_prefered_boundall (struct ifnet *ifn, struct sctp_tcb *stcb, int non_asoc_addr_ok, 861 1.1.2.2 skrll uint8_t loopscope, uint8_t ipv4_scope, uint8_t *sin_loop, uint8_t *sin_local) 862 1.1.2.2 skrll { 863 1.1.2.2 skrll struct ifaddr *ifa; 864 1.1.2.2 skrll struct sockaddr_in *sin; 865 1.1.2.2 skrll int num_eligible_addr = 0; 866 1.1.2.2 skrll 867 1.1.2.2 skrll TAILQ_FOREACH(ifa, &ifn->if_addrlist, ifa_list) { 868 1.1.2.2 skrll sin = sctp_is_v4_ifa_addr_prefered (ifa, loopscope, ipv4_scope, sin_loop, sin_local); 869 1.1.2.2 skrll if (sin == NULL) 870 1.1.2.2 skrll continue; 871 1.1.2.2 skrll if (stcb) { 872 1.1.2.2 skrll if ((non_asoc_addr_ok == 0) && sctp_is_addr_restricted(stcb, (struct sockaddr *)sin)) { 873 1.1.2.2 skrll /* It is restricted for some reason.. probably 874 1.1.2.2 skrll * not yet added. 875 1.1.2.2 skrll */ 876 1.1.2.2 skrll continue; 877 1.1.2.2 skrll } 878 1.1.2.2 skrll } 879 1.1.2.2 skrll num_eligible_addr++; 880 1.1.2.2 skrll } 881 1.1.2.2 skrll return (num_eligible_addr); 882 1.1.2.2 skrll 883 1.1.2.2 skrll } 884 1.1.2.2 skrll 885 1.1.2.2 skrll static struct in_addr 886 1.1.2.2 skrll sctp_choose_v4_boundall(struct sctp_inpcb *inp, 887 1.1.2.2 skrll struct sctp_tcb *stcb, 888 1.1.2.2 skrll struct sctp_nets *net, 889 1.1.2.2 skrll struct rtentry *rt, 890 1.1.2.2 skrll uint8_t ipv4_scope, 891 1.1.2.2 skrll uint8_t loopscope, 892 1.1.2.2 skrll int non_asoc_addr_ok) 893 1.1.2.2 skrll { 894 1.1.2.2 skrll int cur_addr_num=0, num_prefered=0; 895 1.1.2.2 skrll uint8_t sin_loop, sin_local; 896 1.1.2.2 skrll struct ifnet *ifn; 897 1.1.2.2 skrll struct sockaddr_in *sin; 898 1.1.2.2 skrll struct in_addr ans; 899 1.1.2.2 skrll struct ifaddr *ifa; 900 1.1.2.2 skrll /* 901 1.1.2.2 skrll * For v4 we can use (in boundall) any address in the association. If 902 1.1.2.2 skrll * non_asoc_addr_ok is set we can use any address (at least in theory). 903 1.1.2.2 skrll * So we look for prefered addresses first. If we find one, we use it. 904 1.1.2.2 skrll * Otherwise we next try to get an address on the interface, which we 905 1.1.2.2 skrll * should be able to do (unless non_asoc_addr_ok is false and we are 906 1.1.2.2 skrll * routed out that way). In these cases where we can't use the address 907 1.1.2.2 skrll * of the interface we go through all the ifn's looking for an address 908 1.1.2.2 skrll * we can use and fill that in. Punting means we send back address 909 1.1.2.2 skrll * 0, which will probably cause problems actually since then IP will 910 1.1.2.2 skrll * fill in the address of the route ifn, which means we probably already 911 1.1.2.2 skrll * rejected it.. i.e. here comes an abort :-<. 912 1.1.2.2 skrll */ 913 1.1.2.2 skrll ifn = rt->rt_ifp; 914 1.1.2.2 skrll if (net) { 915 1.1.2.2 skrll cur_addr_num = net->indx_of_eligible_next_to_use; 916 1.1.2.2 skrll } 917 1.1.2.2 skrll if (ifn == NULL) { 918 1.1.2.2 skrll goto bound_all_v4_plan_c; 919 1.1.2.2 skrll } 920 1.1.2.2 skrll num_prefered = sctp_count_v4_num_prefered_boundall (ifn, stcb, non_asoc_addr_ok, loopscope, ipv4_scope, &sin_loop, &sin_local); 921 1.1.2.2 skrll #ifdef SCTP_DEBUG 922 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 923 1.1.2.2 skrll printf("Found %d prefered source addresses\n", num_prefered); 924 1.1.2.2 skrll } 925 1.1.2.2 skrll #endif 926 1.1.2.2 skrll if (num_prefered == 0) { 927 1.1.2.2 skrll /* no eligible addresses, we must use some other 928 1.1.2.2 skrll * interface address if we can find one. 929 1.1.2.2 skrll */ 930 1.1.2.2 skrll goto bound_all_v4_plan_b; 931 1.1.2.2 skrll } 932 1.1.2.2 skrll /* Ok we have num_eligible_addr set with how many we can use, 933 1.1.2.2 skrll * this may vary from call to call due to addresses being deprecated etc.. 934 1.1.2.2 skrll */ 935 1.1.2.2 skrll if (cur_addr_num >= num_prefered) { 936 1.1.2.2 skrll cur_addr_num = 0; 937 1.1.2.2 skrll } 938 1.1.2.2 skrll /* select the nth address from the list (where cur_addr_num is the nth) and 939 1.1.2.2 skrll * 0 is the first one, 1 is the second one etc... 940 1.1.2.2 skrll */ 941 1.1.2.2 skrll #ifdef SCTP_DEBUG 942 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 943 1.1.2.2 skrll printf("cur_addr_num:%d\n", cur_addr_num); 944 1.1.2.2 skrll } 945 1.1.2.2 skrll #endif 946 1.1.2.2 skrll sin = sctp_select_v4_nth_prefered_addr_from_ifn_boundall (ifn, stcb, non_asoc_addr_ok, loopscope, 947 1.1.2.2 skrll ipv4_scope, cur_addr_num); 948 1.1.2.2 skrll 949 1.1.2.2 skrll /* if sin is NULL something changed??, plan_a now */ 950 1.1.2.2 skrll if (sin) { 951 1.1.2.2 skrll return (sin->sin_addr); 952 1.1.2.2 skrll } 953 1.1.2.2 skrll 954 1.1.2.2 skrll /* 955 1.1.2.2 skrll * plan_b: Look at the interface that we emit on 956 1.1.2.2 skrll * and see if we can find an acceptable address. 957 1.1.2.2 skrll */ 958 1.1.2.2 skrll bound_all_v4_plan_b: 959 1.1.2.2 skrll TAILQ_FOREACH(ifa, &ifn->if_addrlist, ifa_list) { 960 1.1.2.2 skrll sin = sctp_is_v4_ifa_addr_acceptable (ifa, loopscope, ipv4_scope, &sin_loop, &sin_local); 961 1.1.2.2 skrll if (sin == NULL) 962 1.1.2.2 skrll continue; 963 1.1.2.2 skrll if (stcb) { 964 1.1.2.2 skrll if ((non_asoc_addr_ok == 0) && sctp_is_addr_restricted(stcb, (struct sockaddr *)sin)) { 965 1.1.2.2 skrll /* It is restricted for some reason.. probably 966 1.1.2.2 skrll * not yet added. 967 1.1.2.2 skrll */ 968 1.1.2.2 skrll continue; 969 1.1.2.2 skrll } 970 1.1.2.2 skrll } 971 1.1.2.2 skrll return (sin->sin_addr); 972 1.1.2.2 skrll } 973 1.1.2.2 skrll /* 974 1.1.2.2 skrll * plan_c: Look at all interfaces and find a prefered 975 1.1.2.2 skrll * address. If we reache here we are in trouble I think. 976 1.1.2.2 skrll */ 977 1.1.2.2 skrll bound_all_v4_plan_c: 978 1.1.2.2 skrll for (ifn = TAILQ_FIRST(&ifnet_list); 979 1.1.2.2 skrll ifn && (ifn != inp->next_ifn_touse); 980 1.1.2.2 skrll ifn=TAILQ_NEXT(ifn, if_list)) { 981 1.1.2.2 skrll if (loopscope == 0 && ifn->if_type == IFT_LOOP) { 982 1.1.2.2 skrll /* wrong base scope */ 983 1.1.2.2 skrll continue; 984 1.1.2.2 skrll } 985 1.1.2.2 skrll if (ifn == rt->rt_ifp) 986 1.1.2.2 skrll /* already looked at this guy */ 987 1.1.2.2 skrll continue; 988 1.1.2.2 skrll num_prefered = sctp_count_v4_num_prefered_boundall (ifn, stcb, non_asoc_addr_ok, 989 1.1.2.2 skrll loopscope, ipv4_scope, &sin_loop, &sin_local); 990 1.1.2.2 skrll #ifdef SCTP_DEBUG 991 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 992 1.1.2.2 skrll printf("Found ifn:%p %d prefered source addresses\n", ifn, num_prefered); 993 1.1.2.2 skrll } 994 1.1.2.2 skrll #endif 995 1.1.2.2 skrll if (num_prefered == 0) { 996 1.1.2.2 skrll /* 997 1.1.2.2 skrll * None on this interface. 998 1.1.2.2 skrll */ 999 1.1.2.2 skrll continue; 1000 1.1.2.2 skrll } 1001 1.1.2.2 skrll /* Ok we have num_eligible_addr set with how many we can use, 1002 1.1.2.2 skrll * this may vary from call to call due to addresses being deprecated etc.. 1003 1.1.2.2 skrll */ 1004 1.1.2.2 skrll if (cur_addr_num >= num_prefered) { 1005 1.1.2.2 skrll cur_addr_num = 0; 1006 1.1.2.2 skrll } 1007 1.1.2.2 skrll sin = sctp_select_v4_nth_prefered_addr_from_ifn_boundall (ifn, stcb, non_asoc_addr_ok, loopscope, 1008 1.1.2.2 skrll ipv4_scope, cur_addr_num); 1009 1.1.2.2 skrll if (sin == NULL) 1010 1.1.2.2 skrll continue; 1011 1.1.2.2 skrll return (sin->sin_addr); 1012 1.1.2.2 skrll 1013 1.1.2.2 skrll } 1014 1.1.2.2 skrll 1015 1.1.2.2 skrll /* 1016 1.1.2.2 skrll * plan_d: We are in deep trouble. No prefered address on 1017 1.1.2.2 skrll * any interface. And the emit interface does not 1018 1.1.2.2 skrll * even have an acceptable address. Take anything 1019 1.1.2.2 skrll * we can get! If this does not work we are 1020 1.1.2.2 skrll * probably going to emit a packet that will 1021 1.1.2.2 skrll * illicit an ABORT, falling through. 1022 1.1.2.2 skrll */ 1023 1.1.2.2 skrll 1024 1.1.2.2 skrll for (ifn = TAILQ_FIRST(&ifnet_list); 1025 1.1.2.2 skrll ifn && (ifn != inp->next_ifn_touse); 1026 1.1.2.2 skrll ifn=TAILQ_NEXT(ifn, if_list)) { 1027 1.1.2.2 skrll if (loopscope == 0 && ifn->if_type == IFT_LOOP) { 1028 1.1.2.2 skrll /* wrong base scope */ 1029 1.1.2.2 skrll continue; 1030 1.1.2.2 skrll } 1031 1.1.2.2 skrll if (ifn == rt->rt_ifp) 1032 1.1.2.2 skrll /* already looked at this guy */ 1033 1.1.2.2 skrll continue; 1034 1.1.2.2 skrll 1035 1.1.2.2 skrll TAILQ_FOREACH(ifa, &ifn->if_addrlist, ifa_list) { 1036 1.1.2.2 skrll sin = sctp_is_v4_ifa_addr_acceptable (ifa, loopscope, ipv4_scope, &sin_loop, &sin_local); 1037 1.1.2.2 skrll if (sin == NULL) 1038 1.1.2.2 skrll continue; 1039 1.1.2.2 skrll if (stcb) { 1040 1.1.2.2 skrll if ((non_asoc_addr_ok == 0) && sctp_is_addr_restricted(stcb, (struct sockaddr *)sin)) { 1041 1.1.2.2 skrll /* It is restricted for some reason.. probably 1042 1.1.2.2 skrll * not yet added. 1043 1.1.2.2 skrll */ 1044 1.1.2.2 skrll continue; 1045 1.1.2.2 skrll } 1046 1.1.2.2 skrll } 1047 1.1.2.2 skrll return (sin->sin_addr); 1048 1.1.2.2 skrll } 1049 1.1.2.2 skrll } 1050 1.1.2.2 skrll /* 1051 1.1.2.2 skrll * Ok we can find NO address to source from that is 1052 1.1.2.2 skrll * not on our negative list. It is either the special 1053 1.1.2.2 skrll * ASCONF case where we are sourceing from a intf that 1054 1.1.2.2 skrll * has been ifconfig'd to a different address (i.e. 1055 1.1.2.2 skrll * it holds a ADD/DEL/SET-PRIM and the proper lookup 1056 1.1.2.2 skrll * address. OR we are hosed, and this baby is going 1057 1.1.2.2 skrll * to abort the association. 1058 1.1.2.2 skrll */ 1059 1.1.2.2 skrll if (non_asoc_addr_ok) { 1060 1.1.2.2 skrll return (((struct sockaddr_in *)(rt->rt_ifa->ifa_addr))->sin_addr); 1061 1.1.2.2 skrll } else { 1062 1.1.2.2 skrll memset(&ans, 0, sizeof(ans)); 1063 1.1.2.2 skrll return (ans); 1064 1.1.2.2 skrll } 1065 1.1.2.2 skrll } 1066 1.1.2.2 skrll 1067 1.1.2.2 skrll 1068 1.1.2.2 skrll 1069 1.1.2.2 skrll /* tcb may be NULL */ 1070 1.1.2.2 skrll struct in_addr 1071 1.1.2.2 skrll sctp_ipv4_source_address_selection(struct sctp_inpcb *inp, 1072 1.1.2.2 skrll struct sctp_tcb *stcb, struct route *ro, struct sctp_nets *net, 1073 1.1.2.2 skrll int non_asoc_addr_ok) 1074 1.1.2.2 skrll { 1075 1.1.2.2 skrll struct in_addr ans; 1076 1.1.2.2 skrll const struct sockaddr_in *to; 1077 1.1.2.2 skrll struct rtentry *rt; 1078 1.1.2.2 skrll uint8_t ipv4_scope, loopscope; 1079 1.1.2.2 skrll /* 1080 1.1.2.2 skrll * Rules: 1081 1.1.2.2 skrll * - Find the route if needed, cache if I can. 1082 1.1.2.2 skrll * - Look at interface address in route, Is it 1083 1.1.2.2 skrll * in the bound list. If so we have the best source. 1084 1.1.2.2 skrll * - If not we must rotate amongst the addresses. 1085 1.1.2.2 skrll * 1086 1.1.2.2 skrll * Cavets and issues 1087 1.1.2.2 skrll * 1088 1.1.2.2 skrll * Do we need to pay attention to scope. We can have 1089 1.1.2.2 skrll * a private address or a global address we are sourcing 1090 1.1.2.2 skrll * or sending to. So if we draw it out 1091 1.1.2.2 skrll * source * dest * result 1092 1.1.2.2 skrll * ------------------------------------------ 1093 1.1.2.2 skrll * a Private * Global * NAT? 1094 1.1.2.2 skrll * ------------------------------------------ 1095 1.1.2.2 skrll * b Private * Private * No problem 1096 1.1.2.2 skrll * ------------------------------------------ 1097 1.1.2.2 skrll * c Global * Private * Huh, How will this work? 1098 1.1.2.2 skrll * ------------------------------------------ 1099 1.1.2.2 skrll * d Global * Global * No Problem 1100 1.1.2.2 skrll * ------------------------------------------ 1101 1.1.2.2 skrll * 1102 1.1.2.2 skrll * And then we add to that what happens if there are multiple 1103 1.1.2.2 skrll * addresses assigned to an interface. Remember the ifa on a 1104 1.1.2.2 skrll * ifn is a linked list of addresses. So one interface can 1105 1.1.2.2 skrll * have more than one IPv4 address. What happens if we 1106 1.1.2.2 skrll * have both a private and a global address? Do we then 1107 1.1.2.2 skrll * use context of destination to sort out which one is 1108 1.1.2.2 skrll * best? And what about NAT's sending P->G may get you 1109 1.1.2.2 skrll * a NAT translation, or should you select the G thats 1110 1.1.2.2 skrll * on the interface in preference. 1111 1.1.2.2 skrll * 1112 1.1.2.2 skrll * Decisions: 1113 1.1.2.2 skrll * 1114 1.1.2.2 skrll * - count the number of addresses on the interface. 1115 1.1.2.2 skrll * - if its one, no problem except case <c>. For <a> 1116 1.1.2.2 skrll * we will assume a NAT out there. 1117 1.1.2.2 skrll * - if there are more than one, then we need to worry 1118 1.1.2.2 skrll * about scope P or G. We should prefer G -> G and 1119 1.1.2.2 skrll * P -> P if possible. Then as a secondary fall back 1120 1.1.2.2 skrll * to mixed types G->P being a last ditch one. 1121 1.1.2.2 skrll * - The above all works for bound all, but bound 1122 1.1.2.2 skrll * specific we need to use the same concept but instead 1123 1.1.2.2 skrll * only consider the bound addresses. If the bound set 1124 1.1.2.2 skrll * is NOT assigned to the interface then we must use 1125 1.1.2.2 skrll * rotation amongst them. 1126 1.1.2.2 skrll * 1127 1.1.2.2 skrll * Notes: For v4, we can always punt and let ip_output 1128 1.1.2.2 skrll * decide by sending back a source of 0.0.0.0 1129 1.1.2.2 skrll */ 1130 1.1.2.2 skrll 1131 1.1.2.2 skrll /* 1132 1.1.2.2 skrll * Need a route to cache. 1133 1.1.2.2 skrll * 1134 1.1.2.2 skrll */ 1135 1.1.2.2 skrll rt = rtcache_validate(ro); 1136 1.1.2.2 skrll if (rt == NULL) { 1137 1.1.2.2 skrll /* No route to host .. punt */ 1138 1.1.2.2 skrll memset(&ans, 0, sizeof(ans)); 1139 1.1.2.2 skrll return (ans); 1140 1.1.2.2 skrll } else { 1141 1.1.2.2 skrll to = satocsin(rtcache_getdst(ro)); 1142 1.1.2.2 skrll } 1143 1.1.2.2 skrll /* Setup our scopes */ 1144 1.1.2.2 skrll if (stcb) { 1145 1.1.2.2 skrll ipv4_scope = stcb->asoc.ipv4_local_scope; 1146 1.1.2.2 skrll loopscope = stcb->asoc.loopback_scope; 1147 1.1.2.2 skrll } else { 1148 1.1.2.2 skrll /* Scope based on outbound address */ 1149 1.1.2.2 skrll if ((IN4_ISPRIVATE_ADDRESS(&to->sin_addr))) { 1150 1.1.2.2 skrll ipv4_scope = 1; 1151 1.1.2.2 skrll loopscope = 0; 1152 1.1.2.2 skrll } else if (IN4_ISLOOPBACK_ADDRESS(&to->sin_addr)) { 1153 1.1.2.2 skrll ipv4_scope = 1; 1154 1.1.2.2 skrll loopscope = 1; 1155 1.1.2.2 skrll } else { 1156 1.1.2.2 skrll ipv4_scope = 0; 1157 1.1.2.2 skrll loopscope = 0; 1158 1.1.2.2 skrll } 1159 1.1.2.2 skrll } 1160 1.1.2.2 skrll #ifdef SCTP_DEBUG 1161 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 1162 1.1.2.2 skrll printf("Scope setup loop:%d ipv4_scope:%d\n", 1163 1.1.2.2 skrll loopscope, ipv4_scope); 1164 1.1.2.2 skrll } 1165 1.1.2.2 skrll #endif 1166 1.1.2.2 skrll if (inp->sctp_flags & SCTP_PCB_FLAGS_BOUNDALL) { 1167 1.1.2.2 skrll /* 1168 1.1.2.2 skrll * When bound to all if the address list is set 1169 1.1.2.2 skrll * it is a negative list. Addresses being added 1170 1.1.2.2 skrll * by asconf. 1171 1.1.2.2 skrll */ 1172 1.1.2.2 skrll return (sctp_choose_v4_boundall(inp, stcb, net, rt, 1173 1.1.2.2 skrll ipv4_scope, loopscope, non_asoc_addr_ok)); 1174 1.1.2.2 skrll } 1175 1.1.2.2 skrll /* 1176 1.1.2.2 skrll * Three possiblities here: 1177 1.1.2.2 skrll * 1178 1.1.2.2 skrll * a) stcb is NULL, which means we operate only from 1179 1.1.2.2 skrll * the list of addresses (ifa's) bound to the assoc and 1180 1.1.2.2 skrll * we care not about the list. 1181 1.1.2.2 skrll * b) stcb is NOT-NULL, which means we have an assoc structure and 1182 1.1.2.2 skrll * auto-asconf is on. This means that the list of addresses is 1183 1.1.2.2 skrll * a NOT list. We use the list from the inp, but any listed address 1184 1.1.2.2 skrll * in our list is NOT yet added. However if the non_asoc_addr_ok is 1185 1.1.2.2 skrll * set we CAN use an address NOT available (i.e. being added). Its 1186 1.1.2.2 skrll * a negative list. 1187 1.1.2.2 skrll * c) stcb is NOT-NULL, which means we have an assoc structure and 1188 1.1.2.2 skrll * auto-asconf is off. This means that the list of addresses is 1189 1.1.2.2 skrll * the ONLY addresses I can use.. its positive. 1190 1.1.2.2 skrll * 1191 1.1.2.2 skrll * Note we collapse b & c into the same function just like in 1192 1.1.2.2 skrll * the v6 address selection. 1193 1.1.2.2 skrll */ 1194 1.1.2.2 skrll if (stcb) { 1195 1.1.2.2 skrll return (sctp_choose_v4_boundspecific_stcb(inp, stcb, net, 1196 1.1.2.2 skrll rt, ipv4_scope, loopscope, non_asoc_addr_ok)); 1197 1.1.2.2 skrll } else { 1198 1.1.2.2 skrll return (sctp_choose_v4_boundspecific_inp(inp, rt, 1199 1.1.2.2 skrll ipv4_scope, loopscope)); 1200 1.1.2.2 skrll } 1201 1.1.2.2 skrll /* this should not be reached */ 1202 1.1.2.2 skrll memset(&ans, 0, sizeof(ans)); 1203 1.1.2.2 skrll return (ans); 1204 1.1.2.2 skrll } 1205 1.1.2.2 skrll 1206 1.1.2.2 skrll 1207 1.1.2.2 skrll 1208 1.1.2.2 skrll static struct sockaddr_in6 * 1209 1.1.2.2 skrll sctp_is_v6_ifa_addr_acceptable (struct ifaddr *ifa, int loopscope, int loc_scope, int *sin_loop, int *sin_local) 1210 1.1.2.2 skrll { 1211 1.1.2.2 skrll struct in6_ifaddr *ifa6; 1212 1.1.2.2 skrll struct sockaddr_in6 *sin6; 1213 1.1.2.2 skrll 1214 1.1.2.2 skrll if (ifa->ifa_addr->sa_family != AF_INET6) { 1215 1.1.2.2 skrll /* forget non-v6 */ 1216 1.1.2.2 skrll return (NULL); 1217 1.1.2.2 skrll } 1218 1.1.2.2 skrll ifa6 = (struct in6_ifaddr *)ifa; 1219 1.1.2.2 skrll /* ok to use deprecated addresses? */ 1220 1.1.2.2 skrll if (!ip6_use_deprecated) { 1221 1.1.2.2 skrll if (IFA6_IS_DEPRECATED(ifa6)) { 1222 1.1.2.2 skrll /* can't use this type */ 1223 1.1.2.2 skrll return (NULL); 1224 1.1.2.2 skrll } 1225 1.1.2.2 skrll } 1226 1.1.2.2 skrll /* are we ok, with the current state of this address? */ 1227 1.1.2.2 skrll if (ifa6->ia6_flags & 1228 1.1.2.2 skrll (IN6_IFF_DETACHED | IN6_IFF_NOTREADY | IN6_IFF_ANYCAST)) { 1229 1.1.2.2 skrll /* Can't use these types */ 1230 1.1.2.2 skrll return (NULL); 1231 1.1.2.2 skrll } 1232 1.1.2.2 skrll /* Ok the address may be ok */ 1233 1.1.2.2 skrll sin6 = (struct sockaddr_in6 *)ifa->ifa_addr; 1234 1.1.2.2 skrll *sin_local = *sin_loop = 0; 1235 1.1.2.2 skrll if ((ifa->ifa_ifp->if_type == IFT_LOOP) || 1236 1.1.2.2 skrll (IN6_IS_ADDR_LOOPBACK(&sin6->sin6_addr))) { 1237 1.1.2.2 skrll *sin_loop = 1; 1238 1.1.2.2 skrll } 1239 1.1.2.2 skrll if (!loopscope && *sin_loop) { 1240 1.1.2.2 skrll /* Its a loopback address and we don't have loop scope */ 1241 1.1.2.2 skrll return (NULL); 1242 1.1.2.2 skrll } 1243 1.1.2.2 skrll if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr)) { 1244 1.1.2.2 skrll /* we skip unspecifed addresses */ 1245 1.1.2.2 skrll return (NULL); 1246 1.1.2.2 skrll } 1247 1.1.2.2 skrll 1248 1.1.2.2 skrll if (IN6_IS_ADDR_LINKLOCAL(&sin6->sin6_addr)) { 1249 1.1.2.2 skrll *sin_local = 1; 1250 1.1.2.2 skrll } 1251 1.1.2.2 skrll if (!loc_scope && *sin_local) { 1252 1.1.2.2 skrll /* Its a link local address, and we don't have link local scope */ 1253 1.1.2.2 skrll return (NULL); 1254 1.1.2.2 skrll } 1255 1.1.2.2 skrll return (sin6); 1256 1.1.2.2 skrll } 1257 1.1.2.2 skrll 1258 1.1.2.2 skrll 1259 1.1.2.2 skrll static struct sockaddr_in6 * 1260 1.1.2.2 skrll sctp_choose_v6_boundspecific_stcb(struct sctp_inpcb *inp, 1261 1.1.2.2 skrll struct sctp_tcb *stcb, 1262 1.1.2.2 skrll struct sctp_nets *net, 1263 1.1.2.2 skrll struct rtentry *rt, 1264 1.1.2.2 skrll uint8_t loc_scope, 1265 1.1.2.2 skrll uint8_t loopscope, 1266 1.1.2.2 skrll int non_asoc_addr_ok) 1267 1.1.2.2 skrll { 1268 1.1.2.2 skrll /* 1269 1.1.2.2 skrll * Each endpoint has a list of local addresses associated 1270 1.1.2.2 skrll * with it. The address list is either a "negative list" i.e. 1271 1.1.2.2 skrll * those addresses that are NOT allowed to be used as a source OR 1272 1.1.2.2 skrll * a "postive list" i.e. those addresses that CAN be used. 1273 1.1.2.2 skrll * 1274 1.1.2.2 skrll * Its a negative list if asconf is allowed. What we do 1275 1.1.2.2 skrll * in this case is use the ep address list BUT we have 1276 1.1.2.2 skrll * to cross check it against the negative list. 1277 1.1.2.2 skrll * 1278 1.1.2.2 skrll * In the case where NO asconf is allowed, we have just 1279 1.1.2.2 skrll * a straight association level list that we must use to 1280 1.1.2.2 skrll * find a source address. 1281 1.1.2.2 skrll */ 1282 1.1.2.2 skrll struct sctp_laddr *laddr, *starting_point; 1283 1.1.2.2 skrll struct sockaddr_in6 *sin6; 1284 1.1.2.2 skrll int sin_loop, sin_local; 1285 1.1.2.2 skrll int start_at_beginning=0; 1286 1.1.2.2 skrll struct ifnet *ifn; 1287 1.1.2.2 skrll struct ifaddr *ifa; 1288 1.1.2.2 skrll 1289 1.1.2.2 skrll ifn = rt->rt_ifp; 1290 1.1.2.2 skrll if (inp->sctp_flags & SCTP_PCB_FLAGS_DO_ASCONF) { 1291 1.1.2.2 skrll #ifdef SCTP_DEBUG 1292 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 1293 1.1.2.2 skrll printf("Have a STCB - asconf allowed, not bound all have a netgative list\n"); 1294 1.1.2.2 skrll } 1295 1.1.2.2 skrll #endif 1296 1.1.2.2 skrll /* first question, is the ifn we will emit on 1297 1.1.2.2 skrll * in our list, if so, we want that one. 1298 1.1.2.2 skrll */ 1299 1.1.2.2 skrll if (ifn) { 1300 1.1.2.2 skrll TAILQ_FOREACH(ifa, &ifn->if_addrlist, ifa_list) { 1301 1.1.2.2 skrll if (sctp_is_addr_in_ep(inp, ifa)) { 1302 1.1.2.2 skrll sin6 = sctp_is_v6_ifa_addr_acceptable (ifa, loopscope, loc_scope, &sin_loop, &sin_local); 1303 1.1.2.2 skrll if (sin6 == NULL) 1304 1.1.2.2 skrll continue; 1305 1.1.2.2 skrll if ((non_asoc_addr_ok == 0) && 1306 1.1.2.2 skrll (sctp_is_addr_restricted(stcb, (struct sockaddr *)sin6))) { 1307 1.1.2.2 skrll /* on the no-no list */ 1308 1.1.2.2 skrll continue; 1309 1.1.2.2 skrll } 1310 1.1.2.2 skrll return (sin6); 1311 1.1.2.2 skrll } 1312 1.1.2.2 skrll } 1313 1.1.2.2 skrll } 1314 1.1.2.2 skrll starting_point = stcb->asoc.last_used_address; 1315 1.1.2.2 skrll /* First try for matching scope */ 1316 1.1.2.2 skrll sctp_from_the_top: 1317 1.1.2.2 skrll if (stcb->asoc.last_used_address == NULL) { 1318 1.1.2.2 skrll start_at_beginning=1; 1319 1.1.2.2 skrll stcb->asoc.last_used_address = LIST_FIRST(&inp->sctp_addr_list); 1320 1.1.2.2 skrll } 1321 1.1.2.2 skrll /* search beginning with the last used address */ 1322 1.1.2.2 skrll for (laddr = stcb->asoc.last_used_address; laddr; 1323 1.1.2.2 skrll laddr = LIST_NEXT(laddr, sctp_nxt_addr)) { 1324 1.1.2.2 skrll if (laddr->ifa == NULL) { 1325 1.1.2.2 skrll /* address has been removed */ 1326 1.1.2.2 skrll continue; 1327 1.1.2.2 skrll } 1328 1.1.2.2 skrll sin6 = sctp_is_v6_ifa_addr_acceptable (laddr->ifa, loopscope, loc_scope, &sin_loop, &sin_local); 1329 1.1.2.2 skrll if (sin6 == NULL) 1330 1.1.2.2 skrll continue; 1331 1.1.2.2 skrll if ((non_asoc_addr_ok == 0) && (sctp_is_addr_restricted(stcb, (struct sockaddr *)sin6))) { 1332 1.1.2.2 skrll /* on the no-no list */ 1333 1.1.2.2 skrll continue; 1334 1.1.2.2 skrll } 1335 1.1.2.2 skrll /* is it of matching scope ? */ 1336 1.1.2.2 skrll if ((loopscope == 0) && 1337 1.1.2.2 skrll (loc_scope == 0) && 1338 1.1.2.2 skrll (sin_loop == 0) && 1339 1.1.2.2 skrll (sin_local == 0)) { 1340 1.1.2.2 skrll /* all of global scope we are ok with it */ 1341 1.1.2.2 skrll return (sin6); 1342 1.1.2.2 skrll } 1343 1.1.2.2 skrll if (loopscope && sin_loop) 1344 1.1.2.2 skrll /* both on the loopback, thats ok */ 1345 1.1.2.2 skrll return (sin6); 1346 1.1.2.2 skrll if (loc_scope && sin_local) 1347 1.1.2.2 skrll /* both local scope */ 1348 1.1.2.2 skrll return (sin6); 1349 1.1.2.2 skrll 1350 1.1.2.2 skrll } 1351 1.1.2.2 skrll if (start_at_beginning == 0) { 1352 1.1.2.2 skrll stcb->asoc.last_used_address = NULL; 1353 1.1.2.2 skrll goto sctp_from_the_top; 1354 1.1.2.2 skrll } 1355 1.1.2.2 skrll /* now try for any higher scope than the destination */ 1356 1.1.2.2 skrll stcb->asoc.last_used_address = starting_point; 1357 1.1.2.2 skrll start_at_beginning = 0; 1358 1.1.2.2 skrll sctp_from_the_top2: 1359 1.1.2.2 skrll if (stcb->asoc.last_used_address == NULL) { 1360 1.1.2.2 skrll start_at_beginning=1; 1361 1.1.2.2 skrll stcb->asoc.last_used_address = LIST_FIRST(&inp->sctp_addr_list); 1362 1.1.2.2 skrll } 1363 1.1.2.2 skrll /* search beginning with the last used address */ 1364 1.1.2.2 skrll for (laddr = stcb->asoc.last_used_address; laddr; 1365 1.1.2.2 skrll laddr = LIST_NEXT(laddr, sctp_nxt_addr)) { 1366 1.1.2.2 skrll if (laddr->ifa == NULL) { 1367 1.1.2.2 skrll /* address has been removed */ 1368 1.1.2.2 skrll continue; 1369 1.1.2.2 skrll } 1370 1.1.2.2 skrll sin6 = sctp_is_v6_ifa_addr_acceptable (laddr->ifa, loopscope, loc_scope, &sin_loop, &sin_local); 1371 1.1.2.2 skrll if (sin6 == NULL) 1372 1.1.2.2 skrll continue; 1373 1.1.2.2 skrll if ((non_asoc_addr_ok == 0) && (sctp_is_addr_restricted(stcb, (struct sockaddr *)sin6))) { 1374 1.1.2.2 skrll /* on the no-no list */ 1375 1.1.2.2 skrll continue; 1376 1.1.2.2 skrll } 1377 1.1.2.2 skrll return (sin6); 1378 1.1.2.2 skrll } 1379 1.1.2.2 skrll if (start_at_beginning == 0) { 1380 1.1.2.2 skrll stcb->asoc.last_used_address = NULL; 1381 1.1.2.2 skrll goto sctp_from_the_top2; 1382 1.1.2.2 skrll } 1383 1.1.2.2 skrll } else { 1384 1.1.2.2 skrll #ifdef SCTP_DEBUG 1385 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 1386 1.1.2.2 skrll printf("Have a STCB - no asconf allowed, not bound all have a postive list\n"); 1387 1.1.2.2 skrll } 1388 1.1.2.2 skrll #endif 1389 1.1.2.2 skrll /* First try for interface output match */ 1390 1.1.2.2 skrll LIST_FOREACH(laddr, &stcb->asoc.sctp_local_addr_list, 1391 1.1.2.2 skrll sctp_nxt_addr) { 1392 1.1.2.2 skrll if (laddr->ifa == NULL) { 1393 1.1.2.2 skrll /* address has been removed */ 1394 1.1.2.2 skrll continue; 1395 1.1.2.2 skrll } 1396 1.1.2.2 skrll sin6 = sctp_is_v6_ifa_addr_acceptable (laddr->ifa, loopscope, loc_scope, &sin_loop, &sin_local); 1397 1.1.2.2 skrll if (sin6 == NULL) 1398 1.1.2.2 skrll continue; 1399 1.1.2.2 skrll /* first question, is laddr->ifa an address associated with the emit interface */ 1400 1.1.2.2 skrll if (ifn) { 1401 1.1.2.2 skrll TAILQ_FOREACH(ifa, &ifn->if_addrlist, ifa_list) { 1402 1.1.2.2 skrll if (laddr->ifa == ifa) { 1403 1.1.2.2 skrll sin6 = (struct sockaddr_in6 *)laddr->ifa->ifa_addr; 1404 1.1.2.2 skrll return (sin6); 1405 1.1.2.2 skrll } 1406 1.1.2.2 skrll if (sctp_cmpaddr(ifa->ifa_addr, laddr->ifa->ifa_addr) == 1) { 1407 1.1.2.2 skrll sin6 = (struct sockaddr_in6 *)laddr->ifa->ifa_addr; 1408 1.1.2.2 skrll return (sin6); 1409 1.1.2.2 skrll } 1410 1.1.2.2 skrll } 1411 1.1.2.2 skrll } 1412 1.1.2.2 skrll } 1413 1.1.2.2 skrll /* Next try for matching scope */ 1414 1.1.2.2 skrll LIST_FOREACH(laddr, &stcb->asoc.sctp_local_addr_list, 1415 1.1.2.2 skrll sctp_nxt_addr) { 1416 1.1.2.2 skrll if (laddr->ifa == NULL) { 1417 1.1.2.2 skrll /* address has been removed */ 1418 1.1.2.2 skrll continue; 1419 1.1.2.2 skrll } 1420 1.1.2.2 skrll sin6 = sctp_is_v6_ifa_addr_acceptable (laddr->ifa, loopscope, loc_scope, &sin_loop, &sin_local); 1421 1.1.2.2 skrll if (sin6 == NULL) 1422 1.1.2.2 skrll continue; 1423 1.1.2.2 skrll 1424 1.1.2.2 skrll if ((loopscope == 0) && 1425 1.1.2.2 skrll (loc_scope == 0) && 1426 1.1.2.2 skrll (sin_loop == 0) && 1427 1.1.2.2 skrll (sin_local == 0)) { 1428 1.1.2.2 skrll /* all of global scope we are ok with it */ 1429 1.1.2.2 skrll return (sin6); 1430 1.1.2.2 skrll } 1431 1.1.2.2 skrll if (loopscope && sin_loop) 1432 1.1.2.2 skrll /* both on the loopback, thats ok */ 1433 1.1.2.2 skrll return (sin6); 1434 1.1.2.2 skrll if (loc_scope && sin_local) 1435 1.1.2.2 skrll /* both local scope */ 1436 1.1.2.2 skrll return (sin6); 1437 1.1.2.2 skrll } 1438 1.1.2.2 skrll /* ok, now try for a higher scope in the source address */ 1439 1.1.2.2 skrll /* First try for matching scope */ 1440 1.1.2.2 skrll LIST_FOREACH(laddr, &stcb->asoc.sctp_local_addr_list, 1441 1.1.2.2 skrll sctp_nxt_addr) { 1442 1.1.2.2 skrll if (laddr->ifa == NULL) { 1443 1.1.2.2 skrll /* address has been removed */ 1444 1.1.2.2 skrll continue; 1445 1.1.2.2 skrll } 1446 1.1.2.2 skrll sin6 = sctp_is_v6_ifa_addr_acceptable (laddr->ifa, loopscope, loc_scope, &sin_loop, &sin_local); 1447 1.1.2.2 skrll if (sin6 == NULL) 1448 1.1.2.2 skrll continue; 1449 1.1.2.2 skrll return (sin6); 1450 1.1.2.2 skrll } 1451 1.1.2.2 skrll } 1452 1.1.2.2 skrll return (NULL); 1453 1.1.2.2 skrll } 1454 1.1.2.2 skrll 1455 1.1.2.2 skrll static struct sockaddr_in6 * 1456 1.1.2.2 skrll sctp_choose_v6_boundspecific_inp(struct sctp_inpcb *inp, 1457 1.1.2.2 skrll struct rtentry *rt, 1458 1.1.2.2 skrll uint8_t loc_scope, 1459 1.1.2.2 skrll uint8_t loopscope) 1460 1.1.2.2 skrll { 1461 1.1.2.2 skrll /* 1462 1.1.2.2 skrll * Here we are bound specific and have only 1463 1.1.2.2 skrll * an inp. We must find an address that is bound 1464 1.1.2.2 skrll * that we can give out as a src address. We 1465 1.1.2.2 skrll * prefer two addresses of same scope if we can 1466 1.1.2.2 skrll * find them that way. 1467 1.1.2.2 skrll */ 1468 1.1.2.2 skrll struct sctp_laddr *laddr; 1469 1.1.2.2 skrll struct sockaddr_in6 *sin6; 1470 1.1.2.2 skrll struct ifnet *ifn; 1471 1.1.2.2 skrll struct ifaddr *ifa; 1472 1.1.2.2 skrll int sin_loop, sin_local; 1473 1.1.2.2 skrll 1474 1.1.2.2 skrll /* first question, is the ifn we will emit on 1475 1.1.2.2 skrll * in our list, if so, we want that one. 1476 1.1.2.2 skrll */ 1477 1.1.2.2 skrll 1478 1.1.2.2 skrll ifn = rt->rt_ifp; 1479 1.1.2.2 skrll if (ifn) { 1480 1.1.2.2 skrll TAILQ_FOREACH(ifa, &ifn->if_addrlist, ifa_list) { 1481 1.1.2.2 skrll sin6 = sctp_is_v6_ifa_addr_acceptable (ifa, loopscope, loc_scope, &sin_loop, &sin_local); 1482 1.1.2.2 skrll if (sin6 == NULL) 1483 1.1.2.2 skrll continue; 1484 1.1.2.2 skrll if (sctp_is_addr_in_ep(inp, ifa)) { 1485 1.1.2.2 skrll return (sin6); 1486 1.1.2.2 skrll } 1487 1.1.2.2 skrll } 1488 1.1.2.2 skrll } 1489 1.1.2.2 skrll for (laddr = LIST_FIRST(&inp->sctp_addr_list); 1490 1.1.2.2 skrll laddr && (laddr != inp->next_addr_touse); 1491 1.1.2.2 skrll laddr = LIST_NEXT(laddr, sctp_nxt_addr)) { 1492 1.1.2.2 skrll if (laddr->ifa == NULL) { 1493 1.1.2.2 skrll /* address has been removed */ 1494 1.1.2.2 skrll continue; 1495 1.1.2.2 skrll } 1496 1.1.2.2 skrll sin6 = sctp_is_v6_ifa_addr_acceptable (laddr->ifa, loopscope, loc_scope, &sin_loop, &sin_local); 1497 1.1.2.2 skrll if (sin6 == NULL) 1498 1.1.2.2 skrll continue; 1499 1.1.2.2 skrll 1500 1.1.2.2 skrll if ((loopscope == 0) && 1501 1.1.2.2 skrll (loc_scope == 0) && 1502 1.1.2.2 skrll (sin_loop == 0) && 1503 1.1.2.2 skrll (sin_local == 0)) { 1504 1.1.2.2 skrll /* all of global scope we are ok with it */ 1505 1.1.2.2 skrll return (sin6); 1506 1.1.2.2 skrll } 1507 1.1.2.2 skrll if (loopscope && sin_loop) 1508 1.1.2.2 skrll /* both on the loopback, thats ok */ 1509 1.1.2.2 skrll return (sin6); 1510 1.1.2.2 skrll if (loc_scope && sin_local) 1511 1.1.2.2 skrll /* both local scope */ 1512 1.1.2.2 skrll return (sin6); 1513 1.1.2.2 skrll 1514 1.1.2.2 skrll } 1515 1.1.2.2 skrll /* if we reach here, we could not find two addresses 1516 1.1.2.2 skrll * of the same scope to give out. Lets look for any higher level 1517 1.1.2.2 skrll * scope for a source address. 1518 1.1.2.2 skrll */ 1519 1.1.2.2 skrll for (laddr = LIST_FIRST(&inp->sctp_addr_list); 1520 1.1.2.2 skrll laddr && (laddr != inp->next_addr_touse); 1521 1.1.2.2 skrll laddr = LIST_NEXT(laddr, sctp_nxt_addr)) { 1522 1.1.2.2 skrll if (laddr->ifa == NULL) { 1523 1.1.2.2 skrll /* address has been removed */ 1524 1.1.2.2 skrll continue; 1525 1.1.2.2 skrll } 1526 1.1.2.2 skrll sin6 = sctp_is_v6_ifa_addr_acceptable (laddr->ifa, loopscope, loc_scope, &sin_loop, &sin_local); 1527 1.1.2.2 skrll if (sin6 == NULL) 1528 1.1.2.2 skrll continue; 1529 1.1.2.2 skrll return (sin6); 1530 1.1.2.2 skrll } 1531 1.1.2.2 skrll /* no address bound can be a source for the destination */ 1532 1.1.2.2 skrll #ifdef SCTP_DEBUG 1533 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 1534 1.1.2.2 skrll printf("Src address selection for EP, no acceptable src address found for address\n"); 1535 1.1.2.2 skrll } 1536 1.1.2.2 skrll #endif 1537 1.1.2.2 skrll return (NULL); 1538 1.1.2.2 skrll } 1539 1.1.2.2 skrll 1540 1.1.2.2 skrll 1541 1.1.2.2 skrll static struct sockaddr_in6 * 1542 1.1.2.2 skrll sctp_select_v6_nth_addr_from_ifn_boundall (struct ifnet *ifn, struct sctp_tcb *stcb, int non_asoc_addr_ok, uint8_t loopscope, 1543 1.1.2.2 skrll uint8_t loc_scope, int cur_addr_num, int match_scope) 1544 1.1.2.2 skrll { 1545 1.1.2.2 skrll struct ifaddr *ifa; 1546 1.1.2.2 skrll struct sockaddr_in6 *sin6; 1547 1.1.2.2 skrll int sin_loop, sin_local; 1548 1.1.2.2 skrll int num_eligible_addr = 0; 1549 1.1.2.2 skrll 1550 1.1.2.2 skrll TAILQ_FOREACH(ifa, &ifn->if_addrlist, ifa_list) { 1551 1.1.2.2 skrll sin6 = sctp_is_v6_ifa_addr_acceptable (ifa, loopscope, loc_scope, &sin_loop, &sin_local); 1552 1.1.2.2 skrll if (sin6 == NULL) 1553 1.1.2.2 skrll continue; 1554 1.1.2.2 skrll if (stcb) { 1555 1.1.2.2 skrll if ((non_asoc_addr_ok == 0) && sctp_is_addr_restricted(stcb, (struct sockaddr *)sin6)) { 1556 1.1.2.2 skrll /* It is restricted for some reason.. probably 1557 1.1.2.2 skrll * not yet added. 1558 1.1.2.2 skrll */ 1559 1.1.2.2 skrll continue; 1560 1.1.2.2 skrll } 1561 1.1.2.2 skrll } 1562 1.1.2.2 skrll if (match_scope) { 1563 1.1.2.2 skrll /* Here we are asked to match scope if possible */ 1564 1.1.2.2 skrll if (loopscope && sin_loop) 1565 1.1.2.2 skrll /* src and destination are loopback scope */ 1566 1.1.2.2 skrll return (sin6); 1567 1.1.2.2 skrll if (loc_scope && sin_local) 1568 1.1.2.2 skrll /* src and destination are local scope */ 1569 1.1.2.2 skrll return (sin6); 1570 1.1.2.2 skrll if ((loopscope == 0) && 1571 1.1.2.2 skrll (loc_scope == 0) && 1572 1.1.2.2 skrll (sin_loop == 0) && 1573 1.1.2.2 skrll (sin_local == 0)) { 1574 1.1.2.2 skrll /* src and destination are global scope */ 1575 1.1.2.2 skrll return (sin6); 1576 1.1.2.2 skrll } 1577 1.1.2.2 skrll continue; 1578 1.1.2.2 skrll } 1579 1.1.2.2 skrll if (num_eligible_addr == cur_addr_num) { 1580 1.1.2.2 skrll /* this is it */ 1581 1.1.2.2 skrll return (sin6); 1582 1.1.2.2 skrll } 1583 1.1.2.2 skrll num_eligible_addr++; 1584 1.1.2.2 skrll } 1585 1.1.2.2 skrll return (NULL); 1586 1.1.2.2 skrll } 1587 1.1.2.2 skrll 1588 1.1.2.2 skrll 1589 1.1.2.2 skrll static int 1590 1.1.2.2 skrll sctp_count_v6_num_eligible_boundall (struct ifnet *ifn, struct sctp_tcb *stcb, 1591 1.1.2.2 skrll int non_asoc_addr_ok, uint8_t loopscope, uint8_t loc_scope) 1592 1.1.2.2 skrll { 1593 1.1.2.2 skrll struct ifaddr *ifa; 1594 1.1.2.2 skrll struct sockaddr_in6 *sin6; 1595 1.1.2.2 skrll int num_eligible_addr = 0; 1596 1.1.2.2 skrll int sin_loop, sin_local; 1597 1.1.2.2 skrll 1598 1.1.2.2 skrll TAILQ_FOREACH(ifa, &ifn->if_addrlist, ifa_list) { 1599 1.1.2.2 skrll sin6 = sctp_is_v6_ifa_addr_acceptable (ifa, loopscope, loc_scope, &sin_loop, &sin_local); 1600 1.1.2.2 skrll if (sin6 == NULL) 1601 1.1.2.2 skrll continue; 1602 1.1.2.2 skrll if (stcb) { 1603 1.1.2.2 skrll if ((non_asoc_addr_ok == 0) && sctp_is_addr_restricted(stcb, (struct sockaddr *)sin6)) { 1604 1.1.2.2 skrll /* It is restricted for some reason.. probably 1605 1.1.2.2 skrll * not yet added. 1606 1.1.2.2 skrll */ 1607 1.1.2.2 skrll continue; 1608 1.1.2.2 skrll } 1609 1.1.2.2 skrll } 1610 1.1.2.2 skrll num_eligible_addr++; 1611 1.1.2.2 skrll } 1612 1.1.2.2 skrll return (num_eligible_addr); 1613 1.1.2.2 skrll } 1614 1.1.2.2 skrll 1615 1.1.2.2 skrll 1616 1.1.2.2 skrll static struct sockaddr_in6 * 1617 1.1.2.2 skrll sctp_choose_v6_boundall(struct sctp_inpcb *inp, 1618 1.1.2.2 skrll struct sctp_tcb *stcb, 1619 1.1.2.2 skrll struct sctp_nets *net, 1620 1.1.2.2 skrll struct rtentry *rt, 1621 1.1.2.2 skrll uint8_t loc_scope, 1622 1.1.2.2 skrll uint8_t loopscope, 1623 1.1.2.2 skrll int non_asoc_addr_ok) 1624 1.1.2.2 skrll { 1625 1.1.2.2 skrll /* Ok, we are bound all SO any address 1626 1.1.2.2 skrll * is ok to use as long as it is NOT in the negative 1627 1.1.2.2 skrll * list. 1628 1.1.2.2 skrll */ 1629 1.1.2.2 skrll int num_eligible_addr; 1630 1.1.2.2 skrll int cur_addr_num=0; 1631 1.1.2.2 skrll int started_at_beginning=0; 1632 1.1.2.2 skrll int match_scope_prefered; 1633 1.1.2.2 skrll /* first question is, how many eligible addresses are 1634 1.1.2.2 skrll * there for the destination ifn that we are using that 1635 1.1.2.2 skrll * are within the proper scope? 1636 1.1.2.2 skrll */ 1637 1.1.2.2 skrll struct ifnet *ifn; 1638 1.1.2.2 skrll struct sockaddr_in6 *sin6; 1639 1.1.2.2 skrll 1640 1.1.2.2 skrll ifn = rt->rt_ifp; 1641 1.1.2.2 skrll if (net) { 1642 1.1.2.2 skrll cur_addr_num = net->indx_of_eligible_next_to_use; 1643 1.1.2.2 skrll } 1644 1.1.2.2 skrll if (cur_addr_num == 0) { 1645 1.1.2.2 skrll match_scope_prefered = 1; 1646 1.1.2.2 skrll } else { 1647 1.1.2.2 skrll match_scope_prefered = 0; 1648 1.1.2.2 skrll } 1649 1.1.2.2 skrll num_eligible_addr = sctp_count_v6_num_eligible_boundall (ifn, stcb, non_asoc_addr_ok, loopscope, loc_scope); 1650 1.1.2.2 skrll #ifdef SCTP_DEBUG 1651 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 1652 1.1.2.2 skrll printf("Found %d eligible source addresses\n", num_eligible_addr); 1653 1.1.2.2 skrll } 1654 1.1.2.2 skrll #endif 1655 1.1.2.2 skrll if (num_eligible_addr == 0) { 1656 1.1.2.2 skrll /* no eligible addresses, we must use some other 1657 1.1.2.2 skrll * interface address if we can find one. 1658 1.1.2.2 skrll */ 1659 1.1.2.2 skrll goto bound_all_v6_plan_b; 1660 1.1.2.2 skrll } 1661 1.1.2.2 skrll /* Ok we have num_eligible_addr set with how many we can use, 1662 1.1.2.2 skrll * this may vary from call to call due to addresses being deprecated etc.. 1663 1.1.2.2 skrll */ 1664 1.1.2.2 skrll if (cur_addr_num >= num_eligible_addr) { 1665 1.1.2.2 skrll cur_addr_num = 0; 1666 1.1.2.2 skrll } 1667 1.1.2.2 skrll /* select the nth address from the list (where cur_addr_num is the nth) and 1668 1.1.2.2 skrll * 0 is the first one, 1 is the second one etc... 1669 1.1.2.2 skrll */ 1670 1.1.2.2 skrll #ifdef SCTP_DEBUG 1671 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 1672 1.1.2.2 skrll printf("cur_addr_num:%d match_scope_prefered:%d select it\n", 1673 1.1.2.2 skrll cur_addr_num, match_scope_prefered); 1674 1.1.2.2 skrll } 1675 1.1.2.2 skrll #endif 1676 1.1.2.2 skrll sin6 = sctp_select_v6_nth_addr_from_ifn_boundall (ifn, stcb, non_asoc_addr_ok, loopscope, 1677 1.1.2.2 skrll loc_scope, cur_addr_num, match_scope_prefered); 1678 1.1.2.2 skrll if (match_scope_prefered && (sin6 == NULL)) { 1679 1.1.2.2 skrll /* retry without the preference for matching scope */ 1680 1.1.2.2 skrll #ifdef SCTP_DEBUG 1681 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 1682 1.1.2.2 skrll printf("retry with no match_scope_prefered\n"); 1683 1.1.2.2 skrll } 1684 1.1.2.2 skrll #endif 1685 1.1.2.2 skrll sin6 = sctp_select_v6_nth_addr_from_ifn_boundall (ifn, stcb, non_asoc_addr_ok, loopscope, 1686 1.1.2.2 skrll loc_scope, cur_addr_num, 0); 1687 1.1.2.2 skrll } 1688 1.1.2.2 skrll if (sin6) { 1689 1.1.2.2 skrll #ifdef SCTP_DEBUG 1690 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 1691 1.1.2.2 skrll printf("Selected address %d ifn:%p for the route\n", cur_addr_num, ifn); 1692 1.1.2.2 skrll } 1693 1.1.2.2 skrll #endif 1694 1.1.2.2 skrll if (net) { 1695 1.1.2.2 skrll /* store so we get the next one */ 1696 1.1.2.2 skrll if (cur_addr_num < 255) 1697 1.1.2.2 skrll net->indx_of_eligible_next_to_use = cur_addr_num + 1; 1698 1.1.2.2 skrll else 1699 1.1.2.2 skrll net->indx_of_eligible_next_to_use = 0; 1700 1.1.2.2 skrll } 1701 1.1.2.2 skrll return (sin6); 1702 1.1.2.2 skrll } 1703 1.1.2.2 skrll num_eligible_addr = 0; 1704 1.1.2.2 skrll bound_all_v6_plan_b: 1705 1.1.2.2 skrll /* ok, if we reach here we either fell through 1706 1.1.2.2 skrll * due to something changing during an interupt (unlikely) 1707 1.1.2.2 skrll * or we have NO eligible source addresses for the ifn 1708 1.1.2.2 skrll * of the route (most likely). We must look at all the other 1709 1.1.2.2 skrll * interfaces EXCEPT rt->rt_ifp and do the same game. 1710 1.1.2.2 skrll */ 1711 1.1.2.2 skrll #ifdef SCTP_DEBUG 1712 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 1713 1.1.2.2 skrll printf("bound-all Plan B\n"); 1714 1.1.2.2 skrll } 1715 1.1.2.2 skrll #endif 1716 1.1.2.2 skrll if (inp->next_ifn_touse == NULL) { 1717 1.1.2.2 skrll started_at_beginning=1; 1718 1.1.2.2 skrll inp->next_ifn_touse = TAILQ_FIRST(&ifnet_list); 1719 1.1.2.2 skrll #ifdef SCTP_DEBUG 1720 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 1721 1.1.2.2 skrll printf("Start at first IFN:%p\n", inp->next_ifn_touse); 1722 1.1.2.2 skrll } 1723 1.1.2.2 skrll #endif 1724 1.1.2.2 skrll } else { 1725 1.1.2.2 skrll inp->next_ifn_touse = TAILQ_NEXT(inp->next_ifn_touse, if_list); 1726 1.1.2.2 skrll #ifdef SCTP_DEBUG 1727 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 1728 1.1.2.2 skrll printf("Resume at IFN:%p\n", inp->next_ifn_touse); 1729 1.1.2.2 skrll } 1730 1.1.2.2 skrll #endif 1731 1.1.2.2 skrll if (inp->next_ifn_touse == NULL) { 1732 1.1.2.2 skrll #ifdef SCTP_DEBUG 1733 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 1734 1.1.2.2 skrll printf("IFN Resets\n"); 1735 1.1.2.2 skrll } 1736 1.1.2.2 skrll #endif 1737 1.1.2.2 skrll started_at_beginning=1; 1738 1.1.2.2 skrll inp->next_ifn_touse = TAILQ_FIRST(&ifnet_list); 1739 1.1.2.2 skrll } 1740 1.1.2.2 skrll } 1741 1.1.2.2 skrll for (ifn = inp->next_ifn_touse; ifn; 1742 1.1.2.2 skrll ifn = TAILQ_NEXT(ifn, if_list)) { 1743 1.1.2.2 skrll if (loopscope == 0 && ifn->if_type == IFT_LOOP) { 1744 1.1.2.2 skrll /* wrong base scope */ 1745 1.1.2.2 skrll continue; 1746 1.1.2.2 skrll } 1747 1.1.2.2 skrll if (loc_scope && (ifn->if_index != loc_scope)) { 1748 1.1.2.2 skrll /* by definition the scope (from to->sin6_scopeid) 1749 1.1.2.2 skrll * must match that of the interface. If not then 1750 1.1.2.2 skrll * we could pick a wrong scope for the address. 1751 1.1.2.2 skrll * Ususally we don't hit plan-b since the route 1752 1.1.2.2 skrll * handles this. However we can hit plan-b when 1753 1.1.2.2 skrll * we send to local-host so the route is the 1754 1.1.2.2 skrll * loopback interface, but the destination is a 1755 1.1.2.2 skrll * link local. 1756 1.1.2.2 skrll */ 1757 1.1.2.2 skrll continue; 1758 1.1.2.2 skrll } 1759 1.1.2.2 skrll if (ifn == rt->rt_ifp) { 1760 1.1.2.2 skrll /* already looked at this guy */ 1761 1.1.2.2 skrll continue; 1762 1.1.2.2 skrll } 1763 1.1.2.2 skrll /* Address rotation will only work when we are not 1764 1.1.2.2 skrll * rotating sourced interfaces and are using the interface 1765 1.1.2.2 skrll * of the route. We would need to have a per interface index 1766 1.1.2.2 skrll * in order to do proper rotation. 1767 1.1.2.2 skrll */ 1768 1.1.2.2 skrll num_eligible_addr = sctp_count_v6_num_eligible_boundall (ifn, stcb, non_asoc_addr_ok, loopscope, loc_scope); 1769 1.1.2.2 skrll #ifdef SCTP_DEBUG 1770 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 1771 1.1.2.2 skrll printf("IFN:%p has %d eligible\n", ifn, num_eligible_addr); 1772 1.1.2.2 skrll } 1773 1.1.2.2 skrll #endif 1774 1.1.2.2 skrll if (num_eligible_addr == 0) { 1775 1.1.2.2 skrll /* none we can use */ 1776 1.1.2.2 skrll continue; 1777 1.1.2.2 skrll } 1778 1.1.2.2 skrll /* Ok we have num_eligible_addr set with how many we can use, 1779 1.1.2.2 skrll * this may vary from call to call due to addresses being deprecated etc.. 1780 1.1.2.2 skrll */ 1781 1.1.2.2 skrll inp->next_ifn_touse = ifn; 1782 1.1.2.2 skrll 1783 1.1.2.2 skrll /* select the first one we can find with perference for matching scope. 1784 1.1.2.2 skrll */ 1785 1.1.2.2 skrll sin6 = sctp_select_v6_nth_addr_from_ifn_boundall (ifn, stcb, non_asoc_addr_ok, loopscope, loc_scope, 0, 1); 1786 1.1.2.2 skrll if (sin6 == NULL) { 1787 1.1.2.2 skrll /* can't find one with matching scope how about a source with higher 1788 1.1.2.2 skrll * scope 1789 1.1.2.2 skrll */ 1790 1.1.2.2 skrll sin6 = sctp_select_v6_nth_addr_from_ifn_boundall (ifn, stcb, non_asoc_addr_ok, loopscope, loc_scope, 0, 0); 1791 1.1.2.2 skrll if (sin6 == NULL) 1792 1.1.2.2 skrll /* Hmm, can't find one in the interface now */ 1793 1.1.2.2 skrll continue; 1794 1.1.2.2 skrll } 1795 1.1.2.2 skrll #ifdef SCTP_DEBUG 1796 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 1797 1.1.2.2 skrll printf("Selected the %d'th address of ifn:%p\n", 1798 1.1.2.2 skrll cur_addr_num, ifn); 1799 1.1.2.2 skrll } 1800 1.1.2.2 skrll #endif 1801 1.1.2.2 skrll return (sin6); 1802 1.1.2.2 skrll } 1803 1.1.2.2 skrll if (started_at_beginning == 0) { 1804 1.1.2.2 skrll /* we have not been through all of them yet, force 1805 1.1.2.2 skrll * us to go through them all. 1806 1.1.2.2 skrll */ 1807 1.1.2.2 skrll #ifdef SCTP_DEBUG 1808 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 1809 1.1.2.2 skrll printf("Force a recycle\n"); 1810 1.1.2.2 skrll } 1811 1.1.2.2 skrll #endif 1812 1.1.2.2 skrll inp->next_ifn_touse = NULL; 1813 1.1.2.2 skrll goto bound_all_v6_plan_b; 1814 1.1.2.2 skrll } 1815 1.1.2.2 skrll return (NULL); 1816 1.1.2.2 skrll 1817 1.1.2.2 skrll } 1818 1.1.2.2 skrll 1819 1.1.2.2 skrll /* stcb and net may be NULL */ 1820 1.1.2.2 skrll struct in6_addr 1821 1.1.2.2 skrll sctp_ipv6_source_address_selection(struct sctp_inpcb *inp, 1822 1.1.2.2 skrll struct sctp_tcb *stcb, struct route *ro, struct sctp_nets *net, 1823 1.1.2.2 skrll int non_asoc_addr_ok) 1824 1.1.2.2 skrll { 1825 1.1.2.2 skrll struct in6_addr ans; 1826 1.1.2.2 skrll struct sockaddr_in6 *rt_addr; 1827 1.1.2.2 skrll uint8_t loc_scope, loopscope; 1828 1.1.2.2 skrll struct sockaddr_in6 to; 1829 1.1.2.2 skrll struct rtentry *rt; 1830 1.1.2.2 skrll 1831 1.1.2.2 skrll /* 1832 1.1.2.2 skrll * This routine is tricky standard v6 src address 1833 1.1.2.2 skrll * selection cannot take into account what we have 1834 1.1.2.2 skrll * bound etc, so we can't use it. 1835 1.1.2.2 skrll * 1836 1.1.2.2 skrll * Instead here is what we must do: 1837 1.1.2.2 skrll * 1) Make sure we have a route, if we 1838 1.1.2.2 skrll * don't have a route we can never reach the peer. 1839 1.1.2.2 skrll * 2) Once we have a route, determine the scope of the 1840 1.1.2.2 skrll * route. Link local, loopback or global. 1841 1.1.2.2 skrll * 3) Next we divide into three types. Either we 1842 1.1.2.2 skrll * are bound all.. which means we want to use 1843 1.1.2.2 skrll * one of the addresses of the interface we are 1844 1.1.2.2 skrll * going out. <or> 1845 1.1.2.2 skrll * 4a) We have not stcb, which means we are using the 1846 1.1.2.2 skrll * specific addresses bound on an inp, in this 1847 1.1.2.2 skrll * case we are similar to the stcb case (4b below) 1848 1.1.2.2 skrll * accept the list is always a positive list.<or> 1849 1.1.2.2 skrll * 4b) We are bound specific with a stcb, which means we have a 1850 1.1.2.2 skrll * list of bound addresses and we must see if the 1851 1.1.2.2 skrll * ifn of the route is actually one of the bound addresses. 1852 1.1.2.2 skrll * If not, then we must rotate addresses amongst properly 1853 1.1.2.2 skrll * scoped bound addresses, if so we use the address 1854 1.1.2.2 skrll * of the interface. 1855 1.1.2.2 skrll * 5) Always, no matter which path we take through the above 1856 1.1.2.2 skrll * we must be sure the source address we use is allowed to 1857 1.1.2.2 skrll * be used. I.e. IN6_IFF_DETACHED, IN6_IFF_NOTREADY, and IN6_IFF_ANYCAST 1858 1.1.2.2 skrll * addresses cannot be used. 1859 1.1.2.2 skrll * 6) Addresses that are deprecated MAY be used 1860 1.1.2.2 skrll * if (!ip6_use_deprecated) { 1861 1.1.2.2 skrll * if (IFA6_IS_DEPRECATED(ifa6)) { 1862 1.1.2.2 skrll * skip the address 1863 1.1.2.2 skrll * } 1864 1.1.2.2 skrll * } 1865 1.1.2.2 skrll */ 1866 1.1.2.2 skrll 1867 1.1.2.2 skrll /*** 1> determine route, if not already done */ 1868 1.1.2.2 skrll rt = rtcache_validate(ro); 1869 1.1.2.2 skrll if (rt == NULL) { 1870 1.1.2.2 skrll /* 1871 1.1.2.2 skrll * Need a route to cache. 1872 1.1.2.2 skrll */ 1873 1.1.2.2 skrll int scope_save; 1874 1.1.2.2 skrll 1875 1.1.2.2 skrll memcpy(&to, rtcache_getdst(ro), sizeof(struct sockaddr)); 1876 1.1.2.2 skrll scope_save = to.sin6_scope_id; 1877 1.1.2.2 skrll to.sin6_scope_id = 0; 1878 1.1.2.2 skrll 1879 1.1.2.2 skrll rt = rtcache_lookup(ro, (struct sockaddr *)&to); 1880 1.1.2.2 skrll to.sin6_scope_id = scope_save; 1881 1.1.2.2 skrll } 1882 1.1.2.2 skrll if (rt == NULL) { 1883 1.1.2.2 skrll /* 1884 1.1.2.2 skrll * no route to host. this packet is going no-where. 1885 1.1.2.2 skrll * We probably should make sure we arrange to send back 1886 1.1.2.2 skrll * an error. 1887 1.1.2.2 skrll */ 1888 1.1.2.2 skrll #ifdef SCTP_DEBUG 1889 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 1890 1.1.2.2 skrll printf("No route to host, this packet cannot be sent!\n"); 1891 1.1.2.2 skrll } 1892 1.1.2.2 skrll #endif 1893 1.1.2.2 skrll memset(&ans, 0, sizeof(ans)); 1894 1.1.2.2 skrll return (ans); 1895 1.1.2.2 skrll } 1896 1.1.2.2 skrll 1897 1.1.2.2 skrll /*** 2a> determine scope for outbound address/route */ 1898 1.1.2.2 skrll loc_scope = loopscope = 0; 1899 1.1.2.2 skrll /* 1900 1.1.2.2 skrll * We base our scope on the outbound packet scope and route, 1901 1.1.2.2 skrll * NOT the TCB (if there is one). This way in local scope we will only 1902 1.1.2.2 skrll * use a local scope src address when we send to a local address. 1903 1.1.2.2 skrll */ 1904 1.1.2.2 skrll 1905 1.1.2.2 skrll if (IN6_IS_ADDR_LOOPBACK(&to.sin6_addr)) { 1906 1.1.2.2 skrll /* If the route goes to the loopback address OR 1907 1.1.2.2 skrll * the address is a loopback address, we are loopback 1908 1.1.2.2 skrll * scope. 1909 1.1.2.2 skrll */ 1910 1.1.2.2 skrll #ifdef SCTP_DEBUG 1911 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 1912 1.1.2.2 skrll printf("Loopback scope is set\n"); 1913 1.1.2.2 skrll } 1914 1.1.2.2 skrll #endif 1915 1.1.2.2 skrll loc_scope = 0; 1916 1.1.2.2 skrll loopscope = 1; 1917 1.1.2.2 skrll if (net != NULL) { 1918 1.1.2.2 skrll /* mark it as local */ 1919 1.1.2.2 skrll net->addr_is_local = 1; 1920 1.1.2.2 skrll } 1921 1.1.2.2 skrll 1922 1.1.2.2 skrll } else if (IN6_IS_ADDR_LINKLOCAL(&to.sin6_addr)) { 1923 1.1.2.2 skrll #ifdef SCTP_DEBUG 1924 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 1925 1.1.2.2 skrll printf("Link local scope is set, id:%d\n", to.sin6_scope_id); 1926 1.1.2.2 skrll } 1927 1.1.2.2 skrll #endif 1928 1.1.2.2 skrll if (to.sin6_scope_id) 1929 1.1.2.2 skrll loc_scope = to.sin6_scope_id; 1930 1.1.2.2 skrll else { 1931 1.1.2.2 skrll loc_scope = 1; 1932 1.1.2.2 skrll } 1933 1.1.2.2 skrll loopscope = 0; 1934 1.1.2.2 skrll } else { 1935 1.1.2.2 skrll #ifdef SCTP_DEBUG 1936 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 1937 1.1.2.2 skrll printf("Global scope is set\n"); 1938 1.1.2.2 skrll } 1939 1.1.2.2 skrll #endif 1940 1.1.2.2 skrll } 1941 1.1.2.2 skrll 1942 1.1.2.2 skrll /* now, depending on which way we are bound we call the appropriate 1943 1.1.2.2 skrll * routine to do steps 3-6 1944 1.1.2.2 skrll */ 1945 1.1.2.2 skrll #ifdef SCTP_DEBUG 1946 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 1947 1.1.2.2 skrll printf("Destination address:"); 1948 1.1.2.2 skrll sctp_print_address((struct sockaddr *)&to); 1949 1.1.2.2 skrll } 1950 1.1.2.2 skrll #endif 1951 1.1.2.2 skrll 1952 1.1.2.2 skrll if (inp->sctp_flags & SCTP_PCB_FLAGS_BOUNDALL) { 1953 1.1.2.2 skrll #ifdef SCTP_DEBUG 1954 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 1955 1.1.2.2 skrll printf("Calling bound-all src addr selection for v6\n"); 1956 1.1.2.2 skrll } 1957 1.1.2.2 skrll #endif 1958 1.1.2.2 skrll rt_addr = sctp_choose_v6_boundall(inp, stcb, net, rt, loc_scope, loopscope, non_asoc_addr_ok); 1959 1.1.2.2 skrll } else { 1960 1.1.2.2 skrll #ifdef SCTP_DEBUG 1961 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 1962 1.1.2.2 skrll printf("Calling bound-specific src addr selection for v6\n"); 1963 1.1.2.2 skrll } 1964 1.1.2.2 skrll #endif 1965 1.1.2.2 skrll if (stcb) 1966 1.1.2.2 skrll rt_addr = sctp_choose_v6_boundspecific_stcb(inp, stcb, net, rt, loc_scope, loopscope, non_asoc_addr_ok); 1967 1.1.2.2 skrll else 1968 1.1.2.2 skrll /* we can't have a non-asoc address since we have no association */ 1969 1.1.2.2 skrll rt_addr = sctp_choose_v6_boundspecific_inp(inp, rt, loc_scope, loopscope); 1970 1.1.2.2 skrll } 1971 1.1.2.2 skrll if (rt_addr == NULL) { 1972 1.1.2.2 skrll /* no suitable address? */ 1973 1.1.2.2 skrll struct in6_addr in6; 1974 1.1.2.2 skrll #ifdef SCTP_DEBUG 1975 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 1976 1.1.2.2 skrll printf("V6 packet will reach dead-end no suitable src address\n"); 1977 1.1.2.2 skrll } 1978 1.1.2.2 skrll #endif 1979 1.1.2.2 skrll memset(&in6, 0, sizeof(in6)); 1980 1.1.2.2 skrll return (in6); 1981 1.1.2.2 skrll } 1982 1.1.2.2 skrll #ifdef SCTP_DEBUG 1983 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 1984 1.1.2.2 skrll printf("Source address selected is:"); 1985 1.1.2.2 skrll sctp_print_address((struct sockaddr *)rt_addr); 1986 1.1.2.2 skrll } 1987 1.1.2.2 skrll #endif 1988 1.1.2.2 skrll return (rt_addr->sin6_addr); 1989 1.1.2.2 skrll } 1990 1.1.2.2 skrll 1991 1.1.2.2 skrll static uint8_t 1992 1.1.2.2 skrll sctp_get_ect(struct sctp_tcb *stcb, 1993 1.1.2.2 skrll struct sctp_tmit_chunk *chk) 1994 1.1.2.2 skrll { 1995 1.1.2.2 skrll uint8_t this_random; 1996 1.1.2.2 skrll 1997 1.1.2.2 skrll /* Huh? */ 1998 1.1.2.2 skrll if (sctp_ecn == 0) 1999 1.1.2.2 skrll return (0); 2000 1.1.2.2 skrll 2001 1.1.2.2 skrll if (sctp_ecn_nonce == 0) 2002 1.1.2.2 skrll /* no nonce, always return ECT0 */ 2003 1.1.2.2 skrll return (SCTP_ECT0_BIT); 2004 1.1.2.2 skrll 2005 1.1.2.2 skrll if (stcb->asoc.peer_supports_ecn_nonce == 0) { 2006 1.1.2.2 skrll /* Peer does NOT support it, so we send a ECT0 only */ 2007 1.1.2.2 skrll return (SCTP_ECT0_BIT); 2008 1.1.2.2 skrll } 2009 1.1.2.2 skrll 2010 1.1.2.2 skrll if (chk == NULL) 2011 1.1.2.2 skrll return (SCTP_ECT0_BIT); 2012 1.1.2.2 skrll 2013 1.1.2.2 skrll if (((stcb->asoc.hb_random_idx == 3) && 2014 1.1.2.2 skrll (stcb->asoc.hb_ect_randombit > 7)) || 2015 1.1.2.2 skrll (stcb->asoc.hb_random_idx > 3)) { 2016 1.1.2.2 skrll uint32_t rndval; 2017 1.1.2.2 skrll rndval = sctp_select_initial_TSN(&stcb->sctp_ep->sctp_ep); 2018 1.1.2.2 skrll memcpy(stcb->asoc.hb_random_values, &rndval, 2019 1.1.2.2 skrll sizeof(stcb->asoc.hb_random_values)); 2020 1.1.2.2 skrll this_random = stcb->asoc.hb_random_values[0]; 2021 1.1.2.2 skrll stcb->asoc.hb_random_idx = 0; 2022 1.1.2.2 skrll stcb->asoc.hb_ect_randombit = 0; 2023 1.1.2.2 skrll } else { 2024 1.1.2.2 skrll if (stcb->asoc.hb_ect_randombit > 7) { 2025 1.1.2.2 skrll stcb->asoc.hb_ect_randombit = 0; 2026 1.1.2.2 skrll stcb->asoc.hb_random_idx++; 2027 1.1.2.2 skrll } 2028 1.1.2.2 skrll this_random = stcb->asoc.hb_random_values[stcb->asoc.hb_random_idx]; 2029 1.1.2.2 skrll } 2030 1.1.2.2 skrll if ((this_random >> stcb->asoc.hb_ect_randombit) & 0x01) { 2031 1.1.2.2 skrll if (chk != NULL) 2032 1.1.2.2 skrll /* ECN Nonce stuff */ 2033 1.1.2.2 skrll chk->rec.data.ect_nonce = SCTP_ECT1_BIT; 2034 1.1.2.2 skrll stcb->asoc.hb_ect_randombit++; 2035 1.1.2.2 skrll return (SCTP_ECT1_BIT); 2036 1.1.2.2 skrll } else { 2037 1.1.2.2 skrll stcb->asoc.hb_ect_randombit++; 2038 1.1.2.2 skrll return (SCTP_ECT0_BIT); 2039 1.1.2.2 skrll } 2040 1.1.2.2 skrll } 2041 1.1.2.2 skrll 2042 1.1.2.2 skrll extern int sctp_no_csum_on_loopback; 2043 1.1.2.2 skrll 2044 1.1.2.2 skrll static int 2045 1.1.2.2 skrll sctp_lowlevel_chunk_output(struct sctp_inpcb *inp, 2046 1.1.2.2 skrll struct sctp_tcb *stcb, /* may be NULL */ 2047 1.1.2.2 skrll struct sctp_nets *net, 2048 1.1.2.2 skrll const struct sockaddr *to, 2049 1.1.2.2 skrll struct mbuf *m, 2050 1.1.2.2 skrll int nofragment_flag, 2051 1.1.2.2 skrll int ecn_ok, 2052 1.1.2.2 skrll struct sctp_tmit_chunk *chk, 2053 1.1.2.2 skrll int out_of_asoc_ok) 2054 1.1.2.2 skrll /* nofragment_flag to tell if IP_DF should be set (IPv4 only) */ 2055 1.1.2.2 skrll { 2056 1.1.2.2 skrll /* 2057 1.1.2.2 skrll * Given a mbuf chain (via m_next) that holds a packet header 2058 1.1.2.2 skrll * WITH a SCTPHDR but no IP header, endpoint inp and sa structure. 2059 1.1.2.2 skrll * - calculate SCTP checksum and fill in 2060 1.1.2.2 skrll * - prepend a IP address header 2061 1.1.2.2 skrll * - if boundall use INADDR_ANY 2062 1.1.2.2 skrll * - if boundspecific do source address selection 2063 1.1.2.2 skrll * - set fragmentation option for ipV4 2064 1.1.2.2 skrll * - On return from IP output, check/adjust mtu size 2065 1.1.2.2 skrll * - of output interface and smallest_mtu size as well. 2066 1.1.2.2 skrll */ 2067 1.1.2.2 skrll struct sctphdr *sctphdr; 2068 1.1.2.2 skrll int o_flgs; 2069 1.1.2.2 skrll uint32_t csum; 2070 1.1.2.2 skrll int ret; 2071 1.1.2.2 skrll unsigned int have_mtu; 2072 1.1.2.2 skrll struct route *ro; 2073 1.1.2.2 skrll struct rtentry *rt; 2074 1.1.2.2 skrll 2075 1.1.2.2 skrll if ((net) && (net->dest_state & SCTP_ADDR_OUT_OF_SCOPE)) { 2076 1.1.2.2 skrll sctp_m_freem(m); 2077 1.1.2.2 skrll return (EFAULT); 2078 1.1.2.2 skrll } 2079 1.1.2.2 skrll if ((m->m_flags & M_PKTHDR) == 0) { 2080 1.1.2.2 skrll #ifdef SCTP_DEBUG 2081 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 2082 1.1.2.2 skrll printf("Software error: sctp_lowlevel_chunk_output() called with non pkthdr!\n"); 2083 1.1.2.2 skrll } 2084 1.1.2.2 skrll #endif 2085 1.1.2.2 skrll sctp_m_freem(m); 2086 1.1.2.2 skrll return (EFAULT); 2087 1.1.2.2 skrll } 2088 1.1.2.2 skrll /* Calculate the csum and fill in the length of the packet */ 2089 1.1.2.2 skrll sctphdr = mtod(m, struct sctphdr *); 2090 1.1.2.2 skrll have_mtu = 0; 2091 1.1.2.2 skrll if (sctp_no_csum_on_loopback && 2092 1.1.2.2 skrll (stcb) && 2093 1.1.2.2 skrll (stcb->asoc.loopback_scope)) { 2094 1.1.2.2 skrll sctphdr->checksum = 0; 2095 1.1.2.2 skrll m->m_pkthdr.len = sctp_calculate_len(m); 2096 1.1.2.2 skrll } else { 2097 1.1.2.2 skrll sctphdr->checksum = 0; 2098 1.1.2.2 skrll csum = sctp_calculate_sum(m, &m->m_pkthdr.len, 0); 2099 1.1.2.2 skrll sctphdr->checksum = csum; 2100 1.1.2.2 skrll } 2101 1.1.2.2 skrll if (to->sa_family == AF_INET) { 2102 1.1.2.2 skrll struct ip *ip; 2103 1.1.2.2 skrll static struct route iproute; 2104 1.1.2.2 skrll M_PREPEND(m, sizeof(struct ip), M_DONTWAIT); 2105 1.1.2.2 skrll if (m == NULL) { 2106 1.1.2.2 skrll /* failed to prepend data, give up */ 2107 1.1.2.2 skrll return (ENOMEM); 2108 1.1.2.2 skrll } 2109 1.1.2.2 skrll ip = mtod(m, struct ip *); 2110 1.1.2.2 skrll ip->ip_v = IPVERSION; 2111 1.1.2.2 skrll ip->ip_hl = (sizeof(struct ip) >> 2); 2112 1.1.2.2 skrll if (nofragment_flag) { 2113 1.1.2.2 skrll ip->ip_off = htons(IP_DF); 2114 1.1.2.2 skrll } else 2115 1.1.2.2 skrll ip->ip_off = 0; 2116 1.1.2.2 skrll 2117 1.1.2.2 skrll ip->ip_id = htons(ip_newid(NULL)); 2118 1.1.2.2 skrll ip->ip_ttl = inp->inp_ip_ttl; 2119 1.1.2.2 skrll ip->ip_len = htons(m->m_pkthdr.len); 2120 1.1.2.2 skrll if (stcb) { 2121 1.1.2.2 skrll if ((stcb->asoc.ecn_allowed) && ecn_ok) { 2122 1.1.2.2 skrll /* Enable ECN */ 2123 1.1.2.2 skrll ip->ip_tos = (u_char)((inp->ip_inp.inp.inp_ip.ip_tos & 0x000000fc) | 2124 1.1.2.2 skrll sctp_get_ect(stcb, chk)); 2125 1.1.2.2 skrll } else { 2126 1.1.2.2 skrll /* No ECN */ 2127 1.1.2.2 skrll ip->ip_tos = inp->ip_inp.inp.inp_ip.ip_tos; 2128 1.1.2.2 skrll } 2129 1.1.2.2 skrll } else { 2130 1.1.2.2 skrll /* no association at all */ 2131 1.1.2.2 skrll ip->ip_tos = inp->inp_ip_tos; 2132 1.1.2.2 skrll } 2133 1.1.2.2 skrll ip->ip_p = IPPROTO_SCTP; 2134 1.1.2.2 skrll ip->ip_sum = 0; 2135 1.1.2.2 skrll #ifdef SCTP_DEBUG 2136 1.1.2.2 skrll printf("chunk_output: net %p\n", net); 2137 1.1.2.2 skrll #endif 2138 1.1.2.2 skrll if (net == NULL) { 2139 1.1.2.2 skrll ro = &iproute; 2140 1.1.2.2 skrll memset(&iproute, 0, sizeof(iproute)); 2141 1.1.2.2 skrll rtcache_lookup(ro, to); 2142 1.1.2.2 skrll } else { 2143 1.1.2.2 skrll ro = (struct route *)&net->ro; 2144 1.1.2.2 skrll } 2145 1.1.2.2 skrll /* Now the address selection part */ 2146 1.1.2.2 skrll ip->ip_dst.s_addr = satocsin(to)->sin_addr.s_addr; 2147 1.1.2.2 skrll 2148 1.1.2.2 skrll /* call the routine to select the src address */ 2149 1.1.2.2 skrll if (net) { 2150 1.1.2.2 skrll if (net->src_addr_selected == 0) { 2151 1.1.2.2 skrll /* Cache the source address */ 2152 1.1.2.2 skrll ((struct sockaddr_in *)&net->_s_addr)->sin_addr = sctp_ipv4_source_address_selection(inp, 2153 1.1.2.2 skrll stcb, 2154 1.1.2.2 skrll ro, net, out_of_asoc_ok); 2155 1.1.2.2 skrll if (rtcache_validate(ro)) { 2156 1.1.2.2 skrll net->src_addr_selected = 1; 2157 1.1.2.2 skrll } 2158 1.1.2.2 skrll } 2159 1.1.2.2 skrll ip->ip_src = ((struct sockaddr_in *)&net->_s_addr)->sin_addr; 2160 1.1.2.2 skrll } else { 2161 1.1.2.2 skrll ip->ip_src = sctp_ipv4_source_address_selection(inp, 2162 1.1.2.2 skrll stcb, ro, net, out_of_asoc_ok); 2163 1.1.2.2 skrll } 2164 1.1.2.2 skrll #ifdef SCTP_DEBUG 2165 1.1.2.2 skrll printf("src addr %x\n", ip->ip_src.s_addr); 2166 1.1.2.2 skrll #endif 2167 1.1.2.2 skrll /* 2168 1.1.2.2 skrll * If source address selection fails and we find no route then 2169 1.1.2.2 skrll * the ip_ouput should fail as well with a NO_ROUTE_TO_HOST 2170 1.1.2.2 skrll * type error. We probably should catch that somewhere and 2171 1.1.2.2 skrll * abort the association right away (assuming this is an INIT 2172 1.1.2.2 skrll * being sent). 2173 1.1.2.2 skrll */ 2174 1.1.2.2 skrll rt = rtcache_validate(ro); 2175 1.1.2.2 skrll if ((rt == NULL)) { 2176 1.1.2.2 skrll /* 2177 1.1.2.2 skrll * src addr selection failed to find a route (or valid 2178 1.1.2.2 skrll * source addr), so we can't get there from here! 2179 1.1.2.2 skrll */ 2180 1.1.2.2 skrll #ifdef SCTP_DEBUG 2181 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 2182 1.1.2.2 skrll printf("low_level_output: dropped v4 packet- no valid source addr\n"); 2183 1.1.2.2 skrll printf("Destination was %x\n", (u_int)(ntohl(ip->ip_dst.s_addr))); 2184 1.1.2.2 skrll } 2185 1.1.2.2 skrll #endif /* SCTP_DEBUG */ 2186 1.1.2.2 skrll if (net) { 2187 1.1.2.2 skrll if ((net->dest_state & SCTP_ADDR_REACHABLE) && stcb) 2188 1.1.2.2 skrll sctp_ulp_notify(SCTP_NOTIFY_INTERFACE_DOWN, 2189 1.1.2.2 skrll stcb, 2190 1.1.2.2 skrll SCTP_FAILED_THRESHOLD, 2191 1.1.2.2 skrll (void *)net); 2192 1.1.2.2 skrll net->dest_state &= ~SCTP_ADDR_REACHABLE; 2193 1.1.2.2 skrll net->dest_state |= SCTP_ADDR_NOT_REACHABLE; 2194 1.1.2.2 skrll if (stcb) { 2195 1.1.2.2 skrll if (net == stcb->asoc.primary_destination) { 2196 1.1.2.2 skrll /* need a new primary */ 2197 1.1.2.2 skrll struct sctp_nets *alt; 2198 1.1.2.2 skrll alt = sctp_find_alternate_net(stcb, net); 2199 1.1.2.2 skrll if (alt != net) { 2200 1.1.2.2 skrll if (sctp_set_primary_addr(stcb, 2201 1.1.2.2 skrll (struct sockaddr *)NULL, 2202 1.1.2.2 skrll alt) == 0) { 2203 1.1.2.2 skrll net->dest_state |= SCTP_ADDR_WAS_PRIMARY; 2204 1.1.2.2 skrll net->src_addr_selected = 0; 2205 1.1.2.2 skrll } 2206 1.1.2.2 skrll } 2207 1.1.2.2 skrll } 2208 1.1.2.2 skrll } 2209 1.1.2.2 skrll } 2210 1.1.2.2 skrll sctp_m_freem(m); 2211 1.1.2.2 skrll return (EHOSTUNREACH); 2212 1.1.2.2 skrll } else { 2213 1.1.2.2 skrll have_mtu = rt->rt_ifp->if_mtu; 2214 1.1.2.2 skrll } 2215 1.1.2.2 skrll 2216 1.1.2.2 skrll o_flgs = (IP_RAWOUTPUT | (inp->sctp_socket->so_options & (SO_DONTROUTE | SO_BROADCAST))); 2217 1.1.2.2 skrll #ifdef SCTP_DEBUG 2218 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 2219 1.1.2.2 skrll printf("Calling ipv4 output routine from low level src addr:%x\n", 2220 1.1.2.2 skrll (u_int)(ntohl(ip->ip_src.s_addr))); 2221 1.1.2.2 skrll printf("Destination is %x\n", (u_int)(ntohl(ip->ip_dst.s_addr))); 2222 1.1.2.2 skrll printf("RTP route is %p through\n", rt); 2223 1.1.2.2 skrll printf("length %d\n", ip->ip_len); 2224 1.1.2.2 skrll } 2225 1.1.2.2 skrll #endif 2226 1.1.2.2 skrll if ((have_mtu) && (net) && (have_mtu > net->mtu)) { 2227 1.1.2.2 skrll rt->rt_ifp->if_mtu = net->mtu; 2228 1.1.2.2 skrll } 2229 1.1.2.2 skrll ret = ip_output(m, inp->ip_inp.inp.inp_options, 2230 1.1.2.2 skrll ro, o_flgs, inp->ip_inp.inp.inp_moptions, 2231 1.1.2.2 skrll (struct socket *)inp->sctp_socket); 2232 1.1.2.2 skrll if ((rt) && (have_mtu) && (net) && (have_mtu > net->mtu)) { 2233 1.1.2.2 skrll rt->rt_ifp->if_mtu = have_mtu; 2234 1.1.2.2 skrll } 2235 1.1.2.2 skrll sctp_pegs[SCTP_DATAGRAMS_SENT]++; 2236 1.1.2.2 skrll #ifdef SCTP_DEBUG 2237 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 2238 1.1.2.2 skrll printf("Ip output returns %d\n", ret); 2239 1.1.2.2 skrll } 2240 1.1.2.2 skrll #endif 2241 1.1.2.2 skrll if (net == NULL) { 2242 1.1.2.2 skrll } else { 2243 1.1.2.2 skrll /* PMTU check versus smallest asoc MTU goes here */ 2244 1.1.2.2 skrll if (rt != NULL) { 2245 1.1.2.2 skrll if (rt->rt_rmx.rmx_mtu && 2246 1.1.2.2 skrll (stcb->asoc.smallest_mtu > rt->rt_rmx.rmx_mtu)) { 2247 1.1.2.2 skrll sctp_mtu_size_reset(inp, &stcb->asoc, 2248 1.1.2.2 skrll rt->rt_rmx.rmx_mtu); 2249 1.1.2.2 skrll } 2250 1.1.2.2 skrll } else { 2251 1.1.2.2 skrll /* route was freed */ 2252 1.1.2.2 skrll net->src_addr_selected = 0; 2253 1.1.2.2 skrll } 2254 1.1.2.2 skrll } 2255 1.1.2.2 skrll return (ret); 2256 1.1.2.2 skrll } 2257 1.1.2.2 skrll #ifdef INET6 2258 1.1.2.2 skrll else if (to->sa_family == AF_INET6) { 2259 1.1.2.2 skrll struct ip6_hdr *ip6h; 2260 1.1.2.2 skrll static struct route ip6route; 2261 1.1.2.2 skrll struct ifnet *ifp; 2262 1.1.2.2 skrll u_char flowTop; 2263 1.1.2.2 skrll uint16_t flowBottom; 2264 1.1.2.2 skrll u_char tosBottom, tosTop; 2265 1.1.2.2 skrll struct sockaddr_in6 *sin6, tmp, *lsa6, lsa6_tmp; 2266 1.1.2.2 skrll int prev_scope=0; 2267 1.1.2.2 skrll u_short prev_port=0; 2268 1.1.2.2 skrll 2269 1.1.2.2 skrll M_PREPEND(m, sizeof(struct ip6_hdr), M_DONTWAIT); 2270 1.1.2.2 skrll if (m == NULL) { 2271 1.1.2.2 skrll /* failed to prepend data, give up */ 2272 1.1.2.2 skrll return (ENOMEM); 2273 1.1.2.2 skrll } 2274 1.1.2.2 skrll ip6h = mtod(m, struct ip6_hdr *); 2275 1.1.2.2 skrll 2276 1.1.2.2 skrll /* 2277 1.1.2.2 skrll * We assume here that inp_flow is in host byte order within 2278 1.1.2.2 skrll * the TCB! 2279 1.1.2.2 skrll */ 2280 1.1.2.2 skrll flowBottom = ((struct in6pcb *)inp)->in6p_flowinfo & 0x0000ffff; 2281 1.1.2.2 skrll flowTop = ((((struct in6pcb *)inp)->in6p_flowinfo & 0x000f0000) >> 16); 2282 1.1.2.2 skrll 2283 1.1.2.2 skrll tosTop = (((((struct in6pcb *)inp)->in6p_flowinfo & 0xf0) >> 4) | IPV6_VERSION); 2284 1.1.2.2 skrll 2285 1.1.2.2 skrll /* protect *sin6 from overwrite */ 2286 1.1.2.2 skrll memcpy(&tmp, to, sizeof(struct sockaddr_in6)); 2287 1.1.2.2 skrll sin6 = &tmp; 2288 1.1.2.2 skrll 2289 1.1.2.2 skrll /* KAME hack: embed scopeid */ 2290 1.1.2.2 skrll #if defined(SCTP_BASE_FREEBSD) || defined(__APPLE__) 2291 1.1.2.2 skrll if (in6_embedscope(&sin6->sin6_addr, sin6, NULL, NULL) != 0) 2292 1.1.2.2 skrll #else 2293 1.1.2.2 skrll /* 2294 1.1.2.2 skrll * XXX: appropriate scope zone must be provided or otherwise 2295 1.1.2.2 skrll * ip6_use_defzone must be 1. 2296 1.1.2.2 skrll */ 2297 1.1.2.2 skrll if (sa6_embedscope(sin6, ip6_use_defzone) != 0) 2298 1.1.2.2 skrll #endif 2299 1.1.2.2 skrll return (EINVAL); 2300 1.1.2.2 skrll if (net == NULL) { 2301 1.1.2.2 skrll memset(&ip6route, 0, sizeof(ip6route)); 2302 1.1.2.2 skrll ro = (struct route *)&ip6route; 2303 1.1.2.2 skrll rtcache_lookup(ro, (struct sockaddr *) sin6); 2304 1.1.2.2 skrll } else { 2305 1.1.2.2 skrll ro = (struct route *)&net->ro; 2306 1.1.2.2 skrll } 2307 1.1.2.2 skrll if (stcb != NULL) { 2308 1.1.2.2 skrll if ((stcb->asoc.ecn_allowed) && ecn_ok) { 2309 1.1.2.2 skrll /* Enable ECN */ 2310 1.1.2.2 skrll tosBottom = (((((struct in6pcb *)inp)->in6p_flowinfo & 0x0c) | sctp_get_ect(stcb, chk)) << 4); 2311 1.1.2.2 skrll } else { 2312 1.1.2.2 skrll /* No ECN */ 2313 1.1.2.2 skrll tosBottom = ((((struct in6pcb *)inp)->in6p_flowinfo & 0x0c) << 4); 2314 1.1.2.2 skrll } 2315 1.1.2.2 skrll } else { 2316 1.1.2.2 skrll /* we could get no asoc if it is a O-O-T-B packet */ 2317 1.1.2.2 skrll tosBottom = ((((struct in6pcb *)inp)->in6p_flowinfo & 0x0c) << 4); 2318 1.1.2.2 skrll } 2319 1.1.2.2 skrll ip6h->ip6_flow = htonl(((tosTop << 24) | ((tosBottom|flowTop) << 16) | flowBottom)); 2320 1.1.2.2 skrll ip6h->ip6_nxt = IPPROTO_SCTP; 2321 1.1.2.2 skrll ip6h->ip6_plen = m->m_pkthdr.len; 2322 1.1.2.2 skrll ip6h->ip6_dst = sin6->sin6_addr; 2323 1.1.2.2 skrll 2324 1.1.2.2 skrll /* 2325 1.1.2.2 skrll * Add SRC address selection here: 2326 1.1.2.2 skrll * we can only reuse to a limited degree the kame src-addr-sel, 2327 1.1.2.2 skrll * since we can try their selection but it may not be bound. 2328 1.1.2.2 skrll */ 2329 1.1.2.2 skrll memset(&lsa6_tmp, 0, sizeof(lsa6_tmp)); 2330 1.1.2.2 skrll lsa6_tmp.sin6_family = AF_INET6; 2331 1.1.2.2 skrll lsa6_tmp.sin6_len = sizeof(lsa6_tmp); 2332 1.1.2.2 skrll lsa6 = &lsa6_tmp; 2333 1.1.2.2 skrll rt = rtcache_validate(ro); 2334 1.1.2.2 skrll if (net) { 2335 1.1.2.2 skrll if (net->src_addr_selected == 0) { 2336 1.1.2.2 skrll /* Cache the source address */ 2337 1.1.2.2 skrll ((struct sockaddr_in6 *)&net->_s_addr)->sin6_addr = sctp_ipv6_source_address_selection(inp, 2338 1.1.2.2 skrll stcb, ro, net, out_of_asoc_ok); 2339 1.1.2.2 skrll 2340 1.1.2.2 skrll if (rt != NULL) { 2341 1.1.2.2 skrll net->src_addr_selected = 1; 2342 1.1.2.2 skrll } 2343 1.1.2.2 skrll } 2344 1.1.2.2 skrll lsa6->sin6_addr = ((struct sockaddr_in6 *)&net->_s_addr)->sin6_addr; 2345 1.1.2.2 skrll } else { 2346 1.1.2.2 skrll lsa6->sin6_addr = sctp_ipv6_source_address_selection( 2347 1.1.2.2 skrll inp, stcb, ro, net, out_of_asoc_ok); 2348 1.1.2.2 skrll } 2349 1.1.2.2 skrll lsa6->sin6_port = inp->sctp_lport; 2350 1.1.2.2 skrll 2351 1.1.2.2 skrll if ((rt == NULL)) { 2352 1.1.2.2 skrll /* 2353 1.1.2.2 skrll * src addr selection failed to find a route (or valid 2354 1.1.2.2 skrll * source addr), so we can't get there from here! 2355 1.1.2.2 skrll */ 2356 1.1.2.2 skrll #ifdef SCTP_DEBUG 2357 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 2358 1.1.2.2 skrll printf("low_level_output: dropped v6 pkt- no valid source addr\n"); 2359 1.1.2.2 skrll } 2360 1.1.2.2 skrll #endif 2361 1.1.2.2 skrll sctp_m_freem(m); 2362 1.1.2.2 skrll if (net) { 2363 1.1.2.2 skrll if ((net->dest_state & SCTP_ADDR_REACHABLE) && stcb) 2364 1.1.2.2 skrll sctp_ulp_notify(SCTP_NOTIFY_INTERFACE_DOWN, 2365 1.1.2.2 skrll stcb, 2366 1.1.2.2 skrll SCTP_FAILED_THRESHOLD, 2367 1.1.2.2 skrll (void *)net); 2368 1.1.2.2 skrll net->dest_state &= ~SCTP_ADDR_REACHABLE; 2369 1.1.2.2 skrll net->dest_state |= SCTP_ADDR_NOT_REACHABLE; 2370 1.1.2.2 skrll if (stcb) { 2371 1.1.2.2 skrll if (net == stcb->asoc.primary_destination) { 2372 1.1.2.2 skrll /* need a new primary */ 2373 1.1.2.2 skrll struct sctp_nets *alt; 2374 1.1.2.2 skrll alt = sctp_find_alternate_net(stcb, net); 2375 1.1.2.2 skrll if (alt != net) { 2376 1.1.2.2 skrll if (sctp_set_primary_addr(stcb, 2377 1.1.2.2 skrll (struct sockaddr *)NULL, 2378 1.1.2.2 skrll alt) == 0) { 2379 1.1.2.2 skrll net->dest_state |= SCTP_ADDR_WAS_PRIMARY; 2380 1.1.2.2 skrll net->src_addr_selected = 0; 2381 1.1.2.2 skrll } 2382 1.1.2.2 skrll } 2383 1.1.2.2 skrll } 2384 1.1.2.2 skrll } 2385 1.1.2.2 skrll } 2386 1.1.2.2 skrll return (EHOSTUNREACH); 2387 1.1.2.2 skrll } 2388 1.1.2.2 skrll 2389 1.1.2.2 skrll ip6h->ip6_src = lsa6->sin6_addr; 2390 1.1.2.2 skrll 2391 1.1.2.2 skrll /* 2392 1.1.2.2 skrll * We set the hop limit now since there is a good chance that 2393 1.1.2.2 skrll * our ro pointer is now filled 2394 1.1.2.2 skrll */ 2395 1.1.2.2 skrll ip6h->ip6_hlim = in6_selecthlim((struct in6pcb *)&inp->ip_inp.inp, 2396 1.1.2.2 skrll (ro ? 2397 1.1.2.2 skrll (rt ? (rt->rt_ifp) : (NULL)) : 2398 1.1.2.2 skrll (NULL))); 2399 1.1.2.2 skrll o_flgs = 0; 2400 1.1.2.2 skrll ifp = rt->rt_ifp; 2401 1.1.2.2 skrll #ifdef SCTP_DEBUG 2402 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 2403 1.1.2.2 skrll /* Copy to be sure something bad is not happening */ 2404 1.1.2.2 skrll sin6->sin6_addr = ip6h->ip6_dst; 2405 1.1.2.2 skrll lsa6->sin6_addr = ip6h->ip6_src; 2406 1.1.2.2 skrll 2407 1.1.2.2 skrll printf("Calling ipv6 output routine from low level\n"); 2408 1.1.2.2 skrll printf("src: "); 2409 1.1.2.2 skrll sctp_print_address((struct sockaddr *)lsa6); 2410 1.1.2.2 skrll printf("dst: "); 2411 1.1.2.2 skrll sctp_print_address((struct sockaddr *)sin6); 2412 1.1.2.2 skrll } 2413 1.1.2.2 skrll #endif /* SCTP_DEBUG */ 2414 1.1.2.2 skrll if (net) { 2415 1.1.2.2 skrll sin6 = (struct sockaddr_in6 *)&net->ro.ro_sa; 2416 1.1.2.2 skrll /* preserve the port and scope for link local send */ 2417 1.1.2.2 skrll prev_scope = sin6->sin6_scope_id; 2418 1.1.2.2 skrll prev_port = sin6->sin6_port; 2419 1.1.2.2 skrll } 2420 1.1.2.2 skrll ret = ip6_output(m, ((struct in6pcb *)inp)->in6p_outputopts, 2421 1.1.2.2 skrll ro, 2422 1.1.2.2 skrll o_flgs, 2423 1.1.2.2 skrll ((struct in6pcb *)inp)->in6p_moptions, 2424 1.1.2.2 skrll (struct socket *)inp->sctp_socket, 2425 1.1.2.2 skrll &ifp); 2426 1.1.2.2 skrll if (net) { 2427 1.1.2.2 skrll /* for link local this must be done */ 2428 1.1.2.2 skrll sin6->sin6_scope_id = prev_scope; 2429 1.1.2.2 skrll sin6->sin6_port = prev_port; 2430 1.1.2.2 skrll } 2431 1.1.2.2 skrll #ifdef SCTP_DEBUG 2432 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 2433 1.1.2.2 skrll printf("return from send is %d\n", ret); 2434 1.1.2.2 skrll } 2435 1.1.2.2 skrll #endif /* SCTP_DEBUG_OUTPUT */ 2436 1.1.2.2 skrll sctp_pegs[SCTP_DATAGRAMS_SENT]++; 2437 1.1.2.2 skrll if (net) { 2438 1.1.2.2 skrll /* PMTU check versus smallest asoc MTU goes here */ 2439 1.1.2.2 skrll rt = rtcache_validate(ro); 2440 1.1.2.2 skrll if (rt == NULL) { 2441 1.1.2.2 skrll /* Route was freed */ 2442 1.1.2.2 skrll net->src_addr_selected = 0; 2443 1.1.2.2 skrll } 2444 1.1.2.2 skrll if (rt != NULL) { 2445 1.1.2.2 skrll if (rt->rt_rmx.rmx_mtu && 2446 1.1.2.2 skrll (stcb->asoc.smallest_mtu > rt->rt_rmx.rmx_mtu)) { 2447 1.1.2.2 skrll sctp_mtu_size_reset(inp, 2448 1.1.2.2 skrll &stcb->asoc, 2449 1.1.2.2 skrll rt->rt_rmx.rmx_mtu); 2450 1.1.2.2 skrll } 2451 1.1.2.2 skrll } else if (ifp) { 2452 1.1.2.2 skrll if (ND_IFINFO(ifp)->linkmtu && 2453 1.1.2.2 skrll (stcb->asoc.smallest_mtu > ND_IFINFO(ifp)->linkmtu)) { 2454 1.1.2.2 skrll sctp_mtu_size_reset(inp, 2455 1.1.2.2 skrll &stcb->asoc, 2456 1.1.2.2 skrll ND_IFINFO(ifp)->linkmtu); 2457 1.1.2.2 skrll } 2458 1.1.2.2 skrll } 2459 1.1.2.2 skrll } 2460 1.1.2.2 skrll return (ret); 2461 1.1.2.2 skrll } 2462 1.1.2.2 skrll #endif 2463 1.1.2.2 skrll else { 2464 1.1.2.2 skrll #ifdef SCTP_DEBUG 2465 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 2466 1.1.2.2 skrll printf("Unknown protocol (TSNH) type %d\n", ((const struct sockaddr *)to)->sa_family); 2467 1.1.2.2 skrll } 2468 1.1.2.2 skrll #endif 2469 1.1.2.2 skrll sctp_m_freem(m); 2470 1.1.2.2 skrll return (EFAULT); 2471 1.1.2.2 skrll } 2472 1.1.2.2 skrll } 2473 1.1.2.2 skrll 2474 1.1.2.2 skrll static 2475 1.1.2.2 skrll int sctp_is_address_in_scope(struct ifaddr *ifa, 2476 1.1.2.2 skrll int ipv4_addr_legal, 2477 1.1.2.2 skrll int ipv6_addr_legal, 2478 1.1.2.2 skrll int loopback_scope, 2479 1.1.2.2 skrll int ipv4_local_scope, 2480 1.1.2.2 skrll int local_scope, 2481 1.1.2.2 skrll int site_scope) 2482 1.1.2.2 skrll { 2483 1.1.2.2 skrll if ((loopback_scope == 0) && 2484 1.1.2.2 skrll (ifa->ifa_ifp) && 2485 1.1.2.2 skrll (ifa->ifa_ifp->if_type == IFT_LOOP)) { 2486 1.1.2.2 skrll /* skip loopback if not in scope * 2487 1.1.2.2 skrll */ 2488 1.1.2.2 skrll return (0); 2489 1.1.2.2 skrll } 2490 1.1.2.2 skrll if ((ifa->ifa_addr->sa_family == AF_INET) && ipv4_addr_legal) { 2491 1.1.2.2 skrll struct sockaddr_in *sin; 2492 1.1.2.2 skrll sin = (struct sockaddr_in *)ifa->ifa_addr; 2493 1.1.2.2 skrll if (sin->sin_addr.s_addr == 0) { 2494 1.1.2.2 skrll /* not in scope , unspecified */ 2495 1.1.2.2 skrll return (0); 2496 1.1.2.2 skrll } 2497 1.1.2.2 skrll if ((ipv4_local_scope == 0) && 2498 1.1.2.2 skrll (IN4_ISPRIVATE_ADDRESS(&sin->sin_addr))) { 2499 1.1.2.2 skrll /* private address not in scope */ 2500 1.1.2.2 skrll return (0); 2501 1.1.2.2 skrll } 2502 1.1.2.2 skrll } else if ((ifa->ifa_addr->sa_family == AF_INET6) && ipv6_addr_legal) { 2503 1.1.2.2 skrll struct sockaddr_in6 *sin6; 2504 1.1.2.2 skrll struct in6_ifaddr *ifa6; 2505 1.1.2.2 skrll 2506 1.1.2.2 skrll ifa6 = (struct in6_ifaddr *)ifa; 2507 1.1.2.2 skrll /* ok to use deprecated addresses? */ 2508 1.1.2.2 skrll if (!ip6_use_deprecated) { 2509 1.1.2.2 skrll if (ifa6->ia6_flags & 2510 1.1.2.2 skrll IN6_IFF_DEPRECATED) { 2511 1.1.2.2 skrll return (0); 2512 1.1.2.2 skrll } 2513 1.1.2.2 skrll } 2514 1.1.2.2 skrll if (ifa6->ia6_flags & 2515 1.1.2.2 skrll (IN6_IFF_DETACHED | 2516 1.1.2.2 skrll IN6_IFF_ANYCAST | 2517 1.1.2.2 skrll IN6_IFF_NOTREADY)) { 2518 1.1.2.2 skrll return (0); 2519 1.1.2.2 skrll } 2520 1.1.2.2 skrll sin6 = (struct sockaddr_in6 *)ifa->ifa_addr; 2521 1.1.2.2 skrll if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr)) { 2522 1.1.2.2 skrll /* skip unspecifed addresses */ 2523 1.1.2.2 skrll return (0); 2524 1.1.2.2 skrll } 2525 1.1.2.2 skrll if (/*(local_scope == 0) && */ 2526 1.1.2.2 skrll (IN6_IS_ADDR_LINKLOCAL(&sin6->sin6_addr))) { 2527 1.1.2.2 skrll return (0); 2528 1.1.2.2 skrll } 2529 1.1.2.2 skrll if ((site_scope == 0) && 2530 1.1.2.2 skrll (IN6_IS_ADDR_SITELOCAL(&sin6->sin6_addr))) { 2531 1.1.2.2 skrll return (0); 2532 1.1.2.2 skrll } 2533 1.1.2.2 skrll } else { 2534 1.1.2.2 skrll return (0); 2535 1.1.2.2 skrll } 2536 1.1.2.2 skrll return (1); 2537 1.1.2.2 skrll } 2538 1.1.2.2 skrll 2539 1.1.2.2 skrll 2540 1.1.2.2 skrll void 2541 1.1.2.2 skrll sctp_send_initiate(struct sctp_inpcb *inp, struct sctp_tcb *stcb) 2542 1.1.2.2 skrll { 2543 1.1.2.2 skrll struct mbuf *m, *m_at, *m_last; 2544 1.1.2.2 skrll struct sctp_nets *net; 2545 1.1.2.2 skrll struct sctp_init_msg *initm; 2546 1.1.2.2 skrll struct sctp_supported_addr_param *sup_addr; 2547 1.1.2.2 skrll struct sctp_ecn_supported_param *ecn; 2548 1.1.2.2 skrll struct sctp_prsctp_supported_param *prsctp; 2549 1.1.2.2 skrll struct sctp_ecn_nonce_supported_param *ecn_nonce; 2550 1.1.2.2 skrll struct sctp_supported_chunk_types_param *pr_supported; 2551 1.1.2.2 skrll int cnt_inits_to=0; 2552 1.1.2.2 skrll int padval, ret; 2553 1.1.2.2 skrll 2554 1.1.2.2 skrll /* INIT's always go to the primary (and usually ONLY address) */ 2555 1.1.2.2 skrll m_last = NULL; 2556 1.1.2.2 skrll net = stcb->asoc.primary_destination; 2557 1.1.2.2 skrll if (net == NULL) { 2558 1.1.2.2 skrll net = TAILQ_FIRST(&stcb->asoc.nets); 2559 1.1.2.2 skrll if (net == NULL) { 2560 1.1.2.2 skrll /* TSNH */ 2561 1.1.2.2 skrll return; 2562 1.1.2.2 skrll } 2563 1.1.2.2 skrll /* we confirm any address we send an INIT to */ 2564 1.1.2.2 skrll net->dest_state &= ~SCTP_ADDR_UNCONFIRMED; 2565 1.1.2.2 skrll sctp_set_primary_addr(stcb, NULL, net); 2566 1.1.2.2 skrll } else { 2567 1.1.2.2 skrll /* we confirm any address we send an INIT to */ 2568 1.1.2.2 skrll net->dest_state &= ~SCTP_ADDR_UNCONFIRMED; 2569 1.1.2.2 skrll } 2570 1.1.2.2 skrll #ifdef SCTP_DEBUG 2571 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT4) { 2572 1.1.2.2 skrll printf("Sending INIT to "); 2573 1.1.2.2 skrll sctp_print_address (rtcache_getdst(&net->ro)); 2574 1.1.2.2 skrll } 2575 1.1.2.2 skrll #endif 2576 1.1.2.2 skrll if (rtcache_getdst(&net->ro)->sa_family == AF_INET6) { 2577 1.1.2.2 skrll /* special hook, if we are sending to link local 2578 1.1.2.2 skrll * it will not show up in our private address count. 2579 1.1.2.2 skrll */ 2580 1.1.2.2 skrll if (IN6_IS_ADDR_LINKLOCAL((const struct in6_addr *) rtcache_getdst(&net->ro)->sa_data)) 2581 1.1.2.2 skrll cnt_inits_to = 1; 2582 1.1.2.2 skrll } 2583 1.1.2.2 skrll if (callout_pending(&net->rxt_timer.timer)) { 2584 1.1.2.2 skrll /* This case should not happen */ 2585 1.1.2.2 skrll return; 2586 1.1.2.2 skrll } 2587 1.1.2.2 skrll /* start the INIT timer */ 2588 1.1.2.2 skrll if (sctp_timer_start(SCTP_TIMER_TYPE_INIT, inp, stcb, net)) { 2589 1.1.2.2 skrll /* we are hosed since I can't start the INIT timer? */ 2590 1.1.2.2 skrll return; 2591 1.1.2.2 skrll } 2592 1.1.2.2 skrll MGETHDR(m, M_DONTWAIT, MT_HEADER); 2593 1.1.2.2 skrll if (m == NULL) { 2594 1.1.2.2 skrll /* No memory, INIT timer will re-attempt. */ 2595 1.1.2.2 skrll return; 2596 1.1.2.2 skrll } 2597 1.1.2.2 skrll /* make it into a M_EXT */ 2598 1.1.2.2 skrll MCLGET(m, M_DONTWAIT); 2599 1.1.2.2 skrll if ((m->m_flags & M_EXT) != M_EXT) { 2600 1.1.2.2 skrll /* Failed to get cluster buffer */ 2601 1.1.2.2 skrll sctp_m_freem(m); 2602 1.1.2.2 skrll return; 2603 1.1.2.2 skrll } 2604 1.1.2.2 skrll m->m_data += SCTP_MIN_OVERHEAD; 2605 1.1.2.2 skrll m->m_len = sizeof(struct sctp_init_msg); 2606 1.1.2.2 skrll /* Now lets put the SCTP header in place */ 2607 1.1.2.2 skrll initm = mtod(m, struct sctp_init_msg *); 2608 1.1.2.2 skrll initm->sh.src_port = inp->sctp_lport; 2609 1.1.2.2 skrll initm->sh.dest_port = stcb->rport; 2610 1.1.2.2 skrll initm->sh.v_tag = 0; 2611 1.1.2.2 skrll initm->sh.checksum = 0; /* calculate later */ 2612 1.1.2.2 skrll /* now the chunk header */ 2613 1.1.2.2 skrll initm->msg.ch.chunk_type = SCTP_INITIATION; 2614 1.1.2.2 skrll initm->msg.ch.chunk_flags = 0; 2615 1.1.2.2 skrll /* fill in later from mbuf we build */ 2616 1.1.2.2 skrll initm->msg.ch.chunk_length = 0; 2617 1.1.2.2 skrll /* place in my tag */ 2618 1.1.2.2 skrll initm->msg.init.initiate_tag = htonl(stcb->asoc.my_vtag); 2619 1.1.2.2 skrll /* set up some of the credits. */ 2620 1.1.2.2 skrll initm->msg.init.a_rwnd = htonl(max(inp->sctp_socket->so_rcv.sb_hiwat, 2621 1.1.2.2 skrll SCTP_MINIMAL_RWND)); 2622 1.1.2.2 skrll 2623 1.1.2.2 skrll initm->msg.init.num_outbound_streams = htons(stcb->asoc.pre_open_streams); 2624 1.1.2.2 skrll initm->msg.init.num_inbound_streams = htons(stcb->asoc.max_inbound_streams); 2625 1.1.2.2 skrll initm->msg.init.initial_tsn = htonl(stcb->asoc.init_seq_number); 2626 1.1.2.2 skrll /* now the address restriction */ 2627 1.1.2.2 skrll sup_addr = (struct sctp_supported_addr_param *)((vaddr_t)initm + 2628 1.1.2.2 skrll sizeof(*initm)); 2629 1.1.2.2 skrll sup_addr->ph.param_type = htons(SCTP_SUPPORTED_ADDRTYPE); 2630 1.1.2.2 skrll /* we support 2 types IPv6/IPv4 */ 2631 1.1.2.2 skrll sup_addr->ph.param_length = htons(sizeof(*sup_addr) + 2632 1.1.2.2 skrll sizeof(uint16_t)); 2633 1.1.2.2 skrll sup_addr->addr_type[0] = htons(SCTP_IPV4_ADDRESS); 2634 1.1.2.2 skrll sup_addr->addr_type[1] = htons(SCTP_IPV6_ADDRESS); 2635 1.1.2.2 skrll m->m_len += sizeof(*sup_addr) + sizeof(uint16_t); 2636 1.1.2.2 skrll 2637 1.1.2.2 skrll /* if (inp->sctp_flags & SCTP_PCB_FLAGS_ADAPTIONEVNT) {*/ 2638 1.1.2.2 skrll if (inp->sctp_ep.adaption_layer_indicator) { 2639 1.1.2.2 skrll struct sctp_adaption_layer_indication *ali; 2640 1.1.2.2 skrll ali = (struct sctp_adaption_layer_indication *)( 2641 1.1.2.2 skrll (vaddr_t)sup_addr + sizeof(*sup_addr) + sizeof(uint16_t)); 2642 1.1.2.2 skrll ali->ph.param_type = htons(SCTP_ULP_ADAPTION); 2643 1.1.2.2 skrll ali->ph.param_length = htons(sizeof(*ali)); 2644 1.1.2.2 skrll ali->indication = ntohl(inp->sctp_ep.adaption_layer_indicator); 2645 1.1.2.2 skrll m->m_len += sizeof(*ali); 2646 1.1.2.2 skrll ecn = (struct sctp_ecn_supported_param *)((vaddr_t)ali + 2647 1.1.2.2 skrll sizeof(*ali)); 2648 1.1.2.2 skrll } else { 2649 1.1.2.2 skrll ecn = (struct sctp_ecn_supported_param *)((vaddr_t)sup_addr + 2650 1.1.2.2 skrll sizeof(*sup_addr) + sizeof(uint16_t)); 2651 1.1.2.2 skrll } 2652 1.1.2.2 skrll 2653 1.1.2.2 skrll /* now any cookie time extensions */ 2654 1.1.2.2 skrll if (stcb->asoc.cookie_preserve_req) { 2655 1.1.2.2 skrll struct sctp_cookie_perserve_param *cookie_preserve; 2656 1.1.2.2 skrll cookie_preserve = (struct sctp_cookie_perserve_param *)(ecn); 2657 1.1.2.2 skrll cookie_preserve->ph.param_type = htons(SCTP_COOKIE_PRESERVE); 2658 1.1.2.2 skrll cookie_preserve->ph.param_length = htons( 2659 1.1.2.2 skrll sizeof(*cookie_preserve)); 2660 1.1.2.2 skrll cookie_preserve->time = htonl(stcb->asoc.cookie_preserve_req); 2661 1.1.2.2 skrll m->m_len += sizeof(*cookie_preserve); 2662 1.1.2.2 skrll ecn = (struct sctp_ecn_supported_param *)( 2663 1.1.2.2 skrll (vaddr_t)cookie_preserve + sizeof(*cookie_preserve)); 2664 1.1.2.2 skrll stcb->asoc.cookie_preserve_req = 0; 2665 1.1.2.2 skrll } 2666 1.1.2.2 skrll 2667 1.1.2.2 skrll /* ECN parameter */ 2668 1.1.2.2 skrll if (sctp_ecn == 1) { 2669 1.1.2.2 skrll ecn->ph.param_type = htons(SCTP_ECN_CAPABLE); 2670 1.1.2.2 skrll ecn->ph.param_length = htons(sizeof(*ecn)); 2671 1.1.2.2 skrll m->m_len += sizeof(*ecn); 2672 1.1.2.2 skrll prsctp = (struct sctp_prsctp_supported_param *)((vaddr_t)ecn + 2673 1.1.2.2 skrll sizeof(*ecn)); 2674 1.1.2.2 skrll } else { 2675 1.1.2.2 skrll prsctp = (struct sctp_prsctp_supported_param *)((vaddr_t)ecn); 2676 1.1.2.2 skrll } 2677 1.1.2.2 skrll /* And now tell the peer we do pr-sctp */ 2678 1.1.2.2 skrll prsctp->ph.param_type = htons(SCTP_PRSCTP_SUPPORTED); 2679 1.1.2.2 skrll prsctp->ph.param_length = htons(sizeof(*prsctp)); 2680 1.1.2.2 skrll m->m_len += sizeof(*prsctp); 2681 1.1.2.2 skrll 2682 1.1.2.2 skrll 2683 1.1.2.2 skrll /* And now tell the peer we do all the extensions */ 2684 1.1.2.2 skrll pr_supported = (struct sctp_supported_chunk_types_param *)((vaddr_t)prsctp + 2685 1.1.2.2 skrll sizeof(*prsctp)); 2686 1.1.2.2 skrll 2687 1.1.2.2 skrll pr_supported->ph.param_type = htons(SCTP_SUPPORTED_CHUNK_EXT); 2688 1.1.2.2 skrll pr_supported->ph.param_length = htons(sizeof(*pr_supported) + SCTP_EXT_COUNT); 2689 1.1.2.2 skrll pr_supported->chunk_types[0] = SCTP_ASCONF; 2690 1.1.2.2 skrll pr_supported->chunk_types[1] = SCTP_ASCONF_ACK; 2691 1.1.2.2 skrll pr_supported->chunk_types[2] = SCTP_FORWARD_CUM_TSN; 2692 1.1.2.2 skrll pr_supported->chunk_types[3] = SCTP_PACKET_DROPPED; 2693 1.1.2.2 skrll pr_supported->chunk_types[4] = SCTP_STREAM_RESET; 2694 1.1.2.2 skrll pr_supported->chunk_types[5] = 0; /* pad */ 2695 1.1.2.2 skrll pr_supported->chunk_types[6] = 0; /* pad */ 2696 1.1.2.2 skrll pr_supported->chunk_types[7] = 0; /* pad */ 2697 1.1.2.2 skrll 2698 1.1.2.2 skrll m->m_len += (sizeof(*pr_supported) + SCTP_EXT_COUNT + SCTP_PAD_EXT_COUNT); 2699 1.1.2.2 skrll /* ECN nonce: And now tell the peer we support ECN nonce */ 2700 1.1.2.2 skrll 2701 1.1.2.2 skrll if (sctp_ecn_nonce) { 2702 1.1.2.2 skrll ecn_nonce = (struct sctp_ecn_nonce_supported_param *)((vaddr_t)pr_supported + 2703 1.1.2.2 skrll sizeof(*pr_supported) + SCTP_EXT_COUNT + SCTP_PAD_EXT_COUNT); 2704 1.1.2.2 skrll ecn_nonce->ph.param_type = htons(SCTP_ECN_NONCE_SUPPORTED); 2705 1.1.2.2 skrll ecn_nonce->ph.param_length = htons(sizeof(*ecn_nonce)); 2706 1.1.2.2 skrll m->m_len += sizeof(*ecn_nonce); 2707 1.1.2.2 skrll } 2708 1.1.2.2 skrll 2709 1.1.2.2 skrll m_at = m; 2710 1.1.2.2 skrll /* now the addresses */ 2711 1.1.2.2 skrll if (inp->sctp_flags & SCTP_PCB_FLAGS_BOUNDALL) { 2712 1.1.2.2 skrll struct ifnet *ifn; 2713 1.1.2.2 skrll struct ifaddr *ifa; 2714 1.1.2.2 skrll int cnt; 2715 1.1.2.2 skrll 2716 1.1.2.2 skrll cnt = cnt_inits_to; 2717 1.1.2.2 skrll TAILQ_FOREACH(ifn, &ifnet_list, if_list) { 2718 1.1.2.2 skrll if ((stcb->asoc.loopback_scope == 0) && 2719 1.1.2.2 skrll (ifn->if_type == IFT_LOOP)) { 2720 1.1.2.2 skrll /* 2721 1.1.2.2 skrll * Skip loopback devices if loopback_scope 2722 1.1.2.2 skrll * not set 2723 1.1.2.2 skrll */ 2724 1.1.2.2 skrll continue; 2725 1.1.2.2 skrll } 2726 1.1.2.2 skrll TAILQ_FOREACH(ifa, &ifn->if_addrlist, ifa_list) { 2727 1.1.2.2 skrll if (sctp_is_address_in_scope(ifa, 2728 1.1.2.2 skrll stcb->asoc.ipv4_addr_legal, 2729 1.1.2.2 skrll stcb->asoc.ipv6_addr_legal, 2730 1.1.2.2 skrll stcb->asoc.loopback_scope, 2731 1.1.2.2 skrll stcb->asoc.ipv4_local_scope, 2732 1.1.2.2 skrll stcb->asoc.local_scope, 2733 1.1.2.2 skrll stcb->asoc.site_scope) == 0) { 2734 1.1.2.2 skrll continue; 2735 1.1.2.2 skrll } 2736 1.1.2.2 skrll cnt++; 2737 1.1.2.2 skrll } 2738 1.1.2.2 skrll } 2739 1.1.2.2 skrll if (cnt > 1) { 2740 1.1.2.2 skrll TAILQ_FOREACH(ifn, &ifnet_list, if_list) { 2741 1.1.2.2 skrll if ((stcb->asoc.loopback_scope == 0) && 2742 1.1.2.2 skrll (ifn->if_type == IFT_LOOP)) { 2743 1.1.2.2 skrll /* 2744 1.1.2.2 skrll * Skip loopback devices if loopback_scope 2745 1.1.2.2 skrll * not set 2746 1.1.2.2 skrll */ 2747 1.1.2.2 skrll continue; 2748 1.1.2.2 skrll } 2749 1.1.2.2 skrll TAILQ_FOREACH(ifa, &ifn->if_addrlist, ifa_list) { 2750 1.1.2.2 skrll if (sctp_is_address_in_scope(ifa, 2751 1.1.2.2 skrll stcb->asoc.ipv4_addr_legal, 2752 1.1.2.2 skrll stcb->asoc.ipv6_addr_legal, 2753 1.1.2.2 skrll stcb->asoc.loopback_scope, 2754 1.1.2.2 skrll stcb->asoc.ipv4_local_scope, 2755 1.1.2.2 skrll stcb->asoc.local_scope, 2756 1.1.2.2 skrll stcb->asoc.site_scope) == 0) { 2757 1.1.2.2 skrll continue; 2758 1.1.2.2 skrll } 2759 1.1.2.2 skrll m_at = sctp_add_addr_to_mbuf(m_at, ifa); 2760 1.1.2.2 skrll } 2761 1.1.2.2 skrll } 2762 1.1.2.2 skrll } 2763 1.1.2.2 skrll } else { 2764 1.1.2.2 skrll struct sctp_laddr *laddr; 2765 1.1.2.2 skrll int cnt; 2766 1.1.2.2 skrll cnt = cnt_inits_to; 2767 1.1.2.2 skrll /* First, how many ? */ 2768 1.1.2.2 skrll LIST_FOREACH(laddr, &inp->sctp_addr_list, sctp_nxt_addr) { 2769 1.1.2.2 skrll if (laddr->ifa == NULL) { 2770 1.1.2.2 skrll continue; 2771 1.1.2.2 skrll } 2772 1.1.2.2 skrll if (laddr->ifa->ifa_addr == NULL) 2773 1.1.2.2 skrll continue; 2774 1.1.2.2 skrll if (sctp_is_address_in_scope(laddr->ifa, 2775 1.1.2.2 skrll stcb->asoc.ipv4_addr_legal, 2776 1.1.2.2 skrll stcb->asoc.ipv6_addr_legal, 2777 1.1.2.2 skrll stcb->asoc.loopback_scope, 2778 1.1.2.2 skrll stcb->asoc.ipv4_local_scope, 2779 1.1.2.2 skrll stcb->asoc.local_scope, 2780 1.1.2.2 skrll stcb->asoc.site_scope) == 0) { 2781 1.1.2.2 skrll continue; 2782 1.1.2.2 skrll } 2783 1.1.2.2 skrll cnt++; 2784 1.1.2.2 skrll } 2785 1.1.2.2 skrll /* To get through a NAT we only list addresses if 2786 1.1.2.2 skrll * we have more than one. That way if you just 2787 1.1.2.2 skrll * bind a single address we let the source of the init 2788 1.1.2.2 skrll * dictate our address. 2789 1.1.2.2 skrll */ 2790 1.1.2.2 skrll if (cnt > 1) { 2791 1.1.2.2 skrll LIST_FOREACH(laddr, &inp->sctp_addr_list, sctp_nxt_addr) { 2792 1.1.2.2 skrll if (laddr->ifa == NULL) { 2793 1.1.2.2 skrll continue; 2794 1.1.2.2 skrll } 2795 1.1.2.2 skrll if (laddr->ifa->ifa_addr == NULL) { 2796 1.1.2.2 skrll continue; 2797 1.1.2.2 skrll } 2798 1.1.2.2 skrll 2799 1.1.2.2 skrll if (sctp_is_address_in_scope(laddr->ifa, 2800 1.1.2.2 skrll stcb->asoc.ipv4_addr_legal, 2801 1.1.2.2 skrll stcb->asoc.ipv6_addr_legal, 2802 1.1.2.2 skrll stcb->asoc.loopback_scope, 2803 1.1.2.2 skrll stcb->asoc.ipv4_local_scope, 2804 1.1.2.2 skrll stcb->asoc.local_scope, 2805 1.1.2.2 skrll stcb->asoc.site_scope) == 0) { 2806 1.1.2.2 skrll continue; 2807 1.1.2.2 skrll } 2808 1.1.2.2 skrll m_at = sctp_add_addr_to_mbuf(m_at, laddr->ifa); 2809 1.1.2.2 skrll } 2810 1.1.2.2 skrll } 2811 1.1.2.2 skrll } 2812 1.1.2.2 skrll /* calulate the size and update pkt header and chunk header */ 2813 1.1.2.2 skrll m->m_pkthdr.len = 0; 2814 1.1.2.2 skrll for (m_at = m; m_at; m_at = m_at->m_next) { 2815 1.1.2.2 skrll if (m_at->m_next == NULL) 2816 1.1.2.2 skrll m_last = m_at; 2817 1.1.2.2 skrll m->m_pkthdr.len += m_at->m_len; 2818 1.1.2.2 skrll } 2819 1.1.2.2 skrll initm->msg.ch.chunk_length = htons((m->m_pkthdr.len - 2820 1.1.2.2 skrll sizeof(struct sctphdr))); 2821 1.1.2.2 skrll #ifdef SCTP_DEBUG 2822 1.1.2.2 skrll printf("chunk_length %d\n", ntohs(initm->msg.ch.chunk_length)); 2823 1.1.2.2 skrll #endif 2824 1.1.2.2 skrll /* We pass 0 here to NOT set IP_DF if its IPv4, we 2825 1.1.2.2 skrll * ignore the return here since the timer will drive 2826 1.1.2.2 skrll * a retranmission. 2827 1.1.2.2 skrll */ 2828 1.1.2.2 skrll 2829 1.1.2.2 skrll /* I don't expect this to execute but we will be safe here */ 2830 1.1.2.2 skrll padval = m->m_pkthdr.len % 4; 2831 1.1.2.2 skrll if ((padval) && (m_last)) { 2832 1.1.2.2 skrll /* The compiler worries that m_last may not be 2833 1.1.2.2 skrll * set even though I think it is impossible :-> 2834 1.1.2.2 skrll * however we add m_last here just in case. 2835 1.1.2.2 skrll */ 2836 1.1.2.2 skrll ret = sctp_add_pad_tombuf(m_last, (4-padval)); 2837 1.1.2.2 skrll if (ret) { 2838 1.1.2.2 skrll /* Houston we have a problem, no space */ 2839 1.1.2.2 skrll sctp_m_freem(m); 2840 1.1.2.2 skrll return; 2841 1.1.2.2 skrll } 2842 1.1.2.2 skrll m->m_pkthdr.len += padval; 2843 1.1.2.2 skrll } 2844 1.1.2.2 skrll #ifdef SCTP_DEBUG 2845 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT4) { 2846 1.1.2.2 skrll printf("Calling lowlevel output stcb:%p net:%p\n", 2847 1.1.2.2 skrll stcb, net); 2848 1.1.2.2 skrll } 2849 1.1.2.2 skrll #endif 2850 1.1.2.2 skrll ret = sctp_lowlevel_chunk_output(inp, stcb, net, 2851 1.1.2.2 skrll rtcache_getdst(&net->ro), m, 0, 0, NULL, 0); 2852 1.1.2.2 skrll #ifdef SCTP_DEBUG 2853 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT4) { 2854 1.1.2.2 skrll printf("Low level output returns %d\n", ret); 2855 1.1.2.2 skrll } 2856 1.1.2.2 skrll #endif 2857 1.1.2.2 skrll sctp_timer_start(SCTP_TIMER_TYPE_INIT, inp, stcb, net); 2858 1.1.2.2 skrll SCTP_GETTIME_TIMEVAL(&net->last_sent_time); 2859 1.1.2.2 skrll } 2860 1.1.2.2 skrll 2861 1.1.2.2 skrll struct mbuf * 2862 1.1.2.2 skrll sctp_arethere_unrecognized_parameters(struct mbuf *in_initpkt, 2863 1.1.2.2 skrll int param_offset, int *abort_processing, struct sctp_chunkhdr *cp) 2864 1.1.2.2 skrll { 2865 1.1.2.2 skrll /* Given a mbuf containing an INIT or INIT-ACK 2866 1.1.2.2 skrll * with the param_offset being equal to the 2867 1.1.2.2 skrll * beginning of the params i.e. (iphlen + sizeof(struct sctp_init_msg) 2868 1.1.2.2 skrll * parse through the parameters to the end of the mbuf verifying 2869 1.1.2.2 skrll * that all parameters are known. 2870 1.1.2.2 skrll * 2871 1.1.2.2 skrll * For unknown parameters build and return a mbuf with 2872 1.1.2.2 skrll * UNRECOGNIZED_PARAMETER errors. If the flags indicate 2873 1.1.2.2 skrll * to stop processing this chunk stop, and set *abort_processing 2874 1.1.2.2 skrll * to 1. 2875 1.1.2.2 skrll * 2876 1.1.2.2 skrll * By having param_offset be pre-set to where parameters begin 2877 1.1.2.2 skrll * it is hoped that this routine may be reused in the future 2878 1.1.2.2 skrll * by new features. 2879 1.1.2.2 skrll */ 2880 1.1.2.2 skrll struct sctp_paramhdr *phdr, params; 2881 1.1.2.2 skrll 2882 1.1.2.2 skrll struct mbuf *mat, *op_err; 2883 1.1.2.2 skrll char tempbuf[2048]; 2884 1.1.2.2 skrll int at, limit, pad_needed; 2885 1.1.2.2 skrll uint16_t ptype, plen; 2886 1.1.2.2 skrll int err_at; 2887 1.1.2.2 skrll 2888 1.1.2.2 skrll *abort_processing = 0; 2889 1.1.2.2 skrll mat = in_initpkt; 2890 1.1.2.2 skrll err_at = 0; 2891 1.1.2.2 skrll limit = ntohs(cp->chunk_length) - sizeof(struct sctp_init_chunk); 2892 1.1.2.2 skrll #ifdef SCTP_DEBUG 2893 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT4) { 2894 1.1.2.2 skrll printf("Limit is %d bytes\n", limit); 2895 1.1.2.2 skrll } 2896 1.1.2.2 skrll #endif 2897 1.1.2.2 skrll at = param_offset; 2898 1.1.2.2 skrll op_err = NULL; 2899 1.1.2.2 skrll 2900 1.1.2.2 skrll phdr = sctp_get_next_param(mat, at, ¶ms, sizeof(params)); 2901 1.1.2.2 skrll while ((phdr != NULL) && ((size_t)limit >= sizeof(struct sctp_paramhdr))) { 2902 1.1.2.2 skrll ptype = ntohs(phdr->param_type); 2903 1.1.2.2 skrll plen = ntohs(phdr->param_length); 2904 1.1.2.2 skrll limit -= SCTP_SIZE32(plen); 2905 1.1.2.2 skrll if (plen < sizeof(struct sctp_paramhdr)) { 2906 1.1.2.2 skrll #ifdef SCTP_DEBUG 2907 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT4) { 2908 1.1.2.2 skrll printf("sctp_output.c:Impossible length in parameter < %d\n", plen); 2909 1.1.2.2 skrll } 2910 1.1.2.2 skrll #endif 2911 1.1.2.2 skrll *abort_processing = 1; 2912 1.1.2.2 skrll break; 2913 1.1.2.2 skrll } 2914 1.1.2.2 skrll /* All parameters for all chunks that we 2915 1.1.2.2 skrll * know/understand are listed here. We process 2916 1.1.2.2 skrll * them other places and make appropriate 2917 1.1.2.2 skrll * stop actions per the upper bits. However 2918 1.1.2.2 skrll * this is the generic routine processor's can 2919 1.1.2.2 skrll * call to get back an operr.. to either incorporate (init-ack) 2920 1.1.2.2 skrll * or send. 2921 1.1.2.2 skrll */ 2922 1.1.2.2 skrll if ((ptype == SCTP_HEARTBEAT_INFO) || 2923 1.1.2.2 skrll (ptype == SCTP_IPV4_ADDRESS) || 2924 1.1.2.2 skrll (ptype == SCTP_IPV6_ADDRESS) || 2925 1.1.2.2 skrll (ptype == SCTP_STATE_COOKIE) || 2926 1.1.2.2 skrll (ptype == SCTP_UNRECOG_PARAM) || 2927 1.1.2.2 skrll (ptype == SCTP_COOKIE_PRESERVE) || 2928 1.1.2.2 skrll (ptype == SCTP_SUPPORTED_ADDRTYPE) || 2929 1.1.2.2 skrll (ptype == SCTP_PRSCTP_SUPPORTED) || 2930 1.1.2.2 skrll (ptype == SCTP_ADD_IP_ADDRESS) || 2931 1.1.2.2 skrll (ptype == SCTP_DEL_IP_ADDRESS) || 2932 1.1.2.2 skrll (ptype == SCTP_ECN_CAPABLE) || 2933 1.1.2.2 skrll (ptype == SCTP_ULP_ADAPTION) || 2934 1.1.2.2 skrll (ptype == SCTP_ERROR_CAUSE_IND) || 2935 1.1.2.2 skrll (ptype == SCTP_SET_PRIM_ADDR) || 2936 1.1.2.2 skrll (ptype == SCTP_SUCCESS_REPORT) || 2937 1.1.2.2 skrll (ptype == SCTP_ULP_ADAPTION) || 2938 1.1.2.2 skrll (ptype == SCTP_SUPPORTED_CHUNK_EXT) || 2939 1.1.2.2 skrll (ptype == SCTP_ECN_NONCE_SUPPORTED) 2940 1.1.2.2 skrll ) { 2941 1.1.2.2 skrll /* no skip it */ 2942 1.1.2.2 skrll at += SCTP_SIZE32(plen); 2943 1.1.2.2 skrll } else if (ptype == SCTP_HOSTNAME_ADDRESS) { 2944 1.1.2.2 skrll /* We can NOT handle HOST NAME addresses!! */ 2945 1.1.2.2 skrll #ifdef SCTP_DEBUG 2946 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT4) { 2947 1.1.2.2 skrll printf("Can't handle hostname addresses.. abort processing\n"); 2948 1.1.2.2 skrll } 2949 1.1.2.2 skrll #endif 2950 1.1.2.2 skrll *abort_processing = 1; 2951 1.1.2.2 skrll if (op_err == NULL) { 2952 1.1.2.2 skrll /* Ok need to try to get a mbuf */ 2953 1.1.2.2 skrll MGETHDR(op_err, M_DONTWAIT, MT_DATA); 2954 1.1.2.2 skrll if (op_err) { 2955 1.1.2.2 skrll op_err->m_len = 0; 2956 1.1.2.2 skrll op_err->m_pkthdr.len = 0; 2957 1.1.2.2 skrll /* pre-reserve space for ip and sctp header and chunk hdr*/ 2958 1.1.2.2 skrll op_err->m_data += sizeof(struct ip6_hdr); 2959 1.1.2.2 skrll op_err->m_data += sizeof(struct sctphdr); 2960 1.1.2.2 skrll op_err->m_data += sizeof(struct sctp_chunkhdr); 2961 1.1.2.2 skrll } 2962 1.1.2.2 skrll } 2963 1.1.2.2 skrll if (op_err) { 2964 1.1.2.2 skrll /* If we have space */ 2965 1.1.2.2 skrll struct sctp_paramhdr s; 2966 1.1.2.2 skrll if (err_at % 4) { 2967 1.1.2.2 skrll u_int32_t cpthis=0; 2968 1.1.2.2 skrll pad_needed = 4 - (err_at % 4); 2969 1.1.2.2 skrll m_copyback(op_err, err_at, pad_needed, (void *)&cpthis); 2970 1.1.2.2 skrll err_at += pad_needed; 2971 1.1.2.2 skrll } 2972 1.1.2.2 skrll s.param_type = htons(SCTP_CAUSE_UNRESOLV_ADDR); 2973 1.1.2.2 skrll s.param_length = htons(sizeof(s) + plen); 2974 1.1.2.2 skrll m_copyback(op_err, err_at, sizeof(s), (void *)&s); 2975 1.1.2.2 skrll err_at += sizeof(s); 2976 1.1.2.2 skrll phdr = sctp_get_next_param(mat, at, (struct sctp_paramhdr *)tempbuf, plen); 2977 1.1.2.2 skrll if (phdr == NULL) { 2978 1.1.2.2 skrll sctp_m_freem(op_err); 2979 1.1.2.2 skrll /* we are out of memory but we 2980 1.1.2.2 skrll * still need to have a look at what to 2981 1.1.2.2 skrll * do (the system is in trouble though). 2982 1.1.2.2 skrll */ 2983 1.1.2.2 skrll return (NULL); 2984 1.1.2.2 skrll } 2985 1.1.2.2 skrll m_copyback(op_err, err_at, plen, (void *)phdr); 2986 1.1.2.2 skrll err_at += plen; 2987 1.1.2.2 skrll } 2988 1.1.2.2 skrll return (op_err); 2989 1.1.2.2 skrll } else { 2990 1.1.2.2 skrll /* we do not recognize the parameter 2991 1.1.2.2 skrll * figure out what we do. 2992 1.1.2.2 skrll */ 2993 1.1.2.2 skrll #ifdef SCTP_DEBUG 2994 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT4) { 2995 1.1.2.2 skrll printf("Got parameter type %x - unknown\n", 2996 1.1.2.2 skrll (u_int)ptype); 2997 1.1.2.2 skrll } 2998 1.1.2.2 skrll #endif 2999 1.1.2.2 skrll if ((ptype & 0x4000) == 0x4000) { 3000 1.1.2.2 skrll /* Report bit is set?? */ 3001 1.1.2.2 skrll #ifdef SCTP_DEBUG 3002 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT4) { 3003 1.1.2.2 skrll printf("Report bit is set\n"); 3004 1.1.2.2 skrll } 3005 1.1.2.2 skrll #endif 3006 1.1.2.2 skrll if (op_err == NULL) { 3007 1.1.2.2 skrll /* Ok need to try to get an mbuf */ 3008 1.1.2.2 skrll MGETHDR(op_err, M_DONTWAIT, MT_DATA); 3009 1.1.2.2 skrll if (op_err) { 3010 1.1.2.2 skrll op_err->m_len = 0; 3011 1.1.2.2 skrll op_err->m_pkthdr.len = 0; 3012 1.1.2.2 skrll op_err->m_data += sizeof(struct ip6_hdr); 3013 1.1.2.2 skrll op_err->m_data += sizeof(struct sctphdr); 3014 1.1.2.2 skrll op_err->m_data += sizeof(struct sctp_chunkhdr); 3015 1.1.2.2 skrll } 3016 1.1.2.2 skrll } 3017 1.1.2.2 skrll if (op_err) { 3018 1.1.2.2 skrll /* If we have space */ 3019 1.1.2.2 skrll struct sctp_paramhdr s; 3020 1.1.2.2 skrll if (err_at % 4) { 3021 1.1.2.2 skrll u_int32_t cpthis=0; 3022 1.1.2.2 skrll pad_needed = 4 - (err_at % 4); 3023 1.1.2.2 skrll m_copyback(op_err, err_at, pad_needed, (void *)&cpthis); 3024 1.1.2.2 skrll err_at += pad_needed; 3025 1.1.2.2 skrll } 3026 1.1.2.2 skrll s.param_type = htons(SCTP_UNRECOG_PARAM); 3027 1.1.2.2 skrll s.param_length = htons(sizeof(s) + plen); 3028 1.1.2.2 skrll m_copyback(op_err, err_at, sizeof(s), (void *)&s); 3029 1.1.2.2 skrll err_at += sizeof(s); 3030 1.1.2.2 skrll if (plen > sizeof(tempbuf)) { 3031 1.1.2.2 skrll plen = sizeof(tempbuf); 3032 1.1.2.2 skrll } 3033 1.1.2.2 skrll phdr = sctp_get_next_param(mat, at, (struct sctp_paramhdr *)tempbuf, plen); 3034 1.1.2.2 skrll if (phdr == NULL) { 3035 1.1.2.2 skrll sctp_m_freem(op_err); 3036 1.1.2.2 skrll /* we are out of memory but we 3037 1.1.2.2 skrll * still need to have a look at what to 3038 1.1.2.2 skrll * do (the system is in trouble though). 3039 1.1.2.2 skrll */ 3040 1.1.2.2 skrll goto more_processing; 3041 1.1.2.2 skrll } 3042 1.1.2.2 skrll m_copyback(op_err, err_at, plen, (void *)phdr); 3043 1.1.2.2 skrll err_at += plen; 3044 1.1.2.2 skrll } 3045 1.1.2.2 skrll } 3046 1.1.2.2 skrll more_processing: 3047 1.1.2.2 skrll if ((ptype & 0x8000) == 0x0000) { 3048 1.1.2.2 skrll #ifdef SCTP_DEBUG 3049 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT4) { 3050 1.1.2.2 skrll printf("Abort bit is now setting1\n"); 3051 1.1.2.2 skrll } 3052 1.1.2.2 skrll #endif 3053 1.1.2.2 skrll return (op_err); 3054 1.1.2.2 skrll } else { 3055 1.1.2.2 skrll /* skip this chunk and continue processing */ 3056 1.1.2.2 skrll at += SCTP_SIZE32(plen); 3057 1.1.2.2 skrll } 3058 1.1.2.2 skrll 3059 1.1.2.2 skrll } 3060 1.1.2.2 skrll phdr = sctp_get_next_param(mat, at, ¶ms, sizeof(params)); 3061 1.1.2.2 skrll } 3062 1.1.2.2 skrll return (op_err); 3063 1.1.2.2 skrll } 3064 1.1.2.2 skrll 3065 1.1.2.2 skrll static int 3066 1.1.2.2 skrll sctp_are_there_new_addresses(struct sctp_association *asoc, 3067 1.1.2.2 skrll struct mbuf *in_initpkt, int iphlen, int offset) 3068 1.1.2.2 skrll { 3069 1.1.2.2 skrll /* 3070 1.1.2.2 skrll * Given a INIT packet, look through the packet to verify that 3071 1.1.2.2 skrll * there are NO new addresses. As we go through the parameters 3072 1.1.2.2 skrll * add reports of any un-understood parameters that require an 3073 1.1.2.2 skrll * error. Also we must return (1) to drop the packet if we see 3074 1.1.2.2 skrll * a un-understood parameter that tells us to drop the chunk. 3075 1.1.2.2 skrll */ 3076 1.1.2.2 skrll struct sockaddr_in sin4, *sa4; 3077 1.1.2.2 skrll struct sockaddr_in6 sin6, *sa6; 3078 1.1.2.2 skrll struct sockaddr *sa_touse; 3079 1.1.2.2 skrll struct sockaddr *sa; 3080 1.1.2.2 skrll struct sctp_paramhdr *phdr, params; 3081 1.1.2.2 skrll struct ip *iph; 3082 1.1.2.2 skrll struct mbuf *mat; 3083 1.1.2.2 skrll uint16_t ptype, plen; 3084 1.1.2.2 skrll uint8_t fnd; 3085 1.1.2.2 skrll struct sctp_nets *net; 3086 1.1.2.2 skrll 3087 1.1.2.2 skrll memset(&sin4, 0, sizeof(sin4)); 3088 1.1.2.2 skrll memset(&sin6, 0, sizeof(sin6)); 3089 1.1.2.2 skrll sin4.sin_family = AF_INET; 3090 1.1.2.2 skrll sin4.sin_len = sizeof(sin4); 3091 1.1.2.2 skrll sin6.sin6_family = AF_INET6; 3092 1.1.2.2 skrll sin6.sin6_len = sizeof(sin6); 3093 1.1.2.2 skrll 3094 1.1.2.2 skrll sa_touse = NULL; 3095 1.1.2.2 skrll /* First what about the src address of the pkt ? */ 3096 1.1.2.2 skrll iph = mtod(in_initpkt, struct ip *); 3097 1.1.2.2 skrll if (iph->ip_v == IPVERSION) { 3098 1.1.2.2 skrll /* source addr is IPv4 */ 3099 1.1.2.2 skrll sin4.sin_addr = iph->ip_src; 3100 1.1.2.2 skrll sa_touse = (struct sockaddr *)&sin4; 3101 1.1.2.2 skrll } else if (iph->ip_v == (IPV6_VERSION >> 4)) { 3102 1.1.2.2 skrll /* source addr is IPv6 */ 3103 1.1.2.2 skrll struct ip6_hdr *ip6h; 3104 1.1.2.2 skrll ip6h = mtod(in_initpkt, struct ip6_hdr *); 3105 1.1.2.2 skrll sin6.sin6_addr = ip6h->ip6_src; 3106 1.1.2.2 skrll sa_touse = (struct sockaddr *)&sin6; 3107 1.1.2.2 skrll } else { 3108 1.1.2.2 skrll return (1); 3109 1.1.2.2 skrll } 3110 1.1.2.2 skrll 3111 1.1.2.2 skrll fnd = 0; 3112 1.1.2.2 skrll TAILQ_FOREACH(net, &asoc->nets, sctp_next) { 3113 1.1.2.2 skrll sa = (struct sockaddr *)&net->ro.ro_sa; 3114 1.1.2.2 skrll if (sa->sa_family == sa_touse->sa_family) { 3115 1.1.2.2 skrll if (sa->sa_family == AF_INET) { 3116 1.1.2.2 skrll sa4 = (struct sockaddr_in *)sa; 3117 1.1.2.2 skrll if (sa4->sin_addr.s_addr == 3118 1.1.2.2 skrll sin4.sin_addr.s_addr) { 3119 1.1.2.2 skrll fnd = 1; 3120 1.1.2.2 skrll break; 3121 1.1.2.2 skrll } 3122 1.1.2.2 skrll } else if (sa->sa_family == AF_INET6) { 3123 1.1.2.2 skrll sa6 = (struct sockaddr_in6 *)sa; 3124 1.1.2.2 skrll if (SCTP6_ARE_ADDR_EQUAL(&sa6->sin6_addr, 3125 1.1.2.2 skrll &sin6.sin6_addr)) { 3126 1.1.2.2 skrll fnd = 1; 3127 1.1.2.2 skrll break; 3128 1.1.2.2 skrll } 3129 1.1.2.2 skrll } 3130 1.1.2.2 skrll } 3131 1.1.2.2 skrll } 3132 1.1.2.2 skrll if (fnd == 0) { 3133 1.1.2.2 skrll /* New address added! no need to look futher. */ 3134 1.1.2.2 skrll return (1); 3135 1.1.2.2 skrll } 3136 1.1.2.2 skrll /* Ok so far lets munge through the rest of the packet */ 3137 1.1.2.2 skrll mat = in_initpkt; 3138 1.1.2.2 skrll sa_touse = NULL; 3139 1.1.2.2 skrll offset += sizeof(struct sctp_init_chunk); 3140 1.1.2.2 skrll phdr = sctp_get_next_param(mat, offset, ¶ms, sizeof(params)); 3141 1.1.2.2 skrll while (phdr) { 3142 1.1.2.2 skrll ptype = ntohs(phdr->param_type); 3143 1.1.2.2 skrll plen = ntohs(phdr->param_length); 3144 1.1.2.2 skrll if (ptype == SCTP_IPV4_ADDRESS) { 3145 1.1.2.2 skrll struct sctp_ipv4addr_param *p4, p4_buf; 3146 1.1.2.2 skrll 3147 1.1.2.2 skrll phdr = sctp_get_next_param(mat, offset, 3148 1.1.2.2 skrll (struct sctp_paramhdr *)&p4_buf, sizeof(p4_buf)); 3149 1.1.2.2 skrll if (plen != sizeof(struct sctp_ipv4addr_param) || 3150 1.1.2.2 skrll phdr == NULL) { 3151 1.1.2.2 skrll return (1); 3152 1.1.2.2 skrll } 3153 1.1.2.2 skrll p4 = (struct sctp_ipv4addr_param *)phdr; 3154 1.1.2.2 skrll sin4.sin_addr.s_addr = p4->addr; 3155 1.1.2.2 skrll sa_touse = (struct sockaddr *)&sin4; 3156 1.1.2.2 skrll } else if (ptype == SCTP_IPV6_ADDRESS) { 3157 1.1.2.2 skrll struct sctp_ipv6addr_param *p6, p6_buf; 3158 1.1.2.2 skrll 3159 1.1.2.2 skrll phdr = sctp_get_next_param(mat, offset, 3160 1.1.2.2 skrll (struct sctp_paramhdr *)&p6_buf, sizeof(p6_buf)); 3161 1.1.2.2 skrll if (plen != sizeof(struct sctp_ipv6addr_param) || 3162 1.1.2.2 skrll phdr == NULL) { 3163 1.1.2.2 skrll return (1); 3164 1.1.2.2 skrll } 3165 1.1.2.2 skrll p6 = (struct sctp_ipv6addr_param *)phdr; 3166 1.1.2.2 skrll memcpy((void *)&sin6.sin6_addr, p6->addr, 3167 1.1.2.2 skrll sizeof(p6->addr)); 3168 1.1.2.2 skrll sa_touse = (struct sockaddr *)&sin4; 3169 1.1.2.2 skrll } 3170 1.1.2.2 skrll 3171 1.1.2.2 skrll if (sa_touse) { 3172 1.1.2.2 skrll /* ok, sa_touse points to one to check */ 3173 1.1.2.2 skrll fnd = 0; 3174 1.1.2.2 skrll TAILQ_FOREACH(net, &asoc->nets, sctp_next) { 3175 1.1.2.2 skrll sa = (struct sockaddr *)&net->ro.ro_sa; 3176 1.1.2.2 skrll if (sa->sa_family != sa_touse->sa_family) { 3177 1.1.2.2 skrll continue; 3178 1.1.2.2 skrll } 3179 1.1.2.2 skrll if (sa->sa_family == AF_INET) { 3180 1.1.2.2 skrll sa4 = (struct sockaddr_in *)sa; 3181 1.1.2.2 skrll if (sa4->sin_addr.s_addr == 3182 1.1.2.2 skrll sin4.sin_addr.s_addr) { 3183 1.1.2.2 skrll fnd = 1; 3184 1.1.2.2 skrll break; 3185 1.1.2.2 skrll } 3186 1.1.2.2 skrll } else if (sa->sa_family == AF_INET6) { 3187 1.1.2.2 skrll sa6 = (struct sockaddr_in6 *)sa; 3188 1.1.2.2 skrll if (SCTP6_ARE_ADDR_EQUAL( 3189 1.1.2.2 skrll &sa6->sin6_addr, &sin6.sin6_addr)) { 3190 1.1.2.2 skrll fnd = 1; 3191 1.1.2.2 skrll break; 3192 1.1.2.2 skrll } 3193 1.1.2.2 skrll } 3194 1.1.2.2 skrll } 3195 1.1.2.2 skrll if (!fnd) { 3196 1.1.2.2 skrll /* New addr added! no need to look further */ 3197 1.1.2.2 skrll return (1); 3198 1.1.2.2 skrll } 3199 1.1.2.2 skrll } 3200 1.1.2.2 skrll offset += SCTP_SIZE32(plen); 3201 1.1.2.2 skrll phdr = sctp_get_next_param(mat, offset, ¶ms, sizeof(params)); 3202 1.1.2.2 skrll } 3203 1.1.2.2 skrll return (0); 3204 1.1.2.2 skrll } 3205 1.1.2.2 skrll 3206 1.1.2.2 skrll /* 3207 1.1.2.2 skrll * Given a MBUF chain that was sent into us containing an 3208 1.1.2.2 skrll * INIT. Build a INIT-ACK with COOKIE and send back. 3209 1.1.2.2 skrll * We assume that the in_initpkt has done a pullup to 3210 1.1.2.2 skrll * include IPv6/4header, SCTP header and initial part of 3211 1.1.2.2 skrll * INIT message (i.e. the struct sctp_init_msg). 3212 1.1.2.2 skrll */ 3213 1.1.2.2 skrll void 3214 1.1.2.2 skrll sctp_send_initiate_ack(struct sctp_inpcb *inp, struct sctp_tcb *stcb, 3215 1.1.2.2 skrll struct mbuf *init_pkt, int iphlen, int offset, struct sctphdr *sh, 3216 1.1.2.2 skrll struct sctp_init_chunk *init_chk) 3217 1.1.2.2 skrll { 3218 1.1.2.2 skrll struct sctp_association *asoc; 3219 1.1.2.2 skrll struct mbuf *m, *m_at, *m_tmp, *m_cookie, *op_err, *m_last; 3220 1.1.2.2 skrll struct sctp_init_msg *initackm_out; 3221 1.1.2.2 skrll struct sctp_ecn_supported_param *ecn; 3222 1.1.2.2 skrll struct sctp_prsctp_supported_param *prsctp; 3223 1.1.2.2 skrll struct sctp_ecn_nonce_supported_param *ecn_nonce; 3224 1.1.2.2 skrll struct sctp_supported_chunk_types_param *pr_supported; 3225 1.1.2.2 skrll struct sockaddr_storage store; 3226 1.1.2.2 skrll struct sockaddr_in *sin; 3227 1.1.2.2 skrll struct sockaddr_in6 *sin6; 3228 1.1.2.2 skrll struct route *ro; 3229 1.1.2.2 skrll struct ip *iph; 3230 1.1.2.2 skrll struct ip6_hdr *ip6; 3231 1.1.2.2 skrll const struct sockaddr *to; 3232 1.1.2.2 skrll struct sctp_state_cookie stc; 3233 1.1.2.2 skrll struct sctp_nets *net=NULL; 3234 1.1.2.2 skrll int cnt_inits_to=0; 3235 1.1.2.2 skrll uint16_t his_limit, i_want; 3236 1.1.2.2 skrll int abort_flag, padval, sz_of; 3237 1.1.2.2 skrll 3238 1.1.2.2 skrll if (stcb) { 3239 1.1.2.2 skrll asoc = &stcb->asoc; 3240 1.1.2.2 skrll } else { 3241 1.1.2.2 skrll asoc = NULL; 3242 1.1.2.2 skrll } 3243 1.1.2.2 skrll m_last = NULL; 3244 1.1.2.2 skrll if ((asoc != NULL) && 3245 1.1.2.2 skrll (SCTP_GET_STATE(asoc) != SCTP_STATE_COOKIE_WAIT) && 3246 1.1.2.2 skrll (sctp_are_there_new_addresses(asoc, init_pkt, iphlen, offset))) { 3247 1.1.2.2 skrll /* new addresses, out of here in non-cookie-wait states */ 3248 1.1.2.2 skrll /* 3249 1.1.2.2 skrll * Send a ABORT, we don't add the new address error clause though 3250 1.1.2.2 skrll * we even set the T bit and copy in the 0 tag.. this looks no 3251 1.1.2.2 skrll * different than if no listner was present. 3252 1.1.2.2 skrll */ 3253 1.1.2.2 skrll sctp_send_abort(init_pkt, iphlen, sh, 0, NULL); 3254 1.1.2.2 skrll return; 3255 1.1.2.2 skrll } 3256 1.1.2.2 skrll abort_flag = 0; 3257 1.1.2.2 skrll op_err = sctp_arethere_unrecognized_parameters(init_pkt, 3258 1.1.2.2 skrll (offset+sizeof(struct sctp_init_chunk)), 3259 1.1.2.2 skrll &abort_flag, (struct sctp_chunkhdr *)init_chk); 3260 1.1.2.2 skrll if (abort_flag) { 3261 1.1.2.2 skrll sctp_send_abort(init_pkt, iphlen, sh, init_chk->init.initiate_tag, op_err); 3262 1.1.2.2 skrll return; 3263 1.1.2.2 skrll } 3264 1.1.2.2 skrll MGETHDR(m, M_DONTWAIT, MT_HEADER); 3265 1.1.2.2 skrll if (m == NULL) { 3266 1.1.2.2 skrll /* No memory, INIT timer will re-attempt. */ 3267 1.1.2.2 skrll if (op_err) 3268 1.1.2.2 skrll sctp_m_freem(op_err); 3269 1.1.2.2 skrll return; 3270 1.1.2.2 skrll } 3271 1.1.2.2 skrll MCLGET(m, M_DONTWAIT); 3272 1.1.2.2 skrll if ((m->m_flags & M_EXT) != M_EXT) { 3273 1.1.2.2 skrll /* Failed to get cluster buffer */ 3274 1.1.2.2 skrll if (op_err) 3275 1.1.2.2 skrll sctp_m_freem(op_err); 3276 1.1.2.2 skrll sctp_m_freem(m); 3277 1.1.2.2 skrll return; 3278 1.1.2.2 skrll } 3279 1.1.2.2 skrll m->m_data += SCTP_MIN_OVERHEAD; 3280 1.1.2.2 skrll m->m_pkthdr.rcvif = 0; 3281 1.1.2.2 skrll m->m_len = sizeof(struct sctp_init_msg); 3282 1.1.2.2 skrll 3283 1.1.2.2 skrll /* the time I built cookie */ 3284 1.1.2.2 skrll SCTP_GETTIME_TIMEVAL(&stc.time_entered); 3285 1.1.2.2 skrll 3286 1.1.2.2 skrll /* populate any tie tags */ 3287 1.1.2.2 skrll if (asoc != NULL) { 3288 1.1.2.2 skrll /* unlock before tag selections */ 3289 1.1.2.2 skrll SCTP_TCB_UNLOCK(stcb); 3290 1.1.2.2 skrll if (asoc->my_vtag_nonce == 0) 3291 1.1.2.2 skrll asoc->my_vtag_nonce = sctp_select_a_tag(inp); 3292 1.1.2.2 skrll stc.tie_tag_my_vtag = asoc->my_vtag_nonce; 3293 1.1.2.2 skrll 3294 1.1.2.2 skrll if (asoc->peer_vtag_nonce == 0) 3295 1.1.2.2 skrll asoc->peer_vtag_nonce = sctp_select_a_tag(inp); 3296 1.1.2.2 skrll stc.tie_tag_peer_vtag = asoc->peer_vtag_nonce; 3297 1.1.2.2 skrll 3298 1.1.2.2 skrll stc.cookie_life = asoc->cookie_life; 3299 1.1.2.2 skrll net = asoc->primary_destination; 3300 1.1.2.2 skrll /* now we must relock */ 3301 1.1.2.2 skrll SCTP_INP_RLOCK(inp); 3302 1.1.2.2 skrll /* we may be in trouble here if the inp got freed 3303 1.1.2.2 skrll * most likely this set of tests will protect 3304 1.1.2.2 skrll * us but there is a chance not. 3305 1.1.2.2 skrll */ 3306 1.1.2.2 skrll if (inp->sctp_flags & (SCTP_PCB_FLAGS_SOCKET_GONE|SCTP_PCB_FLAGS_SOCKET_ALLGONE)) { 3307 1.1.2.2 skrll if (op_err) 3308 1.1.2.2 skrll sctp_m_freem(op_err); 3309 1.1.2.2 skrll sctp_m_freem(m); 3310 1.1.2.2 skrll sctp_send_abort(init_pkt, iphlen, sh, 0, NULL); 3311 1.1.2.2 skrll return; 3312 1.1.2.2 skrll } 3313 1.1.2.2 skrll SCTP_TCB_LOCK(stcb); 3314 1.1.2.2 skrll SCTP_INP_RUNLOCK(stcb->sctp_ep); 3315 1.1.2.2 skrll } else { 3316 1.1.2.2 skrll stc.tie_tag_my_vtag = 0; 3317 1.1.2.2 skrll stc.tie_tag_peer_vtag = 0; 3318 1.1.2.2 skrll /* life I will award this cookie */ 3319 1.1.2.2 skrll stc.cookie_life = inp->sctp_ep.def_cookie_life; 3320 1.1.2.2 skrll } 3321 1.1.2.2 skrll 3322 1.1.2.2 skrll /* copy in the ports for later check */ 3323 1.1.2.2 skrll stc.myport = sh->dest_port; 3324 1.1.2.2 skrll stc.peerport = sh->src_port; 3325 1.1.2.2 skrll 3326 1.1.2.2 skrll /* 3327 1.1.2.2 skrll * If we wanted to honor cookie life extentions, we would add 3328 1.1.2.2 skrll * to stc.cookie_life. For now we should NOT honor any extension 3329 1.1.2.2 skrll */ 3330 1.1.2.2 skrll stc.site_scope = stc.local_scope = stc.loopback_scope = 0; 3331 1.1.2.2 skrll if (inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) { 3332 1.1.2.2 skrll struct inpcb *in_inp; 3333 1.1.2.2 skrll /* Its a V6 socket */ 3334 1.1.2.2 skrll in_inp = (struct inpcb *)inp; 3335 1.1.2.2 skrll stc.ipv6_addr_legal = 1; 3336 1.1.2.2 skrll /* Now look at the binding flag to see if V4 will be legal */ 3337 1.1.2.2 skrll if ( 3338 1.1.2.2 skrll #if defined(__FreeBSD__) || defined(__APPLE__) 3339 1.1.2.2 skrll (in_inp->inp_flags & IN6P_IPV6_V6ONLY) 3340 1.1.2.2 skrll #elif defined(__OpenBSD__) 3341 1.1.2.2 skrll (0) /* For openbsd we do dual bind only */ 3342 1.1.2.2 skrll #else 3343 1.1.2.2 skrll (((struct in6pcb *)in_inp)->in6p_flags & IN6P_IPV6_V6ONLY) 3344 1.1.2.2 skrll #endif 3345 1.1.2.2 skrll == 0) { 3346 1.1.2.2 skrll stc.ipv4_addr_legal = 1; 3347 1.1.2.2 skrll } else { 3348 1.1.2.2 skrll /* V4 addresses are NOT legal on the association */ 3349 1.1.2.2 skrll stc.ipv4_addr_legal = 0; 3350 1.1.2.2 skrll } 3351 1.1.2.2 skrll } else { 3352 1.1.2.2 skrll /* Its a V4 socket, no - V6 */ 3353 1.1.2.2 skrll stc.ipv4_addr_legal = 1; 3354 1.1.2.2 skrll stc.ipv6_addr_legal = 0; 3355 1.1.2.2 skrll } 3356 1.1.2.2 skrll 3357 1.1.2.2 skrll #ifdef SCTP_DONT_DO_PRIVADDR_SCOPE 3358 1.1.2.2 skrll stc.ipv4_scope = 1; 3359 1.1.2.2 skrll #else 3360 1.1.2.2 skrll stc.ipv4_scope = 0; 3361 1.1.2.2 skrll #endif 3362 1.1.2.2 skrll /* now for scope setup */ 3363 1.1.2.2 skrll memset((void *)&store, 0, sizeof(store)); 3364 1.1.2.2 skrll sin = (struct sockaddr_in *)&store; 3365 1.1.2.2 skrll sin6 = (struct sockaddr_in6 *)&store; 3366 1.1.2.2 skrll if (net == NULL) { 3367 1.1.2.2 skrll to = (struct sockaddr *)&store; 3368 1.1.2.2 skrll iph = mtod(init_pkt, struct ip *); 3369 1.1.2.2 skrll if (iph->ip_v == IPVERSION) { 3370 1.1.2.2 skrll struct in_addr addr; 3371 1.1.2.2 skrll static struct route iproute; 3372 1.1.2.2 skrll 3373 1.1.2.2 skrll sin->sin_family = AF_INET; 3374 1.1.2.2 skrll sin->sin_len = sizeof(struct sockaddr_in); 3375 1.1.2.2 skrll sin->sin_port = sh->src_port; 3376 1.1.2.2 skrll sin->sin_addr = iph->ip_src; 3377 1.1.2.2 skrll /* lookup address */ 3378 1.1.2.2 skrll stc.address[0] = sin->sin_addr.s_addr; 3379 1.1.2.2 skrll stc.address[1] = 0; 3380 1.1.2.2 skrll stc.address[2] = 0; 3381 1.1.2.2 skrll stc.address[3] = 0; 3382 1.1.2.2 skrll stc.addr_type = SCTP_IPV4_ADDRESS; 3383 1.1.2.2 skrll /* local from address */ 3384 1.1.2.2 skrll memset(&iproute, 0, sizeof(iproute)); 3385 1.1.2.2 skrll ro = &iproute; 3386 1.1.2.2 skrll 3387 1.1.2.2 skrll rtcache_lookup(ro, (struct sockaddr *) sin); 3388 1.1.2.2 skrll addr = sctp_ipv4_source_address_selection(inp, NULL, 3389 1.1.2.2 skrll ro, NULL, 0); 3390 1.1.2.2 skrll stc.laddress[0] = addr.s_addr; 3391 1.1.2.2 skrll stc.laddress[1] = 0; 3392 1.1.2.2 skrll stc.laddress[2] = 0; 3393 1.1.2.2 skrll stc.laddress[3] = 0; 3394 1.1.2.2 skrll stc.laddr_type = SCTP_IPV4_ADDRESS; 3395 1.1.2.2 skrll /* scope_id is only for v6 */ 3396 1.1.2.2 skrll stc.scope_id = 0; 3397 1.1.2.2 skrll #ifndef SCTP_DONT_DO_PRIVADDR_SCOPE 3398 1.1.2.2 skrll if (IN4_ISPRIVATE_ADDRESS(&sin->sin_addr)) { 3399 1.1.2.2 skrll stc.ipv4_scope = 1; 3400 1.1.2.2 skrll } 3401 1.1.2.2 skrll #else 3402 1.1.2.2 skrll stc.ipv4_scope = 1; 3403 1.1.2.2 skrll #endif /* SCTP_DONT_DO_PRIVADDR_SCOPE */ 3404 1.1.2.2 skrll /* Must use the address in this case */ 3405 1.1.2.2 skrll if (sctp_is_address_on_local_host((struct sockaddr *)sin)) { 3406 1.1.2.2 skrll stc.loopback_scope = 1; 3407 1.1.2.2 skrll stc.ipv4_scope = 1; 3408 1.1.2.2 skrll stc.site_scope = 1; 3409 1.1.2.2 skrll stc.local_scope = 1; 3410 1.1.2.2 skrll } 3411 1.1.2.2 skrll } else if (iph->ip_v == (IPV6_VERSION >> 4)) { 3412 1.1.2.2 skrll struct in6_addr addr; 3413 1.1.2.2 skrll static struct route iproute6; 3414 1.1.2.2 skrll ip6 = mtod(init_pkt, struct ip6_hdr *); 3415 1.1.2.2 skrll sin6->sin6_family = AF_INET6; 3416 1.1.2.2 skrll sin6->sin6_len = sizeof(struct sockaddr_in6); 3417 1.1.2.2 skrll sin6->sin6_port = sh->src_port; 3418 1.1.2.2 skrll sin6->sin6_addr = ip6->ip6_src; 3419 1.1.2.2 skrll /* lookup address */ 3420 1.1.2.2 skrll memcpy(&stc.address, &sin6->sin6_addr, 3421 1.1.2.2 skrll sizeof(struct in6_addr)); 3422 1.1.2.2 skrll sin6->sin6_scope_id = 0; 3423 1.1.2.2 skrll stc.addr_type = SCTP_IPV6_ADDRESS; 3424 1.1.2.2 skrll stc.scope_id = 0; 3425 1.1.2.2 skrll if (sctp_is_address_on_local_host((struct sockaddr *)sin6)) { 3426 1.1.2.2 skrll stc.loopback_scope = 1; 3427 1.1.2.2 skrll stc.local_scope = 1; 3428 1.1.2.2 skrll stc.site_scope = 1; 3429 1.1.2.2 skrll stc.ipv4_scope = 1; 3430 1.1.2.2 skrll } else if (IN6_IS_ADDR_LINKLOCAL(&sin6->sin6_addr)) { 3431 1.1.2.2 skrll /* 3432 1.1.2.2 skrll * If the new destination is a LINK_LOCAL 3433 1.1.2.2 skrll * we must have common both site and local 3434 1.1.2.2 skrll * scope. Don't set local scope though since 3435 1.1.2.2 skrll * we must depend on the source to be added 3436 1.1.2.2 skrll * implicitly. We cannot assure just because 3437 1.1.2.2 skrll * we share one link that all links are common. 3438 1.1.2.2 skrll * 3439 1.1.2.2 skrll * XXX: never treat link-local case explicitly. 3440 1.1.2.2 skrll * Use general routines defined in scope6.c. 3441 1.1.2.2 skrll * (jinmei@kame) 3442 1.1.2.2 skrll */ 3443 1.1.2.2 skrll stc.local_scope = 0; 3444 1.1.2.2 skrll stc.site_scope = 1; 3445 1.1.2.2 skrll stc.ipv4_scope = 1; 3446 1.1.2.2 skrll /* we start counting for the private 3447 1.1.2.2 skrll * address stuff at 1. since the link 3448 1.1.2.2 skrll * local we source from won't show 3449 1.1.2.2 skrll * up in our scoped count. 3450 1.1.2.2 skrll */ 3451 1.1.2.2 skrll cnt_inits_to=1; 3452 1.1.2.2 skrll /* pull out the scope_id from incoming pkt */ 3453 1.1.2.2 skrll #if defined(SCTP_BASE_FREEBSD) || defined(__APPLE__) 3454 1.1.2.2 skrll (void)in6_recoverscope(sin6, &in6_src, 3455 1.1.2.2 skrll init_pkt->m_pkthdr.rcvif); 3456 1.1.2.2 skrll in6_embedscope(&sin6->sin6_addr, sin6, NULL, 3457 1.1.2.2 skrll NULL); 3458 1.1.2.2 skrll #else 3459 1.1.2.2 skrll (void)sa6_recoverscope(sin6); 3460 1.1.2.2 skrll #endif 3461 1.1.2.2 skrll stc.scope_id = sin6->sin6_scope_id; 3462 1.1.2.2 skrll 3463 1.1.2.2 skrll } else if (IN6_IS_ADDR_SITELOCAL(&sin6->sin6_addr)) { 3464 1.1.2.2 skrll /* 3465 1.1.2.2 skrll * If the new destination is SITE_LOCAL 3466 1.1.2.2 skrll * then we must have site scope in common. 3467 1.1.2.2 skrll */ 3468 1.1.2.2 skrll stc.site_scope = 1; 3469 1.1.2.2 skrll } 3470 1.1.2.2 skrll /* local from address */ 3471 1.1.2.2 skrll memset(&iproute6, 0, sizeof(iproute6)); 3472 1.1.2.2 skrll ro = (struct route *)&iproute6; 3473 1.1.2.2 skrll rtcache_lookup(ro, (struct sockaddr *) sin6); 3474 1.1.2.2 skrll addr = sctp_ipv6_source_address_selection(inp, NULL, 3475 1.1.2.2 skrll ro, NULL, 0); 3476 1.1.2.2 skrll memcpy(&stc.laddress, &addr, sizeof(struct in6_addr)); 3477 1.1.2.2 skrll stc.laddr_type = SCTP_IPV6_ADDRESS; 3478 1.1.2.2 skrll } 3479 1.1.2.2 skrll } else { 3480 1.1.2.2 skrll /* set the scope per the existing tcb */ 3481 1.1.2.2 skrll struct sctp_nets *lnet; 3482 1.1.2.2 skrll 3483 1.1.2.2 skrll stc.loopback_scope = asoc->loopback_scope; 3484 1.1.2.2 skrll stc.ipv4_scope = asoc->ipv4_local_scope; 3485 1.1.2.2 skrll stc.site_scope = asoc->site_scope; 3486 1.1.2.2 skrll stc.local_scope = asoc->local_scope; 3487 1.1.2.2 skrll TAILQ_FOREACH(lnet, &asoc->nets, sctp_next) { 3488 1.1.2.2 skrll if (rtcache_getdst(&lnet->ro)->sa_family == AF_INET6) { 3489 1.1.2.2 skrll if (IN6_IS_ADDR_LINKLOCAL((const struct in6_addr *) rtcache_getdst(&lnet->ro)->sa_data)) { 3490 1.1.2.2 skrll /* if we have a LL address, start counting 3491 1.1.2.2 skrll * at 1. 3492 1.1.2.2 skrll */ 3493 1.1.2.2 skrll cnt_inits_to = 1; 3494 1.1.2.2 skrll } 3495 1.1.2.2 skrll } 3496 1.1.2.2 skrll } 3497 1.1.2.2 skrll 3498 1.1.2.2 skrll /* use the net pointer */ 3499 1.1.2.2 skrll to = rtcache_getdst(&net->ro); 3500 1.1.2.2 skrll if (to->sa_family == AF_INET) { 3501 1.1.2.2 skrll memcpy(&stc.address[0], to, sizeof(struct in_addr)); 3502 1.1.2.2 skrll stc.address[1] = 0; 3503 1.1.2.2 skrll stc.address[2] = 0; 3504 1.1.2.2 skrll stc.address[3] = 0; 3505 1.1.2.2 skrll stc.addr_type = SCTP_IPV4_ADDRESS; 3506 1.1.2.2 skrll if (net->src_addr_selected == 0) { 3507 1.1.2.2 skrll /* strange case here, the INIT 3508 1.1.2.2 skrll * should have did the selection. 3509 1.1.2.2 skrll */ 3510 1.1.2.2 skrll net->_s_addr.sin.sin_addr = 3511 1.1.2.2 skrll sctp_ipv4_source_address_selection(inp, 3512 1.1.2.2 skrll stcb, &net->ro, net, 0); 3513 1.1.2.2 skrll net->src_addr_selected = 1; 3514 1.1.2.2 skrll 3515 1.1.2.2 skrll } 3516 1.1.2.2 skrll 3517 1.1.2.2 skrll stc.laddress[0] = net->_s_addr.sin.sin_addr.s_addr; 3518 1.1.2.2 skrll stc.laddress[1] = 0; 3519 1.1.2.2 skrll stc.laddress[2] = 0; 3520 1.1.2.2 skrll stc.laddress[3] = 0; 3521 1.1.2.2 skrll stc.laddr_type = SCTP_IPV4_ADDRESS; 3522 1.1.2.2 skrll } else if (to->sa_family == AF_INET6) { 3523 1.1.2.2 skrll memcpy(&stc.address, &to->sa_data, 3524 1.1.2.2 skrll sizeof(struct in6_addr)); 3525 1.1.2.2 skrll stc.addr_type = SCTP_IPV6_ADDRESS; 3526 1.1.2.2 skrll if (net->src_addr_selected == 0) { 3527 1.1.2.2 skrll /* strange case here, the INIT 3528 1.1.2.2 skrll * should have did the selection. 3529 1.1.2.2 skrll */ 3530 1.1.2.2 skrll net->_s_addr.sin6.sin6_addr = 3531 1.1.2.2 skrll sctp_ipv6_source_address_selection(inp, 3532 1.1.2.2 skrll stcb, &net->ro, net, 0); 3533 1.1.2.2 skrll net->src_addr_selected = 1; 3534 1.1.2.2 skrll } 3535 1.1.2.2 skrll memcpy(&stc.laddress, &net->_s_addr.sin6.sin6_addr, 3536 1.1.2.2 skrll sizeof(struct in6_addr)); 3537 1.1.2.2 skrll stc.laddr_type = SCTP_IPV6_ADDRESS; 3538 1.1.2.2 skrll } 3539 1.1.2.2 skrll } 3540 1.1.2.2 skrll /* Now lets put the SCTP header in place */ 3541 1.1.2.2 skrll initackm_out = mtod(m, struct sctp_init_msg *); 3542 1.1.2.2 skrll initackm_out->sh.src_port = inp->sctp_lport; 3543 1.1.2.2 skrll initackm_out->sh.dest_port = sh->src_port; 3544 1.1.2.2 skrll initackm_out->sh.v_tag = init_chk->init.initiate_tag; 3545 1.1.2.2 skrll /* Save it off for quick ref */ 3546 1.1.2.2 skrll stc.peers_vtag = init_chk->init.initiate_tag; 3547 1.1.2.2 skrll initackm_out->sh.checksum = 0; /* calculate later */ 3548 1.1.2.2 skrll /* who are we */ 3549 1.1.2.2 skrll strncpy(stc.identification, SCTP_VERSION_STRING, 3550 1.1.2.2 skrll min(strlen(SCTP_VERSION_STRING), sizeof(stc.identification))); 3551 1.1.2.2 skrll /* now the chunk header */ 3552 1.1.2.2 skrll initackm_out->msg.ch.chunk_type = SCTP_INITIATION_ACK; 3553 1.1.2.2 skrll initackm_out->msg.ch.chunk_flags = 0; 3554 1.1.2.2 skrll /* fill in later from mbuf we build */ 3555 1.1.2.2 skrll initackm_out->msg.ch.chunk_length = 0; 3556 1.1.2.2 skrll /* place in my tag */ 3557 1.1.2.2 skrll if ((asoc != NULL) && 3558 1.1.2.2 skrll ((SCTP_GET_STATE(asoc) == SCTP_STATE_COOKIE_WAIT) || 3559 1.1.2.2 skrll (SCTP_GET_STATE(asoc) == SCTP_STATE_COOKIE_ECHOED))) { 3560 1.1.2.2 skrll /* re-use the v-tags and init-seq here */ 3561 1.1.2.2 skrll initackm_out->msg.init.initiate_tag = htonl(asoc->my_vtag); 3562 1.1.2.2 skrll initackm_out->msg.init.initial_tsn = htonl(asoc->init_seq_number); 3563 1.1.2.2 skrll } else { 3564 1.1.2.2 skrll initackm_out->msg.init.initiate_tag = htonl(sctp_select_a_tag(inp)); 3565 1.1.2.2 skrll /* get a TSN to use too */ 3566 1.1.2.2 skrll initackm_out->msg.init.initial_tsn = htonl(sctp_select_initial_TSN(&inp->sctp_ep)); 3567 1.1.2.2 skrll } 3568 1.1.2.2 skrll /* save away my tag to */ 3569 1.1.2.2 skrll stc.my_vtag = initackm_out->msg.init.initiate_tag; 3570 1.1.2.2 skrll 3571 1.1.2.2 skrll /* set up some of the credits. */ 3572 1.1.2.2 skrll initackm_out->msg.init.a_rwnd = htonl(max(inp->sctp_socket->so_rcv.sb_hiwat, SCTP_MINIMAL_RWND)); 3573 1.1.2.2 skrll /* set what I want */ 3574 1.1.2.2 skrll his_limit = ntohs(init_chk->init.num_inbound_streams); 3575 1.1.2.2 skrll /* choose what I want */ 3576 1.1.2.2 skrll if (asoc != NULL) { 3577 1.1.2.2 skrll if (asoc->streamoutcnt > inp->sctp_ep.pre_open_stream_count) { 3578 1.1.2.2 skrll i_want = asoc->streamoutcnt; 3579 1.1.2.2 skrll } else { 3580 1.1.2.2 skrll i_want = inp->sctp_ep.pre_open_stream_count; 3581 1.1.2.2 skrll } 3582 1.1.2.2 skrll } else { 3583 1.1.2.2 skrll i_want = inp->sctp_ep.pre_open_stream_count; 3584 1.1.2.2 skrll } 3585 1.1.2.2 skrll if (his_limit < i_want) { 3586 1.1.2.2 skrll /* I Want more :< */ 3587 1.1.2.2 skrll initackm_out->msg.init.num_outbound_streams = init_chk->init.num_inbound_streams; 3588 1.1.2.2 skrll } else { 3589 1.1.2.2 skrll /* I can have what I want :> */ 3590 1.1.2.2 skrll initackm_out->msg.init.num_outbound_streams = htons(i_want); 3591 1.1.2.2 skrll } 3592 1.1.2.2 skrll /* tell him his limt. */ 3593 1.1.2.2 skrll initackm_out->msg.init.num_inbound_streams = 3594 1.1.2.2 skrll htons(inp->sctp_ep.max_open_streams_intome); 3595 1.1.2.2 skrll /* setup the ECN pointer */ 3596 1.1.2.2 skrll 3597 1.1.2.2 skrll /* if (inp->sctp_flags & SCTP_PCB_FLAGS_ADAPTIONEVNT) {*/ 3598 1.1.2.2 skrll if (inp->sctp_ep.adaption_layer_indicator) { 3599 1.1.2.2 skrll struct sctp_adaption_layer_indication *ali; 3600 1.1.2.2 skrll ali = (struct sctp_adaption_layer_indication *)( 3601 1.1.2.2 skrll (vaddr_t)initackm_out + sizeof(*initackm_out)); 3602 1.1.2.2 skrll ali->ph.param_type = htons(SCTP_ULP_ADAPTION); 3603 1.1.2.2 skrll ali->ph.param_length = htons(sizeof(*ali)); 3604 1.1.2.2 skrll ali->indication = ntohl(inp->sctp_ep.adaption_layer_indicator); 3605 1.1.2.2 skrll m->m_len += sizeof(*ali); 3606 1.1.2.2 skrll ecn = (struct sctp_ecn_supported_param *)((vaddr_t)ali + 3607 1.1.2.2 skrll sizeof(*ali)); 3608 1.1.2.2 skrll } else { 3609 1.1.2.2 skrll ecn = (struct sctp_ecn_supported_param*)( 3610 1.1.2.2 skrll (vaddr_t)initackm_out + sizeof(*initackm_out)); 3611 1.1.2.2 skrll } 3612 1.1.2.2 skrll 3613 1.1.2.2 skrll /* ECN parameter */ 3614 1.1.2.2 skrll if (sctp_ecn == 1) { 3615 1.1.2.2 skrll ecn->ph.param_type = htons(SCTP_ECN_CAPABLE); 3616 1.1.2.2 skrll ecn->ph.param_length = htons(sizeof(*ecn)); 3617 1.1.2.2 skrll m->m_len += sizeof(*ecn); 3618 1.1.2.2 skrll 3619 1.1.2.2 skrll prsctp = (struct sctp_prsctp_supported_param *)((vaddr_t)ecn + 3620 1.1.2.2 skrll sizeof(*ecn)); 3621 1.1.2.2 skrll } else { 3622 1.1.2.2 skrll prsctp = (struct sctp_prsctp_supported_param *)((vaddr_t)ecn); 3623 1.1.2.2 skrll } 3624 1.1.2.2 skrll /* And now tell the peer we do pr-sctp */ 3625 1.1.2.2 skrll prsctp->ph.param_type = htons(SCTP_PRSCTP_SUPPORTED); 3626 1.1.2.2 skrll prsctp->ph.param_length = htons(sizeof(*prsctp)); 3627 1.1.2.2 skrll m->m_len += sizeof(*prsctp); 3628 1.1.2.2 skrll 3629 1.1.2.2 skrll 3630 1.1.2.2 skrll /* And now tell the peer we do all the extensions */ 3631 1.1.2.2 skrll pr_supported = (struct sctp_supported_chunk_types_param *)((vaddr_t)prsctp + 3632 1.1.2.2 skrll sizeof(*prsctp)); 3633 1.1.2.2 skrll 3634 1.1.2.2 skrll pr_supported->ph.param_type = htons(SCTP_SUPPORTED_CHUNK_EXT); 3635 1.1.2.2 skrll pr_supported->ph.param_length = htons(sizeof(*pr_supported) + SCTP_EXT_COUNT); 3636 1.1.2.2 skrll pr_supported->chunk_types[0] = SCTP_ASCONF; 3637 1.1.2.2 skrll pr_supported->chunk_types[1] = SCTP_ASCONF_ACK; 3638 1.1.2.2 skrll pr_supported->chunk_types[2] = SCTP_FORWARD_CUM_TSN; 3639 1.1.2.2 skrll pr_supported->chunk_types[3] = SCTP_PACKET_DROPPED; 3640 1.1.2.2 skrll pr_supported->chunk_types[4] = SCTP_STREAM_RESET; 3641 1.1.2.2 skrll pr_supported->chunk_types[5] = 0; /* pad */ 3642 1.1.2.2 skrll pr_supported->chunk_types[6] = 0; /* pad */ 3643 1.1.2.2 skrll pr_supported->chunk_types[7] = 0; /* pad */ 3644 1.1.2.2 skrll 3645 1.1.2.2 skrll m->m_len += (sizeof(*pr_supported) + SCTP_EXT_COUNT + SCTP_PAD_EXT_COUNT); 3646 1.1.2.2 skrll if (sctp_ecn_nonce) { 3647 1.1.2.2 skrll /* ECN nonce: And now tell the peer we support ECN nonce */ 3648 1.1.2.2 skrll ecn_nonce = (struct sctp_ecn_nonce_supported_param *)((vaddr_t)pr_supported + 3649 1.1.2.2 skrll sizeof(*pr_supported) + SCTP_EXT_COUNT + SCTP_PAD_EXT_COUNT); 3650 1.1.2.2 skrll ecn_nonce->ph.param_type = htons(SCTP_ECN_NONCE_SUPPORTED); 3651 1.1.2.2 skrll ecn_nonce->ph.param_length = htons(sizeof(*ecn_nonce)); 3652 1.1.2.2 skrll m->m_len += sizeof(*ecn_nonce); 3653 1.1.2.2 skrll } 3654 1.1.2.2 skrll 3655 1.1.2.2 skrll m_at = m; 3656 1.1.2.2 skrll /* now the addresses */ 3657 1.1.2.2 skrll if (inp->sctp_flags & SCTP_PCB_FLAGS_BOUNDALL) { 3658 1.1.2.2 skrll struct ifnet *ifn; 3659 1.1.2.2 skrll struct ifaddr *ifa; 3660 1.1.2.2 skrll int cnt = cnt_inits_to; 3661 1.1.2.2 skrll 3662 1.1.2.2 skrll TAILQ_FOREACH(ifn, &ifnet_list, if_list) { 3663 1.1.2.2 skrll if ((stc.loopback_scope == 0) && 3664 1.1.2.2 skrll (ifn->if_type == IFT_LOOP)) { 3665 1.1.2.2 skrll /* 3666 1.1.2.2 skrll * Skip loopback devices if loopback_scope 3667 1.1.2.2 skrll * not set 3668 1.1.2.2 skrll */ 3669 1.1.2.2 skrll continue; 3670 1.1.2.2 skrll } 3671 1.1.2.2 skrll TAILQ_FOREACH(ifa, &ifn->if_addrlist, ifa_list) { 3672 1.1.2.2 skrll if (sctp_is_address_in_scope(ifa, 3673 1.1.2.2 skrll stc.ipv4_addr_legal, stc.ipv6_addr_legal, 3674 1.1.2.2 skrll stc.loopback_scope, stc.ipv4_scope, 3675 1.1.2.2 skrll stc.local_scope, stc.site_scope) == 0) { 3676 1.1.2.2 skrll continue; 3677 1.1.2.2 skrll } 3678 1.1.2.2 skrll cnt++; 3679 1.1.2.2 skrll } 3680 1.1.2.2 skrll } 3681 1.1.2.2 skrll if (cnt > 1) { 3682 1.1.2.2 skrll TAILQ_FOREACH(ifn, &ifnet_list, if_list) { 3683 1.1.2.2 skrll if ((stc.loopback_scope == 0) && 3684 1.1.2.2 skrll (ifn->if_type == IFT_LOOP)) { 3685 1.1.2.2 skrll /* 3686 1.1.2.2 skrll * Skip loopback devices if 3687 1.1.2.2 skrll * loopback_scope not set 3688 1.1.2.2 skrll */ 3689 1.1.2.2 skrll continue; 3690 1.1.2.2 skrll } 3691 1.1.2.2 skrll TAILQ_FOREACH(ifa, &ifn->if_addrlist, ifa_list) { 3692 1.1.2.2 skrll if (sctp_is_address_in_scope(ifa, 3693 1.1.2.2 skrll stc.ipv4_addr_legal, 3694 1.1.2.2 skrll stc.ipv6_addr_legal, 3695 1.1.2.2 skrll stc.loopback_scope, stc.ipv4_scope, 3696 1.1.2.2 skrll stc.local_scope, stc.site_scope) == 0) { 3697 1.1.2.2 skrll continue; 3698 1.1.2.2 skrll } 3699 1.1.2.2 skrll m_at = sctp_add_addr_to_mbuf(m_at, ifa); 3700 1.1.2.2 skrll } 3701 1.1.2.2 skrll } 3702 1.1.2.2 skrll } 3703 1.1.2.2 skrll } else { 3704 1.1.2.2 skrll struct sctp_laddr *laddr; 3705 1.1.2.2 skrll int cnt; 3706 1.1.2.2 skrll cnt = cnt_inits_to; 3707 1.1.2.2 skrll /* First, how many ? */ 3708 1.1.2.2 skrll LIST_FOREACH(laddr, &inp->sctp_addr_list, sctp_nxt_addr) { 3709 1.1.2.2 skrll if (laddr->ifa == NULL) { 3710 1.1.2.2 skrll continue; 3711 1.1.2.2 skrll } 3712 1.1.2.2 skrll if (laddr->ifa->ifa_addr == NULL) 3713 1.1.2.2 skrll continue; 3714 1.1.2.2 skrll if (sctp_is_address_in_scope(laddr->ifa, 3715 1.1.2.2 skrll stc.ipv4_addr_legal, stc.ipv6_addr_legal, 3716 1.1.2.2 skrll stc.loopback_scope, stc.ipv4_scope, 3717 1.1.2.2 skrll stc.local_scope, stc.site_scope) == 0) { 3718 1.1.2.2 skrll continue; 3719 1.1.2.2 skrll } 3720 1.1.2.2 skrll cnt++; 3721 1.1.2.2 skrll } 3722 1.1.2.2 skrll /* If we bind a single address only we won't list 3723 1.1.2.2 skrll * any. This way you can get through a NAT 3724 1.1.2.2 skrll */ 3725 1.1.2.2 skrll if (cnt > 1) { 3726 1.1.2.2 skrll LIST_FOREACH(laddr, &inp->sctp_addr_list, sctp_nxt_addr) { 3727 1.1.2.2 skrll if (laddr->ifa == NULL) { 3728 1.1.2.2 skrll #ifdef SCTP_DEBUG 3729 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 3730 1.1.2.2 skrll printf("Help I have fallen and I can't get up!\n"); 3731 1.1.2.2 skrll } 3732 1.1.2.2 skrll #endif 3733 1.1.2.2 skrll continue; 3734 1.1.2.2 skrll } 3735 1.1.2.2 skrll if (laddr->ifa->ifa_addr == NULL) 3736 1.1.2.2 skrll continue; 3737 1.1.2.2 skrll if (sctp_is_address_in_scope(laddr->ifa, 3738 1.1.2.2 skrll stc.ipv4_addr_legal, stc.ipv6_addr_legal, 3739 1.1.2.2 skrll stc.loopback_scope, stc.ipv4_scope, 3740 1.1.2.2 skrll stc.local_scope, stc.site_scope) == 0) { 3741 1.1.2.2 skrll continue; 3742 1.1.2.2 skrll } 3743 1.1.2.2 skrll m_at = sctp_add_addr_to_mbuf(m_at, laddr->ifa); 3744 1.1.2.2 skrll } 3745 1.1.2.2 skrll } 3746 1.1.2.2 skrll } 3747 1.1.2.2 skrll 3748 1.1.2.2 skrll /* tack on the operational error if present */ 3749 1.1.2.2 skrll if (op_err) { 3750 1.1.2.2 skrll if (op_err->m_pkthdr.len % 4) { 3751 1.1.2.2 skrll /* must add a pad to the param */ 3752 1.1.2.2 skrll u_int32_t cpthis=0; 3753 1.1.2.2 skrll int padlen; 3754 1.1.2.2 skrll padlen = 4 - (op_err->m_pkthdr.len % 4); 3755 1.1.2.2 skrll m_copyback(op_err, op_err->m_pkthdr.len, padlen, (void *)&cpthis); 3756 1.1.2.2 skrll } 3757 1.1.2.2 skrll while (m_at->m_next != NULL) { 3758 1.1.2.2 skrll m_at = m_at->m_next; 3759 1.1.2.2 skrll } 3760 1.1.2.2 skrll m_at->m_next = op_err; 3761 1.1.2.2 skrll while (m_at->m_next != NULL) { 3762 1.1.2.2 skrll m_at = m_at->m_next; 3763 1.1.2.2 skrll } 3764 1.1.2.2 skrll } 3765 1.1.2.2 skrll /* Get total size of init packet */ 3766 1.1.2.2 skrll sz_of = SCTP_SIZE32(ntohs(init_chk->ch.chunk_length)); 3767 1.1.2.2 skrll /* pre-calulate the size and update pkt header and chunk header */ 3768 1.1.2.2 skrll m->m_pkthdr.len = 0; 3769 1.1.2.2 skrll for (m_tmp = m; m_tmp; m_tmp = m_tmp->m_next) { 3770 1.1.2.2 skrll m->m_pkthdr.len += m_tmp->m_len; 3771 1.1.2.2 skrll if (m_tmp->m_next == NULL) { 3772 1.1.2.2 skrll /* m_tmp should now point to last one */ 3773 1.1.2.2 skrll break; 3774 1.1.2.2 skrll } 3775 1.1.2.2 skrll } 3776 1.1.2.2 skrll /* 3777 1.1.2.2 skrll * Figure now the size of the cookie. We know the size of the 3778 1.1.2.2 skrll * INIT-ACK. The Cookie is going to be the size of INIT, INIT-ACK, 3779 1.1.2.2 skrll * COOKIE-STRUCTURE and SIGNATURE. 3780 1.1.2.2 skrll */ 3781 1.1.2.2 skrll 3782 1.1.2.2 skrll /* 3783 1.1.2.2 skrll * take our earlier INIT calc and add in the sz we just calculated 3784 1.1.2.2 skrll * minus the size of the sctphdr (its not included in chunk size 3785 1.1.2.2 skrll */ 3786 1.1.2.2 skrll 3787 1.1.2.2 skrll /* add once for the INIT-ACK */ 3788 1.1.2.2 skrll sz_of += (m->m_pkthdr.len - sizeof(struct sctphdr)); 3789 1.1.2.2 skrll 3790 1.1.2.2 skrll /* add a second time for the INIT-ACK in the cookie */ 3791 1.1.2.2 skrll sz_of += (m->m_pkthdr.len - sizeof(struct sctphdr)); 3792 1.1.2.2 skrll 3793 1.1.2.2 skrll /* Now add the cookie header and cookie message struct */ 3794 1.1.2.2 skrll sz_of += sizeof(struct sctp_state_cookie_param); 3795 1.1.2.2 skrll /* ...and add the size of our signature */ 3796 1.1.2.2 skrll sz_of += SCTP_SIGNATURE_SIZE; 3797 1.1.2.2 skrll initackm_out->msg.ch.chunk_length = htons(sz_of); 3798 1.1.2.2 skrll 3799 1.1.2.2 skrll /* Now we must build a cookie */ 3800 1.1.2.2 skrll m_cookie = sctp_add_cookie(inp, init_pkt, offset, m, 3801 1.1.2.2 skrll sizeof(struct sctphdr), &stc); 3802 1.1.2.2 skrll if (m_cookie == NULL) { 3803 1.1.2.2 skrll /* memory problem */ 3804 1.1.2.2 skrll sctp_m_freem(m); 3805 1.1.2.2 skrll return; 3806 1.1.2.2 skrll } 3807 1.1.2.2 skrll /* Now append the cookie to the end and update the space/size */ 3808 1.1.2.2 skrll m_tmp->m_next = m_cookie; 3809 1.1.2.2 skrll 3810 1.1.2.2 skrll /* 3811 1.1.2.2 skrll * We pass 0 here to NOT set IP_DF if its IPv4, we ignore the 3812 1.1.2.2 skrll * return here since the timer will drive a retranmission. 3813 1.1.2.2 skrll */ 3814 1.1.2.2 skrll padval = m->m_pkthdr.len % 4; 3815 1.1.2.2 skrll if ((padval) && (m_last)) { 3816 1.1.2.2 skrll /* see my previous comments on m_last */ 3817 1.1.2.2 skrll int ret; 3818 1.1.2.2 skrll ret = sctp_add_pad_tombuf(m_last, (4-padval)); 3819 1.1.2.2 skrll if (ret) { 3820 1.1.2.2 skrll /* Houston we have a problem, no space */ 3821 1.1.2.2 skrll sctp_m_freem(m); 3822 1.1.2.2 skrll return; 3823 1.1.2.2 skrll } 3824 1.1.2.2 skrll m->m_pkthdr.len += padval; 3825 1.1.2.2 skrll } 3826 1.1.2.2 skrll sctp_lowlevel_chunk_output(inp, NULL, NULL, to, m, 0, 0, NULL, 0); 3827 1.1.2.2 skrll } 3828 1.1.2.2 skrll 3829 1.1.2.2 skrll 3830 1.1.2.2 skrll static void 3831 1.1.2.2 skrll sctp_insert_on_wheel(struct sctp_association *asoc, 3832 1.1.2.2 skrll struct sctp_stream_out *strq) 3833 1.1.2.2 skrll { 3834 1.1.2.2 skrll struct sctp_stream_out *stre, *strn; 3835 1.1.2.2 skrll stre = TAILQ_FIRST(&asoc->out_wheel); 3836 1.1.2.2 skrll if (stre == NULL) { 3837 1.1.2.2 skrll /* only one on wheel */ 3838 1.1.2.2 skrll TAILQ_INSERT_HEAD(&asoc->out_wheel, strq, next_spoke); 3839 1.1.2.2 skrll return; 3840 1.1.2.2 skrll } 3841 1.1.2.2 skrll for (; stre; stre = strn) { 3842 1.1.2.2 skrll strn = TAILQ_NEXT(stre, next_spoke); 3843 1.1.2.2 skrll if (stre->stream_no > strq->stream_no) { 3844 1.1.2.2 skrll TAILQ_INSERT_BEFORE(stre, strq, next_spoke); 3845 1.1.2.2 skrll return; 3846 1.1.2.2 skrll } else if (stre->stream_no == strq->stream_no) { 3847 1.1.2.2 skrll /* huh, should not happen */ 3848 1.1.2.2 skrll return; 3849 1.1.2.2 skrll } else if (strn == NULL) { 3850 1.1.2.2 skrll /* next one is null */ 3851 1.1.2.2 skrll TAILQ_INSERT_AFTER(&asoc->out_wheel, stre, strq, 3852 1.1.2.2 skrll next_spoke); 3853 1.1.2.2 skrll } 3854 1.1.2.2 skrll } 3855 1.1.2.2 skrll } 3856 1.1.2.2 skrll 3857 1.1.2.2 skrll static void 3858 1.1.2.2 skrll sctp_remove_from_wheel(struct sctp_association *asoc, 3859 1.1.2.2 skrll struct sctp_stream_out *strq) 3860 1.1.2.2 skrll { 3861 1.1.2.2 skrll /* take off and then setup so we know it is not on the wheel */ 3862 1.1.2.2 skrll TAILQ_REMOVE(&asoc->out_wheel, strq, next_spoke); 3863 1.1.2.2 skrll strq->next_spoke.tqe_next = NULL; 3864 1.1.2.2 skrll strq->next_spoke.tqe_prev = NULL; 3865 1.1.2.2 skrll } 3866 1.1.2.2 skrll 3867 1.1.2.2 skrll 3868 1.1.2.2 skrll static void 3869 1.1.2.2 skrll sctp_prune_prsctp(struct sctp_tcb *stcb, 3870 1.1.2.2 skrll struct sctp_association *asoc, 3871 1.1.2.2 skrll struct sctp_sndrcvinfo *srcv, 3872 1.1.2.2 skrll int dataout 3873 1.1.2.2 skrll ) 3874 1.1.2.2 skrll { 3875 1.1.2.2 skrll int freed_spc=0; 3876 1.1.2.2 skrll struct sctp_tmit_chunk *chk, *nchk; 3877 1.1.2.2 skrll if ((asoc->peer_supports_prsctp) && (asoc->sent_queue_cnt_removeable > 0)) { 3878 1.1.2.2 skrll TAILQ_FOREACH(chk, &asoc->sent_queue, sctp_next) { 3879 1.1.2.2 skrll /* 3880 1.1.2.2 skrll * Look for chunks marked with the PR_SCTP 3881 1.1.2.2 skrll * flag AND the buffer space flag. If the one 3882 1.1.2.2 skrll * being sent is equal or greater priority then 3883 1.1.2.2 skrll * purge the old one and free some space. 3884 1.1.2.2 skrll */ 3885 1.1.2.2 skrll if ((chk->flags & (SCTP_PR_SCTP_ENABLED | 3886 1.1.2.2 skrll SCTP_PR_SCTP_BUFFER)) == 3887 1.1.2.2 skrll (SCTP_PR_SCTP_ENABLED|SCTP_PR_SCTP_BUFFER)) { 3888 1.1.2.2 skrll /* 3889 1.1.2.2 skrll * This one is PR-SCTP AND buffer space 3890 1.1.2.2 skrll * limited type 3891 1.1.2.2 skrll */ 3892 1.1.2.2 skrll if (chk->rec.data.timetodrop.tv_sec >= (long)srcv->sinfo_timetolive) { 3893 1.1.2.2 skrll /* Lower numbers equates to 3894 1.1.2.2 skrll * higher priority so if the 3895 1.1.2.2 skrll * one we are looking at has a 3896 1.1.2.2 skrll * larger or equal priority we 3897 1.1.2.2 skrll * want to drop the data and 3898 1.1.2.2 skrll * NOT retransmit it. 3899 1.1.2.2 skrll */ 3900 1.1.2.2 skrll if (chk->data) { 3901 1.1.2.2 skrll /* We release the 3902 1.1.2.2 skrll * book_size if the 3903 1.1.2.2 skrll * mbuf is here 3904 1.1.2.2 skrll */ 3905 1.1.2.2 skrll int ret_spc; 3906 1.1.2.2 skrll int cause; 3907 1.1.2.2 skrll if (chk->sent > SCTP_DATAGRAM_UNSENT) 3908 1.1.2.2 skrll cause = SCTP_RESPONSE_TO_USER_REQ|SCTP_NOTIFY_DATAGRAM_SENT; 3909 1.1.2.2 skrll else 3910 1.1.2.2 skrll cause = SCTP_RESPONSE_TO_USER_REQ|SCTP_NOTIFY_DATAGRAM_UNSENT; 3911 1.1.2.2 skrll ret_spc = sctp_release_pr_sctp_chunk(stcb, chk, 3912 1.1.2.2 skrll cause, 3913 1.1.2.2 skrll &asoc->sent_queue); 3914 1.1.2.2 skrll freed_spc += ret_spc; 3915 1.1.2.2 skrll if (freed_spc >= dataout) { 3916 1.1.2.2 skrll return; 3917 1.1.2.2 skrll } 3918 1.1.2.2 skrll } /* if chunk was present */ 3919 1.1.2.2 skrll } /* if of sufficent priority */ 3920 1.1.2.2 skrll } /* if chunk has enabled */ 3921 1.1.2.2 skrll } /* tailqforeach */ 3922 1.1.2.2 skrll 3923 1.1.2.2 skrll chk = TAILQ_FIRST(&asoc->send_queue); 3924 1.1.2.2 skrll while (chk) { 3925 1.1.2.2 skrll nchk = TAILQ_NEXT(chk, sctp_next); 3926 1.1.2.2 skrll /* Here we must move to the sent queue and mark */ 3927 1.1.2.2 skrll if ((chk->flags & (SCTP_PR_SCTP_ENABLED | 3928 1.1.2.2 skrll SCTP_PR_SCTP_BUFFER)) == 3929 1.1.2.2 skrll (SCTP_PR_SCTP_ENABLED|SCTP_PR_SCTP_BUFFER)) { 3930 1.1.2.2 skrll if (chk->rec.data.timetodrop.tv_sec >= (long)srcv->sinfo_timetolive) { 3931 1.1.2.2 skrll if (chk->data) { 3932 1.1.2.2 skrll /* We release the 3933 1.1.2.2 skrll * book_size if the 3934 1.1.2.2 skrll * mbuf is here 3935 1.1.2.2 skrll */ 3936 1.1.2.2 skrll int ret_spc; 3937 1.1.2.2 skrll ret_spc = sctp_release_pr_sctp_chunk(stcb, chk, 3938 1.1.2.2 skrll SCTP_RESPONSE_TO_USER_REQ|SCTP_NOTIFY_DATAGRAM_UNSENT, 3939 1.1.2.2 skrll &asoc->send_queue); 3940 1.1.2.2 skrll 3941 1.1.2.2 skrll freed_spc += ret_spc; 3942 1.1.2.2 skrll if (freed_spc >= dataout) { 3943 1.1.2.2 skrll return; 3944 1.1.2.2 skrll } 3945 1.1.2.2 skrll } /* end if chk->data */ 3946 1.1.2.2 skrll } /* end if right class */ 3947 1.1.2.2 skrll } /* end if chk pr-sctp */ 3948 1.1.2.2 skrll chk = nchk; 3949 1.1.2.2 skrll } /* end while (chk) */ 3950 1.1.2.2 skrll } /* if enabled in asoc */ 3951 1.1.2.2 skrll } 3952 1.1.2.2 skrll 3953 1.1.2.2 skrll static void 3954 1.1.2.2 skrll sctp_prepare_chunk(struct sctp_tmit_chunk *template, 3955 1.1.2.2 skrll struct sctp_tcb *stcb, 3956 1.1.2.2 skrll struct sctp_sndrcvinfo *srcv, 3957 1.1.2.2 skrll struct sctp_stream_out *strq, 3958 1.1.2.2 skrll struct sctp_nets *net) 3959 1.1.2.2 skrll { 3960 1.1.2.2 skrll memset(template, 0, sizeof(struct sctp_tmit_chunk)); 3961 1.1.2.2 skrll template->sent = SCTP_DATAGRAM_UNSENT; 3962 1.1.2.2 skrll if ((stcb->asoc.peer_supports_prsctp) && 3963 1.1.2.2 skrll (srcv->sinfo_flags & (MSG_PR_SCTP_TTL|MSG_PR_SCTP_BUF)) && 3964 1.1.2.2 skrll (srcv->sinfo_timetolive > 0) 3965 1.1.2.2 skrll ) { 3966 1.1.2.2 skrll /* If: 3967 1.1.2.2 skrll * Peer supports PR-SCTP 3968 1.1.2.2 skrll * The flags is set against this send for PR-SCTP 3969 1.1.2.2 skrll * And timetolive is a postive value, zero is reserved 3970 1.1.2.2 skrll * to mean a reliable send for both buffer/time 3971 1.1.2.2 skrll * related one. 3972 1.1.2.2 skrll */ 3973 1.1.2.2 skrll if (srcv->sinfo_flags & MSG_PR_SCTP_BUF) { 3974 1.1.2.2 skrll /* 3975 1.1.2.2 skrll * Time to live is a priority stored in tv_sec 3976 1.1.2.2 skrll * when doing the buffer drop thing. 3977 1.1.2.2 skrll */ 3978 1.1.2.2 skrll template->rec.data.timetodrop.tv_sec = srcv->sinfo_timetolive; 3979 1.1.2.2 skrll } else { 3980 1.1.2.2 skrll struct timeval tv; 3981 1.1.2.2 skrll 3982 1.1.2.2 skrll SCTP_GETTIME_TIMEVAL(&template->rec.data.timetodrop); 3983 1.1.2.2 skrll tv.tv_sec = srcv->sinfo_timetolive / 1000; 3984 1.1.2.2 skrll tv.tv_usec = (srcv->sinfo_timetolive * 1000) % 1000000; 3985 1.1.2.2 skrll #ifndef __FreeBSD__ 3986 1.1.2.2 skrll timeradd(&template->rec.data.timetodrop, &tv, 3987 1.1.2.2 skrll &template->rec.data.timetodrop); 3988 1.1.2.2 skrll #else 3989 1.1.2.2 skrll timevaladd(&template->rec.data.timetodrop, &tv); 3990 1.1.2.2 skrll #endif 3991 1.1.2.2 skrll } 3992 1.1.2.2 skrll } 3993 1.1.2.2 skrll if ((srcv->sinfo_flags & MSG_UNORDERED) == 0) { 3994 1.1.2.2 skrll template->rec.data.stream_seq = strq->next_sequence_sent; 3995 1.1.2.2 skrll } else { 3996 1.1.2.2 skrll template->rec.data.stream_seq = 0; 3997 1.1.2.2 skrll } 3998 1.1.2.2 skrll template->rec.data.TSN_seq = 0; /* not yet assigned */ 3999 1.1.2.2 skrll 4000 1.1.2.2 skrll template->rec.data.stream_number = srcv->sinfo_stream; 4001 1.1.2.2 skrll template->rec.data.payloadtype = srcv->sinfo_ppid; 4002 1.1.2.2 skrll template->rec.data.context = srcv->sinfo_context; 4003 1.1.2.2 skrll template->rec.data.doing_fast_retransmit = 0; 4004 1.1.2.2 skrll template->rec.data.ect_nonce = 0; /* ECN Nonce */ 4005 1.1.2.2 skrll 4006 1.1.2.2 skrll if (srcv->sinfo_flags & MSG_ADDR_OVER) { 4007 1.1.2.2 skrll template->whoTo = net; 4008 1.1.2.2 skrll } else { 4009 1.1.2.2 skrll if (stcb->asoc.primary_destination) 4010 1.1.2.2 skrll template->whoTo = stcb->asoc.primary_destination; 4011 1.1.2.2 skrll else { 4012 1.1.2.2 skrll /* TSNH */ 4013 1.1.2.2 skrll template->whoTo = net; 4014 1.1.2.2 skrll } 4015 1.1.2.2 skrll } 4016 1.1.2.2 skrll /* the actual chunk flags */ 4017 1.1.2.2 skrll if (srcv->sinfo_flags & MSG_UNORDERED) { 4018 1.1.2.2 skrll template->rec.data.rcv_flags = SCTP_DATA_UNORDERED; 4019 1.1.2.2 skrll } else { 4020 1.1.2.2 skrll template->rec.data.rcv_flags = 0; 4021 1.1.2.2 skrll } 4022 1.1.2.2 skrll /* no flags yet, FRAGMENT_OK goes here */ 4023 1.1.2.2 skrll template->flags = 0; 4024 1.1.2.2 skrll /* PR sctp flags */ 4025 1.1.2.2 skrll if (stcb->asoc.peer_supports_prsctp) { 4026 1.1.2.2 skrll if (srcv->sinfo_timetolive > 0) { 4027 1.1.2.2 skrll /* 4028 1.1.2.2 skrll * We only set the flag if timetolive (or 4029 1.1.2.2 skrll * priority) was set to a positive number. 4030 1.1.2.2 skrll * Zero is reserved specifically to be 4031 1.1.2.2 skrll * EXCLUDED and sent reliable. 4032 1.1.2.2 skrll */ 4033 1.1.2.2 skrll if (srcv->sinfo_flags & MSG_PR_SCTP_TTL) { 4034 1.1.2.2 skrll template->flags |= SCTP_PR_SCTP_ENABLED; 4035 1.1.2.2 skrll } 4036 1.1.2.2 skrll if (srcv->sinfo_flags & MSG_PR_SCTP_BUF) { 4037 1.1.2.2 skrll template->flags |= SCTP_PR_SCTP_BUFFER; 4038 1.1.2.2 skrll } 4039 1.1.2.2 skrll } 4040 1.1.2.2 skrll } 4041 1.1.2.2 skrll template->asoc = &stcb->asoc; 4042 1.1.2.2 skrll } 4043 1.1.2.2 skrll 4044 1.1.2.2 skrll 4045 1.1.2.2 skrll int 4046 1.1.2.2 skrll sctp_get_frag_point(struct sctp_tcb *stcb, 4047 1.1.2.2 skrll struct sctp_association *asoc) 4048 1.1.2.2 skrll { 4049 1.1.2.2 skrll int siz, ovh; 4050 1.1.2.2 skrll 4051 1.1.2.2 skrll /* For endpoints that have both 6 and 4 addresses 4052 1.1.2.2 skrll * we must reserver room for the 6 ip header, for 4053 1.1.2.2 skrll * those that are only dealing with V4 we use 4054 1.1.2.2 skrll * a larger frag point. 4055 1.1.2.2 skrll */ 4056 1.1.2.2 skrll if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) { 4057 1.1.2.2 skrll ovh = SCTP_MED_OVERHEAD; 4058 1.1.2.2 skrll } else { 4059 1.1.2.2 skrll ovh = SCTP_MED_V4_OVERHEAD; 4060 1.1.2.2 skrll } 4061 1.1.2.2 skrll 4062 1.1.2.2 skrll if (stcb->sctp_ep->sctp_frag_point > asoc->smallest_mtu) 4063 1.1.2.2 skrll siz = asoc->smallest_mtu - ovh; 4064 1.1.2.2 skrll else 4065 1.1.2.2 skrll siz = (stcb->sctp_ep->sctp_frag_point - ovh); 4066 1.1.2.2 skrll /* 4067 1.1.2.2 skrll if (siz > (MCLBYTES-sizeof(struct sctp_data_chunk))) { */ 4068 1.1.2.2 skrll /* A data chunk MUST fit in a cluster */ 4069 1.1.2.2 skrll /* siz = (MCLBYTES - sizeof(struct sctp_data_chunk));*/ 4070 1.1.2.2 skrll /* }*/ 4071 1.1.2.2 skrll 4072 1.1.2.2 skrll if (siz % 4) { 4073 1.1.2.2 skrll /* make it an even word boundary please */ 4074 1.1.2.2 skrll siz -= (siz % 4); 4075 1.1.2.2 skrll } 4076 1.1.2.2 skrll return (siz); 4077 1.1.2.2 skrll } 4078 1.1.2.2 skrll extern unsigned int sctp_max_chunks_on_queue; 4079 1.1.2.2 skrll 4080 1.1.2.2 skrll #define SBLOCKWAIT(f) (((f)&MSG_DONTWAIT) ? M_NOWAIT : M_WAITOK) 4081 1.1.2.2 skrll 4082 1.1.2.2 skrll static int 4083 1.1.2.2 skrll sctp_msg_append(struct sctp_tcb *stcb, 4084 1.1.2.2 skrll struct sctp_nets *net, 4085 1.1.2.2 skrll struct mbuf *m, 4086 1.1.2.2 skrll struct sctp_sndrcvinfo *srcv, 4087 1.1.2.2 skrll int flags) 4088 1.1.2.2 skrll { 4089 1.1.2.2 skrll struct socket *so; 4090 1.1.2.2 skrll struct sctp_association *asoc; 4091 1.1.2.2 skrll struct sctp_stream_out *strq; 4092 1.1.2.2 skrll struct sctp_tmit_chunk *chk; 4093 1.1.2.2 skrll struct sctpchunk_listhead tmp; 4094 1.1.2.2 skrll struct sctp_tmit_chunk template; 4095 1.1.2.2 skrll struct mbuf *n, *mnext; 4096 1.1.2.2 skrll struct mbuf *mm; 4097 1.1.2.2 skrll unsigned int dataout, siz; 4098 1.1.2.2 skrll int mbcnt = 0; 4099 1.1.2.2 skrll int mbcnt_e = 0; 4100 1.1.2.2 skrll int error = 0; 4101 1.1.2.2 skrll 4102 1.1.2.2 skrll if ((stcb == NULL) || (net == NULL) || (m == NULL) || (srcv == NULL)) { 4103 1.1.2.2 skrll /* Software fault, you blew it on the call */ 4104 1.1.2.2 skrll #ifdef SCTP_DEBUG 4105 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 4106 1.1.2.2 skrll printf("software error in sctp_msg_append:1\n"); 4107 1.1.2.2 skrll printf("stcb:%p net:%p m:%p srcv:%p\n", 4108 1.1.2.2 skrll stcb, net, m, srcv); 4109 1.1.2.2 skrll } 4110 1.1.2.2 skrll #endif 4111 1.1.2.2 skrll if (m) 4112 1.1.2.2 skrll sctp_m_freem(m); 4113 1.1.2.2 skrll return (EFAULT); 4114 1.1.2.2 skrll } 4115 1.1.2.2 skrll so = stcb->sctp_socket; 4116 1.1.2.2 skrll asoc = &stcb->asoc; 4117 1.1.2.2 skrll if (srcv->sinfo_flags & MSG_ABORT) { 4118 1.1.2.2 skrll if ((SCTP_GET_STATE(asoc) != SCTP_STATE_COOKIE_WAIT) && 4119 1.1.2.2 skrll (SCTP_GET_STATE(asoc) != SCTP_STATE_COOKIE_ECHOED)) { 4120 1.1.2.2 skrll /* It has to be up before we abort */ 4121 1.1.2.2 skrll /* how big is the user initiated abort? */ 4122 1.1.2.2 skrll if ((m->m_flags & M_PKTHDR) && (m->m_pkthdr.len)) { 4123 1.1.2.2 skrll dataout = m->m_pkthdr.len; 4124 1.1.2.2 skrll } else { 4125 1.1.2.2 skrll /* we must count */ 4126 1.1.2.2 skrll dataout = 0; 4127 1.1.2.2 skrll for (n = m; n; n = n->m_next) { 4128 1.1.2.2 skrll dataout += n->m_len; 4129 1.1.2.2 skrll } 4130 1.1.2.2 skrll } 4131 1.1.2.2 skrll M_PREPEND(m, sizeof(struct sctp_paramhdr), M_DONTWAIT); 4132 1.1.2.2 skrll if (m) { 4133 1.1.2.2 skrll struct sctp_paramhdr *ph; 4134 1.1.2.2 skrll m->m_len = sizeof(struct sctp_paramhdr) + dataout; 4135 1.1.2.2 skrll ph = mtod(m, struct sctp_paramhdr *); 4136 1.1.2.2 skrll ph->param_type = htons(SCTP_CAUSE_USER_INITIATED_ABT); 4137 1.1.2.2 skrll ph->param_length = htons(m->m_len); 4138 1.1.2.2 skrll } 4139 1.1.2.2 skrll sctp_abort_an_association(stcb->sctp_ep, stcb, SCTP_RESPONSE_TO_USER_REQ, m); 4140 1.1.2.2 skrll m = NULL; 4141 1.1.2.2 skrll } else { 4142 1.1.2.2 skrll /* Only free if we don't send an abort */ 4143 1.1.2.2 skrll ; 4144 1.1.2.2 skrll } 4145 1.1.2.2 skrll goto out; 4146 1.1.2.2 skrll } 4147 1.1.2.2 skrll if ((SCTP_GET_STATE(asoc) == SCTP_STATE_SHUTDOWN_SENT) || 4148 1.1.2.2 skrll (SCTP_GET_STATE(asoc) == SCTP_STATE_SHUTDOWN_ACK_SENT) || 4149 1.1.2.2 skrll (SCTP_GET_STATE(asoc) == SCTP_STATE_SHUTDOWN_RECEIVED) || 4150 1.1.2.2 skrll (asoc->state & SCTP_STATE_SHUTDOWN_PENDING)) { 4151 1.1.2.2 skrll /* got data while shutting down */ 4152 1.1.2.2 skrll error = ECONNRESET; 4153 1.1.2.2 skrll goto out; 4154 1.1.2.2 skrll } 4155 1.1.2.2 skrll 4156 1.1.2.2 skrll if (srcv->sinfo_stream >= asoc->streamoutcnt) { 4157 1.1.2.2 skrll /* Invalid stream number */ 4158 1.1.2.2 skrll error = EINVAL; 4159 1.1.2.2 skrll goto out; 4160 1.1.2.2 skrll } 4161 1.1.2.2 skrll if (asoc->strmout == NULL) { 4162 1.1.2.2 skrll /* huh? software error */ 4163 1.1.2.2 skrll #ifdef SCTP_DEBUG 4164 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 4165 1.1.2.2 skrll printf("software error in sctp_msg_append:2\n"); 4166 1.1.2.2 skrll } 4167 1.1.2.2 skrll #endif 4168 1.1.2.2 skrll error = EFAULT; 4169 1.1.2.2 skrll goto out; 4170 1.1.2.2 skrll } 4171 1.1.2.2 skrll strq = &asoc->strmout[srcv->sinfo_stream]; 4172 1.1.2.2 skrll /* how big is it ? */ 4173 1.1.2.2 skrll if ((m->m_flags & M_PKTHDR) && (m->m_pkthdr.len)) { 4174 1.1.2.2 skrll dataout = m->m_pkthdr.len; 4175 1.1.2.2 skrll } else { 4176 1.1.2.2 skrll /* we must count */ 4177 1.1.2.2 skrll dataout = 0; 4178 1.1.2.2 skrll for (n = m; n; n = n->m_next) { 4179 1.1.2.2 skrll dataout += n->m_len; 4180 1.1.2.2 skrll } 4181 1.1.2.2 skrll } 4182 1.1.2.2 skrll #ifdef SCTP_DEBUG 4183 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 4184 1.1.2.2 skrll printf("Attempt to send out %d bytes\n", 4185 1.1.2.2 skrll dataout); 4186 1.1.2.2 skrll } 4187 1.1.2.2 skrll #endif 4188 1.1.2.2 skrll 4189 1.1.2.2 skrll /* lock the socket buf */ 4190 1.1.2.2 skrll error = sblock(&so->so_snd, SBLOCKWAIT(flags)); 4191 1.1.2.2 skrll if (error) 4192 1.1.2.2 skrll goto out_locked; 4193 1.1.2.2 skrll 4194 1.1.2.2 skrll if (dataout > so->so_snd.sb_hiwat) { 4195 1.1.2.2 skrll /* It will NEVER fit */ 4196 1.1.2.2 skrll error = EMSGSIZE; 4197 1.1.2.2 skrll goto release; 4198 1.1.2.2 skrll } 4199 1.1.2.2 skrll if ((srcv->sinfo_flags & MSG_EOF) && 4200 1.1.2.2 skrll (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_UDPTYPE) && 4201 1.1.2.2 skrll (dataout == 0) 4202 1.1.2.2 skrll ) { 4203 1.1.2.2 skrll goto zap_by_it_all; 4204 1.1.2.2 skrll } 4205 1.1.2.2 skrll if ((so->so_snd.sb_hiwat < 4206 1.1.2.2 skrll (dataout + asoc->total_output_queue_size)) || 4207 1.1.2.2 skrll (asoc->chunks_on_out_queue > sctp_max_chunks_on_queue) || 4208 1.1.2.2 skrll (asoc->total_output_mbuf_queue_size > 4209 1.1.2.2 skrll so->so_snd.sb_mbmax) 4210 1.1.2.2 skrll ) { 4211 1.1.2.2 skrll /* XXX Buffer space hunt for data to skip */ 4212 1.1.2.2 skrll if (asoc->peer_supports_prsctp) { 4213 1.1.2.2 skrll sctp_prune_prsctp(stcb, asoc, srcv, dataout); 4214 1.1.2.2 skrll } 4215 1.1.2.2 skrll while ((so->so_snd.sb_hiwat < 4216 1.1.2.2 skrll (dataout + asoc->total_output_queue_size)) || 4217 1.1.2.2 skrll (asoc->chunks_on_out_queue > sctp_max_chunks_on_queue) || 4218 1.1.2.2 skrll (asoc->total_output_mbuf_queue_size > 4219 1.1.2.2 skrll so->so_snd.sb_mbmax)) { 4220 1.1.2.2 skrll struct sctp_inpcb *inp; 4221 1.1.2.2 skrll /* Now did we free up enough room? */ 4222 1.1.2.2 skrll if (so->so_state & SS_NBIO) { 4223 1.1.2.2 skrll /* Non-blocking io in place */ 4224 1.1.2.2 skrll error = EWOULDBLOCK; 4225 1.1.2.2 skrll goto release; 4226 1.1.2.2 skrll } 4227 1.1.2.2 skrll /* 4228 1.1.2.2 skrll * We store off a pointer to the endpoint. 4229 1.1.2.2 skrll * Since on return from this we must check to 4230 1.1.2.2 skrll * see if an so_error is set. If so we may have 4231 1.1.2.2 skrll * been reset and our stcb destroyed. Returning 4232 1.1.2.2 skrll * an error will cause the correct error return 4233 1.1.2.2 skrll * through and fix this all. 4234 1.1.2.2 skrll */ 4235 1.1.2.2 skrll inp = stcb->sctp_ep; 4236 1.1.2.2 skrll /* 4237 1.1.2.2 skrll * Not sure how else to do this since 4238 1.1.2.2 skrll * the level we suspended at is not 4239 1.1.2.2 skrll * known deep down where we are. I will 4240 1.1.2.2 skrll * drop to spl0() so that others can 4241 1.1.2.2 skrll * get in. 4242 1.1.2.2 skrll */ 4243 1.1.2.2 skrll 4244 1.1.2.2 skrll inp->sctp_tcb_at_block = (void *)stcb; 4245 1.1.2.2 skrll inp->error_on_block = 0; 4246 1.1.2.2 skrll sbunlock(&so->so_snd); 4247 1.1.2.2 skrll error = sbwait(&so->so_snd); 4248 1.1.2.2 skrll /* 4249 1.1.2.2 skrll * XXX: This is ugly but I have 4250 1.1.2.2 skrll * recreated most of what goes on to 4251 1.1.2.2 skrll * block in the sb. UGHH 4252 1.1.2.2 skrll * May want to add the bit about being 4253 1.1.2.2 skrll * no longer connected.. but this then 4254 1.1.2.2 skrll * further dooms the UDP model NOT to 4255 1.1.2.2 skrll * allow this. 4256 1.1.2.2 skrll */ 4257 1.1.2.2 skrll inp->sctp_tcb_at_block = 0; 4258 1.1.2.2 skrll if (inp->error_on_block) 4259 1.1.2.2 skrll error = inp->error_on_block; 4260 1.1.2.2 skrll if (so->so_error) 4261 1.1.2.2 skrll error = so->so_error; 4262 1.1.2.2 skrll if (error) { 4263 1.1.2.2 skrll goto out_locked; 4264 1.1.2.2 skrll } 4265 1.1.2.2 skrll error = sblock(&so->so_snd, M_WAITOK); 4266 1.1.2.2 skrll if (error) 4267 1.1.2.2 skrll goto out_locked; 4268 1.1.2.2 skrll /* Otherwise we cycle back and recheck 4269 1.1.2.2 skrll * the space 4270 1.1.2.2 skrll */ 4271 1.1.2.2 skrll #if defined(__FreeBSD__) && __FreeBSD_version >= 502115 4272 1.1.2.2 skrll if (so->so_rcv.sb_state & SBS_CANTSENDMORE) { 4273 1.1.2.2 skrll #else 4274 1.1.2.2 skrll if (so->so_state & SS_CANTSENDMORE) { 4275 1.1.2.2 skrll #endif 4276 1.1.2.2 skrll error = EPIPE; 4277 1.1.2.2 skrll goto release; 4278 1.1.2.2 skrll } 4279 1.1.2.2 skrll if (so->so_error) { 4280 1.1.2.2 skrll error = so->so_error; 4281 1.1.2.2 skrll goto release; 4282 1.1.2.2 skrll } 4283 1.1.2.2 skrll } 4284 1.1.2.2 skrll } 4285 1.1.2.2 skrll /* If we have a packet header fix it if it was broke */ 4286 1.1.2.2 skrll if (m->m_flags & M_PKTHDR) { 4287 1.1.2.2 skrll m->m_pkthdr.len = dataout; 4288 1.1.2.2 skrll } 4289 1.1.2.2 skrll /* use the smallest one, user set value or 4290 1.1.2.2 skrll * smallest mtu of the asoc 4291 1.1.2.2 skrll */ 4292 1.1.2.2 skrll siz = sctp_get_frag_point(stcb, asoc); 4293 1.1.2.2 skrll if ((dataout) && (dataout <= siz)) { 4294 1.1.2.2 skrll /* Fast path */ 4295 1.1.2.2 skrll chk = (struct sctp_tmit_chunk *)SCTP_ZONE_GET(sctppcbinfo.ipi_zone_chunk); 4296 1.1.2.2 skrll if (chk == NULL) { 4297 1.1.2.2 skrll error = ENOMEM; 4298 1.1.2.2 skrll goto release; 4299 1.1.2.2 skrll } 4300 1.1.2.2 skrll sctp_prepare_chunk(chk, stcb, srcv, strq, net); 4301 1.1.2.2 skrll chk->whoTo->ref_count++; 4302 1.1.2.2 skrll chk->rec.data.rcv_flags |= SCTP_DATA_NOT_FRAG; 4303 1.1.2.2 skrll 4304 1.1.2.2 skrll /* no flags yet, FRAGMENT_OK goes here */ 4305 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk++; 4306 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 4307 1.1.2.2 skrll asoc->chunks_on_out_queue++; 4308 1.1.2.2 skrll chk->data = m; 4309 1.1.2.2 skrll m = NULL; 4310 1.1.2.2 skrll /* Total in the MSIZE */ 4311 1.1.2.2 skrll for (mm = chk->data; mm; mm = mm->m_next) { 4312 1.1.2.2 skrll mbcnt += MSIZE; 4313 1.1.2.2 skrll if (mm->m_flags & M_EXT) { 4314 1.1.2.2 skrll mbcnt += chk->data->m_ext.ext_size; 4315 1.1.2.2 skrll } 4316 1.1.2.2 skrll } 4317 1.1.2.2 skrll /* fix up the send_size if it is not present */ 4318 1.1.2.2 skrll chk->send_size = dataout; 4319 1.1.2.2 skrll chk->book_size = chk->send_size; 4320 1.1.2.2 skrll chk->mbcnt = mbcnt; 4321 1.1.2.2 skrll /* ok, we are commited */ 4322 1.1.2.2 skrll if ((srcv->sinfo_flags & MSG_UNORDERED) == 0) { 4323 1.1.2.2 skrll /* bump the ssn if we are unordered. */ 4324 1.1.2.2 skrll strq->next_sequence_sent++; 4325 1.1.2.2 skrll } 4326 1.1.2.2 skrll chk->data->m_nextpkt = 0; 4327 1.1.2.2 skrll asoc->stream_queue_cnt++; 4328 1.1.2.2 skrll TAILQ_INSERT_TAIL(&strq->outqueue, chk, sctp_next); 4329 1.1.2.2 skrll /* now check if this stream is on the wheel */ 4330 1.1.2.2 skrll if ((strq->next_spoke.tqe_next == NULL) && 4331 1.1.2.2 skrll (strq->next_spoke.tqe_prev == NULL)) { 4332 1.1.2.2 skrll /* Insert it on the wheel since it is not 4333 1.1.2.2 skrll * on it currently 4334 1.1.2.2 skrll */ 4335 1.1.2.2 skrll sctp_insert_on_wheel(asoc, strq); 4336 1.1.2.2 skrll } 4337 1.1.2.2 skrll } else if ((dataout) && (dataout > siz)) { 4338 1.1.2.2 skrll /* Slow path */ 4339 1.1.2.2 skrll if ((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_NO_FRAGMENT) && 4340 1.1.2.2 skrll (dataout > siz)) { 4341 1.1.2.2 skrll error = EMSGSIZE; 4342 1.1.2.2 skrll goto release; 4343 1.1.2.2 skrll } 4344 1.1.2.2 skrll /* setup the template */ 4345 1.1.2.2 skrll sctp_prepare_chunk(&template, stcb, srcv, strq, net); 4346 1.1.2.2 skrll 4347 1.1.2.2 skrll n = m; 4348 1.1.2.2 skrll while (dataout > siz) { 4349 1.1.2.2 skrll /* 4350 1.1.2.2 skrll * We can wait since this is called from the user 4351 1.1.2.2 skrll * send side 4352 1.1.2.2 skrll */ 4353 1.1.2.2 skrll n->m_nextpkt = m_split(n, siz, M_WAIT); 4354 1.1.2.2 skrll if (n->m_nextpkt == NULL) { 4355 1.1.2.2 skrll error = EFAULT; 4356 1.1.2.2 skrll goto release; 4357 1.1.2.2 skrll } 4358 1.1.2.2 skrll dataout -= siz; 4359 1.1.2.2 skrll n = n->m_nextpkt; 4360 1.1.2.2 skrll } 4361 1.1.2.2 skrll /* 4362 1.1.2.2 skrll * ok, now we have a chain on m where m->m_nextpkt points to 4363 1.1.2.2 skrll * the next chunk and m/m->m_next chain is the piece to send. 4364 1.1.2.2 skrll * We must go through the chains and thread them on to 4365 1.1.2.2 skrll * sctp_tmit_chunk chains and place them all on the stream 4366 1.1.2.2 skrll * queue, breaking the m->m_nextpkt pointers as we go. 4367 1.1.2.2 skrll */ 4368 1.1.2.2 skrll n = m; 4369 1.1.2.2 skrll TAILQ_INIT(&tmp); 4370 1.1.2.2 skrll while (n) { 4371 1.1.2.2 skrll /* 4372 1.1.2.2 skrll * first go through and allocate a sctp_tmit chunk 4373 1.1.2.2 skrll * for each chunk piece 4374 1.1.2.2 skrll */ 4375 1.1.2.2 skrll chk = (struct sctp_tmit_chunk *)SCTP_ZONE_GET(sctppcbinfo.ipi_zone_chunk); 4376 1.1.2.2 skrll if (chk == NULL) { 4377 1.1.2.2 skrll /* 4378 1.1.2.2 skrll * ok we must spin through and dump anything 4379 1.1.2.2 skrll * we have allocated and then jump to the 4380 1.1.2.2 skrll * no_membad 4381 1.1.2.2 skrll */ 4382 1.1.2.2 skrll chk = TAILQ_FIRST(&tmp); 4383 1.1.2.2 skrll while (chk) { 4384 1.1.2.2 skrll TAILQ_REMOVE(&tmp, chk, sctp_next); 4385 1.1.2.2 skrll SCTP_ZONE_FREE(sctppcbinfo.ipi_zone_chunk, chk); 4386 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk--; 4387 1.1.2.2 skrll asoc->chunks_on_out_queue--; 4388 1.1.2.2 skrll if ((int)sctppcbinfo.ipi_count_chunk < 0) { 4389 1.1.2.2 skrll panic("Chunk count is negative"); 4390 1.1.2.2 skrll } 4391 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 4392 1.1.2.2 skrll chk = TAILQ_FIRST(&tmp); 4393 1.1.2.2 skrll } 4394 1.1.2.2 skrll error = ENOMEM; 4395 1.1.2.2 skrll goto release; 4396 1.1.2.2 skrll } 4397 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk++; 4398 1.1.2.2 skrll asoc->chunks_on_out_queue++; 4399 1.1.2.2 skrll 4400 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 4401 1.1.2.2 skrll *chk = template; 4402 1.1.2.2 skrll chk->whoTo->ref_count++; 4403 1.1.2.2 skrll chk->data = n; 4404 1.1.2.2 skrll /* Total in the MSIZE */ 4405 1.1.2.2 skrll mbcnt_e = 0; 4406 1.1.2.2 skrll for (mm = chk->data; mm; mm = mm->m_next) { 4407 1.1.2.2 skrll mbcnt_e += MSIZE; 4408 1.1.2.2 skrll if (mm->m_flags & M_EXT) { 4409 1.1.2.2 skrll mbcnt_e += chk->data->m_ext.ext_size; 4410 1.1.2.2 skrll } 4411 1.1.2.2 skrll } 4412 1.1.2.2 skrll /* now fix the chk->send_size */ 4413 1.1.2.2 skrll if (chk->data->m_flags & M_PKTHDR) { 4414 1.1.2.2 skrll chk->send_size = chk->data->m_pkthdr.len; 4415 1.1.2.2 skrll } else { 4416 1.1.2.2 skrll struct mbuf *nn; 4417 1.1.2.2 skrll chk->send_size = 0; 4418 1.1.2.2 skrll for (nn = chk->data; nn; nn = nn->m_next) { 4419 1.1.2.2 skrll chk->send_size += nn->m_len; 4420 1.1.2.2 skrll } 4421 1.1.2.2 skrll } 4422 1.1.2.2 skrll chk->book_size = chk->send_size; 4423 1.1.2.2 skrll chk->mbcnt = mbcnt_e; 4424 1.1.2.2 skrll mbcnt += mbcnt_e; 4425 1.1.2.2 skrll if (chk->flags & SCTP_PR_SCTP_BUFFER) { 4426 1.1.2.2 skrll asoc->sent_queue_cnt_removeable++; 4427 1.1.2.2 skrll } 4428 1.1.2.2 skrll n = n->m_nextpkt; 4429 1.1.2.2 skrll TAILQ_INSERT_TAIL(&tmp, chk, sctp_next); 4430 1.1.2.2 skrll } 4431 1.1.2.2 skrll m = NULL; 4432 1.1.2.2 skrll /* now that we have enough space for all de-couple the 4433 1.1.2.2 skrll * chain of mbufs by going through our temp array 4434 1.1.2.2 skrll * and breaking the pointers. 4435 1.1.2.2 skrll */ 4436 1.1.2.2 skrll /* ok, we are commited */ 4437 1.1.2.2 skrll if ((srcv->sinfo_flags & MSG_UNORDERED) == 0) { 4438 1.1.2.2 skrll /* bump the ssn if we are unordered. */ 4439 1.1.2.2 skrll strq->next_sequence_sent++; 4440 1.1.2.2 skrll } 4441 1.1.2.2 skrll /* Mark the first/last flags. This will 4442 1.1.2.2 skrll * result int a 3 for a single item on the list 4443 1.1.2.2 skrll */ 4444 1.1.2.2 skrll chk = TAILQ_FIRST(&tmp); 4445 1.1.2.2 skrll chk->rec.data.rcv_flags |= SCTP_DATA_FIRST_FRAG; 4446 1.1.2.2 skrll chk = TAILQ_LAST(&tmp, sctpchunk_listhead); 4447 1.1.2.2 skrll chk->rec.data.rcv_flags |= SCTP_DATA_LAST_FRAG; 4448 1.1.2.2 skrll /* now break any chains on the queue and 4449 1.1.2.2 skrll * move it to the streams actual queue. 4450 1.1.2.2 skrll */ 4451 1.1.2.2 skrll chk = TAILQ_FIRST(&tmp); 4452 1.1.2.2 skrll while (chk) { 4453 1.1.2.2 skrll chk->data->m_nextpkt = 0; 4454 1.1.2.2 skrll TAILQ_REMOVE(&tmp, chk, sctp_next); 4455 1.1.2.2 skrll asoc->stream_queue_cnt++; 4456 1.1.2.2 skrll TAILQ_INSERT_TAIL(&strq->outqueue, chk, sctp_next); 4457 1.1.2.2 skrll chk = TAILQ_FIRST(&tmp); 4458 1.1.2.2 skrll } 4459 1.1.2.2 skrll /* now check if this stream is on the wheel */ 4460 1.1.2.2 skrll if ((strq->next_spoke.tqe_next == NULL) && 4461 1.1.2.2 skrll (strq->next_spoke.tqe_prev == NULL)) { 4462 1.1.2.2 skrll /* Insert it on the wheel since it is not 4463 1.1.2.2 skrll * on it currently 4464 1.1.2.2 skrll */ 4465 1.1.2.2 skrll sctp_insert_on_wheel(asoc, strq); 4466 1.1.2.2 skrll } 4467 1.1.2.2 skrll } 4468 1.1.2.2 skrll /* has a SHUTDOWN been (also) requested by the user on this asoc? */ 4469 1.1.2.2 skrll zap_by_it_all: 4470 1.1.2.2 skrll 4471 1.1.2.2 skrll if ((srcv->sinfo_flags & MSG_EOF) && 4472 1.1.2.2 skrll (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_UDPTYPE)) { 4473 1.1.2.2 skrll 4474 1.1.2.2 skrll int some_on_streamwheel = 0; 4475 1.1.2.2 skrll 4476 1.1.2.2 skrll if (!TAILQ_EMPTY(&asoc->out_wheel)) { 4477 1.1.2.2 skrll /* Check to see if some data queued */ 4478 1.1.2.2 skrll struct sctp_stream_out *outs; 4479 1.1.2.2 skrll TAILQ_FOREACH(outs, &asoc->out_wheel, next_spoke) { 4480 1.1.2.2 skrll if (!TAILQ_EMPTY(&outs->outqueue)) { 4481 1.1.2.2 skrll some_on_streamwheel = 1; 4482 1.1.2.2 skrll break; 4483 1.1.2.2 skrll } 4484 1.1.2.2 skrll } 4485 1.1.2.2 skrll } 4486 1.1.2.2 skrll 4487 1.1.2.2 skrll if (TAILQ_EMPTY(&asoc->send_queue) && 4488 1.1.2.2 skrll TAILQ_EMPTY(&asoc->sent_queue) && 4489 1.1.2.2 skrll (some_on_streamwheel == 0)) { 4490 1.1.2.2 skrll /* there is nothing queued to send, so I'm done... */ 4491 1.1.2.2 skrll if ((SCTP_GET_STATE(asoc) != SCTP_STATE_SHUTDOWN_SENT) && 4492 1.1.2.2 skrll (SCTP_GET_STATE(asoc) != SCTP_STATE_SHUTDOWN_ACK_SENT)) { 4493 1.1.2.2 skrll /* only send SHUTDOWN the first time through */ 4494 1.1.2.2 skrll #ifdef SCTP_DEBUG 4495 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT4) { 4496 1.1.2.2 skrll printf("%s:%d sends a shutdown\n", 4497 1.1.2.2 skrll __FILE__, 4498 1.1.2.2 skrll __LINE__ 4499 1.1.2.2 skrll ); 4500 1.1.2.2 skrll } 4501 1.1.2.2 skrll #endif 4502 1.1.2.2 skrll sctp_send_shutdown(stcb, stcb->asoc.primary_destination); 4503 1.1.2.2 skrll asoc->state = SCTP_STATE_SHUTDOWN_SENT; 4504 1.1.2.2 skrll sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWN, stcb->sctp_ep, stcb, 4505 1.1.2.2 skrll asoc->primary_destination); 4506 1.1.2.2 skrll sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNGUARD, stcb->sctp_ep, stcb, 4507 1.1.2.2 skrll asoc->primary_destination); 4508 1.1.2.2 skrll } 4509 1.1.2.2 skrll } else { 4510 1.1.2.2 skrll /* 4511 1.1.2.2 skrll * we still got (or just got) data to send, so set 4512 1.1.2.2 skrll * SHUTDOWN_PENDING 4513 1.1.2.2 skrll */ 4514 1.1.2.2 skrll /* 4515 1.1.2.2 skrll * XXX sockets draft says that MSG_EOF should be sent 4516 1.1.2.2 skrll * with no data. currently, we will allow user data 4517 1.1.2.2 skrll * to be sent first and move to SHUTDOWN-PENDING 4518 1.1.2.2 skrll */ 4519 1.1.2.2 skrll asoc->state |= SCTP_STATE_SHUTDOWN_PENDING; 4520 1.1.2.2 skrll } 4521 1.1.2.2 skrll } 4522 1.1.2.2 skrll #ifdef SCTP_MBCNT_LOGGING 4523 1.1.2.2 skrll sctp_log_mbcnt(SCTP_LOG_MBCNT_INCREASE, 4524 1.1.2.2 skrll asoc->total_output_queue_size, 4525 1.1.2.2 skrll dataout, 4526 1.1.2.2 skrll asoc->total_output_mbuf_queue_size, 4527 1.1.2.2 skrll mbcnt); 4528 1.1.2.2 skrll #endif 4529 1.1.2.2 skrll asoc->total_output_queue_size += dataout; 4530 1.1.2.2 skrll asoc->total_output_mbuf_queue_size += mbcnt; 4531 1.1.2.2 skrll if ((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) || 4532 1.1.2.2 skrll (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_IN_TCPPOOL)) { 4533 1.1.2.2 skrll so->so_snd.sb_cc += dataout; 4534 1.1.2.2 skrll so->so_snd.sb_mbcnt += mbcnt; 4535 1.1.2.2 skrll } 4536 1.1.2.2 skrll 4537 1.1.2.2 skrll #ifdef SCTP_DEBUG 4538 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT2) { 4539 1.1.2.2 skrll printf("++total out:%d total_mbuf_out:%d\n", 4540 1.1.2.2 skrll (int)asoc->total_output_queue_size, 4541 1.1.2.2 skrll (int)asoc->total_output_mbuf_queue_size); 4542 1.1.2.2 skrll } 4543 1.1.2.2 skrll #endif 4544 1.1.2.2 skrll 4545 1.1.2.2 skrll release: 4546 1.1.2.2 skrll sbunlock(&so->so_snd); 4547 1.1.2.2 skrll out_locked: 4548 1.1.2.2 skrll 4549 1.1.2.2 skrll out: 4550 1.1.2.2 skrll if (m && m->m_nextpkt) { 4551 1.1.2.2 skrll n = m; 4552 1.1.2.2 skrll while (n) { 4553 1.1.2.2 skrll mnext = n->m_nextpkt; 4554 1.1.2.2 skrll n->m_nextpkt = NULL; 4555 1.1.2.2 skrll sctp_m_freem(n); 4556 1.1.2.2 skrll n = mnext; 4557 1.1.2.2 skrll } 4558 1.1.2.2 skrll } else if (m) 4559 1.1.2.2 skrll sctp_m_freem(m); 4560 1.1.2.2 skrll 4561 1.1.2.2 skrll return (error); 4562 1.1.2.2 skrll } 4563 1.1.2.2 skrll 4564 1.1.2.2 skrll static struct mbuf * 4565 1.1.2.2 skrll sctp_copy_mbufchain(struct mbuf *clonechain, 4566 1.1.2.2 skrll struct mbuf *outchain) 4567 1.1.2.2 skrll { 4568 1.1.2.2 skrll struct mbuf *appendchain; 4569 1.1.2.2 skrll #if defined(__FreeBSD__) || defined(__NetBSD__) 4570 1.1.2.2 skrll /* Supposedly m_copypacket is an optimization, use it if we can */ 4571 1.1.2.2 skrll if (clonechain->m_flags & M_PKTHDR) { 4572 1.1.2.2 skrll appendchain = m_copypacket(clonechain, M_DONTWAIT); 4573 1.1.2.2 skrll sctp_pegs[SCTP_CACHED_SRC]++; 4574 1.1.2.2 skrll } else 4575 1.1.2.2 skrll appendchain = m_copy(clonechain, 0, M_COPYALL); 4576 1.1.2.2 skrll #elif defined(__APPLE__) 4577 1.1.2.2 skrll appendchain = sctp_m_copym(clonechain, 0, M_COPYALL, M_DONTWAIT); 4578 1.1.2.2 skrll #else 4579 1.1.2.2 skrll appendchain = m_copy(clonechain, 0, M_COPYALL); 4580 1.1.2.2 skrll #endif 4581 1.1.2.2 skrll 4582 1.1.2.2 skrll if (appendchain == NULL) { 4583 1.1.2.2 skrll /* error */ 4584 1.1.2.2 skrll if (outchain) 4585 1.1.2.2 skrll sctp_m_freem(outchain); 4586 1.1.2.2 skrll return (NULL); 4587 1.1.2.2 skrll } 4588 1.1.2.2 skrll if (outchain) { 4589 1.1.2.2 skrll /* tack on to the end */ 4590 1.1.2.2 skrll struct mbuf *m; 4591 1.1.2.2 skrll m = outchain; 4592 1.1.2.2 skrll while (m) { 4593 1.1.2.2 skrll if (m->m_next == NULL) { 4594 1.1.2.2 skrll m->m_next = appendchain; 4595 1.1.2.2 skrll break; 4596 1.1.2.2 skrll } 4597 1.1.2.2 skrll m = m->m_next; 4598 1.1.2.2 skrll } 4599 1.1.2.2 skrll if (outchain->m_flags & M_PKTHDR) { 4600 1.1.2.2 skrll int append_tot; 4601 1.1.2.2 skrll struct mbuf *t; 4602 1.1.2.2 skrll t = appendchain; 4603 1.1.2.2 skrll append_tot = 0; 4604 1.1.2.2 skrll while (t) { 4605 1.1.2.2 skrll append_tot += t->m_len; 4606 1.1.2.2 skrll t = t->m_next; 4607 1.1.2.2 skrll } 4608 1.1.2.2 skrll outchain->m_pkthdr.len += append_tot; 4609 1.1.2.2 skrll } 4610 1.1.2.2 skrll return (outchain); 4611 1.1.2.2 skrll } else { 4612 1.1.2.2 skrll return (appendchain); 4613 1.1.2.2 skrll } 4614 1.1.2.2 skrll } 4615 1.1.2.2 skrll 4616 1.1.2.2 skrll static void 4617 1.1.2.2 skrll sctp_sendall_iterator(struct sctp_inpcb *inp, struct sctp_tcb *stcb, void *ptr, u_int32_t val) 4618 1.1.2.2 skrll { 4619 1.1.2.2 skrll struct sctp_copy_all *ca; 4620 1.1.2.2 skrll struct mbuf *m; 4621 1.1.2.2 skrll int turned_on_nonblock=0, ret; 4622 1.1.2.2 skrll 4623 1.1.2.2 skrll ca = (struct sctp_copy_all *)ptr; 4624 1.1.2.2 skrll if (ca->m == NULL) { 4625 1.1.2.2 skrll return; 4626 1.1.2.2 skrll } 4627 1.1.2.2 skrll if (ca->inp != inp) { 4628 1.1.2.2 skrll /* TSNH */ 4629 1.1.2.2 skrll return; 4630 1.1.2.2 skrll } 4631 1.1.2.2 skrll m = sctp_copy_mbufchain(ca->m, NULL); 4632 1.1.2.2 skrll if (m == NULL) { 4633 1.1.2.2 skrll /* can't copy so we are done */ 4634 1.1.2.2 skrll ca->cnt_failed++; 4635 1.1.2.2 skrll return; 4636 1.1.2.2 skrll } 4637 1.1.2.2 skrll if ((stcb->sctp_socket->so_state & SS_NBIO) == 0) { 4638 1.1.2.2 skrll /* we have to do this non-blocking */ 4639 1.1.2.2 skrll turned_on_nonblock = 1; 4640 1.1.2.2 skrll stcb->sctp_socket->so_state |= SS_NBIO; 4641 1.1.2.2 skrll } 4642 1.1.2.2 skrll ret = sctp_msg_append(stcb, stcb->asoc.primary_destination, m, &ca->sndrcv, 0); 4643 1.1.2.2 skrll if (turned_on_nonblock) { 4644 1.1.2.2 skrll /* we turned on non-blocking so turn it off */ 4645 1.1.2.2 skrll stcb->sctp_socket->so_state &= ~SS_NBIO; 4646 1.1.2.2 skrll } 4647 1.1.2.2 skrll if (ret) { 4648 1.1.2.2 skrll ca->cnt_failed++; 4649 1.1.2.2 skrll } else { 4650 1.1.2.2 skrll ca->cnt_sent++; 4651 1.1.2.2 skrll } 4652 1.1.2.2 skrll } 4653 1.1.2.2 skrll 4654 1.1.2.2 skrll static void 4655 1.1.2.2 skrll sctp_sendall_completes(void *ptr, u_int32_t val) 4656 1.1.2.2 skrll { 4657 1.1.2.2 skrll struct sctp_copy_all *ca; 4658 1.1.2.2 skrll ca = (struct sctp_copy_all *)ptr; 4659 1.1.2.2 skrll /* Do a notify here? 4660 1.1.2.2 skrll * Kacheong suggests that the notify 4661 1.1.2.2 skrll * be done at the send time.. so you would 4662 1.1.2.2 skrll * push up a notification if any send failed. 4663 1.1.2.2 skrll * Don't know if this is feasable since the 4664 1.1.2.2 skrll * only failures we have is "memory" related and 4665 1.1.2.2 skrll * if you cannot get an mbuf to send the data 4666 1.1.2.2 skrll * you surely can't get an mbuf to send up 4667 1.1.2.2 skrll * to notify the user you can't send the data :-> 4668 1.1.2.2 skrll */ 4669 1.1.2.2 skrll 4670 1.1.2.2 skrll /* now free everything */ 4671 1.1.2.2 skrll m_freem(ca->m); 4672 1.1.2.2 skrll free(ca, M_PCB); 4673 1.1.2.2 skrll } 4674 1.1.2.2 skrll 4675 1.1.2.2 skrll 4676 1.1.2.2 skrll #define MC_ALIGN(m, len) do { \ 4677 1.1.2.2 skrll (m)->m_data += (MCLBYTES - (len)) & ~(sizeof(long) - 1); \ 4678 1.1.2.2 skrll } while (0) 4679 1.1.2.2 skrll 4680 1.1.2.2 skrll 4681 1.1.2.2 skrll 4682 1.1.2.2 skrll static struct mbuf * 4683 1.1.2.2 skrll sctp_copy_out_all(struct uio *uio, int len) 4684 1.1.2.2 skrll { 4685 1.1.2.2 skrll struct mbuf *ret, *at; 4686 1.1.2.2 skrll int left, willcpy, cancpy, error; 4687 1.1.2.2 skrll 4688 1.1.2.2 skrll MGETHDR(ret, M_WAIT, MT_HEADER); 4689 1.1.2.2 skrll if (ret == NULL) { 4690 1.1.2.2 skrll /* TSNH */ 4691 1.1.2.2 skrll return (NULL); 4692 1.1.2.2 skrll } 4693 1.1.2.2 skrll left = len; 4694 1.1.2.2 skrll ret->m_len = 0; 4695 1.1.2.2 skrll ret->m_pkthdr.len = len; 4696 1.1.2.2 skrll MCLGET(ret, M_WAIT); 4697 1.1.2.2 skrll if (ret == NULL) { 4698 1.1.2.2 skrll return (NULL); 4699 1.1.2.2 skrll } 4700 1.1.2.2 skrll if ((ret->m_flags & M_EXT) == 0) { 4701 1.1.2.2 skrll m_freem (ret); 4702 1.1.2.2 skrll return (NULL); 4703 1.1.2.2 skrll } 4704 1.1.2.2 skrll cancpy = M_TRAILINGSPACE(ret); 4705 1.1.2.2 skrll willcpy = min(cancpy, left); 4706 1.1.2.2 skrll at = ret; 4707 1.1.2.2 skrll while (left > 0) { 4708 1.1.2.2 skrll /* Align data to the end */ 4709 1.1.2.2 skrll MC_ALIGN(at, willcpy); 4710 1.1.2.2 skrll error = uiomove(mtod(at, void *), willcpy, uio); 4711 1.1.2.2 skrll if (error) { 4712 1.1.2.2 skrll err_out_now: 4713 1.1.2.2 skrll m_freem(ret); 4714 1.1.2.2 skrll return (NULL); 4715 1.1.2.2 skrll } 4716 1.1.2.2 skrll at->m_len = willcpy; 4717 1.1.2.2 skrll at->m_nextpkt = at->m_next = 0; 4718 1.1.2.2 skrll left -= willcpy; 4719 1.1.2.2 skrll if (left > 0) { 4720 1.1.2.2 skrll MGET(at->m_next, M_WAIT, MT_DATA); 4721 1.1.2.2 skrll if (at->m_next == NULL) { 4722 1.1.2.2 skrll goto err_out_now; 4723 1.1.2.2 skrll } 4724 1.1.2.2 skrll at = at->m_next; 4725 1.1.2.2 skrll at->m_len = 0; 4726 1.1.2.2 skrll MCLGET(at, M_WAIT); 4727 1.1.2.2 skrll if (at == NULL) { 4728 1.1.2.2 skrll goto err_out_now; 4729 1.1.2.2 skrll } 4730 1.1.2.2 skrll if ((at->m_flags & M_EXT) == 0) { 4731 1.1.2.2 skrll goto err_out_now; 4732 1.1.2.2 skrll } 4733 1.1.2.2 skrll cancpy = M_TRAILINGSPACE(at); 4734 1.1.2.2 skrll willcpy = min(cancpy, left); 4735 1.1.2.2 skrll } 4736 1.1.2.2 skrll } 4737 1.1.2.2 skrll return (ret); 4738 1.1.2.2 skrll } 4739 1.1.2.2 skrll 4740 1.1.2.2 skrll static int 4741 1.1.2.2 skrll sctp_sendall (struct sctp_inpcb *inp, struct uio *uio, struct mbuf *m, struct sctp_sndrcvinfo *srcv) 4742 1.1.2.2 skrll { 4743 1.1.2.2 skrll int ret; 4744 1.1.2.2 skrll struct sctp_copy_all *ca; 4745 1.1.2.2 skrll ca = malloc(sizeof(struct sctp_copy_all), M_PCB, M_WAIT); 4746 1.1.2.2 skrll if (ca == NULL) { 4747 1.1.2.2 skrll m_freem(m); 4748 1.1.2.2 skrll return (ENOMEM); 4749 1.1.2.2 skrll } 4750 1.1.2.2 skrll memset (ca, 0, sizeof(struct sctp_copy_all)); 4751 1.1.2.2 skrll 4752 1.1.2.2 skrll ca->inp = inp; 4753 1.1.2.2 skrll ca->sndrcv = *srcv; 4754 1.1.2.2 skrll /* take off the sendall flag, it would 4755 1.1.2.2 skrll * be bad if we failed to do this :-0 4756 1.1.2.2 skrll */ 4757 1.1.2.2 skrll ca->sndrcv.sinfo_flags &= ~MSG_SENDALL; 4758 1.1.2.2 skrll 4759 1.1.2.2 skrll /* get length and mbuf chain */ 4760 1.1.2.2 skrll if (uio) { 4761 1.1.2.2 skrll ca->sndlen = uio->uio_resid; 4762 1.1.2.2 skrll ca->m = sctp_copy_out_all(uio, ca->sndlen); 4763 1.1.2.2 skrll if (ca->m == NULL) { 4764 1.1.2.2 skrll free(ca, M_PCB); 4765 1.1.2.2 skrll return (ENOMEM); 4766 1.1.2.2 skrll } 4767 1.1.2.2 skrll } else { 4768 1.1.2.2 skrll if ((m->m_flags & M_PKTHDR) == 0) { 4769 1.1.2.2 skrll ca->sndlen = 0; 4770 1.1.2.2 skrll while(m) { 4771 1.1.2.2 skrll ca->sndlen += m->m_len; 4772 1.1.2.2 skrll m = m->m_next; 4773 1.1.2.2 skrll } 4774 1.1.2.2 skrll } else { 4775 1.1.2.2 skrll ca->sndlen = m->m_pkthdr.len; 4776 1.1.2.2 skrll } 4777 1.1.2.2 skrll ca->m = m; 4778 1.1.2.2 skrll } 4779 1.1.2.2 skrll 4780 1.1.2.2 skrll ret = sctp_initiate_iterator(sctp_sendall_iterator, SCTP_PCB_ANY_FLAGS, SCTP_ASOC_ANY_STATE, 4781 1.1.2.2 skrll (void *)ca, 0, sctp_sendall_completes, inp); 4782 1.1.2.2 skrll if (ret) { 4783 1.1.2.2 skrll #ifdef SCTP_DEBUG 4784 1.1.2.2 skrll printf("Failed to initate iterator to takeover associations\n"); 4785 1.1.2.2 skrll #endif 4786 1.1.2.2 skrll free(ca, M_PCB); 4787 1.1.2.2 skrll return (EFAULT); 4788 1.1.2.2 skrll 4789 1.1.2.2 skrll } 4790 1.1.2.2 skrll return (0); 4791 1.1.2.2 skrll } 4792 1.1.2.2 skrll 4793 1.1.2.2 skrll 4794 1.1.2.2 skrll void 4795 1.1.2.2 skrll sctp_toss_old_cookies(struct sctp_association *asoc) 4796 1.1.2.2 skrll { 4797 1.1.2.2 skrll struct sctp_tmit_chunk *chk, *nchk; 4798 1.1.2.2 skrll chk = TAILQ_FIRST(&asoc->control_send_queue); 4799 1.1.2.2 skrll while (chk) { 4800 1.1.2.2 skrll nchk = TAILQ_NEXT(chk, sctp_next); 4801 1.1.2.2 skrll if (chk->rec.chunk_id == SCTP_COOKIE_ECHO) { 4802 1.1.2.2 skrll TAILQ_REMOVE(&asoc->control_send_queue, chk, sctp_next); 4803 1.1.2.2 skrll if (chk->data) { 4804 1.1.2.2 skrll sctp_m_freem(chk->data); 4805 1.1.2.2 skrll chk->data = NULL; 4806 1.1.2.2 skrll } 4807 1.1.2.2 skrll asoc->ctrl_queue_cnt--; 4808 1.1.2.2 skrll if (chk->whoTo) 4809 1.1.2.2 skrll sctp_free_remote_addr(chk->whoTo); 4810 1.1.2.2 skrll SCTP_ZONE_FREE(sctppcbinfo.ipi_zone_chunk, chk); 4811 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk--; 4812 1.1.2.2 skrll if ((int)sctppcbinfo.ipi_count_chunk < 0) { 4813 1.1.2.2 skrll panic("Chunk count is negative"); 4814 1.1.2.2 skrll } 4815 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 4816 1.1.2.2 skrll } 4817 1.1.2.2 skrll chk = nchk; 4818 1.1.2.2 skrll } 4819 1.1.2.2 skrll } 4820 1.1.2.2 skrll 4821 1.1.2.2 skrll void 4822 1.1.2.2 skrll sctp_toss_old_asconf(struct sctp_tcb *stcb) 4823 1.1.2.2 skrll { 4824 1.1.2.2 skrll struct sctp_association *asoc; 4825 1.1.2.2 skrll struct sctp_tmit_chunk *chk, *chk_tmp; 4826 1.1.2.2 skrll 4827 1.1.2.2 skrll asoc = &stcb->asoc; 4828 1.1.2.2 skrll for (chk = TAILQ_FIRST(&asoc->control_send_queue); chk != NULL; 4829 1.1.2.2 skrll chk = chk_tmp) { 4830 1.1.2.2 skrll /* get next chk */ 4831 1.1.2.2 skrll chk_tmp = TAILQ_NEXT(chk, sctp_next); 4832 1.1.2.2 skrll /* find SCTP_ASCONF chunk in queue (only one ever in queue) */ 4833 1.1.2.2 skrll if (chk->rec.chunk_id == SCTP_ASCONF) { 4834 1.1.2.2 skrll TAILQ_REMOVE(&asoc->control_send_queue, chk, sctp_next); 4835 1.1.2.2 skrll if (chk->data) { 4836 1.1.2.2 skrll sctp_m_freem(chk->data); 4837 1.1.2.2 skrll chk->data = NULL; 4838 1.1.2.2 skrll } 4839 1.1.2.2 skrll asoc->ctrl_queue_cnt--; 4840 1.1.2.2 skrll if (chk->whoTo) 4841 1.1.2.2 skrll sctp_free_remote_addr(chk->whoTo); 4842 1.1.2.2 skrll SCTP_ZONE_FREE(sctppcbinfo.ipi_zone_chunk, chk); 4843 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk--; 4844 1.1.2.2 skrll if ((int)sctppcbinfo.ipi_count_chunk < 0) { 4845 1.1.2.2 skrll panic("Chunk count is negative"); 4846 1.1.2.2 skrll } 4847 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 4848 1.1.2.2 skrll } 4849 1.1.2.2 skrll } 4850 1.1.2.2 skrll } 4851 1.1.2.2 skrll 4852 1.1.2.2 skrll 4853 1.1.2.2 skrll static void 4854 1.1.2.2 skrll sctp_clean_up_datalist(struct sctp_tcb *stcb, 4855 1.1.2.2 skrll struct sctp_association *asoc, 4856 1.1.2.2 skrll struct sctp_tmit_chunk **data_list, 4857 1.1.2.2 skrll int bundle_at, 4858 1.1.2.2 skrll struct sctp_nets *net) 4859 1.1.2.2 skrll { 4860 1.1.2.2 skrll int i; 4861 1.1.2.2 skrll for (i = 0; i < bundle_at; i++) { 4862 1.1.2.2 skrll /* off of the send queue */ 4863 1.1.2.2 skrll if (i) { 4864 1.1.2.2 skrll /* Any chunk NOT 0 you zap the time 4865 1.1.2.2 skrll * chunk 0 gets zapped or set based on 4866 1.1.2.2 skrll * if a RTO measurment is needed. 4867 1.1.2.2 skrll */ 4868 1.1.2.2 skrll data_list[i]->do_rtt = 0; 4869 1.1.2.2 skrll } 4870 1.1.2.2 skrll /* record time */ 4871 1.1.2.2 skrll data_list[i]->sent_rcv_time = net->last_sent_time; 4872 1.1.2.2 skrll TAILQ_REMOVE(&asoc->send_queue, 4873 1.1.2.2 skrll data_list[i], 4874 1.1.2.2 skrll sctp_next); 4875 1.1.2.2 skrll /* on to the sent queue */ 4876 1.1.2.2 skrll TAILQ_INSERT_TAIL(&asoc->sent_queue, 4877 1.1.2.2 skrll data_list[i], 4878 1.1.2.2 skrll sctp_next); 4879 1.1.2.2 skrll /* This does not lower until the cum-ack passes it */ 4880 1.1.2.2 skrll asoc->sent_queue_cnt++; 4881 1.1.2.2 skrll asoc->send_queue_cnt--; 4882 1.1.2.2 skrll if ((asoc->peers_rwnd <= 0) && 4883 1.1.2.2 skrll (asoc->total_flight == 0) && 4884 1.1.2.2 skrll (bundle_at == 1)) { 4885 1.1.2.2 skrll /* Mark the chunk as being a window probe */ 4886 1.1.2.2 skrll #ifdef SCTP_DEBUG 4887 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 4888 1.1.2.2 skrll printf("WINDOW PROBE SET\n"); 4889 1.1.2.2 skrll } 4890 1.1.2.2 skrll #endif 4891 1.1.2.2 skrll sctp_pegs[SCTP_WINDOW_PROBES]++; 4892 1.1.2.2 skrll data_list[i]->rec.data.state_flags |= SCTP_WINDOW_PROBE; 4893 1.1.2.2 skrll } else { 4894 1.1.2.2 skrll data_list[i]->rec.data.state_flags &= ~SCTP_WINDOW_PROBE; 4895 1.1.2.2 skrll } 4896 1.1.2.2 skrll #ifdef SCTP_AUDITING_ENABLED 4897 1.1.2.2 skrll sctp_audit_log(0xC2, 3); 4898 1.1.2.2 skrll #endif 4899 1.1.2.2 skrll data_list[i]->sent = SCTP_DATAGRAM_SENT; 4900 1.1.2.2 skrll data_list[i]->snd_count = 1; 4901 1.1.2.2 skrll net->flight_size += data_list[i]->book_size; 4902 1.1.2.2 skrll asoc->total_flight += data_list[i]->book_size; 4903 1.1.2.2 skrll asoc->total_flight_count++; 4904 1.1.2.2 skrll #ifdef SCTP_LOG_RWND 4905 1.1.2.2 skrll sctp_log_rwnd(SCTP_DECREASE_PEER_RWND, 4906 1.1.2.2 skrll asoc->peers_rwnd , data_list[i]->send_size, sctp_peer_chunk_oh); 4907 1.1.2.2 skrll #endif 4908 1.1.2.2 skrll asoc->peers_rwnd = sctp_sbspace_sub(asoc->peers_rwnd, 4909 1.1.2.2 skrll (u_int32_t)(data_list[i]->send_size + sctp_peer_chunk_oh)); 4910 1.1.2.2 skrll if (asoc->peers_rwnd < stcb->sctp_ep->sctp_ep.sctp_sws_sender) { 4911 1.1.2.2 skrll /* SWS sender side engages */ 4912 1.1.2.2 skrll asoc->peers_rwnd = 0; 4913 1.1.2.2 skrll } 4914 1.1.2.2 skrll } 4915 1.1.2.2 skrll } 4916 1.1.2.2 skrll 4917 1.1.2.2 skrll static void 4918 1.1.2.2 skrll sctp_clean_up_ctl(struct sctp_association *asoc) 4919 1.1.2.2 skrll { 4920 1.1.2.2 skrll struct sctp_tmit_chunk *chk, *nchk; 4921 1.1.2.2 skrll for (chk = TAILQ_FIRST(&asoc->control_send_queue); 4922 1.1.2.2 skrll chk; chk = nchk) { 4923 1.1.2.2 skrll nchk = TAILQ_NEXT(chk, sctp_next); 4924 1.1.2.2 skrll if ((chk->rec.chunk_id == SCTP_SELECTIVE_ACK) || 4925 1.1.2.2 skrll (chk->rec.chunk_id == SCTP_HEARTBEAT_REQUEST) || 4926 1.1.2.2 skrll (chk->rec.chunk_id == SCTP_HEARTBEAT_ACK) || 4927 1.1.2.2 skrll (chk->rec.chunk_id == SCTP_SHUTDOWN) || 4928 1.1.2.2 skrll (chk->rec.chunk_id == SCTP_SHUTDOWN_ACK) || 4929 1.1.2.2 skrll (chk->rec.chunk_id == SCTP_OPERATION_ERROR) || 4930 1.1.2.2 skrll (chk->rec.chunk_id == SCTP_PACKET_DROPPED) || 4931 1.1.2.2 skrll (chk->rec.chunk_id == SCTP_COOKIE_ACK) || 4932 1.1.2.2 skrll (chk->rec.chunk_id == SCTP_ECN_CWR) || 4933 1.1.2.2 skrll (chk->rec.chunk_id == SCTP_ASCONF_ACK)) { 4934 1.1.2.2 skrll /* Stray chunks must be cleaned up */ 4935 1.1.2.2 skrll clean_up_anyway: 4936 1.1.2.2 skrll TAILQ_REMOVE(&asoc->control_send_queue, chk, sctp_next); 4937 1.1.2.2 skrll if (chk->data) { 4938 1.1.2.2 skrll sctp_m_freem(chk->data); 4939 1.1.2.2 skrll chk->data = NULL; 4940 1.1.2.2 skrll } 4941 1.1.2.2 skrll asoc->ctrl_queue_cnt--; 4942 1.1.2.2 skrll sctp_free_remote_addr(chk->whoTo); 4943 1.1.2.2 skrll SCTP_ZONE_FREE(sctppcbinfo.ipi_zone_chunk, chk); 4944 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk--; 4945 1.1.2.2 skrll if ((int)sctppcbinfo.ipi_count_chunk < 0) { 4946 1.1.2.2 skrll panic("Chunk count is negative"); 4947 1.1.2.2 skrll } 4948 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 4949 1.1.2.2 skrll } else if (chk->rec.chunk_id == SCTP_STREAM_RESET) { 4950 1.1.2.2 skrll struct sctp_stream_reset_req *strreq; 4951 1.1.2.2 skrll /* special handling, we must look into the param */ 4952 1.1.2.2 skrll strreq = mtod(chk->data, struct sctp_stream_reset_req *); 4953 1.1.2.2 skrll if (strreq->sr_req.ph.param_type == ntohs(SCTP_STR_RESET_RESPONSE)) { 4954 1.1.2.2 skrll goto clean_up_anyway; 4955 1.1.2.2 skrll } 4956 1.1.2.2 skrll } 4957 1.1.2.2 skrll } 4958 1.1.2.2 skrll } 4959 1.1.2.2 skrll 4960 1.1.2.2 skrll static int 4961 1.1.2.2 skrll sctp_move_to_outqueue(struct sctp_tcb *stcb, 4962 1.1.2.2 skrll struct sctp_stream_out *strq) 4963 1.1.2.2 skrll { 4964 1.1.2.2 skrll /* Move from the stream to the send_queue keeping track of the total */ 4965 1.1.2.2 skrll struct sctp_association *asoc; 4966 1.1.2.2 skrll int tot_moved = 0; 4967 1.1.2.2 skrll int failed = 0; 4968 1.1.2.2 skrll int padval; 4969 1.1.2.2 skrll struct sctp_tmit_chunk *chk, *nchk; 4970 1.1.2.2 skrll struct sctp_data_chunk *dchkh; 4971 1.1.2.2 skrll struct sctpchunk_listhead tmp; 4972 1.1.2.2 skrll struct mbuf *orig; 4973 1.1.2.2 skrll 4974 1.1.2.2 skrll asoc = &stcb->asoc; 4975 1.1.2.2 skrll TAILQ_INIT(&tmp); 4976 1.1.2.2 skrll chk = TAILQ_FIRST(&strq->outqueue); 4977 1.1.2.2 skrll while (chk) { 4978 1.1.2.2 skrll nchk = TAILQ_NEXT(chk, sctp_next); 4979 1.1.2.2 skrll /* now put in the chunk header */ 4980 1.1.2.2 skrll orig = chk->data; 4981 1.1.2.2 skrll M_PREPEND(chk->data, sizeof(struct sctp_data_chunk), M_DONTWAIT); 4982 1.1.2.2 skrll if (chk->data == NULL) { 4983 1.1.2.2 skrll /* HELP */ 4984 1.1.2.2 skrll failed++; 4985 1.1.2.2 skrll break; 4986 1.1.2.2 skrll } 4987 1.1.2.2 skrll if (orig != chk->data) { 4988 1.1.2.2 skrll /* A new mbuf was added, account for it */ 4989 1.1.2.2 skrll if ((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) || 4990 1.1.2.2 skrll (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_IN_TCPPOOL)) { 4991 1.1.2.2 skrll stcb->sctp_socket->so_snd.sb_mbcnt += MSIZE; 4992 1.1.2.2 skrll } 4993 1.1.2.2 skrll #ifdef SCTP_MBCNT_LOGGING 4994 1.1.2.2 skrll sctp_log_mbcnt(SCTP_LOG_MBCNT_INCREASE, 4995 1.1.2.2 skrll asoc->total_output_queue_size, 4996 1.1.2.2 skrll 0, 4997 1.1.2.2 skrll asoc->total_output_mbuf_queue_size, 4998 1.1.2.2 skrll MSIZE); 4999 1.1.2.2 skrll #endif 5000 1.1.2.2 skrll stcb->asoc.total_output_mbuf_queue_size += MSIZE; 5001 1.1.2.2 skrll chk->mbcnt += MSIZE; 5002 1.1.2.2 skrll } 5003 1.1.2.2 skrll chk->send_size += sizeof(struct sctp_data_chunk); 5004 1.1.2.2 skrll /* This should NOT have to do anything, but 5005 1.1.2.2 skrll * I would rather be cautious 5006 1.1.2.2 skrll */ 5007 1.1.2.2 skrll if (!failed && ((size_t)chk->data->m_len < sizeof(struct sctp_data_chunk))) { 5008 1.1.2.2 skrll m_pullup(chk->data, sizeof(struct sctp_data_chunk)); 5009 1.1.2.2 skrll if (chk->data == NULL) { 5010 1.1.2.2 skrll failed++; 5011 1.1.2.2 skrll break; 5012 1.1.2.2 skrll } 5013 1.1.2.2 skrll } 5014 1.1.2.2 skrll dchkh = mtod(chk->data, struct sctp_data_chunk *); 5015 1.1.2.2 skrll dchkh->ch.chunk_length = htons(chk->send_size); 5016 1.1.2.2 skrll /* Chunks must be padded to even word boundary */ 5017 1.1.2.2 skrll padval = chk->send_size % 4; 5018 1.1.2.2 skrll if (padval) { 5019 1.1.2.2 skrll /* For fragmented messages this should not 5020 1.1.2.2 skrll * run except possibly on the last chunk 5021 1.1.2.2 skrll */ 5022 1.1.2.2 skrll if (sctp_pad_lastmbuf(chk->data, (4 - padval))) { 5023 1.1.2.2 skrll /* we are in big big trouble no mbufs :< */ 5024 1.1.2.2 skrll failed++; 5025 1.1.2.2 skrll break; 5026 1.1.2.2 skrll } 5027 1.1.2.2 skrll chk->send_size += (4 - padval); 5028 1.1.2.2 skrll } 5029 1.1.2.2 skrll /* pull from stream queue */ 5030 1.1.2.2 skrll TAILQ_REMOVE(&strq->outqueue, chk, sctp_next); 5031 1.1.2.2 skrll asoc->stream_queue_cnt--; 5032 1.1.2.2 skrll TAILQ_INSERT_TAIL(&tmp, chk, sctp_next); 5033 1.1.2.2 skrll /* add it in to the size of moved chunks */ 5034 1.1.2.2 skrll if (chk->rec.data.rcv_flags & SCTP_DATA_LAST_FRAG) { 5035 1.1.2.2 skrll /* we pull only one message */ 5036 1.1.2.2 skrll break; 5037 1.1.2.2 skrll } 5038 1.1.2.2 skrll chk = nchk; 5039 1.1.2.2 skrll } 5040 1.1.2.2 skrll if (failed) { 5041 1.1.2.2 skrll /* Gak, we just lost the user message */ 5042 1.1.2.2 skrll chk = TAILQ_FIRST(&tmp); 5043 1.1.2.2 skrll while (chk) { 5044 1.1.2.2 skrll nchk = TAILQ_NEXT(chk, sctp_next); 5045 1.1.2.2 skrll TAILQ_REMOVE(&tmp, chk, sctp_next); 5046 1.1.2.2 skrll 5047 1.1.2.2 skrll sctp_ulp_notify(SCTP_NOTIFY_DG_FAIL, stcb, 5048 1.1.2.2 skrll (SCTP_NOTIFY_DATAGRAM_UNSENT|SCTP_INTERNAL_ERROR), 5049 1.1.2.2 skrll chk); 5050 1.1.2.2 skrll 5051 1.1.2.2 skrll if (chk->data) { 5052 1.1.2.2 skrll sctp_m_freem(chk->data); 5053 1.1.2.2 skrll chk->data = NULL; 5054 1.1.2.2 skrll } 5055 1.1.2.2 skrll if (chk->whoTo) { 5056 1.1.2.2 skrll sctp_free_remote_addr(chk->whoTo); 5057 1.1.2.2 skrll chk->whoTo = NULL; 5058 1.1.2.2 skrll } 5059 1.1.2.2 skrll SCTP_ZONE_FREE(sctppcbinfo.ipi_zone_chunk, chk); 5060 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk--; 5061 1.1.2.2 skrll if ((int)sctppcbinfo.ipi_count_chunk < 0) { 5062 1.1.2.2 skrll panic("Chunk count is negative"); 5063 1.1.2.2 skrll } 5064 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 5065 1.1.2.2 skrll chk = nchk; 5066 1.1.2.2 skrll } 5067 1.1.2.2 skrll return (0); 5068 1.1.2.2 skrll } 5069 1.1.2.2 skrll /* now pull them off of temp wheel */ 5070 1.1.2.2 skrll chk = TAILQ_FIRST(&tmp); 5071 1.1.2.2 skrll while (chk) { 5072 1.1.2.2 skrll nchk = TAILQ_NEXT(chk, sctp_next); 5073 1.1.2.2 skrll /* insert on send_queue */ 5074 1.1.2.2 skrll TAILQ_REMOVE(&tmp, chk, sctp_next); 5075 1.1.2.2 skrll TAILQ_INSERT_TAIL(&asoc->send_queue, chk, sctp_next); 5076 1.1.2.2 skrll asoc->send_queue_cnt++; 5077 1.1.2.2 skrll /* assign TSN */ 5078 1.1.2.2 skrll chk->rec.data.TSN_seq = asoc->sending_seq++; 5079 1.1.2.2 skrll 5080 1.1.2.2 skrll dchkh = mtod(chk->data, struct sctp_data_chunk *); 5081 1.1.2.2 skrll /* Put the rest of the things in place now. Size 5082 1.1.2.2 skrll * was done earlier in previous loop prior to 5083 1.1.2.2 skrll * padding. 5084 1.1.2.2 skrll */ 5085 1.1.2.2 skrll dchkh->ch.chunk_type = SCTP_DATA; 5086 1.1.2.2 skrll dchkh->ch.chunk_flags = chk->rec.data.rcv_flags; 5087 1.1.2.2 skrll dchkh->dp.tsn = htonl(chk->rec.data.TSN_seq); 5088 1.1.2.2 skrll dchkh->dp.stream_id = htons(strq->stream_no); 5089 1.1.2.2 skrll dchkh->dp.stream_sequence = htons(chk->rec.data.stream_seq); 5090 1.1.2.2 skrll dchkh->dp.protocol_id = chk->rec.data.payloadtype; 5091 1.1.2.2 skrll /* total count moved */ 5092 1.1.2.2 skrll tot_moved += chk->send_size; 5093 1.1.2.2 skrll chk = nchk; 5094 1.1.2.2 skrll } 5095 1.1.2.2 skrll return (tot_moved); 5096 1.1.2.2 skrll } 5097 1.1.2.2 skrll 5098 1.1.2.2 skrll static void 5099 1.1.2.2 skrll sctp_fill_outqueue(struct sctp_tcb *stcb, 5100 1.1.2.2 skrll struct sctp_nets *net) 5101 1.1.2.2 skrll { 5102 1.1.2.2 skrll struct sctp_association *asoc; 5103 1.1.2.2 skrll struct sctp_tmit_chunk *chk; 5104 1.1.2.2 skrll struct sctp_stream_out *strq, *strqn; 5105 1.1.2.2 skrll int mtu_fromwheel, goal_mtu; 5106 1.1.2.2 skrll unsigned int moved, seenend, cnt_mvd=0; 5107 1.1.2.2 skrll 5108 1.1.2.2 skrll asoc = &stcb->asoc; 5109 1.1.2.2 skrll /* Attempt to move at least 1 MTU's worth 5110 1.1.2.2 skrll * onto the wheel for each destination address 5111 1.1.2.2 skrll */ 5112 1.1.2.2 skrll goal_mtu = net->cwnd - net->flight_size; 5113 1.1.2.2 skrll if ((unsigned int)goal_mtu < net->mtu) { 5114 1.1.2.2 skrll goal_mtu = net->mtu; 5115 1.1.2.2 skrll } 5116 1.1.2.2 skrll if (sctp_pegs[SCTP_MOVED_MTU] < (unsigned int)goal_mtu) { 5117 1.1.2.2 skrll sctp_pegs[SCTP_MOVED_MTU] = goal_mtu; 5118 1.1.2.2 skrll } 5119 1.1.2.2 skrll seenend = moved = mtu_fromwheel = 0; 5120 1.1.2.2 skrll if (asoc->last_out_stream == NULL) { 5121 1.1.2.2 skrll strq = asoc->last_out_stream = TAILQ_FIRST(&asoc->out_wheel); 5122 1.1.2.2 skrll if (asoc->last_out_stream == NULL) { 5123 1.1.2.2 skrll /* huh nothing on the wheel, TSNH */ 5124 1.1.2.2 skrll return; 5125 1.1.2.2 skrll } 5126 1.1.2.2 skrll goto done_it; 5127 1.1.2.2 skrll } 5128 1.1.2.2 skrll strq = TAILQ_NEXT(asoc->last_out_stream, next_spoke); 5129 1.1.2.2 skrll done_it: 5130 1.1.2.2 skrll if (strq == NULL) { 5131 1.1.2.2 skrll asoc->last_out_stream = TAILQ_FIRST(&asoc->out_wheel); 5132 1.1.2.2 skrll } 5133 1.1.2.2 skrll while (mtu_fromwheel < goal_mtu) { 5134 1.1.2.2 skrll if (strq == NULL) { 5135 1.1.2.2 skrll if (seenend == 0) { 5136 1.1.2.2 skrll seenend = 1; 5137 1.1.2.2 skrll strq = TAILQ_FIRST(&asoc->out_wheel); 5138 1.1.2.2 skrll } else if ((moved == 0) && (seenend)) { 5139 1.1.2.2 skrll /* none left on the wheel */ 5140 1.1.2.2 skrll sctp_pegs[SCTP_MOVED_NLEF]++; 5141 1.1.2.2 skrll return; 5142 1.1.2.2 skrll } else if (moved) { 5143 1.1.2.2 skrll /* 5144 1.1.2.2 skrll * clear the flags and rotate back through 5145 1.1.2.2 skrll * again 5146 1.1.2.2 skrll */ 5147 1.1.2.2 skrll moved = 0; 5148 1.1.2.2 skrll seenend = 0; 5149 1.1.2.2 skrll strq = TAILQ_FIRST(&asoc->out_wheel); 5150 1.1.2.2 skrll } 5151 1.1.2.2 skrll if (strq == NULL) 5152 1.1.2.2 skrll break; 5153 1.1.2.2 skrll continue; 5154 1.1.2.2 skrll } 5155 1.1.2.2 skrll strqn = TAILQ_NEXT(strq, next_spoke); 5156 1.1.2.2 skrll if ((chk = TAILQ_FIRST(&strq->outqueue)) == NULL) { 5157 1.1.2.2 skrll /* none left on this queue, prune a spoke? */ 5158 1.1.2.2 skrll sctp_remove_from_wheel(asoc, strq); 5159 1.1.2.2 skrll if (strq == asoc->last_out_stream) { 5160 1.1.2.2 skrll /* the last one we used went off the wheel */ 5161 1.1.2.2 skrll asoc->last_out_stream = NULL; 5162 1.1.2.2 skrll } 5163 1.1.2.2 skrll strq = strqn; 5164 1.1.2.2 skrll continue; 5165 1.1.2.2 skrll } 5166 1.1.2.2 skrll if (chk->whoTo != net) { 5167 1.1.2.2 skrll /* Skip this stream, first one on stream 5168 1.1.2.2 skrll * does not head to our current destination. 5169 1.1.2.2 skrll */ 5170 1.1.2.2 skrll strq = strqn; 5171 1.1.2.2 skrll continue; 5172 1.1.2.2 skrll } 5173 1.1.2.2 skrll mtu_fromwheel += sctp_move_to_outqueue(stcb, strq); 5174 1.1.2.2 skrll cnt_mvd++; 5175 1.1.2.2 skrll moved++; 5176 1.1.2.2 skrll asoc->last_out_stream = strq; 5177 1.1.2.2 skrll strq = strqn; 5178 1.1.2.2 skrll } 5179 1.1.2.2 skrll sctp_pegs[SCTP_MOVED_MAX]++; 5180 1.1.2.2 skrll #ifdef SCTP_DEBUG 5181 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 5182 1.1.2.2 skrll printf("Ok we moved %d chunks to send queue\n", 5183 1.1.2.2 skrll moved); 5184 1.1.2.2 skrll } 5185 1.1.2.2 skrll #endif 5186 1.1.2.2 skrll if (sctp_pegs[SCTP_MOVED_QMAX] < cnt_mvd) { 5187 1.1.2.2 skrll sctp_pegs[SCTP_MOVED_QMAX] = cnt_mvd; 5188 1.1.2.2 skrll } 5189 1.1.2.2 skrll } 5190 1.1.2.2 skrll 5191 1.1.2.2 skrll void 5192 1.1.2.2 skrll sctp_fix_ecn_echo(struct sctp_association *asoc) 5193 1.1.2.2 skrll { 5194 1.1.2.2 skrll struct sctp_tmit_chunk *chk; 5195 1.1.2.2 skrll TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) { 5196 1.1.2.2 skrll if (chk->rec.chunk_id == SCTP_ECN_ECHO) { 5197 1.1.2.2 skrll chk->sent = SCTP_DATAGRAM_UNSENT; 5198 1.1.2.2 skrll } 5199 1.1.2.2 skrll } 5200 1.1.2.2 skrll } 5201 1.1.2.2 skrll 5202 1.1.2.2 skrll static void 5203 1.1.2.2 skrll sctp_move_to_an_alt(struct sctp_tcb *stcb, 5204 1.1.2.2 skrll struct sctp_association *asoc, 5205 1.1.2.2 skrll struct sctp_nets *net) 5206 1.1.2.2 skrll { 5207 1.1.2.2 skrll struct sctp_tmit_chunk *chk; 5208 1.1.2.2 skrll struct sctp_nets *a_net; 5209 1.1.2.2 skrll a_net = sctp_find_alternate_net(stcb, net); 5210 1.1.2.2 skrll if ((a_net != net) && 5211 1.1.2.2 skrll ((a_net->dest_state & SCTP_ADDR_REACHABLE) == SCTP_ADDR_REACHABLE)) { 5212 1.1.2.2 skrll /* 5213 1.1.2.2 skrll * We only proceed if a valid alternate is found that is 5214 1.1.2.2 skrll * not this one and is reachable. Here we must move all 5215 1.1.2.2 skrll * chunks queued in the send queue off of the destination 5216 1.1.2.2 skrll * address to our alternate. 5217 1.1.2.2 skrll */ 5218 1.1.2.2 skrll TAILQ_FOREACH(chk, &asoc->send_queue, sctp_next) { 5219 1.1.2.2 skrll if (chk->whoTo == net) { 5220 1.1.2.2 skrll /* Move the chunk to our alternate */ 5221 1.1.2.2 skrll sctp_free_remote_addr(chk->whoTo); 5222 1.1.2.2 skrll chk->whoTo = a_net; 5223 1.1.2.2 skrll a_net->ref_count++; 5224 1.1.2.2 skrll } 5225 1.1.2.2 skrll } 5226 1.1.2.2 skrll } 5227 1.1.2.2 skrll } 5228 1.1.2.2 skrll 5229 1.1.2.2 skrll static int sctp_from_user_send=0; 5230 1.1.2.2 skrll 5231 1.1.2.2 skrll static int 5232 1.1.2.2 skrll sctp_med_chunk_output(struct sctp_inpcb *inp, 5233 1.1.2.2 skrll struct sctp_tcb *stcb, 5234 1.1.2.2 skrll struct sctp_association *asoc, 5235 1.1.2.2 skrll int *num_out, 5236 1.1.2.2 skrll int *reason_code, 5237 1.1.2.2 skrll int control_only, int *cwnd_full, int from_where, 5238 1.1.2.2 skrll struct timeval *now, int *now_filled) 5239 1.1.2.2 skrll { 5240 1.1.2.2 skrll /* 5241 1.1.2.2 skrll * Ok this is the generic chunk service queue. 5242 1.1.2.2 skrll * we must do the following: 5243 1.1.2.2 skrll * - Service the stream queue that is next, moving any message 5244 1.1.2.2 skrll * (note I must get a complete message i.e. FIRST/MIDDLE and 5245 1.1.2.2 skrll * LAST to the out queue in one pass) and assigning TSN's 5246 1.1.2.2 skrll * - Check to see if the cwnd/rwnd allows any output, if so we 5247 1.1.2.2 skrll * go ahead and fomulate and send the low level chunks. Making 5248 1.1.2.2 skrll * sure to combine any control in the control chunk queue also. 5249 1.1.2.2 skrll */ 5250 1.1.2.2 skrll struct sctp_nets *net; 5251 1.1.2.2 skrll struct mbuf *outchain; 5252 1.1.2.2 skrll struct sctp_tmit_chunk *chk, *nchk; 5253 1.1.2.2 skrll struct sctphdr *shdr; 5254 1.1.2.2 skrll /* temp arrays for unlinking */ 5255 1.1.2.2 skrll struct sctp_tmit_chunk *data_list[SCTP_MAX_DATA_BUNDLING]; 5256 1.1.2.2 skrll int no_fragmentflg, error; 5257 1.1.2.2 skrll int one_chunk, hbflag; 5258 1.1.2.2 skrll int asconf, cookie, no_out_cnt; 5259 1.1.2.2 skrll int bundle_at, ctl_cnt, no_data_chunks, cwnd_full_ind; 5260 1.1.2.2 skrll unsigned int mtu, r_mtu, omtu; 5261 1.1.2.2 skrll *num_out = 0; 5262 1.1.2.2 skrll cwnd_full_ind = 0; 5263 1.1.2.2 skrll ctl_cnt = no_out_cnt = asconf = cookie = 0; 5264 1.1.2.2 skrll /* 5265 1.1.2.2 skrll * First lets prime the pump. For each destination, if there 5266 1.1.2.2 skrll * is room in the flight size, attempt to pull an MTU's worth 5267 1.1.2.2 skrll * out of the stream queues into the general send_queue 5268 1.1.2.2 skrll */ 5269 1.1.2.2 skrll #ifdef SCTP_AUDITING_ENABLED 5270 1.1.2.2 skrll sctp_audit_log(0xC2, 2); 5271 1.1.2.2 skrll #endif 5272 1.1.2.2 skrll #ifdef SCTP_DEBUG 5273 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 5274 1.1.2.2 skrll printf("***********************\n"); 5275 1.1.2.2 skrll } 5276 1.1.2.2 skrll #endif 5277 1.1.2.2 skrll hbflag = 0; 5278 1.1.2.2 skrll if (control_only) 5279 1.1.2.2 skrll no_data_chunks = 1; 5280 1.1.2.2 skrll else 5281 1.1.2.2 skrll no_data_chunks = 0; 5282 1.1.2.2 skrll 5283 1.1.2.2 skrll /* Nothing to possible to send? */ 5284 1.1.2.2 skrll if (TAILQ_EMPTY(&asoc->control_send_queue) && 5285 1.1.2.2 skrll TAILQ_EMPTY(&asoc->send_queue) && 5286 1.1.2.2 skrll TAILQ_EMPTY(&asoc->out_wheel)) { 5287 1.1.2.2 skrll #ifdef SCTP_DEBUG 5288 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 5289 1.1.2.2 skrll printf("All wheels empty\n"); 5290 1.1.2.2 skrll } 5291 1.1.2.2 skrll #endif 5292 1.1.2.2 skrll return (0); 5293 1.1.2.2 skrll } 5294 1.1.2.2 skrll if (asoc->peers_rwnd <= 0) { 5295 1.1.2.2 skrll /* No room in peers rwnd */ 5296 1.1.2.2 skrll *cwnd_full = 1; 5297 1.1.2.2 skrll *reason_code = 1; 5298 1.1.2.2 skrll if (asoc->total_flight > 0) { 5299 1.1.2.2 skrll /* we are allowed one chunk in flight */ 5300 1.1.2.2 skrll no_data_chunks = 1; 5301 1.1.2.2 skrll sctp_pegs[SCTP_RWND_BLOCKED]++; 5302 1.1.2.2 skrll } 5303 1.1.2.2 skrll } 5304 1.1.2.2 skrll #ifdef SCTP_DEBUG 5305 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 5306 1.1.2.2 skrll printf("Ok we have done the fillup no_data_chunk=%d tf=%d prw:%d\n", 5307 1.1.2.2 skrll (int)no_data_chunks, 5308 1.1.2.2 skrll (int)asoc->total_flight, (int)asoc->peers_rwnd); 5309 1.1.2.2 skrll } 5310 1.1.2.2 skrll #endif 5311 1.1.2.2 skrll TAILQ_FOREACH(net, &asoc->nets, sctp_next) { 5312 1.1.2.2 skrll #ifdef SCTP_DEBUG 5313 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 5314 1.1.2.2 skrll printf("net:%p fs:%d cwnd:%d\n", 5315 1.1.2.2 skrll net, net->flight_size, net->cwnd); 5316 1.1.2.2 skrll } 5317 1.1.2.2 skrll #endif 5318 1.1.2.2 skrll if (net->flight_size >= net->cwnd) { 5319 1.1.2.2 skrll /* skip this network, no room */ 5320 1.1.2.2 skrll cwnd_full_ind++; 5321 1.1.2.2 skrll #ifdef SCTP_DEBUG 5322 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 5323 1.1.2.2 skrll printf("Ok skip fillup->fs:%d > cwnd:%d\n", 5324 1.1.2.2 skrll net->flight_size, 5325 1.1.2.2 skrll net->cwnd); 5326 1.1.2.2 skrll } 5327 1.1.2.2 skrll #endif 5328 1.1.2.2 skrll sctp_pegs[SCTP_CWND_NOFILL]++; 5329 1.1.2.2 skrll continue; 5330 1.1.2.2 skrll } 5331 1.1.2.2 skrll /* 5332 1.1.2.2 skrll * spin through the stream queues moving one message and 5333 1.1.2.2 skrll * assign TSN's as appropriate. 5334 1.1.2.2 skrll */ 5335 1.1.2.2 skrll sctp_fill_outqueue(stcb, net); 5336 1.1.2.2 skrll } 5337 1.1.2.2 skrll *cwnd_full = cwnd_full_ind; 5338 1.1.2.2 skrll /* now service each destination and send out what we can for it */ 5339 1.1.2.2 skrll #ifdef SCTP_DEBUG 5340 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 5341 1.1.2.2 skrll int chk_cnt = 0; 5342 1.1.2.2 skrll TAILQ_FOREACH(chk, &asoc->send_queue, sctp_next) { 5343 1.1.2.2 skrll chk_cnt++; 5344 1.1.2.2 skrll } 5345 1.1.2.2 skrll printf("We have %d chunks on the send_queue\n", chk_cnt); 5346 1.1.2.2 skrll chk_cnt = 0; 5347 1.1.2.2 skrll TAILQ_FOREACH(chk, &asoc->sent_queue, sctp_next) { 5348 1.1.2.2 skrll chk_cnt++; 5349 1.1.2.2 skrll } 5350 1.1.2.2 skrll printf("We have %d chunks on the sent_queue\n", chk_cnt); 5351 1.1.2.2 skrll TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) { 5352 1.1.2.2 skrll chk_cnt++; 5353 1.1.2.2 skrll } 5354 1.1.2.2 skrll printf("We have %d chunks on the control_queue\n", chk_cnt); 5355 1.1.2.2 skrll } 5356 1.1.2.2 skrll #endif 5357 1.1.2.2 skrll /* If we have data to send, and DSACK is running, stop it 5358 1.1.2.2 skrll * and build a SACK to dump on to bundle with output. This 5359 1.1.2.2 skrll * actually MAY make it so the bundling does not occur if 5360 1.1.2.2 skrll * the SACK is big but I think this is ok because basic SACK 5361 1.1.2.2 skrll * space is pre-reserved in our fragmentation size choice. 5362 1.1.2.2 skrll */ 5363 1.1.2.2 skrll if ((TAILQ_FIRST(&asoc->send_queue) != NULL) && 5364 1.1.2.2 skrll (no_data_chunks == 0)) { 5365 1.1.2.2 skrll /* We will be sending something */ 5366 1.1.2.2 skrll if (callout_pending(&stcb->asoc.dack_timer.timer)) { 5367 1.1.2.2 skrll /* Yep a callout is pending */ 5368 1.1.2.2 skrll sctp_timer_stop(SCTP_TIMER_TYPE_RECV, 5369 1.1.2.2 skrll stcb->sctp_ep, 5370 1.1.2.2 skrll stcb, NULL); 5371 1.1.2.2 skrll sctp_send_sack(stcb); 5372 1.1.2.2 skrll } 5373 1.1.2.2 skrll } 5374 1.1.2.2 skrll /* Nothing to send? */ 5375 1.1.2.2 skrll if ((TAILQ_FIRST(&asoc->control_send_queue) == NULL) && 5376 1.1.2.2 skrll (TAILQ_FIRST(&asoc->send_queue) == NULL)) { 5377 1.1.2.2 skrll return (0); 5378 1.1.2.2 skrll } 5379 1.1.2.2 skrll TAILQ_FOREACH(net, &asoc->nets, sctp_next) { 5380 1.1.2.2 skrll /* how much can we send? */ 5381 1.1.2.2 skrll if (net->ref_count < 2) { 5382 1.1.2.2 skrll /* Ref-count of 1 so we cannot have data or control 5383 1.1.2.2 skrll * queued to this address. Skip it. 5384 1.1.2.2 skrll */ 5385 1.1.2.2 skrll continue; 5386 1.1.2.2 skrll } 5387 1.1.2.2 skrll ctl_cnt = bundle_at = 0; 5388 1.1.2.2 skrll outchain = NULL; 5389 1.1.2.2 skrll no_fragmentflg = 1; 5390 1.1.2.2 skrll one_chunk = 0; 5391 1.1.2.2 skrll 5392 1.1.2.2 skrll if (rtcache_validate(&net->ro)) { 5393 1.1.2.2 skrll /* if we have a route and an ifp 5394 1.1.2.2 skrll * check to see if we have room to 5395 1.1.2.2 skrll * send to this guy 5396 1.1.2.2 skrll */ 5397 1.1.2.2 skrll struct ifnet *ifp; 5398 1.1.2.2 skrll ifp = net->ro._ro_rt->rt_ifp; 5399 1.1.2.2 skrll if ((ifp->if_snd.ifq_len + 2) >= ifp->if_snd.ifq_maxlen) { 5400 1.1.2.2 skrll sctp_pegs[SCTP_IFP_QUEUE_FULL]++; 5401 1.1.2.2 skrll #ifdef SCTP_LOG_MAXBURST 5402 1.1.2.2 skrll sctp_log_maxburst(net, ifp->if_snd.ifq_len, ifp->if_snd.ifq_maxlen, SCTP_MAX_IFP_APPLIED); 5403 1.1.2.2 skrll #endif 5404 1.1.2.2 skrll continue; 5405 1.1.2.2 skrll } 5406 1.1.2.2 skrll } 5407 1.1.2.2 skrll if (((struct sockaddr *)&net->ro.ro_sa)->sa_family == AF_INET) { 5408 1.1.2.2 skrll mtu = net->mtu - (sizeof(struct ip) + sizeof(struct sctphdr)); 5409 1.1.2.2 skrll } else { 5410 1.1.2.2 skrll mtu = net->mtu - (sizeof(struct ip6_hdr) + sizeof(struct sctphdr)); 5411 1.1.2.2 skrll } 5412 1.1.2.2 skrll if (mtu > asoc->peers_rwnd) { 5413 1.1.2.2 skrll if (asoc->total_flight > 0) { 5414 1.1.2.2 skrll /* We have a packet in flight somewhere */ 5415 1.1.2.2 skrll r_mtu = asoc->peers_rwnd; 5416 1.1.2.2 skrll } else { 5417 1.1.2.2 skrll /* We are always allowed to send one MTU out */ 5418 1.1.2.2 skrll one_chunk = 1; 5419 1.1.2.2 skrll r_mtu = mtu; 5420 1.1.2.2 skrll } 5421 1.1.2.2 skrll } else { 5422 1.1.2.2 skrll r_mtu = mtu; 5423 1.1.2.2 skrll } 5424 1.1.2.2 skrll #ifdef SCTP_DEBUG 5425 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 5426 1.1.2.2 skrll printf("Ok r_mtu is %d mtu is %d for this net:%p one_chunk:%d\n", 5427 1.1.2.2 skrll r_mtu, mtu, net, one_chunk); 5428 1.1.2.2 skrll } 5429 1.1.2.2 skrll #endif 5430 1.1.2.2 skrll /************************/ 5431 1.1.2.2 skrll /* Control transmission */ 5432 1.1.2.2 skrll /************************/ 5433 1.1.2.2 skrll /* Now first lets go through the control queue */ 5434 1.1.2.2 skrll for (chk = TAILQ_FIRST(&asoc->control_send_queue); 5435 1.1.2.2 skrll chk; chk = nchk) { 5436 1.1.2.2 skrll nchk = TAILQ_NEXT(chk, sctp_next); 5437 1.1.2.2 skrll if (chk->whoTo != net) { 5438 1.1.2.2 skrll /* 5439 1.1.2.2 skrll * No, not sent to the network we are 5440 1.1.2.2 skrll * looking at 5441 1.1.2.2 skrll */ 5442 1.1.2.2 skrll continue; 5443 1.1.2.2 skrll } 5444 1.1.2.2 skrll if (chk->data == NULL) { 5445 1.1.2.2 skrll continue; 5446 1.1.2.2 skrll } 5447 1.1.2.2 skrll if ((chk->data->m_flags & M_PKTHDR) == 0) { 5448 1.1.2.2 skrll /* 5449 1.1.2.2 skrll * NOTE: the chk queue MUST have the PKTHDR 5450 1.1.2.2 skrll * flag set on it with a total in the 5451 1.1.2.2 skrll * m_pkthdr.len field!! else the chunk will 5452 1.1.2.2 skrll * ALWAYS be skipped 5453 1.1.2.2 skrll */ 5454 1.1.2.2 skrll continue; 5455 1.1.2.2 skrll } 5456 1.1.2.2 skrll if (chk->sent != SCTP_DATAGRAM_UNSENT) { 5457 1.1.2.2 skrll /* 5458 1.1.2.2 skrll * It must be unsent. Cookies and ASCONF's 5459 1.1.2.2 skrll * hang around but there timers will force 5460 1.1.2.2 skrll * when marked for resend. 5461 1.1.2.2 skrll */ 5462 1.1.2.2 skrll continue; 5463 1.1.2.2 skrll } 5464 1.1.2.2 skrll /* Here we do NOT factor the r_mtu */ 5465 1.1.2.2 skrll if ((chk->data->m_pkthdr.len < (int)mtu) || 5466 1.1.2.2 skrll (chk->flags & CHUNK_FLAGS_FRAGMENT_OK)) { 5467 1.1.2.2 skrll /* 5468 1.1.2.2 skrll * We probably should glom the mbuf chain from 5469 1.1.2.2 skrll * the chk->data for control but the problem 5470 1.1.2.2 skrll * is it becomes yet one more level of 5471 1.1.2.2 skrll * tracking to do if for some reason output 5472 1.1.2.2 skrll * fails. Then I have got to reconstruct the 5473 1.1.2.2 skrll * merged control chain.. el yucko.. for now 5474 1.1.2.2 skrll * we take the easy way and do the copy 5475 1.1.2.2 skrll */ 5476 1.1.2.2 skrll outchain = sctp_copy_mbufchain(chk->data, 5477 1.1.2.2 skrll outchain); 5478 1.1.2.2 skrll if (outchain == NULL) { 5479 1.1.2.2 skrll return (ENOMEM); 5480 1.1.2.2 skrll } 5481 1.1.2.2 skrll /* update our MTU size */ 5482 1.1.2.2 skrll if (mtu > chk->data->m_pkthdr.len) 5483 1.1.2.2 skrll mtu -= chk->data->m_pkthdr.len; 5484 1.1.2.2 skrll else 5485 1.1.2.2 skrll mtu = 0; 5486 1.1.2.2 skrll /* Do clear IP_DF ? */ 5487 1.1.2.2 skrll if (chk->flags & CHUNK_FLAGS_FRAGMENT_OK) { 5488 1.1.2.2 skrll no_fragmentflg = 0; 5489 1.1.2.2 skrll } 5490 1.1.2.2 skrll /* Mark things to be removed, if needed */ 5491 1.1.2.2 skrll if ((chk->rec.chunk_id == SCTP_SELECTIVE_ACK) || 5492 1.1.2.2 skrll (chk->rec.chunk_id == SCTP_HEARTBEAT_REQUEST) || 5493 1.1.2.2 skrll (chk->rec.chunk_id == SCTP_HEARTBEAT_ACK) || 5494 1.1.2.2 skrll (chk->rec.chunk_id == SCTP_SHUTDOWN) || 5495 1.1.2.2 skrll (chk->rec.chunk_id == SCTP_SHUTDOWN_ACK) || 5496 1.1.2.2 skrll (chk->rec.chunk_id == SCTP_OPERATION_ERROR) || 5497 1.1.2.2 skrll (chk->rec.chunk_id == SCTP_COOKIE_ACK) || 5498 1.1.2.2 skrll (chk->rec.chunk_id == SCTP_ECN_CWR) || 5499 1.1.2.2 skrll (chk->rec.chunk_id == SCTP_PACKET_DROPPED) || 5500 1.1.2.2 skrll (chk->rec.chunk_id == SCTP_ASCONF_ACK)) { 5501 1.1.2.2 skrll 5502 1.1.2.2 skrll if (chk->rec.chunk_id == SCTP_HEARTBEAT_REQUEST) 5503 1.1.2.2 skrll hbflag = 1; 5504 1.1.2.2 skrll /* remove these chunks at the end */ 5505 1.1.2.2 skrll if (chk->rec.chunk_id == SCTP_SELECTIVE_ACK) { 5506 1.1.2.2 skrll /* turn off the timer */ 5507 1.1.2.2 skrll if (callout_pending(&stcb->asoc.dack_timer.timer)) { 5508 1.1.2.2 skrll sctp_timer_stop(SCTP_TIMER_TYPE_RECV, 5509 1.1.2.2 skrll inp, stcb, net); 5510 1.1.2.2 skrll } 5511 1.1.2.2 skrll } 5512 1.1.2.2 skrll ctl_cnt++; 5513 1.1.2.2 skrll } else { 5514 1.1.2.2 skrll /* 5515 1.1.2.2 skrll * Other chunks, since they have 5516 1.1.2.2 skrll * timers running (i.e. COOKIE or 5517 1.1.2.2 skrll * ASCONF) we just "trust" that it 5518 1.1.2.2 skrll * gets sent or retransmitted. 5519 1.1.2.2 skrll */ 5520 1.1.2.2 skrll ctl_cnt++; 5521 1.1.2.2 skrll if (chk->rec.chunk_id == SCTP_COOKIE_ECHO) { 5522 1.1.2.2 skrll cookie = 1; 5523 1.1.2.2 skrll no_out_cnt = 1; 5524 1.1.2.2 skrll } else if (chk->rec.chunk_id == SCTP_ASCONF) { 5525 1.1.2.2 skrll /* 5526 1.1.2.2 skrll * set hb flag since we can use 5527 1.1.2.2 skrll * these for RTO 5528 1.1.2.2 skrll */ 5529 1.1.2.2 skrll hbflag = 1; 5530 1.1.2.2 skrll asconf = 1; 5531 1.1.2.2 skrll } 5532 1.1.2.2 skrll chk->sent = SCTP_DATAGRAM_SENT; 5533 1.1.2.2 skrll chk->snd_count++; 5534 1.1.2.2 skrll } 5535 1.1.2.2 skrll if (mtu == 0) { 5536 1.1.2.2 skrll /* 5537 1.1.2.2 skrll * Ok we are out of room but we can 5538 1.1.2.2 skrll * output without effecting the flight 5539 1.1.2.2 skrll * size since this little guy is a 5540 1.1.2.2 skrll * control only packet. 5541 1.1.2.2 skrll */ 5542 1.1.2.2 skrll if (asconf) { 5543 1.1.2.2 skrll sctp_timer_start(SCTP_TIMER_TYPE_ASCONF, inp, stcb, net); 5544 1.1.2.2 skrll asconf = 0; 5545 1.1.2.2 skrll } 5546 1.1.2.2 skrll if (cookie) { 5547 1.1.2.2 skrll sctp_timer_start(SCTP_TIMER_TYPE_COOKIE, inp, stcb, net); 5548 1.1.2.2 skrll cookie = 0; 5549 1.1.2.2 skrll } 5550 1.1.2.2 skrll if (outchain->m_len == 0) { 5551 1.1.2.2 skrll /* 5552 1.1.2.2 skrll * Special case for when you 5553 1.1.2.2 skrll * get a 0 len mbuf at the 5554 1.1.2.2 skrll * head due to the lack of a 5555 1.1.2.2 skrll * MHDR at the beginning. 5556 1.1.2.2 skrll */ 5557 1.1.2.2 skrll outchain->m_len = sizeof(struct sctphdr); 5558 1.1.2.2 skrll } else { 5559 1.1.2.2 skrll M_PREPEND(outchain, sizeof(struct sctphdr), M_DONTWAIT); 5560 1.1.2.2 skrll if (outchain == NULL) { 5561 1.1.2.2 skrll /* no memory */ 5562 1.1.2.2 skrll error = ENOBUFS; 5563 1.1.2.2 skrll goto error_out_again; 5564 1.1.2.2 skrll } 5565 1.1.2.2 skrll } 5566 1.1.2.2 skrll shdr = mtod(outchain, struct sctphdr *); 5567 1.1.2.2 skrll shdr->src_port = inp->sctp_lport; 5568 1.1.2.2 skrll shdr->dest_port = stcb->rport; 5569 1.1.2.2 skrll shdr->v_tag = htonl(stcb->asoc.peer_vtag); 5570 1.1.2.2 skrll shdr->checksum = 0; 5571 1.1.2.2 skrll 5572 1.1.2.2 skrll if ((error = sctp_lowlevel_chunk_output(inp, stcb, net, 5573 1.1.2.2 skrll rtcache_getdst(&net->ro), 5574 1.1.2.2 skrll outchain, 5575 1.1.2.2 skrll no_fragmentflg, 0, NULL, asconf))) { 5576 1.1.2.2 skrll if (error == ENOBUFS) { 5577 1.1.2.2 skrll asoc->ifp_had_enobuf = 1; 5578 1.1.2.2 skrll } 5579 1.1.2.2 skrll sctp_pegs[SCTP_DATA_OUT_ERR]++; 5580 1.1.2.2 skrll if (from_where == 0) { 5581 1.1.2.2 skrll sctp_pegs[SCTP_ERROUT_FRM_USR]++; 5582 1.1.2.2 skrll } 5583 1.1.2.2 skrll error_out_again: 5584 1.1.2.2 skrll #ifdef SCTP_DEBUG 5585 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT2) { 5586 1.1.2.2 skrll printf("Gak got ctrl error %d\n", error); 5587 1.1.2.2 skrll } 5588 1.1.2.2 skrll #endif 5589 1.1.2.2 skrll /* error, could not output */ 5590 1.1.2.2 skrll if (hbflag) { 5591 1.1.2.2 skrll #ifdef SCTP_DEBUG 5592 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 5593 1.1.2.2 skrll printf("Update HB anyway\n"); 5594 1.1.2.2 skrll } 5595 1.1.2.2 skrll #endif 5596 1.1.2.2 skrll if (*now_filled == 0) { 5597 1.1.2.2 skrll SCTP_GETTIME_TIMEVAL(&net->last_sent_time); 5598 1.1.2.2 skrll *now_filled = 1; 5599 1.1.2.2 skrll *now = net->last_sent_time; 5600 1.1.2.2 skrll } else { 5601 1.1.2.2 skrll net->last_sent_time = *now; 5602 1.1.2.2 skrll } 5603 1.1.2.2 skrll hbflag = 0; 5604 1.1.2.2 skrll } 5605 1.1.2.2 skrll if (error == EHOSTUNREACH) { 5606 1.1.2.2 skrll /* 5607 1.1.2.2 skrll * Destination went 5608 1.1.2.2 skrll * unreachable during 5609 1.1.2.2 skrll * this send 5610 1.1.2.2 skrll */ 5611 1.1.2.2 skrll #ifdef SCTP_DEBUG 5612 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 5613 1.1.2.2 skrll printf("Moving data to an alterante\n"); 5614 1.1.2.2 skrll } 5615 1.1.2.2 skrll #endif 5616 1.1.2.2 skrll sctp_move_to_an_alt(stcb, asoc, net); 5617 1.1.2.2 skrll } 5618 1.1.2.2 skrll sctp_clean_up_ctl (asoc); 5619 1.1.2.2 skrll return (error); 5620 1.1.2.2 skrll } else 5621 1.1.2.2 skrll asoc->ifp_had_enobuf = 0; 5622 1.1.2.2 skrll /* Only HB or ASCONF advances time */ 5623 1.1.2.2 skrll if (hbflag) { 5624 1.1.2.2 skrll if (*now_filled == 0) { 5625 1.1.2.2 skrll SCTP_GETTIME_TIMEVAL(&net->last_sent_time); 5626 1.1.2.2 skrll *now_filled = 1; 5627 1.1.2.2 skrll *now = net->last_sent_time; 5628 1.1.2.2 skrll } else { 5629 1.1.2.2 skrll net->last_sent_time = *now; 5630 1.1.2.2 skrll } 5631 1.1.2.2 skrll hbflag = 0; 5632 1.1.2.2 skrll } 5633 1.1.2.2 skrll /* 5634 1.1.2.2 skrll * increase the number we sent, if a 5635 1.1.2.2 skrll * cookie is sent we don't tell them 5636 1.1.2.2 skrll * any was sent out. 5637 1.1.2.2 skrll */ 5638 1.1.2.2 skrll if (!no_out_cnt) 5639 1.1.2.2 skrll *num_out += ctl_cnt; 5640 1.1.2.2 skrll /* recalc a clean slate and setup */ 5641 1.1.2.2 skrll if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) { 5642 1.1.2.2 skrll mtu = (net->mtu - SCTP_MIN_OVERHEAD); 5643 1.1.2.2 skrll } else { 5644 1.1.2.2 skrll mtu = (net->mtu - SCTP_MIN_V4_OVERHEAD); 5645 1.1.2.2 skrll } 5646 1.1.2.2 skrll no_fragmentflg = 1; 5647 1.1.2.2 skrll } 5648 1.1.2.2 skrll } 5649 1.1.2.2 skrll } 5650 1.1.2.2 skrll /*********************/ 5651 1.1.2.2 skrll /* Data transmission */ 5652 1.1.2.2 skrll /*********************/ 5653 1.1.2.2 skrll /* now lets add any data within the MTU constraints */ 5654 1.1.2.2 skrll if (((struct sockaddr *)&net->ro.ro_sa)->sa_family == AF_INET) { 5655 1.1.2.2 skrll omtu = net->mtu - (sizeof(struct ip) + sizeof(struct sctphdr)); 5656 1.1.2.2 skrll } else { 5657 1.1.2.2 skrll omtu = net->mtu - (sizeof(struct ip6_hdr) + sizeof(struct sctphdr)); 5658 1.1.2.2 skrll } 5659 1.1.2.2 skrll 5660 1.1.2.2 skrll #ifdef SCTP_DEBUG 5661 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 5662 1.1.2.2 skrll printf("Now to data transmission\n"); 5663 1.1.2.2 skrll } 5664 1.1.2.2 skrll #endif 5665 1.1.2.2 skrll 5666 1.1.2.2 skrll if (((asoc->state & SCTP_STATE_OPEN) == SCTP_STATE_OPEN) || 5667 1.1.2.2 skrll (cookie)) { 5668 1.1.2.2 skrll for (chk = TAILQ_FIRST(&asoc->send_queue); chk; chk = nchk) { 5669 1.1.2.2 skrll if (no_data_chunks) { 5670 1.1.2.2 skrll /* let only control go out */ 5671 1.1.2.2 skrll #ifdef SCTP_DEBUG 5672 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 5673 1.1.2.2 skrll printf("Either nothing to send or we are full\n"); 5674 1.1.2.2 skrll } 5675 1.1.2.2 skrll #endif 5676 1.1.2.2 skrll break; 5677 1.1.2.2 skrll } 5678 1.1.2.2 skrll if (net->flight_size >= net->cwnd) { 5679 1.1.2.2 skrll /* skip this net, no room for data */ 5680 1.1.2.2 skrll #ifdef SCTP_DEBUG 5681 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 5682 1.1.2.2 skrll printf("fs:%d > cwnd:%d\n", 5683 1.1.2.2 skrll net->flight_size, net->cwnd); 5684 1.1.2.2 skrll } 5685 1.1.2.2 skrll #endif 5686 1.1.2.2 skrll sctp_pegs[SCTP_CWND_BLOCKED]++; 5687 1.1.2.2 skrll *reason_code = 2; 5688 1.1.2.2 skrll break; 5689 1.1.2.2 skrll } 5690 1.1.2.2 skrll nchk = TAILQ_NEXT(chk, sctp_next); 5691 1.1.2.2 skrll if (chk->whoTo != net) { 5692 1.1.2.2 skrll /* No, not sent to this net */ 5693 1.1.2.2 skrll #ifdef SCTP_DEBUG 5694 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 5695 1.1.2.2 skrll printf("chk->whoTo:%p not %p\n", 5696 1.1.2.2 skrll chk->whoTo, net); 5697 1.1.2.2 skrll 5698 1.1.2.2 skrll } 5699 1.1.2.2 skrll #endif 5700 1.1.2.2 skrll continue; 5701 1.1.2.2 skrll } 5702 1.1.2.2 skrll #ifdef SCTP_DEBUG 5703 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 5704 1.1.2.2 skrll printf("Can we pick up a chunk?\n"); 5705 1.1.2.2 skrll } 5706 1.1.2.2 skrll #endif 5707 1.1.2.2 skrll if ((chk->send_size > omtu) && ((chk->flags & CHUNK_FLAGS_FRAGMENT_OK) == 0)) { 5708 1.1.2.2 skrll /* strange, we have a chunk that is to bit 5709 1.1.2.2 skrll * for its destination and yet no fragment ok flag. 5710 1.1.2.2 skrll * Something went wrong when the PMTU changed...we did 5711 1.1.2.2 skrll * not mark this chunk for some reason?? I will 5712 1.1.2.2 skrll * fix it here by letting IP fragment it for now and 5713 1.1.2.2 skrll * printing a warning. This really should not happen ... 5714 1.1.2.2 skrll */ 5715 1.1.2.2 skrll /*#ifdef SCTP_DEBUG*/ 5716 1.1.2.2 skrll printf("Warning chunk of %d bytes > mtu:%d and yet PMTU disc missed\n", 5717 1.1.2.2 skrll chk->send_size, mtu); 5718 1.1.2.2 skrll /*#endif*/ 5719 1.1.2.2 skrll chk->flags |= CHUNK_FLAGS_FRAGMENT_OK; 5720 1.1.2.2 skrll } 5721 1.1.2.2 skrll 5722 1.1.2.2 skrll if (((chk->send_size <= mtu) && (chk->send_size <= r_mtu)) || 5723 1.1.2.2 skrll ((chk->flags & CHUNK_FLAGS_FRAGMENT_OK) && (chk->send_size <= asoc->peers_rwnd))) { 5724 1.1.2.2 skrll /* ok we will add this one */ 5725 1.1.2.2 skrll #ifdef SCTP_DEBUG 5726 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 5727 1.1.2.2 skrll printf("Picking up the chunk\n"); 5728 1.1.2.2 skrll } 5729 1.1.2.2 skrll #endif 5730 1.1.2.2 skrll outchain = sctp_copy_mbufchain(chk->data, outchain); 5731 1.1.2.2 skrll if (outchain == NULL) { 5732 1.1.2.2 skrll #ifdef SCTP_DEBUG 5733 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 5734 1.1.2.2 skrll printf("Gakk no memory\n"); 5735 1.1.2.2 skrll } 5736 1.1.2.2 skrll #endif 5737 1.1.2.2 skrll if (!callout_pending(&net->rxt_timer.timer)) { 5738 1.1.2.2 skrll sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, net); 5739 1.1.2.2 skrll } 5740 1.1.2.2 skrll return (ENOMEM); 5741 1.1.2.2 skrll } 5742 1.1.2.2 skrll /* upate our MTU size */ 5743 1.1.2.2 skrll /* Do clear IP_DF ? */ 5744 1.1.2.2 skrll if (chk->flags & CHUNK_FLAGS_FRAGMENT_OK) { 5745 1.1.2.2 skrll no_fragmentflg = 0; 5746 1.1.2.2 skrll } 5747 1.1.2.2 skrll mtu -= chk->send_size; 5748 1.1.2.2 skrll r_mtu -= chk->send_size; 5749 1.1.2.2 skrll data_list[bundle_at++] = chk; 5750 1.1.2.2 skrll if (bundle_at >= SCTP_MAX_DATA_BUNDLING) { 5751 1.1.2.2 skrll mtu = 0; 5752 1.1.2.2 skrll break; 5753 1.1.2.2 skrll } 5754 1.1.2.2 skrll if (mtu <= 0) { 5755 1.1.2.2 skrll mtu = 0; 5756 1.1.2.2 skrll break; 5757 1.1.2.2 skrll } 5758 1.1.2.2 skrll if ((r_mtu <= 0) || one_chunk) { 5759 1.1.2.2 skrll r_mtu = 0; 5760 1.1.2.2 skrll break; 5761 1.1.2.2 skrll } 5762 1.1.2.2 skrll } else { 5763 1.1.2.2 skrll /* 5764 1.1.2.2 skrll * Must be sent in order of the TSN's 5765 1.1.2.2 skrll * (on a network) 5766 1.1.2.2 skrll */ 5767 1.1.2.2 skrll #ifdef SCTP_DEBUG 5768 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 5769 1.1.2.2 skrll printf("ok no more chk:%d > mtu:%d || < r_mtu:%d\n", 5770 1.1.2.2 skrll chk->send_size, mtu, r_mtu); 5771 1.1.2.2 skrll } 5772 1.1.2.2 skrll #endif 5773 1.1.2.2 skrll 5774 1.1.2.2 skrll break; 5775 1.1.2.2 skrll } 5776 1.1.2.2 skrll }/* for () */ 5777 1.1.2.2 skrll } /* if asoc.state OPEN */ 5778 1.1.2.2 skrll /* Is there something to send for this destination? */ 5779 1.1.2.2 skrll #ifdef SCTP_DEBUG 5780 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 5781 1.1.2.2 skrll printf("ok now is chain assembled? %p\n", 5782 1.1.2.2 skrll outchain); 5783 1.1.2.2 skrll } 5784 1.1.2.2 skrll #endif 5785 1.1.2.2 skrll 5786 1.1.2.2 skrll if (outchain) { 5787 1.1.2.2 skrll /* We may need to start a control timer or two */ 5788 1.1.2.2 skrll if (asconf) { 5789 1.1.2.2 skrll sctp_timer_start(SCTP_TIMER_TYPE_ASCONF, inp, stcb, net); 5790 1.1.2.2 skrll asconf = 0; 5791 1.1.2.2 skrll } 5792 1.1.2.2 skrll if (cookie) { 5793 1.1.2.2 skrll sctp_timer_start(SCTP_TIMER_TYPE_COOKIE, inp, stcb, net); 5794 1.1.2.2 skrll cookie = 0; 5795 1.1.2.2 skrll } 5796 1.1.2.2 skrll /* must start a send timer if data is being sent */ 5797 1.1.2.2 skrll if (bundle_at && (!callout_pending(&net->rxt_timer.timer))) { 5798 1.1.2.2 skrll /* no timer running on this destination 5799 1.1.2.2 skrll * restart it. 5800 1.1.2.2 skrll */ 5801 1.1.2.2 skrll #ifdef SCTP_DEBUG 5802 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 5803 1.1.2.2 skrll printf("ok lets start a send timer .. we will transmit %p\n", 5804 1.1.2.2 skrll outchain); 5805 1.1.2.2 skrll } 5806 1.1.2.2 skrll #endif 5807 1.1.2.2 skrll sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, net); 5808 1.1.2.2 skrll } 5809 1.1.2.2 skrll /* Now send it, if there is anything to send :> */ 5810 1.1.2.2 skrll if ((outchain->m_flags & M_PKTHDR) == 0) { 5811 1.1.2.2 skrll struct mbuf *t; 5812 1.1.2.2 skrll 5813 1.1.2.2 skrll MGETHDR(t, M_DONTWAIT, MT_HEADER); 5814 1.1.2.2 skrll if (t == NULL) { 5815 1.1.2.2 skrll sctp_m_freem(outchain); 5816 1.1.2.2 skrll return (ENOMEM); 5817 1.1.2.2 skrll } 5818 1.1.2.2 skrll t->m_next = outchain; 5819 1.1.2.2 skrll t->m_pkthdr.len = 0; 5820 1.1.2.2 skrll t->m_pkthdr.rcvif = 0; 5821 1.1.2.2 skrll t->m_len = 0; 5822 1.1.2.2 skrll 5823 1.1.2.2 skrll outchain = t; 5824 1.1.2.2 skrll while (t) { 5825 1.1.2.2 skrll outchain->m_pkthdr.len += t->m_len; 5826 1.1.2.2 skrll t = t->m_next; 5827 1.1.2.2 skrll } 5828 1.1.2.2 skrll } 5829 1.1.2.2 skrll if (outchain->m_len == 0) { 5830 1.1.2.2 skrll /* Special case for when you get a 0 len 5831 1.1.2.2 skrll * mbuf at the head due to the lack 5832 1.1.2.2 skrll * of a MHDR at the beginning. 5833 1.1.2.2 skrll */ 5834 1.1.2.2 skrll MH_ALIGN(outchain, sizeof(struct sctphdr)); 5835 1.1.2.2 skrll outchain->m_len = sizeof(struct sctphdr); 5836 1.1.2.2 skrll } else { 5837 1.1.2.2 skrll M_PREPEND(outchain, sizeof(struct sctphdr), M_DONTWAIT); 5838 1.1.2.2 skrll if (outchain == NULL) { 5839 1.1.2.2 skrll /* out of mbufs */ 5840 1.1.2.2 skrll error = ENOBUFS; 5841 1.1.2.2 skrll goto errored_send; 5842 1.1.2.2 skrll } 5843 1.1.2.2 skrll } 5844 1.1.2.2 skrll shdr = mtod(outchain, struct sctphdr *); 5845 1.1.2.2 skrll shdr->src_port = inp->sctp_lport; 5846 1.1.2.2 skrll shdr->dest_port = stcb->rport; 5847 1.1.2.2 skrll shdr->v_tag = htonl(stcb->asoc.peer_vtag); 5848 1.1.2.2 skrll shdr->checksum = 0; 5849 1.1.2.2 skrll if ((error = sctp_lowlevel_chunk_output(inp, stcb, net, 5850 1.1.2.2 skrll rtcache_getdst(&net->ro), 5851 1.1.2.2 skrll outchain, 5852 1.1.2.2 skrll no_fragmentflg, bundle_at, data_list[0], asconf))) { 5853 1.1.2.2 skrll /* error, we could not output */ 5854 1.1.2.2 skrll if (error == ENOBUFS) { 5855 1.1.2.2 skrll asoc->ifp_had_enobuf = 1; 5856 1.1.2.2 skrll } 5857 1.1.2.2 skrll sctp_pegs[SCTP_DATA_OUT_ERR]++; 5858 1.1.2.2 skrll if (from_where == 0) { 5859 1.1.2.2 skrll sctp_pegs[SCTP_ERROUT_FRM_USR]++; 5860 1.1.2.2 skrll } 5861 1.1.2.2 skrll 5862 1.1.2.2 skrll errored_send: 5863 1.1.2.2 skrll #ifdef SCTP_DEBUG 5864 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 5865 1.1.2.2 skrll printf("Gak send error %d\n", error); 5866 1.1.2.2 skrll } 5867 1.1.2.2 skrll #endif 5868 1.1.2.2 skrll if (hbflag) { 5869 1.1.2.2 skrll #ifdef SCTP_DEBUG 5870 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 5871 1.1.2.2 skrll printf("Update HB time anyway\n"); 5872 1.1.2.2 skrll } 5873 1.1.2.2 skrll #endif 5874 1.1.2.2 skrll if (*now_filled == 0) { 5875 1.1.2.2 skrll SCTP_GETTIME_TIMEVAL(&net->last_sent_time); 5876 1.1.2.2 skrll *now_filled = 1; 5877 1.1.2.2 skrll *now = net->last_sent_time; 5878 1.1.2.2 skrll } else { 5879 1.1.2.2 skrll net->last_sent_time = *now; 5880 1.1.2.2 skrll } 5881 1.1.2.2 skrll hbflag = 0; 5882 1.1.2.2 skrll } 5883 1.1.2.2 skrll if (error == EHOSTUNREACH) { 5884 1.1.2.2 skrll /* 5885 1.1.2.2 skrll * Destination went unreachable during 5886 1.1.2.2 skrll * this send 5887 1.1.2.2 skrll */ 5888 1.1.2.2 skrll #ifdef SCTP_DEBUG 5889 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 5890 1.1.2.2 skrll printf("Calling the movement routine\n"); 5891 1.1.2.2 skrll } 5892 1.1.2.2 skrll #endif 5893 1.1.2.2 skrll sctp_move_to_an_alt(stcb, asoc, net); 5894 1.1.2.2 skrll } 5895 1.1.2.2 skrll sctp_clean_up_ctl (asoc); 5896 1.1.2.2 skrll return (error); 5897 1.1.2.2 skrll } else { 5898 1.1.2.2 skrll asoc->ifp_had_enobuf = 0; 5899 1.1.2.2 skrll } 5900 1.1.2.2 skrll if (bundle_at || hbflag) { 5901 1.1.2.2 skrll /* For data/asconf and hb set time */ 5902 1.1.2.2 skrll if (*now_filled == 0) { 5903 1.1.2.2 skrll SCTP_GETTIME_TIMEVAL(&net->last_sent_time); 5904 1.1.2.2 skrll *now_filled = 1; 5905 1.1.2.2 skrll *now = net->last_sent_time; 5906 1.1.2.2 skrll } else { 5907 1.1.2.2 skrll net->last_sent_time = *now; 5908 1.1.2.2 skrll } 5909 1.1.2.2 skrll } 5910 1.1.2.2 skrll 5911 1.1.2.2 skrll if (!no_out_cnt) { 5912 1.1.2.2 skrll *num_out += (ctl_cnt + bundle_at); 5913 1.1.2.2 skrll } 5914 1.1.2.2 skrll if (bundle_at) { 5915 1.1.2.2 skrll if (!net->rto_pending) { 5916 1.1.2.2 skrll /* setup for a RTO measurement */ 5917 1.1.2.2 skrll net->rto_pending = 1; 5918 1.1.2.2 skrll data_list[0]->do_rtt = 1; 5919 1.1.2.2 skrll } else { 5920 1.1.2.2 skrll data_list[0]->do_rtt = 0; 5921 1.1.2.2 skrll } 5922 1.1.2.2 skrll sctp_pegs[SCTP_PEG_TSNS_SENT] += bundle_at; 5923 1.1.2.2 skrll sctp_clean_up_datalist(stcb, asoc, data_list, bundle_at, net); 5924 1.1.2.2 skrll } 5925 1.1.2.2 skrll if (one_chunk) { 5926 1.1.2.2 skrll break; 5927 1.1.2.2 skrll } 5928 1.1.2.2 skrll } 5929 1.1.2.2 skrll } 5930 1.1.2.2 skrll /* At the end there should be no NON timed 5931 1.1.2.2 skrll * chunks hanging on this queue. 5932 1.1.2.2 skrll */ 5933 1.1.2.2 skrll if ((*num_out == 0) && (*reason_code == 0)) { 5934 1.1.2.2 skrll *reason_code = 3; 5935 1.1.2.2 skrll } 5936 1.1.2.2 skrll sctp_clean_up_ctl (asoc); 5937 1.1.2.2 skrll return (0); 5938 1.1.2.2 skrll } 5939 1.1.2.2 skrll 5940 1.1.2.2 skrll void 5941 1.1.2.2 skrll sctp_queue_op_err(struct sctp_tcb *stcb, struct mbuf *op_err) 5942 1.1.2.2 skrll { 5943 1.1.2.2 skrll /* Prepend a OPERATIONAL_ERROR chunk header 5944 1.1.2.2 skrll * and put on the end of the control chunk queue. 5945 1.1.2.2 skrll */ 5946 1.1.2.2 skrll /* Sender had better have gotten a MGETHDR or else 5947 1.1.2.2 skrll * the control chunk will be forever skipped 5948 1.1.2.2 skrll */ 5949 1.1.2.2 skrll struct sctp_chunkhdr *hdr; 5950 1.1.2.2 skrll struct sctp_tmit_chunk *chk; 5951 1.1.2.2 skrll struct mbuf *mat; 5952 1.1.2.2 skrll 5953 1.1.2.2 skrll chk = (struct sctp_tmit_chunk *)SCTP_ZONE_GET(sctppcbinfo.ipi_zone_chunk); 5954 1.1.2.2 skrll if (chk == NULL) { 5955 1.1.2.2 skrll /* no memory */ 5956 1.1.2.2 skrll sctp_m_freem(op_err); 5957 1.1.2.2 skrll return; 5958 1.1.2.2 skrll } 5959 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk++; 5960 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 5961 1.1.2.2 skrll M_PREPEND(op_err, sizeof(struct sctp_chunkhdr), M_DONTWAIT); 5962 1.1.2.2 skrll if (op_err == NULL) { 5963 1.1.2.2 skrll SCTP_ZONE_FREE(sctppcbinfo.ipi_zone_chunk, chk); 5964 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk--; 5965 1.1.2.2 skrll if ((int)sctppcbinfo.ipi_count_chunk < 0) { 5966 1.1.2.2 skrll panic("Chunk count is negative"); 5967 1.1.2.2 skrll } 5968 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 5969 1.1.2.2 skrll return; 5970 1.1.2.2 skrll } 5971 1.1.2.2 skrll chk->send_size = 0; 5972 1.1.2.2 skrll mat = op_err; 5973 1.1.2.2 skrll while (mat != NULL) { 5974 1.1.2.2 skrll chk->send_size += mat->m_len; 5975 1.1.2.2 skrll mat = mat->m_next; 5976 1.1.2.2 skrll } 5977 1.1.2.2 skrll chk->rec.chunk_id = SCTP_OPERATION_ERROR; 5978 1.1.2.2 skrll chk->sent = SCTP_DATAGRAM_UNSENT; 5979 1.1.2.2 skrll chk->snd_count = 0; 5980 1.1.2.2 skrll chk->flags = 0; 5981 1.1.2.2 skrll chk->asoc = &stcb->asoc; 5982 1.1.2.2 skrll chk->data = op_err; 5983 1.1.2.2 skrll chk->whoTo = chk->asoc->primary_destination; 5984 1.1.2.2 skrll chk->whoTo->ref_count++; 5985 1.1.2.2 skrll hdr = mtod(op_err, struct sctp_chunkhdr *); 5986 1.1.2.2 skrll hdr->chunk_type = SCTP_OPERATION_ERROR; 5987 1.1.2.2 skrll hdr->chunk_flags = 0; 5988 1.1.2.2 skrll hdr->chunk_length = htons(chk->send_size); 5989 1.1.2.2 skrll TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, 5990 1.1.2.2 skrll chk, 5991 1.1.2.2 skrll sctp_next); 5992 1.1.2.2 skrll chk->asoc->ctrl_queue_cnt++; 5993 1.1.2.2 skrll } 5994 1.1.2.2 skrll 5995 1.1.2.2 skrll int 5996 1.1.2.2 skrll sctp_send_cookie_echo(struct mbuf *m, 5997 1.1.2.2 skrll int offset, 5998 1.1.2.2 skrll struct sctp_tcb *stcb, 5999 1.1.2.2 skrll struct sctp_nets *net) 6000 1.1.2.2 skrll { 6001 1.1.2.2 skrll /* 6002 1.1.2.2 skrll * pull out the cookie and put it at the front of the control 6003 1.1.2.2 skrll * chunk queue. 6004 1.1.2.2 skrll */ 6005 1.1.2.2 skrll int at; 6006 1.1.2.2 skrll struct mbuf *cookie, *mat; 6007 1.1.2.2 skrll struct sctp_paramhdr parm, *phdr; 6008 1.1.2.2 skrll struct sctp_chunkhdr *hdr; 6009 1.1.2.2 skrll struct sctp_tmit_chunk *chk; 6010 1.1.2.2 skrll uint16_t ptype, plen; 6011 1.1.2.2 skrll /* First find the cookie in the param area */ 6012 1.1.2.2 skrll cookie = NULL; 6013 1.1.2.2 skrll at = offset + sizeof(struct sctp_init_chunk); 6014 1.1.2.2 skrll 6015 1.1.2.2 skrll do { 6016 1.1.2.2 skrll phdr = sctp_get_next_param(m, at, &parm, sizeof(parm)); 6017 1.1.2.2 skrll if (phdr == NULL) { 6018 1.1.2.2 skrll return (-3); 6019 1.1.2.2 skrll } 6020 1.1.2.2 skrll ptype = ntohs(phdr->param_type); 6021 1.1.2.2 skrll plen = ntohs(phdr->param_length); 6022 1.1.2.2 skrll if (ptype == SCTP_STATE_COOKIE) { 6023 1.1.2.2 skrll int pad; 6024 1.1.2.2 skrll /* found the cookie */ 6025 1.1.2.2 skrll if ((pad = (plen % 4))) { 6026 1.1.2.2 skrll plen += 4 - pad; 6027 1.1.2.2 skrll } 6028 1.1.2.2 skrll cookie = sctp_m_copym(m, at, plen, M_DONTWAIT); 6029 1.1.2.2 skrll if (cookie == NULL) { 6030 1.1.2.2 skrll /* No memory */ 6031 1.1.2.2 skrll return (-2); 6032 1.1.2.2 skrll } 6033 1.1.2.2 skrll break; 6034 1.1.2.2 skrll } 6035 1.1.2.2 skrll at += SCTP_SIZE32(plen); 6036 1.1.2.2 skrll } while (phdr); 6037 1.1.2.2 skrll if (cookie == NULL) { 6038 1.1.2.2 skrll /* Did not find the cookie */ 6039 1.1.2.2 skrll return (-3); 6040 1.1.2.2 skrll } 6041 1.1.2.2 skrll /* ok, we got the cookie lets change it into a cookie echo chunk */ 6042 1.1.2.2 skrll 6043 1.1.2.2 skrll /* first the change from param to cookie */ 6044 1.1.2.2 skrll hdr = mtod(cookie, struct sctp_chunkhdr *); 6045 1.1.2.2 skrll hdr->chunk_type = SCTP_COOKIE_ECHO; 6046 1.1.2.2 skrll hdr->chunk_flags = 0; 6047 1.1.2.2 skrll /* now we MUST have a PKTHDR on it */ 6048 1.1.2.2 skrll if ((cookie->m_flags & M_PKTHDR) != M_PKTHDR) { 6049 1.1.2.2 skrll /* we hope this happens rarely */ 6050 1.1.2.2 skrll MGETHDR(mat, M_DONTWAIT, MT_HEADER); 6051 1.1.2.2 skrll if (mat == NULL) { 6052 1.1.2.2 skrll sctp_m_freem(cookie); 6053 1.1.2.2 skrll return (-4); 6054 1.1.2.2 skrll } 6055 1.1.2.2 skrll mat->m_len = 0; 6056 1.1.2.2 skrll mat->m_pkthdr.rcvif = 0; 6057 1.1.2.2 skrll mat->m_next = cookie; 6058 1.1.2.2 skrll cookie = mat; 6059 1.1.2.2 skrll } 6060 1.1.2.2 skrll cookie->m_pkthdr.len = plen; 6061 1.1.2.2 skrll /* get the chunk stuff now and place it in the FRONT of the queue */ 6062 1.1.2.2 skrll chk = (struct sctp_tmit_chunk *)SCTP_ZONE_GET(sctppcbinfo.ipi_zone_chunk); 6063 1.1.2.2 skrll if (chk == NULL) { 6064 1.1.2.2 skrll /* no memory */ 6065 1.1.2.2 skrll sctp_m_freem(cookie); 6066 1.1.2.2 skrll return (-5); 6067 1.1.2.2 skrll } 6068 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk++; 6069 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 6070 1.1.2.2 skrll chk->send_size = cookie->m_pkthdr.len; 6071 1.1.2.2 skrll chk->rec.chunk_id = SCTP_COOKIE_ECHO; 6072 1.1.2.2 skrll chk->sent = SCTP_DATAGRAM_UNSENT; 6073 1.1.2.2 skrll chk->snd_count = 0; 6074 1.1.2.2 skrll chk->flags = 0; 6075 1.1.2.2 skrll chk->asoc = &stcb->asoc; 6076 1.1.2.2 skrll chk->data = cookie; 6077 1.1.2.2 skrll chk->whoTo = chk->asoc->primary_destination; 6078 1.1.2.2 skrll chk->whoTo->ref_count++; 6079 1.1.2.2 skrll TAILQ_INSERT_HEAD(&chk->asoc->control_send_queue, chk, sctp_next); 6080 1.1.2.2 skrll chk->asoc->ctrl_queue_cnt++; 6081 1.1.2.2 skrll return (0); 6082 1.1.2.2 skrll } 6083 1.1.2.2 skrll 6084 1.1.2.2 skrll void 6085 1.1.2.2 skrll sctp_send_heartbeat_ack(struct sctp_tcb *stcb, 6086 1.1.2.2 skrll struct mbuf *m, 6087 1.1.2.2 skrll int offset, 6088 1.1.2.2 skrll int chk_length, 6089 1.1.2.2 skrll struct sctp_nets *net) 6090 1.1.2.2 skrll { 6091 1.1.2.2 skrll /* take a HB request and make it into a 6092 1.1.2.2 skrll * HB ack and send it. 6093 1.1.2.2 skrll */ 6094 1.1.2.2 skrll struct mbuf *outchain; 6095 1.1.2.2 skrll struct sctp_chunkhdr *chdr; 6096 1.1.2.2 skrll struct sctp_tmit_chunk *chk; 6097 1.1.2.2 skrll 6098 1.1.2.2 skrll 6099 1.1.2.2 skrll if (net == NULL) 6100 1.1.2.2 skrll /* must have a net pointer */ 6101 1.1.2.2 skrll return; 6102 1.1.2.2 skrll 6103 1.1.2.2 skrll outchain = sctp_m_copym(m, offset, chk_length, M_DONTWAIT); 6104 1.1.2.2 skrll if (outchain == NULL) { 6105 1.1.2.2 skrll /* gak out of memory */ 6106 1.1.2.2 skrll return; 6107 1.1.2.2 skrll } 6108 1.1.2.2 skrll chdr = mtod(outchain, struct sctp_chunkhdr *); 6109 1.1.2.2 skrll chdr->chunk_type = SCTP_HEARTBEAT_ACK; 6110 1.1.2.2 skrll chdr->chunk_flags = 0; 6111 1.1.2.2 skrll if ((outchain->m_flags & M_PKTHDR) != M_PKTHDR) { 6112 1.1.2.2 skrll /* should not happen but we are cautious. */ 6113 1.1.2.2 skrll struct mbuf *tmp; 6114 1.1.2.2 skrll MGETHDR(tmp, M_DONTWAIT, MT_HEADER); 6115 1.1.2.2 skrll if (tmp == NULL) { 6116 1.1.2.2 skrll return; 6117 1.1.2.2 skrll } 6118 1.1.2.2 skrll tmp->m_len = 0; 6119 1.1.2.2 skrll tmp->m_pkthdr.rcvif = 0; 6120 1.1.2.2 skrll tmp->m_next = outchain; 6121 1.1.2.2 skrll outchain = tmp; 6122 1.1.2.2 skrll } 6123 1.1.2.2 skrll outchain->m_pkthdr.len = chk_length; 6124 1.1.2.2 skrll if (chk_length % 4) { 6125 1.1.2.2 skrll /* need pad */ 6126 1.1.2.2 skrll u_int32_t cpthis=0; 6127 1.1.2.2 skrll int padlen; 6128 1.1.2.2 skrll padlen = 4 - (outchain->m_pkthdr.len % 4); 6129 1.1.2.2 skrll m_copyback(outchain, outchain->m_pkthdr.len, padlen, (void *)&cpthis); 6130 1.1.2.2 skrll } 6131 1.1.2.2 skrll chk = (struct sctp_tmit_chunk *)SCTP_ZONE_GET(sctppcbinfo.ipi_zone_chunk); 6132 1.1.2.2 skrll if (chk == NULL) { 6133 1.1.2.2 skrll /* no memory */ 6134 1.1.2.2 skrll sctp_m_freem(outchain); 6135 1.1.2.2 skrll return ; 6136 1.1.2.2 skrll } 6137 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk++; 6138 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 6139 1.1.2.2 skrll 6140 1.1.2.2 skrll chk->send_size = chk_length; 6141 1.1.2.2 skrll chk->rec.chunk_id = SCTP_HEARTBEAT_ACK; 6142 1.1.2.2 skrll chk->sent = SCTP_DATAGRAM_UNSENT; 6143 1.1.2.2 skrll chk->snd_count = 0; 6144 1.1.2.2 skrll chk->flags = 0; 6145 1.1.2.2 skrll chk->asoc = &stcb->asoc; 6146 1.1.2.2 skrll chk->data = outchain; 6147 1.1.2.2 skrll chk->whoTo = net; 6148 1.1.2.2 skrll chk->whoTo->ref_count++; 6149 1.1.2.2 skrll TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next); 6150 1.1.2.2 skrll chk->asoc->ctrl_queue_cnt++; 6151 1.1.2.2 skrll } 6152 1.1.2.2 skrll 6153 1.1.2.2 skrll int 6154 1.1.2.2 skrll sctp_send_cookie_ack(struct sctp_tcb *stcb) { 6155 1.1.2.2 skrll /* formulate and queue a cookie-ack back to sender */ 6156 1.1.2.2 skrll struct mbuf *cookie_ack; 6157 1.1.2.2 skrll struct sctp_chunkhdr *hdr; 6158 1.1.2.2 skrll struct sctp_tmit_chunk *chk; 6159 1.1.2.2 skrll 6160 1.1.2.2 skrll cookie_ack = NULL; 6161 1.1.2.2 skrll MGETHDR(cookie_ack, M_DONTWAIT, MT_HEADER); 6162 1.1.2.2 skrll if (cookie_ack == NULL) { 6163 1.1.2.2 skrll /* no mbuf's */ 6164 1.1.2.2 skrll return (-1); 6165 1.1.2.2 skrll } 6166 1.1.2.2 skrll cookie_ack->m_data += SCTP_MIN_OVERHEAD; 6167 1.1.2.2 skrll chk = (struct sctp_tmit_chunk *)SCTP_ZONE_GET(sctppcbinfo.ipi_zone_chunk); 6168 1.1.2.2 skrll if (chk == NULL) { 6169 1.1.2.2 skrll /* no memory */ 6170 1.1.2.2 skrll sctp_m_freem(cookie_ack); 6171 1.1.2.2 skrll return (-1); 6172 1.1.2.2 skrll } 6173 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk++; 6174 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 6175 1.1.2.2 skrll 6176 1.1.2.2 skrll chk->send_size = sizeof(struct sctp_chunkhdr); 6177 1.1.2.2 skrll chk->rec.chunk_id = SCTP_COOKIE_ACK; 6178 1.1.2.2 skrll chk->sent = SCTP_DATAGRAM_UNSENT; 6179 1.1.2.2 skrll chk->snd_count = 0; 6180 1.1.2.2 skrll chk->flags = 0; 6181 1.1.2.2 skrll chk->asoc = &stcb->asoc; 6182 1.1.2.2 skrll chk->data = cookie_ack; 6183 1.1.2.2 skrll if (chk->asoc->last_control_chunk_from != NULL) { 6184 1.1.2.2 skrll chk->whoTo = chk->asoc->last_control_chunk_from; 6185 1.1.2.2 skrll } else { 6186 1.1.2.2 skrll chk->whoTo = chk->asoc->primary_destination; 6187 1.1.2.2 skrll } 6188 1.1.2.2 skrll chk->whoTo->ref_count++; 6189 1.1.2.2 skrll hdr = mtod(cookie_ack, struct sctp_chunkhdr *); 6190 1.1.2.2 skrll hdr->chunk_type = SCTP_COOKIE_ACK; 6191 1.1.2.2 skrll hdr->chunk_flags = 0; 6192 1.1.2.2 skrll hdr->chunk_length = htons(chk->send_size); 6193 1.1.2.2 skrll cookie_ack->m_pkthdr.len = cookie_ack->m_len = chk->send_size; 6194 1.1.2.2 skrll cookie_ack->m_pkthdr.rcvif = 0; 6195 1.1.2.2 skrll TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next); 6196 1.1.2.2 skrll chk->asoc->ctrl_queue_cnt++; 6197 1.1.2.2 skrll return (0); 6198 1.1.2.2 skrll } 6199 1.1.2.2 skrll 6200 1.1.2.2 skrll 6201 1.1.2.2 skrll int 6202 1.1.2.2 skrll sctp_send_shutdown_ack(struct sctp_tcb *stcb, struct sctp_nets *net) 6203 1.1.2.2 skrll { 6204 1.1.2.2 skrll /* formulate and queue a SHUTDOWN-ACK back to the sender */ 6205 1.1.2.2 skrll struct mbuf *m_shutdown_ack; 6206 1.1.2.2 skrll struct sctp_shutdown_ack_chunk *ack_cp; 6207 1.1.2.2 skrll struct sctp_tmit_chunk *chk; 6208 1.1.2.2 skrll 6209 1.1.2.2 skrll m_shutdown_ack = NULL; 6210 1.1.2.2 skrll MGETHDR(m_shutdown_ack, M_DONTWAIT, MT_HEADER); 6211 1.1.2.2 skrll if (m_shutdown_ack == NULL) { 6212 1.1.2.2 skrll /* no mbuf's */ 6213 1.1.2.2 skrll return (-1); 6214 1.1.2.2 skrll } 6215 1.1.2.2 skrll m_shutdown_ack->m_data += SCTP_MIN_OVERHEAD; 6216 1.1.2.2 skrll chk = (struct sctp_tmit_chunk *)SCTP_ZONE_GET(sctppcbinfo.ipi_zone_chunk); 6217 1.1.2.2 skrll if (chk == NULL) { 6218 1.1.2.2 skrll /* no memory */ 6219 1.1.2.2 skrll sctp_m_freem(m_shutdown_ack); 6220 1.1.2.2 skrll return (-1); 6221 1.1.2.2 skrll } 6222 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk++; 6223 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 6224 1.1.2.2 skrll 6225 1.1.2.2 skrll chk->send_size = sizeof(struct sctp_chunkhdr); 6226 1.1.2.2 skrll chk->rec.chunk_id = SCTP_SHUTDOWN_ACK; 6227 1.1.2.2 skrll chk->sent = SCTP_DATAGRAM_UNSENT; 6228 1.1.2.2 skrll chk->snd_count = 0; 6229 1.1.2.2 skrll chk->flags = 0; 6230 1.1.2.2 skrll chk->asoc = &stcb->asoc; 6231 1.1.2.2 skrll chk->data = m_shutdown_ack; 6232 1.1.2.2 skrll chk->whoTo = net; 6233 1.1.2.2 skrll net->ref_count++; 6234 1.1.2.2 skrll 6235 1.1.2.2 skrll ack_cp = mtod(m_shutdown_ack, struct sctp_shutdown_ack_chunk *); 6236 1.1.2.2 skrll ack_cp->ch.chunk_type = SCTP_SHUTDOWN_ACK; 6237 1.1.2.2 skrll ack_cp->ch.chunk_flags = 0; 6238 1.1.2.2 skrll ack_cp->ch.chunk_length = htons(chk->send_size); 6239 1.1.2.2 skrll m_shutdown_ack->m_pkthdr.len = m_shutdown_ack->m_len = chk->send_size; 6240 1.1.2.2 skrll m_shutdown_ack->m_pkthdr.rcvif = 0; 6241 1.1.2.2 skrll TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next); 6242 1.1.2.2 skrll chk->asoc->ctrl_queue_cnt++; 6243 1.1.2.2 skrll return (0); 6244 1.1.2.2 skrll } 6245 1.1.2.2 skrll 6246 1.1.2.2 skrll int 6247 1.1.2.2 skrll sctp_send_shutdown(struct sctp_tcb *stcb, struct sctp_nets *net) 6248 1.1.2.2 skrll { 6249 1.1.2.2 skrll /* formulate and queue a SHUTDOWN to the sender */ 6250 1.1.2.2 skrll struct mbuf *m_shutdown; 6251 1.1.2.2 skrll struct sctp_shutdown_chunk *shutdown_cp; 6252 1.1.2.2 skrll struct sctp_tmit_chunk *chk; 6253 1.1.2.2 skrll 6254 1.1.2.2 skrll m_shutdown = NULL; 6255 1.1.2.2 skrll MGETHDR(m_shutdown, M_DONTWAIT, MT_HEADER); 6256 1.1.2.2 skrll if (m_shutdown == NULL) { 6257 1.1.2.2 skrll /* no mbuf's */ 6258 1.1.2.2 skrll return (-1); 6259 1.1.2.2 skrll } 6260 1.1.2.2 skrll m_shutdown->m_data += SCTP_MIN_OVERHEAD; 6261 1.1.2.2 skrll chk = (struct sctp_tmit_chunk *)SCTP_ZONE_GET(sctppcbinfo.ipi_zone_chunk); 6262 1.1.2.2 skrll if (chk == NULL) { 6263 1.1.2.2 skrll /* no memory */ 6264 1.1.2.2 skrll sctp_m_freem(m_shutdown); 6265 1.1.2.2 skrll return (-1); 6266 1.1.2.2 skrll } 6267 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk++; 6268 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 6269 1.1.2.2 skrll 6270 1.1.2.2 skrll chk->send_size = sizeof(struct sctp_shutdown_chunk); 6271 1.1.2.2 skrll chk->rec.chunk_id = SCTP_SHUTDOWN; 6272 1.1.2.2 skrll chk->sent = SCTP_DATAGRAM_UNSENT; 6273 1.1.2.2 skrll chk->snd_count = 0; 6274 1.1.2.2 skrll chk->flags = 0; 6275 1.1.2.2 skrll chk->asoc = &stcb->asoc; 6276 1.1.2.2 skrll chk->data = m_shutdown; 6277 1.1.2.2 skrll chk->whoTo = net; 6278 1.1.2.2 skrll net->ref_count++; 6279 1.1.2.2 skrll 6280 1.1.2.2 skrll shutdown_cp = mtod(m_shutdown, struct sctp_shutdown_chunk *); 6281 1.1.2.2 skrll shutdown_cp->ch.chunk_type = SCTP_SHUTDOWN; 6282 1.1.2.2 skrll shutdown_cp->ch.chunk_flags = 0; 6283 1.1.2.2 skrll shutdown_cp->ch.chunk_length = htons(chk->send_size); 6284 1.1.2.2 skrll shutdown_cp->cumulative_tsn_ack = htonl(stcb->asoc.cumulative_tsn); 6285 1.1.2.2 skrll m_shutdown->m_pkthdr.len = m_shutdown->m_len = chk->send_size; 6286 1.1.2.2 skrll m_shutdown->m_pkthdr.rcvif = 0; 6287 1.1.2.2 skrll TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next); 6288 1.1.2.2 skrll chk->asoc->ctrl_queue_cnt++; 6289 1.1.2.2 skrll 6290 1.1.2.2 skrll if ((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) || 6291 1.1.2.2 skrll (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_IN_TCPPOOL)) { 6292 1.1.2.2 skrll stcb->sctp_ep->sctp_socket->so_snd.sb_cc = 0; 6293 1.1.2.2 skrll soisdisconnecting(stcb->sctp_ep->sctp_socket); 6294 1.1.2.2 skrll } 6295 1.1.2.2 skrll return (0); 6296 1.1.2.2 skrll } 6297 1.1.2.2 skrll 6298 1.1.2.2 skrll int 6299 1.1.2.2 skrll sctp_send_asconf(struct sctp_tcb *stcb, struct sctp_nets *net) 6300 1.1.2.2 skrll { 6301 1.1.2.2 skrll /* 6302 1.1.2.2 skrll * formulate and queue an ASCONF to the peer 6303 1.1.2.2 skrll * ASCONF parameters should be queued on the assoc queue 6304 1.1.2.2 skrll */ 6305 1.1.2.2 skrll struct sctp_tmit_chunk *chk; 6306 1.1.2.2 skrll struct mbuf *m_asconf; 6307 1.1.2.2 skrll 6308 1.1.2.2 skrll /* compose an ASCONF chunk, maximum length is PMTU */ 6309 1.1.2.2 skrll m_asconf = sctp_compose_asconf(stcb); 6310 1.1.2.2 skrll if (m_asconf == NULL) { 6311 1.1.2.2 skrll return (-1); 6312 1.1.2.2 skrll } 6313 1.1.2.2 skrll chk = (struct sctp_tmit_chunk *)SCTP_ZONE_GET(sctppcbinfo.ipi_zone_chunk); 6314 1.1.2.2 skrll if (chk == NULL) { 6315 1.1.2.2 skrll /* no memory */ 6316 1.1.2.2 skrll sctp_m_freem(m_asconf); 6317 1.1.2.2 skrll return (-1); 6318 1.1.2.2 skrll } 6319 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk++; 6320 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 6321 1.1.2.2 skrll 6322 1.1.2.2 skrll chk->data = m_asconf; 6323 1.1.2.2 skrll chk->send_size = m_asconf->m_pkthdr.len; 6324 1.1.2.2 skrll chk->rec.chunk_id = SCTP_ASCONF; 6325 1.1.2.2 skrll chk->sent = SCTP_DATAGRAM_UNSENT; 6326 1.1.2.2 skrll chk->snd_count = 0; 6327 1.1.2.2 skrll chk->flags = 0; 6328 1.1.2.2 skrll chk->asoc = &stcb->asoc; 6329 1.1.2.2 skrll chk->whoTo = chk->asoc->primary_destination; 6330 1.1.2.2 skrll chk->whoTo->ref_count++; 6331 1.1.2.2 skrll TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next); 6332 1.1.2.2 skrll chk->asoc->ctrl_queue_cnt++; 6333 1.1.2.2 skrll return (0); 6334 1.1.2.2 skrll } 6335 1.1.2.2 skrll 6336 1.1.2.2 skrll int 6337 1.1.2.2 skrll sctp_send_asconf_ack(struct sctp_tcb *stcb, uint32_t retrans) 6338 1.1.2.2 skrll { 6339 1.1.2.2 skrll /* 6340 1.1.2.2 skrll * formulate and queue a asconf-ack back to sender 6341 1.1.2.2 skrll * the asconf-ack must be stored in the tcb 6342 1.1.2.2 skrll */ 6343 1.1.2.2 skrll struct sctp_tmit_chunk *chk; 6344 1.1.2.2 skrll struct mbuf *m_ack; 6345 1.1.2.2 skrll 6346 1.1.2.2 skrll /* is there a asconf-ack mbuf chain to send? */ 6347 1.1.2.2 skrll if (stcb->asoc.last_asconf_ack_sent == NULL) { 6348 1.1.2.2 skrll return (-1); 6349 1.1.2.2 skrll } 6350 1.1.2.2 skrll 6351 1.1.2.2 skrll /* copy the asconf_ack */ 6352 1.1.2.2 skrll #if defined(__FreeBSD__) || defined(__NetBSD__) 6353 1.1.2.2 skrll /* Supposedly the m_copypacket is a optimzation, 6354 1.1.2.2 skrll * use it if we can. 6355 1.1.2.2 skrll */ 6356 1.1.2.2 skrll if (stcb->asoc.last_asconf_ack_sent->m_flags & M_PKTHDR) { 6357 1.1.2.2 skrll m_ack = m_copypacket(stcb->asoc.last_asconf_ack_sent, M_DONTWAIT); 6358 1.1.2.2 skrll sctp_pegs[SCTP_CACHED_SRC]++; 6359 1.1.2.2 skrll } else 6360 1.1.2.2 skrll m_ack = m_copy(stcb->asoc.last_asconf_ack_sent, 0, M_COPYALL); 6361 1.1.2.2 skrll #else 6362 1.1.2.2 skrll m_ack = m_copy(stcb->asoc.last_asconf_ack_sent, 0, M_COPYALL); 6363 1.1.2.2 skrll #endif 6364 1.1.2.2 skrll if (m_ack == NULL) { 6365 1.1.2.2 skrll /* couldn't copy it */ 6366 1.1.2.2 skrll 6367 1.1.2.2 skrll return (-1); 6368 1.1.2.2 skrll } 6369 1.1.2.2 skrll chk = (struct sctp_tmit_chunk *)SCTP_ZONE_GET(sctppcbinfo.ipi_zone_chunk); 6370 1.1.2.2 skrll if (chk == NULL) { 6371 1.1.2.2 skrll /* no memory */ 6372 1.1.2.2 skrll if (m_ack) 6373 1.1.2.2 skrll sctp_m_freem(m_ack); 6374 1.1.2.2 skrll return (-1); 6375 1.1.2.2 skrll } 6376 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk++; 6377 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 6378 1.1.2.2 skrll 6379 1.1.2.2 skrll /* figure out where it goes to */ 6380 1.1.2.2 skrll if (retrans) { 6381 1.1.2.2 skrll /* we're doing a retransmission */ 6382 1.1.2.2 skrll if (stcb->asoc.used_alt_asconfack > 2) { 6383 1.1.2.2 skrll /* tried alternate nets already, go back */ 6384 1.1.2.2 skrll chk->whoTo = NULL; 6385 1.1.2.2 skrll } else { 6386 1.1.2.2 skrll /* need to try and alternate net */ 6387 1.1.2.2 skrll chk->whoTo = sctp_find_alternate_net(stcb, stcb->asoc.last_control_chunk_from); 6388 1.1.2.2 skrll stcb->asoc.used_alt_asconfack++; 6389 1.1.2.2 skrll } 6390 1.1.2.2 skrll if (chk->whoTo == NULL) { 6391 1.1.2.2 skrll /* no alternate */ 6392 1.1.2.2 skrll if (stcb->asoc.last_control_chunk_from == NULL) 6393 1.1.2.2 skrll chk->whoTo = stcb->asoc.primary_destination; 6394 1.1.2.2 skrll else 6395 1.1.2.2 skrll chk->whoTo = stcb->asoc.last_control_chunk_from; 6396 1.1.2.2 skrll stcb->asoc.used_alt_asconfack = 0; 6397 1.1.2.2 skrll } 6398 1.1.2.2 skrll } else { 6399 1.1.2.2 skrll /* normal case */ 6400 1.1.2.2 skrll if (stcb->asoc.last_control_chunk_from == NULL) 6401 1.1.2.2 skrll chk->whoTo = stcb->asoc.primary_destination; 6402 1.1.2.2 skrll else 6403 1.1.2.2 skrll chk->whoTo = stcb->asoc.last_control_chunk_from; 6404 1.1.2.2 skrll stcb->asoc.used_alt_asconfack = 0; 6405 1.1.2.2 skrll } 6406 1.1.2.2 skrll chk->data = m_ack; 6407 1.1.2.2 skrll chk->send_size = m_ack->m_pkthdr.len; 6408 1.1.2.2 skrll chk->rec.chunk_id = SCTP_ASCONF_ACK; 6409 1.1.2.2 skrll chk->sent = SCTP_DATAGRAM_UNSENT; 6410 1.1.2.2 skrll chk->snd_count = 0; 6411 1.1.2.2 skrll chk->flags = 0; 6412 1.1.2.2 skrll chk->asoc = &stcb->asoc; 6413 1.1.2.2 skrll chk->whoTo->ref_count++; 6414 1.1.2.2 skrll TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next); 6415 1.1.2.2 skrll chk->asoc->ctrl_queue_cnt++; 6416 1.1.2.2 skrll return (0); 6417 1.1.2.2 skrll } 6418 1.1.2.2 skrll 6419 1.1.2.2 skrll 6420 1.1.2.2 skrll static int 6421 1.1.2.2 skrll sctp_chunk_retransmission(struct sctp_inpcb *inp, 6422 1.1.2.2 skrll struct sctp_tcb *stcb, 6423 1.1.2.2 skrll struct sctp_association *asoc, 6424 1.1.2.2 skrll int *cnt_out, struct timeval *now, int *now_filled) 6425 1.1.2.2 skrll { 6426 1.1.2.2 skrll /* 6427 1.1.2.2 skrll * send out one MTU of retransmission. 6428 1.1.2.2 skrll * If fast_retransmit is happening we ignore the cwnd. 6429 1.1.2.2 skrll * Otherwise we obey the cwnd and rwnd. 6430 1.1.2.2 skrll * For a Cookie or Asconf in the control chunk queue we retransmit 6431 1.1.2.2 skrll * them by themselves. 6432 1.1.2.2 skrll * 6433 1.1.2.2 skrll * For data chunks we will pick out the lowest TSN's in the 6434 1.1.2.2 skrll * sent_queue marked for resend and bundle them all together 6435 1.1.2.2 skrll * (up to a MTU of destination). The address to send to should 6436 1.1.2.2 skrll * have been selected/changed where the retransmission was 6437 1.1.2.2 skrll * marked (i.e. in FR or t3-timeout routines). 6438 1.1.2.2 skrll */ 6439 1.1.2.2 skrll struct sctp_tmit_chunk *data_list[SCTP_MAX_DATA_BUNDLING]; 6440 1.1.2.2 skrll struct sctp_tmit_chunk *chk, *fwd; 6441 1.1.2.2 skrll struct mbuf *m; 6442 1.1.2.2 skrll struct sctphdr *shdr; 6443 1.1.2.2 skrll int asconf; 6444 1.1.2.2 skrll struct sctp_nets *net; 6445 1.1.2.2 skrll int no_fragmentflg, bundle_at, cnt_thru; 6446 1.1.2.2 skrll unsigned int mtu; 6447 1.1.2.2 skrll int error, i, one_chunk, fwd_tsn, ctl_cnt, tmr_started; 6448 1.1.2.2 skrll 6449 1.1.2.2 skrll tmr_started = ctl_cnt = bundle_at = error = 0; 6450 1.1.2.2 skrll no_fragmentflg = 1; 6451 1.1.2.2 skrll asconf = 0; 6452 1.1.2.2 skrll fwd_tsn = 0; 6453 1.1.2.2 skrll *cnt_out = 0; 6454 1.1.2.2 skrll fwd = NULL; 6455 1.1.2.2 skrll m = NULL; 6456 1.1.2.2 skrll #ifdef SCTP_AUDITING_ENABLED 6457 1.1.2.2 skrll sctp_audit_log(0xC3, 1); 6458 1.1.2.2 skrll #endif 6459 1.1.2.2 skrll if (TAILQ_EMPTY(&asoc->sent_queue)) { 6460 1.1.2.2 skrll #ifdef SCTP_DEBUG 6461 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 6462 1.1.2.2 skrll printf("SCTP hits empty queue with cnt set to %d?\n", 6463 1.1.2.2 skrll asoc->sent_queue_retran_cnt); 6464 1.1.2.2 skrll } 6465 1.1.2.2 skrll #endif 6466 1.1.2.2 skrll asoc->sent_queue_cnt = 0; 6467 1.1.2.2 skrll asoc->sent_queue_cnt_removeable = 0; 6468 1.1.2.2 skrll } 6469 1.1.2.2 skrll TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) { 6470 1.1.2.2 skrll if (chk->sent != SCTP_DATAGRAM_RESEND) { 6471 1.1.2.2 skrll /* we only worry about things marked for resend */ 6472 1.1.2.2 skrll continue; 6473 1.1.2.2 skrll } 6474 1.1.2.2 skrll if ((chk->rec.chunk_id == SCTP_COOKIE_ECHO) || 6475 1.1.2.2 skrll (chk->rec.chunk_id == SCTP_ASCONF) || 6476 1.1.2.2 skrll (chk->rec.chunk_id == SCTP_STREAM_RESET) || 6477 1.1.2.2 skrll (chk->rec.chunk_id == SCTP_FORWARD_CUM_TSN)) { 6478 1.1.2.2 skrll if (chk->rec.chunk_id == SCTP_STREAM_RESET) { 6479 1.1.2.2 skrll /* For stream reset we only retran the request 6480 1.1.2.2 skrll * not the response. 6481 1.1.2.2 skrll */ 6482 1.1.2.2 skrll struct sctp_stream_reset_req *strreq; 6483 1.1.2.2 skrll strreq = mtod(chk->data, struct sctp_stream_reset_req *); 6484 1.1.2.2 skrll if (strreq->sr_req.ph.param_type != ntohs(SCTP_STR_RESET_REQUEST)) { 6485 1.1.2.2 skrll continue; 6486 1.1.2.2 skrll } 6487 1.1.2.2 skrll } 6488 1.1.2.2 skrll ctl_cnt++; 6489 1.1.2.2 skrll if (chk->rec.chunk_id == SCTP_ASCONF) { 6490 1.1.2.2 skrll no_fragmentflg = 1; 6491 1.1.2.2 skrll asconf = 1; 6492 1.1.2.2 skrll } 6493 1.1.2.2 skrll if (chk->rec.chunk_id == SCTP_FORWARD_CUM_TSN) { 6494 1.1.2.2 skrll fwd_tsn = 1; 6495 1.1.2.2 skrll fwd = chk; 6496 1.1.2.2 skrll } 6497 1.1.2.2 skrll m = sctp_copy_mbufchain(chk->data, m); 6498 1.1.2.2 skrll break; 6499 1.1.2.2 skrll } 6500 1.1.2.2 skrll } 6501 1.1.2.2 skrll one_chunk = 0; 6502 1.1.2.2 skrll cnt_thru = 0; 6503 1.1.2.2 skrll /* do we have control chunks to retransmit? */ 6504 1.1.2.2 skrll if (m != NULL) { 6505 1.1.2.2 skrll /* Start a timer no matter if we suceed or fail */ 6506 1.1.2.2 skrll if (chk->rec.chunk_id == SCTP_COOKIE_ECHO) { 6507 1.1.2.2 skrll sctp_timer_start(SCTP_TIMER_TYPE_COOKIE, inp, stcb, chk->whoTo); 6508 1.1.2.2 skrll } else if (chk->rec.chunk_id == SCTP_ASCONF) 6509 1.1.2.2 skrll sctp_timer_start(SCTP_TIMER_TYPE_ASCONF, inp, stcb, chk->whoTo); 6510 1.1.2.2 skrll 6511 1.1.2.2 skrll if (m->m_len == 0) { 6512 1.1.2.2 skrll /* Special case for when you get a 0 len 6513 1.1.2.2 skrll * mbuf at the head due to the lack 6514 1.1.2.2 skrll * of a MHDR at the beginning. 6515 1.1.2.2 skrll */ 6516 1.1.2.2 skrll m->m_len = sizeof(struct sctphdr); 6517 1.1.2.2 skrll } else { 6518 1.1.2.2 skrll M_PREPEND(m, sizeof(struct sctphdr), M_DONTWAIT); 6519 1.1.2.2 skrll if (m == NULL) { 6520 1.1.2.2 skrll return (ENOBUFS); 6521 1.1.2.2 skrll } 6522 1.1.2.2 skrll } 6523 1.1.2.2 skrll shdr = mtod(m, struct sctphdr *); 6524 1.1.2.2 skrll shdr->src_port = inp->sctp_lport; 6525 1.1.2.2 skrll shdr->dest_port = stcb->rport; 6526 1.1.2.2 skrll shdr->v_tag = htonl(stcb->asoc.peer_vtag); 6527 1.1.2.2 skrll shdr->checksum = 0; 6528 1.1.2.2 skrll chk->snd_count++; /* update our count */ 6529 1.1.2.2 skrll 6530 1.1.2.2 skrll if ((error = sctp_lowlevel_chunk_output(inp, stcb, chk->whoTo, 6531 1.1.2.2 skrll rtcache_getdst(&chk->whoTo->ro), m, 6532 1.1.2.2 skrll no_fragmentflg, 0, NULL, asconf))) { 6533 1.1.2.2 skrll sctp_pegs[SCTP_DATA_OUT_ERR]++; 6534 1.1.2.2 skrll return (error); 6535 1.1.2.2 skrll } 6536 1.1.2.2 skrll /* 6537 1.1.2.2 skrll *We don't want to mark the net->sent time here since this 6538 1.1.2.2 skrll * we use this for HB and retrans cannot measure RTT 6539 1.1.2.2 skrll */ 6540 1.1.2.2 skrll /* SCTP_GETTIME_TIMEVAL(&chk->whoTo->last_sent_time);*/ 6541 1.1.2.2 skrll *cnt_out += 1; 6542 1.1.2.2 skrll chk->sent = SCTP_DATAGRAM_SENT; 6543 1.1.2.2 skrll sctp_ucount_decr(asoc->sent_queue_retran_cnt); 6544 1.1.2.2 skrll if (fwd_tsn == 0) { 6545 1.1.2.2 skrll return (0); 6546 1.1.2.2 skrll } else { 6547 1.1.2.2 skrll /* Clean up the fwd-tsn list */ 6548 1.1.2.2 skrll sctp_clean_up_ctl (asoc); 6549 1.1.2.2 skrll return (0); 6550 1.1.2.2 skrll } 6551 1.1.2.2 skrll } 6552 1.1.2.2 skrll /* Ok, it is just data retransmission we need to do or 6553 1.1.2.2 skrll * that and a fwd-tsn with it all. 6554 1.1.2.2 skrll */ 6555 1.1.2.2 skrll if (TAILQ_EMPTY(&asoc->sent_queue)) { 6556 1.1.2.2 skrll return (-1); 6557 1.1.2.2 skrll } 6558 1.1.2.2 skrll #ifdef SCTP_DEBUG 6559 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 6560 1.1.2.2 skrll printf("Normal chunk retransmission cnt:%d\n", 6561 1.1.2.2 skrll asoc->sent_queue_retran_cnt); 6562 1.1.2.2 skrll } 6563 1.1.2.2 skrll #endif 6564 1.1.2.2 skrll if ((SCTP_GET_STATE(asoc) == SCTP_STATE_COOKIE_ECHOED) || 6565 1.1.2.2 skrll (SCTP_GET_STATE(asoc) == SCTP_STATE_COOKIE_WAIT)) { 6566 1.1.2.2 skrll /* not yet open, resend the cookie and that is it */ 6567 1.1.2.2 skrll return (1); 6568 1.1.2.2 skrll } 6569 1.1.2.2 skrll 6570 1.1.2.2 skrll 6571 1.1.2.2 skrll #ifdef SCTP_AUDITING_ENABLED 6572 1.1.2.2 skrll sctp_auditing(20, inp, stcb, NULL); 6573 1.1.2.2 skrll #endif 6574 1.1.2.2 skrll TAILQ_FOREACH(chk, &asoc->sent_queue, sctp_next) { 6575 1.1.2.2 skrll if (chk->sent != SCTP_DATAGRAM_RESEND) { 6576 1.1.2.2 skrll /* No, not sent to this net or not ready for rtx */ 6577 1.1.2.2 skrll continue; 6578 1.1.2.2 skrll 6579 1.1.2.2 skrll } 6580 1.1.2.2 skrll /* pick up the net */ 6581 1.1.2.2 skrll net = chk->whoTo; 6582 1.1.2.2 skrll if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) { 6583 1.1.2.2 skrll mtu = (net->mtu - SCTP_MIN_OVERHEAD); 6584 1.1.2.2 skrll } else { 6585 1.1.2.2 skrll mtu = net->mtu- SCTP_MIN_V4_OVERHEAD; 6586 1.1.2.2 skrll } 6587 1.1.2.2 skrll 6588 1.1.2.2 skrll if ((asoc->peers_rwnd < mtu) && (asoc->total_flight > 0)) { 6589 1.1.2.2 skrll /* No room in peers rwnd */ 6590 1.1.2.2 skrll uint32_t tsn; 6591 1.1.2.2 skrll tsn = asoc->last_acked_seq + 1; 6592 1.1.2.2 skrll if (tsn == chk->rec.data.TSN_seq) { 6593 1.1.2.2 skrll /* we make a special exception for this case. 6594 1.1.2.2 skrll * The peer has no rwnd but is missing the 6595 1.1.2.2 skrll * lowest chunk.. which is probably what is 6596 1.1.2.2 skrll * holding up the rwnd. 6597 1.1.2.2 skrll */ 6598 1.1.2.2 skrll goto one_chunk_around; 6599 1.1.2.2 skrll } 6600 1.1.2.2 skrll #ifdef SCTP_DEBUG 6601 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 6602 1.1.2.2 skrll printf("blocked-peers_rwnd:%d tf:%d\n", 6603 1.1.2.2 skrll (int)asoc->peers_rwnd, 6604 1.1.2.2 skrll (int)asoc->total_flight); 6605 1.1.2.2 skrll } 6606 1.1.2.2 skrll #endif 6607 1.1.2.2 skrll sctp_pegs[SCTP_RWND_BLOCKED]++; 6608 1.1.2.2 skrll return (1); 6609 1.1.2.2 skrll } 6610 1.1.2.2 skrll one_chunk_around: 6611 1.1.2.2 skrll if (asoc->peers_rwnd < mtu) { 6612 1.1.2.2 skrll one_chunk = 1; 6613 1.1.2.2 skrll } 6614 1.1.2.2 skrll #ifdef SCTP_AUDITING_ENABLED 6615 1.1.2.2 skrll sctp_audit_log(0xC3, 2); 6616 1.1.2.2 skrll #endif 6617 1.1.2.2 skrll bundle_at = 0; 6618 1.1.2.2 skrll m = NULL; 6619 1.1.2.2 skrll net->fast_retran_ip = 0; 6620 1.1.2.2 skrll if (chk->rec.data.doing_fast_retransmit == 0) { 6621 1.1.2.2 skrll /* if no FR in progress skip destination that 6622 1.1.2.2 skrll * have flight_size > cwnd. 6623 1.1.2.2 skrll */ 6624 1.1.2.2 skrll if (net->flight_size >= net->cwnd) { 6625 1.1.2.2 skrll sctp_pegs[SCTP_CWND_BLOCKED]++; 6626 1.1.2.2 skrll continue; 6627 1.1.2.2 skrll } 6628 1.1.2.2 skrll } else { 6629 1.1.2.2 skrll /* Mark the destination net to have FR recovery 6630 1.1.2.2 skrll * limits put on it. 6631 1.1.2.2 skrll */ 6632 1.1.2.2 skrll net->fast_retran_ip = 1; 6633 1.1.2.2 skrll } 6634 1.1.2.2 skrll 6635 1.1.2.2 skrll if ((chk->send_size <= mtu) || (chk->flags & CHUNK_FLAGS_FRAGMENT_OK)) { 6636 1.1.2.2 skrll /* ok we will add this one */ 6637 1.1.2.2 skrll m = sctp_copy_mbufchain(chk->data, m); 6638 1.1.2.2 skrll if (m == NULL) { 6639 1.1.2.2 skrll return (ENOMEM); 6640 1.1.2.2 skrll } 6641 1.1.2.2 skrll /* upate our MTU size */ 6642 1.1.2.2 skrll /* Do clear IP_DF ? */ 6643 1.1.2.2 skrll if (chk->flags & CHUNK_FLAGS_FRAGMENT_OK) { 6644 1.1.2.2 skrll no_fragmentflg = 0; 6645 1.1.2.2 skrll } 6646 1.1.2.2 skrll mtu -= chk->send_size; 6647 1.1.2.2 skrll data_list[bundle_at++] = chk; 6648 1.1.2.2 skrll if (one_chunk && (asoc->total_flight <= 0)) { 6649 1.1.2.2 skrll sctp_pegs[SCTP_WINDOW_PROBES]++; 6650 1.1.2.2 skrll chk->rec.data.state_flags |= SCTP_WINDOW_PROBE; 6651 1.1.2.2 skrll } 6652 1.1.2.2 skrll } 6653 1.1.2.2 skrll if (one_chunk == 0) { 6654 1.1.2.2 skrll /* now are there anymore forward from chk to pick up?*/ 6655 1.1.2.2 skrll fwd = TAILQ_NEXT(chk, sctp_next); 6656 1.1.2.2 skrll while (fwd) { 6657 1.1.2.2 skrll if (fwd->sent != SCTP_DATAGRAM_RESEND) { 6658 1.1.2.2 skrll /* Nope, not for retran */ 6659 1.1.2.2 skrll fwd = TAILQ_NEXT(fwd, sctp_next); 6660 1.1.2.2 skrll continue; 6661 1.1.2.2 skrll } 6662 1.1.2.2 skrll if (fwd->whoTo != net) { 6663 1.1.2.2 skrll /* Nope, not the net in question */ 6664 1.1.2.2 skrll fwd = TAILQ_NEXT(fwd, sctp_next); 6665 1.1.2.2 skrll continue; 6666 1.1.2.2 skrll } 6667 1.1.2.2 skrll if (fwd->send_size <= mtu) { 6668 1.1.2.2 skrll m = sctp_copy_mbufchain(fwd->data, m); 6669 1.1.2.2 skrll if (m == NULL) { 6670 1.1.2.2 skrll return (ENOMEM); 6671 1.1.2.2 skrll } 6672 1.1.2.2 skrll /* upate our MTU size */ 6673 1.1.2.2 skrll /* Do clear IP_DF ? */ 6674 1.1.2.2 skrll if (fwd->flags & CHUNK_FLAGS_FRAGMENT_OK) { 6675 1.1.2.2 skrll no_fragmentflg = 0; 6676 1.1.2.2 skrll } 6677 1.1.2.2 skrll mtu -= fwd->send_size; 6678 1.1.2.2 skrll data_list[bundle_at++] = fwd; 6679 1.1.2.2 skrll if (bundle_at >= SCTP_MAX_DATA_BUNDLING) { 6680 1.1.2.2 skrll break; 6681 1.1.2.2 skrll } 6682 1.1.2.2 skrll fwd = TAILQ_NEXT(fwd, sctp_next); 6683 1.1.2.2 skrll } else { 6684 1.1.2.2 skrll /* can't fit so we are done */ 6685 1.1.2.2 skrll break; 6686 1.1.2.2 skrll } 6687 1.1.2.2 skrll } 6688 1.1.2.2 skrll } 6689 1.1.2.2 skrll /* Is there something to send for this destination? */ 6690 1.1.2.2 skrll if (m) { 6691 1.1.2.2 skrll /* No matter if we fail/or suceed we should 6692 1.1.2.2 skrll * start a timer. A failure is like a lost 6693 1.1.2.2 skrll * IP packet :-) 6694 1.1.2.2 skrll */ 6695 1.1.2.2 skrll if (!callout_pending(&net->rxt_timer.timer)) { 6696 1.1.2.2 skrll /* no timer running on this destination 6697 1.1.2.2 skrll * restart it. 6698 1.1.2.2 skrll */ 6699 1.1.2.2 skrll sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, net); 6700 1.1.2.2 skrll tmr_started = 1; 6701 1.1.2.2 skrll } 6702 1.1.2.2 skrll if (m->m_len == 0) { 6703 1.1.2.2 skrll /* Special case for when you get a 0 len 6704 1.1.2.2 skrll * mbuf at the head due to the lack 6705 1.1.2.2 skrll * of a MHDR at the beginning. 6706 1.1.2.2 skrll */ 6707 1.1.2.2 skrll m->m_len = sizeof(struct sctphdr); 6708 1.1.2.2 skrll } else { 6709 1.1.2.2 skrll M_PREPEND(m, sizeof(struct sctphdr), M_DONTWAIT); 6710 1.1.2.2 skrll if (m == NULL) { 6711 1.1.2.2 skrll return (ENOBUFS); 6712 1.1.2.2 skrll } 6713 1.1.2.2 skrll } 6714 1.1.2.2 skrll shdr = mtod(m, struct sctphdr *); 6715 1.1.2.2 skrll shdr->src_port = inp->sctp_lport; 6716 1.1.2.2 skrll shdr->dest_port = stcb->rport; 6717 1.1.2.2 skrll shdr->v_tag = htonl(stcb->asoc.peer_vtag); 6718 1.1.2.2 skrll shdr->checksum = 0; 6719 1.1.2.2 skrll 6720 1.1.2.2 skrll /* Now lets send it, if there is anything to send :> */ 6721 1.1.2.2 skrll if ((error = sctp_lowlevel_chunk_output(inp, stcb, net, 6722 1.1.2.2 skrll rtcache_getdst(&net->ro), 6723 1.1.2.2 skrll m, 6724 1.1.2.2 skrll no_fragmentflg, 0, NULL, asconf))) { 6725 1.1.2.2 skrll /* error, we could not output */ 6726 1.1.2.2 skrll sctp_pegs[SCTP_DATA_OUT_ERR]++; 6727 1.1.2.2 skrll return (error); 6728 1.1.2.2 skrll } 6729 1.1.2.2 skrll /* For HB's */ 6730 1.1.2.2 skrll /* 6731 1.1.2.2 skrll * We don't want to mark the net->sent time here since 6732 1.1.2.2 skrll * this we use this for HB and retrans cannot measure 6733 1.1.2.2 skrll * RTT 6734 1.1.2.2 skrll */ 6735 1.1.2.2 skrll /* SCTP_GETTIME_TIMEVAL(&net->last_sent_time);*/ 6736 1.1.2.2 skrll 6737 1.1.2.2 skrll /* For auto-close */ 6738 1.1.2.2 skrll cnt_thru++; 6739 1.1.2.2 skrll if (*now_filled == 0) { 6740 1.1.2.2 skrll SCTP_GETTIME_TIMEVAL(&asoc->time_last_sent); 6741 1.1.2.2 skrll *now = asoc->time_last_sent; 6742 1.1.2.2 skrll *now_filled = 1; 6743 1.1.2.2 skrll } else { 6744 1.1.2.2 skrll asoc->time_last_sent = *now; 6745 1.1.2.2 skrll } 6746 1.1.2.2 skrll *cnt_out += bundle_at; 6747 1.1.2.2 skrll #ifdef SCTP_AUDITING_ENABLED 6748 1.1.2.2 skrll sctp_audit_log(0xC4, bundle_at); 6749 1.1.2.2 skrll #endif 6750 1.1.2.2 skrll for (i = 0; i < bundle_at; i++) { 6751 1.1.2.2 skrll sctp_pegs[SCTP_RETRANTSN_SENT]++; 6752 1.1.2.2 skrll data_list[i]->sent = SCTP_DATAGRAM_SENT; 6753 1.1.2.2 skrll data_list[i]->snd_count++; 6754 1.1.2.2 skrll sctp_ucount_decr(asoc->sent_queue_retran_cnt); 6755 1.1.2.2 skrll /* record the time */ 6756 1.1.2.2 skrll data_list[i]->sent_rcv_time = asoc->time_last_sent; 6757 1.1.2.2 skrll net->flight_size += data_list[i]->book_size; 6758 1.1.2.2 skrll asoc->total_flight += data_list[i]->book_size; 6759 1.1.2.2 skrll asoc->total_flight_count++; 6760 1.1.2.2 skrll 6761 1.1.2.2 skrll #ifdef SCTP_LOG_RWND 6762 1.1.2.2 skrll sctp_log_rwnd(SCTP_DECREASE_PEER_RWND, 6763 1.1.2.2 skrll asoc->peers_rwnd , data_list[i]->send_size, sctp_peer_chunk_oh); 6764 1.1.2.2 skrll #endif 6765 1.1.2.2 skrll asoc->peers_rwnd = sctp_sbspace_sub(asoc->peers_rwnd, 6766 1.1.2.2 skrll (u_int32_t)(data_list[i]->send_size + sctp_peer_chunk_oh)); 6767 1.1.2.2 skrll if (asoc->peers_rwnd < stcb->sctp_ep->sctp_ep.sctp_sws_sender) { 6768 1.1.2.2 skrll /* SWS sender side engages */ 6769 1.1.2.2 skrll asoc->peers_rwnd = 0; 6770 1.1.2.2 skrll } 6771 1.1.2.2 skrll 6772 1.1.2.2 skrll if ((i == 0) && 6773 1.1.2.2 skrll (data_list[i]->rec.data.doing_fast_retransmit)) { 6774 1.1.2.2 skrll sctp_pegs[SCTP_FAST_RETRAN]++; 6775 1.1.2.2 skrll if ((data_list[i] == TAILQ_FIRST(&asoc->sent_queue)) && 6776 1.1.2.2 skrll (tmr_started == 0)) { 6777 1.1.2.2 skrll /* 6778 1.1.2.2 skrll * ok we just fast-retrans'd 6779 1.1.2.2 skrll * the lowest TSN, i.e the 6780 1.1.2.2 skrll * first on the list. In this 6781 1.1.2.2 skrll * case we want to give some 6782 1.1.2.2 skrll * more time to get a SACK 6783 1.1.2.2 skrll * back without a t3-expiring. 6784 1.1.2.2 skrll */ 6785 1.1.2.2 skrll sctp_timer_stop(SCTP_TIMER_TYPE_SEND, inp, stcb, net); 6786 1.1.2.2 skrll sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, net); 6787 1.1.2.2 skrll } 6788 1.1.2.2 skrll } 6789 1.1.2.2 skrll } 6790 1.1.2.2 skrll #ifdef SCTP_AUDITING_ENABLED 6791 1.1.2.2 skrll sctp_auditing(21, inp, stcb, NULL); 6792 1.1.2.2 skrll #endif 6793 1.1.2.2 skrll } else { 6794 1.1.2.2 skrll /* None will fit */ 6795 1.1.2.2 skrll return (1); 6796 1.1.2.2 skrll } 6797 1.1.2.2 skrll if (asoc->sent_queue_retran_cnt <= 0) { 6798 1.1.2.2 skrll /* all done we have no more to retran */ 6799 1.1.2.2 skrll asoc->sent_queue_retran_cnt = 0; 6800 1.1.2.2 skrll break; 6801 1.1.2.2 skrll } 6802 1.1.2.2 skrll if (one_chunk) { 6803 1.1.2.2 skrll /* No more room in rwnd */ 6804 1.1.2.2 skrll return (1); 6805 1.1.2.2 skrll } 6806 1.1.2.2 skrll /* stop the for loop here. we sent out a packet */ 6807 1.1.2.2 skrll break; 6808 1.1.2.2 skrll } 6809 1.1.2.2 skrll return (0); 6810 1.1.2.2 skrll } 6811 1.1.2.2 skrll 6812 1.1.2.2 skrll 6813 1.1.2.2 skrll static int 6814 1.1.2.2 skrll sctp_timer_validation(struct sctp_inpcb *inp, 6815 1.1.2.2 skrll struct sctp_tcb *stcb, 6816 1.1.2.2 skrll struct sctp_association *asoc, 6817 1.1.2.2 skrll int ret) 6818 1.1.2.2 skrll { 6819 1.1.2.2 skrll struct sctp_nets *net; 6820 1.1.2.2 skrll /* Validate that a timer is running somewhere */ 6821 1.1.2.2 skrll TAILQ_FOREACH(net, &asoc->nets, sctp_next) { 6822 1.1.2.2 skrll if (callout_pending(&net->rxt_timer.timer)) { 6823 1.1.2.2 skrll /* Here is a timer */ 6824 1.1.2.2 skrll return (ret); 6825 1.1.2.2 skrll } 6826 1.1.2.2 skrll } 6827 1.1.2.2 skrll /* Gak, we did not have a timer somewhere */ 6828 1.1.2.2 skrll #ifdef SCTP_DEBUG 6829 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 6830 1.1.2.2 skrll printf("Deadlock avoided starting timer on a dest at retran\n"); 6831 1.1.2.2 skrll } 6832 1.1.2.2 skrll #endif 6833 1.1.2.2 skrll sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, asoc->primary_destination); 6834 1.1.2.2 skrll return (ret); 6835 1.1.2.2 skrll } 6836 1.1.2.2 skrll 6837 1.1.2.2 skrll int 6838 1.1.2.2 skrll sctp_chunk_output(struct sctp_inpcb *inp, 6839 1.1.2.2 skrll struct sctp_tcb *stcb, 6840 1.1.2.2 skrll int from_where) 6841 1.1.2.2 skrll { 6842 1.1.2.2 skrll /* Ok this is the generic chunk service queue. 6843 1.1.2.2 skrll * we must do the following: 6844 1.1.2.2 skrll * - See if there are retransmits pending, if so we 6845 1.1.2.2 skrll * must do these first and return. 6846 1.1.2.2 skrll * - Service the stream queue that is next, 6847 1.1.2.2 skrll * moving any message (note I must get a complete 6848 1.1.2.2 skrll * message i.e. FIRST/MIDDLE and LAST to the out 6849 1.1.2.2 skrll * queue in one pass) and assigning TSN's 6850 1.1.2.2 skrll * - Check to see if the cwnd/rwnd allows any output, if 6851 1.1.2.2 skrll * so we go ahead and fomulate and send the low level 6852 1.1.2.2 skrll * chunks. Making sure to combine any control in the 6853 1.1.2.2 skrll * control chunk queue also. 6854 1.1.2.2 skrll */ 6855 1.1.2.2 skrll struct sctp_association *asoc; 6856 1.1.2.2 skrll struct sctp_nets *net; 6857 1.1.2.2 skrll int error, num_out, tot_out, ret, reason_code, burst_cnt, burst_limit; 6858 1.1.2.2 skrll struct timeval now; 6859 1.1.2.2 skrll int now_filled=0; 6860 1.1.2.2 skrll int cwnd_full=0; 6861 1.1.2.2 skrll asoc = &stcb->asoc; 6862 1.1.2.2 skrll tot_out = 0; 6863 1.1.2.2 skrll num_out = 0; 6864 1.1.2.2 skrll reason_code = 0; 6865 1.1.2.2 skrll sctp_pegs[SCTP_CALLS_TO_CO]++; 6866 1.1.2.2 skrll #ifdef SCTP_DEBUG 6867 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 6868 1.1.2.2 skrll printf("in co - retran count:%d\n", asoc->sent_queue_retran_cnt); 6869 1.1.2.2 skrll } 6870 1.1.2.2 skrll #endif 6871 1.1.2.2 skrll while (asoc->sent_queue_retran_cnt) { 6872 1.1.2.2 skrll /* Ok, it is retransmission time only, we send out only ONE 6873 1.1.2.2 skrll * packet with a single call off to the retran code. 6874 1.1.2.2 skrll */ 6875 1.1.2.2 skrll ret = sctp_chunk_retransmission(inp, stcb, asoc, &num_out, &now, &now_filled); 6876 1.1.2.2 skrll if (ret > 0) { 6877 1.1.2.2 skrll /* Can't send anymore */ 6878 1.1.2.2 skrll #ifdef SCTP_DEBUG 6879 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 6880 1.1.2.2 skrll printf("retransmission ret:%d -- full\n", ret); 6881 1.1.2.2 skrll } 6882 1.1.2.2 skrll #endif 6883 1.1.2.2 skrll /* 6884 1.1.2.2 skrll * now lets push out control by calling med-level 6885 1.1.2.2 skrll * output once. this assures that we WILL send HB's 6886 1.1.2.2 skrll * if queued too. 6887 1.1.2.2 skrll */ 6888 1.1.2.2 skrll (void)sctp_med_chunk_output(inp, stcb, asoc, &num_out, &reason_code, 1, 6889 1.1.2.2 skrll &cwnd_full, from_where, 6890 1.1.2.2 skrll &now, &now_filled); 6891 1.1.2.2 skrll #ifdef SCTP_DEBUG 6892 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 6893 1.1.2.2 skrll printf("Control send outputs:%d@full\n", num_out); 6894 1.1.2.2 skrll } 6895 1.1.2.2 skrll #endif 6896 1.1.2.2 skrll #ifdef SCTP_AUDITING_ENABLED 6897 1.1.2.2 skrll sctp_auditing(8, inp, stcb, NULL); 6898 1.1.2.2 skrll #endif 6899 1.1.2.2 skrll return (sctp_timer_validation(inp, stcb, asoc, ret)); 6900 1.1.2.2 skrll } 6901 1.1.2.2 skrll if (ret < 0) { 6902 1.1.2.2 skrll /* 6903 1.1.2.2 skrll * The count was off.. retran is not happening so do 6904 1.1.2.2 skrll * the normal retransmission. 6905 1.1.2.2 skrll */ 6906 1.1.2.2 skrll #ifdef SCTP_DEBUG 6907 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 6908 1.1.2.2 skrll printf("Done with retrans, none left fill up window\n"); 6909 1.1.2.2 skrll } 6910 1.1.2.2 skrll #endif 6911 1.1.2.2 skrll #ifdef SCTP_AUDITING_ENABLED 6912 1.1.2.2 skrll sctp_auditing(9, inp, stcb, NULL); 6913 1.1.2.2 skrll #endif 6914 1.1.2.2 skrll break; 6915 1.1.2.2 skrll } 6916 1.1.2.2 skrll if (from_where == 1) { 6917 1.1.2.2 skrll /* Only one transmission allowed out of a timeout */ 6918 1.1.2.2 skrll #ifdef SCTP_DEBUG 6919 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 6920 1.1.2.2 skrll printf("Only one packet allowed out\n"); 6921 1.1.2.2 skrll } 6922 1.1.2.2 skrll #endif 6923 1.1.2.2 skrll #ifdef SCTP_AUDITING_ENABLED 6924 1.1.2.2 skrll sctp_auditing(10, inp, stcb, NULL); 6925 1.1.2.2 skrll #endif 6926 1.1.2.2 skrll /* Push out any control */ 6927 1.1.2.2 skrll (void)sctp_med_chunk_output(inp, stcb, asoc, &num_out, &reason_code, 1, &cwnd_full, from_where, 6928 1.1.2.2 skrll &now, &now_filled); 6929 1.1.2.2 skrll return (ret); 6930 1.1.2.2 skrll } 6931 1.1.2.2 skrll if ((num_out == 0) && (ret == 0)) { 6932 1.1.2.2 skrll /* No more retrans to send */ 6933 1.1.2.2 skrll break; 6934 1.1.2.2 skrll } 6935 1.1.2.2 skrll } 6936 1.1.2.2 skrll #ifdef SCTP_AUDITING_ENABLED 6937 1.1.2.2 skrll sctp_auditing(12, inp, stcb, NULL); 6938 1.1.2.2 skrll #endif 6939 1.1.2.2 skrll /* Check for bad destinations, if they exist move chunks around. */ 6940 1.1.2.2 skrll burst_limit = asoc->max_burst; 6941 1.1.2.2 skrll TAILQ_FOREACH(net, &asoc->nets, sctp_next) { 6942 1.1.2.2 skrll if ((net->dest_state & SCTP_ADDR_NOT_REACHABLE) == 6943 1.1.2.2 skrll SCTP_ADDR_NOT_REACHABLE) { 6944 1.1.2.2 skrll /* 6945 1.1.2.2 skrll * if possible move things off of this address 6946 1.1.2.2 skrll * we still may send below due to the dormant state 6947 1.1.2.2 skrll * but we try to find an alternate address to send 6948 1.1.2.2 skrll * to and if we have one we move all queued data on 6949 1.1.2.2 skrll * the out wheel to this alternate address. 6950 1.1.2.2 skrll */ 6951 1.1.2.2 skrll sctp_move_to_an_alt(stcb, asoc, net); 6952 1.1.2.2 skrll } else { 6953 1.1.2.2 skrll /* 6954 1.1.2.2 skrll if ((asoc->sat_network) || (net->addr_is_local)) { 6955 1.1.2.2 skrll burst_limit = asoc->max_burst * SCTP_SAT_NETWORK_BURST_INCR; 6956 1.1.2.2 skrll } 6957 1.1.2.2 skrll */ 6958 1.1.2.2 skrll #ifdef SCTP_DEBUG 6959 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 6960 1.1.2.2 skrll printf("examined net:%p burst limit:%d\n", net, asoc->max_burst); 6961 1.1.2.2 skrll } 6962 1.1.2.2 skrll #endif 6963 1.1.2.2 skrll 6964 1.1.2.2 skrll #ifdef SCTP_USE_ALLMAN_BURST 6965 1.1.2.2 skrll if ((net->flight_size+(burst_limit*net->mtu)) < net->cwnd) { 6966 1.1.2.2 skrll if (net->ssthresh < net->cwnd) 6967 1.1.2.2 skrll net->ssthresh = net->cwnd; 6968 1.1.2.2 skrll net->cwnd = (net->flight_size+(burst_limit*net->mtu)); 6969 1.1.2.2 skrll #ifdef SCTP_LOG_MAXBURST 6970 1.1.2.2 skrll sctp_log_maxburst(net, 0, burst_limit, SCTP_MAX_BURST_APPLIED); 6971 1.1.2.2 skrll #endif 6972 1.1.2.2 skrll sctp_pegs[SCTP_MAX_BURST_APL]++; 6973 1.1.2.2 skrll } 6974 1.1.2.2 skrll net->fast_retran_ip = 0; 6975 1.1.2.2 skrll #endif 6976 1.1.2.2 skrll } 6977 1.1.2.2 skrll 6978 1.1.2.2 skrll } 6979 1.1.2.2 skrll /* Fill up what we can to the destination */ 6980 1.1.2.2 skrll burst_cnt = 0; 6981 1.1.2.2 skrll cwnd_full = 0; 6982 1.1.2.2 skrll do { 6983 1.1.2.2 skrll #ifdef SCTP_DEBUG 6984 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 6985 1.1.2.2 skrll printf("Burst count:%d - call m-c-o\n", burst_cnt); 6986 1.1.2.2 skrll } 6987 1.1.2.2 skrll #endif 6988 1.1.2.2 skrll error = sctp_med_chunk_output(inp, stcb, asoc, &num_out, 6989 1.1.2.2 skrll &reason_code, 0, &cwnd_full, from_where, 6990 1.1.2.2 skrll &now, &now_filled); 6991 1.1.2.2 skrll if (error) { 6992 1.1.2.2 skrll #ifdef SCTP_DEBUG 6993 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 6994 1.1.2.2 skrll printf("Error %d was returned from med-c-op\n", error); 6995 1.1.2.2 skrll } 6996 1.1.2.2 skrll #endif 6997 1.1.2.2 skrll #ifdef SCTP_LOG_MAXBURST 6998 1.1.2.2 skrll sctp_log_maxburst(asoc->primary_destination, error , burst_cnt, SCTP_MAX_BURST_ERROR_STOP); 6999 1.1.2.2 skrll #endif 7000 1.1.2.2 skrll break; 7001 1.1.2.2 skrll } 7002 1.1.2.2 skrll #ifdef SCTP_DEBUG 7003 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT3) { 7004 1.1.2.2 skrll printf("m-c-o put out %d\n", num_out); 7005 1.1.2.2 skrll } 7006 1.1.2.2 skrll #endif 7007 1.1.2.2 skrll tot_out += num_out; 7008 1.1.2.2 skrll burst_cnt++; 7009 1.1.2.2 skrll } while (num_out 7010 1.1.2.2 skrll #ifndef SCTP_USE_ALLMAN_BURST 7011 1.1.2.2 skrll && (burst_cnt < burst_limit) 7012 1.1.2.2 skrll #endif 7013 1.1.2.2 skrll ); 7014 1.1.2.2 skrll #ifndef SCTP_USE_ALLMAN_BURST 7015 1.1.2.2 skrll if (burst_cnt >= burst_limit) { 7016 1.1.2.2 skrll sctp_pegs[SCTP_MAX_BURST_APL]++; 7017 1.1.2.2 skrll asoc->burst_limit_applied = 1; 7018 1.1.2.2 skrll #ifdef SCTP_LOG_MAXBURST 7019 1.1.2.2 skrll sctp_log_maxburst(asoc->primary_destination, 0 , burst_cnt, SCTP_MAX_BURST_APPLIED); 7020 1.1.2.2 skrll #endif 7021 1.1.2.2 skrll } else { 7022 1.1.2.2 skrll asoc->burst_limit_applied = 0; 7023 1.1.2.2 skrll } 7024 1.1.2.2 skrll #endif 7025 1.1.2.2 skrll 7026 1.1.2.2 skrll #ifdef SCTP_DEBUG 7027 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 7028 1.1.2.2 skrll printf("Ok, we have put out %d chunks\n", tot_out); 7029 1.1.2.2 skrll } 7030 1.1.2.2 skrll #endif 7031 1.1.2.2 skrll if (tot_out == 0) { 7032 1.1.2.2 skrll sctp_pegs[SCTP_CO_NODATASNT]++; 7033 1.1.2.2 skrll if (asoc->stream_queue_cnt > 0) { 7034 1.1.2.2 skrll sctp_pegs[SCTP_SOS_NOSNT]++; 7035 1.1.2.2 skrll } else { 7036 1.1.2.2 skrll sctp_pegs[SCTP_NOS_NOSNT]++; 7037 1.1.2.2 skrll } 7038 1.1.2.2 skrll if (asoc->send_queue_cnt > 0) { 7039 1.1.2.2 skrll sctp_pegs[SCTP_SOSE_NOSNT]++; 7040 1.1.2.2 skrll } else { 7041 1.1.2.2 skrll sctp_pegs[SCTP_NOSE_NOSNT]++; 7042 1.1.2.2 skrll } 7043 1.1.2.2 skrll } 7044 1.1.2.2 skrll /* Now we need to clean up the control chunk chain if 7045 1.1.2.2 skrll * a ECNE is on it. It must be marked as UNSENT again 7046 1.1.2.2 skrll * so next call will continue to send it until 7047 1.1.2.2 skrll * such time that we get a CWR, to remove it. 7048 1.1.2.2 skrll */ 7049 1.1.2.2 skrll sctp_fix_ecn_echo(asoc); 7050 1.1.2.2 skrll return (error); 7051 1.1.2.2 skrll } 7052 1.1.2.2 skrll 7053 1.1.2.2 skrll 7054 1.1.2.2 skrll int 7055 1.1.2.2 skrll sctp_output(struct sctp_inpcb *inp, struct mbuf *m, 7056 1.1.2.2 skrll struct sockaddr *addr, struct mbuf *control, struct lwp *l, int flags) 7057 1.1.2.2 skrll { 7058 1.1.2.2 skrll struct sctp_inpcb *t_inp; 7059 1.1.2.2 skrll struct sctp_tcb *stcb; 7060 1.1.2.2 skrll struct sctp_nets *net; 7061 1.1.2.2 skrll struct sctp_association *asoc; 7062 1.1.2.2 skrll int create_lock_applied = 0; 7063 1.1.2.2 skrll int queue_only, error = 0; 7064 1.1.2.2 skrll struct sctp_sndrcvinfo srcv; 7065 1.1.2.2 skrll int un_sent = 0; 7066 1.1.2.2 skrll int use_rcvinfo = 0; 7067 1.1.2.2 skrll t_inp = inp; 7068 1.1.2.2 skrll /* struct route ro;*/ 7069 1.1.2.2 skrll 7070 1.1.2.2 skrll queue_only = 0; 7071 1.1.2.2 skrll stcb = NULL; 7072 1.1.2.2 skrll asoc = NULL; 7073 1.1.2.2 skrll net = NULL; 7074 1.1.2.2 skrll 7075 1.1.2.2 skrll #ifdef SCTP_DEBUG 7076 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 7077 1.1.2.2 skrll printf("USR Send BEGINS\n"); 7078 1.1.2.2 skrll } 7079 1.1.2.2 skrll #endif 7080 1.1.2.2 skrll 7081 1.1.2.2 skrll if ((inp->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) && 7082 1.1.2.2 skrll (inp->sctp_flags & SCTP_PCB_FLAGS_ACCEPTING)) { 7083 1.1.2.2 skrll /* The listner can NOT send */ 7084 1.1.2.2 skrll if (control) { 7085 1.1.2.2 skrll sctppcbinfo.mbuf_track--; 7086 1.1.2.2 skrll sctp_m_freem(control); 7087 1.1.2.2 skrll control = NULL; 7088 1.1.2.2 skrll } 7089 1.1.2.2 skrll sctp_m_freem(m); 7090 1.1.2.2 skrll return (EFAULT); 7091 1.1.2.2 skrll } 7092 1.1.2.2 skrll /* Can't allow a V6 address on a non-v6 socket */ 7093 1.1.2.2 skrll if (addr) { 7094 1.1.2.2 skrll SCTP_ASOC_CREATE_LOCK(inp); 7095 1.1.2.2 skrll if ((inp->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE) || 7096 1.1.2.2 skrll (inp->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE)) { 7097 1.1.2.2 skrll /* Should I really unlock ? */ 7098 1.1.2.2 skrll SCTP_ASOC_CREATE_UNLOCK(inp); 7099 1.1.2.2 skrll if (control) { 7100 1.1.2.2 skrll sctppcbinfo.mbuf_track--; 7101 1.1.2.2 skrll sctp_m_freem(control); 7102 1.1.2.2 skrll control = NULL; 7103 1.1.2.2 skrll } 7104 1.1.2.2 skrll sctp_m_freem(m); 7105 1.1.2.2 skrll return (EFAULT); 7106 1.1.2.2 skrll } 7107 1.1.2.2 skrll create_lock_applied = 1; 7108 1.1.2.2 skrll if (((inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) == 0) && 7109 1.1.2.2 skrll (addr->sa_family == AF_INET6)) { 7110 1.1.2.2 skrll SCTP_ASOC_CREATE_UNLOCK(inp); 7111 1.1.2.2 skrll if (control) { 7112 1.1.2.2 skrll sctppcbinfo.mbuf_track--; 7113 1.1.2.2 skrll sctp_m_freem(control); 7114 1.1.2.2 skrll control = NULL; 7115 1.1.2.2 skrll } 7116 1.1.2.2 skrll sctp_m_freem(m); 7117 1.1.2.2 skrll return (EINVAL); 7118 1.1.2.2 skrll } 7119 1.1.2.2 skrll } 7120 1.1.2.2 skrll if (control) { 7121 1.1.2.2 skrll sctppcbinfo.mbuf_track++; 7122 1.1.2.2 skrll if (sctp_find_cmsg(SCTP_SNDRCV, (void *)&srcv, control, 7123 1.1.2.2 skrll sizeof(srcv))) { 7124 1.1.2.2 skrll if (srcv.sinfo_flags & MSG_SENDALL) { 7125 1.1.2.2 skrll /* its a sendall */ 7126 1.1.2.2 skrll sctppcbinfo.mbuf_track--; 7127 1.1.2.2 skrll sctp_m_freem(control); 7128 1.1.2.2 skrll if (create_lock_applied) { 7129 1.1.2.2 skrll SCTP_ASOC_CREATE_UNLOCK(inp); 7130 1.1.2.2 skrll create_lock_applied = 0; 7131 1.1.2.2 skrll } 7132 1.1.2.2 skrll return (sctp_sendall(inp, NULL, m, &srcv)); 7133 1.1.2.2 skrll } 7134 1.1.2.2 skrll if (srcv.sinfo_assoc_id) { 7135 1.1.2.2 skrll if (inp->sctp_flags & SCTP_PCB_FLAGS_CONNECTED) { 7136 1.1.2.2 skrll SCTP_INP_RLOCK(inp); 7137 1.1.2.2 skrll stcb = LIST_FIRST(&inp->sctp_asoc_list); 7138 1.1.2.2 skrll if (stcb) { 7139 1.1.2.2 skrll SCTP_TCB_LOCK(stcb); 7140 1.1.2.2 skrll } 7141 1.1.2.2 skrll SCTP_INP_RUNLOCK(inp); 7142 1.1.2.2 skrll 7143 1.1.2.2 skrll if (stcb == NULL) { 7144 1.1.2.2 skrll if (create_lock_applied) { 7145 1.1.2.2 skrll SCTP_ASOC_CREATE_UNLOCK(inp); 7146 1.1.2.2 skrll create_lock_applied = 0; 7147 1.1.2.2 skrll } 7148 1.1.2.2 skrll sctppcbinfo.mbuf_track--; 7149 1.1.2.2 skrll sctp_m_freem(control); 7150 1.1.2.2 skrll sctp_m_freem(m); 7151 1.1.2.2 skrll return (ENOTCONN); 7152 1.1.2.2 skrll } 7153 1.1.2.2 skrll net = stcb->asoc.primary_destination; 7154 1.1.2.2 skrll } else { 7155 1.1.2.2 skrll stcb = sctp_findassociation_ep_asocid(inp, srcv.sinfo_assoc_id); 7156 1.1.2.2 skrll } 7157 1.1.2.2 skrll /* 7158 1.1.2.2 skrll * Question: Should I error here if the 7159 1.1.2.2 skrll 7160 1.1.2.2 skrll * assoc_id is no longer valid? 7161 1.1.2.2 skrll * i.e. I can't find it? 7162 1.1.2.2 skrll */ 7163 1.1.2.2 skrll if ((stcb) && 7164 1.1.2.2 skrll (addr != NULL)) { 7165 1.1.2.2 skrll /* Must locate the net structure */ 7166 1.1.2.2 skrll if (addr) 7167 1.1.2.2 skrll net = sctp_findnet(stcb, addr); 7168 1.1.2.2 skrll } 7169 1.1.2.2 skrll if (net == NULL) 7170 1.1.2.2 skrll net = stcb->asoc.primary_destination; 7171 1.1.2.2 skrll } 7172 1.1.2.2 skrll use_rcvinfo = 1; 7173 1.1.2.2 skrll } 7174 1.1.2.2 skrll } 7175 1.1.2.2 skrll if (stcb == NULL) { 7176 1.1.2.2 skrll if (inp->sctp_flags & SCTP_PCB_FLAGS_CONNECTED) { 7177 1.1.2.2 skrll SCTP_INP_RLOCK(inp); 7178 1.1.2.2 skrll stcb = LIST_FIRST(&inp->sctp_asoc_list); 7179 1.1.2.2 skrll if (stcb) { 7180 1.1.2.2 skrll SCTP_TCB_LOCK(stcb); 7181 1.1.2.2 skrll } 7182 1.1.2.2 skrll SCTP_INP_RUNLOCK(inp); 7183 1.1.2.2 skrll if (stcb == NULL) { 7184 1.1.2.2 skrll if (create_lock_applied) { 7185 1.1.2.2 skrll SCTP_ASOC_CREATE_UNLOCK(inp); 7186 1.1.2.2 skrll create_lock_applied = 0; 7187 1.1.2.2 skrll } 7188 1.1.2.2 skrll if (control) { 7189 1.1.2.2 skrll sctppcbinfo.mbuf_track--; 7190 1.1.2.2 skrll sctp_m_freem(control); 7191 1.1.2.2 skrll control = NULL; 7192 1.1.2.2 skrll } 7193 1.1.2.2 skrll sctp_m_freem(m); 7194 1.1.2.2 skrll return (ENOTCONN); 7195 1.1.2.2 skrll } 7196 1.1.2.2 skrll if (addr == NULL) { 7197 1.1.2.2 skrll net = stcb->asoc.primary_destination; 7198 1.1.2.2 skrll } else { 7199 1.1.2.2 skrll net = sctp_findnet(stcb, addr); 7200 1.1.2.2 skrll if (net == NULL) { 7201 1.1.2.2 skrll net = stcb->asoc.primary_destination; 7202 1.1.2.2 skrll } 7203 1.1.2.2 skrll } 7204 1.1.2.2 skrll } else { 7205 1.1.2.2 skrll if (addr != NULL) { 7206 1.1.2.2 skrll SCTP_INP_WLOCK(inp); 7207 1.1.2.2 skrll SCTP_INP_INCR_REF(inp); 7208 1.1.2.2 skrll SCTP_INP_WUNLOCK(inp); 7209 1.1.2.2 skrll stcb = sctp_findassociation_ep_addr(&t_inp, addr, &net, NULL, NULL); 7210 1.1.2.2 skrll if (stcb == NULL) { 7211 1.1.2.2 skrll SCTP_INP_WLOCK(inp); 7212 1.1.2.2 skrll SCTP_INP_DECR_REF(inp); 7213 1.1.2.2 skrll SCTP_INP_WUNLOCK(inp); 7214 1.1.2.2 skrll } 7215 1.1.2.2 skrll } 7216 1.1.2.2 skrll } 7217 1.1.2.2 skrll } 7218 1.1.2.2 skrll if ((stcb == NULL) && 7219 1.1.2.2 skrll (inp->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE)) { 7220 1.1.2.2 skrll if (control) { 7221 1.1.2.2 skrll sctppcbinfo.mbuf_track--; 7222 1.1.2.2 skrll sctp_m_freem(control); 7223 1.1.2.2 skrll control = NULL; 7224 1.1.2.2 skrll } 7225 1.1.2.2 skrll if (create_lock_applied) { 7226 1.1.2.2 skrll SCTP_ASOC_CREATE_UNLOCK(inp); 7227 1.1.2.2 skrll create_lock_applied = 0; 7228 1.1.2.2 skrll } 7229 1.1.2.2 skrll sctp_m_freem(m); 7230 1.1.2.2 skrll return (ENOTCONN); 7231 1.1.2.2 skrll } else if ((stcb == NULL) && 7232 1.1.2.2 skrll (addr == NULL)) { 7233 1.1.2.2 skrll if (control) { 7234 1.1.2.2 skrll sctppcbinfo.mbuf_track--; 7235 1.1.2.2 skrll sctp_m_freem(control); 7236 1.1.2.2 skrll control = NULL; 7237 1.1.2.2 skrll } 7238 1.1.2.2 skrll if (create_lock_applied) { 7239 1.1.2.2 skrll SCTP_ASOC_CREATE_UNLOCK(inp); 7240 1.1.2.2 skrll create_lock_applied = 0; 7241 1.1.2.2 skrll } 7242 1.1.2.2 skrll sctp_m_freem(m); 7243 1.1.2.2 skrll return (ENOENT); 7244 1.1.2.2 skrll } else if (stcb == NULL) { 7245 1.1.2.2 skrll /* UDP mode, we must go ahead and start the INIT process */ 7246 1.1.2.2 skrll if ((use_rcvinfo) && (srcv.sinfo_flags & MSG_ABORT)) { 7247 1.1.2.2 skrll /* Strange user to do this */ 7248 1.1.2.2 skrll if (control) { 7249 1.1.2.2 skrll sctppcbinfo.mbuf_track--; 7250 1.1.2.2 skrll sctp_m_freem(control); 7251 1.1.2.2 skrll control = NULL; 7252 1.1.2.2 skrll } 7253 1.1.2.2 skrll if (create_lock_applied) { 7254 1.1.2.2 skrll SCTP_ASOC_CREATE_UNLOCK(inp); 7255 1.1.2.2 skrll create_lock_applied = 0; 7256 1.1.2.2 skrll } 7257 1.1.2.2 skrll sctp_m_freem(m); 7258 1.1.2.2 skrll return (ENOENT); 7259 1.1.2.2 skrll } 7260 1.1.2.2 skrll stcb = sctp_aloc_assoc(inp, addr, 1, &error, 0); 7261 1.1.2.2 skrll if (stcb == NULL) { 7262 1.1.2.2 skrll if (control) { 7263 1.1.2.2 skrll sctppcbinfo.mbuf_track--; 7264 1.1.2.2 skrll sctp_m_freem(control); 7265 1.1.2.2 skrll control = NULL; 7266 1.1.2.2 skrll } 7267 1.1.2.2 skrll if (create_lock_applied) { 7268 1.1.2.2 skrll SCTP_ASOC_CREATE_UNLOCK(inp); 7269 1.1.2.2 skrll create_lock_applied = 0; 7270 1.1.2.2 skrll } 7271 1.1.2.2 skrll sctp_m_freem(m); 7272 1.1.2.2 skrll return (error); 7273 1.1.2.2 skrll } 7274 1.1.2.2 skrll if (create_lock_applied) { 7275 1.1.2.2 skrll SCTP_ASOC_CREATE_UNLOCK(inp); 7276 1.1.2.2 skrll create_lock_applied = 0; 7277 1.1.2.2 skrll } else { 7278 1.1.2.2 skrll printf("Huh-1, create lock should have been applied!\n"); 7279 1.1.2.2 skrll } 7280 1.1.2.2 skrll queue_only = 1; 7281 1.1.2.2 skrll asoc = &stcb->asoc; 7282 1.1.2.2 skrll asoc->state = SCTP_STATE_COOKIE_WAIT; 7283 1.1.2.2 skrll SCTP_GETTIME_TIMEVAL(&asoc->time_entered); 7284 1.1.2.2 skrll if (control) { 7285 1.1.2.2 skrll /* see if a init structure exists in cmsg headers */ 7286 1.1.2.2 skrll struct sctp_initmsg initm; 7287 1.1.2.2 skrll int i; 7288 1.1.2.2 skrll if (sctp_find_cmsg(SCTP_INIT, (void *)&initm, control, 7289 1.1.2.2 skrll sizeof(initm))) { 7290 1.1.2.2 skrll /* we have an INIT override of the default */ 7291 1.1.2.2 skrll if (initm.sinit_max_attempts) 7292 1.1.2.2 skrll asoc->max_init_times = initm.sinit_max_attempts; 7293 1.1.2.2 skrll if (initm.sinit_num_ostreams) 7294 1.1.2.2 skrll asoc->pre_open_streams = initm.sinit_num_ostreams; 7295 1.1.2.2 skrll if (initm.sinit_max_instreams) 7296 1.1.2.2 skrll asoc->max_inbound_streams = initm.sinit_max_instreams; 7297 1.1.2.2 skrll if (initm.sinit_max_init_timeo) 7298 1.1.2.2 skrll asoc->initial_init_rto_max = initm.sinit_max_init_timeo; 7299 1.1.2.2 skrll } 7300 1.1.2.2 skrll if (asoc->streamoutcnt < asoc->pre_open_streams) { 7301 1.1.2.2 skrll /* Default is NOT correct */ 7302 1.1.2.2 skrll #ifdef SCTP_DEBUG 7303 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 7304 1.1.2.2 skrll printf("Ok, defout:%d pre_open:%d\n", 7305 1.1.2.2 skrll asoc->streamoutcnt, asoc->pre_open_streams); 7306 1.1.2.2 skrll } 7307 1.1.2.2 skrll #endif 7308 1.1.2.2 skrll free(asoc->strmout, M_PCB); 7309 1.1.2.2 skrll asoc->strmout = NULL; 7310 1.1.2.2 skrll asoc->streamoutcnt = asoc->pre_open_streams; 7311 1.1.2.2 skrll asoc->strmout = malloc(asoc->streamoutcnt * 7312 1.1.2.2 skrll sizeof(struct sctp_stream_out), M_PCB, 7313 1.1.2.2 skrll M_WAIT); 7314 1.1.2.2 skrll for (i = 0; i < asoc->streamoutcnt; i++) { 7315 1.1.2.2 skrll /* 7316 1.1.2.2 skrll * inbound side must be set to 0xffff, 7317 1.1.2.2 skrll * also NOTE when we get the INIT-ACK 7318 1.1.2.2 skrll * back (for INIT sender) we MUST 7319 1.1.2.2 skrll * reduce the count (streamoutcnt) but 7320 1.1.2.2 skrll * first check if we sent to any of the 7321 1.1.2.2 skrll * upper streams that were dropped (if 7322 1.1.2.2 skrll * some were). Those that were dropped 7323 1.1.2.2 skrll * must be notified to the upper layer 7324 1.1.2.2 skrll * as failed to send. 7325 1.1.2.2 skrll */ 7326 1.1.2.2 skrll asoc->strmout[i].next_sequence_sent = 0x0; 7327 1.1.2.2 skrll TAILQ_INIT(&asoc->strmout[i].outqueue); 7328 1.1.2.2 skrll asoc->strmout[i].stream_no = i; 7329 1.1.2.2 skrll asoc->strmout[i].next_spoke.tqe_next = 0; 7330 1.1.2.2 skrll asoc->strmout[i].next_spoke.tqe_prev = 0; 7331 1.1.2.2 skrll } 7332 1.1.2.2 skrll } 7333 1.1.2.2 skrll } 7334 1.1.2.2 skrll sctp_send_initiate(inp, stcb); 7335 1.1.2.2 skrll /* 7336 1.1.2.2 skrll * we may want to dig in after this call and adjust the MTU 7337 1.1.2.2 skrll * value. It defaulted to 1500 (constant) but the ro structure 7338 1.1.2.2 skrll * may now have an update and thus we may need to change it 7339 1.1.2.2 skrll * BEFORE we append the message. 7340 1.1.2.2 skrll */ 7341 1.1.2.2 skrll net = stcb->asoc.primary_destination; 7342 1.1.2.2 skrll } else { 7343 1.1.2.2 skrll if (create_lock_applied) { 7344 1.1.2.2 skrll SCTP_ASOC_CREATE_UNLOCK(inp); 7345 1.1.2.2 skrll create_lock_applied = 0; 7346 1.1.2.2 skrll } 7347 1.1.2.2 skrll asoc = &stcb->asoc; 7348 1.1.2.2 skrll if ((SCTP_GET_STATE(asoc) == SCTP_STATE_COOKIE_WAIT) || 7349 1.1.2.2 skrll (SCTP_GET_STATE(asoc) == SCTP_STATE_COOKIE_ECHOED)) { 7350 1.1.2.2 skrll queue_only = 1; 7351 1.1.2.2 skrll } 7352 1.1.2.2 skrll if ((SCTP_GET_STATE(asoc) == SCTP_STATE_SHUTDOWN_SENT) || 7353 1.1.2.2 skrll (SCTP_GET_STATE(asoc) == SCTP_STATE_SHUTDOWN_RECEIVED) || 7354 1.1.2.2 skrll (SCTP_GET_STATE(asoc) == SCTP_STATE_SHUTDOWN_ACK_SENT) || 7355 1.1.2.2 skrll (asoc->state & SCTP_STATE_SHUTDOWN_PENDING)) { 7356 1.1.2.2 skrll if (control) { 7357 1.1.2.2 skrll sctppcbinfo.mbuf_track--; 7358 1.1.2.2 skrll sctp_m_freem(control); 7359 1.1.2.2 skrll control = NULL; 7360 1.1.2.2 skrll } 7361 1.1.2.2 skrll if ((use_rcvinfo) && 7362 1.1.2.2 skrll (srcv.sinfo_flags & MSG_ABORT)) { 7363 1.1.2.2 skrll sctp_msg_append(stcb, net, m, &srcv, flags); 7364 1.1.2.2 skrll error = 0; 7365 1.1.2.2 skrll } else { 7366 1.1.2.2 skrll if (m) 7367 1.1.2.2 skrll sctp_m_freem(m); 7368 1.1.2.2 skrll error = ECONNRESET; 7369 1.1.2.2 skrll } 7370 1.1.2.2 skrll SCTP_TCB_UNLOCK(stcb); 7371 1.1.2.2 skrll return (error); 7372 1.1.2.2 skrll } 7373 1.1.2.2 skrll } 7374 1.1.2.2 skrll if (create_lock_applied) { 7375 1.1.2.2 skrll /* we should never hit here with the create lock applied 7376 1.1.2.2 skrll * 7377 1.1.2.2 skrll */ 7378 1.1.2.2 skrll SCTP_ASOC_CREATE_UNLOCK(inp); 7379 1.1.2.2 skrll create_lock_applied = 0; 7380 1.1.2.2 skrll } 7381 1.1.2.2 skrll 7382 1.1.2.2 skrll 7383 1.1.2.2 skrll if (use_rcvinfo == 0) { 7384 1.1.2.2 skrll srcv = stcb->asoc.def_send; 7385 1.1.2.2 skrll } 7386 1.1.2.2 skrll #ifdef SCTP_DEBUG 7387 1.1.2.2 skrll else { 7388 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT5) { 7389 1.1.2.2 skrll printf("stream:%d\n", srcv.sinfo_stream); 7390 1.1.2.2 skrll printf("flags:%x\n", (u_int)srcv.sinfo_flags); 7391 1.1.2.2 skrll printf("ppid:%d\n", srcv.sinfo_ppid); 7392 1.1.2.2 skrll printf("context:%d\n", srcv.sinfo_context); 7393 1.1.2.2 skrll } 7394 1.1.2.2 skrll } 7395 1.1.2.2 skrll #endif 7396 1.1.2.2 skrll if (control) { 7397 1.1.2.2 skrll sctppcbinfo.mbuf_track--; 7398 1.1.2.2 skrll sctp_m_freem(control); 7399 1.1.2.2 skrll control = NULL; 7400 1.1.2.2 skrll } 7401 1.1.2.2 skrll if (net && ((srcv.sinfo_flags & MSG_ADDR_OVER))) { 7402 1.1.2.2 skrll /* we take the override or the unconfirmed */ 7403 1.1.2.2 skrll ; 7404 1.1.2.2 skrll } else { 7405 1.1.2.2 skrll net = stcb->asoc.primary_destination; 7406 1.1.2.2 skrll } 7407 1.1.2.2 skrll if ((error = sctp_msg_append(stcb, net, m, &srcv, flags))) { 7408 1.1.2.2 skrll SCTP_TCB_UNLOCK(stcb); 7409 1.1.2.2 skrll return (error); 7410 1.1.2.2 skrll } 7411 1.1.2.2 skrll if (net->flight_size > net->cwnd) { 7412 1.1.2.2 skrll sctp_pegs[SCTP_SENDTO_FULL_CWND]++; 7413 1.1.2.2 skrll queue_only = 1; 7414 1.1.2.2 skrll } else if (asoc->ifp_had_enobuf) { 7415 1.1.2.2 skrll sctp_pegs[SCTP_QUEONLY_BURSTLMT]++; 7416 1.1.2.2 skrll queue_only = 1; 7417 1.1.2.2 skrll } else { 7418 1.1.2.2 skrll un_sent = ((stcb->asoc.total_output_queue_size - stcb->asoc.total_flight) + 7419 1.1.2.2 skrll ((stcb->asoc.chunks_on_out_queue - stcb->asoc.total_flight_count) * sizeof(struct sctp_data_chunk)) + 7420 1.1.2.2 skrll SCTP_MED_OVERHEAD); 7421 1.1.2.2 skrll 7422 1.1.2.2 skrll if (((inp->sctp_flags & SCTP_PCB_FLAGS_NODELAY) == 0) && 7423 1.1.2.2 skrll (stcb->asoc.total_flight > 0) && 7424 1.1.2.2 skrll (un_sent < (int)stcb->asoc.smallest_mtu) 7425 1.1.2.2 skrll ) { 7426 1.1.2.2 skrll 7427 1.1.2.2 skrll /* Ok, Nagle is set on and we have 7428 1.1.2.2 skrll * data outstanding. Don't send anything 7429 1.1.2.2 skrll * and let the SACK drive out the data. 7430 1.1.2.2 skrll */ 7431 1.1.2.2 skrll sctp_pegs[SCTP_NAGLE_NOQ]++; 7432 1.1.2.2 skrll queue_only = 1; 7433 1.1.2.2 skrll } else { 7434 1.1.2.2 skrll sctp_pegs[SCTP_NAGLE_OFF]++; 7435 1.1.2.2 skrll } 7436 1.1.2.2 skrll } 7437 1.1.2.2 skrll if ((queue_only == 0) && stcb->asoc.peers_rwnd) { 7438 1.1.2.2 skrll /* we can attempt to send too.*/ 7439 1.1.2.2 skrll #ifdef SCTP_DEBUG 7440 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 7441 1.1.2.2 skrll printf("USR Send calls sctp_chunk_output\n"); 7442 1.1.2.2 skrll } 7443 1.1.2.2 skrll #endif 7444 1.1.2.2 skrll #ifdef SCTP_AUDITING_ENABLED 7445 1.1.2.2 skrll sctp_audit_log(0xC0, 1); 7446 1.1.2.2 skrll sctp_auditing(6, inp, stcb, net); 7447 1.1.2.2 skrll #endif 7448 1.1.2.2 skrll sctp_pegs[SCTP_OUTPUT_FRM_SND]++; 7449 1.1.2.2 skrll sctp_chunk_output(inp, stcb, 0); 7450 1.1.2.2 skrll #ifdef SCTP_AUDITING_ENABLED 7451 1.1.2.2 skrll sctp_audit_log(0xC0, 2); 7452 1.1.2.2 skrll sctp_auditing(7, inp, stcb, net); 7453 1.1.2.2 skrll #endif 7454 1.1.2.2 skrll 7455 1.1.2.2 skrll } 7456 1.1.2.2 skrll #ifdef SCTP_DEBUG 7457 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 7458 1.1.2.2 skrll printf("USR Send complete qo:%d prw:%d\n", queue_only, stcb->asoc.peers_rwnd); 7459 1.1.2.2 skrll } 7460 1.1.2.2 skrll #endif 7461 1.1.2.2 skrll SCTP_TCB_UNLOCK(stcb); 7462 1.1.2.2 skrll return (0); 7463 1.1.2.2 skrll } 7464 1.1.2.2 skrll 7465 1.1.2.2 skrll void 7466 1.1.2.2 skrll send_forward_tsn(struct sctp_tcb *stcb, 7467 1.1.2.2 skrll struct sctp_association *asoc) 7468 1.1.2.2 skrll { 7469 1.1.2.2 skrll struct sctp_tmit_chunk *chk; 7470 1.1.2.2 skrll struct sctp_forward_tsn_chunk *fwdtsn; 7471 1.1.2.2 skrll 7472 1.1.2.2 skrll TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) { 7473 1.1.2.2 skrll if (chk->rec.chunk_id == SCTP_FORWARD_CUM_TSN) { 7474 1.1.2.2 skrll /* mark it to unsent */ 7475 1.1.2.2 skrll chk->sent = SCTP_DATAGRAM_UNSENT; 7476 1.1.2.2 skrll chk->snd_count = 0; 7477 1.1.2.2 skrll /* Do we correct its output location? */ 7478 1.1.2.2 skrll if (chk->whoTo != asoc->primary_destination) { 7479 1.1.2.2 skrll sctp_free_remote_addr(chk->whoTo); 7480 1.1.2.2 skrll chk->whoTo = asoc->primary_destination; 7481 1.1.2.2 skrll chk->whoTo->ref_count++; 7482 1.1.2.2 skrll } 7483 1.1.2.2 skrll goto sctp_fill_in_rest; 7484 1.1.2.2 skrll } 7485 1.1.2.2 skrll } 7486 1.1.2.2 skrll /* Ok if we reach here we must build one */ 7487 1.1.2.2 skrll chk = (struct sctp_tmit_chunk *)SCTP_ZONE_GET(sctppcbinfo.ipi_zone_chunk); 7488 1.1.2.2 skrll if (chk == NULL) { 7489 1.1.2.2 skrll return; 7490 1.1.2.2 skrll } 7491 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk++; 7492 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 7493 1.1.2.2 skrll chk->rec.chunk_id = SCTP_FORWARD_CUM_TSN; 7494 1.1.2.2 skrll chk->asoc = asoc; 7495 1.1.2.2 skrll MGETHDR(chk->data, M_DONTWAIT, MT_DATA); 7496 1.1.2.2 skrll if (chk->data == NULL) { 7497 1.1.2.2 skrll chk->whoTo->ref_count--; 7498 1.1.2.2 skrll SCTP_ZONE_FREE(sctppcbinfo.ipi_zone_chunk, chk); 7499 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk--; 7500 1.1.2.2 skrll if ((int)sctppcbinfo.ipi_count_chunk < 0) { 7501 1.1.2.2 skrll panic("Chunk count is negative"); 7502 1.1.2.2 skrll } 7503 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 7504 1.1.2.2 skrll return; 7505 1.1.2.2 skrll } 7506 1.1.2.2 skrll chk->data->m_data += SCTP_MIN_OVERHEAD; 7507 1.1.2.2 skrll chk->sent = SCTP_DATAGRAM_UNSENT; 7508 1.1.2.2 skrll chk->snd_count = 0; 7509 1.1.2.2 skrll chk->whoTo = asoc->primary_destination; 7510 1.1.2.2 skrll chk->whoTo->ref_count++; 7511 1.1.2.2 skrll TAILQ_INSERT_TAIL(&asoc->control_send_queue, chk, sctp_next); 7512 1.1.2.2 skrll asoc->ctrl_queue_cnt++; 7513 1.1.2.2 skrll sctp_fill_in_rest: 7514 1.1.2.2 skrll /* Here we go through and fill out the part that 7515 1.1.2.2 skrll * deals with stream/seq of the ones we skip. 7516 1.1.2.2 skrll */ 7517 1.1.2.2 skrll chk->data->m_pkthdr.len = chk->data->m_len = 0; 7518 1.1.2.2 skrll { 7519 1.1.2.2 skrll struct sctp_tmit_chunk *at, *tp1, *last; 7520 1.1.2.2 skrll struct sctp_strseq *strseq; 7521 1.1.2.2 skrll unsigned int cnt_of_space, i, ovh; 7522 1.1.2.2 skrll unsigned int space_needed; 7523 1.1.2.2 skrll unsigned int cnt_of_skipped = 0; 7524 1.1.2.2 skrll TAILQ_FOREACH(at, &asoc->sent_queue, sctp_next) { 7525 1.1.2.2 skrll if (at->sent != SCTP_FORWARD_TSN_SKIP) { 7526 1.1.2.2 skrll /* no more to look at */ 7527 1.1.2.2 skrll break; 7528 1.1.2.2 skrll } 7529 1.1.2.2 skrll if (at->rec.data.rcv_flags & SCTP_DATA_UNORDERED) { 7530 1.1.2.2 skrll /* We don't report these */ 7531 1.1.2.2 skrll continue; 7532 1.1.2.2 skrll } 7533 1.1.2.2 skrll cnt_of_skipped++; 7534 1.1.2.2 skrll } 7535 1.1.2.2 skrll space_needed = (sizeof(struct sctp_forward_tsn_chunk) + 7536 1.1.2.2 skrll (cnt_of_skipped * sizeof(struct sctp_strseq))); 7537 1.1.2.2 skrll if ((M_TRAILINGSPACE(chk->data) < (int)space_needed) && 7538 1.1.2.2 skrll ((chk->data->m_flags & M_EXT) == 0)) { 7539 1.1.2.2 skrll /* Need a M_EXT, get one and move 7540 1.1.2.2 skrll * fwdtsn to data area. 7541 1.1.2.2 skrll */ 7542 1.1.2.2 skrll MCLGET(chk->data, M_DONTWAIT); 7543 1.1.2.2 skrll } 7544 1.1.2.2 skrll cnt_of_space = M_TRAILINGSPACE(chk->data); 7545 1.1.2.2 skrll 7546 1.1.2.2 skrll if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) { 7547 1.1.2.2 skrll ovh = SCTP_MIN_OVERHEAD; 7548 1.1.2.2 skrll } else { 7549 1.1.2.2 skrll ovh = SCTP_MIN_V4_OVERHEAD; 7550 1.1.2.2 skrll } 7551 1.1.2.2 skrll if (cnt_of_space > (asoc->smallest_mtu-ovh)) { 7552 1.1.2.2 skrll /* trim to a mtu size */ 7553 1.1.2.2 skrll cnt_of_space = asoc->smallest_mtu - ovh; 7554 1.1.2.2 skrll } 7555 1.1.2.2 skrll if (cnt_of_space < space_needed) { 7556 1.1.2.2 skrll /* ok we must trim down the chunk by lowering 7557 1.1.2.2 skrll * the advance peer ack point. 7558 1.1.2.2 skrll */ 7559 1.1.2.2 skrll cnt_of_skipped = (cnt_of_space- 7560 1.1.2.2 skrll ((sizeof(struct sctp_forward_tsn_chunk))/ 7561 1.1.2.2 skrll sizeof(struct sctp_strseq))); 7562 1.1.2.2 skrll /* Go through and find the TSN that 7563 1.1.2.2 skrll * will be the one we report. 7564 1.1.2.2 skrll */ 7565 1.1.2.2 skrll at = TAILQ_FIRST(&asoc->sent_queue); 7566 1.1.2.2 skrll for (i = 0; i < cnt_of_skipped; i++) { 7567 1.1.2.2 skrll tp1 = TAILQ_NEXT(at, sctp_next); 7568 1.1.2.2 skrll at = tp1; 7569 1.1.2.2 skrll } 7570 1.1.2.2 skrll last = at; 7571 1.1.2.2 skrll /* last now points to last one I can report, update peer ack point */ 7572 1.1.2.2 skrll asoc->advanced_peer_ack_point = last->rec.data.TSN_seq; 7573 1.1.2.2 skrll space_needed -= (cnt_of_skipped * sizeof(struct sctp_strseq)); 7574 1.1.2.2 skrll } 7575 1.1.2.2 skrll chk->send_size = space_needed; 7576 1.1.2.2 skrll /* Setup the chunk */ 7577 1.1.2.2 skrll fwdtsn = mtod(chk->data, struct sctp_forward_tsn_chunk *); 7578 1.1.2.2 skrll fwdtsn->ch.chunk_length = htons(chk->send_size); 7579 1.1.2.2 skrll fwdtsn->ch.chunk_flags = 0; 7580 1.1.2.2 skrll fwdtsn->ch.chunk_type = SCTP_FORWARD_CUM_TSN; 7581 1.1.2.2 skrll fwdtsn->new_cumulative_tsn = htonl(asoc->advanced_peer_ack_point); 7582 1.1.2.2 skrll chk->send_size = (sizeof(struct sctp_forward_tsn_chunk) + 7583 1.1.2.2 skrll (cnt_of_skipped * sizeof(struct sctp_strseq))); 7584 1.1.2.2 skrll chk->data->m_pkthdr.len = chk->data->m_len = chk->send_size; 7585 1.1.2.2 skrll fwdtsn++; 7586 1.1.2.2 skrll /* Move pointer to after the fwdtsn and transfer to 7587 1.1.2.2 skrll * the strseq pointer. 7588 1.1.2.2 skrll */ 7589 1.1.2.2 skrll strseq = (struct sctp_strseq *)fwdtsn; 7590 1.1.2.2 skrll /* 7591 1.1.2.2 skrll * Now populate the strseq list. This is done blindly 7592 1.1.2.2 skrll * without pulling out duplicate stream info. This is 7593 1.1.2.2 skrll * inefficent but won't harm the process since the peer 7594 1.1.2.2 skrll * will look at these in sequence and will thus release 7595 1.1.2.2 skrll * anything. It could mean we exceed the PMTU and chop 7596 1.1.2.2 skrll * off some that we could have included.. but this is 7597 1.1.2.2 skrll * unlikely (aka 1432/4 would mean 300+ stream seq's would 7598 1.1.2.2 skrll * have to be reported in one FWD-TSN. With a bit of work 7599 1.1.2.2 skrll * we can later FIX this to optimize and pull out duplcates.. 7600 1.1.2.2 skrll * but it does add more overhead. So for now... not! 7601 1.1.2.2 skrll */ 7602 1.1.2.2 skrll at = TAILQ_FIRST(&asoc->sent_queue); 7603 1.1.2.2 skrll for (i = 0; i < cnt_of_skipped; i++) { 7604 1.1.2.2 skrll tp1 = TAILQ_NEXT(at, sctp_next); 7605 1.1.2.2 skrll if (at->rec.data.rcv_flags & SCTP_DATA_UNORDERED) { 7606 1.1.2.2 skrll /* We don't report these */ 7607 1.1.2.2 skrll i--; 7608 1.1.2.2 skrll at = tp1; 7609 1.1.2.2 skrll continue; 7610 1.1.2.2 skrll } 7611 1.1.2.2 skrll strseq->stream = ntohs(at->rec.data.stream_number); 7612 1.1.2.2 skrll strseq->sequence = ntohs(at->rec.data.stream_seq); 7613 1.1.2.2 skrll strseq++; 7614 1.1.2.2 skrll at = tp1; 7615 1.1.2.2 skrll } 7616 1.1.2.2 skrll } 7617 1.1.2.2 skrll return; 7618 1.1.2.2 skrll 7619 1.1.2.2 skrll } 7620 1.1.2.2 skrll 7621 1.1.2.2 skrll void 7622 1.1.2.2 skrll sctp_send_sack(struct sctp_tcb *stcb) 7623 1.1.2.2 skrll { 7624 1.1.2.2 skrll /* 7625 1.1.2.2 skrll * Queue up a SACK in the control queue. We must first check to 7626 1.1.2.2 skrll * see if a SACK is somehow on the control queue. If so, we will 7627 1.1.2.2 skrll * take and and remove the old one. 7628 1.1.2.2 skrll */ 7629 1.1.2.2 skrll struct sctp_association *asoc; 7630 1.1.2.2 skrll struct sctp_tmit_chunk *chk, *a_chk; 7631 1.1.2.2 skrll struct sctp_sack_chunk *sack; 7632 1.1.2.2 skrll struct sctp_gap_ack_block *gap_descriptor; 7633 1.1.2.2 skrll uint32_t *dup; 7634 1.1.2.2 skrll int start; 7635 1.1.2.2 skrll unsigned int i, maxi, seeing_ones, m_size; 7636 1.1.2.2 skrll unsigned int num_gap_blocks, space; 7637 1.1.2.2 skrll 7638 1.1.2.2 skrll start = maxi = 0; 7639 1.1.2.2 skrll seeing_ones = 1; 7640 1.1.2.2 skrll a_chk = NULL; 7641 1.1.2.2 skrll asoc = &stcb->asoc; 7642 1.1.2.2 skrll if (asoc->last_data_chunk_from == NULL) { 7643 1.1.2.2 skrll /* Hmm we never received anything */ 7644 1.1.2.2 skrll return; 7645 1.1.2.2 skrll } 7646 1.1.2.2 skrll sctp_set_rwnd(stcb, asoc); 7647 1.1.2.2 skrll TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) { 7648 1.1.2.2 skrll if (chk->rec.chunk_id == SCTP_SELECTIVE_ACK) { 7649 1.1.2.2 skrll /* Hmm, found a sack already on queue, remove it */ 7650 1.1.2.2 skrll TAILQ_REMOVE(&asoc->control_send_queue, chk, sctp_next); 7651 1.1.2.2 skrll asoc->ctrl_queue_cnt++; 7652 1.1.2.2 skrll a_chk = chk; 7653 1.1.2.2 skrll if (a_chk->data) 7654 1.1.2.2 skrll sctp_m_freem(a_chk->data); 7655 1.1.2.2 skrll a_chk->data = NULL; 7656 1.1.2.2 skrll sctp_free_remote_addr(a_chk->whoTo); 7657 1.1.2.2 skrll a_chk->whoTo = NULL; 7658 1.1.2.2 skrll break; 7659 1.1.2.2 skrll } 7660 1.1.2.2 skrll } 7661 1.1.2.2 skrll if (a_chk == NULL) { 7662 1.1.2.2 skrll a_chk = (struct sctp_tmit_chunk *)SCTP_ZONE_GET(sctppcbinfo.ipi_zone_chunk); 7663 1.1.2.2 skrll if (a_chk == NULL) { 7664 1.1.2.2 skrll /* No memory so we drop the idea, and set a timer */ 7665 1.1.2.2 skrll sctp_timer_stop(SCTP_TIMER_TYPE_RECV, 7666 1.1.2.2 skrll stcb->sctp_ep, stcb, NULL); 7667 1.1.2.2 skrll sctp_timer_start(SCTP_TIMER_TYPE_RECV, 7668 1.1.2.2 skrll stcb->sctp_ep, stcb, NULL); 7669 1.1.2.2 skrll return; 7670 1.1.2.2 skrll } 7671 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk++; 7672 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 7673 1.1.2.2 skrll a_chk->rec.chunk_id = SCTP_SELECTIVE_ACK; 7674 1.1.2.2 skrll } 7675 1.1.2.2 skrll a_chk->asoc = asoc; 7676 1.1.2.2 skrll a_chk->snd_count = 0; 7677 1.1.2.2 skrll a_chk->send_size = 0; /* fill in later */ 7678 1.1.2.2 skrll a_chk->sent = SCTP_DATAGRAM_UNSENT; 7679 1.1.2.2 skrll m_size = (asoc->mapping_array_size << 3); 7680 1.1.2.2 skrll 7681 1.1.2.2 skrll if ((asoc->numduptsns) || 7682 1.1.2.2 skrll (asoc->last_data_chunk_from->dest_state & SCTP_ADDR_NOT_REACHABLE) 7683 1.1.2.2 skrll ) { 7684 1.1.2.2 skrll /* Ok, we have some duplicates or the destination for the 7685 1.1.2.2 skrll * sack is unreachable, lets see if we can select an alternate 7686 1.1.2.2 skrll * than asoc->last_data_chunk_from 7687 1.1.2.2 skrll */ 7688 1.1.2.2 skrll if ((!(asoc->last_data_chunk_from->dest_state & 7689 1.1.2.2 skrll SCTP_ADDR_NOT_REACHABLE)) && 7690 1.1.2.2 skrll (asoc->used_alt_onsack > 2)) { 7691 1.1.2.2 skrll /* We used an alt last time, don't this time */ 7692 1.1.2.2 skrll a_chk->whoTo = NULL; 7693 1.1.2.2 skrll } else { 7694 1.1.2.2 skrll asoc->used_alt_onsack++; 7695 1.1.2.2 skrll a_chk->whoTo = sctp_find_alternate_net(stcb, asoc->last_data_chunk_from); 7696 1.1.2.2 skrll } 7697 1.1.2.2 skrll if (a_chk->whoTo == NULL) { 7698 1.1.2.2 skrll /* Nope, no alternate */ 7699 1.1.2.2 skrll a_chk->whoTo = asoc->last_data_chunk_from; 7700 1.1.2.2 skrll asoc->used_alt_onsack = 0; 7701 1.1.2.2 skrll } 7702 1.1.2.2 skrll } else { 7703 1.1.2.2 skrll /* No duplicates so we use the last 7704 1.1.2.2 skrll * place we received data from. 7705 1.1.2.2 skrll */ 7706 1.1.2.2 skrll #ifdef SCTP_DEBUG 7707 1.1.2.2 skrll if (asoc->last_data_chunk_from == NULL) { 7708 1.1.2.2 skrll printf("Huh, last_data_chunk_from is null when we want to sack??\n"); 7709 1.1.2.2 skrll } 7710 1.1.2.2 skrll #endif 7711 1.1.2.2 skrll asoc->used_alt_onsack = 0; 7712 1.1.2.2 skrll a_chk->whoTo = asoc->last_data_chunk_from; 7713 1.1.2.2 skrll } 7714 1.1.2.2 skrll if (a_chk->whoTo) 7715 1.1.2.2 skrll a_chk->whoTo->ref_count++; 7716 1.1.2.2 skrll 7717 1.1.2.2 skrll /* Ok now lets formulate a MBUF with our sack */ 7718 1.1.2.2 skrll MGETHDR(a_chk->data, M_DONTWAIT, MT_DATA); 7719 1.1.2.2 skrll if ((a_chk->data == NULL) || 7720 1.1.2.2 skrll (a_chk->whoTo == NULL)) { 7721 1.1.2.2 skrll /* rats, no mbuf memory */ 7722 1.1.2.2 skrll if (a_chk->data) { 7723 1.1.2.2 skrll /* was a problem with the destination */ 7724 1.1.2.2 skrll sctp_m_freem(a_chk->data); 7725 1.1.2.2 skrll a_chk->data = NULL; 7726 1.1.2.2 skrll } 7727 1.1.2.2 skrll a_chk->whoTo->ref_count--; 7728 1.1.2.2 skrll SCTP_ZONE_FREE(sctppcbinfo.ipi_zone_chunk, a_chk); 7729 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk--; 7730 1.1.2.2 skrll if ((int)sctppcbinfo.ipi_count_chunk < 0) { 7731 1.1.2.2 skrll panic("Chunk count is negative"); 7732 1.1.2.2 skrll } 7733 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 7734 1.1.2.2 skrll sctp_timer_stop(SCTP_TIMER_TYPE_RECV, 7735 1.1.2.2 skrll stcb->sctp_ep, stcb, NULL); 7736 1.1.2.2 skrll sctp_timer_start(SCTP_TIMER_TYPE_RECV, 7737 1.1.2.2 skrll stcb->sctp_ep, stcb, NULL); 7738 1.1.2.2 skrll return; 7739 1.1.2.2 skrll } 7740 1.1.2.2 skrll /* First count the number of gap ack blocks we need */ 7741 1.1.2.2 skrll if (asoc->highest_tsn_inside_map == asoc->cumulative_tsn) { 7742 1.1.2.2 skrll /* We know if there are none above the cum-ack we 7743 1.1.2.2 skrll * have everything with NO gaps 7744 1.1.2.2 skrll */ 7745 1.1.2.2 skrll num_gap_blocks = 0; 7746 1.1.2.2 skrll } else { 7747 1.1.2.2 skrll /* Ok we must count how many gaps we 7748 1.1.2.2 skrll * have. 7749 1.1.2.2 skrll */ 7750 1.1.2.2 skrll num_gap_blocks = 0; 7751 1.1.2.2 skrll if (asoc->highest_tsn_inside_map >= asoc->mapping_array_base_tsn) { 7752 1.1.2.2 skrll maxi = (asoc->highest_tsn_inside_map - asoc->mapping_array_base_tsn); 7753 1.1.2.2 skrll } else { 7754 1.1.2.2 skrll maxi = (asoc->highest_tsn_inside_map + (MAX_TSN - asoc->mapping_array_base_tsn) + 1); 7755 1.1.2.2 skrll } 7756 1.1.2.2 skrll if (maxi > m_size) { 7757 1.1.2.2 skrll /* impossible but who knows, someone is playing with us :> */ 7758 1.1.2.2 skrll #ifdef SCTP_DEBUG 7759 1.1.2.2 skrll printf("GAK maxi:%d > m_size:%d came out higher than allowed htsn:%u base:%u cumack:%u\n", 7760 1.1.2.2 skrll maxi, 7761 1.1.2.2 skrll m_size, 7762 1.1.2.2 skrll asoc->highest_tsn_inside_map, 7763 1.1.2.2 skrll asoc->mapping_array_base_tsn, 7764 1.1.2.2 skrll asoc->cumulative_tsn 7765 1.1.2.2 skrll ); 7766 1.1.2.2 skrll #endif 7767 1.1.2.2 skrll num_gap_blocks = 0; 7768 1.1.2.2 skrll goto no_gaps_now; 7769 1.1.2.2 skrll } 7770 1.1.2.2 skrll if (asoc->cumulative_tsn >= asoc->mapping_array_base_tsn) { 7771 1.1.2.2 skrll start = (asoc->cumulative_tsn - asoc->mapping_array_base_tsn); 7772 1.1.2.2 skrll } else { 7773 1.1.2.2 skrll /* Set it so we start at 0 */ 7774 1.1.2.2 skrll start = -1; 7775 1.1.2.2 skrll } 7776 1.1.2.2 skrll /* Ok move start up one to look at the NEXT past the cum-ack */ 7777 1.1.2.2 skrll start++; 7778 1.1.2.2 skrll for (i = start; i <= maxi; i++) { 7779 1.1.2.2 skrll if (seeing_ones) { 7780 1.1.2.2 skrll /* while seeing ones I must 7781 1.1.2.2 skrll * transition back to 0 before 7782 1.1.2.2 skrll * finding the next gap and 7783 1.1.2.2 skrll * counting the segment. 7784 1.1.2.2 skrll */ 7785 1.1.2.2 skrll if (SCTP_IS_TSN_PRESENT(asoc->mapping_array, i) == 0) { 7786 1.1.2.2 skrll seeing_ones = 0; 7787 1.1.2.2 skrll } 7788 1.1.2.2 skrll } else { 7789 1.1.2.2 skrll if (SCTP_IS_TSN_PRESENT(asoc->mapping_array, i)) { 7790 1.1.2.2 skrll seeing_ones = 1; 7791 1.1.2.2 skrll num_gap_blocks++; 7792 1.1.2.2 skrll } 7793 1.1.2.2 skrll } 7794 1.1.2.2 skrll } 7795 1.1.2.2 skrll no_gaps_now: 7796 1.1.2.2 skrll if (num_gap_blocks == 0) { 7797 1.1.2.2 skrll /* 7798 1.1.2.2 skrll * Traveled all of the bits and NO one, 7799 1.1.2.2 skrll * must have reneged 7800 1.1.2.2 skrll */ 7801 1.1.2.2 skrll if (compare_with_wrap(asoc->cumulative_tsn, asoc->highest_tsn_inside_map, MAX_TSN)) { 7802 1.1.2.2 skrll asoc->highest_tsn_inside_map = asoc->cumulative_tsn; 7803 1.1.2.2 skrll #ifdef SCTP_MAP_LOGGING 7804 1.1.2.2 skrll sctp_log_map(0, 4, asoc->highest_tsn_inside_map, SCTP_MAP_SLIDE_RESULT); 7805 1.1.2.2 skrll #endif 7806 1.1.2.2 skrll } 7807 1.1.2.2 skrll } 7808 1.1.2.2 skrll } 7809 1.1.2.2 skrll 7810 1.1.2.2 skrll /* Now calculate the space needed */ 7811 1.1.2.2 skrll space = (sizeof(struct sctp_sack_chunk) + 7812 1.1.2.2 skrll (num_gap_blocks * sizeof(struct sctp_gap_ack_block)) + 7813 1.1.2.2 skrll (asoc->numduptsns * sizeof(int32_t)) 7814 1.1.2.2 skrll ); 7815 1.1.2.2 skrll if (space > (asoc->smallest_mtu-SCTP_MAX_OVERHEAD)) { 7816 1.1.2.2 skrll /* Reduce the size of the sack to fit */ 7817 1.1.2.2 skrll int calc, fit; 7818 1.1.2.2 skrll calc = (asoc->smallest_mtu - SCTP_MAX_OVERHEAD); 7819 1.1.2.2 skrll calc -= sizeof(struct sctp_gap_ack_block); 7820 1.1.2.2 skrll fit = calc/sizeof(struct sctp_gap_ack_block); 7821 1.1.2.2 skrll if (fit > (int)num_gap_blocks) { 7822 1.1.2.2 skrll /* discard some dups */ 7823 1.1.2.2 skrll asoc->numduptsns = (fit - num_gap_blocks); 7824 1.1.2.2 skrll } else { 7825 1.1.2.2 skrll /* discard all dups and some gaps */ 7826 1.1.2.2 skrll num_gap_blocks = fit; 7827 1.1.2.2 skrll asoc->numduptsns = 0; 7828 1.1.2.2 skrll } 7829 1.1.2.2 skrll /* recalc space */ 7830 1.1.2.2 skrll space = (sizeof(struct sctp_sack_chunk) + 7831 1.1.2.2 skrll (num_gap_blocks * sizeof(struct sctp_gap_ack_block)) + 7832 1.1.2.2 skrll (asoc->numduptsns * sizeof(int32_t)) 7833 1.1.2.2 skrll ); 7834 1.1.2.2 skrll 7835 1.1.2.2 skrll } 7836 1.1.2.2 skrll 7837 1.1.2.2 skrll if ((space+SCTP_MIN_OVERHEAD) > MHLEN) { 7838 1.1.2.2 skrll /* We need a cluster */ 7839 1.1.2.2 skrll MCLGET(a_chk->data, M_DONTWAIT); 7840 1.1.2.2 skrll if ((a_chk->data->m_flags & M_EXT) != M_EXT) { 7841 1.1.2.2 skrll /* can't get a cluster 7842 1.1.2.2 skrll * give up and try later. 7843 1.1.2.2 skrll */ 7844 1.1.2.2 skrll if (a_chk->data) 7845 1.1.2.2 skrll sctp_m_freem(a_chk->data); 7846 1.1.2.2 skrll a_chk->data = NULL; 7847 1.1.2.2 skrll a_chk->whoTo->ref_count--; 7848 1.1.2.2 skrll SCTP_ZONE_FREE(sctppcbinfo.ipi_zone_chunk, a_chk); 7849 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk--; 7850 1.1.2.2 skrll if ((int)sctppcbinfo.ipi_count_chunk < 0) { 7851 1.1.2.2 skrll panic("Chunk count is negative"); 7852 1.1.2.2 skrll } 7853 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 7854 1.1.2.2 skrll sctp_timer_stop(SCTP_TIMER_TYPE_RECV, 7855 1.1.2.2 skrll stcb->sctp_ep, stcb, NULL); 7856 1.1.2.2 skrll sctp_timer_start(SCTP_TIMER_TYPE_RECV, 7857 1.1.2.2 skrll stcb->sctp_ep, stcb, NULL); 7858 1.1.2.2 skrll return; 7859 1.1.2.2 skrll } 7860 1.1.2.2 skrll } 7861 1.1.2.2 skrll 7862 1.1.2.2 skrll /* ok, lets go through and fill it in */ 7863 1.1.2.2 skrll a_chk->data->m_data += SCTP_MIN_OVERHEAD; 7864 1.1.2.2 skrll sack = mtod(a_chk->data, struct sctp_sack_chunk *); 7865 1.1.2.2 skrll sack->ch.chunk_type = SCTP_SELECTIVE_ACK; 7866 1.1.2.2 skrll sack->ch.chunk_flags = asoc->receiver_nonce_sum & SCTP_SACK_NONCE_SUM; 7867 1.1.2.2 skrll sack->sack.cum_tsn_ack = htonl(asoc->cumulative_tsn); 7868 1.1.2.2 skrll sack->sack.a_rwnd = htonl(asoc->my_rwnd); 7869 1.1.2.2 skrll asoc->my_last_reported_rwnd = asoc->my_rwnd; 7870 1.1.2.2 skrll sack->sack.num_gap_ack_blks = htons(num_gap_blocks); 7871 1.1.2.2 skrll sack->sack.num_dup_tsns = htons(asoc->numduptsns); 7872 1.1.2.2 skrll 7873 1.1.2.2 skrll a_chk->send_size = (sizeof(struct sctp_sack_chunk) + 7874 1.1.2.2 skrll (num_gap_blocks * sizeof(struct sctp_gap_ack_block)) + 7875 1.1.2.2 skrll (asoc->numduptsns * sizeof(int32_t))); 7876 1.1.2.2 skrll a_chk->data->m_pkthdr.len = a_chk->data->m_len = a_chk->send_size; 7877 1.1.2.2 skrll sack->ch.chunk_length = htons(a_chk->send_size); 7878 1.1.2.2 skrll 7879 1.1.2.2 skrll gap_descriptor = (struct sctp_gap_ack_block *)((vaddr_t)sack + sizeof(struct sctp_sack_chunk)); 7880 1.1.2.2 skrll seeing_ones = 0; 7881 1.1.2.2 skrll for (i = start; i <= maxi; i++) { 7882 1.1.2.2 skrll if (num_gap_blocks == 0) { 7883 1.1.2.2 skrll break; 7884 1.1.2.2 skrll } 7885 1.1.2.2 skrll if (seeing_ones) { 7886 1.1.2.2 skrll /* while seeing Ones I must 7887 1.1.2.2 skrll * transition back to 0 before 7888 1.1.2.2 skrll * finding the next gap 7889 1.1.2.2 skrll */ 7890 1.1.2.2 skrll if (SCTP_IS_TSN_PRESENT(asoc->mapping_array, i) == 0) { 7891 1.1.2.2 skrll gap_descriptor->end = htons(((uint16_t)(i-start))); 7892 1.1.2.2 skrll gap_descriptor++; 7893 1.1.2.2 skrll seeing_ones = 0; 7894 1.1.2.2 skrll num_gap_blocks--; 7895 1.1.2.2 skrll } 7896 1.1.2.2 skrll } else { 7897 1.1.2.2 skrll if (SCTP_IS_TSN_PRESENT(asoc->mapping_array, i)) { 7898 1.1.2.2 skrll gap_descriptor->start = htons(((uint16_t)(i+1-start))); 7899 1.1.2.2 skrll /* advance struct to next pointer */ 7900 1.1.2.2 skrll seeing_ones = 1; 7901 1.1.2.2 skrll } 7902 1.1.2.2 skrll } 7903 1.1.2.2 skrll } 7904 1.1.2.2 skrll if (num_gap_blocks) { 7905 1.1.2.2 skrll /* special case where the array is all 1's 7906 1.1.2.2 skrll * to the end of the array. 7907 1.1.2.2 skrll */ 7908 1.1.2.2 skrll gap_descriptor->end = htons(((uint16_t)((i-start)))); 7909 1.1.2.2 skrll gap_descriptor++; 7910 1.1.2.2 skrll } 7911 1.1.2.2 skrll /* now we must add any dups we are going to report. */ 7912 1.1.2.2 skrll if (asoc->numduptsns) { 7913 1.1.2.2 skrll dup = (uint32_t *)gap_descriptor; 7914 1.1.2.2 skrll for (i = 0; i < asoc->numduptsns; i++) { 7915 1.1.2.2 skrll *dup = htonl(asoc->dup_tsns[i]); 7916 1.1.2.2 skrll dup++; 7917 1.1.2.2 skrll } 7918 1.1.2.2 skrll asoc->numduptsns = 0; 7919 1.1.2.2 skrll } 7920 1.1.2.2 skrll /* now that the chunk is prepared queue it to the control 7921 1.1.2.2 skrll * chunk queue. 7922 1.1.2.2 skrll */ 7923 1.1.2.2 skrll TAILQ_INSERT_TAIL(&asoc->control_send_queue, a_chk, sctp_next); 7924 1.1.2.2 skrll asoc->ctrl_queue_cnt++; 7925 1.1.2.2 skrll sctp_pegs[SCTP_PEG_SACKS_SENT]++; 7926 1.1.2.2 skrll return; 7927 1.1.2.2 skrll } 7928 1.1.2.2 skrll 7929 1.1.2.2 skrll void 7930 1.1.2.2 skrll sctp_send_abort_tcb(struct sctp_tcb *stcb, struct mbuf *operr) 7931 1.1.2.2 skrll { 7932 1.1.2.2 skrll struct mbuf *m_abort; 7933 1.1.2.2 skrll struct sctp_abort_msg *abort_m; 7934 1.1.2.2 skrll int sz; 7935 1.1.2.2 skrll abort_m = NULL; 7936 1.1.2.2 skrll MGETHDR(m_abort, M_DONTWAIT, MT_HEADER); 7937 1.1.2.2 skrll if (m_abort == NULL) { 7938 1.1.2.2 skrll /* no mbuf's */ 7939 1.1.2.2 skrll return; 7940 1.1.2.2 skrll } 7941 1.1.2.2 skrll m_abort->m_data += SCTP_MIN_OVERHEAD; 7942 1.1.2.2 skrll abort_m = mtod(m_abort, struct sctp_abort_msg *); 7943 1.1.2.2 skrll m_abort->m_len = sizeof(struct sctp_abort_msg); 7944 1.1.2.2 skrll m_abort->m_next = operr; 7945 1.1.2.2 skrll sz = 0; 7946 1.1.2.2 skrll if (operr) { 7947 1.1.2.2 skrll struct mbuf *n; 7948 1.1.2.2 skrll n = operr; 7949 1.1.2.2 skrll while (n) { 7950 1.1.2.2 skrll sz += n->m_len; 7951 1.1.2.2 skrll n = n->m_next; 7952 1.1.2.2 skrll } 7953 1.1.2.2 skrll } 7954 1.1.2.2 skrll abort_m->msg.ch.chunk_type = SCTP_ABORT_ASSOCIATION; 7955 1.1.2.2 skrll abort_m->msg.ch.chunk_flags = 0; 7956 1.1.2.2 skrll abort_m->msg.ch.chunk_length = htons(sizeof(struct sctp_abort_chunk) + 7957 1.1.2.2 skrll sz); 7958 1.1.2.2 skrll abort_m->sh.src_port = stcb->sctp_ep->sctp_lport; 7959 1.1.2.2 skrll abort_m->sh.dest_port = stcb->rport; 7960 1.1.2.2 skrll abort_m->sh.v_tag = htonl(stcb->asoc.peer_vtag); 7961 1.1.2.2 skrll abort_m->sh.checksum = 0; 7962 1.1.2.2 skrll m_abort->m_pkthdr.len = m_abort->m_len + sz; 7963 1.1.2.2 skrll m_abort->m_pkthdr.rcvif = 0; 7964 1.1.2.2 skrll sctp_lowlevel_chunk_output(stcb->sctp_ep, stcb, 7965 1.1.2.2 skrll stcb->asoc.primary_destination, 7966 1.1.2.2 skrll rtcache_getdst(&stcb->asoc.primary_destination->ro), 7967 1.1.2.2 skrll m_abort, 1, 0, NULL, 0); 7968 1.1.2.2 skrll } 7969 1.1.2.2 skrll 7970 1.1.2.2 skrll int 7971 1.1.2.2 skrll sctp_send_shutdown_complete(struct sctp_tcb *stcb, 7972 1.1.2.2 skrll struct sctp_nets *net) 7973 1.1.2.2 skrll 7974 1.1.2.2 skrll { 7975 1.1.2.2 skrll /* formulate and SEND a SHUTDOWN-COMPLETE */ 7976 1.1.2.2 skrll struct mbuf *m_shutdown_comp; 7977 1.1.2.2 skrll struct sctp_shutdown_complete_msg *comp_cp; 7978 1.1.2.2 skrll 7979 1.1.2.2 skrll m_shutdown_comp = NULL; 7980 1.1.2.2 skrll MGETHDR(m_shutdown_comp, M_DONTWAIT, MT_HEADER); 7981 1.1.2.2 skrll if (m_shutdown_comp == NULL) { 7982 1.1.2.2 skrll /* no mbuf's */ 7983 1.1.2.2 skrll return (-1); 7984 1.1.2.2 skrll } 7985 1.1.2.2 skrll m_shutdown_comp->m_data += sizeof(struct ip6_hdr); 7986 1.1.2.2 skrll comp_cp = mtod(m_shutdown_comp, struct sctp_shutdown_complete_msg *); 7987 1.1.2.2 skrll comp_cp->shut_cmp.ch.chunk_type = SCTP_SHUTDOWN_COMPLETE; 7988 1.1.2.2 skrll comp_cp->shut_cmp.ch.chunk_flags = 0; 7989 1.1.2.2 skrll comp_cp->shut_cmp.ch.chunk_length = htons(sizeof(struct sctp_shutdown_complete_chunk)); 7990 1.1.2.2 skrll comp_cp->sh.src_port = stcb->sctp_ep->sctp_lport; 7991 1.1.2.2 skrll comp_cp->sh.dest_port = stcb->rport; 7992 1.1.2.2 skrll comp_cp->sh.v_tag = htonl(stcb->asoc.peer_vtag); 7993 1.1.2.2 skrll comp_cp->sh.checksum = 0; 7994 1.1.2.2 skrll 7995 1.1.2.2 skrll m_shutdown_comp->m_pkthdr.len = m_shutdown_comp->m_len = sizeof(struct sctp_shutdown_complete_msg); 7996 1.1.2.2 skrll m_shutdown_comp->m_pkthdr.rcvif = 0; 7997 1.1.2.2 skrll sctp_lowlevel_chunk_output(stcb->sctp_ep, stcb, net, 7998 1.1.2.2 skrll rtcache_getdst(&net->ro), m_shutdown_comp, 7999 1.1.2.2 skrll 1, 0, NULL, 0); 8000 1.1.2.2 skrll if ((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) || 8001 1.1.2.2 skrll (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_IN_TCPPOOL)) { 8002 1.1.2.2 skrll stcb->sctp_ep->sctp_flags &= ~SCTP_PCB_FLAGS_CONNECTED; 8003 1.1.2.2 skrll stcb->sctp_ep->sctp_socket->so_snd.sb_cc = 0; 8004 1.1.2.2 skrll soisdisconnected(stcb->sctp_ep->sctp_socket); 8005 1.1.2.2 skrll } 8006 1.1.2.2 skrll return (0); 8007 1.1.2.2 skrll } 8008 1.1.2.2 skrll 8009 1.1.2.2 skrll int 8010 1.1.2.2 skrll sctp_send_shutdown_complete2(struct mbuf *m, int iphlen, struct sctphdr *sh) 8011 1.1.2.2 skrll { 8012 1.1.2.2 skrll /* formulate and SEND a SHUTDOWN-COMPLETE */ 8013 1.1.2.2 skrll struct mbuf *mout; 8014 1.1.2.2 skrll struct ip *iph, *iph_out; 8015 1.1.2.2 skrll struct ip6_hdr *ip6, *ip6_out; 8016 1.1.2.2 skrll int offset_out; 8017 1.1.2.2 skrll struct sctp_shutdown_complete_msg *comp_cp; 8018 1.1.2.2 skrll 8019 1.1.2.2 skrll MGETHDR(mout, M_DONTWAIT, MT_HEADER); 8020 1.1.2.2 skrll if (mout == NULL) { 8021 1.1.2.2 skrll /* no mbuf's */ 8022 1.1.2.2 skrll return (-1); 8023 1.1.2.2 skrll } 8024 1.1.2.2 skrll iph = mtod(m, struct ip *); 8025 1.1.2.2 skrll iph_out = NULL; 8026 1.1.2.2 skrll ip6_out = NULL; 8027 1.1.2.2 skrll offset_out = 0; 8028 1.1.2.2 skrll if (iph->ip_v == IPVERSION) { 8029 1.1.2.2 skrll mout->m_len = sizeof(struct ip) + 8030 1.1.2.2 skrll sizeof(struct sctp_shutdown_complete_msg); 8031 1.1.2.2 skrll mout->m_next = NULL; 8032 1.1.2.2 skrll iph_out = mtod(mout, struct ip *); 8033 1.1.2.2 skrll 8034 1.1.2.2 skrll /* Fill in the IP header for the ABORT */ 8035 1.1.2.2 skrll iph_out->ip_v = IPVERSION; 8036 1.1.2.2 skrll iph_out->ip_hl = (sizeof(struct ip)/4); 8037 1.1.2.2 skrll iph_out->ip_tos = (u_char)0; 8038 1.1.2.2 skrll iph_out->ip_id = 0; 8039 1.1.2.2 skrll iph_out->ip_off = 0; 8040 1.1.2.2 skrll iph_out->ip_ttl = MAXTTL; 8041 1.1.2.2 skrll iph_out->ip_p = IPPROTO_SCTP; 8042 1.1.2.2 skrll iph_out->ip_src.s_addr = iph->ip_dst.s_addr; 8043 1.1.2.2 skrll iph_out->ip_dst.s_addr = iph->ip_src.s_addr; 8044 1.1.2.2 skrll 8045 1.1.2.2 skrll /* let IP layer calculate this */ 8046 1.1.2.2 skrll iph_out->ip_sum = 0; 8047 1.1.2.2 skrll offset_out += sizeof(*iph_out); 8048 1.1.2.2 skrll comp_cp = (struct sctp_shutdown_complete_msg *)( 8049 1.1.2.2 skrll (vaddr_t)iph_out + offset_out); 8050 1.1.2.2 skrll } else if (iph->ip_v == (IPV6_VERSION >> 4)) { 8051 1.1.2.2 skrll ip6 = (struct ip6_hdr *)iph; 8052 1.1.2.2 skrll mout->m_len = sizeof(struct ip6_hdr) + 8053 1.1.2.2 skrll sizeof(struct sctp_shutdown_complete_msg); 8054 1.1.2.2 skrll mout->m_next = NULL; 8055 1.1.2.2 skrll ip6_out = mtod(mout, struct ip6_hdr *); 8056 1.1.2.2 skrll 8057 1.1.2.2 skrll /* Fill in the IPv6 header for the ABORT */ 8058 1.1.2.2 skrll ip6_out->ip6_flow = ip6->ip6_flow; 8059 1.1.2.2 skrll ip6_out->ip6_hlim = ip6_defhlim; 8060 1.1.2.2 skrll ip6_out->ip6_nxt = IPPROTO_SCTP; 8061 1.1.2.2 skrll ip6_out->ip6_src = ip6->ip6_dst; 8062 1.1.2.2 skrll ip6_out->ip6_dst = ip6->ip6_src; 8063 1.1.2.2 skrll ip6_out->ip6_plen = mout->m_len; 8064 1.1.2.2 skrll offset_out += sizeof(*ip6_out); 8065 1.1.2.2 skrll comp_cp = (struct sctp_shutdown_complete_msg *)( 8066 1.1.2.2 skrll (vaddr_t)ip6_out + offset_out); 8067 1.1.2.2 skrll } else { 8068 1.1.2.2 skrll /* Currently not supported. */ 8069 1.1.2.2 skrll return (-1); 8070 1.1.2.2 skrll } 8071 1.1.2.2 skrll 8072 1.1.2.2 skrll /* Now copy in and fill in the ABORT tags etc. */ 8073 1.1.2.2 skrll comp_cp->sh.src_port = sh->dest_port; 8074 1.1.2.2 skrll comp_cp->sh.dest_port = sh->src_port; 8075 1.1.2.2 skrll comp_cp->sh.checksum = 0; 8076 1.1.2.2 skrll comp_cp->sh.v_tag = sh->v_tag; 8077 1.1.2.2 skrll comp_cp->shut_cmp.ch.chunk_flags = SCTP_HAD_NO_TCB; 8078 1.1.2.2 skrll comp_cp->shut_cmp.ch.chunk_type = SCTP_SHUTDOWN_COMPLETE; 8079 1.1.2.2 skrll comp_cp->shut_cmp.ch.chunk_length = htons(sizeof(struct sctp_shutdown_complete_chunk)); 8080 1.1.2.2 skrll 8081 1.1.2.2 skrll mout->m_pkthdr.len = mout->m_len; 8082 1.1.2.2 skrll /* add checksum */ 8083 1.1.2.2 skrll if ((sctp_no_csum_on_loopback) && 8084 1.1.2.2 skrll (m->m_pkthdr.rcvif) && 8085 1.1.2.2 skrll (m->m_pkthdr.rcvif->if_type == IFT_LOOP)) { 8086 1.1.2.2 skrll comp_cp->sh.checksum = 0; 8087 1.1.2.2 skrll } else { 8088 1.1.2.2 skrll comp_cp->sh.checksum = sctp_calculate_sum(mout, NULL, offset_out); 8089 1.1.2.2 skrll } 8090 1.1.2.2 skrll 8091 1.1.2.2 skrll /* zap the rcvif, it should be null */ 8092 1.1.2.2 skrll mout->m_pkthdr.rcvif = 0; 8093 1.1.2.2 skrll /* zap the stack pointer to the route */ 8094 1.1.2.2 skrll if (iph_out != NULL) { 8095 1.1.2.2 skrll struct route ro; 8096 1.1.2.2 skrll 8097 1.1.2.2 skrll memset(&ro, 0, sizeof ro); 8098 1.1.2.2 skrll #ifdef SCTP_DEBUG 8099 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT2) { 8100 1.1.2.2 skrll printf("sctp_shutdown_complete2 calling ip_output:\n"); 8101 1.1.2.2 skrll sctp_print_address_pkt(iph_out, &comp_cp->sh); 8102 1.1.2.2 skrll } 8103 1.1.2.2 skrll #endif 8104 1.1.2.2 skrll /* set IPv4 length */ 8105 1.1.2.2 skrll iph_out->ip_len = htons(mout->m_pkthdr.len); 8106 1.1.2.2 skrll /* out it goes */ 8107 1.1.2.2 skrll ip_output(mout, 0, &ro, IP_RAWOUTPUT, NULL, NULL); 8108 1.1.2.2 skrll } else if (ip6_out != NULL) { 8109 1.1.2.2 skrll struct route ro; 8110 1.1.2.2 skrll 8111 1.1.2.2 skrll memset(&ro, 0, sizeof(ro)); 8112 1.1.2.2 skrll #ifdef SCTP_DEBUG 8113 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT2) { 8114 1.1.2.2 skrll printf("sctp_shutdown_complete2 calling ip6_output:\n"); 8115 1.1.2.2 skrll sctp_print_address_pkt((struct ip *)ip6_out, 8116 1.1.2.2 skrll &comp_cp->sh); 8117 1.1.2.2 skrll } 8118 1.1.2.2 skrll #endif 8119 1.1.2.2 skrll ip6_output(mout, NULL, &ro, 0, NULL, NULL, NULL); 8120 1.1.2.2 skrll } 8121 1.1.2.2 skrll sctp_pegs[SCTP_DATAGRAMS_SENT]++; 8122 1.1.2.2 skrll return (0); 8123 1.1.2.2 skrll } 8124 1.1.2.2 skrll 8125 1.1.2.2 skrll static struct sctp_nets * 8126 1.1.2.2 skrll sctp_select_hb_destination(struct sctp_tcb *stcb, struct timeval *now) 8127 1.1.2.2 skrll { 8128 1.1.2.2 skrll struct sctp_nets *net, *hnet; 8129 1.1.2.2 skrll int ms_goneby, highest_ms, state_overide=0; 8130 1.1.2.2 skrll 8131 1.1.2.2 skrll SCTP_GETTIME_TIMEVAL(now); 8132 1.1.2.2 skrll highest_ms = 0; 8133 1.1.2.2 skrll hnet = NULL; 8134 1.1.2.2 skrll TAILQ_FOREACH(net, &stcb->asoc.nets, sctp_next) { 8135 1.1.2.2 skrll if ( 8136 1.1.2.2 skrll ((net->dest_state & SCTP_ADDR_NOHB) && ((net->dest_state & SCTP_ADDR_UNCONFIRMED) == 0)) || 8137 1.1.2.2 skrll (net->dest_state & SCTP_ADDR_OUT_OF_SCOPE) 8138 1.1.2.2 skrll ) { 8139 1.1.2.2 skrll /* Skip this guy from consideration if HB is off AND its confirmed*/ 8140 1.1.2.2 skrll #ifdef SCTP_DEBUG 8141 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT4) { 8142 1.1.2.2 skrll printf("Skipping net:%p state:%d nohb/out-of-scope\n", 8143 1.1.2.2 skrll net, net->dest_state); 8144 1.1.2.2 skrll } 8145 1.1.2.2 skrll #endif 8146 1.1.2.2 skrll continue; 8147 1.1.2.2 skrll } 8148 1.1.2.2 skrll if (sctp_destination_is_reachable(stcb, (struct sockaddr *)&net->ro.ro_sa) == 0) { 8149 1.1.2.2 skrll /* skip this dest net from consideration */ 8150 1.1.2.2 skrll #ifdef SCTP_DEBUG 8151 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT4) { 8152 1.1.2.2 skrll printf("Skipping net:%p reachable NOT\n", 8153 1.1.2.2 skrll net); 8154 1.1.2.2 skrll } 8155 1.1.2.2 skrll #endif 8156 1.1.2.2 skrll continue; 8157 1.1.2.2 skrll } 8158 1.1.2.2 skrll if (net->last_sent_time.tv_sec) { 8159 1.1.2.2 skrll /* Sent to so we subtract */ 8160 1.1.2.2 skrll ms_goneby = (now->tv_sec - net->last_sent_time.tv_sec) * 1000; 8161 1.1.2.2 skrll } else 8162 1.1.2.2 skrll /* Never been sent to */ 8163 1.1.2.2 skrll ms_goneby = 0x7fffffff; 8164 1.1.2.2 skrll #ifdef SCTP_DEBUG 8165 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT4) { 8166 1.1.2.2 skrll printf("net:%p ms_goneby:%d\n", 8167 1.1.2.2 skrll net, ms_goneby); 8168 1.1.2.2 skrll } 8169 1.1.2.2 skrll #endif 8170 1.1.2.2 skrll /* When the address state is unconfirmed but still considered reachable, we 8171 1.1.2.2 skrll * HB at a higher rate. Once it goes confirmed OR reaches the "unreachable" 8172 1.1.2.2 skrll * state, thenw we cut it back to HB at a more normal pace. 8173 1.1.2.2 skrll */ 8174 1.1.2.2 skrll if ((net->dest_state & (SCTP_ADDR_UNCONFIRMED|SCTP_ADDR_NOT_REACHABLE)) == SCTP_ADDR_UNCONFIRMED) { 8175 1.1.2.2 skrll state_overide = 1; 8176 1.1.2.2 skrll } else { 8177 1.1.2.2 skrll state_overide = 0; 8178 1.1.2.2 skrll } 8179 1.1.2.2 skrll 8180 1.1.2.2 skrll if ((((unsigned int)ms_goneby >= net->RTO) || (state_overide)) && 8181 1.1.2.2 skrll (ms_goneby > highest_ms)) { 8182 1.1.2.2 skrll highest_ms = ms_goneby; 8183 1.1.2.2 skrll hnet = net; 8184 1.1.2.2 skrll #ifdef SCTP_DEBUG 8185 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT4) { 8186 1.1.2.2 skrll printf("net:%p is the new high\n", 8187 1.1.2.2 skrll net); 8188 1.1.2.2 skrll } 8189 1.1.2.2 skrll #endif 8190 1.1.2.2 skrll } 8191 1.1.2.2 skrll } 8192 1.1.2.2 skrll if (hnet && 8193 1.1.2.2 skrll ((hnet->dest_state & (SCTP_ADDR_UNCONFIRMED|SCTP_ADDR_NOT_REACHABLE)) == SCTP_ADDR_UNCONFIRMED)) { 8194 1.1.2.2 skrll state_overide = 1; 8195 1.1.2.2 skrll } else { 8196 1.1.2.2 skrll state_overide = 0; 8197 1.1.2.2 skrll } 8198 1.1.2.2 skrll 8199 1.1.2.2 skrll if (highest_ms && (((unsigned int)highest_ms >= hnet->RTO) || state_overide)) { 8200 1.1.2.2 skrll /* Found the one with longest delay bounds 8201 1.1.2.2 skrll * OR it is unconfirmed and still not marked 8202 1.1.2.2 skrll * unreachable. 8203 1.1.2.2 skrll */ 8204 1.1.2.2 skrll #ifdef SCTP_DEBUG 8205 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT4) { 8206 1.1.2.2 skrll printf("net:%p is the hb winner -", 8207 1.1.2.2 skrll hnet); 8208 1.1.2.2 skrll if (hnet) 8209 1.1.2.2 skrll sctp_print_address((struct sockaddr *)&hnet->ro.ro_sa); 8210 1.1.2.2 skrll else 8211 1.1.2.2 skrll printf(" none\n"); 8212 1.1.2.2 skrll } 8213 1.1.2.2 skrll #endif 8214 1.1.2.2 skrll /* update the timer now */ 8215 1.1.2.2 skrll hnet->last_sent_time = *now; 8216 1.1.2.2 skrll return (hnet); 8217 1.1.2.2 skrll } 8218 1.1.2.2 skrll /* Nothing to HB */ 8219 1.1.2.2 skrll return (NULL); 8220 1.1.2.2 skrll } 8221 1.1.2.2 skrll 8222 1.1.2.2 skrll int 8223 1.1.2.2 skrll sctp_send_hb(struct sctp_tcb *stcb, int user_req, struct sctp_nets *u_net) 8224 1.1.2.2 skrll { 8225 1.1.2.2 skrll struct sctp_tmit_chunk *chk; 8226 1.1.2.2 skrll struct sctp_nets *net; 8227 1.1.2.2 skrll struct sctp_heartbeat_chunk *hb; 8228 1.1.2.2 skrll struct timeval now; 8229 1.1.2.2 skrll struct sockaddr_in *sin; 8230 1.1.2.2 skrll struct sockaddr_in6 *sin6; 8231 1.1.2.2 skrll 8232 1.1.2.2 skrll if (user_req == 0) { 8233 1.1.2.2 skrll net = sctp_select_hb_destination(stcb, &now); 8234 1.1.2.2 skrll if (net == NULL) { 8235 1.1.2.2 skrll /* All our busy none to send to, just 8236 1.1.2.2 skrll * start the timer again. 8237 1.1.2.2 skrll */ 8238 1.1.2.2 skrll if (stcb->asoc.state == 0) { 8239 1.1.2.2 skrll return (0); 8240 1.1.2.2 skrll } 8241 1.1.2.2 skrll sctp_timer_start(SCTP_TIMER_TYPE_HEARTBEAT, 8242 1.1.2.2 skrll stcb->sctp_ep, 8243 1.1.2.2 skrll stcb, 8244 1.1.2.2 skrll net); 8245 1.1.2.2 skrll return (0); 8246 1.1.2.2 skrll } 8247 1.1.2.2 skrll #ifndef SCTP_USE_ALLMAN_BURST 8248 1.1.2.2 skrll else { 8249 1.1.2.2 skrll /* found one idle.. decay cwnd on this one 8250 1.1.2.2 skrll * by 1/2 if none outstanding. 8251 1.1.2.2 skrll */ 8252 1.1.2.2 skrll 8253 1.1.2.2 skrll if (net->flight_size == 0) { 8254 1.1.2.2 skrll net->cwnd /= 2; 8255 1.1.2.2 skrll if (net->addr_is_local) { 8256 1.1.2.2 skrll if (net->cwnd < (net->mtu *4)) { 8257 1.1.2.2 skrll net->cwnd = net->mtu * 4; 8258 1.1.2.2 skrll } 8259 1.1.2.2 skrll } else { 8260 1.1.2.2 skrll if (net->cwnd < (net->mtu * 2)) { 8261 1.1.2.2 skrll net->cwnd = net->mtu * 2; 8262 1.1.2.2 skrll } 8263 1.1.2.2 skrll } 8264 1.1.2.2 skrll 8265 1.1.2.2 skrll } 8266 1.1.2.2 skrll 8267 1.1.2.2 skrll } 8268 1.1.2.2 skrll #endif 8269 1.1.2.2 skrll } else { 8270 1.1.2.2 skrll net = u_net; 8271 1.1.2.2 skrll if (net == NULL) { 8272 1.1.2.2 skrll return (0); 8273 1.1.2.2 skrll } 8274 1.1.2.2 skrll SCTP_GETTIME_TIMEVAL(&now); 8275 1.1.2.2 skrll } 8276 1.1.2.2 skrll sin = (struct sockaddr_in *)&net->ro.ro_sa; 8277 1.1.2.2 skrll if (sin->sin_family != AF_INET) { 8278 1.1.2.2 skrll if (sin->sin_family != AF_INET6) { 8279 1.1.2.2 skrll /* huh */ 8280 1.1.2.2 skrll return (0); 8281 1.1.2.2 skrll } 8282 1.1.2.2 skrll } 8283 1.1.2.2 skrll chk = (struct sctp_tmit_chunk *)SCTP_ZONE_GET(sctppcbinfo.ipi_zone_chunk); 8284 1.1.2.2 skrll if (chk == NULL) { 8285 1.1.2.2 skrll #ifdef SCTP_DEBUG 8286 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT4) { 8287 1.1.2.2 skrll printf("Gak, can't get a chunk for hb\n"); 8288 1.1.2.2 skrll } 8289 1.1.2.2 skrll #endif 8290 1.1.2.2 skrll return (0); 8291 1.1.2.2 skrll } 8292 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 8293 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk++; 8294 1.1.2.2 skrll chk->rec.chunk_id = SCTP_HEARTBEAT_REQUEST; 8295 1.1.2.2 skrll chk->asoc = &stcb->asoc; 8296 1.1.2.2 skrll chk->send_size = sizeof(struct sctp_heartbeat_chunk); 8297 1.1.2.2 skrll MGETHDR(chk->data, M_DONTWAIT, MT_DATA); 8298 1.1.2.2 skrll if (chk->data == NULL) { 8299 1.1.2.2 skrll SCTP_ZONE_FREE(sctppcbinfo.ipi_zone_chunk, chk); 8300 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk--; 8301 1.1.2.2 skrll if ((int)sctppcbinfo.ipi_count_chunk < 0) { 8302 1.1.2.2 skrll panic("Chunk count is negative"); 8303 1.1.2.2 skrll } 8304 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 8305 1.1.2.2 skrll return (0); 8306 1.1.2.2 skrll } 8307 1.1.2.2 skrll chk->data->m_data += SCTP_MIN_OVERHEAD; 8308 1.1.2.2 skrll chk->data->m_pkthdr.len = chk->data->m_len = chk->send_size; 8309 1.1.2.2 skrll chk->sent = SCTP_DATAGRAM_UNSENT; 8310 1.1.2.2 skrll chk->snd_count = 0; 8311 1.1.2.2 skrll chk->whoTo = net; 8312 1.1.2.2 skrll chk->whoTo->ref_count++; 8313 1.1.2.2 skrll /* Now we have a mbuf that we can fill in with the details */ 8314 1.1.2.2 skrll hb = mtod(chk->data, struct sctp_heartbeat_chunk *); 8315 1.1.2.2 skrll 8316 1.1.2.2 skrll /* fill out chunk header */ 8317 1.1.2.2 skrll hb->ch.chunk_type = SCTP_HEARTBEAT_REQUEST; 8318 1.1.2.2 skrll hb->ch.chunk_flags = 0; 8319 1.1.2.2 skrll hb->ch.chunk_length = htons(chk->send_size); 8320 1.1.2.2 skrll /* Fill out hb parameter */ 8321 1.1.2.2 skrll hb->heartbeat.hb_info.ph.param_type = htons(SCTP_HEARTBEAT_INFO); 8322 1.1.2.2 skrll hb->heartbeat.hb_info.ph.param_length = htons(sizeof(struct sctp_heartbeat_info_param)); 8323 1.1.2.2 skrll hb->heartbeat.hb_info.time_value_1 = now.tv_sec; 8324 1.1.2.2 skrll hb->heartbeat.hb_info.time_value_2 = now.tv_usec; 8325 1.1.2.2 skrll /* Did our user request this one, put it in */ 8326 1.1.2.2 skrll hb->heartbeat.hb_info.user_req = user_req; 8327 1.1.2.2 skrll hb->heartbeat.hb_info.addr_family = sin->sin_family; 8328 1.1.2.2 skrll hb->heartbeat.hb_info.addr_len = sin->sin_len; 8329 1.1.2.2 skrll if (net->dest_state & SCTP_ADDR_UNCONFIRMED) { 8330 1.1.2.2 skrll /* we only take from the entropy pool if the address is 8331 1.1.2.2 skrll * not confirmed. 8332 1.1.2.2 skrll */ 8333 1.1.2.2 skrll net->heartbeat_random1 = hb->heartbeat.hb_info.random_value1 = sctp_select_initial_TSN(&stcb->sctp_ep->sctp_ep); 8334 1.1.2.2 skrll net->heartbeat_random2 = hb->heartbeat.hb_info.random_value2 = sctp_select_initial_TSN(&stcb->sctp_ep->sctp_ep); 8335 1.1.2.2 skrll } else { 8336 1.1.2.2 skrll net->heartbeat_random1 = hb->heartbeat.hb_info.random_value1 = 0; 8337 1.1.2.2 skrll net->heartbeat_random2 = hb->heartbeat.hb_info.random_value2 = 0; 8338 1.1.2.2 skrll } 8339 1.1.2.2 skrll if (sin->sin_family == AF_INET) { 8340 1.1.2.2 skrll memcpy(hb->heartbeat.hb_info.address, &sin->sin_addr, sizeof(sin->sin_addr)); 8341 1.1.2.2 skrll } else if (sin->sin_family == AF_INET6) { 8342 1.1.2.2 skrll /* We leave the scope the way it is in our lookup table. */ 8343 1.1.2.2 skrll sin6 = (struct sockaddr_in6 *)&net->ro.ro_sa; 8344 1.1.2.2 skrll memcpy(hb->heartbeat.hb_info.address, &sin6->sin6_addr, sizeof(sin6->sin6_addr)); 8345 1.1.2.2 skrll } else { 8346 1.1.2.2 skrll /* huh compiler bug */ 8347 1.1.2.2 skrll #ifdef SCTP_DEBUG 8348 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 8349 1.1.2.2 skrll printf("Compiler bug bleeds a mbuf and a chunk\n"); 8350 1.1.2.2 skrll } 8351 1.1.2.2 skrll #endif 8352 1.1.2.2 skrll return (0); 8353 1.1.2.2 skrll } 8354 1.1.2.2 skrll /* ok we have a destination that needs a beat */ 8355 1.1.2.2 skrll /* lets do the theshold management Qiaobing style */ 8356 1.1.2.2 skrll if (user_req == 0) { 8357 1.1.2.2 skrll if (sctp_threshold_management(stcb->sctp_ep, stcb, net, 8358 1.1.2.2 skrll stcb->asoc.max_send_times)) { 8359 1.1.2.2 skrll /* we have lost the association, in a way this 8360 1.1.2.2 skrll * is quite bad since we really are one less time 8361 1.1.2.2 skrll * since we really did not send yet. This is the 8362 1.1.2.2 skrll * down side to the Q's style as defined in the RFC 8363 1.1.2.2 skrll * and not my alternate style defined in the RFC. 8364 1.1.2.2 skrll */ 8365 1.1.2.2 skrll if (chk->data != NULL) { 8366 1.1.2.2 skrll sctp_m_freem(chk->data); 8367 1.1.2.2 skrll chk->data = NULL; 8368 1.1.2.2 skrll } 8369 1.1.2.2 skrll SCTP_ZONE_FREE(sctppcbinfo.ipi_zone_chunk, chk); 8370 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk--; 8371 1.1.2.2 skrll if ((int)sctppcbinfo.ipi_count_chunk < 0) { 8372 1.1.2.2 skrll panic("Chunk count is negative"); 8373 1.1.2.2 skrll } 8374 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 8375 1.1.2.2 skrll return (-1); 8376 1.1.2.2 skrll } 8377 1.1.2.2 skrll } 8378 1.1.2.2 skrll net->hb_responded = 0; 8379 1.1.2.2 skrll #ifdef SCTP_DEBUG 8380 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT4) { 8381 1.1.2.2 skrll printf("Inserting chunk for HB\n"); 8382 1.1.2.2 skrll } 8383 1.1.2.2 skrll #endif 8384 1.1.2.2 skrll TAILQ_INSERT_TAIL(&stcb->asoc.control_send_queue, chk, sctp_next); 8385 1.1.2.2 skrll stcb->asoc.ctrl_queue_cnt++; 8386 1.1.2.2 skrll sctp_pegs[SCTP_HB_SENT]++; 8387 1.1.2.2 skrll /* 8388 1.1.2.2 skrll * Call directly med level routine to put out the chunk. It will 8389 1.1.2.2 skrll * always tumble out control chunks aka HB but it may even tumble 8390 1.1.2.2 skrll * out data too. 8391 1.1.2.2 skrll */ 8392 1.1.2.2 skrll if (user_req == 0) { 8393 1.1.2.2 skrll /* Ok now lets start the HB timer if it is NOT a user req */ 8394 1.1.2.2 skrll sctp_timer_start(SCTP_TIMER_TYPE_HEARTBEAT, stcb->sctp_ep, 8395 1.1.2.2 skrll stcb, net); 8396 1.1.2.2 skrll } 8397 1.1.2.2 skrll return (1); 8398 1.1.2.2 skrll } 8399 1.1.2.2 skrll 8400 1.1.2.2 skrll void 8401 1.1.2.2 skrll sctp_send_ecn_echo(struct sctp_tcb *stcb, struct sctp_nets *net, 8402 1.1.2.2 skrll uint32_t high_tsn) 8403 1.1.2.2 skrll { 8404 1.1.2.2 skrll struct sctp_association *asoc; 8405 1.1.2.2 skrll struct sctp_ecne_chunk *ecne; 8406 1.1.2.2 skrll struct sctp_tmit_chunk *chk; 8407 1.1.2.2 skrll asoc = &stcb->asoc; 8408 1.1.2.2 skrll TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) { 8409 1.1.2.2 skrll if (chk->rec.chunk_id == SCTP_ECN_ECHO) { 8410 1.1.2.2 skrll /* found a previous ECN_ECHO update it if needed */ 8411 1.1.2.2 skrll ecne = mtod(chk->data, struct sctp_ecne_chunk *); 8412 1.1.2.2 skrll ecne->tsn = htonl(high_tsn); 8413 1.1.2.2 skrll return; 8414 1.1.2.2 skrll } 8415 1.1.2.2 skrll } 8416 1.1.2.2 skrll /* nope could not find one to update so we must build one */ 8417 1.1.2.2 skrll chk = (struct sctp_tmit_chunk *)SCTP_ZONE_GET(sctppcbinfo.ipi_zone_chunk); 8418 1.1.2.2 skrll if (chk == NULL) { 8419 1.1.2.2 skrll return; 8420 1.1.2.2 skrll } 8421 1.1.2.2 skrll sctp_pegs[SCTP_ECNE_SENT]++; 8422 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk++; 8423 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 8424 1.1.2.2 skrll chk->rec.chunk_id = SCTP_ECN_ECHO; 8425 1.1.2.2 skrll chk->asoc = &stcb->asoc; 8426 1.1.2.2 skrll chk->send_size = sizeof(struct sctp_ecne_chunk); 8427 1.1.2.2 skrll MGETHDR(chk->data, M_DONTWAIT, MT_DATA); 8428 1.1.2.2 skrll if (chk->data == NULL) { 8429 1.1.2.2 skrll SCTP_ZONE_FREE(sctppcbinfo.ipi_zone_chunk, chk); 8430 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk--; 8431 1.1.2.2 skrll if ((int)sctppcbinfo.ipi_count_chunk < 0) { 8432 1.1.2.2 skrll panic("Chunk count is negative"); 8433 1.1.2.2 skrll } 8434 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 8435 1.1.2.2 skrll return; 8436 1.1.2.2 skrll } 8437 1.1.2.2 skrll chk->data->m_data += SCTP_MIN_OVERHEAD; 8438 1.1.2.2 skrll chk->data->m_pkthdr.len = chk->data->m_len = chk->send_size; 8439 1.1.2.2 skrll chk->sent = SCTP_DATAGRAM_UNSENT; 8440 1.1.2.2 skrll chk->snd_count = 0; 8441 1.1.2.2 skrll chk->whoTo = net; 8442 1.1.2.2 skrll chk->whoTo->ref_count++; 8443 1.1.2.2 skrll ecne = mtod(chk->data, struct sctp_ecne_chunk *); 8444 1.1.2.2 skrll ecne->ch.chunk_type = SCTP_ECN_ECHO; 8445 1.1.2.2 skrll ecne->ch.chunk_flags = 0; 8446 1.1.2.2 skrll ecne->ch.chunk_length = htons(sizeof(struct sctp_ecne_chunk)); 8447 1.1.2.2 skrll ecne->tsn = htonl(high_tsn); 8448 1.1.2.2 skrll TAILQ_INSERT_TAIL(&stcb->asoc.control_send_queue, chk, sctp_next); 8449 1.1.2.2 skrll asoc->ctrl_queue_cnt++; 8450 1.1.2.2 skrll } 8451 1.1.2.2 skrll 8452 1.1.2.2 skrll void 8453 1.1.2.2 skrll sctp_send_packet_dropped(struct sctp_tcb *stcb, struct sctp_nets *net, 8454 1.1.2.2 skrll struct mbuf *m, int iphlen, int bad_crc) 8455 1.1.2.2 skrll { 8456 1.1.2.2 skrll struct sctp_association *asoc; 8457 1.1.2.2 skrll struct sctp_pktdrop_chunk *drp; 8458 1.1.2.2 skrll struct sctp_tmit_chunk *chk; 8459 1.1.2.2 skrll uint8_t *datap; 8460 1.1.2.2 skrll int len; 8461 1.1.2.2 skrll unsigned int small_one; 8462 1.1.2.2 skrll struct ip *iph; 8463 1.1.2.2 skrll 8464 1.1.2.2 skrll long spc; 8465 1.1.2.2 skrll asoc = &stcb->asoc; 8466 1.1.2.2 skrll if (asoc->peer_supports_pktdrop == 0) { 8467 1.1.2.2 skrll /* peer must declare support before I 8468 1.1.2.2 skrll * send one. 8469 1.1.2.2 skrll */ 8470 1.1.2.2 skrll return; 8471 1.1.2.2 skrll } 8472 1.1.2.2 skrll chk = (struct sctp_tmit_chunk *)SCTP_ZONE_GET(sctppcbinfo.ipi_zone_chunk); 8473 1.1.2.2 skrll if (chk == NULL) { 8474 1.1.2.2 skrll return; 8475 1.1.2.2 skrll } 8476 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk++; 8477 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 8478 1.1.2.2 skrll 8479 1.1.2.2 skrll iph = mtod(m, struct ip *); 8480 1.1.2.2 skrll if (iph == NULL) { 8481 1.1.2.2 skrll return; 8482 1.1.2.2 skrll } 8483 1.1.2.2 skrll if (iph->ip_v == IPVERSION) { 8484 1.1.2.2 skrll /* IPv4 */ 8485 1.1.2.2 skrll #if defined(__FreeBSD__) 8486 1.1.2.2 skrll len = chk->send_size = iph->ip_len; 8487 1.1.2.2 skrll #else 8488 1.1.2.2 skrll len = chk->send_size = (iph->ip_len - iphlen); 8489 1.1.2.2 skrll #endif 8490 1.1.2.2 skrll } else { 8491 1.1.2.2 skrll struct ip6_hdr *ip6h; 8492 1.1.2.2 skrll /* IPv6 */ 8493 1.1.2.2 skrll ip6h = mtod(m, struct ip6_hdr *); 8494 1.1.2.2 skrll len = chk->send_size = htons(ip6h->ip6_plen); 8495 1.1.2.2 skrll } 8496 1.1.2.2 skrll if ((len+iphlen) > m->m_pkthdr.len) { 8497 1.1.2.2 skrll /* huh */ 8498 1.1.2.2 skrll chk->send_size = len = m->m_pkthdr.len - iphlen; 8499 1.1.2.2 skrll } 8500 1.1.2.2 skrll chk->asoc = &stcb->asoc; 8501 1.1.2.2 skrll MGETHDR(chk->data, M_DONTWAIT, MT_DATA); 8502 1.1.2.2 skrll if (chk->data == NULL) { 8503 1.1.2.2 skrll jump_out: 8504 1.1.2.2 skrll SCTP_ZONE_FREE(sctppcbinfo.ipi_zone_chunk, chk); 8505 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk--; 8506 1.1.2.2 skrll if ((int)sctppcbinfo.ipi_count_chunk < 0) { 8507 1.1.2.2 skrll panic("Chunk count is negative"); 8508 1.1.2.2 skrll } 8509 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 8510 1.1.2.2 skrll return; 8511 1.1.2.2 skrll } 8512 1.1.2.2 skrll if ((chk->send_size+sizeof(struct sctp_pktdrop_chunk)+SCTP_MIN_OVERHEAD) > MHLEN) { 8513 1.1.2.2 skrll MCLGET(chk->data, M_DONTWAIT); 8514 1.1.2.2 skrll if ((chk->data->m_flags & M_EXT) == 0) { 8515 1.1.2.2 skrll /* Give up */ 8516 1.1.2.2 skrll sctp_m_freem(chk->data); 8517 1.1.2.2 skrll chk->data = NULL; 8518 1.1.2.2 skrll goto jump_out; 8519 1.1.2.2 skrll } 8520 1.1.2.2 skrll } 8521 1.1.2.2 skrll chk->data->m_data += SCTP_MIN_OVERHEAD; 8522 1.1.2.2 skrll drp = mtod(chk->data, struct sctp_pktdrop_chunk *); 8523 1.1.2.2 skrll if (drp == NULL) { 8524 1.1.2.2 skrll sctp_m_freem(chk->data); 8525 1.1.2.2 skrll chk->data = NULL; 8526 1.1.2.2 skrll goto jump_out; 8527 1.1.2.2 skrll } 8528 1.1.2.2 skrll small_one = asoc->smallest_mtu; 8529 1.1.2.2 skrll if (small_one > MCLBYTES) { 8530 1.1.2.2 skrll /* Only one cluster worth of data MAX */ 8531 1.1.2.2 skrll small_one = MCLBYTES; 8532 1.1.2.2 skrll } 8533 1.1.2.2 skrll chk->book_size = (chk->send_size + sizeof(struct sctp_pktdrop_chunk) + 8534 1.1.2.2 skrll sizeof(struct sctphdr) + SCTP_MED_OVERHEAD); 8535 1.1.2.2 skrll if (chk->book_size > small_one) { 8536 1.1.2.2 skrll drp->ch.chunk_flags = SCTP_PACKET_TRUNCATED; 8537 1.1.2.2 skrll drp->trunc_len = htons(chk->send_size); 8538 1.1.2.2 skrll chk->send_size = small_one - (SCTP_MED_OVERHEAD + 8539 1.1.2.2 skrll sizeof(struct sctp_pktdrop_chunk) + 8540 1.1.2.2 skrll sizeof(struct sctphdr)); 8541 1.1.2.2 skrll len = chk->send_size; 8542 1.1.2.2 skrll } else { 8543 1.1.2.2 skrll /* no truncation needed */ 8544 1.1.2.2 skrll drp->ch.chunk_flags = 0; 8545 1.1.2.2 skrll drp->trunc_len = htons(0); 8546 1.1.2.2 skrll } 8547 1.1.2.2 skrll if (bad_crc) { 8548 1.1.2.2 skrll drp->ch.chunk_flags |= SCTP_BADCRC; 8549 1.1.2.2 skrll } 8550 1.1.2.2 skrll chk->send_size += sizeof(struct sctp_pktdrop_chunk); 8551 1.1.2.2 skrll chk->data->m_pkthdr.len = chk->data->m_len = chk->send_size; 8552 1.1.2.2 skrll chk->sent = SCTP_DATAGRAM_UNSENT; 8553 1.1.2.2 skrll chk->snd_count = 0; 8554 1.1.2.2 skrll if (net) { 8555 1.1.2.2 skrll /* we should hit here */ 8556 1.1.2.2 skrll chk->whoTo = net; 8557 1.1.2.2 skrll } else { 8558 1.1.2.2 skrll chk->whoTo = asoc->primary_destination; 8559 1.1.2.2 skrll } 8560 1.1.2.2 skrll chk->whoTo->ref_count++; 8561 1.1.2.2 skrll chk->rec.chunk_id = SCTP_PACKET_DROPPED; 8562 1.1.2.2 skrll drp->ch.chunk_type = SCTP_PACKET_DROPPED; 8563 1.1.2.2 skrll drp->ch.chunk_length = htons(chk->send_size); 8564 1.1.2.2 skrll spc = stcb->sctp_socket->so_rcv.sb_hiwat; 8565 1.1.2.2 skrll if (spc < 0) { 8566 1.1.2.2 skrll spc = 0; 8567 1.1.2.2 skrll } 8568 1.1.2.2 skrll drp->bottle_bw = htonl(spc); 8569 1.1.2.2 skrll drp->current_onq = htonl(asoc->size_on_delivery_queue + 8570 1.1.2.2 skrll asoc->size_on_reasm_queue + 8571 1.1.2.2 skrll asoc->size_on_all_streams + 8572 1.1.2.2 skrll asoc->my_rwnd_control_len + 8573 1.1.2.2 skrll stcb->sctp_socket->so_rcv.sb_cc); 8574 1.1.2.2 skrll drp->reserved = 0; 8575 1.1.2.2 skrll datap = drp->data; 8576 1.1.2.2 skrll m_copydata(m, iphlen, len, datap); 8577 1.1.2.2 skrll TAILQ_INSERT_TAIL(&stcb->asoc.control_send_queue, chk, sctp_next); 8578 1.1.2.2 skrll asoc->ctrl_queue_cnt++; 8579 1.1.2.2 skrll } 8580 1.1.2.2 skrll 8581 1.1.2.2 skrll void 8582 1.1.2.2 skrll sctp_send_cwr(struct sctp_tcb *stcb, struct sctp_nets *net, uint32_t high_tsn) 8583 1.1.2.2 skrll { 8584 1.1.2.2 skrll struct sctp_association *asoc; 8585 1.1.2.2 skrll struct sctp_cwr_chunk *cwr; 8586 1.1.2.2 skrll struct sctp_tmit_chunk *chk; 8587 1.1.2.2 skrll 8588 1.1.2.2 skrll asoc = &stcb->asoc; 8589 1.1.2.2 skrll TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) { 8590 1.1.2.2 skrll if (chk->rec.chunk_id == SCTP_ECN_CWR) { 8591 1.1.2.2 skrll /* found a previous ECN_CWR update it if needed */ 8592 1.1.2.2 skrll cwr = mtod(chk->data, struct sctp_cwr_chunk *); 8593 1.1.2.2 skrll if (compare_with_wrap(high_tsn, ntohl(cwr->tsn), 8594 1.1.2.2 skrll MAX_TSN)) { 8595 1.1.2.2 skrll cwr->tsn = htonl(high_tsn); 8596 1.1.2.2 skrll } 8597 1.1.2.2 skrll return; 8598 1.1.2.2 skrll } 8599 1.1.2.2 skrll } 8600 1.1.2.2 skrll /* nope could not find one to update so we must build one */ 8601 1.1.2.2 skrll chk = (struct sctp_tmit_chunk *)SCTP_ZONE_GET(sctppcbinfo.ipi_zone_chunk); 8602 1.1.2.2 skrll if (chk == NULL) { 8603 1.1.2.2 skrll return; 8604 1.1.2.2 skrll } 8605 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk++; 8606 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 8607 1.1.2.2 skrll chk->rec.chunk_id = SCTP_ECN_CWR; 8608 1.1.2.2 skrll chk->asoc = &stcb->asoc; 8609 1.1.2.2 skrll chk->send_size = sizeof(struct sctp_cwr_chunk); 8610 1.1.2.2 skrll MGETHDR(chk->data, M_DONTWAIT, MT_DATA); 8611 1.1.2.2 skrll if (chk->data == NULL) { 8612 1.1.2.2 skrll SCTP_ZONE_FREE(sctppcbinfo.ipi_zone_chunk, chk); 8613 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk--; 8614 1.1.2.2 skrll if ((int)sctppcbinfo.ipi_count_chunk < 0) { 8615 1.1.2.2 skrll panic("Chunk count is negative"); 8616 1.1.2.2 skrll } 8617 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 8618 1.1.2.2 skrll return; 8619 1.1.2.2 skrll } 8620 1.1.2.2 skrll chk->data->m_data += SCTP_MIN_OVERHEAD; 8621 1.1.2.2 skrll chk->data->m_pkthdr.len = chk->data->m_len = chk->send_size; 8622 1.1.2.2 skrll chk->sent = SCTP_DATAGRAM_UNSENT; 8623 1.1.2.2 skrll chk->snd_count = 0; 8624 1.1.2.2 skrll chk->whoTo = net; 8625 1.1.2.2 skrll chk->whoTo->ref_count++; 8626 1.1.2.2 skrll cwr = mtod(chk->data, struct sctp_cwr_chunk *); 8627 1.1.2.2 skrll cwr->ch.chunk_type = SCTP_ECN_CWR; 8628 1.1.2.2 skrll cwr->ch.chunk_flags = 0; 8629 1.1.2.2 skrll cwr->ch.chunk_length = htons(sizeof(struct sctp_cwr_chunk)); 8630 1.1.2.2 skrll cwr->tsn = htonl(high_tsn); 8631 1.1.2.2 skrll TAILQ_INSERT_TAIL(&stcb->asoc.control_send_queue, chk, sctp_next); 8632 1.1.2.2 skrll asoc->ctrl_queue_cnt++; 8633 1.1.2.2 skrll } 8634 1.1.2.2 skrll static void 8635 1.1.2.2 skrll sctp_reset_the_streams(struct sctp_tcb *stcb, 8636 1.1.2.2 skrll struct sctp_stream_reset_request *req, int number_entries, uint16_t *list) 8637 1.1.2.2 skrll { 8638 1.1.2.2 skrll int i; 8639 1.1.2.2 skrll 8640 1.1.2.2 skrll if (req->reset_flags & SCTP_RESET_ALL) { 8641 1.1.2.2 skrll for (i=0; i<stcb->asoc.streamoutcnt; i++) { 8642 1.1.2.2 skrll stcb->asoc.strmout[i].next_sequence_sent = 0; 8643 1.1.2.2 skrll } 8644 1.1.2.2 skrll } else if (number_entries) { 8645 1.1.2.2 skrll for (i=0; i<number_entries; i++) { 8646 1.1.2.2 skrll if (list[i] >= stcb->asoc.streamoutcnt) { 8647 1.1.2.2 skrll /* no such stream */ 8648 1.1.2.2 skrll continue; 8649 1.1.2.2 skrll } 8650 1.1.2.2 skrll stcb->asoc.strmout[(list[i])].next_sequence_sent = 0; 8651 1.1.2.2 skrll } 8652 1.1.2.2 skrll } 8653 1.1.2.2 skrll sctp_ulp_notify(SCTP_NOTIFY_STR_RESET_SEND, stcb, number_entries, (void *)list); 8654 1.1.2.2 skrll } 8655 1.1.2.2 skrll 8656 1.1.2.2 skrll void 8657 1.1.2.2 skrll sctp_send_str_reset_ack(struct sctp_tcb *stcb, 8658 1.1.2.2 skrll struct sctp_stream_reset_request *req) 8659 1.1.2.2 skrll { 8660 1.1.2.2 skrll struct sctp_association *asoc; 8661 1.1.2.2 skrll struct sctp_stream_reset_resp *strack; 8662 1.1.2.2 skrll struct sctp_tmit_chunk *chk; 8663 1.1.2.2 skrll uint32_t seq; 8664 1.1.2.2 skrll int number_entries, i; 8665 1.1.2.2 skrll uint8_t two_way=0, not_peer=0; 8666 1.1.2.2 skrll uint16_t *list=NULL; 8667 1.1.2.2 skrll 8668 1.1.2.2 skrll asoc = &stcb->asoc; 8669 1.1.2.2 skrll if (req->reset_flags & SCTP_RESET_ALL) 8670 1.1.2.2 skrll number_entries = 0; 8671 1.1.2.2 skrll else 8672 1.1.2.2 skrll number_entries = (ntohs(req->ph.param_length) - sizeof(struct sctp_stream_reset_request)) / sizeof(uint16_t); 8673 1.1.2.2 skrll 8674 1.1.2.2 skrll chk = (struct sctp_tmit_chunk *)SCTP_ZONE_GET(sctppcbinfo.ipi_zone_chunk); 8675 1.1.2.2 skrll if (chk == NULL) { 8676 1.1.2.2 skrll return; 8677 1.1.2.2 skrll } 8678 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk++; 8679 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 8680 1.1.2.2 skrll chk->rec.chunk_id = SCTP_STREAM_RESET; 8681 1.1.2.2 skrll chk->asoc = &stcb->asoc; 8682 1.1.2.2 skrll chk->send_size = sizeof(struct sctp_stream_reset_resp) + (number_entries * sizeof(uint16_t)); 8683 1.1.2.2 skrll MGETHDR(chk->data, M_DONTWAIT, MT_DATA); 8684 1.1.2.2 skrll if (chk->data == NULL) { 8685 1.1.2.2 skrll strresp_jump_out: 8686 1.1.2.2 skrll SCTP_ZONE_FREE(sctppcbinfo.ipi_zone_chunk, chk); 8687 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk--; 8688 1.1.2.2 skrll if ((int)sctppcbinfo.ipi_count_chunk < 0) { 8689 1.1.2.2 skrll panic("Chunk count is negative"); 8690 1.1.2.2 skrll } 8691 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 8692 1.1.2.2 skrll return; 8693 1.1.2.2 skrll } 8694 1.1.2.2 skrll chk->data->m_data += SCTP_MIN_OVERHEAD; 8695 1.1.2.2 skrll chk->data->m_pkthdr.len = chk->data->m_len = SCTP_SIZE32(chk->send_size); 8696 1.1.2.2 skrll if (M_TRAILINGSPACE(chk->data) < (int)SCTP_SIZE32(chk->send_size)) { 8697 1.1.2.2 skrll MCLGET(chk->data, M_DONTWAIT); 8698 1.1.2.2 skrll if ((chk->data->m_flags & M_EXT) == 0) { 8699 1.1.2.2 skrll /* Give up */ 8700 1.1.2.2 skrll sctp_m_freem(chk->data); 8701 1.1.2.2 skrll chk->data = NULL; 8702 1.1.2.2 skrll goto strresp_jump_out; 8703 1.1.2.2 skrll } 8704 1.1.2.2 skrll chk->data->m_data += SCTP_MIN_OVERHEAD; 8705 1.1.2.2 skrll } 8706 1.1.2.2 skrll if (M_TRAILINGSPACE(chk->data) < (int)SCTP_SIZE32(chk->send_size)) { 8707 1.1.2.2 skrll /* can't do it, no room */ 8708 1.1.2.2 skrll /* Give up */ 8709 1.1.2.2 skrll sctp_m_freem(chk->data); 8710 1.1.2.2 skrll chk->data = NULL; 8711 1.1.2.2 skrll goto strresp_jump_out; 8712 1.1.2.2 skrll 8713 1.1.2.2 skrll } 8714 1.1.2.2 skrll chk->sent = SCTP_DATAGRAM_UNSENT; 8715 1.1.2.2 skrll chk->snd_count = 0; 8716 1.1.2.2 skrll chk->whoTo = asoc->primary_destination; 8717 1.1.2.2 skrll chk->whoTo->ref_count++; 8718 1.1.2.2 skrll strack = mtod(chk->data, struct sctp_stream_reset_resp *); 8719 1.1.2.2 skrll 8720 1.1.2.2 skrll strack->ch.chunk_type = SCTP_STREAM_RESET; 8721 1.1.2.2 skrll strack->ch.chunk_flags = 0; 8722 1.1.2.2 skrll strack->ch.chunk_length = htons(chk->send_size); 8723 1.1.2.2 skrll 8724 1.1.2.2 skrll memset(strack->sr_resp.reset_pad, 0, sizeof(strack->sr_resp.reset_pad)); 8725 1.1.2.2 skrll 8726 1.1.2.2 skrll strack->sr_resp.ph.param_type = ntohs(SCTP_STR_RESET_RESPONSE); 8727 1.1.2.2 skrll strack->sr_resp.ph.param_length = htons((chk->send_size - sizeof(struct sctp_chunkhdr))); 8728 1.1.2.2 skrll 8729 1.1.2.2 skrll 8730 1.1.2.2 skrll 8731 1.1.2.2 skrll if (chk->send_size % 4) { 8732 1.1.2.2 skrll /* need a padding for the end */ 8733 1.1.2.2 skrll int pad; 8734 1.1.2.2 skrll uint8_t *end; 8735 1.1.2.2 skrll end = (uint8_t *)((vaddr_t)strack + chk->send_size); 8736 1.1.2.2 skrll pad = chk->send_size % 4; 8737 1.1.2.2 skrll for (i = 0; i < pad; i++) { 8738 1.1.2.2 skrll end[i] = 0; 8739 1.1.2.2 skrll } 8740 1.1.2.2 skrll chk->send_size += pad; 8741 1.1.2.2 skrll } 8742 1.1.2.2 skrll 8743 1.1.2.2 skrll /* actual response */ 8744 1.1.2.2 skrll if (req->reset_flags & SCTP_RESET_YOUR) { 8745 1.1.2.2 skrll strack->sr_resp.reset_flags = SCTP_RESET_PERFORMED; 8746 1.1.2.2 skrll } else { 8747 1.1.2.2 skrll strack->sr_resp.reset_flags = 0; 8748 1.1.2.2 skrll } 8749 1.1.2.2 skrll 8750 1.1.2.2 skrll /* copied from reset request */ 8751 1.1.2.2 skrll strack->sr_resp.reset_req_seq_resp = req->reset_req_seq; 8752 1.1.2.2 skrll seq = ntohl(req->reset_req_seq); 8753 1.1.2.2 skrll 8754 1.1.2.2 skrll list = req->list_of_streams; 8755 1.1.2.2 skrll /* copy the un-converted network byte order streams */ 8756 1.1.2.2 skrll for (i=0; i<number_entries; i++) { 8757 1.1.2.2 skrll strack->sr_resp.list_of_streams[i] = list[i]; 8758 1.1.2.2 skrll } 8759 1.1.2.2 skrll if (asoc->str_reset_seq_in == seq) { 8760 1.1.2.2 skrll /* is it the next expected? */ 8761 1.1.2.2 skrll asoc->str_reset_seq_in++; 8762 1.1.2.2 skrll strack->sr_resp.reset_at_tsn = htonl(asoc->sending_seq); 8763 1.1.2.2 skrll asoc->str_reset_sending_seq = asoc->sending_seq; 8764 1.1.2.2 skrll if (number_entries) { 8765 1.1.2.2 skrll uint16_t temp; 8766 1.1.2.2 skrll /* convert them to host byte order */ 8767 1.1.2.2 skrll for (i=0 ; i<number_entries; i++) { 8768 1.1.2.2 skrll temp = ntohs(list[i]); 8769 1.1.2.2 skrll list[i] = temp; 8770 1.1.2.2 skrll } 8771 1.1.2.2 skrll } 8772 1.1.2.2 skrll if (req->reset_flags & SCTP_RESET_YOUR) { 8773 1.1.2.2 skrll /* reset my outbound streams */ 8774 1.1.2.2 skrll sctp_reset_the_streams(stcb, req , number_entries, list); 8775 1.1.2.2 skrll } 8776 1.1.2.2 skrll if (req->reset_flags & SCTP_RECIPRICAL) { 8777 1.1.2.2 skrll /* reset peer too */ 8778 1.1.2.2 skrll sctp_send_str_reset_req(stcb, number_entries, list, two_way, not_peer); 8779 1.1.2.2 skrll } 8780 1.1.2.2 skrll 8781 1.1.2.2 skrll } else { 8782 1.1.2.2 skrll /* no its a retran so I must just ack and do nothing */ 8783 1.1.2.2 skrll strack->sr_resp.reset_at_tsn = htonl(asoc->str_reset_sending_seq); 8784 1.1.2.2 skrll } 8785 1.1.2.2 skrll strack->sr_resp.cumulative_tsn = htonl(asoc->cumulative_tsn); 8786 1.1.2.2 skrll TAILQ_INSERT_TAIL(&asoc->control_send_queue, 8787 1.1.2.2 skrll chk, 8788 1.1.2.2 skrll sctp_next); 8789 1.1.2.2 skrll asoc->ctrl_queue_cnt++; 8790 1.1.2.2 skrll } 8791 1.1.2.2 skrll 8792 1.1.2.2 skrll 8793 1.1.2.2 skrll void 8794 1.1.2.2 skrll sctp_send_str_reset_req(struct sctp_tcb *stcb, 8795 1.1.2.2 skrll int number_entrys, uint16_t *list, uint8_t two_way, uint8_t not_peer) 8796 1.1.2.2 skrll { 8797 1.1.2.2 skrll /* Send a stream reset request. The number_entrys may be 0 and list NULL 8798 1.1.2.2 skrll * if the request is to reset all streams. If two_way is true then we 8799 1.1.2.2 skrll * not only request a RESET of the received streams but we also 8800 1.1.2.2 skrll * request the peer to send a reset req to us too. 8801 1.1.2.2 skrll * Flag combinations in table: 8802 1.1.2.2 skrll * 8803 1.1.2.2 skrll * two_way | not_peer | = | Flags 8804 1.1.2.2 skrll * ------------------------------ 8805 1.1.2.2 skrll * 0 | 0 | = | SCTP_RESET_YOUR (just the peer) 8806 1.1.2.2 skrll * 1 | 0 | = | SCTP_RESET_YOUR | SCTP_RECIPRICAL (both sides) 8807 1.1.2.2 skrll * 0 | 1 | = | Not a Valid Request (not anyone) 8808 1.1.2.2 skrll * 1 | 1 | = | SCTP_RESET_RECIPRICAL (Just local host) 8809 1.1.2.2 skrll */ 8810 1.1.2.2 skrll struct sctp_association *asoc; 8811 1.1.2.2 skrll struct sctp_stream_reset_req *strreq; 8812 1.1.2.2 skrll struct sctp_tmit_chunk *chk; 8813 1.1.2.2 skrll 8814 1.1.2.2 skrll 8815 1.1.2.2 skrll asoc = &stcb->asoc; 8816 1.1.2.2 skrll if (asoc->stream_reset_outstanding) { 8817 1.1.2.2 skrll /* Already one pending, must get ACK back 8818 1.1.2.2 skrll * to clear the flag. 8819 1.1.2.2 skrll */ 8820 1.1.2.2 skrll return; 8821 1.1.2.2 skrll } 8822 1.1.2.2 skrll 8823 1.1.2.2 skrll if ((two_way == 0) && (not_peer == 1)) { 8824 1.1.2.2 skrll /* not a valid request */ 8825 1.1.2.2 skrll return; 8826 1.1.2.2 skrll } 8827 1.1.2.2 skrll 8828 1.1.2.2 skrll chk = (struct sctp_tmit_chunk *)SCTP_ZONE_GET(sctppcbinfo.ipi_zone_chunk); 8829 1.1.2.2 skrll if (chk == NULL) { 8830 1.1.2.2 skrll return; 8831 1.1.2.2 skrll } 8832 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk++; 8833 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 8834 1.1.2.2 skrll chk->rec.chunk_id = SCTP_STREAM_RESET; 8835 1.1.2.2 skrll chk->asoc = &stcb->asoc; 8836 1.1.2.2 skrll chk->send_size = sizeof(struct sctp_stream_reset_req) + (number_entrys * sizeof(uint16_t)); 8837 1.1.2.2 skrll MGETHDR(chk->data, M_DONTWAIT, MT_DATA); 8838 1.1.2.2 skrll if (chk->data == NULL) { 8839 1.1.2.2 skrll strreq_jump_out: 8840 1.1.2.2 skrll SCTP_ZONE_FREE(sctppcbinfo.ipi_zone_chunk, chk); 8841 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk--; 8842 1.1.2.2 skrll if ((int)sctppcbinfo.ipi_count_chunk < 0) { 8843 1.1.2.2 skrll panic("Chunk count is negative"); 8844 1.1.2.2 skrll } 8845 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 8846 1.1.2.2 skrll return; 8847 1.1.2.2 skrll } 8848 1.1.2.2 skrll chk->data->m_data += SCTP_MIN_OVERHEAD; 8849 1.1.2.2 skrll chk->data->m_pkthdr.len = chk->data->m_len = SCTP_SIZE32(chk->send_size); 8850 1.1.2.2 skrll if (M_TRAILINGSPACE(chk->data) < (int)SCTP_SIZE32(chk->send_size)) { 8851 1.1.2.2 skrll MCLGET(chk->data, M_DONTWAIT); 8852 1.1.2.2 skrll if ((chk->data->m_flags & M_EXT) == 0) { 8853 1.1.2.2 skrll /* Give up */ 8854 1.1.2.2 skrll sctp_m_freem(chk->data); 8855 1.1.2.2 skrll chk->data = NULL; 8856 1.1.2.2 skrll goto strreq_jump_out; 8857 1.1.2.2 skrll } 8858 1.1.2.2 skrll chk->data->m_data += SCTP_MIN_OVERHEAD; 8859 1.1.2.2 skrll } 8860 1.1.2.2 skrll if (M_TRAILINGSPACE(chk->data) < (int)SCTP_SIZE32(chk->send_size)) { 8861 1.1.2.2 skrll /* can't do it, no room */ 8862 1.1.2.2 skrll /* Give up */ 8863 1.1.2.2 skrll sctp_m_freem(chk->data); 8864 1.1.2.2 skrll chk->data = NULL; 8865 1.1.2.2 skrll goto strreq_jump_out; 8866 1.1.2.2 skrll } 8867 1.1.2.2 skrll chk->sent = SCTP_DATAGRAM_UNSENT; 8868 1.1.2.2 skrll chk->snd_count = 0; 8869 1.1.2.2 skrll chk->whoTo = asoc->primary_destination; 8870 1.1.2.2 skrll chk->whoTo->ref_count++; 8871 1.1.2.2 skrll 8872 1.1.2.2 skrll strreq = mtod(chk->data, struct sctp_stream_reset_req *); 8873 1.1.2.2 skrll strreq->ch.chunk_type = SCTP_STREAM_RESET; 8874 1.1.2.2 skrll strreq->ch.chunk_flags = 0; 8875 1.1.2.2 skrll strreq->ch.chunk_length = htons(chk->send_size); 8876 1.1.2.2 skrll 8877 1.1.2.2 skrll strreq->sr_req.ph.param_type = ntohs(SCTP_STR_RESET_REQUEST); 8878 1.1.2.2 skrll strreq->sr_req.ph.param_length = htons((chk->send_size - sizeof(struct sctp_chunkhdr))); 8879 1.1.2.2 skrll 8880 1.1.2.2 skrll if (chk->send_size % 4) { 8881 1.1.2.2 skrll /* need a padding for the end */ 8882 1.1.2.2 skrll int pad, i; 8883 1.1.2.2 skrll uint8_t *end; 8884 1.1.2.2 skrll end = (uint8_t *)((vaddr_t)strreq + chk->send_size); 8885 1.1.2.2 skrll pad = chk->send_size % 4; 8886 1.1.2.2 skrll for (i=0; i<pad; i++) { 8887 1.1.2.2 skrll end[i] = 0; 8888 1.1.2.2 skrll } 8889 1.1.2.2 skrll chk->send_size += pad; 8890 1.1.2.2 skrll } 8891 1.1.2.2 skrll 8892 1.1.2.2 skrll strreq->sr_req.reset_flags = 0; 8893 1.1.2.2 skrll if (number_entrys == 0) { 8894 1.1.2.2 skrll strreq->sr_req.reset_flags |= SCTP_RESET_ALL; 8895 1.1.2.2 skrll } 8896 1.1.2.2 skrll if (two_way == 0) { 8897 1.1.2.2 skrll strreq->sr_req.reset_flags |= SCTP_RESET_YOUR; 8898 1.1.2.2 skrll } else { 8899 1.1.2.2 skrll if (not_peer == 0) { 8900 1.1.2.2 skrll strreq->sr_req.reset_flags |= SCTP_RECIPRICAL | SCTP_RESET_YOUR; 8901 1.1.2.2 skrll } else { 8902 1.1.2.2 skrll strreq->sr_req.reset_flags |= SCTP_RECIPRICAL; 8903 1.1.2.2 skrll } 8904 1.1.2.2 skrll } 8905 1.1.2.2 skrll memset(strreq->sr_req.reset_pad, 0, sizeof(strreq->sr_req.reset_pad)); 8906 1.1.2.2 skrll strreq->sr_req.reset_req_seq = htonl(asoc->str_reset_seq_out); 8907 1.1.2.2 skrll if (number_entrys) { 8908 1.1.2.2 skrll /* populate the specific entry's */ 8909 1.1.2.2 skrll int i; 8910 1.1.2.2 skrll for (i=0; i < number_entrys; i++) { 8911 1.1.2.2 skrll strreq->sr_req.list_of_streams[i] = htons(list[i]); 8912 1.1.2.2 skrll } 8913 1.1.2.2 skrll } 8914 1.1.2.2 skrll TAILQ_INSERT_TAIL(&asoc->control_send_queue, 8915 1.1.2.2 skrll chk, 8916 1.1.2.2 skrll sctp_next); 8917 1.1.2.2 skrll asoc->ctrl_queue_cnt++; 8918 1.1.2.2 skrll sctp_timer_start(SCTP_TIMER_TYPE_STRRESET, stcb->sctp_ep, stcb, chk->whoTo); 8919 1.1.2.2 skrll asoc->stream_reset_outstanding = 1; 8920 1.1.2.2 skrll } 8921 1.1.2.2 skrll 8922 1.1.2.2 skrll void 8923 1.1.2.2 skrll sctp_send_abort(struct mbuf *m, int iphlen, struct sctphdr *sh, uint32_t vtag, 8924 1.1.2.2 skrll struct mbuf *err_cause) 8925 1.1.2.2 skrll { 8926 1.1.2.2 skrll /* 8927 1.1.2.2 skrll * Formulate the abort message, and send it back down. 8928 1.1.2.2 skrll */ 8929 1.1.2.2 skrll struct mbuf *mout; 8930 1.1.2.2 skrll struct sctp_abort_msg *abm; 8931 1.1.2.2 skrll struct ip *iph, *iph_out; 8932 1.1.2.2 skrll struct ip6_hdr *ip6, *ip6_out; 8933 1.1.2.2 skrll int iphlen_out; 8934 1.1.2.2 skrll 8935 1.1.2.2 skrll /* don't respond to ABORT with ABORT */ 8936 1.1.2.2 skrll if (sctp_is_there_an_abort_here(m, iphlen, &vtag)) { 8937 1.1.2.2 skrll if (err_cause) 8938 1.1.2.2 skrll sctp_m_freem(err_cause); 8939 1.1.2.2 skrll return; 8940 1.1.2.2 skrll } 8941 1.1.2.2 skrll MGETHDR(mout, M_DONTWAIT, MT_HEADER); 8942 1.1.2.2 skrll if (mout == NULL) { 8943 1.1.2.2 skrll if (err_cause) 8944 1.1.2.2 skrll sctp_m_freem(err_cause); 8945 1.1.2.2 skrll return; 8946 1.1.2.2 skrll } 8947 1.1.2.2 skrll iph = mtod(m, struct ip *); 8948 1.1.2.2 skrll iph_out = NULL; 8949 1.1.2.2 skrll ip6_out = NULL; 8950 1.1.2.2 skrll if (iph->ip_v == IPVERSION) { 8951 1.1.2.2 skrll iph_out = mtod(mout, struct ip *); 8952 1.1.2.2 skrll mout->m_len = sizeof(*iph_out) + sizeof(*abm); 8953 1.1.2.2 skrll mout->m_next = err_cause; 8954 1.1.2.2 skrll 8955 1.1.2.2 skrll /* Fill in the IP header for the ABORT */ 8956 1.1.2.2 skrll iph_out->ip_v = IPVERSION; 8957 1.1.2.2 skrll iph_out->ip_hl = (sizeof(struct ip) / 4); 8958 1.1.2.2 skrll iph_out->ip_tos = (u_char)0; 8959 1.1.2.2 skrll iph_out->ip_id = 0; 8960 1.1.2.2 skrll iph_out->ip_off = 0; 8961 1.1.2.2 skrll iph_out->ip_ttl = MAXTTL; 8962 1.1.2.2 skrll iph_out->ip_p = IPPROTO_SCTP; 8963 1.1.2.2 skrll iph_out->ip_src.s_addr = iph->ip_dst.s_addr; 8964 1.1.2.2 skrll iph_out->ip_dst.s_addr = iph->ip_src.s_addr; 8965 1.1.2.2 skrll /* let IP layer calculate this */ 8966 1.1.2.2 skrll iph_out->ip_sum = 0; 8967 1.1.2.2 skrll 8968 1.1.2.2 skrll iphlen_out = sizeof(*iph_out); 8969 1.1.2.2 skrll abm = (struct sctp_abort_msg *)((vaddr_t)iph_out + iphlen_out); 8970 1.1.2.2 skrll } else if (iph->ip_v == (IPV6_VERSION >> 4)) { 8971 1.1.2.2 skrll ip6 = (struct ip6_hdr *)iph; 8972 1.1.2.2 skrll ip6_out = mtod(mout, struct ip6_hdr *); 8973 1.1.2.2 skrll mout->m_len = sizeof(*ip6_out) + sizeof(*abm); 8974 1.1.2.2 skrll mout->m_next = err_cause; 8975 1.1.2.2 skrll 8976 1.1.2.2 skrll /* Fill in the IP6 header for the ABORT */ 8977 1.1.2.2 skrll ip6_out->ip6_flow = ip6->ip6_flow; 8978 1.1.2.2 skrll ip6_out->ip6_hlim = ip6_defhlim; 8979 1.1.2.2 skrll ip6_out->ip6_nxt = IPPROTO_SCTP; 8980 1.1.2.2 skrll ip6_out->ip6_src = ip6->ip6_dst; 8981 1.1.2.2 skrll ip6_out->ip6_dst = ip6->ip6_src; 8982 1.1.2.2 skrll 8983 1.1.2.2 skrll iphlen_out = sizeof(*ip6_out); 8984 1.1.2.2 skrll abm = (struct sctp_abort_msg *)((vaddr_t)ip6_out + iphlen_out); 8985 1.1.2.2 skrll } else { 8986 1.1.2.2 skrll /* Currently not supported */ 8987 1.1.2.2 skrll return; 8988 1.1.2.2 skrll } 8989 1.1.2.2 skrll 8990 1.1.2.2 skrll abm->sh.src_port = sh->dest_port; 8991 1.1.2.2 skrll abm->sh.dest_port = sh->src_port; 8992 1.1.2.2 skrll abm->sh.checksum = 0; 8993 1.1.2.2 skrll if (vtag == 0) { 8994 1.1.2.2 skrll abm->sh.v_tag = sh->v_tag; 8995 1.1.2.2 skrll abm->msg.ch.chunk_flags = SCTP_HAD_NO_TCB; 8996 1.1.2.2 skrll } else { 8997 1.1.2.2 skrll abm->sh.v_tag = htonl(vtag); 8998 1.1.2.2 skrll abm->msg.ch.chunk_flags = 0; 8999 1.1.2.2 skrll } 9000 1.1.2.2 skrll abm->msg.ch.chunk_type = SCTP_ABORT_ASSOCIATION; 9001 1.1.2.2 skrll 9002 1.1.2.2 skrll if (err_cause) { 9003 1.1.2.2 skrll struct mbuf *m_tmp = err_cause; 9004 1.1.2.2 skrll int err_len = 0; 9005 1.1.2.2 skrll /* get length of the err_cause chain */ 9006 1.1.2.2 skrll while (m_tmp != NULL) { 9007 1.1.2.2 skrll err_len += m_tmp->m_len; 9008 1.1.2.2 skrll m_tmp = m_tmp->m_next; 9009 1.1.2.2 skrll } 9010 1.1.2.2 skrll mout->m_pkthdr.len = mout->m_len + err_len; 9011 1.1.2.2 skrll if (err_len % 4) { 9012 1.1.2.2 skrll /* need pad at end of chunk */ 9013 1.1.2.2 skrll u_int32_t cpthis=0; 9014 1.1.2.2 skrll int padlen; 9015 1.1.2.2 skrll padlen = 4 - (mout->m_pkthdr.len % 4); 9016 1.1.2.2 skrll m_copyback(mout, mout->m_pkthdr.len, padlen, (void *)&cpthis); 9017 1.1.2.2 skrll } 9018 1.1.2.2 skrll abm->msg.ch.chunk_length = htons(sizeof(abm->msg.ch) + err_len); 9019 1.1.2.2 skrll } else { 9020 1.1.2.2 skrll mout->m_pkthdr.len = mout->m_len; 9021 1.1.2.2 skrll abm->msg.ch.chunk_length = htons(sizeof(abm->msg.ch)); 9022 1.1.2.2 skrll } 9023 1.1.2.2 skrll 9024 1.1.2.2 skrll /* add checksum */ 9025 1.1.2.2 skrll if ((sctp_no_csum_on_loopback) && 9026 1.1.2.2 skrll (m->m_pkthdr.rcvif) && 9027 1.1.2.2 skrll (m->m_pkthdr.rcvif->if_type == IFT_LOOP)) { 9028 1.1.2.2 skrll abm->sh.checksum = 0; 9029 1.1.2.2 skrll } else { 9030 1.1.2.2 skrll abm->sh.checksum = sctp_calculate_sum(mout, NULL, iphlen_out); 9031 1.1.2.2 skrll } 9032 1.1.2.2 skrll 9033 1.1.2.2 skrll /* zap the rcvif, it should be null */ 9034 1.1.2.2 skrll mout->m_pkthdr.rcvif = 0; 9035 1.1.2.2 skrll if (iph_out != NULL) { 9036 1.1.2.2 skrll struct route ro; 9037 1.1.2.2 skrll 9038 1.1.2.2 skrll /* zap the stack pointer to the route */ 9039 1.1.2.2 skrll memset(&ro, 0, sizeof ro); 9040 1.1.2.2 skrll #ifdef SCTP_DEBUG 9041 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT2) { 9042 1.1.2.2 skrll printf("sctp_send_abort calling ip_output:\n"); 9043 1.1.2.2 skrll sctp_print_address_pkt(iph_out, &abm->sh); 9044 1.1.2.2 skrll } 9045 1.1.2.2 skrll #endif 9046 1.1.2.2 skrll /* set IPv4 length */ 9047 1.1.2.2 skrll iph_out->ip_len = htons(mout->m_pkthdr.len); 9048 1.1.2.2 skrll /* out it goes */ 9049 1.1.2.2 skrll (void)ip_output(mout, 0, &ro, IP_RAWOUTPUT, NULL, NULL); 9050 1.1.2.2 skrll } else if (ip6_out != NULL) { 9051 1.1.2.2 skrll struct route ro; 9052 1.1.2.2 skrll 9053 1.1.2.2 skrll /* zap the stack pointer to the route */ 9054 1.1.2.2 skrll memset(&ro, 0, sizeof(ro)); 9055 1.1.2.2 skrll #ifdef SCTP_DEBUG 9056 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT2) { 9057 1.1.2.2 skrll printf("sctp_send_abort calling ip6_output:\n"); 9058 1.1.2.2 skrll sctp_print_address_pkt((struct ip *)ip6_out, &abm->sh); 9059 1.1.2.2 skrll } 9060 1.1.2.2 skrll #endif 9061 1.1.2.2 skrll ip6_output(mout, NULL, &ro, 0, NULL, NULL, NULL); 9062 1.1.2.2 skrll } 9063 1.1.2.2 skrll sctp_pegs[SCTP_DATAGRAMS_SENT]++; 9064 1.1.2.2 skrll } 9065 1.1.2.2 skrll 9066 1.1.2.2 skrll void 9067 1.1.2.2 skrll sctp_send_operr_to(struct mbuf *m, int iphlen, 9068 1.1.2.2 skrll struct mbuf *scm, 9069 1.1.2.2 skrll uint32_t vtag) 9070 1.1.2.2 skrll { 9071 1.1.2.2 skrll struct sctphdr *ihdr; 9072 1.1.2.2 skrll struct sctphdr *ohdr; 9073 1.1.2.2 skrll struct sctp_chunkhdr *ophdr; 9074 1.1.2.2 skrll 9075 1.1.2.2 skrll struct ip *iph; 9076 1.1.2.2 skrll #ifdef SCTP_DEBUG 9077 1.1.2.2 skrll struct sockaddr_in6 lsa6, fsa6; 9078 1.1.2.2 skrll #endif 9079 1.1.2.2 skrll uint32_t val; 9080 1.1.2.2 skrll iph = mtod(m, struct ip *); 9081 1.1.2.2 skrll ihdr = (struct sctphdr *)((vaddr_t)iph + iphlen); 9082 1.1.2.2 skrll if (!(scm->m_flags & M_PKTHDR)) { 9083 1.1.2.2 skrll /* must be a pkthdr */ 9084 1.1.2.2 skrll printf("Huh, not a packet header in send_operr\n"); 9085 1.1.2.2 skrll m_freem(scm); 9086 1.1.2.2 skrll return; 9087 1.1.2.2 skrll } 9088 1.1.2.2 skrll M_PREPEND(scm, (sizeof(struct sctphdr) + sizeof(struct sctp_chunkhdr)), M_DONTWAIT); 9089 1.1.2.2 skrll if (scm == NULL) { 9090 1.1.2.2 skrll /* can't send because we can't add a mbuf */ 9091 1.1.2.2 skrll return; 9092 1.1.2.2 skrll } 9093 1.1.2.2 skrll ohdr = mtod(scm, struct sctphdr *); 9094 1.1.2.2 skrll ohdr->src_port = ihdr->dest_port; 9095 1.1.2.2 skrll ohdr->dest_port = ihdr->src_port; 9096 1.1.2.2 skrll ohdr->v_tag = vtag; 9097 1.1.2.2 skrll ohdr->checksum = 0; 9098 1.1.2.2 skrll ophdr = (struct sctp_chunkhdr *)(ohdr + 1); 9099 1.1.2.2 skrll ophdr->chunk_type = SCTP_OPERATION_ERROR; 9100 1.1.2.2 skrll ophdr->chunk_flags = 0; 9101 1.1.2.2 skrll ophdr->chunk_length = htons(scm->m_pkthdr.len - sizeof(struct sctphdr)); 9102 1.1.2.2 skrll if (scm->m_pkthdr.len % 4) { 9103 1.1.2.2 skrll /* need padding */ 9104 1.1.2.2 skrll u_int32_t cpthis=0; 9105 1.1.2.2 skrll int padlen; 9106 1.1.2.2 skrll padlen = 4 - (scm->m_pkthdr.len % 4); 9107 1.1.2.2 skrll m_copyback(scm, scm->m_pkthdr.len, padlen, (void *)&cpthis); 9108 1.1.2.2 skrll } 9109 1.1.2.2 skrll if ((sctp_no_csum_on_loopback) && 9110 1.1.2.2 skrll (m->m_pkthdr.rcvif) && 9111 1.1.2.2 skrll (m->m_pkthdr.rcvif->if_type == IFT_LOOP)) { 9112 1.1.2.2 skrll val = 0; 9113 1.1.2.2 skrll } else { 9114 1.1.2.2 skrll val = sctp_calculate_sum(scm, NULL, 0); 9115 1.1.2.2 skrll } 9116 1.1.2.2 skrll ohdr->checksum = val; 9117 1.1.2.2 skrll if (iph->ip_v == IPVERSION) { 9118 1.1.2.2 skrll /* V4 */ 9119 1.1.2.2 skrll struct ip *out; 9120 1.1.2.2 skrll struct route ro; 9121 1.1.2.2 skrll M_PREPEND(scm, sizeof(struct ip), M_DONTWAIT); 9122 1.1.2.2 skrll if (scm == NULL) 9123 1.1.2.2 skrll return; 9124 1.1.2.2 skrll memset(&ro, 0, sizeof ro); 9125 1.1.2.2 skrll out = mtod(scm, struct ip *); 9126 1.1.2.2 skrll out->ip_v = iph->ip_v; 9127 1.1.2.2 skrll out->ip_hl = (sizeof(struct ip)/4); 9128 1.1.2.2 skrll out->ip_tos = iph->ip_tos; 9129 1.1.2.2 skrll out->ip_id = iph->ip_id; 9130 1.1.2.2 skrll out->ip_off = 0; 9131 1.1.2.2 skrll out->ip_ttl = MAXTTL; 9132 1.1.2.2 skrll out->ip_p = IPPROTO_SCTP; 9133 1.1.2.2 skrll out->ip_sum = 0; 9134 1.1.2.2 skrll out->ip_src = iph->ip_dst; 9135 1.1.2.2 skrll out->ip_dst = iph->ip_src; 9136 1.1.2.2 skrll out->ip_len = htons(scm->m_pkthdr.len); 9137 1.1.2.2 skrll ip_output(scm, 0, &ro, IP_RAWOUTPUT, NULL, NULL); 9138 1.1.2.2 skrll sctp_pegs[SCTP_DATAGRAMS_SENT]++; 9139 1.1.2.2 skrll } else { 9140 1.1.2.2 skrll /* V6 */ 9141 1.1.2.2 skrll struct route ro; 9142 1.1.2.2 skrll struct ip6_hdr *out6, *in6; 9143 1.1.2.2 skrll 9144 1.1.2.2 skrll M_PREPEND(scm, sizeof(struct ip6_hdr), M_DONTWAIT); 9145 1.1.2.2 skrll if (scm == NULL) 9146 1.1.2.2 skrll return; 9147 1.1.2.2 skrll memset(&ro, 0, sizeof ro); 9148 1.1.2.2 skrll in6 = mtod(m, struct ip6_hdr *); 9149 1.1.2.2 skrll out6 = mtod(scm, struct ip6_hdr *); 9150 1.1.2.2 skrll out6->ip6_flow = in6->ip6_flow; 9151 1.1.2.2 skrll out6->ip6_hlim = ip6_defhlim; 9152 1.1.2.2 skrll out6->ip6_nxt = IPPROTO_SCTP; 9153 1.1.2.2 skrll out6->ip6_src = in6->ip6_dst; 9154 1.1.2.2 skrll out6->ip6_dst = in6->ip6_src; 9155 1.1.2.2 skrll 9156 1.1.2.2 skrll #ifdef SCTP_DEBUG 9157 1.1.2.2 skrll memset(&lsa6, 0, sizeof(lsa6)); 9158 1.1.2.2 skrll lsa6.sin6_len = sizeof(lsa6); 9159 1.1.2.2 skrll lsa6.sin6_family = AF_INET6; 9160 1.1.2.2 skrll lsa6.sin6_addr = out6->ip6_src; 9161 1.1.2.2 skrll memset(&fsa6, 0, sizeof(fsa6)); 9162 1.1.2.2 skrll fsa6.sin6_len = sizeof(fsa6); 9163 1.1.2.2 skrll fsa6.sin6_family = AF_INET6; 9164 1.1.2.2 skrll fsa6.sin6_addr = out6->ip6_dst; 9165 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT2) { 9166 1.1.2.2 skrll printf("sctp_operr_to calling ipv6 output:\n"); 9167 1.1.2.2 skrll printf("src: "); 9168 1.1.2.2 skrll sctp_print_address((struct sockaddr *)&lsa6); 9169 1.1.2.2 skrll printf("dst "); 9170 1.1.2.2 skrll sctp_print_address((struct sockaddr *)&fsa6); 9171 1.1.2.2 skrll } 9172 1.1.2.2 skrll #endif /* SCTP_DEBUG */ 9173 1.1.2.2 skrll ip6_output(scm, NULL, &ro, 0, NULL, NULL, NULL); 9174 1.1.2.2 skrll sctp_pegs[SCTP_DATAGRAMS_SENT]++; 9175 1.1.2.2 skrll } 9176 1.1.2.2 skrll } 9177 1.1.2.2 skrll 9178 1.1.2.2 skrll static int 9179 1.1.2.2 skrll sctp_copy_one(struct mbuf *m, struct uio *uio, int cpsz, int resv_upfront, int *mbcnt) 9180 1.1.2.2 skrll { 9181 1.1.2.2 skrll int left, cancpy, willcpy, error; 9182 1.1.2.2 skrll left = cpsz; 9183 1.1.2.2 skrll 9184 1.1.2.2 skrll if (m == NULL) { 9185 1.1.2.2 skrll /* TSNH */ 9186 1.1.2.2 skrll *mbcnt = 0; 9187 1.1.2.2 skrll return (ENOMEM); 9188 1.1.2.2 skrll } 9189 1.1.2.2 skrll m->m_len = 0; 9190 1.1.2.2 skrll if ((left+resv_upfront) > (int)MHLEN) { 9191 1.1.2.2 skrll MCLGET(m, M_WAIT); 9192 1.1.2.2 skrll if (m == NULL) { 9193 1.1.2.2 skrll *mbcnt = 0; 9194 1.1.2.2 skrll return (ENOMEM); 9195 1.1.2.2 skrll } 9196 1.1.2.2 skrll if ((m->m_flags & M_EXT) == 0) { 9197 1.1.2.2 skrll *mbcnt = 0; 9198 1.1.2.2 skrll return (ENOMEM); 9199 1.1.2.2 skrll } 9200 1.1.2.2 skrll *mbcnt += m->m_ext.ext_size; 9201 1.1.2.2 skrll } 9202 1.1.2.2 skrll *mbcnt += MSIZE; 9203 1.1.2.2 skrll cancpy = M_TRAILINGSPACE(m); 9204 1.1.2.2 skrll willcpy = min(cancpy, left); 9205 1.1.2.2 skrll if ((willcpy + resv_upfront) > cancpy) { 9206 1.1.2.2 skrll willcpy -= resv_upfront; 9207 1.1.2.2 skrll } 9208 1.1.2.2 skrll while (left > 0) { 9209 1.1.2.2 skrll /* Align data to the end */ 9210 1.1.2.2 skrll if ((m->m_flags & M_EXT) == 0) { 9211 1.1.2.2 skrll if (m->m_flags & M_PKTHDR) { 9212 1.1.2.2 skrll MH_ALIGN(m, willcpy); 9213 1.1.2.2 skrll } else { 9214 1.1.2.2 skrll M_ALIGN(m, willcpy); 9215 1.1.2.2 skrll } 9216 1.1.2.2 skrll } else { 9217 1.1.2.2 skrll MC_ALIGN(m, willcpy); 9218 1.1.2.2 skrll } 9219 1.1.2.2 skrll error = uiomove(mtod(m, void *), willcpy, uio); 9220 1.1.2.2 skrll if (error) { 9221 1.1.2.2 skrll return (error); 9222 1.1.2.2 skrll } 9223 1.1.2.2 skrll m->m_len = willcpy; 9224 1.1.2.2 skrll m->m_nextpkt = 0; 9225 1.1.2.2 skrll left -= willcpy; 9226 1.1.2.2 skrll if (left > 0) { 9227 1.1.2.2 skrll MGET(m->m_next, M_WAIT, MT_DATA); 9228 1.1.2.2 skrll if (m->m_next == NULL) { 9229 1.1.2.2 skrll *mbcnt = 0; 9230 1.1.2.2 skrll return (ENOMEM); 9231 1.1.2.2 skrll } 9232 1.1.2.2 skrll m = m->m_next; 9233 1.1.2.2 skrll m->m_len = 0; 9234 1.1.2.2 skrll *mbcnt += MSIZE; 9235 1.1.2.2 skrll if (left > (int)MHLEN) { 9236 1.1.2.2 skrll MCLGET(m, M_WAIT); 9237 1.1.2.2 skrll if (m == NULL) { 9238 1.1.2.2 skrll *mbcnt = 0; 9239 1.1.2.2 skrll return (ENOMEM); 9240 1.1.2.2 skrll } 9241 1.1.2.2 skrll if ((m->m_flags & M_EXT) == 0) { 9242 1.1.2.2 skrll *mbcnt = 0; 9243 1.1.2.2 skrll return (ENOMEM); 9244 1.1.2.2 skrll } 9245 1.1.2.2 skrll *mbcnt += m->m_ext.ext_size; 9246 1.1.2.2 skrll } 9247 1.1.2.2 skrll cancpy = M_TRAILINGSPACE(m); 9248 1.1.2.2 skrll willcpy = min(cancpy, left); 9249 1.1.2.2 skrll } 9250 1.1.2.2 skrll } 9251 1.1.2.2 skrll return (0); 9252 1.1.2.2 skrll } 9253 1.1.2.2 skrll 9254 1.1.2.2 skrll static int 9255 1.1.2.2 skrll sctp_copy_it_in(struct sctp_inpcb *inp, 9256 1.1.2.2 skrll struct sctp_tcb *stcb, 9257 1.1.2.2 skrll struct sctp_association *asoc, 9258 1.1.2.2 skrll struct sctp_nets *net, 9259 1.1.2.2 skrll struct sctp_sndrcvinfo *srcv, 9260 1.1.2.2 skrll struct uio *uio, 9261 1.1.2.2 skrll int flags) 9262 1.1.2.2 skrll { 9263 1.1.2.2 skrll /* This routine must be very careful in 9264 1.1.2.2 skrll * its work. Protocol processing is 9265 1.1.2.2 skrll * up and running so care must be taken to 9266 1.1.2.2 skrll * spl...() when you need to do something 9267 1.1.2.2 skrll * that may effect the stcb/asoc. The sb is 9268 1.1.2.2 skrll * locked however. When data is copied the 9269 1.1.2.2 skrll * protocol processing should be enabled since 9270 1.1.2.2 skrll * this is a slower operation... 9271 1.1.2.2 skrll */ 9272 1.1.2.2 skrll struct socket *so; 9273 1.1.2.2 skrll int error = 0; 9274 1.1.2.2 skrll int frag_size, mbcnt = 0, mbcnt_e = 0; 9275 1.1.2.2 skrll unsigned int sndlen; 9276 1.1.2.2 skrll unsigned int tot_demand; 9277 1.1.2.2 skrll int tot_out, dataout; 9278 1.1.2.2 skrll struct sctp_tmit_chunk *chk; 9279 1.1.2.2 skrll struct mbuf *mm; 9280 1.1.2.2 skrll struct sctp_stream_out *strq; 9281 1.1.2.2 skrll uint32_t my_vtag; 9282 1.1.2.2 skrll int resv_in_first; 9283 1.1.2.2 skrll 9284 1.1.2.2 skrll so = stcb->sctp_socket; 9285 1.1.2.2 skrll solock(so); 9286 1.1.2.2 skrll chk = NULL; 9287 1.1.2.2 skrll mm = NULL; 9288 1.1.2.2 skrll 9289 1.1.2.2 skrll sndlen = uio->uio_resid; 9290 1.1.2.2 skrll /* lock the socket buf */ 9291 1.1.2.2 skrll error = sblock(&so->so_snd, SBLOCKWAIT(flags)); 9292 1.1.2.2 skrll if (error) 9293 1.1.2.2 skrll goto out_locked; 9294 1.1.2.2 skrll 9295 1.1.2.2 skrll #ifdef SCTP_DEBUG 9296 1.1.2.2 skrll printf("sctp_copy_it_in: %d\n", sndlen); 9297 1.1.2.2 skrll #endif 9298 1.1.2.2 skrll /* will it ever fit ? */ 9299 1.1.2.2 skrll if (sndlen > so->so_snd.sb_hiwat) { 9300 1.1.2.2 skrll /* It will NEVER fit */ 9301 1.1.2.2 skrll error = EMSGSIZE; 9302 1.1.2.2 skrll goto release; 9303 1.1.2.2 skrll } 9304 1.1.2.2 skrll /* Do I need to block? */ 9305 1.1.2.2 skrll if ((so->so_snd.sb_hiwat < 9306 1.1.2.2 skrll (sndlen + asoc->total_output_queue_size)) || 9307 1.1.2.2 skrll (asoc->chunks_on_out_queue > sctp_max_chunks_on_queue) || 9308 1.1.2.2 skrll (asoc->total_output_mbuf_queue_size > 9309 1.1.2.2 skrll so->so_snd.sb_mbmax) 9310 1.1.2.2 skrll ) { 9311 1.1.2.2 skrll /* prune any prsctp bufs out */ 9312 1.1.2.2 skrll if (asoc->peer_supports_prsctp) { 9313 1.1.2.2 skrll sctp_prune_prsctp(stcb, asoc, srcv, sndlen); 9314 1.1.2.2 skrll } 9315 1.1.2.2 skrll /* 9316 1.1.2.2 skrll * We store off a pointer to the endpoint. 9317 1.1.2.2 skrll * Since on return from this we must check to 9318 1.1.2.2 skrll * see if an so_error is set. If so we may have 9319 1.1.2.2 skrll * been reset and our stcb destroyed. Returning 9320 1.1.2.2 skrll * an error will flow back to the user... 9321 1.1.2.2 skrll */ 9322 1.1.2.2 skrll while ((so->so_snd.sb_hiwat < 9323 1.1.2.2 skrll (sndlen + asoc->total_output_queue_size)) || 9324 1.1.2.2 skrll (asoc->chunks_on_out_queue > 9325 1.1.2.2 skrll sctp_max_chunks_on_queue) || 9326 1.1.2.2 skrll (asoc->total_output_mbuf_queue_size > 9327 1.1.2.2 skrll so->so_snd.sb_mbmax) 9328 1.1.2.2 skrll ) { 9329 1.1.2.2 skrll if ((so->so_state & SS_NBIO) 9330 1.1.2.2 skrll #if defined(__FreeBSD__) && __FreeBSD_version >= 500000 9331 1.1.2.2 skrll || (flags & MSG_NBIO) 9332 1.1.2.2 skrll #endif 9333 1.1.2.2 skrll ) { 9334 1.1.2.2 skrll /* Non-blocking io in place */ 9335 1.1.2.2 skrll error = EWOULDBLOCK; 9336 1.1.2.2 skrll goto release; 9337 1.1.2.2 skrll } 9338 1.1.2.2 skrll inp->sctp_tcb_at_block = (void *)stcb; 9339 1.1.2.2 skrll inp->error_on_block = 0; 9340 1.1.2.2 skrll #ifdef SCTP_BLK_LOGGING 9341 1.1.2.2 skrll sctp_log_block(SCTP_BLOCK_LOG_INTO_BLK, 9342 1.1.2.2 skrll so, asoc); 9343 1.1.2.2 skrll #endif 9344 1.1.2.2 skrll sbunlock(&so->so_snd); 9345 1.1.2.2 skrll SCTP_TCB_UNLOCK(stcb); 9346 1.1.2.2 skrll error = sbwait(&so->so_snd); 9347 1.1.2.2 skrll SCTP_INP_RLOCK(inp); 9348 1.1.2.2 skrll if ((inp->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE) || 9349 1.1.2.2 skrll (inp->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE)) { 9350 1.1.2.2 skrll /* Should I really unlock ? */ 9351 1.1.2.2 skrll SCTP_INP_RUNLOCK(inp); 9352 1.1.2.2 skrll error = EFAULT; 9353 1.1.2.2 skrll goto out_locked; 9354 1.1.2.2 skrll } 9355 1.1.2.2 skrll SCTP_TCB_LOCK(stcb); 9356 1.1.2.2 skrll SCTP_INP_RUNLOCK(inp); 9357 1.1.2.2 skrll 9358 1.1.2.2 skrll inp->sctp_tcb_at_block = 0; 9359 1.1.2.2 skrll #ifdef SCTP_BLK_LOGGING 9360 1.1.2.2 skrll sctp_log_block(SCTP_BLOCK_LOG_OUTOF_BLK, 9361 1.1.2.2 skrll so, asoc); 9362 1.1.2.2 skrll #endif 9363 1.1.2.2 skrll if (inp->error_on_block) { 9364 1.1.2.2 skrll /* 9365 1.1.2.2 skrll * if our asoc was killed, the free code 9366 1.1.2.2 skrll * (in sctp_pcb.c) will save a error in 9367 1.1.2.2 skrll * here for us 9368 1.1.2.2 skrll */ 9369 1.1.2.2 skrll error = inp->error_on_block; 9370 1.1.2.2 skrll goto out_locked; 9371 1.1.2.2 skrll } 9372 1.1.2.2 skrll if (error) { 9373 1.1.2.2 skrll goto out_locked; 9374 1.1.2.2 skrll } 9375 1.1.2.2 skrll /* did we encounter a socket error? */ 9376 1.1.2.2 skrll if (so->so_error) { 9377 1.1.2.2 skrll error = so->so_error; 9378 1.1.2.2 skrll goto out_locked; 9379 1.1.2.2 skrll } 9380 1.1.2.2 skrll error = sblock(&so->so_snd, M_WAITOK); 9381 1.1.2.2 skrll if (error) { 9382 1.1.2.2 skrll /* Can't aquire the lock */ 9383 1.1.2.2 skrll goto out_locked; 9384 1.1.2.2 skrll } 9385 1.1.2.2 skrll #if defined(__FreeBSD__) && __FreeBSD_version >= 502115 9386 1.1.2.2 skrll if (so->so_rcv.sb_state & SBS_CANTSENDMORE) { 9387 1.1.2.2 skrll #else 9388 1.1.2.2 skrll if (so->so_state & SS_CANTSENDMORE) { 9389 1.1.2.2 skrll #endif 9390 1.1.2.2 skrll /* The socket is now set not to sendmore.. its gone */ 9391 1.1.2.2 skrll error = EPIPE; 9392 1.1.2.2 skrll goto release; 9393 1.1.2.2 skrll } 9394 1.1.2.2 skrll if (so->so_error) { 9395 1.1.2.2 skrll error = so->so_error; 9396 1.1.2.2 skrll goto release; 9397 1.1.2.2 skrll } 9398 1.1.2.2 skrll if (asoc->peer_supports_prsctp) { 9399 1.1.2.2 skrll sctp_prune_prsctp(stcb, asoc, srcv, sndlen); 9400 1.1.2.2 skrll } 9401 1.1.2.2 skrll } 9402 1.1.2.2 skrll } 9403 1.1.2.2 skrll dataout = tot_out = uio->uio_resid; 9404 1.1.2.2 skrll if (inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) { 9405 1.1.2.2 skrll resv_in_first = SCTP_MED_OVERHEAD; 9406 1.1.2.2 skrll } else { 9407 1.1.2.2 skrll resv_in_first = SCTP_MED_V4_OVERHEAD; 9408 1.1.2.2 skrll } 9409 1.1.2.2 skrll 9410 1.1.2.2 skrll /* Are we aborting? */ 9411 1.1.2.2 skrll if (srcv->sinfo_flags & MSG_ABORT) { 9412 1.1.2.2 skrll if ((SCTP_GET_STATE(asoc) != SCTP_STATE_COOKIE_WAIT) && 9413 1.1.2.2 skrll (SCTP_GET_STATE(asoc) != SCTP_STATE_COOKIE_ECHOED)) { 9414 1.1.2.2 skrll /* It has to be up before we abort */ 9415 1.1.2.2 skrll /* how big is the user initiated abort? */ 9416 1.1.2.2 skrll 9417 1.1.2.2 skrll /* I wonder about doing a MGET without a splnet set. 9418 1.1.2.2 skrll * it is done that way in the sosend code so I guess 9419 1.1.2.2 skrll * it is ok :-0 9420 1.1.2.2 skrll */ 9421 1.1.2.2 skrll MGETHDR(mm, M_WAIT, MT_DATA); 9422 1.1.2.2 skrll if (mm) { 9423 1.1.2.2 skrll struct sctp_paramhdr *ph; 9424 1.1.2.2 skrll 9425 1.1.2.2 skrll tot_demand = (tot_out + sizeof(struct sctp_paramhdr)); 9426 1.1.2.2 skrll if (tot_demand > MHLEN) { 9427 1.1.2.2 skrll if (tot_demand > MCLBYTES) { 9428 1.1.2.2 skrll /* truncate user data */ 9429 1.1.2.2 skrll tot_demand = MCLBYTES; 9430 1.1.2.2 skrll tot_out = tot_demand - sizeof(struct sctp_paramhdr); 9431 1.1.2.2 skrll } 9432 1.1.2.2 skrll MCLGET(mm, M_WAIT); 9433 1.1.2.2 skrll if ((mm->m_flags & M_EXT) == 0) { 9434 1.1.2.2 skrll /* truncate further */ 9435 1.1.2.2 skrll tot_demand = MHLEN; 9436 1.1.2.2 skrll tot_out = tot_demand - sizeof(struct sctp_paramhdr); 9437 1.1.2.2 skrll } 9438 1.1.2.2 skrll } 9439 1.1.2.2 skrll /* now move forward the data pointer */ 9440 1.1.2.2 skrll ph = mtod(mm, struct sctp_paramhdr *); 9441 1.1.2.2 skrll ph->param_type = htons(SCTP_CAUSE_USER_INITIATED_ABT); 9442 1.1.2.2 skrll ph->param_length = htons((sizeof(struct sctp_paramhdr) + tot_out)); 9443 1.1.2.2 skrll ph++; 9444 1.1.2.2 skrll mm->m_pkthdr.len = tot_out + sizeof(struct sctp_paramhdr); 9445 1.1.2.2 skrll mm->m_len = mm->m_pkthdr.len; 9446 1.1.2.2 skrll error = uiomove((void *)ph, (int)tot_out, uio); 9447 1.1.2.2 skrll if (error) { 9448 1.1.2.2 skrll /* 9449 1.1.2.2 skrll * Here if we can't get his data we 9450 1.1.2.2 skrll * still abort we just don't get to 9451 1.1.2.2 skrll * send the users note :-0 9452 1.1.2.2 skrll */ 9453 1.1.2.2 skrll sctp_m_freem(mm); 9454 1.1.2.2 skrll mm = NULL; 9455 1.1.2.2 skrll } 9456 1.1.2.2 skrll } 9457 1.1.2.2 skrll sbunlock(&so->so_snd); 9458 1.1.2.2 skrll sctp_abort_an_association(stcb->sctp_ep, stcb, 9459 1.1.2.2 skrll SCTP_RESPONSE_TO_USER_REQ, 9460 1.1.2.2 skrll mm); 9461 1.1.2.2 skrll mm = NULL; 9462 1.1.2.2 skrll goto out_locked; 9463 1.1.2.2 skrll } 9464 1.1.2.2 skrll goto release; 9465 1.1.2.2 skrll } 9466 1.1.2.2 skrll 9467 1.1.2.2 skrll /* Now can we send this? */ 9468 1.1.2.2 skrll if ((SCTP_GET_STATE(asoc) == SCTP_STATE_SHUTDOWN_SENT) || 9469 1.1.2.2 skrll (SCTP_GET_STATE(asoc) == SCTP_STATE_SHUTDOWN_ACK_SENT) || 9470 1.1.2.2 skrll (SCTP_GET_STATE(asoc) == SCTP_STATE_SHUTDOWN_RECEIVED) || 9471 1.1.2.2 skrll (asoc->state & SCTP_STATE_SHUTDOWN_PENDING)) { 9472 1.1.2.2 skrll /* got data while shutting down */ 9473 1.1.2.2 skrll error = ECONNRESET; 9474 1.1.2.2 skrll goto release; 9475 1.1.2.2 skrll } 9476 1.1.2.2 skrll /* Is the stream no. valid? */ 9477 1.1.2.2 skrll if (srcv->sinfo_stream >= asoc->streamoutcnt) { 9478 1.1.2.2 skrll /* Invalid stream number */ 9479 1.1.2.2 skrll error = EINVAL; 9480 1.1.2.2 skrll goto release; 9481 1.1.2.2 skrll } 9482 1.1.2.2 skrll if (asoc->strmout == NULL) { 9483 1.1.2.2 skrll /* huh? software error */ 9484 1.1.2.2 skrll #ifdef SCTP_DEBUG 9485 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 9486 1.1.2.2 skrll printf("software error in sctp_copy_it_in\n"); 9487 1.1.2.2 skrll } 9488 1.1.2.2 skrll #endif 9489 1.1.2.2 skrll error = EFAULT; 9490 1.1.2.2 skrll goto release; 9491 1.1.2.2 skrll } 9492 1.1.2.2 skrll if ((srcv->sinfo_flags & MSG_EOF) && 9493 1.1.2.2 skrll (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_UDPTYPE) && 9494 1.1.2.2 skrll (tot_out == 0)) { 9495 1.1.2.2 skrll sounlock(so); 9496 1.1.2.2 skrll goto zap_by_it_now; 9497 1.1.2.2 skrll } 9498 1.1.2.2 skrll if (tot_out == 0) { 9499 1.1.2.2 skrll /* not allowed */ 9500 1.1.2.2 skrll error = EMSGSIZE; 9501 1.1.2.2 skrll goto release; 9502 1.1.2.2 skrll } 9503 1.1.2.2 skrll /* save off the tag */ 9504 1.1.2.2 skrll my_vtag = asoc->my_vtag; 9505 1.1.2.2 skrll strq = &asoc->strmout[srcv->sinfo_stream]; 9506 1.1.2.2 skrll /* First lets figure out the "chunking" point */ 9507 1.1.2.2 skrll frag_size = sctp_get_frag_point(stcb, asoc); 9508 1.1.2.2 skrll 9509 1.1.2.2 skrll /* two choices here, it all fits in one chunk or 9510 1.1.2.2 skrll * we need multiple chunks. 9511 1.1.2.2 skrll */ 9512 1.1.2.2 skrll sounlock(so); 9513 1.1.2.2 skrll if (tot_out <= frag_size) { 9514 1.1.2.2 skrll /* no need to setup a template */ 9515 1.1.2.2 skrll chk = (struct sctp_tmit_chunk *)SCTP_ZONE_GET(sctppcbinfo.ipi_zone_chunk); 9516 1.1.2.2 skrll if (chk == NULL) { 9517 1.1.2.2 skrll error = ENOMEM; 9518 1.1.2.2 skrll goto release; 9519 1.1.2.2 skrll } 9520 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk++; 9521 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 9522 1.1.2.2 skrll asoc->chunks_on_out_queue++; 9523 1.1.2.2 skrll MGETHDR(mm, M_WAIT, MT_DATA); 9524 1.1.2.2 skrll if (mm == NULL) { 9525 1.1.2.2 skrll error = ENOMEM; 9526 1.1.2.2 skrll goto clean_up; 9527 1.1.2.2 skrll } 9528 1.1.2.2 skrll error = sctp_copy_one(mm, uio, tot_out, resv_in_first, &mbcnt_e); 9529 1.1.2.2 skrll if (error) 9530 1.1.2.2 skrll goto clean_up; 9531 1.1.2.2 skrll sctp_prepare_chunk(chk, stcb, srcv, strq, net); 9532 1.1.2.2 skrll chk->mbcnt = mbcnt_e; 9533 1.1.2.2 skrll mbcnt += mbcnt_e; 9534 1.1.2.2 skrll mbcnt_e = 0; 9535 1.1.2.2 skrll mm->m_pkthdr.len = tot_out; 9536 1.1.2.2 skrll chk->data = mm; 9537 1.1.2.2 skrll mm = NULL; 9538 1.1.2.2 skrll 9539 1.1.2.2 skrll /* the actual chunk flags */ 9540 1.1.2.2 skrll chk->rec.data.rcv_flags |= SCTP_DATA_NOT_FRAG; 9541 1.1.2.2 skrll chk->whoTo->ref_count++; 9542 1.1.2.2 skrll 9543 1.1.2.2 skrll /* fix up the send_size if it is not present */ 9544 1.1.2.2 skrll chk->send_size = tot_out; 9545 1.1.2.2 skrll chk->book_size = chk->send_size; 9546 1.1.2.2 skrll /* ok, we are commited */ 9547 1.1.2.2 skrll if ((srcv->sinfo_flags & MSG_UNORDERED) == 0) { 9548 1.1.2.2 skrll /* bump the ssn if we are unordered. */ 9549 1.1.2.2 skrll strq->next_sequence_sent++; 9550 1.1.2.2 skrll } 9551 1.1.2.2 skrll if (chk->flags & SCTP_PR_SCTP_BUFFER) { 9552 1.1.2.2 skrll asoc->sent_queue_cnt_removeable++; 9553 1.1.2.2 skrll } 9554 1.1.2.2 skrll solock(so); 9555 1.1.2.2 skrll if ((asoc->state == 0) || 9556 1.1.2.2 skrll (my_vtag != asoc->my_vtag) || 9557 1.1.2.2 skrll (so != inp->sctp_socket) || 9558 1.1.2.2 skrll (inp->sctp_socket == 0)) { 9559 1.1.2.2 skrll /* connection was aborted */ 9560 1.1.2.2 skrll sounlock(so); 9561 1.1.2.2 skrll error = ECONNRESET; 9562 1.1.2.2 skrll goto clean_up; 9563 1.1.2.2 skrll } 9564 1.1.2.2 skrll asoc->stream_queue_cnt++; 9565 1.1.2.2 skrll TAILQ_INSERT_TAIL(&strq->outqueue, chk, sctp_next); 9566 1.1.2.2 skrll /* now check if this stream is on the wheel */ 9567 1.1.2.2 skrll if ((strq->next_spoke.tqe_next == NULL) && 9568 1.1.2.2 skrll (strq->next_spoke.tqe_prev == NULL)) { 9569 1.1.2.2 skrll /* Insert it on the wheel since it is not 9570 1.1.2.2 skrll * on it currently 9571 1.1.2.2 skrll */ 9572 1.1.2.2 skrll sctp_insert_on_wheel(asoc, strq); 9573 1.1.2.2 skrll } 9574 1.1.2.2 skrll sounlock(so); 9575 1.1.2.2 skrll clean_up: 9576 1.1.2.2 skrll if (error) { 9577 1.1.2.2 skrll SCTP_ZONE_FREE(sctppcbinfo.ipi_zone_chunk, chk); 9578 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk--; 9579 1.1.2.2 skrll if ((int)sctppcbinfo.ipi_count_chunk < 0) { 9580 1.1.2.2 skrll panic("Chunk count is negative"); 9581 1.1.2.2 skrll } 9582 1.1.2.2 skrll goto release; 9583 1.1.2.2 skrll } 9584 1.1.2.2 skrll } else { 9585 1.1.2.2 skrll /* we need to setup a template */ 9586 1.1.2.2 skrll struct sctp_tmit_chunk template; 9587 1.1.2.2 skrll struct sctpchunk_listhead tmp; 9588 1.1.2.2 skrll 9589 1.1.2.2 skrll /* setup the template */ 9590 1.1.2.2 skrll sctp_prepare_chunk(&template, stcb, srcv, strq, net); 9591 1.1.2.2 skrll 9592 1.1.2.2 skrll /* Prepare the temp list */ 9593 1.1.2.2 skrll TAILQ_INIT(&tmp); 9594 1.1.2.2 skrll 9595 1.1.2.2 skrll /* Template is complete, now time for the work */ 9596 1.1.2.2 skrll while (tot_out > 0) { 9597 1.1.2.2 skrll /* Get a chunk */ 9598 1.1.2.2 skrll chk = (struct sctp_tmit_chunk *)SCTP_ZONE_GET(sctppcbinfo.ipi_zone_chunk); 9599 1.1.2.2 skrll if (chk == NULL) { 9600 1.1.2.2 skrll /* 9601 1.1.2.2 skrll * ok we must spin through and dump anything 9602 1.1.2.2 skrll * we have allocated and then jump to the 9603 1.1.2.2 skrll * no_membad 9604 1.1.2.2 skrll */ 9605 1.1.2.2 skrll error = ENOMEM; 9606 1.1.2.2 skrll } 9607 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk++; 9608 1.1.2.2 skrll asoc->chunks_on_out_queue++; 9609 1.1.2.2 skrll 9610 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 9611 1.1.2.2 skrll *chk = template; 9612 1.1.2.2 skrll chk->whoTo->ref_count++; 9613 1.1.2.2 skrll MGETHDR(chk->data, M_WAIT, MT_DATA); 9614 1.1.2.2 skrll if (chk->data == NULL) { 9615 1.1.2.2 skrll error = ENOMEM; 9616 1.1.2.2 skrll goto temp_clean_up; 9617 1.1.2.2 skrll } 9618 1.1.2.2 skrll tot_demand = min(tot_out, frag_size); 9619 1.1.2.2 skrll error = sctp_copy_one(chk->data, uio, tot_demand , resv_in_first, &mbcnt_e); 9620 1.1.2.2 skrll if (error) 9621 1.1.2.2 skrll goto temp_clean_up; 9622 1.1.2.2 skrll /* now fix the chk->send_size */ 9623 1.1.2.2 skrll chk->mbcnt = mbcnt_e; 9624 1.1.2.2 skrll mbcnt += mbcnt_e; 9625 1.1.2.2 skrll mbcnt_e = 0; 9626 1.1.2.2 skrll chk->send_size = tot_demand; 9627 1.1.2.2 skrll chk->data->m_pkthdr.len = tot_demand; 9628 1.1.2.2 skrll chk->book_size = chk->send_size; 9629 1.1.2.2 skrll if (chk->flags & SCTP_PR_SCTP_BUFFER) { 9630 1.1.2.2 skrll asoc->sent_queue_cnt_removeable++; 9631 1.1.2.2 skrll } 9632 1.1.2.2 skrll TAILQ_INSERT_TAIL(&tmp, chk, sctp_next); 9633 1.1.2.2 skrll tot_out -= tot_demand; 9634 1.1.2.2 skrll } 9635 1.1.2.2 skrll /* Now the tmp list holds all chunks and data */ 9636 1.1.2.2 skrll if ((srcv->sinfo_flags & MSG_UNORDERED) == 0) { 9637 1.1.2.2 skrll /* bump the ssn if we are unordered. */ 9638 1.1.2.2 skrll strq->next_sequence_sent++; 9639 1.1.2.2 skrll } 9640 1.1.2.2 skrll /* Mark the first/last flags. This will 9641 1.1.2.2 skrll * result int a 3 for a single item on the list 9642 1.1.2.2 skrll */ 9643 1.1.2.2 skrll chk = TAILQ_FIRST(&tmp); 9644 1.1.2.2 skrll chk->rec.data.rcv_flags |= SCTP_DATA_FIRST_FRAG; 9645 1.1.2.2 skrll chk = TAILQ_LAST(&tmp, sctpchunk_listhead); 9646 1.1.2.2 skrll chk->rec.data.rcv_flags |= SCTP_DATA_LAST_FRAG; 9647 1.1.2.2 skrll 9648 1.1.2.2 skrll /* now move it to the streams actual queue */ 9649 1.1.2.2 skrll /* first stop protocol processing */ 9650 1.1.2.2 skrll mutex_enter(softnet_lock); 9651 1.1.2.2 skrll if ((asoc->state == 0) || 9652 1.1.2.2 skrll (my_vtag != asoc->my_vtag) || 9653 1.1.2.2 skrll (so != inp->sctp_socket) || 9654 1.1.2.2 skrll (inp->sctp_socket == 0)) { 9655 1.1.2.2 skrll /* connection was aborted */ 9656 1.1.2.2 skrll mutex_exit(softnet_lock); 9657 1.1.2.2 skrll error = ECONNRESET; 9658 1.1.2.2 skrll goto temp_clean_up; 9659 1.1.2.2 skrll } 9660 1.1.2.2 skrll chk = TAILQ_FIRST(&tmp); 9661 1.1.2.2 skrll while (chk) { 9662 1.1.2.2 skrll chk->data->m_nextpkt = 0; 9663 1.1.2.2 skrll TAILQ_REMOVE(&tmp, chk, sctp_next); 9664 1.1.2.2 skrll asoc->stream_queue_cnt++; 9665 1.1.2.2 skrll TAILQ_INSERT_TAIL(&strq->outqueue, chk, sctp_next); 9666 1.1.2.2 skrll chk = TAILQ_FIRST(&tmp); 9667 1.1.2.2 skrll } 9668 1.1.2.2 skrll /* now check if this stream is on the wheel */ 9669 1.1.2.2 skrll if ((strq->next_spoke.tqe_next == NULL) && 9670 1.1.2.2 skrll (strq->next_spoke.tqe_prev == NULL)) { 9671 1.1.2.2 skrll /* Insert it on the wheel since it is not 9672 1.1.2.2 skrll * on it currently 9673 1.1.2.2 skrll */ 9674 1.1.2.2 skrll sctp_insert_on_wheel(asoc, strq); 9675 1.1.2.2 skrll } 9676 1.1.2.2 skrll /* Ok now we can allow pping */ 9677 1.1.2.2 skrll mutex_exit(softnet_lock); 9678 1.1.2.2 skrll temp_clean_up: 9679 1.1.2.2 skrll if (error) { 9680 1.1.2.2 skrll chk = TAILQ_FIRST(&tmp); 9681 1.1.2.2 skrll while (chk) { 9682 1.1.2.2 skrll if (chk->data) { 9683 1.1.2.2 skrll sctp_m_freem(chk->data); 9684 1.1.2.2 skrll chk->data = NULL; 9685 1.1.2.2 skrll } 9686 1.1.2.2 skrll TAILQ_REMOVE(&tmp, chk, sctp_next); 9687 1.1.2.2 skrll SCTP_ZONE_FREE(sctppcbinfo.ipi_zone_chunk, chk); 9688 1.1.2.2 skrll sctppcbinfo.ipi_count_chunk--; 9689 1.1.2.2 skrll asoc->chunks_on_out_queue--; 9690 1.1.2.2 skrll if ((int)sctppcbinfo.ipi_count_chunk < 0) { 9691 1.1.2.2 skrll panic("Chunk count is negative"); 9692 1.1.2.2 skrll } 9693 1.1.2.2 skrll sctppcbinfo.ipi_gencnt_chunk++; 9694 1.1.2.2 skrll chk = TAILQ_FIRST(&tmp); 9695 1.1.2.2 skrll } 9696 1.1.2.2 skrll goto release; 9697 1.1.2.2 skrll } 9698 1.1.2.2 skrll } 9699 1.1.2.2 skrll zap_by_it_now: 9700 1.1.2.2 skrll #ifdef SCTP_MBCNT_LOGGING 9701 1.1.2.2 skrll sctp_log_mbcnt(SCTP_LOG_MBCNT_INCREASE, 9702 1.1.2.2 skrll asoc->total_output_queue_size, 9703 1.1.2.2 skrll dataout, 9704 1.1.2.2 skrll asoc->total_output_mbuf_queue_size, 9705 1.1.2.2 skrll mbcnt); 9706 1.1.2.2 skrll #endif 9707 1.1.2.2 skrll solock(so); 9708 1.1.2.2 skrll asoc->total_output_queue_size += dataout; 9709 1.1.2.2 skrll asoc->total_output_mbuf_queue_size += mbcnt; 9710 1.1.2.2 skrll if ((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) || 9711 1.1.2.2 skrll (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_IN_TCPPOOL)) { 9712 1.1.2.2 skrll so->so_snd.sb_cc += dataout; 9713 1.1.2.2 skrll so->so_snd.sb_mbcnt += mbcnt; 9714 1.1.2.2 skrll } 9715 1.1.2.2 skrll if ((srcv->sinfo_flags & MSG_EOF) && 9716 1.1.2.2 skrll (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_UDPTYPE) 9717 1.1.2.2 skrll ) { 9718 1.1.2.2 skrll int some_on_streamwheel = 0; 9719 1.1.2.2 skrll error = 0; 9720 1.1.2.2 skrll if (!TAILQ_EMPTY(&asoc->out_wheel)) { 9721 1.1.2.2 skrll /* Check to see if some data queued */ 9722 1.1.2.2 skrll struct sctp_stream_out *outs; 9723 1.1.2.2 skrll TAILQ_FOREACH(outs, &asoc->out_wheel, next_spoke) { 9724 1.1.2.2 skrll if (!TAILQ_EMPTY(&outs->outqueue)) { 9725 1.1.2.2 skrll some_on_streamwheel = 1; 9726 1.1.2.2 skrll break; 9727 1.1.2.2 skrll } 9728 1.1.2.2 skrll } 9729 1.1.2.2 skrll } 9730 1.1.2.2 skrll if (TAILQ_EMPTY(&asoc->send_queue) && 9731 1.1.2.2 skrll TAILQ_EMPTY(&asoc->sent_queue) && 9732 1.1.2.2 skrll (some_on_streamwheel == 0)) { 9733 1.1.2.2 skrll /* there is nothing queued to send, so I'm done... */ 9734 1.1.2.2 skrll if ((SCTP_GET_STATE(asoc) != SCTP_STATE_SHUTDOWN_SENT) && 9735 1.1.2.2 skrll (SCTP_GET_STATE(asoc) != SCTP_STATE_SHUTDOWN_ACK_SENT)) { 9736 1.1.2.2 skrll /* only send SHUTDOWN the first time through */ 9737 1.1.2.2 skrll #ifdef SCTP_DEBUG 9738 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT4) { 9739 1.1.2.2 skrll printf("%s:%d sends a shutdown\n", 9740 1.1.2.2 skrll __FILE__, 9741 1.1.2.2 skrll __LINE__ 9742 1.1.2.2 skrll ); 9743 1.1.2.2 skrll } 9744 1.1.2.2 skrll #endif 9745 1.1.2.2 skrll sctp_send_shutdown(stcb, stcb->asoc.primary_destination); 9746 1.1.2.2 skrll asoc->state = SCTP_STATE_SHUTDOWN_SENT; 9747 1.1.2.2 skrll sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWN, stcb->sctp_ep, stcb, 9748 1.1.2.2 skrll asoc->primary_destination); 9749 1.1.2.2 skrll sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNGUARD, stcb->sctp_ep, stcb, 9750 1.1.2.2 skrll asoc->primary_destination); 9751 1.1.2.2 skrll } 9752 1.1.2.2 skrll } else { 9753 1.1.2.2 skrll /* 9754 1.1.2.2 skrll * we still got (or just got) data to send, so set 9755 1.1.2.2 skrll * SHUTDOWN_PENDING 9756 1.1.2.2 skrll */ 9757 1.1.2.2 skrll /* 9758 1.1.2.2 skrll * XXX sockets draft says that MSG_EOF should be sent 9759 1.1.2.2 skrll * with no data. currently, we will allow user data 9760 1.1.2.2 skrll * to be sent first and move to SHUTDOWN-PENDING 9761 1.1.2.2 skrll */ 9762 1.1.2.2 skrll asoc->state |= SCTP_STATE_SHUTDOWN_PENDING; 9763 1.1.2.2 skrll } 9764 1.1.2.2 skrll } 9765 1.1.2.2 skrll #ifdef SCTP_DEBUG 9766 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT2) { 9767 1.1.2.2 skrll printf("++total out:%d total_mbuf_out:%d\n", 9768 1.1.2.2 skrll (int)asoc->total_output_queue_size, 9769 1.1.2.2 skrll (int)asoc->total_output_mbuf_queue_size); 9770 1.1.2.2 skrll } 9771 1.1.2.2 skrll #endif 9772 1.1.2.2 skrll 9773 1.1.2.2 skrll release: 9774 1.1.2.2 skrll sbunlock(&so->so_snd); 9775 1.1.2.2 skrll out_locked: 9776 1.1.2.2 skrll sounlock(so); 9777 1.1.2.2 skrll 9778 1.1.2.2 skrll if (mm) 9779 1.1.2.2 skrll sctp_m_freem(mm); 9780 1.1.2.2 skrll return (error); 9781 1.1.2.2 skrll } 9782 1.1.2.2 skrll 9783 1.1.2.2 skrll 9784 1.1.2.2 skrll int 9785 1.1.2.2 skrll sctp_sosend(struct socket *so, struct sockaddr *addr, struct uio *uio, 9786 1.1.2.2 skrll struct mbuf *top, struct mbuf *control, int flags, struct lwp *p) 9787 1.1.2.2 skrll { 9788 1.1.2.2 skrll int error, use_rcvinfo; 9789 1.1.2.2 skrll int queue_only = 0, queue_only_for_init=0; 9790 1.1.2.2 skrll int un_sent = 0; 9791 1.1.2.2 skrll int now_filled=0; 9792 1.1.2.2 skrll struct sctp_inpcb *inp; 9793 1.1.2.2 skrll struct sctp_tcb *stcb=NULL; 9794 1.1.2.2 skrll struct sctp_sndrcvinfo srcv; 9795 1.1.2.2 skrll struct timeval now; 9796 1.1.2.2 skrll struct sctp_nets *net; 9797 1.1.2.2 skrll struct sctp_association *asoc; 9798 1.1.2.2 skrll struct sctp_inpcb *t_inp; 9799 1.1.2.2 skrll int create_lock_applied = 0; 9800 1.1.2.2 skrll 9801 1.1.2.2 skrll error = use_rcvinfo = 0; 9802 1.1.2.2 skrll net = NULL; 9803 1.1.2.2 skrll stcb = NULL; 9804 1.1.2.2 skrll asoc = NULL; 9805 1.1.2.2 skrll t_inp = inp = (struct sctp_inpcb *)so->so_pcb; 9806 1.1.2.2 skrll 9807 1.1.2.2 skrll solock(so); 9808 1.1.2.2 skrll if ((inp->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) && 9809 1.1.2.2 skrll (inp->sctp_flags & SCTP_PCB_FLAGS_ACCEPTING)) { 9810 1.1.2.2 skrll /* The listner can NOT send */ 9811 1.1.2.2 skrll error = EFAULT; 9812 1.1.2.2 skrll sounlock(so); 9813 1.1.2.2 skrll goto out; 9814 1.1.2.2 skrll } 9815 1.1.2.2 skrll if (addr) { 9816 1.1.2.2 skrll SCTP_ASOC_CREATE_LOCK(inp); 9817 1.1.2.2 skrll if ((inp->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE) || 9818 1.1.2.2 skrll (inp->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE)) { 9819 1.1.2.2 skrll /* Should I really unlock ? */ 9820 1.1.2.2 skrll error = EFAULT; 9821 1.1.2.2 skrll sounlock(so); 9822 1.1.2.2 skrll goto out; 9823 1.1.2.2 skrll 9824 1.1.2.2 skrll } 9825 1.1.2.2 skrll create_lock_applied = 1; 9826 1.1.2.2 skrll if (((inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) == 0) && 9827 1.1.2.2 skrll (addr->sa_family == AF_INET6)) { 9828 1.1.2.2 skrll error = EINVAL; 9829 1.1.2.2 skrll sounlock(so); 9830 1.1.2.2 skrll goto out; 9831 1.1.2.2 skrll } 9832 1.1.2.2 skrll } 9833 1.1.2.2 skrll /* now we must find the assoc */ 9834 1.1.2.2 skrll if (inp->sctp_flags & SCTP_PCB_FLAGS_CONNECTED) { 9835 1.1.2.2 skrll SCTP_INP_RLOCK(inp); 9836 1.1.2.2 skrll stcb = LIST_FIRST(&inp->sctp_asoc_list); 9837 1.1.2.2 skrll if (stcb == NULL) { 9838 1.1.2.2 skrll SCTP_INP_RUNLOCK(inp); 9839 1.1.2.2 skrll error = ENOTCONN; 9840 1.1.2.2 skrll sounlock(so); 9841 1.1.2.2 skrll goto out; 9842 1.1.2.2 skrll } 9843 1.1.2.2 skrll SCTP_TCB_LOCK(stcb); 9844 1.1.2.2 skrll SCTP_INP_RUNLOCK(inp); 9845 1.1.2.2 skrll net = stcb->asoc.primary_destination; 9846 1.1.2.2 skrll } 9847 1.1.2.2 skrll #ifdef SCTP_DEBUG 9848 1.1.2.2 skrll printf("sctp_sosend: get control\n"); 9849 1.1.2.2 skrll #endif 9850 1.1.2.2 skrll /* get control */ 9851 1.1.2.2 skrll if (control) { 9852 1.1.2.2 skrll /* process cmsg snd/rcv info (maybe a assoc-id) */ 9853 1.1.2.2 skrll if (sctp_find_cmsg(SCTP_SNDRCV, (void *)&srcv, control, 9854 1.1.2.2 skrll sizeof(srcv))) { 9855 1.1.2.2 skrll /* got one */ 9856 1.1.2.2 skrll if (srcv.sinfo_flags & MSG_SENDALL) { 9857 1.1.2.2 skrll /* its a sendall */ 9858 1.1.2.2 skrll sctppcbinfo.mbuf_track--; 9859 1.1.2.2 skrll sctp_m_freem(control); 9860 1.1.2.2 skrll 9861 1.1.2.2 skrll if (create_lock_applied) { 9862 1.1.2.2 skrll SCTP_ASOC_CREATE_UNLOCK(inp); 9863 1.1.2.2 skrll create_lock_applied = 0; 9864 1.1.2.2 skrll } 9865 1.1.2.2 skrll return (sctp_sendall(inp, uio, top, &srcv)); 9866 1.1.2.2 skrll } 9867 1.1.2.2 skrll use_rcvinfo = 1; 9868 1.1.2.2 skrll } 9869 1.1.2.2 skrll } 9870 1.1.2.2 skrll #ifdef SCTP_DEBUG 9871 1.1.2.2 skrll printf("sctp_sosend: doing lookup\n"); 9872 1.1.2.2 skrll #endif 9873 1.1.2.2 skrll if (stcb == NULL) { 9874 1.1.2.2 skrll /* Need to do a lookup */ 9875 1.1.2.2 skrll if (use_rcvinfo && srcv.sinfo_assoc_id) { 9876 1.1.2.2 skrll stcb = sctp_findassociation_ep_asocid(inp, srcv.sinfo_assoc_id); 9877 1.1.2.2 skrll /* 9878 1.1.2.2 skrll * Question: Should I error here if the assoc_id is 9879 1.1.2.2 skrll * no longer valid? i.e. I can't find it? 9880 1.1.2.2 skrll */ 9881 1.1.2.2 skrll if ((stcb) && 9882 1.1.2.2 skrll (addr != NULL)) { 9883 1.1.2.2 skrll /* Must locate the net structure */ 9884 1.1.2.2 skrll net = sctp_findnet(stcb, addr); 9885 1.1.2.2 skrll } 9886 1.1.2.2 skrll } 9887 1.1.2.2 skrll if (stcb == NULL) { 9888 1.1.2.2 skrll if (addr != NULL) { 9889 1.1.2.2 skrll /* Since we did not use findep we must 9890 1.1.2.2 skrll * increment it, and if we don't find a 9891 1.1.2.2 skrll * tcb decrement it. 9892 1.1.2.2 skrll */ 9893 1.1.2.2 skrll SCTP_INP_WLOCK(inp); 9894 1.1.2.2 skrll SCTP_INP_INCR_REF(inp); 9895 1.1.2.2 skrll SCTP_INP_WUNLOCK(inp); 9896 1.1.2.2 skrll stcb = sctp_findassociation_ep_addr(&t_inp, addr, &net, NULL, NULL); 9897 1.1.2.2 skrll if (stcb == NULL) { 9898 1.1.2.2 skrll SCTP_INP_WLOCK(inp); 9899 1.1.2.2 skrll SCTP_INP_DECR_REF(inp); 9900 1.1.2.2 skrll SCTP_INP_WUNLOCK(inp); 9901 1.1.2.2 skrll } 9902 1.1.2.2 skrll } 9903 1.1.2.2 skrll } 9904 1.1.2.2 skrll } 9905 1.1.2.2 skrll if ((stcb == NULL) && 9906 1.1.2.2 skrll (inp->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE)) { 9907 1.1.2.2 skrll error = ENOTCONN; 9908 1.1.2.2 skrll sounlock(so); 9909 1.1.2.2 skrll goto out; 9910 1.1.2.2 skrll } else if ((stcb == NULL) && (addr == NULL)) { 9911 1.1.2.2 skrll error = ENOENT; 9912 1.1.2.2 skrll sounlock(so); 9913 1.1.2.2 skrll goto out; 9914 1.1.2.2 skrll } else if (stcb == NULL) { 9915 1.1.2.2 skrll /* UDP style, we must go ahead and start the INIT process */ 9916 1.1.2.2 skrll if ((use_rcvinfo) && 9917 1.1.2.2 skrll (srcv.sinfo_flags & MSG_ABORT)) { 9918 1.1.2.2 skrll /* User asks to abort a non-existant asoc */ 9919 1.1.2.2 skrll error = ENOENT; 9920 1.1.2.2 skrll sounlock(so); 9921 1.1.2.2 skrll goto out; 9922 1.1.2.2 skrll } 9923 1.1.2.2 skrll /* get an asoc/stcb struct */ 9924 1.1.2.2 skrll stcb = sctp_aloc_assoc(inp, addr, 1, &error, 0); 9925 1.1.2.2 skrll if (stcb == NULL) { 9926 1.1.2.2 skrll /* Error is setup for us in the call */ 9927 1.1.2.2 skrll sounlock(so); 9928 1.1.2.2 skrll goto out; 9929 1.1.2.2 skrll } 9930 1.1.2.2 skrll if (create_lock_applied) { 9931 1.1.2.2 skrll SCTP_ASOC_CREATE_UNLOCK(inp); 9932 1.1.2.2 skrll create_lock_applied = 0; 9933 1.1.2.2 skrll } else { 9934 1.1.2.2 skrll printf("Huh-3? create lock should have been on??\n"); 9935 1.1.2.2 skrll } 9936 1.1.2.2 skrll /* Turn on queue only flag to prevent data from being sent */ 9937 1.1.2.2 skrll queue_only = 1; 9938 1.1.2.2 skrll asoc = &stcb->asoc; 9939 1.1.2.2 skrll asoc->state = SCTP_STATE_COOKIE_WAIT; 9940 1.1.2.2 skrll SCTP_GETTIME_TIMEVAL(&asoc->time_entered); 9941 1.1.2.2 skrll if (control) { 9942 1.1.2.2 skrll /* see if a init structure exists in cmsg headers */ 9943 1.1.2.2 skrll struct sctp_initmsg initm; 9944 1.1.2.2 skrll int i; 9945 1.1.2.2 skrll if (sctp_find_cmsg(SCTP_INIT, (void *)&initm, control, sizeof(initm))) { 9946 1.1.2.2 skrll /* we have an INIT override of the default */ 9947 1.1.2.2 skrll if (initm.sinit_max_attempts) 9948 1.1.2.2 skrll asoc->max_init_times = initm.sinit_max_attempts; 9949 1.1.2.2 skrll if (initm.sinit_num_ostreams) 9950 1.1.2.2 skrll asoc->pre_open_streams = initm.sinit_num_ostreams; 9951 1.1.2.2 skrll if (initm.sinit_max_instreams) 9952 1.1.2.2 skrll asoc->max_inbound_streams = initm.sinit_max_instreams; 9953 1.1.2.2 skrll if (initm.sinit_max_init_timeo) 9954 1.1.2.2 skrll asoc->initial_init_rto_max = initm.sinit_max_init_timeo; 9955 1.1.2.2 skrll if (asoc->streamoutcnt < asoc->pre_open_streams) { 9956 1.1.2.2 skrll /* Default is NOT correct */ 9957 1.1.2.2 skrll #ifdef SCTP_DEBUG 9958 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 9959 1.1.2.2 skrll printf("Ok, defout:%d pre_open:%d\n", 9960 1.1.2.2 skrll asoc->streamoutcnt, asoc->pre_open_streams); 9961 1.1.2.2 skrll } 9962 1.1.2.2 skrll #endif 9963 1.1.2.2 skrll free(asoc->strmout, M_PCB); 9964 1.1.2.2 skrll asoc->strmout = NULL; 9965 1.1.2.2 skrll asoc->streamoutcnt = asoc->pre_open_streams; 9966 1.1.2.2 skrll 9967 1.1.2.2 skrll /* What happesn if this fails? .. we panic ...*/ 9968 1.1.2.2 skrll asoc->strmout = malloc( 9969 1.1.2.2 skrll asoc->streamoutcnt * 9970 1.1.2.2 skrll sizeof(struct sctp_stream_out), 9971 1.1.2.2 skrll M_PCB, M_WAIT); 9972 1.1.2.2 skrll for (i = 0; i < asoc->streamoutcnt; i++) { 9973 1.1.2.2 skrll /* 9974 1.1.2.2 skrll * inbound side must be set to 0xffff, 9975 1.1.2.2 skrll * also NOTE when we get the INIT-ACK 9976 1.1.2.2 skrll * back (for INIT sender) we MUST 9977 1.1.2.2 skrll * reduce the count (streamoutcnt) but 9978 1.1.2.2 skrll * first check if we sent to any of the 9979 1.1.2.2 skrll * upper streams that were dropped (if 9980 1.1.2.2 skrll * some were). Those that were dropped 9981 1.1.2.2 skrll * must be notified to the upper layer 9982 1.1.2.2 skrll * as failed to send. 9983 1.1.2.2 skrll */ 9984 1.1.2.2 skrll asoc->strmout[i].next_sequence_sent = 0x0; 9985 1.1.2.2 skrll TAILQ_INIT(&asoc->strmout[i].outqueue); 9986 1.1.2.2 skrll asoc->strmout[i].stream_no = i; 9987 1.1.2.2 skrll asoc->strmout[i].next_spoke.tqe_next = 0; 9988 1.1.2.2 skrll asoc->strmout[i].next_spoke.tqe_prev = 0; 9989 1.1.2.2 skrll } 9990 1.1.2.2 skrll } 9991 1.1.2.2 skrll } 9992 1.1.2.2 skrll 9993 1.1.2.2 skrll } 9994 1.1.2.2 skrll /* out with the INIT */ 9995 1.1.2.2 skrll queue_only_for_init = 1; 9996 1.1.2.2 skrll sctp_send_initiate(inp, stcb); 9997 1.1.2.2 skrll /* 9998 1.1.2.2 skrll * we may want to dig in after this call and adjust the MTU 9999 1.1.2.2 skrll * value. It defaulted to 1500 (constant) but the ro structure 10000 1.1.2.2 skrll * may now have an update and thus we may need to change it 10001 1.1.2.2 skrll * BEFORE we append the message. 10002 1.1.2.2 skrll */ 10003 1.1.2.2 skrll net = stcb->asoc.primary_destination; 10004 1.1.2.2 skrll asoc = &stcb->asoc; 10005 1.1.2.2 skrll } else { 10006 1.1.2.2 skrll asoc = &stcb->asoc; 10007 1.1.2.2 skrll } 10008 1.1.2.2 skrll if (create_lock_applied) { 10009 1.1.2.2 skrll SCTP_ASOC_CREATE_UNLOCK(inp); 10010 1.1.2.2 skrll create_lock_applied = 0; 10011 1.1.2.2 skrll } 10012 1.1.2.2 skrll if ((SCTP_GET_STATE(asoc) == SCTP_STATE_COOKIE_WAIT) || 10013 1.1.2.2 skrll (SCTP_GET_STATE(asoc) == SCTP_STATE_COOKIE_ECHOED)) { 10014 1.1.2.2 skrll queue_only = 1; 10015 1.1.2.2 skrll } 10016 1.1.2.2 skrll if (use_rcvinfo == 0) { 10017 1.1.2.2 skrll /* Grab the default stuff from the asoc */ 10018 1.1.2.2 skrll srcv = stcb->asoc.def_send; 10019 1.1.2.2 skrll } 10020 1.1.2.2 skrll /* we are now done with all control */ 10021 1.1.2.2 skrll if (control) { 10022 1.1.2.2 skrll sctp_m_freem(control); 10023 1.1.2.2 skrll control = NULL; 10024 1.1.2.2 skrll } 10025 1.1.2.2 skrll 10026 1.1.2.2 skrll if ((SCTP_GET_STATE(asoc) == SCTP_STATE_SHUTDOWN_SENT) || 10027 1.1.2.2 skrll (SCTP_GET_STATE(asoc) == SCTP_STATE_SHUTDOWN_RECEIVED) || 10028 1.1.2.2 skrll (SCTP_GET_STATE(asoc) == SCTP_STATE_SHUTDOWN_ACK_SENT) || 10029 1.1.2.2 skrll (asoc->state & SCTP_STATE_SHUTDOWN_PENDING)) { 10030 1.1.2.2 skrll if ((use_rcvinfo) && 10031 1.1.2.2 skrll (srcv.sinfo_flags & MSG_ABORT)) { 10032 1.1.2.2 skrll ; 10033 1.1.2.2 skrll } else { 10034 1.1.2.2 skrll error = ECONNRESET; 10035 1.1.2.2 skrll sounlock(so); 10036 1.1.2.2 skrll goto out; 10037 1.1.2.2 skrll } 10038 1.1.2.2 skrll } 10039 1.1.2.2 skrll /* Ok, we will attempt a msgsnd :> */ 10040 1.1.2.2 skrll #if 0 /* XXX */ 10041 1.1.2.2 skrll if (p) 10042 1.1.2.2 skrll p->p_stats->p_ru.ru_msgsnd++; 10043 1.1.2.2 skrll #endif 10044 1.1.2.2 skrll 10045 1.1.2.2 skrll if (stcb) { 10046 1.1.2.2 skrll if (net && ((srcv.sinfo_flags & MSG_ADDR_OVER))) { 10047 1.1.2.2 skrll /* we take the override or the unconfirmed */ 10048 1.1.2.2 skrll ; 10049 1.1.2.2 skrll } else { 10050 1.1.2.2 skrll net = stcb->asoc.primary_destination; 10051 1.1.2.2 skrll } 10052 1.1.2.2 skrll } 10053 1.1.2.2 skrll 10054 1.1.2.2 skrll #ifdef SCTP_DEBUG 10055 1.1.2.2 skrll printf("sctp_sosend: before copying in %p\n", top); 10056 1.1.2.2 skrll #endif 10057 1.1.2.2 skrll if (top == NULL) { 10058 1.1.2.2 skrll /* Must copy it all in from user land. The 10059 1.1.2.2 skrll * socket buf is locked but we don't suspend 10060 1.1.2.2 skrll * protocol processing until we are ready to 10061 1.1.2.2 skrll * send/queue it. 10062 1.1.2.2 skrll */ 10063 1.1.2.2 skrll sounlock(so); 10064 1.1.2.2 skrll #ifdef SCTP_DEBUG 10065 1.1.2.2 skrll printf("sctp_sosend: before cii\n"); 10066 1.1.2.2 skrll #endif 10067 1.1.2.2 skrll error = sctp_copy_it_in(inp, stcb, asoc, net, &srcv, uio, flags); 10068 1.1.2.2 skrll #ifdef SCTP_DEBUG 10069 1.1.2.2 skrll printf("sctp_sosend: after cii\n"); 10070 1.1.2.2 skrll #endif 10071 1.1.2.2 skrll if (error) 10072 1.1.2.2 skrll goto out; 10073 1.1.2.2 skrll } else { 10074 1.1.2.2 skrll /* Here we must either pull in the user data to chunk 10075 1.1.2.2 skrll * buffers, or use top to do a msg_append. 10076 1.1.2.2 skrll */ 10077 1.1.2.2 skrll error = sctp_msg_append(stcb, net, top, &srcv, flags); 10078 1.1.2.2 skrll sounlock(so); 10079 1.1.2.2 skrll if (error) 10080 1.1.2.2 skrll goto out; 10081 1.1.2.2 skrll /* zap the top since it is now being used */ 10082 1.1.2.2 skrll top = 0; 10083 1.1.2.2 skrll } 10084 1.1.2.2 skrll #ifdef SCTP_DEBUG 10085 1.1.2.2 skrll printf("sctp_sosend: after copying in\n"); 10086 1.1.2.2 skrll #endif 10087 1.1.2.2 skrll if (net->flight_size > net->cwnd) { 10088 1.1.2.2 skrll sctp_pegs[SCTP_SENDTO_FULL_CWND]++; 10089 1.1.2.2 skrll queue_only = 1; 10090 1.1.2.2 skrll 10091 1.1.2.2 skrll } else if (asoc->ifp_had_enobuf) { 10092 1.1.2.2 skrll sctp_pegs[SCTP_QUEONLY_BURSTLMT]++; 10093 1.1.2.2 skrll queue_only = 1; 10094 1.1.2.2 skrll } else { 10095 1.1.2.2 skrll un_sent = ((stcb->asoc.total_output_queue_size - stcb->asoc.total_flight) + 10096 1.1.2.2 skrll ((stcb->asoc.chunks_on_out_queue - stcb->asoc.total_flight_count) * sizeof(struct sctp_data_chunk)) + 10097 1.1.2.2 skrll SCTP_MED_OVERHEAD); 10098 1.1.2.2 skrll 10099 1.1.2.2 skrll if (((inp->sctp_flags & SCTP_PCB_FLAGS_NODELAY) == 0) && 10100 1.1.2.2 skrll (stcb->asoc.total_flight > 0) && 10101 1.1.2.2 skrll (un_sent < (int)stcb->asoc.smallest_mtu)) { 10102 1.1.2.2 skrll 10103 1.1.2.2 skrll /* Ok, Nagle is set on and we have data outstanding. Don't 10104 1.1.2.2 skrll * send anything and let SACKs drive out the data unless we 10105 1.1.2.2 skrll * have a "full" segment to send. 10106 1.1.2.2 skrll */ 10107 1.1.2.2 skrll sctp_pegs[SCTP_NAGLE_NOQ]++; 10108 1.1.2.2 skrll queue_only = 1; 10109 1.1.2.2 skrll } else { 10110 1.1.2.2 skrll sctp_pegs[SCTP_NAGLE_OFF]++; 10111 1.1.2.2 skrll } 10112 1.1.2.2 skrll } 10113 1.1.2.2 skrll if (queue_only_for_init) { 10114 1.1.2.2 skrll /* It is possible to have a turn around of the 10115 1.1.2.2 skrll * INIT/INIT-ACK/COOKIE before I have a chance to 10116 1.1.2.2 skrll * copy in the data. In such a case I DO want to 10117 1.1.2.2 skrll * send it out by reversing the queue only flag. 10118 1.1.2.2 skrll */ 10119 1.1.2.2 skrll if ((SCTP_GET_STATE(asoc) != SCTP_STATE_COOKIE_WAIT) || 10120 1.1.2.2 skrll (SCTP_GET_STATE(asoc) != SCTP_STATE_COOKIE_ECHOED)) { 10121 1.1.2.2 skrll /* yep, reverse it */ 10122 1.1.2.2 skrll queue_only = 0; 10123 1.1.2.2 skrll } 10124 1.1.2.2 skrll } 10125 1.1.2.2 skrll 10126 1.1.2.2 skrll #ifdef SCTP_DEBUG 10127 1.1.2.2 skrll printf("sctp_sosend: before sending chunk\n"); 10128 1.1.2.2 skrll #endif 10129 1.1.2.2 skrll if ((queue_only == 0) && (stcb->asoc.peers_rwnd && un_sent)) { 10130 1.1.2.2 skrll /* we can attempt to send too.*/ 10131 1.1.2.2 skrll #ifdef SCTP_DEBUG 10132 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 10133 1.1.2.2 skrll printf("USR Send calls sctp_chunk_output\n"); 10134 1.1.2.2 skrll } 10135 1.1.2.2 skrll #endif 10136 1.1.2.2 skrll solock(so); 10137 1.1.2.2 skrll sctp_pegs[SCTP_OUTPUT_FRM_SND]++; 10138 1.1.2.2 skrll sctp_chunk_output(inp, stcb, 0); 10139 1.1.2.2 skrll sounlock(so); 10140 1.1.2.2 skrll } else if ((queue_only == 0) && 10141 1.1.2.2 skrll (stcb->asoc.peers_rwnd == 0) && 10142 1.1.2.2 skrll (stcb->asoc.total_flight == 0)) { 10143 1.1.2.2 skrll /* We get to have a probe outstanding */ 10144 1.1.2.2 skrll solock(so); 10145 1.1.2.2 skrll sctp_from_user_send = 1; 10146 1.1.2.2 skrll sctp_chunk_output(inp, stcb, 0); 10147 1.1.2.2 skrll sctp_from_user_send = 0; 10148 1.1.2.2 skrll sounlock(so); 10149 1.1.2.2 skrll 10150 1.1.2.2 skrll } else if (!TAILQ_EMPTY(&stcb->asoc.control_send_queue)) { 10151 1.1.2.2 skrll int num_out, reason, cwnd_full; 10152 1.1.2.2 skrll /* Here we do control only */ 10153 1.1.2.2 skrll solock(so); 10154 1.1.2.2 skrll sctp_med_chunk_output(inp, stcb, &stcb->asoc, &num_out, 10155 1.1.2.2 skrll &reason, 1, &cwnd_full, 1, &now, &now_filled); 10156 1.1.2.2 skrll sounlock(so); 10157 1.1.2.2 skrll } 10158 1.1.2.2 skrll #ifdef SCTP_DEBUG 10159 1.1.2.2 skrll if (sctp_debug_on & SCTP_DEBUG_OUTPUT1) { 10160 1.1.2.2 skrll printf("USR Send complete qo:%d prw:%d unsent:%d tf:%d cooq:%d toqs:%d \n", 10161 1.1.2.2 skrll queue_only, stcb->asoc.peers_rwnd, un_sent, 10162 1.1.2.2 skrll stcb->asoc.total_flight, stcb->asoc.chunks_on_out_queue, 10163 1.1.2.2 skrll stcb->asoc.total_output_queue_size); 10164 1.1.2.2 skrll } 10165 1.1.2.2 skrll #endif 10166 1.1.2.2 skrll out: 10167 1.1.2.2 skrll if (create_lock_applied) { 10168 1.1.2.2 skrll SCTP_ASOC_CREATE_UNLOCK(inp); 10169 1.1.2.2 skrll create_lock_applied = 0; 10170 1.1.2.2 skrll } 10171 1.1.2.2 skrll if (stcb) { 10172 1.1.2.2 skrll SCTP_TCB_UNLOCK(stcb); 10173 1.1.2.2 skrll } 10174 1.1.2.2 skrll if (top) 10175 1.1.2.2 skrll sctp_m_freem(top); 10176 1.1.2.2 skrll if (control) 10177 1.1.2.2 skrll sctp_m_freem(control); 10178 1.1.2.2 skrll return (error); 10179 1.1.2.2 skrll } 10180
Indexes created Sat Sep 20 22:09:52 GMT 2025