1d6dda9b2SRandall Stewart /* $KAME: sctp_sys_calls.c,v 1.9 2004/08/17 06:08:53 itojun Exp $ */ 2d6dda9b2SRandall Stewart 3d6dda9b2SRandall Stewart /* 4d6dda9b2SRandall Stewart * Copyright (C) 2002-2006 Cisco Systems Inc, 5d6dda9b2SRandall Stewart * All rights reserved. 6d6dda9b2SRandall Stewart * 7d6dda9b2SRandall Stewart * Redistribution and use in source and binary forms, with or without 8d6dda9b2SRandall Stewart * modification, are permitted provided that the following conditions 9d6dda9b2SRandall Stewart * are met: 10d6dda9b2SRandall Stewart * 1. Redistributions of source code must retain the above copyright 11d6dda9b2SRandall Stewart * notice, this list of conditions and the following disclaimer. 12d6dda9b2SRandall Stewart * 2. Redistributions in binary form must reproduce the above copyright 13d6dda9b2SRandall Stewart * notice, this list of conditions and the following disclaimer in the 14d6dda9b2SRandall Stewart * documentation and/or other materials provided with the distribution. 15d6dda9b2SRandall Stewart * 3. Neither the name of the project nor the names of its contributors 16d6dda9b2SRandall Stewart * may be used to endorse or promote products derived from this software 17d6dda9b2SRandall Stewart * without specific prior written permission. 18d6dda9b2SRandall Stewart * 19d6dda9b2SRandall Stewart * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND 20d6dda9b2SRandall Stewart * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 21d6dda9b2SRandall Stewart * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 22d6dda9b2SRandall Stewart * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE 23d6dda9b2SRandall Stewart * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 24d6dda9b2SRandall Stewart * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 25d6dda9b2SRandall Stewart * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 26d6dda9b2SRandall Stewart * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 27d6dda9b2SRandall Stewart * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 28d6dda9b2SRandall Stewart * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 29d6dda9b2SRandall Stewart * SUCH DAMAGE. 30d6dda9b2SRandall Stewart */ 31d6dda9b2SRandall Stewart #include <sys/cdefs.h> 32d6dda9b2SRandall Stewart __FBSDID("$FreeBSD$"); 33d6dda9b2SRandall Stewart #include <stdio.h> 34d6dda9b2SRandall Stewart #include <string.h> 35d6dda9b2SRandall Stewart #include <errno.h> 36d6dda9b2SRandall Stewart #include <stdlib.h> 37d6dda9b2SRandall Stewart #include <unistd.h> 38d6dda9b2SRandall Stewart #include <sys/types.h> 39d6dda9b2SRandall Stewart #include <sys/socket.h> 40d6dda9b2SRandall Stewart #include <sys/errno.h> 41d6dda9b2SRandall Stewart #include <sys/syscall.h> 42d6dda9b2SRandall Stewart #include <sys/uio.h> 43d6dda9b2SRandall Stewart #include <netinet/in.h> 44d6dda9b2SRandall Stewart #include <arpa/inet.h> 45d6dda9b2SRandall Stewart #include <netinet/sctp_uio.h> 46d6dda9b2SRandall Stewart #include <netinet/sctp.h> 47d6dda9b2SRandall Stewart 48d6dda9b2SRandall Stewart #include <net/if_dl.h> 49d6dda9b2SRandall Stewart 50d6dda9b2SRandall Stewart #ifndef IN6_IS_ADDR_V4MAPPED 51d6dda9b2SRandall Stewart #define IN6_IS_ADDR_V4MAPPED(a) \ 52d6dda9b2SRandall Stewart ((*(const u_int32_t *)(const void *)(&(a)->s6_addr[0]) == 0) && \ 53d6dda9b2SRandall Stewart (*(const u_int32_t *)(const void *)(&(a)->s6_addr[4]) == 0) && \ 54d6dda9b2SRandall Stewart (*(const u_int32_t *)(const void *)(&(a)->s6_addr[8]) == ntohl(0x0000ffff))) 55d6dda9b2SRandall Stewart #endif 56d6dda9b2SRandall Stewart 57d6dda9b2SRandall Stewart #define SCTP_CONTROL_VEC_SIZE_SND 8192 58d6dda9b2SRandall Stewart #define SCTP_CONTROL_VEC_SIZE_RCV 16384 59d6dda9b2SRandall Stewart 60d6dda9b2SRandall Stewart #ifdef SCTP_DEBUG_PRINT_ADDRESS 61d6dda9b2SRandall Stewart static void 62d6dda9b2SRandall Stewart SCTPPrintAnAddress(struct sockaddr *a) 63d6dda9b2SRandall Stewart { 64d6dda9b2SRandall Stewart char stringToPrint[256]; 65d6dda9b2SRandall Stewart u_short prt; 66d6dda9b2SRandall Stewart char *srcaddr, *txt; 67d6dda9b2SRandall Stewart 68d6dda9b2SRandall Stewart if (a == NULL) { 69d6dda9b2SRandall Stewart printf("NULL\n"); 70d6dda9b2SRandall Stewart return; 71d6dda9b2SRandall Stewart } 72d6dda9b2SRandall Stewart if (a->sa_family == AF_INET) { 73d6dda9b2SRandall Stewart srcaddr = (char *)&((struct sockaddr_in *)a)->sin_addr; 74d6dda9b2SRandall Stewart txt = "IPv4 Address: "; 75d6dda9b2SRandall Stewart prt = ntohs(((struct sockaddr_in *)a)->sin_port); 76d6dda9b2SRandall Stewart } else if (a->sa_family == AF_INET6) { 77d6dda9b2SRandall Stewart srcaddr = (char *)&((struct sockaddr_in6 *)a)->sin6_addr; 78d6dda9b2SRandall Stewart prt = ntohs(((struct sockaddr_in6 *)a)->sin6_port); 79d6dda9b2SRandall Stewart txt = "IPv6 Address: "; 80d6dda9b2SRandall Stewart } else if (a->sa_family == AF_LINK) { 81d6dda9b2SRandall Stewart int i; 82d6dda9b2SRandall Stewart char tbuf[200]; 83d6dda9b2SRandall Stewart u_char adbuf[200]; 84d6dda9b2SRandall Stewart struct sockaddr_dl *dl; 85d6dda9b2SRandall Stewart 86d6dda9b2SRandall Stewart dl = (struct sockaddr_dl *)a; 87d6dda9b2SRandall Stewart strncpy(tbuf, dl->sdl_data, dl->sdl_nlen); 88d6dda9b2SRandall Stewart tbuf[dl->sdl_nlen] = 0; 89d6dda9b2SRandall Stewart printf("Intf:%s (len:%d)Interface index:%d type:%x(%d) ll-len:%d ", 90d6dda9b2SRandall Stewart tbuf, 91d6dda9b2SRandall Stewart dl->sdl_nlen, 92d6dda9b2SRandall Stewart dl->sdl_index, 93d6dda9b2SRandall Stewart dl->sdl_type, 94d6dda9b2SRandall Stewart dl->sdl_type, 95d6dda9b2SRandall Stewart dl->sdl_alen 96d6dda9b2SRandall Stewart ); 97d6dda9b2SRandall Stewart memcpy(adbuf, LLADDR(dl), dl->sdl_alen); 98d6dda9b2SRandall Stewart for (i = 0; i < dl->sdl_alen; i++) { 99d6dda9b2SRandall Stewart printf("%2.2x", adbuf[i]); 100d6dda9b2SRandall Stewart if (i < (dl->sdl_alen - 1)) 101d6dda9b2SRandall Stewart printf(":"); 102d6dda9b2SRandall Stewart } 103d6dda9b2SRandall Stewart printf("\n"); 104d6dda9b2SRandall Stewart /* 105d6dda9b2SRandall Stewart * u_short sdl_route[16]; *//* source routing 106d6dda9b2SRandall Stewart * information 107d6dda9b2SRandall Stewart */ 108d6dda9b2SRandall Stewart return; 109d6dda9b2SRandall Stewart } else { 110d6dda9b2SRandall Stewart return; 111d6dda9b2SRandall Stewart } 112d6dda9b2SRandall Stewart if (inet_ntop(a->sa_family, srcaddr, stringToPrint, sizeof(stringToPrint))) { 113d6dda9b2SRandall Stewart if (a->sa_family == AF_INET6) { 114d6dda9b2SRandall Stewart printf("%s%s:%d scope:%d\n", 115d6dda9b2SRandall Stewart txt, stringToPrint, prt, 116d6dda9b2SRandall Stewart ((struct sockaddr_in6 *)a)->sin6_scope_id); 117d6dda9b2SRandall Stewart } else { 118d6dda9b2SRandall Stewart printf("%s%s:%d\n", txt, stringToPrint, prt); 119d6dda9b2SRandall Stewart } 120d6dda9b2SRandall Stewart 121d6dda9b2SRandall Stewart } else { 122d6dda9b2SRandall Stewart printf("%s unprintable?\n", txt); 123d6dda9b2SRandall Stewart } 124d6dda9b2SRandall Stewart } 125d6dda9b2SRandall Stewart 126d6dda9b2SRandall Stewart #endif /* SCTP_DEBUG_PRINT_ADDRESS */ 127d6dda9b2SRandall Stewart 128d6dda9b2SRandall Stewart static void 129d6dda9b2SRandall Stewart in6_sin6_2_sin(struct sockaddr_in *sin, struct sockaddr_in6 *sin6) 130d6dda9b2SRandall Stewart { 131d6dda9b2SRandall Stewart bzero(sin, sizeof(*sin)); 132d6dda9b2SRandall Stewart sin->sin_len = sizeof(struct sockaddr_in); 133d6dda9b2SRandall Stewart sin->sin_family = AF_INET; 134d6dda9b2SRandall Stewart sin->sin_port = sin6->sin6_port; 135d6dda9b2SRandall Stewart sin->sin_addr.s_addr = sin6->sin6_addr.__u6_addr.__u6_addr32[3]; 136d6dda9b2SRandall Stewart } 137d6dda9b2SRandall Stewart 138d6dda9b2SRandall Stewart int 139d6dda9b2SRandall Stewart sctp_getaddrlen(sa_family_t family) 140d6dda9b2SRandall Stewart { 141d6dda9b2SRandall Stewart int error, sd; 142d6dda9b2SRandall Stewart socklen_t siz; 143d6dda9b2SRandall Stewart struct sctp_assoc_value av; 144d6dda9b2SRandall Stewart 145d6dda9b2SRandall Stewart av.assoc_value = family; 146d6dda9b2SRandall Stewart siz = sizeof(av); 147d6dda9b2SRandall Stewart #if defined(AF_INET) 148d6dda9b2SRandall Stewart sd = socket(AF_INET, SOCK_SEQPACKET, IPPROTO_SCTP); 149d6dda9b2SRandall Stewart #elif defined(AF_INET6) 150d6dda9b2SRandall Stewart sd = socket(AF_INET6, SOCK_SEQPACKET, IPPROTO_SCTP); 151d6dda9b2SRandall Stewart #endif 152d6dda9b2SRandall Stewart if (sd == -1) { 153d6dda9b2SRandall Stewart return (errno); 154d6dda9b2SRandall Stewart } 155d6dda9b2SRandall Stewart error = getsockopt(sd, IPPROTO_SCTP, SCTP_GET_ADDR_LEN, &av, &siz); 156d6dda9b2SRandall Stewart close(sd); 157d6dda9b2SRandall Stewart if (error == 0) { 158d6dda9b2SRandall Stewart return ((int)av.assoc_value); 159d6dda9b2SRandall Stewart } else { 160d6dda9b2SRandall Stewart return (error); 161d6dda9b2SRandall Stewart } 162d6dda9b2SRandall Stewart } 163d6dda9b2SRandall Stewart 164d6dda9b2SRandall Stewart int 165d6dda9b2SRandall Stewart sctp_connectx(int sd, const struct sockaddr *addrs, int addrcnt) 166d6dda9b2SRandall Stewart { 167d6dda9b2SRandall Stewart char buf[2048]; 168d6dda9b2SRandall Stewart int i, ret, cnt, *aa; 169d6dda9b2SRandall Stewart char *cpto; 170d6dda9b2SRandall Stewart const struct sockaddr *at; 171d6dda9b2SRandall Stewart size_t len = sizeof(int); 172d6dda9b2SRandall Stewart 173d6dda9b2SRandall Stewart at = addrs; 174d6dda9b2SRandall Stewart cnt = 0; 175d6dda9b2SRandall Stewart cpto = ((caddr_t)buf + sizeof(int)); 176d6dda9b2SRandall Stewart /* validate all the addresses and get the size */ 177d6dda9b2SRandall Stewart for (i = 0; i < addrcnt; i++) { 178d6dda9b2SRandall Stewart if (at->sa_family == AF_INET) { 179d6dda9b2SRandall Stewart memcpy(cpto, at, at->sa_len); 180d6dda9b2SRandall Stewart cpto = ((caddr_t)cpto + at->sa_len); 181d6dda9b2SRandall Stewart len += at->sa_len; 182d6dda9b2SRandall Stewart } else if (at->sa_family == AF_INET6) { 183d6dda9b2SRandall Stewart if (IN6_IS_ADDR_V4MAPPED(&((struct sockaddr_in6 *)at)->sin6_addr)) { 184d6dda9b2SRandall Stewart len += sizeof(struct sockaddr_in); 185d6dda9b2SRandall Stewart in6_sin6_2_sin((struct sockaddr_in *)cpto, (struct sockaddr_in6 *)at); 186d6dda9b2SRandall Stewart cpto = ((caddr_t)cpto + sizeof(struct sockaddr_in)); 187d6dda9b2SRandall Stewart len += sizeof(struct sockaddr_in); 188d6dda9b2SRandall Stewart } else { 189d6dda9b2SRandall Stewart memcpy(cpto, at, at->sa_len); 190d6dda9b2SRandall Stewart cpto = ((caddr_t)cpto + at->sa_len); 191d6dda9b2SRandall Stewart len += at->sa_len; 192d6dda9b2SRandall Stewart } 193d6dda9b2SRandall Stewart } else { 194d6dda9b2SRandall Stewart errno = EINVAL; 195d6dda9b2SRandall Stewart return (-1); 196d6dda9b2SRandall Stewart } 197d6dda9b2SRandall Stewart if (len > (sizeof(buf) - sizeof(int))) { 198d6dda9b2SRandall Stewart /* Never enough memory */ 199d6dda9b2SRandall Stewart return (E2BIG); 200d6dda9b2SRandall Stewart } 201d6dda9b2SRandall Stewart at = (struct sockaddr *)((caddr_t)at + at->sa_len); 202d6dda9b2SRandall Stewart cnt++; 203d6dda9b2SRandall Stewart } 204d6dda9b2SRandall Stewart /* do we have any? */ 205d6dda9b2SRandall Stewart if (cnt == 0) { 206d6dda9b2SRandall Stewart errno = EINVAL; 207d6dda9b2SRandall Stewart return (-1); 208d6dda9b2SRandall Stewart } 209d6dda9b2SRandall Stewart aa = (int *)buf; 210d6dda9b2SRandall Stewart *aa = cnt; 211d6dda9b2SRandall Stewart ret = setsockopt(sd, IPPROTO_SCTP, SCTP_CONNECT_X, (void *)buf, 212d6dda9b2SRandall Stewart (socklen_t) len); 213d6dda9b2SRandall Stewart return (ret); 214d6dda9b2SRandall Stewart } 215d6dda9b2SRandall Stewart 216d6dda9b2SRandall Stewart int 217d6dda9b2SRandall Stewart sctp_bindx(int sd, struct sockaddr *addrs, int addrcnt, int flags) 218d6dda9b2SRandall Stewart { 219d6dda9b2SRandall Stewart struct sctp_getaddresses *gaddrs; 220d6dda9b2SRandall Stewart struct sockaddr *sa; 221d6dda9b2SRandall Stewart int i, sz, fam, argsz; 222d6dda9b2SRandall Stewart 223d6dda9b2SRandall Stewart if ((flags != SCTP_BINDX_ADD_ADDR) && 224d6dda9b2SRandall Stewart (flags != SCTP_BINDX_REM_ADDR)) { 225d6dda9b2SRandall Stewart errno = EFAULT; 226d6dda9b2SRandall Stewart return (-1); 227d6dda9b2SRandall Stewart } 228d6dda9b2SRandall Stewart argsz = (sizeof(struct sockaddr_storage) + 229d6dda9b2SRandall Stewart sizeof(struct sctp_getaddresses)); 230d6dda9b2SRandall Stewart gaddrs = (struct sctp_getaddresses *)calloc(1, argsz); 231d6dda9b2SRandall Stewart if (gaddrs == NULL) { 232d6dda9b2SRandall Stewart errno = ENOMEM; 233d6dda9b2SRandall Stewart return (-1); 234d6dda9b2SRandall Stewart } 235d6dda9b2SRandall Stewart gaddrs->sget_assoc_id = 0; 236d6dda9b2SRandall Stewart sa = addrs; 237d6dda9b2SRandall Stewart for (i = 0; i < addrcnt; i++) { 238d6dda9b2SRandall Stewart sz = sa->sa_len; 239d6dda9b2SRandall Stewart fam = sa->sa_family; 240d6dda9b2SRandall Stewart ((struct sockaddr_in *)&addrs[i])->sin_port = ((struct sockaddr_in *)sa)->sin_port; 241d6dda9b2SRandall Stewart if ((fam != AF_INET) && (fam != AF_INET6)) { 242d6dda9b2SRandall Stewart errno = EINVAL; 243d6dda9b2SRandall Stewart return (-1); 244d6dda9b2SRandall Stewart } 245d6dda9b2SRandall Stewart memcpy(gaddrs->addr, sa, sz); 246d6dda9b2SRandall Stewart if (setsockopt(sd, IPPROTO_SCTP, flags, 247d6dda9b2SRandall Stewart gaddrs, (socklen_t) argsz) != 0) { 248d6dda9b2SRandall Stewart free(gaddrs); 249d6dda9b2SRandall Stewart return (-1); 250d6dda9b2SRandall Stewart } 251d6dda9b2SRandall Stewart memset(gaddrs, 0, argsz); 252d6dda9b2SRandall Stewart sa = (struct sockaddr *)((caddr_t)sa + sz); 253d6dda9b2SRandall Stewart } 254d6dda9b2SRandall Stewart free(gaddrs); 255d6dda9b2SRandall Stewart return (0); 256d6dda9b2SRandall Stewart } 257d6dda9b2SRandall Stewart 258d6dda9b2SRandall Stewart 259d6dda9b2SRandall Stewart int 260d6dda9b2SRandall Stewart sctp_opt_info(int sd, sctp_assoc_t id, int opt, void *arg, socklen_t * size) 261d6dda9b2SRandall Stewart { 262d6dda9b2SRandall Stewart if (arg == NULL) { 263d6dda9b2SRandall Stewart return (EINVAL); 264d6dda9b2SRandall Stewart } 265d6dda9b2SRandall Stewart if ((opt == SCTP_RTOINFO) || 266d6dda9b2SRandall Stewart (opt == SCTP_ASSOCINFO) || 267d6dda9b2SRandall Stewart (opt == SCTP_PRIMARY_ADDR) || 268d6dda9b2SRandall Stewart (opt == SCTP_SET_PEER_PRIMARY_ADDR) || 269d6dda9b2SRandall Stewart (opt == SCTP_PEER_ADDR_PARAMS) || 270d6dda9b2SRandall Stewart (opt == SCTP_STATUS) || 271d6dda9b2SRandall Stewart (opt == SCTP_GET_PEER_ADDR_INFO) || 272d6dda9b2SRandall Stewart (opt == SCTP_AUTH_ACTIVE_KEY) || 273d6dda9b2SRandall Stewart (opt == SCTP_PEER_AUTH_CHUNKS) || 274d6dda9b2SRandall Stewart (opt == SCTP_LOCAL_AUTH_CHUNKS)) { 275d6dda9b2SRandall Stewart *(sctp_assoc_t *) arg = id; 276d6dda9b2SRandall Stewart return (getsockopt(sd, IPPROTO_SCTP, opt, arg, size)); 277d6dda9b2SRandall Stewart } else { 278d6dda9b2SRandall Stewart errno = EOPNOTSUPP; 279d6dda9b2SRandall Stewart return (-1); 280d6dda9b2SRandall Stewart } 281d6dda9b2SRandall Stewart } 282d6dda9b2SRandall Stewart 283d6dda9b2SRandall Stewart int 284d6dda9b2SRandall Stewart sctp_getpaddrs(int sd, sctp_assoc_t id, struct sockaddr **raddrs) 285d6dda9b2SRandall Stewart { 286d6dda9b2SRandall Stewart struct sctp_getaddresses *addrs; 287d6dda9b2SRandall Stewart struct sockaddr *sa; 288d6dda9b2SRandall Stewart struct sockaddr *re; 289d6dda9b2SRandall Stewart sctp_assoc_t asoc; 290d6dda9b2SRandall Stewart caddr_t lim; 291066f54d8SCraig Rodrigues socklen_t siz; 292d6dda9b2SRandall Stewart int cnt; 293d6dda9b2SRandall Stewart 294d6dda9b2SRandall Stewart if (raddrs == NULL) { 295d6dda9b2SRandall Stewart errno = EFAULT; 296d6dda9b2SRandall Stewart return (-1); 297d6dda9b2SRandall Stewart } 298d6dda9b2SRandall Stewart asoc = id; 299d6dda9b2SRandall Stewart siz = sizeof(sctp_assoc_t); 300d6dda9b2SRandall Stewart if (getsockopt(sd, IPPROTO_SCTP, SCTP_GET_REMOTE_ADDR_SIZE, 301066f54d8SCraig Rodrigues &asoc, &siz) != 0) { 302d6dda9b2SRandall Stewart errno = ENOMEM; 303d6dda9b2SRandall Stewart return (-1); 304d6dda9b2SRandall Stewart } 305d6dda9b2SRandall Stewart /* size required is returned in 'asoc' */ 306d6dda9b2SRandall Stewart siz = (uint32_t) asoc; 307d6dda9b2SRandall Stewart siz += sizeof(struct sctp_getaddresses); 308d6dda9b2SRandall Stewart addrs = calloc((unsigned long)1, (unsigned long)siz); 309d6dda9b2SRandall Stewart if (addrs == NULL) { 310d6dda9b2SRandall Stewart errno = ENOMEM; 311d6dda9b2SRandall Stewart return (-1); 312d6dda9b2SRandall Stewart } 313d6dda9b2SRandall Stewart memset(addrs, 0, siz); 314d6dda9b2SRandall Stewart addrs->sget_assoc_id = id; 315d6dda9b2SRandall Stewart /* Now lets get the array of addresses */ 316d6dda9b2SRandall Stewart if (getsockopt(sd, IPPROTO_SCTP, SCTP_GET_PEER_ADDRESSES, 317d6dda9b2SRandall Stewart addrs, (socklen_t *) & siz) != 0) { 318d6dda9b2SRandall Stewart free(addrs); 319d6dda9b2SRandall Stewart errno = ENOMEM; 320d6dda9b2SRandall Stewart return (-1); 321d6dda9b2SRandall Stewart } 322d6dda9b2SRandall Stewart re = (struct sockaddr *)&addrs->addr[0]; 323d6dda9b2SRandall Stewart *raddrs = re; 324d6dda9b2SRandall Stewart cnt = 0; 325d6dda9b2SRandall Stewart sa = (struct sockaddr *)&addrs->addr[0]; 326d6dda9b2SRandall Stewart lim = (caddr_t)addrs + siz; 327d6dda9b2SRandall Stewart while (((caddr_t)sa < lim) && (sa->sa_len > 0)) { 328d6dda9b2SRandall Stewart sa = (struct sockaddr *)((caddr_t)sa + sa->sa_len); 329d6dda9b2SRandall Stewart cnt++; 330d6dda9b2SRandall Stewart } 331d6dda9b2SRandall Stewart return (cnt); 332d6dda9b2SRandall Stewart } 333d6dda9b2SRandall Stewart 334d6dda9b2SRandall Stewart void 335d6dda9b2SRandall Stewart sctp_freepaddrs(struct sockaddr *addrs) 336d6dda9b2SRandall Stewart { 337d6dda9b2SRandall Stewart /* Take away the hidden association id */ 338d6dda9b2SRandall Stewart void *fr_addr; 339d6dda9b2SRandall Stewart 340d6dda9b2SRandall Stewart fr_addr = (void *)((caddr_t)addrs - sizeof(sctp_assoc_t)); 341d6dda9b2SRandall Stewart /* Now free it */ 342d6dda9b2SRandall Stewart free(fr_addr); 343d6dda9b2SRandall Stewart } 344d6dda9b2SRandall Stewart 345d6dda9b2SRandall Stewart int 346d6dda9b2SRandall Stewart sctp_getladdrs(int sd, sctp_assoc_t id, struct sockaddr **raddrs) 347d6dda9b2SRandall Stewart { 348d6dda9b2SRandall Stewart struct sctp_getaddresses *addrs; 349d6dda9b2SRandall Stewart struct sockaddr *re; 350d6dda9b2SRandall Stewart caddr_t lim; 351d6dda9b2SRandall Stewart struct sockaddr *sa; 352d6dda9b2SRandall Stewart int size_of_addresses; 353066f54d8SCraig Rodrigues socklen_t siz; 354d6dda9b2SRandall Stewart int cnt; 355d6dda9b2SRandall Stewart 356d6dda9b2SRandall Stewart if (raddrs == NULL) { 357d6dda9b2SRandall Stewart errno = EFAULT; 358d6dda9b2SRandall Stewart return (-1); 359d6dda9b2SRandall Stewart } 360d6dda9b2SRandall Stewart size_of_addresses = 0; 361d6dda9b2SRandall Stewart siz = sizeof(int); 362d6dda9b2SRandall Stewart if (getsockopt(sd, IPPROTO_SCTP, SCTP_GET_LOCAL_ADDR_SIZE, 363066f54d8SCraig Rodrigues &size_of_addresses, &siz) != 0) { 364d6dda9b2SRandall Stewart errno = ENOMEM; 365d6dda9b2SRandall Stewart return (-1); 366d6dda9b2SRandall Stewart } 367d6dda9b2SRandall Stewart if (size_of_addresses == 0) { 368d6dda9b2SRandall Stewart errno = ENOTCONN; 369d6dda9b2SRandall Stewart return (-1); 370d6dda9b2SRandall Stewart } 371d6dda9b2SRandall Stewart siz = size_of_addresses + sizeof(struct sockaddr_storage); 372d6dda9b2SRandall Stewart siz += sizeof(struct sctp_getaddresses); 373d6dda9b2SRandall Stewart addrs = calloc((unsigned long)1, (unsigned long)siz); 374d6dda9b2SRandall Stewart if (addrs == NULL) { 375d6dda9b2SRandall Stewart errno = ENOMEM; 376d6dda9b2SRandall Stewart return (-1); 377d6dda9b2SRandall Stewart } 378d6dda9b2SRandall Stewart memset(addrs, 0, siz); 379d6dda9b2SRandall Stewart addrs->sget_assoc_id = id; 380d6dda9b2SRandall Stewart /* Now lets get the array of addresses */ 381d6dda9b2SRandall Stewart if (getsockopt(sd, IPPROTO_SCTP, SCTP_GET_LOCAL_ADDRESSES, addrs, 382d6dda9b2SRandall Stewart (socklen_t *) & siz) != 0) { 383d6dda9b2SRandall Stewart free(addrs); 384d6dda9b2SRandall Stewart errno = ENOMEM; 385d6dda9b2SRandall Stewart return (-1); 386d6dda9b2SRandall Stewart } 387d6dda9b2SRandall Stewart re = (struct sockaddr *)&addrs->addr[0]; 388d6dda9b2SRandall Stewart *raddrs = re; 389d6dda9b2SRandall Stewart cnt = 0; 390d6dda9b2SRandall Stewart sa = (struct sockaddr *)&addrs->addr[0]; 391d6dda9b2SRandall Stewart lim = (caddr_t)addrs + siz; 392d6dda9b2SRandall Stewart while (((caddr_t)sa < lim) && (sa->sa_len > 0)) { 393d6dda9b2SRandall Stewart sa = (struct sockaddr *)((caddr_t)sa + sa->sa_len); 394d6dda9b2SRandall Stewart cnt++; 395d6dda9b2SRandall Stewart } 396d6dda9b2SRandall Stewart return (cnt); 397d6dda9b2SRandall Stewart } 398d6dda9b2SRandall Stewart 399d6dda9b2SRandall Stewart void 400d6dda9b2SRandall Stewart sctp_freeladdrs(struct sockaddr *addrs) 401d6dda9b2SRandall Stewart { 402d6dda9b2SRandall Stewart /* Take away the hidden association id */ 403d6dda9b2SRandall Stewart void *fr_addr; 404d6dda9b2SRandall Stewart 405d6dda9b2SRandall Stewart fr_addr = (void *)((caddr_t)addrs - sizeof(sctp_assoc_t)); 406d6dda9b2SRandall Stewart /* Now free it */ 407d6dda9b2SRandall Stewart free(fr_addr); 408d6dda9b2SRandall Stewart } 409d6dda9b2SRandall Stewart 410d6dda9b2SRandall Stewart 411d6dda9b2SRandall Stewart ssize_t 412d6dda9b2SRandall Stewart sctp_sendmsg(int s, 413d6dda9b2SRandall Stewart const void *data, 414d6dda9b2SRandall Stewart size_t len, 415d6dda9b2SRandall Stewart const struct sockaddr *to, 416d6dda9b2SRandall Stewart socklen_t tolen __attribute__((unused)), 417d6dda9b2SRandall Stewart u_int32_t ppid, 418d6dda9b2SRandall Stewart u_int32_t flags, 419d6dda9b2SRandall Stewart u_int16_t stream_no, 420d6dda9b2SRandall Stewart u_int32_t timetolive, 421d6dda9b2SRandall Stewart u_int32_t context) 422d6dda9b2SRandall Stewart { 423d6dda9b2SRandall Stewart #ifdef SYS_sctp_generic_sendmsg 424d6dda9b2SRandall Stewart struct sctp_sndrcvinfo sinfo; 425d6dda9b2SRandall Stewart 426d6dda9b2SRandall Stewart sinfo.sinfo_ppid = ppid; 427d6dda9b2SRandall Stewart sinfo.sinfo_flags = flags; 428d6dda9b2SRandall Stewart sinfo.sinfo_stream = stream_no; 429d6dda9b2SRandall Stewart sinfo.sinfo_timetolive = timetolive; 430d6dda9b2SRandall Stewart sinfo.sinfo_context = context; 431d6dda9b2SRandall Stewart sinfo.sinfo_assoc_id = 0; 432d6dda9b2SRandall Stewart return (syscall(SYS_sctp_generic_sendmsg, s, 433d6dda9b2SRandall Stewart data, len, to, tolen, &sinfo, 0)); 434d6dda9b2SRandall Stewart #else 435d6dda9b2SRandall Stewart 436d6dda9b2SRandall Stewart ssize_t sz; 437d6dda9b2SRandall Stewart struct msghdr msg; 438d6dda9b2SRandall Stewart struct sctp_sndrcvinfo *s_info; 439d6dda9b2SRandall Stewart struct iovec iov[2]; 440d6dda9b2SRandall Stewart char controlVector[SCTP_CONTROL_VEC_SIZE_RCV]; 441d6dda9b2SRandall Stewart struct cmsghdr *cmsg; 442d6dda9b2SRandall Stewart struct sockaddr *who = NULL; 443d6dda9b2SRandall Stewart union { 444d6dda9b2SRandall Stewart struct sockaddr_in in; 445d6dda9b2SRandall Stewart struct sockaddr_in6 in6; 446d6dda9b2SRandall Stewart } addr; 447d6dda9b2SRandall Stewart 448d6dda9b2SRandall Stewart /* 449d6dda9b2SRandall Stewart fprintf(io, "sctp_sendmsg(sd:%d, data:%x, len:%d, to:%x, tolen:%d, ppid:%x, flags:%x str:%d ttl:%d ctx:%x\n", 450d6dda9b2SRandall Stewart s, 451d6dda9b2SRandall Stewart (u_int)data, 452d6dda9b2SRandall Stewart (int)len, 453d6dda9b2SRandall Stewart (u_int)to, 454d6dda9b2SRandall Stewart (int)tolen, 455d6dda9b2SRandall Stewart ppid, flags, 456d6dda9b2SRandall Stewart (int)stream_no, 457d6dda9b2SRandall Stewart (int)timetolive, 458d6dda9b2SRandall Stewart (u_int)context); 459d6dda9b2SRandall Stewart fflush(io); 460d6dda9b2SRandall Stewart */ 461d6dda9b2SRandall Stewart if (to) { 462d6dda9b2SRandall Stewart if (to->sa_len == 0) { 463d6dda9b2SRandall Stewart /* 464d6dda9b2SRandall Stewart * For the lazy app, that did not set sa_len, we 465d6dda9b2SRandall Stewart * attempt to set for them. 466d6dda9b2SRandall Stewart */ 467d6dda9b2SRandall Stewart if (to->sa_family == AF_INET) { 468d6dda9b2SRandall Stewart memcpy(&addr, to, sizeof(struct sockaddr_in)); 469d6dda9b2SRandall Stewart addr.in.sin_len = sizeof(struct sockaddr_in); 470d6dda9b2SRandall Stewart } else if (to->sa_family == AF_INET6) { 471d6dda9b2SRandall Stewart memcpy(&addr, to, sizeof(struct sockaddr_in6)); 472d6dda9b2SRandall Stewart addr.in6.sin6_len = sizeof(struct sockaddr_in6); 473d6dda9b2SRandall Stewart } 474d6dda9b2SRandall Stewart } else { 475d6dda9b2SRandall Stewart memcpy(&addr, to, to->sa_len); 476d6dda9b2SRandall Stewart } 477d6dda9b2SRandall Stewart who = (struct sockaddr *)&addr; 478d6dda9b2SRandall Stewart } 479d6dda9b2SRandall Stewart iov[0].iov_base = (char *)data; 480d6dda9b2SRandall Stewart iov[0].iov_len = len; 481d6dda9b2SRandall Stewart iov[1].iov_base = NULL; 482d6dda9b2SRandall Stewart iov[1].iov_len = 0; 483d6dda9b2SRandall Stewart 484d6dda9b2SRandall Stewart if (to) { 485d6dda9b2SRandall Stewart msg.msg_name = (caddr_t)who; 486d6dda9b2SRandall Stewart msg.msg_namelen = who->sa_len; 487d6dda9b2SRandall Stewart } else { 488d6dda9b2SRandall Stewart msg.msg_name = (caddr_t)NULL; 489d6dda9b2SRandall Stewart msg.msg_namelen = 0; 490d6dda9b2SRandall Stewart } 491d6dda9b2SRandall Stewart msg.msg_iov = iov; 492d6dda9b2SRandall Stewart msg.msg_iovlen = 1; 493d6dda9b2SRandall Stewart msg.msg_control = (caddr_t)controlVector; 494d6dda9b2SRandall Stewart 495d6dda9b2SRandall Stewart cmsg = (struct cmsghdr *)controlVector; 496d6dda9b2SRandall Stewart 497d6dda9b2SRandall Stewart cmsg->cmsg_level = IPPROTO_SCTP; 498d6dda9b2SRandall Stewart cmsg->cmsg_type = SCTP_SNDRCV; 499d6dda9b2SRandall Stewart cmsg->cmsg_len = CMSG_LEN(sizeof(struct sctp_sndrcvinfo)); 500d6dda9b2SRandall Stewart s_info = (struct sctp_sndrcvinfo *)CMSG_DATA(cmsg); 501d6dda9b2SRandall Stewart 502d6dda9b2SRandall Stewart s_info->sinfo_stream = stream_no; 503d6dda9b2SRandall Stewart s_info->sinfo_ssn = 0; 504d6dda9b2SRandall Stewart s_info->sinfo_flags = flags; 505d6dda9b2SRandall Stewart s_info->sinfo_ppid = ppid; 506d6dda9b2SRandall Stewart s_info->sinfo_context = context; 507d6dda9b2SRandall Stewart s_info->sinfo_assoc_id = 0; 508d6dda9b2SRandall Stewart s_info->sinfo_timetolive = timetolive; 509d6dda9b2SRandall Stewart errno = 0; 510d6dda9b2SRandall Stewart msg.msg_controllen = cmsg->cmsg_len; 511d6dda9b2SRandall Stewart sz = sendmsg(s, &msg, 0); 512d6dda9b2SRandall Stewart return (sz); 513d6dda9b2SRandall Stewart #endif 514d6dda9b2SRandall Stewart } 515d6dda9b2SRandall Stewart 516d6dda9b2SRandall Stewart 517d6dda9b2SRandall Stewart sctp_assoc_t 518d6dda9b2SRandall Stewart sctp_getassocid(int sd, struct sockaddr *sa) 519d6dda9b2SRandall Stewart { 520d6dda9b2SRandall Stewart struct sctp_paddrparams sp; 521066f54d8SCraig Rodrigues socklen_t siz; 522d6dda9b2SRandall Stewart 523d6dda9b2SRandall Stewart /* First get the assoc id */ 524d6dda9b2SRandall Stewart siz = sizeof(struct sctp_paddrparams); 525d6dda9b2SRandall Stewart memset(&sp, 0, sizeof(sp)); 526d6dda9b2SRandall Stewart memcpy((caddr_t)&sp.spp_address, sa, sa->sa_len); 527d6dda9b2SRandall Stewart errno = 0; 528d6dda9b2SRandall Stewart if (getsockopt(sd, IPPROTO_SCTP, 529066f54d8SCraig Rodrigues SCTP_PEER_ADDR_PARAMS, &sp, &siz) != 0) { 530d6dda9b2SRandall Stewart return ((sctp_assoc_t) 0); 531d6dda9b2SRandall Stewart } 532d6dda9b2SRandall Stewart /* We depend on the fact that 0 can never be returned */ 533d6dda9b2SRandall Stewart return (sp.spp_assoc_id); 534d6dda9b2SRandall Stewart } 535d6dda9b2SRandall Stewart 536d6dda9b2SRandall Stewart ssize_t 537d6dda9b2SRandall Stewart sctp_send(int sd, const void *data, size_t len, 538d6dda9b2SRandall Stewart const struct sctp_sndrcvinfo *sinfo, 539d6dda9b2SRandall Stewart int flags) 540d6dda9b2SRandall Stewart { 541d6dda9b2SRandall Stewart 542d6dda9b2SRandall Stewart #ifdef SYS_sctp_generic_sendmsg 543d6dda9b2SRandall Stewart struct sockaddr *to = NULL; 544d6dda9b2SRandall Stewart 545d6dda9b2SRandall Stewart return (syscall(SYS_sctp_generic_sendmsg, sd, 546d6dda9b2SRandall Stewart data, len, to, 0, sinfo, flags)); 547d6dda9b2SRandall Stewart #else 548d6dda9b2SRandall Stewart ssize_t sz; 549d6dda9b2SRandall Stewart struct msghdr msg; 550d6dda9b2SRandall Stewart struct iovec iov[2]; 551d6dda9b2SRandall Stewart struct sctp_sndrcvinfo *s_info; 552d6dda9b2SRandall Stewart char controlVector[SCTP_CONTROL_VEC_SIZE_SND]; 553d6dda9b2SRandall Stewart struct cmsghdr *cmsg; 554d6dda9b2SRandall Stewart 555d6dda9b2SRandall Stewart if (sinfo == NULL) { 556d6dda9b2SRandall Stewart return (EINVAL); 557d6dda9b2SRandall Stewart } 558d6dda9b2SRandall Stewart iov[0].iov_base = (char *)data; 559d6dda9b2SRandall Stewart iov[0].iov_len = len; 560d6dda9b2SRandall Stewart iov[1].iov_base = NULL; 561d6dda9b2SRandall Stewart iov[1].iov_len = 0; 562d6dda9b2SRandall Stewart 563d6dda9b2SRandall Stewart msg.msg_name = 0; 564d6dda9b2SRandall Stewart msg.msg_namelen = 0; 565d6dda9b2SRandall Stewart msg.msg_iov = iov; 566d6dda9b2SRandall Stewart msg.msg_iovlen = 1; 567d6dda9b2SRandall Stewart msg.msg_control = (caddr_t)controlVector; 568d6dda9b2SRandall Stewart 569d6dda9b2SRandall Stewart cmsg = (struct cmsghdr *)controlVector; 570d6dda9b2SRandall Stewart 571d6dda9b2SRandall Stewart cmsg->cmsg_level = IPPROTO_SCTP; 572d6dda9b2SRandall Stewart cmsg->cmsg_type = SCTP_SNDRCV; 573d6dda9b2SRandall Stewart cmsg->cmsg_len = CMSG_LEN(sizeof(struct sctp_sndrcvinfo)); 574d6dda9b2SRandall Stewart s_info = (struct sctp_sndrcvinfo *)CMSG_DATA(cmsg); 575d6dda9b2SRandall Stewart /* copy in the data */ 576d6dda9b2SRandall Stewart *s_info = *sinfo; 577d6dda9b2SRandall Stewart errno = 0; 578d6dda9b2SRandall Stewart msg.msg_controllen = cmsg->cmsg_len; 579d6dda9b2SRandall Stewart sz = sendmsg(sd, &msg, flags); 580d6dda9b2SRandall Stewart return (sz); 581d6dda9b2SRandall Stewart #endif 582d6dda9b2SRandall Stewart } 583d6dda9b2SRandall Stewart 584d6dda9b2SRandall Stewart 585d6dda9b2SRandall Stewart 586d6dda9b2SRandall Stewart ssize_t 587d6dda9b2SRandall Stewart sctp_sendx(int sd, const void *msg, size_t msg_len, 588d6dda9b2SRandall Stewart struct sockaddr *addrs, int addrcnt, 589d6dda9b2SRandall Stewart struct sctp_sndrcvinfo *sinfo, 590d6dda9b2SRandall Stewart int flags) 591d6dda9b2SRandall Stewart { 592d6dda9b2SRandall Stewart ssize_t ret; 593d6dda9b2SRandall Stewart int i, cnt, *aa, saved_errno; 594d6dda9b2SRandall Stewart char *buf; 595d6dda9b2SRandall Stewart int add_len, len, no_end_cx = 0; 596d6dda9b2SRandall Stewart struct sockaddr *at; 597d6dda9b2SRandall Stewart 598d6dda9b2SRandall Stewart len = sizeof(int); 599d6dda9b2SRandall Stewart at = addrs; 600d6dda9b2SRandall Stewart cnt = 0; 601d6dda9b2SRandall Stewart /* validate all the addresses and get the size */ 602d6dda9b2SRandall Stewart for (i = 0; i < addrcnt; i++) { 603d6dda9b2SRandall Stewart if (at->sa_family == AF_INET) { 604d6dda9b2SRandall Stewart add_len = sizeof(struct sockaddr_in); 605d6dda9b2SRandall Stewart } else if (at->sa_family == AF_INET6) { 606d6dda9b2SRandall Stewart add_len = sizeof(struct sockaddr_in6); 607d6dda9b2SRandall Stewart } else { 608d6dda9b2SRandall Stewart errno = EINVAL; 609d6dda9b2SRandall Stewart return (-1); 610d6dda9b2SRandall Stewart } 611d6dda9b2SRandall Stewart len += add_len; 612d6dda9b2SRandall Stewart at = (struct sockaddr *)((caddr_t)at + add_len); 613d6dda9b2SRandall Stewart cnt++; 614d6dda9b2SRandall Stewart } 615d6dda9b2SRandall Stewart /* do we have any? */ 616d6dda9b2SRandall Stewart if (cnt == 0) { 617d6dda9b2SRandall Stewart errno = EINVAL; 618d6dda9b2SRandall Stewart return (-1); 619d6dda9b2SRandall Stewart } 620d6dda9b2SRandall Stewart if (len > 2048) { 621d6dda9b2SRandall Stewart /* Never enough memory */ 622d6dda9b2SRandall Stewart return (E2BIG); 623d6dda9b2SRandall Stewart } 624d6dda9b2SRandall Stewart buf = malloc(len); 625d6dda9b2SRandall Stewart if (buf == NULL) { 626d6dda9b2SRandall Stewart return (ENOMEM); 627d6dda9b2SRandall Stewart } 628d6dda9b2SRandall Stewart aa = (int *)buf; 629d6dda9b2SRandall Stewart *aa = cnt; 630d6dda9b2SRandall Stewart aa++; 631d6dda9b2SRandall Stewart memcpy((caddr_t)aa, addrs, (len - sizeof(int))); 632d6dda9b2SRandall Stewart ret = setsockopt(sd, IPPROTO_SCTP, SCTP_CONNECT_X_DELAYED, (void *)buf, 633d6dda9b2SRandall Stewart (socklen_t) len); 634d6dda9b2SRandall Stewart 635d6dda9b2SRandall Stewart free(buf); 636d6dda9b2SRandall Stewart if (ret != 0) { 637d6dda9b2SRandall Stewart if (errno == EALREADY) { 638d6dda9b2SRandall Stewart no_end_cx = 1;; 639d6dda9b2SRandall Stewart goto continue_send; 640d6dda9b2SRandall Stewart } 641d6dda9b2SRandall Stewart return (ret); 642d6dda9b2SRandall Stewart } 643d6dda9b2SRandall Stewart continue_send: 644d6dda9b2SRandall Stewart sinfo->sinfo_assoc_id = sctp_getassocid(sd, addrs); 645d6dda9b2SRandall Stewart if (sinfo->sinfo_assoc_id == 0) { 646d6dda9b2SRandall Stewart printf("Huh, can't get associd? TSNH!\n"); 647d6dda9b2SRandall Stewart (void)setsockopt(sd, IPPROTO_SCTP, SCTP_CONNECT_X_COMPLETE, (void *)addrs, 648d6dda9b2SRandall Stewart (socklen_t) addrs->sa_len); 649d6dda9b2SRandall Stewart errno = ENOENT; 650d6dda9b2SRandall Stewart return (-1); 651d6dda9b2SRandall Stewart } 652d6dda9b2SRandall Stewart ret = sctp_send(sd, msg, msg_len, sinfo, flags); 653d6dda9b2SRandall Stewart saved_errno = errno; 654d6dda9b2SRandall Stewart if (no_end_cx == 0) 655d6dda9b2SRandall Stewart (void)setsockopt(sd, IPPROTO_SCTP, SCTP_CONNECT_X_COMPLETE, (void *)addrs, 656d6dda9b2SRandall Stewart (socklen_t) addrs->sa_len); 657d6dda9b2SRandall Stewart 658d6dda9b2SRandall Stewart errno = saved_errno; 659d6dda9b2SRandall Stewart return (ret); 660d6dda9b2SRandall Stewart } 661d6dda9b2SRandall Stewart 662d6dda9b2SRandall Stewart ssize_t 663d6dda9b2SRandall Stewart sctp_sendmsgx(int sd, 664d6dda9b2SRandall Stewart const void *msg, 665d6dda9b2SRandall Stewart size_t len, 666d6dda9b2SRandall Stewart struct sockaddr *addrs, 667d6dda9b2SRandall Stewart int addrcnt, 668d6dda9b2SRandall Stewart u_int32_t ppid, 669d6dda9b2SRandall Stewart u_int32_t flags, 670d6dda9b2SRandall Stewart u_int16_t stream_no, 671d6dda9b2SRandall Stewart u_int32_t timetolive, 672d6dda9b2SRandall Stewart u_int32_t context) 673d6dda9b2SRandall Stewart { 674d6dda9b2SRandall Stewart struct sctp_sndrcvinfo sinfo; 675d6dda9b2SRandall Stewart 676d6dda9b2SRandall Stewart memset((void *)&sinfo, 0, sizeof(struct sctp_sndrcvinfo)); 677d6dda9b2SRandall Stewart sinfo.sinfo_ppid = ppid; 678d6dda9b2SRandall Stewart sinfo.sinfo_flags = flags; 679d6dda9b2SRandall Stewart sinfo.sinfo_ssn = stream_no; 680d6dda9b2SRandall Stewart sinfo.sinfo_timetolive = timetolive; 681d6dda9b2SRandall Stewart sinfo.sinfo_context = context; 682d6dda9b2SRandall Stewart return sctp_sendx(sd, msg, len, addrs, addrcnt, &sinfo, 0); 683d6dda9b2SRandall Stewart } 684d6dda9b2SRandall Stewart 685d6dda9b2SRandall Stewart ssize_t 686d6dda9b2SRandall Stewart sctp_recvmsg(int s, 687d6dda9b2SRandall Stewart void *dbuf, 688d6dda9b2SRandall Stewart size_t len, 689d6dda9b2SRandall Stewart struct sockaddr *from, 690d6dda9b2SRandall Stewart socklen_t * fromlen, 691d6dda9b2SRandall Stewart struct sctp_sndrcvinfo *sinfo, 692d6dda9b2SRandall Stewart int *msg_flags) 693d6dda9b2SRandall Stewart { 694d6dda9b2SRandall Stewart 695d6dda9b2SRandall Stewart #ifdef SYS_sctp_generic_recvmsg 696d6dda9b2SRandall Stewart struct iovec iov[2]; 697d6dda9b2SRandall Stewart 698d6dda9b2SRandall Stewart iov[0].iov_base = dbuf; 699d6dda9b2SRandall Stewart iov[0].iov_len = len; 700d6dda9b2SRandall Stewart return (syscall(SYS_sctp_generic_recvmsg, s, 701d6dda9b2SRandall Stewart iov, 1, from, fromlen, sinfo, msg_flags)); 702d6dda9b2SRandall Stewart #else 703d6dda9b2SRandall Stewart struct sctp_sndrcvinfo *s_info; 704d6dda9b2SRandall Stewart ssize_t sz; 705d6dda9b2SRandall Stewart int sinfo_found = 0; 706d6dda9b2SRandall Stewart struct msghdr msg; 707d6dda9b2SRandall Stewart struct iovec iov[2]; 708d6dda9b2SRandall Stewart char controlVector[SCTP_CONTROL_VEC_SIZE_RCV]; 709d6dda9b2SRandall Stewart struct cmsghdr *cmsg; 710d6dda9b2SRandall Stewart 711d6dda9b2SRandall Stewart if (msg_flags == NULL) { 712d6dda9b2SRandall Stewart errno = EINVAL; 713d6dda9b2SRandall Stewart return (-1); 714d6dda9b2SRandall Stewart } 715d6dda9b2SRandall Stewart msg.msg_flags = 0; 716d6dda9b2SRandall Stewart iov[0].iov_base = dbuf; 717d6dda9b2SRandall Stewart iov[0].iov_len = len; 718d6dda9b2SRandall Stewart iov[1].iov_base = NULL; 719d6dda9b2SRandall Stewart iov[1].iov_len = 0; 720d6dda9b2SRandall Stewart msg.msg_name = (caddr_t)from; 721d6dda9b2SRandall Stewart if (fromlen == NULL) 722d6dda9b2SRandall Stewart msg.msg_namelen = 0; 723d6dda9b2SRandall Stewart else 724d6dda9b2SRandall Stewart msg.msg_namelen = *fromlen; 725d6dda9b2SRandall Stewart msg.msg_iov = iov; 726d6dda9b2SRandall Stewart msg.msg_iovlen = 1; 727d6dda9b2SRandall Stewart msg.msg_control = (caddr_t)controlVector; 728d6dda9b2SRandall Stewart msg.msg_controllen = sizeof(controlVector); 729d6dda9b2SRandall Stewart errno = 0; 730d6dda9b2SRandall Stewart sz = recvmsg(s, &msg, 0); 731d6dda9b2SRandall Stewart if (sz <= 0) 732d6dda9b2SRandall Stewart return (sz); 733d6dda9b2SRandall Stewart 734d6dda9b2SRandall Stewart s_info = NULL; 735d6dda9b2SRandall Stewart len = sz; 736d6dda9b2SRandall Stewart *msg_flags = msg.msg_flags; 737d6dda9b2SRandall Stewart if (sinfo) 738d6dda9b2SRandall Stewart sinfo->sinfo_assoc_id = 0; 739d6dda9b2SRandall Stewart 740d6dda9b2SRandall Stewart if ((msg.msg_controllen) && sinfo) { 741d6dda9b2SRandall Stewart /* 742d6dda9b2SRandall Stewart * parse through and see if we find the sctp_sndrcvinfo (if 743d6dda9b2SRandall Stewart * the user wants it). 744d6dda9b2SRandall Stewart */ 745d6dda9b2SRandall Stewart cmsg = (struct cmsghdr *)controlVector; 746d6dda9b2SRandall Stewart while (cmsg) { 747d6dda9b2SRandall Stewart if ((cmsg->cmsg_len == 0) || (cmsg->cmsg_len > msg.msg_controllen)) { 748d6dda9b2SRandall Stewart break; 749d6dda9b2SRandall Stewart } 750d6dda9b2SRandall Stewart if (cmsg->cmsg_level == IPPROTO_SCTP) { 751d6dda9b2SRandall Stewart if (cmsg->cmsg_type == SCTP_SNDRCV) { 752d6dda9b2SRandall Stewart /* Got it */ 753d6dda9b2SRandall Stewart s_info = (struct sctp_sndrcvinfo *)CMSG_DATA(cmsg); 754d6dda9b2SRandall Stewart /* Copy it to the user */ 755d6dda9b2SRandall Stewart if (sinfo) 756d6dda9b2SRandall Stewart *sinfo = *s_info; 757d6dda9b2SRandall Stewart sinfo_found = 1; 758d6dda9b2SRandall Stewart break; 759d6dda9b2SRandall Stewart } else if (cmsg->cmsg_type == SCTP_EXTRCV) { 760d6dda9b2SRandall Stewart /* 761d6dda9b2SRandall Stewart * Got it, presumably the user has 762d6dda9b2SRandall Stewart * asked for this extra info, so the 763d6dda9b2SRandall Stewart * structure holds more room :-D 764d6dda9b2SRandall Stewart */ 765d6dda9b2SRandall Stewart s_info = (struct sctp_sndrcvinfo *)CMSG_DATA(cmsg); 766d6dda9b2SRandall Stewart /* Copy it to the user */ 767d6dda9b2SRandall Stewart if (sinfo) { 768d6dda9b2SRandall Stewart memcpy(sinfo, s_info, sizeof(struct sctp_extrcvinfo)); 769d6dda9b2SRandall Stewart } 770d6dda9b2SRandall Stewart sinfo_found = 1; 771d6dda9b2SRandall Stewart break; 772d6dda9b2SRandall Stewart 773d6dda9b2SRandall Stewart } 774d6dda9b2SRandall Stewart } 775d6dda9b2SRandall Stewart cmsg = CMSG_NXTHDR(&msg, cmsg); 776d6dda9b2SRandall Stewart } 777d6dda9b2SRandall Stewart } 778d6dda9b2SRandall Stewart return (sz); 779d6dda9b2SRandall Stewart #endif 780d6dda9b2SRandall Stewart } 781d6dda9b2SRandall Stewart 782d6dda9b2SRandall Stewart 783d6dda9b2SRandall Stewart #if defined(HAVE_SCTP_PEELOFF_SOCKOPT) 784d6dda9b2SRandall Stewart #include <netinet/sctp_peeloff.h> 785d6dda9b2SRandall Stewart 786d6dda9b2SRandall Stewart int 787d6dda9b2SRandall Stewart sctp_peeloff(int sd, sctp_assoc_t assoc_id) 788d6dda9b2SRandall Stewart { 789d6dda9b2SRandall Stewart struct sctp_peeloff_opt peeloff; 790d6dda9b2SRandall Stewart int error; 791d6dda9b2SRandall Stewart socklen_t optlen; 792d6dda9b2SRandall Stewart 793d6dda9b2SRandall Stewart /* set in the socket option params */ 794d6dda9b2SRandall Stewart memset(&peeloff, 0, sizeof(peeloff)); 795d6dda9b2SRandall Stewart peeloff.s = sd; 796d6dda9b2SRandall Stewart peeloff.assoc_id = assoc_id; 797d6dda9b2SRandall Stewart optlen = sizeof(peeloff); 798d6dda9b2SRandall Stewart error = getsockopt(sd, IPPROTO_SCTP, SCTP_PEELOFF, (void *)&peeloff, 799d6dda9b2SRandall Stewart &optlen); 800d6dda9b2SRandall Stewart if (error) { 801d6dda9b2SRandall Stewart errno = error; 802d6dda9b2SRandall Stewart return (-1); 803d6dda9b2SRandall Stewart } else { 804d6dda9b2SRandall Stewart return (peeloff.new_sd); 805d6dda9b2SRandall Stewart } 806d6dda9b2SRandall Stewart } 807d6dda9b2SRandall Stewart 808d6dda9b2SRandall Stewart #endif 809d6dda9b2SRandall Stewart 810d6dda9b2SRandall Stewart #if !defined(SYS_sctp_peeloff) && !defined(HAVE_SCTP_PEELOFF_SOCKOPT) 811d6dda9b2SRandall Stewart 812d6dda9b2SRandall Stewart int 813d6dda9b2SRandall Stewart sctp_peeloff(int sd, sctp_assoc_t assoc_id) 814d6dda9b2SRandall Stewart { 815d6dda9b2SRandall Stewart /* NOT supported, return invalid sd */ 816d6dda9b2SRandall Stewart errno = ENOTSUP; 817d6dda9b2SRandall Stewart return (-1); 818d6dda9b2SRandall Stewart } 819d6dda9b2SRandall Stewart 820d6dda9b2SRandall Stewart #endif 821d6dda9b2SRandall Stewart #if defined(SYS_sctp_peeloff) && !defined(HAVE_SCTP_PEELOFF_SOCKOPT) 822d6dda9b2SRandall Stewart int 823d6dda9b2SRandall Stewart sctp_peeloff(int sd, sctp_assoc_t assoc_id) 824d6dda9b2SRandall Stewart { 825d6dda9b2SRandall Stewart return (syscall(SYS_sctp_peeloff, sd, assoc_id)); 826d6dda9b2SRandall Stewart } 827d6dda9b2SRandall Stewart 828d6dda9b2SRandall Stewart #endif 829