50cec91936
This also moves two 16 bit int's to become 32 bit values so we do not have to use atomic_add_16. Most of the changes are %p, casts and other various nasty's that were in the orignal code base. With this commit my machine will now do a build universe.. however I as yet have not tested on a 64bit machine .. it may not work :-(
1373 lines
33 KiB
C
1373 lines
33 KiB
C
/*-
|
|
* Copyright (c) 2001-2006, Cisco Systems, Inc. All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions are met:
|
|
*
|
|
* a) Redistributions of source code must retain the above copyright notice,
|
|
* this list of conditions and the following disclaimer.
|
|
*
|
|
* b) Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in
|
|
* the documentation and/or other materials provided with the distribution.
|
|
*
|
|
* c) Neither the name of Cisco Systems, Inc. nor the names of its
|
|
* contributors may be used to endorse or promote products derived
|
|
* from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
|
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
|
|
* THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
|
|
* LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
|
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
|
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
|
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
|
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
|
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
|
|
* THE POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
/* $KAME: sctp6_usrreq.c,v 1.38 2005/08/24 08:08:56 suz Exp $ */
|
|
#include <sys/cdefs.h>
|
|
__FBSDID("$FreeBSD$");
|
|
#include "opt_inet.h"
|
|
#include "opt_inet6.h"
|
|
#include "opt_inet.h"
|
|
#include "opt_ipsec.h"
|
|
#include "opt_sctp.h"
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/mbuf.h>
|
|
#include <sys/domain.h>
|
|
#include <sys/protosw.h>
|
|
#include <sys/socket.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/socketvar.h>
|
|
#include <sys/sysctl.h>
|
|
#include <sys/errno.h>
|
|
#include <sys/stat.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/syslog.h>
|
|
#include <sys/proc.h>
|
|
#include <net/if.h>
|
|
#include <net/route.h>
|
|
#include <net/if_types.h>
|
|
#include <netinet/in.h>
|
|
#include <netinet/in_systm.h>
|
|
#include <netinet/ip.h>
|
|
#include <netinet/in_pcb.h>
|
|
#include <netinet/in_var.h>
|
|
#include <netinet/ip_var.h>
|
|
#include <netinet/sctp_os.h>
|
|
#include <netinet/sctp_pcb.h>
|
|
#include <netinet/sctp_header.h>
|
|
#include <netinet/sctp_var.h>
|
|
#include <netinet/sctputil.h>
|
|
#include <netinet/sctp_output.h>
|
|
#include <netinet/sctp_bsd_addr.h>
|
|
#include <netinet/sctp_input.h>
|
|
#include <netinet/sctp_asconf.h>
|
|
#include <netinet6/ip6_var.h>
|
|
#include <netinet6/scope6_var.h>
|
|
#include <netinet/sctp_bsd_addr.h>
|
|
#include <netinet/ip6.h>
|
|
#include <netinet6/in6_pcb.h>
|
|
#include <netinet/icmp6.h>
|
|
#include <netinet6/sctp6_var.h>
|
|
#include <netinet6/ip6protosw.h>
|
|
#include <netinet6/nd6.h>
|
|
|
|
#ifdef IPSEC
|
|
#include <netinet6/ipsec.h>
|
|
#include <netinet6/ipsec6.h>
|
|
#endif /* IPSEC */
|
|
|
|
#if defined(NFAITH) && NFAITH > 0
|
|
#include <net/if_faith.h>
|
|
#endif
|
|
|
|
|
|
|
|
extern struct protosw inetsw[];
|
|
|
|
|
|
#ifndef in6pcb
|
|
#define in6pcb inpcb
|
|
#endif
|
|
#ifndef sotoin6pcb
|
|
#define sotoin6pcb sotoinpcb
|
|
#endif
|
|
|
|
|
|
#ifdef SCTP_DEBUG
|
|
extern u_int32_t sctp_debug_on;
|
|
|
|
#endif
|
|
|
|
|
|
|
|
extern int sctp_no_csum_on_loopback;
|
|
|
|
int
|
|
sctp6_input(mp, offp, proto)
|
|
struct mbuf **mp;
|
|
int *offp;
|
|
|
|
int proto;
|
|
|
|
{
|
|
struct mbuf *m = *mp;
|
|
struct ip6_hdr *ip6;
|
|
struct sctphdr *sh;
|
|
struct sctp_inpcb *in6p = NULL;
|
|
struct sctp_nets *net;
|
|
int refcount_up = 0;
|
|
u_int32_t check, calc_check;
|
|
struct inpcb *in6p_ip;
|
|
struct sctp_chunkhdr *ch;
|
|
int length, mlen, offset, iphlen;
|
|
u_int8_t ecn_bits;
|
|
struct sctp_tcb *stcb = NULL;
|
|
int off = *offp;
|
|
int s;
|
|
|
|
ip6 = mtod(m, struct ip6_hdr *);
|
|
#ifndef PULLDOWN_TEST
|
|
/* If PULLDOWN_TEST off, must be in a single mbuf. */
|
|
IP6_EXTHDR_CHECK(m, off, (int)(sizeof(*sh) + sizeof(*ch)), IPPROTO_DONE);
|
|
sh = (struct sctphdr *)((caddr_t)ip6 + off);
|
|
ch = (struct sctp_chunkhdr *)((caddr_t)sh + sizeof(*sh));
|
|
#else
|
|
/* Ensure that (sctphdr + sctp_chunkhdr) in a row. */
|
|
IP6_EXTHDR_GET(sh, struct sctphdr *, m, off, sizeof(*sh) + sizeof(*ch));
|
|
if (sh == NULL) {
|
|
SCTP_STAT_INCR(sctps_hdrops);
|
|
return IPPROTO_DONE;
|
|
}
|
|
ch = (struct sctp_chunkhdr *)((caddr_t)sh + sizeof(struct sctphdr));
|
|
#endif
|
|
|
|
iphlen = off;
|
|
offset = iphlen + sizeof(*sh) + sizeof(*ch);
|
|
|
|
#if defined(NFAITH) && NFAITH > 0
|
|
|
|
if (faithprefix_p != NULL && (*faithprefix_p) (&ip6->ip6_dst)) {
|
|
/* XXX send icmp6 host/port unreach? */
|
|
goto bad;
|
|
}
|
|
#endif /* NFAITH defined and > 0 */
|
|
SCTP_STAT_INCR(sctps_recvpackets);
|
|
SCTP_STAT_INCR_COUNTER64(sctps_inpackets);
|
|
#ifdef SCTP_DEBUG
|
|
if (sctp_debug_on & SCTP_DEBUG_INPUT1) {
|
|
printf("V6 input gets a packet iphlen:%d pktlen:%d\n", iphlen, m->m_pkthdr.len);
|
|
}
|
|
#endif
|
|
if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst)) {
|
|
/* No multi-cast support in SCTP */
|
|
goto bad;
|
|
}
|
|
/* destination port of 0 is illegal, based on RFC2960. */
|
|
if (sh->dest_port == 0)
|
|
goto bad;
|
|
if ((sctp_no_csum_on_loopback == 0) ||
|
|
(m->m_pkthdr.rcvif == NULL) ||
|
|
(m->m_pkthdr.rcvif->if_type != IFT_LOOP)) {
|
|
/*
|
|
* we do NOT validate things from the loopback if the sysctl
|
|
* is set to 1.
|
|
*/
|
|
check = sh->checksum; /* save incoming checksum */
|
|
if ((check == 0) && (sctp_no_csum_on_loopback)) {
|
|
/*
|
|
* special hook for where we got a local address
|
|
* somehow routed across a non IFT_LOOP type
|
|
* interface
|
|
*/
|
|
if (IN6_ARE_ADDR_EQUAL(&ip6->ip6_src, &ip6->ip6_dst))
|
|
goto sctp_skip_csum;
|
|
}
|
|
sh->checksum = 0; /* prepare for calc */
|
|
calc_check = sctp_calculate_sum(m, &mlen, iphlen);
|
|
if (calc_check != check) {
|
|
#ifdef SCTP_DEBUG
|
|
if (sctp_debug_on & SCTP_DEBUG_INPUT1) {
|
|
printf("Bad CSUM on SCTP packet calc_check:%x check:%x m:%p mlen:%d iphlen:%d\n",
|
|
calc_check, check, m,
|
|
mlen, iphlen);
|
|
}
|
|
#endif
|
|
stcb = sctp_findassociation_addr(m, iphlen, offset - sizeof(*ch),
|
|
sh, ch, &in6p, &net);
|
|
/* in6p's ref-count increased && stcb locked */
|
|
if ((in6p) && (stcb)) {
|
|
sctp_send_packet_dropped(stcb, net, m, iphlen, 1);
|
|
sctp_chunk_output((struct sctp_inpcb *)in6p, stcb, 2);
|
|
} else if ((in6p != NULL) && (stcb == NULL)) {
|
|
refcount_up = 1;
|
|
}
|
|
SCTP_STAT_INCR(sctps_badsum);
|
|
SCTP_STAT_INCR_COUNTER32(sctps_checksumerrors);
|
|
goto bad;
|
|
}
|
|
sh->checksum = calc_check;
|
|
} else {
|
|
sctp_skip_csum:
|
|
mlen = m->m_pkthdr.len;
|
|
}
|
|
net = NULL;
|
|
/*
|
|
* Locate pcb and tcb for datagram sctp_findassociation_addr() wants
|
|
* IP/SCTP/first chunk header...
|
|
*/
|
|
stcb = sctp_findassociation_addr(m, iphlen, offset - sizeof(*ch),
|
|
sh, ch, &in6p, &net);
|
|
/* in6p's ref-count increased */
|
|
if (in6p == NULL) {
|
|
struct sctp_init_chunk *init_chk, chunk_buf;
|
|
|
|
SCTP_STAT_INCR(sctps_noport);
|
|
if (ch->chunk_type == SCTP_INITIATION) {
|
|
/*
|
|
* we do a trick here to get the INIT tag, dig in
|
|
* and get the tag from the INIT and put it in the
|
|
* common header.
|
|
*/
|
|
init_chk = (struct sctp_init_chunk *)sctp_m_getptr(m,
|
|
iphlen + sizeof(*sh), sizeof(*init_chk),
|
|
(u_int8_t *) & chunk_buf);
|
|
sh->v_tag = init_chk->init.initiate_tag;
|
|
}
|
|
sctp_send_abort(m, iphlen, sh, 0, NULL);
|
|
goto bad;
|
|
} else if (stcb == NULL) {
|
|
refcount_up = 1;
|
|
}
|
|
in6p_ip = (struct inpcb *)in6p;
|
|
#ifdef IPSEC
|
|
/*
|
|
* Check AH/ESP integrity.
|
|
*/
|
|
if (in6p_ip && (ipsec6_in_reject(m, in6p_ip))) {
|
|
/* XXX */
|
|
ipsec6stat.in_polvio++;
|
|
goto bad;
|
|
}
|
|
#endif /* IPSEC */
|
|
|
|
|
|
/*
|
|
* CONTROL chunk processing
|
|
*/
|
|
length = ntohs(ip6->ip6_plen) + iphlen;
|
|
offset -= sizeof(*ch);
|
|
ecn_bits = ((ntohl(ip6->ip6_flow) >> 20) & 0x000000ff);
|
|
s = splnet();
|
|
(void)sctp_common_input_processing(&m, iphlen, offset, length, sh, ch,
|
|
in6p, stcb, net, ecn_bits);
|
|
/* inp's ref-count reduced && stcb unlocked */
|
|
splx(s);
|
|
/* XXX this stuff below gets moved to appropriate parts later... */
|
|
if (m)
|
|
m_freem(m);
|
|
if ((in6p) && refcount_up) {
|
|
/* reduce ref-count */
|
|
SCTP_INP_WLOCK(in6p);
|
|
SCTP_INP_DECR_REF(in6p);
|
|
SCTP_INP_WUNLOCK(in6p);
|
|
}
|
|
return IPPROTO_DONE;
|
|
|
|
bad:
|
|
if (stcb)
|
|
SCTP_TCB_UNLOCK(stcb);
|
|
|
|
if ((in6p) && refcount_up) {
|
|
/* reduce ref-count */
|
|
SCTP_INP_WLOCK(in6p);
|
|
SCTP_INP_DECR_REF(in6p);
|
|
SCTP_INP_WUNLOCK(in6p);
|
|
}
|
|
if (m)
|
|
m_freem(m);
|
|
return IPPROTO_DONE;
|
|
}
|
|
|
|
|
|
static void
|
|
sctp6_notify_mbuf(struct sctp_inpcb *inp,
|
|
struct icmp6_hdr *icmp6,
|
|
struct sctphdr *sh,
|
|
struct sctp_tcb *stcb,
|
|
struct sctp_nets *net)
|
|
{
|
|
u_int32_t nxtsz;
|
|
|
|
if ((inp == NULL) || (stcb == NULL) || (net == NULL) ||
|
|
(icmp6 == NULL) || (sh == NULL)) {
|
|
goto out;
|
|
}
|
|
/* First do we even look at it? */
|
|
if (ntohl(sh->v_tag) != (stcb->asoc.peer_vtag))
|
|
goto out;
|
|
|
|
if (icmp6->icmp6_type != ICMP6_PACKET_TOO_BIG) {
|
|
/* not PACKET TO BIG */
|
|
goto out;
|
|
}
|
|
/*
|
|
* ok we need to look closely. We could even get smarter and look at
|
|
* anyone that we sent to in case we get a different ICMP that tells
|
|
* us there is no way to reach a host, but for this impl, all we
|
|
* care about is MTU discovery.
|
|
*/
|
|
nxtsz = ntohl(icmp6->icmp6_mtu);
|
|
/* Stop any PMTU timer */
|
|
sctp_timer_stop(SCTP_TIMER_TYPE_PATHMTURAISE, inp, stcb, NULL);
|
|
|
|
/* Adjust destination size limit */
|
|
if (net->mtu > nxtsz) {
|
|
net->mtu = nxtsz;
|
|
}
|
|
/* now what about the ep? */
|
|
if (stcb->asoc.smallest_mtu > nxtsz) {
|
|
struct sctp_tmit_chunk *chk;
|
|
|
|
/* Adjust that too */
|
|
stcb->asoc.smallest_mtu = nxtsz;
|
|
/* now off to subtract IP_DF flag if needed */
|
|
|
|
TAILQ_FOREACH(chk, &stcb->asoc.send_queue, sctp_next) {
|
|
if ((u_int32_t) (chk->send_size + IP_HDR_SIZE) > nxtsz) {
|
|
chk->flags |= CHUNK_FLAGS_FRAGMENT_OK;
|
|
}
|
|
}
|
|
TAILQ_FOREACH(chk, &stcb->asoc.sent_queue, sctp_next) {
|
|
if ((u_int32_t) (chk->send_size + IP_HDR_SIZE) > nxtsz) {
|
|
/*
|
|
* For this guy we also mark for immediate
|
|
* resend since we sent to big of chunk
|
|
*/
|
|
chk->flags |= CHUNK_FLAGS_FRAGMENT_OK;
|
|
if (chk->sent != SCTP_DATAGRAM_RESEND)
|
|
stcb->asoc.sent_queue_retran_cnt++;
|
|
chk->sent = SCTP_DATAGRAM_RESEND;
|
|
chk->rec.data.doing_fast_retransmit = 0;
|
|
|
|
chk->sent = SCTP_DATAGRAM_RESEND;
|
|
/* Clear any time so NO RTT is being done */
|
|
chk->sent_rcv_time.tv_sec = 0;
|
|
chk->sent_rcv_time.tv_usec = 0;
|
|
stcb->asoc.total_flight -= chk->send_size;
|
|
net->flight_size -= chk->send_size;
|
|
}
|
|
}
|
|
}
|
|
sctp_timer_start(SCTP_TIMER_TYPE_PATHMTURAISE, inp, stcb, NULL);
|
|
out:
|
|
if (stcb)
|
|
SCTP_TCB_UNLOCK(stcb);
|
|
}
|
|
|
|
|
|
void
|
|
sctp6_ctlinput(cmd, pktdst, d)
|
|
int cmd;
|
|
struct sockaddr *pktdst;
|
|
void *d;
|
|
{
|
|
struct sctphdr sh;
|
|
struct ip6ctlparam *ip6cp = NULL;
|
|
int s, cm;
|
|
|
|
if (pktdst->sa_family != AF_INET6 ||
|
|
pktdst->sa_len != sizeof(struct sockaddr_in6))
|
|
return;
|
|
|
|
if ((unsigned)cmd >= PRC_NCMDS)
|
|
return;
|
|
if (PRC_IS_REDIRECT(cmd)) {
|
|
d = NULL;
|
|
} else if (inet6ctlerrmap[cmd] == 0) {
|
|
return;
|
|
}
|
|
/* if the parameter is from icmp6, decode it. */
|
|
if (d != NULL) {
|
|
ip6cp = (struct ip6ctlparam *)d;
|
|
} else {
|
|
ip6cp = (struct ip6ctlparam *)NULL;
|
|
}
|
|
|
|
if (ip6cp) {
|
|
/*
|
|
* XXX: We assume that when IPV6 is non NULL, M and OFF are
|
|
* valid.
|
|
*/
|
|
/* check if we can safely examine src and dst ports */
|
|
struct sctp_inpcb *inp = NULL;
|
|
struct sctp_tcb *stcb = NULL;
|
|
struct sctp_nets *net = NULL;
|
|
struct sockaddr_in6 final;
|
|
|
|
if (ip6cp->ip6c_m == NULL ||
|
|
(size_t)ip6cp->ip6c_m->m_pkthdr.len < (ip6cp->ip6c_off + sizeof(sh)))
|
|
return;
|
|
|
|
bzero(&sh, sizeof(sh));
|
|
bzero(&final, sizeof(final));
|
|
inp = NULL;
|
|
net = NULL;
|
|
m_copydata(ip6cp->ip6c_m, ip6cp->ip6c_off, sizeof(sh),
|
|
(caddr_t)&sh);
|
|
ip6cp->ip6c_src->sin6_port = sh.src_port;
|
|
final.sin6_len = sizeof(final);
|
|
final.sin6_family = AF_INET6;
|
|
final.sin6_addr = ((struct sockaddr_in6 *)pktdst)->sin6_addr;
|
|
final.sin6_port = sh.dest_port;
|
|
s = splnet();
|
|
stcb = sctp_findassociation_addr_sa((struct sockaddr *)ip6cp->ip6c_src,
|
|
(struct sockaddr *)&final,
|
|
&inp, &net, 1);
|
|
/* inp's ref-count increased && stcb locked */
|
|
if (stcb != NULL && inp && (inp->sctp_socket != NULL)) {
|
|
if (cmd == PRC_MSGSIZE) {
|
|
sctp6_notify_mbuf(inp,
|
|
ip6cp->ip6c_icmp6,
|
|
&sh,
|
|
stcb,
|
|
net);
|
|
/* inp's ref-count reduced && stcb unlocked */
|
|
} else {
|
|
if (cmd == PRC_HOSTDEAD) {
|
|
cm = EHOSTUNREACH;
|
|
} else {
|
|
cm = inet6ctlerrmap[cmd];
|
|
}
|
|
sctp_notify(inp, cm, &sh,
|
|
(struct sockaddr *)&final,
|
|
stcb, net);
|
|
/* inp's ref-count reduced && stcb unlocked */
|
|
}
|
|
} else {
|
|
if (PRC_IS_REDIRECT(cmd) && inp) {
|
|
in6_rtchange((struct in6pcb *)inp,
|
|
inet6ctlerrmap[cmd]);
|
|
}
|
|
if (inp) {
|
|
/* reduce inp's ref-count */
|
|
SCTP_INP_WLOCK(inp);
|
|
SCTP_INP_DECR_REF(inp);
|
|
SCTP_INP_WUNLOCK(inp);
|
|
}
|
|
if (stcb)
|
|
SCTP_TCB_UNLOCK(stcb);
|
|
}
|
|
splx(s);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* this routine can probably be collasped into the one in sctp_userreq.c
|
|
* since they do the same thing and now we lookup with a sockaddr
|
|
*/
|
|
static int
|
|
sctp6_getcred(SYSCTL_HANDLER_ARGS)
|
|
{
|
|
struct sockaddr_in6 addrs[2];
|
|
struct sctp_inpcb *inp;
|
|
struct sctp_nets *net;
|
|
struct sctp_tcb *stcb;
|
|
int error, s;
|
|
|
|
error = suser(req->td);
|
|
if (error)
|
|
return (error);
|
|
|
|
if (req->newlen != sizeof(addrs))
|
|
return (EINVAL);
|
|
if (req->oldlen != sizeof(struct ucred))
|
|
return (EINVAL);
|
|
error = SYSCTL_IN(req, addrs, sizeof(addrs));
|
|
if (error)
|
|
return (error);
|
|
s = splnet();
|
|
|
|
stcb = sctp_findassociation_addr_sa(sin6tosa(&addrs[0]),
|
|
sin6tosa(&addrs[1]),
|
|
&inp, &net, 1);
|
|
if (stcb == NULL || inp == NULL || inp->sctp_socket == NULL) {
|
|
error = ENOENT;
|
|
if (inp) {
|
|
SCTP_INP_WLOCK(inp);
|
|
SCTP_INP_DECR_REF(inp);
|
|
SCTP_INP_WUNLOCK(inp);
|
|
}
|
|
goto out;
|
|
}
|
|
error = SYSCTL_OUT(req, inp->sctp_socket->so_cred,
|
|
sizeof(struct ucred));
|
|
|
|
SCTP_TCB_UNLOCK(stcb);
|
|
out:
|
|
splx(s);
|
|
return (error);
|
|
}
|
|
|
|
SYSCTL_PROC(_net_inet6_sctp6, OID_AUTO, getcred, CTLTYPE_OPAQUE | CTLFLAG_RW,
|
|
0, 0,
|
|
sctp6_getcred, "S,ucred", "Get the ucred of a SCTP6 connection");
|
|
|
|
|
|
/* This is the same as the sctp_abort() could be made common */
|
|
static void
|
|
sctp6_abort(struct socket *so)
|
|
{
|
|
struct sctp_inpcb *inp;
|
|
int s;
|
|
uint32_t flags;
|
|
|
|
inp = (struct sctp_inpcb *)so->so_pcb;
|
|
if (inp == 0)
|
|
return;
|
|
s = splnet();
|
|
sctp_must_try_again:
|
|
flags = inp->sctp_flags;
|
|
#ifdef SCTP_LOG_CLOSING
|
|
sctp_log_closing(inp, NULL, 17);
|
|
#endif
|
|
if (((flags & SCTP_PCB_FLAGS_SOCKET_GONE) == 0) &&
|
|
(atomic_cmpset_int(&inp->sctp_flags, flags, (flags | SCTP_PCB_FLAGS_SOCKET_GONE | SCTP_PCB_FLAGS_CLOSE_IP)))) {
|
|
#ifdef SCTP_LOG_CLOSING
|
|
sctp_log_closing(inp, NULL, 16);
|
|
#endif
|
|
sctp_inpcb_free(inp, 1, 0);
|
|
SOCK_LOCK(so);
|
|
so->so_snd.sb_cc = 0;
|
|
so->so_snd.sb_mb = NULL;
|
|
so->so_snd.sb_mbcnt = 0;
|
|
|
|
/*
|
|
* same for the rcv ones, they are only here for the
|
|
* accounting/select.
|
|
*/
|
|
so->so_rcv.sb_cc = 0;
|
|
so->so_rcv.sb_mb = NULL;
|
|
so->so_rcv.sb_mbcnt = 0;
|
|
/*
|
|
* Now null out the reference, we are completely detached.
|
|
*/
|
|
so->so_pcb = NULL;
|
|
SOCK_UNLOCK(so);
|
|
} else {
|
|
flags = inp->sctp_flags;
|
|
if ((flags & SCTP_PCB_FLAGS_SOCKET_GONE) == 0) {
|
|
goto sctp_must_try_again;
|
|
}
|
|
}
|
|
splx(s);
|
|
return;
|
|
}
|
|
|
|
static int
|
|
sctp6_attach(struct socket *so, int proto, struct thread *p)
|
|
{
|
|
struct in6pcb *inp6;
|
|
int s, error;
|
|
struct sctp_inpcb *inp;
|
|
|
|
inp = (struct sctp_inpcb *)so->so_pcb;
|
|
if (inp != NULL)
|
|
return EINVAL;
|
|
|
|
if (so->so_snd.sb_hiwat == 0 || so->so_rcv.sb_hiwat == 0) {
|
|
error = soreserve(so, sctp_sendspace, sctp_recvspace);
|
|
if (error)
|
|
return error;
|
|
}
|
|
s = splnet();
|
|
error = sctp_inpcb_alloc(so);
|
|
splx(s);
|
|
if (error)
|
|
return error;
|
|
inp = (struct sctp_inpcb *)so->so_pcb;
|
|
inp->sctp_flags |= SCTP_PCB_FLAGS_BOUND_V6; /* I'm v6! */
|
|
inp6 = (struct in6pcb *)inp;
|
|
|
|
inp6->inp_vflag |= INP_IPV6;
|
|
inp6->in6p_hops = -1; /* use kernel default */
|
|
inp6->in6p_cksum = -1; /* just to be sure */
|
|
#ifdef INET
|
|
/*
|
|
* XXX: ugly!! IPv4 TTL initialization is necessary for an IPv6
|
|
* socket as well, because the socket may be bound to an IPv6
|
|
* wildcard address, which may match an IPv4-mapped IPv6 address.
|
|
*/
|
|
inp6->inp_ip_ttl = ip_defttl;
|
|
#endif
|
|
/*
|
|
* Hmm what about the IPSEC stuff that is missing here but in
|
|
* sctp_attach()?
|
|
*/
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
sctp6_bind(struct socket *so, struct sockaddr *addr, struct thread *p)
|
|
{
|
|
struct sctp_inpcb *inp;
|
|
struct in6pcb *inp6;
|
|
int s, error;
|
|
|
|
inp = (struct sctp_inpcb *)so->so_pcb;
|
|
if (inp == 0)
|
|
return EINVAL;
|
|
|
|
inp6 = (struct in6pcb *)inp;
|
|
inp6->inp_vflag &= ~INP_IPV4;
|
|
inp6->inp_vflag |= INP_IPV6;
|
|
if (addr != NULL &&
|
|
(inp6->inp_flags & IN6P_IPV6_V6ONLY)
|
|
== 0) {
|
|
if (addr->sa_family == AF_INET) {
|
|
/* binding v4 addr to v6 socket, so reset flags */
|
|
inp6->inp_vflag |= INP_IPV4;
|
|
inp6->inp_vflag &= ~INP_IPV6;
|
|
} else {
|
|
struct sockaddr_in6 *sin6_p;
|
|
|
|
sin6_p = (struct sockaddr_in6 *)addr;
|
|
|
|
if (IN6_IS_ADDR_UNSPECIFIED(&sin6_p->sin6_addr)) {
|
|
inp6->inp_vflag |= INP_IPV4;
|
|
} else if (IN6_IS_ADDR_V4MAPPED(&sin6_p->sin6_addr)) {
|
|
struct sockaddr_in sin;
|
|
|
|
in6_sin6_2_sin(&sin, sin6_p);
|
|
inp6->inp_vflag |= INP_IPV4;
|
|
inp6->inp_vflag &= ~INP_IPV6;
|
|
s = splnet();
|
|
error = sctp_inpcb_bind(so, (struct sockaddr *)&sin, p);
|
|
splx(s);
|
|
return error;
|
|
}
|
|
}
|
|
} else if (addr != NULL) {
|
|
/* IPV6_V6ONLY socket */
|
|
if (addr->sa_family == AF_INET) {
|
|
/* can't bind v4 addr to v6 only socket! */
|
|
return EINVAL;
|
|
} else {
|
|
struct sockaddr_in6 *sin6_p;
|
|
|
|
sin6_p = (struct sockaddr_in6 *)addr;
|
|
|
|
if (IN6_IS_ADDR_V4MAPPED(&sin6_p->sin6_addr))
|
|
/* can't bind v4-mapped addrs either! */
|
|
/* NOTE: we don't support SIIT */
|
|
return EINVAL;
|
|
}
|
|
}
|
|
s = splnet();
|
|
error = sctp_inpcb_bind(so, addr, p);
|
|
splx(s);
|
|
return error;
|
|
}
|
|
|
|
|
|
static void
|
|
sctp6_close(struct socket *so)
|
|
{
|
|
struct sctp_inpcb *inp;
|
|
uint32_t flags;
|
|
|
|
inp = (struct sctp_inpcb *)so->so_pcb;
|
|
if (inp == 0)
|
|
return;
|
|
|
|
/*
|
|
* Inform all the lower layer assoc that we are done.
|
|
*/
|
|
sctp_must_try_again:
|
|
flags = inp->sctp_flags;
|
|
#ifdef SCTP_LOG_CLOSING
|
|
sctp_log_closing(inp, NULL, 17);
|
|
#endif
|
|
if (((flags & SCTP_PCB_FLAGS_SOCKET_GONE) == 0) &&
|
|
(atomic_cmpset_int(&inp->sctp_flags, flags, (flags | SCTP_PCB_FLAGS_SOCKET_GONE | SCTP_PCB_FLAGS_CLOSE_IP)))) {
|
|
if (((so->so_options & SO_LINGER) && (so->so_linger == 0)) ||
|
|
(so->so_rcv.sb_cc > 0)) {
|
|
#ifdef SCTP_LOG_CLOSING
|
|
sctp_log_closing(inp, NULL, 13);
|
|
#endif
|
|
sctp_inpcb_free(inp, 1, 1);
|
|
} else {
|
|
#ifdef SCTP_LOG_CLOSING
|
|
sctp_log_closing(inp, NULL, 14);
|
|
#endif
|
|
sctp_inpcb_free(inp, 0, 1);
|
|
}
|
|
/*
|
|
* The socket is now detached, no matter what the state of
|
|
* the SCTP association.
|
|
*/
|
|
SOCK_LOCK(so);
|
|
so->so_snd.sb_cc = 0;
|
|
so->so_snd.sb_mb = NULL;
|
|
so->so_snd.sb_mbcnt = 0;
|
|
|
|
/*
|
|
* same for the rcv ones, they are only here for the
|
|
* accounting/select.
|
|
*/
|
|
so->so_rcv.sb_cc = 0;
|
|
so->so_rcv.sb_mb = NULL;
|
|
so->so_rcv.sb_mbcnt = 0;
|
|
/*
|
|
* Now null out the reference, we are completely detached.
|
|
*/
|
|
so->so_pcb = NULL;
|
|
SOCK_UNLOCK(so);
|
|
} else {
|
|
flags = inp->sctp_flags;
|
|
if ((flags & SCTP_PCB_FLAGS_SOCKET_GONE) == 0) {
|
|
goto sctp_must_try_again;
|
|
}
|
|
}
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
static int
|
|
sctp6_disconnect(struct socket *so)
|
|
{
|
|
struct sctp_inpcb *inp;
|
|
int s;
|
|
|
|
s = splnet(); /* XXX */
|
|
inp = (struct sctp_inpcb *)so->so_pcb;
|
|
if (inp == NULL) {
|
|
splx(s);
|
|
return (ENOTCONN);
|
|
}
|
|
SCTP_INP_RLOCK(inp);
|
|
if (inp->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) {
|
|
if (LIST_EMPTY(&inp->sctp_asoc_list)) {
|
|
/* No connection */
|
|
splx(s);
|
|
SCTP_INP_RUNLOCK(inp);
|
|
return (ENOTCONN);
|
|
} else {
|
|
int some_on_streamwheel = 0;
|
|
struct sctp_association *asoc;
|
|
struct sctp_tcb *stcb;
|
|
|
|
stcb = LIST_FIRST(&inp->sctp_asoc_list);
|
|
if (stcb == NULL) {
|
|
splx(s);
|
|
SCTP_INP_RUNLOCK(inp);
|
|
return (EINVAL);
|
|
}
|
|
SCTP_TCB_LOCK(stcb);
|
|
asoc = &stcb->asoc;
|
|
if (((so->so_options & SO_LINGER) &&
|
|
(so->so_linger == 0)) ||
|
|
(so->so_rcv.sb_cc > 0)) {
|
|
if (SCTP_GET_STATE(asoc) !=
|
|
SCTP_STATE_COOKIE_WAIT) {
|
|
/* Left with Data unread */
|
|
struct mbuf *err;
|
|
|
|
err = NULL;
|
|
MGET(err, M_DONTWAIT, MT_DATA);
|
|
if (err) {
|
|
/*
|
|
* Fill in the user
|
|
* initiated abort
|
|
*/
|
|
struct sctp_paramhdr *ph;
|
|
|
|
ph = mtod(err, struct sctp_paramhdr *);
|
|
err->m_len = sizeof(struct sctp_paramhdr);
|
|
ph->param_type = htons(SCTP_CAUSE_USER_INITIATED_ABT);
|
|
ph->param_length = htons(err->m_len);
|
|
}
|
|
sctp_send_abort_tcb(stcb, err);
|
|
SCTP_STAT_INCR_COUNTER32(sctps_aborted);
|
|
}
|
|
SCTP_INP_RUNLOCK(inp);
|
|
if ((SCTP_GET_STATE(&stcb->asoc) == SCTP_STATE_OPEN) ||
|
|
(SCTP_GET_STATE(&stcb->asoc) == SCTP_STATE_SHUTDOWN_RECEIVED)) {
|
|
SCTP_STAT_DECR_GAUGE32(sctps_currestab);
|
|
}
|
|
sctp_free_assoc(inp, stcb, 0);
|
|
/* No unlock tcb assoc is gone */
|
|
splx(s);
|
|
return (0);
|
|
}
|
|
if (!TAILQ_EMPTY(&asoc->out_wheel)) {
|
|
/* Check to see if some data queued */
|
|
struct sctp_stream_out *outs;
|
|
|
|
TAILQ_FOREACH(outs, &asoc->out_wheel,
|
|
next_spoke) {
|
|
if (!TAILQ_EMPTY(&outs->outqueue)) {
|
|
some_on_streamwheel = 1;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
if (TAILQ_EMPTY(&asoc->send_queue) &&
|
|
TAILQ_EMPTY(&asoc->sent_queue) &&
|
|
(some_on_streamwheel == 0)) {
|
|
/* nothing queued to send, so I'm done... */
|
|
if ((SCTP_GET_STATE(asoc) !=
|
|
SCTP_STATE_SHUTDOWN_SENT) &&
|
|
(SCTP_GET_STATE(asoc) !=
|
|
SCTP_STATE_SHUTDOWN_ACK_SENT)) {
|
|
/* only send SHUTDOWN the first time */
|
|
sctp_send_shutdown(stcb, stcb->asoc.primary_destination);
|
|
sctp_chunk_output(stcb->sctp_ep, stcb, 1);
|
|
asoc->state = SCTP_STATE_SHUTDOWN_SENT;
|
|
SCTP_STAT_DECR_GAUGE32(sctps_currestab);
|
|
sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWN,
|
|
stcb->sctp_ep, stcb,
|
|
asoc->primary_destination);
|
|
sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNGUARD,
|
|
stcb->sctp_ep, stcb,
|
|
asoc->primary_destination);
|
|
}
|
|
} else {
|
|
/*
|
|
* we still got (or just got) data to send,
|
|
* so set SHUTDOWN_PENDING
|
|
*/
|
|
/*
|
|
* XXX sockets draft says that MSG_EOF
|
|
* should be sent with no data. currently,
|
|
* we will allow user data to be sent first
|
|
* and move to SHUTDOWN-PENDING
|
|
*/
|
|
asoc->state |= SCTP_STATE_SHUTDOWN_PENDING;
|
|
}
|
|
SCTP_TCB_UNLOCK(stcb);
|
|
SCTP_INP_RUNLOCK(inp);
|
|
splx(s);
|
|
return (0);
|
|
}
|
|
} else {
|
|
/* UDP model does not support this */
|
|
SCTP_INP_RUNLOCK(inp);
|
|
splx(s);
|
|
return EOPNOTSUPP;
|
|
}
|
|
}
|
|
|
|
int
|
|
sctp_sendm(struct socket *so, int flags, struct mbuf *m, struct sockaddr *addr,
|
|
struct mbuf *control, struct thread *p);
|
|
|
|
|
|
|
|
static int
|
|
sctp6_send(struct socket *so, int flags, struct mbuf *m, struct sockaddr *addr,
|
|
struct mbuf *control, struct thread *p)
|
|
{
|
|
struct sctp_inpcb *inp;
|
|
struct inpcb *in_inp;
|
|
struct in6pcb *inp6;
|
|
|
|
#ifdef INET
|
|
struct sockaddr_in6 *sin6;
|
|
|
|
#endif /* INET */
|
|
/* No SPL needed since sctp_output does this */
|
|
|
|
inp = (struct sctp_inpcb *)so->so_pcb;
|
|
if (inp == NULL) {
|
|
if (control) {
|
|
m_freem(control);
|
|
control = NULL;
|
|
}
|
|
m_freem(m);
|
|
return EINVAL;
|
|
}
|
|
in_inp = (struct inpcb *)inp;
|
|
inp6 = (struct in6pcb *)inp;
|
|
/*
|
|
* For the TCP model we may get a NULL addr, if we are a connected
|
|
* socket thats ok.
|
|
*/
|
|
if ((inp->sctp_flags & SCTP_PCB_FLAGS_CONNECTED) &&
|
|
(addr == NULL)) {
|
|
goto connected_type;
|
|
}
|
|
if (addr == NULL) {
|
|
m_freem(m);
|
|
if (control) {
|
|
m_freem(control);
|
|
control = NULL;
|
|
}
|
|
return (EDESTADDRREQ);
|
|
}
|
|
#ifdef INET
|
|
sin6 = (struct sockaddr_in6 *)addr;
|
|
if (
|
|
|
|
(inp6->inp_flags & IN6P_IPV6_V6ONLY)
|
|
) {
|
|
/*
|
|
* if IPV6_V6ONLY flag, we discard datagrams destined to a
|
|
* v4 addr or v4-mapped addr
|
|
*/
|
|
if (addr->sa_family == AF_INET) {
|
|
return EINVAL;
|
|
}
|
|
if (IN6_IS_ADDR_V4MAPPED(&sin6->sin6_addr)) {
|
|
return EINVAL;
|
|
}
|
|
}
|
|
if (IN6_IS_ADDR_V4MAPPED(&sin6->sin6_addr)) {
|
|
if (!ip6_v6only) {
|
|
struct sockaddr_in sin;
|
|
|
|
/* convert v4-mapped into v4 addr and send */
|
|
in6_sin6_2_sin(&sin, sin6);
|
|
return sctp_sendm(so, flags, m, (struct sockaddr *)&sin,
|
|
control, p);
|
|
} else {
|
|
/* mapped addresses aren't enabled */
|
|
return EINVAL;
|
|
}
|
|
}
|
|
#endif /* INET */
|
|
connected_type:
|
|
/* now what about control */
|
|
if (control) {
|
|
if (inp->control) {
|
|
printf("huh? control set?\n");
|
|
m_freem(inp->control);
|
|
inp->control = NULL;
|
|
}
|
|
inp->control = control;
|
|
}
|
|
/* add it in possibly */
|
|
if ((inp->pkt) &&
|
|
(inp->pkt->m_flags & M_PKTHDR)) {
|
|
struct mbuf *x;
|
|
int c_len;
|
|
|
|
c_len = 0;
|
|
/* How big is it */
|
|
for (x = m; x; x = x->m_next) {
|
|
c_len += x->m_len;
|
|
}
|
|
inp->pkt->m_pkthdr.len += c_len;
|
|
}
|
|
/* Place the data */
|
|
if (inp->pkt) {
|
|
inp->pkt_last->m_next = m;
|
|
inp->pkt_last = m;
|
|
} else {
|
|
inp->pkt_last = inp->pkt = m;
|
|
}
|
|
if (
|
|
/* FreeBSD and MacOSX uses a flag passed */
|
|
((flags & PRUS_MORETOCOME) == 0)
|
|
) {
|
|
/*
|
|
* note with the current version this code will only be used
|
|
* by OpenBSD, NetBSD and FreeBSD have methods for
|
|
* re-defining sosend() to use sctp_sosend(). One can
|
|
* optionaly switch back to this code (by changing back the
|
|
* defininitions but this is not advisable.
|
|
*/
|
|
int ret;
|
|
|
|
ret = sctp_output(inp, inp->pkt, addr, inp->control, p, flags);
|
|
inp->pkt = NULL;
|
|
inp->control = NULL;
|
|
return (ret);
|
|
} else {
|
|
return (0);
|
|
}
|
|
}
|
|
|
|
static int
|
|
sctp6_connect(struct socket *so, struct sockaddr *addr, struct thread *p)
|
|
{
|
|
int s = splnet();
|
|
|
|
int error = 0;
|
|
struct sctp_inpcb *inp;
|
|
struct in6pcb *inp6;
|
|
struct sctp_tcb *stcb;
|
|
|
|
#ifdef INET
|
|
struct sockaddr_in6 *sin6;
|
|
struct sockaddr_storage ss;
|
|
|
|
#endif /* INET */
|
|
|
|
inp6 = (struct in6pcb *)so->so_pcb;
|
|
inp = (struct sctp_inpcb *)so->so_pcb;
|
|
if (inp == 0) {
|
|
splx(s);
|
|
return (ECONNRESET); /* I made the same as TCP since we are
|
|
* not setup? */
|
|
}
|
|
SCTP_ASOC_CREATE_LOCK(inp);
|
|
SCTP_INP_RLOCK(inp);
|
|
if ((inp->sctp_flags & SCTP_PCB_FLAGS_UNBOUND) ==
|
|
SCTP_PCB_FLAGS_UNBOUND) {
|
|
/* Bind a ephemeral port */
|
|
SCTP_INP_RUNLOCK(inp);
|
|
error = sctp6_bind(so, NULL, p);
|
|
if (error) {
|
|
splx(s);
|
|
SCTP_ASOC_CREATE_UNLOCK(inp);
|
|
|
|
return (error);
|
|
}
|
|
SCTP_INP_RLOCK(inp);
|
|
}
|
|
if ((inp->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) &&
|
|
(inp->sctp_flags & SCTP_PCB_FLAGS_CONNECTED)) {
|
|
/* We are already connected AND the TCP model */
|
|
splx(s);
|
|
SCTP_INP_RUNLOCK(inp);
|
|
SCTP_ASOC_CREATE_UNLOCK(inp);
|
|
return (EADDRINUSE);
|
|
}
|
|
#ifdef INET
|
|
sin6 = (struct sockaddr_in6 *)addr;
|
|
if (
|
|
(inp6->inp_flags & IN6P_IPV6_V6ONLY)
|
|
) {
|
|
/*
|
|
* if IPV6_V6ONLY flag, ignore connections destined to a v4
|
|
* addr or v4-mapped addr
|
|
*/
|
|
if (addr->sa_family == AF_INET) {
|
|
splx(s);
|
|
SCTP_INP_RUNLOCK(inp);
|
|
SCTP_ASOC_CREATE_UNLOCK(inp);
|
|
return EINVAL;
|
|
}
|
|
if (IN6_IS_ADDR_V4MAPPED(&sin6->sin6_addr)) {
|
|
splx(s);
|
|
SCTP_INP_RUNLOCK(inp);
|
|
SCTP_ASOC_CREATE_UNLOCK(inp);
|
|
return EINVAL;
|
|
}
|
|
}
|
|
if (IN6_IS_ADDR_V4MAPPED(&sin6->sin6_addr)) {
|
|
if (!ip6_v6only) {
|
|
/* convert v4-mapped into v4 addr */
|
|
in6_sin6_2_sin((struct sockaddr_in *)&ss, sin6);
|
|
addr = (struct sockaddr *)&ss;
|
|
} else {
|
|
/* mapped addresses aren't enabled */
|
|
splx(s);
|
|
SCTP_INP_RUNLOCK(inp);
|
|
SCTP_ASOC_CREATE_UNLOCK(inp);
|
|
return EINVAL;
|
|
}
|
|
} else
|
|
#endif /* INET */
|
|
addr = addr; /* for true v6 address case */
|
|
|
|
/* Now do we connect? */
|
|
if (inp->sctp_flags & SCTP_PCB_FLAGS_CONNECTED) {
|
|
stcb = LIST_FIRST(&inp->sctp_asoc_list);
|
|
if (stcb)
|
|
SCTP_TCB_UNLOCK(stcb);
|
|
SCTP_INP_RUNLOCK(inp);
|
|
} else {
|
|
SCTP_INP_RUNLOCK(inp);
|
|
SCTP_INP_WLOCK(inp);
|
|
SCTP_INP_INCR_REF(inp);
|
|
SCTP_INP_WUNLOCK(inp);
|
|
stcb = sctp_findassociation_ep_addr(&inp, addr, NULL, NULL, NULL);
|
|
if (stcb == NULL) {
|
|
SCTP_INP_WLOCK(inp);
|
|
SCTP_INP_DECR_REF(inp);
|
|
SCTP_INP_WUNLOCK(inp);
|
|
}
|
|
}
|
|
|
|
if (stcb != NULL) {
|
|
/* Already have or am bring up an association */
|
|
SCTP_ASOC_CREATE_UNLOCK(inp);
|
|
SCTP_TCB_UNLOCK(stcb);
|
|
splx(s);
|
|
return (EALREADY);
|
|
}
|
|
/* We are GOOD to go */
|
|
stcb = sctp_aloc_assoc(inp, addr, 1, &error, 0);
|
|
SCTP_ASOC_CREATE_UNLOCK(inp);
|
|
if (stcb == NULL) {
|
|
/* Gak! no memory */
|
|
splx(s);
|
|
return (error);
|
|
}
|
|
if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) {
|
|
stcb->sctp_ep->sctp_flags |= SCTP_PCB_FLAGS_CONNECTED;
|
|
/* Set the connected flag so we can queue data */
|
|
soisconnecting(so);
|
|
}
|
|
stcb->asoc.state = SCTP_STATE_COOKIE_WAIT;
|
|
SCTP_GETTIME_TIMEVAL(&stcb->asoc.time_entered);
|
|
|
|
/* initialize authentication parameters for the assoc */
|
|
sctp_initialize_auth_params(inp, stcb);
|
|
|
|
sctp_send_initiate(inp, stcb);
|
|
SCTP_TCB_UNLOCK(stcb);
|
|
splx(s);
|
|
return error;
|
|
}
|
|
|
|
static int
|
|
sctp6_getaddr(struct socket *so, struct sockaddr **addr)
|
|
{
|
|
struct sockaddr_in6 *sin6;
|
|
|
|
struct sctp_inpcb *inp;
|
|
|
|
int error;
|
|
|
|
|
|
/*
|
|
* Do the malloc first in case it blocks.
|
|
*/
|
|
SCTP_MALLOC_SONAME(sin6, struct sockaddr_in6 *, sizeof *sin6);
|
|
sin6->sin6_family = AF_INET6;
|
|
sin6->sin6_len = sizeof(*sin6);
|
|
|
|
inp = (struct sctp_inpcb *)so->so_pcb;
|
|
if (inp == NULL) {
|
|
SCTP_FREE_SONAME(sin6);
|
|
return ECONNRESET;
|
|
}
|
|
SCTP_INP_RLOCK(inp);
|
|
sin6->sin6_port = inp->sctp_lport;
|
|
if (inp->sctp_flags & SCTP_PCB_FLAGS_BOUNDALL) {
|
|
/* For the bound all case you get back 0 */
|
|
if (inp->sctp_flags & SCTP_PCB_FLAGS_CONNECTED) {
|
|
struct sctp_tcb *stcb;
|
|
struct sockaddr_in6 *sin_a6;
|
|
struct sctp_nets *net;
|
|
int fnd;
|
|
|
|
stcb = LIST_FIRST(&inp->sctp_asoc_list);
|
|
if (stcb == NULL) {
|
|
goto notConn6;
|
|
}
|
|
fnd = 0;
|
|
sin_a6 = NULL;
|
|
TAILQ_FOREACH(net, &stcb->asoc.nets, sctp_next) {
|
|
sin_a6 = (struct sockaddr_in6 *)&net->ro._l_addr;
|
|
if (sin_a6->sin6_family == AF_INET6) {
|
|
fnd = 1;
|
|
break;
|
|
}
|
|
}
|
|
if ((!fnd) || (sin_a6 == NULL)) {
|
|
/* punt */
|
|
goto notConn6;
|
|
}
|
|
sin6->sin6_addr = sctp_ipv6_source_address_selection(
|
|
inp, stcb, (struct route *)&net->ro, net, 0);
|
|
|
|
} else {
|
|
/* For the bound all case you get back 0 */
|
|
notConn6:
|
|
memset(&sin6->sin6_addr, 0, sizeof(sin6->sin6_addr));
|
|
}
|
|
} else {
|
|
/* Take the first IPv6 address in the list */
|
|
struct sctp_laddr *laddr;
|
|
int fnd = 0;
|
|
|
|
LIST_FOREACH(laddr, &inp->sctp_addr_list, sctp_nxt_addr) {
|
|
if (laddr->ifa->ifa_addr->sa_family == AF_INET6) {
|
|
struct sockaddr_in6 *sin_a;
|
|
|
|
sin_a = (struct sockaddr_in6 *)laddr->ifa->ifa_addr;
|
|
sin6->sin6_addr = sin_a->sin6_addr;
|
|
fnd = 1;
|
|
break;
|
|
}
|
|
}
|
|
if (!fnd) {
|
|
SCTP_FREE_SONAME(sin6);
|
|
SCTP_INP_RUNLOCK(inp);
|
|
return ENOENT;
|
|
}
|
|
}
|
|
SCTP_INP_RUNLOCK(inp);
|
|
/* Scoping things for v6 */
|
|
if ((error = sa6_recoverscope(sin6)) != 0)
|
|
return (error);
|
|
(*addr) = (struct sockaddr *)sin6;
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
sctp6_peeraddr(struct socket *so, struct sockaddr **addr)
|
|
{
|
|
struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)*addr;
|
|
|
|
int fnd;
|
|
struct sockaddr_in6 *sin_a6;
|
|
struct sctp_inpcb *inp;
|
|
struct sctp_tcb *stcb;
|
|
struct sctp_nets *net;
|
|
|
|
int error;
|
|
|
|
|
|
/*
|
|
* Do the malloc first in case it blocks.
|
|
*/
|
|
inp = (struct sctp_inpcb *)so->so_pcb;
|
|
if ((inp->sctp_flags & SCTP_PCB_FLAGS_CONNECTED) == 0) {
|
|
/* UDP type and listeners will drop out here */
|
|
return (ENOTCONN);
|
|
}
|
|
SCTP_MALLOC_SONAME(sin6, struct sockaddr_in6 *, sizeof *sin6);
|
|
sin6->sin6_family = AF_INET6;
|
|
sin6->sin6_len = sizeof(*sin6);
|
|
|
|
/* We must recapture incase we blocked */
|
|
inp = (struct sctp_inpcb *)so->so_pcb;
|
|
if (inp == NULL) {
|
|
SCTP_FREE_SONAME(sin6);
|
|
return ECONNRESET;
|
|
}
|
|
SCTP_INP_RLOCK(inp);
|
|
stcb = LIST_FIRST(&inp->sctp_asoc_list);
|
|
if (stcb)
|
|
SCTP_TCB_LOCK(stcb);
|
|
SCTP_INP_RUNLOCK(inp);
|
|
if (stcb == NULL) {
|
|
SCTP_FREE_SONAME(sin6);
|
|
return ECONNRESET;
|
|
}
|
|
fnd = 0;
|
|
TAILQ_FOREACH(net, &stcb->asoc.nets, sctp_next) {
|
|
sin_a6 = (struct sockaddr_in6 *)&net->ro._l_addr;
|
|
if (sin_a6->sin6_family == AF_INET6) {
|
|
fnd = 1;
|
|
sin6->sin6_port = stcb->rport;
|
|
sin6->sin6_addr = sin_a6->sin6_addr;
|
|
break;
|
|
}
|
|
}
|
|
SCTP_TCB_UNLOCK(stcb);
|
|
if (!fnd) {
|
|
/* No IPv4 address */
|
|
SCTP_FREE_SONAME(sin6);
|
|
return ENOENT;
|
|
}
|
|
if ((error = sa6_recoverscope(sin6)) != 0)
|
|
return (error);
|
|
*addr = (struct sockaddr *)sin6;
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
sctp6_in6getaddr(struct socket *so, struct sockaddr **nam)
|
|
{
|
|
struct sockaddr *addr;
|
|
|
|
struct in6pcb *inp6 = sotoin6pcb(so);
|
|
int error, s;
|
|
|
|
if (inp6 == NULL)
|
|
return EINVAL;
|
|
|
|
s = splnet();
|
|
/* allow v6 addresses precedence */
|
|
error = sctp6_getaddr(so, nam);
|
|
if (error) {
|
|
/* try v4 next if v6 failed */
|
|
error = sctp_ingetaddr(so, nam);
|
|
if (error) {
|
|
splx(s);
|
|
return (error);
|
|
}
|
|
addr = *nam;
|
|
/* if I'm V6ONLY, convert it to v4-mapped */
|
|
if (
|
|
(inp6->inp_flags & IN6P_IPV6_V6ONLY)
|
|
) {
|
|
struct sockaddr_in6 sin6;
|
|
|
|
in6_sin_2_v4mapsin6((struct sockaddr_in *)addr, &sin6);
|
|
memcpy(addr, &sin6, sizeof(struct sockaddr_in6));
|
|
}
|
|
}
|
|
splx(s);
|
|
return (error);
|
|
}
|
|
|
|
|
|
static int
|
|
sctp6_getpeeraddr(struct socket *so, struct sockaddr **nam)
|
|
{
|
|
struct sockaddr *addr = *nam;
|
|
|
|
struct in6pcb *inp6 = sotoin6pcb(so);
|
|
int error, s;
|
|
|
|
if (inp6 == NULL)
|
|
return EINVAL;
|
|
|
|
s = splnet();
|
|
/* allow v6 addresses precedence */
|
|
error = sctp6_peeraddr(so, nam);
|
|
if (error) {
|
|
/* try v4 next if v6 failed */
|
|
error = sctp_peeraddr(so, nam);
|
|
if (error) {
|
|
splx(s);
|
|
return (error);
|
|
}
|
|
/* if I'm V6ONLY, convert it to v4-mapped */
|
|
if (
|
|
(inp6->inp_flags & IN6P_IPV6_V6ONLY)
|
|
) {
|
|
struct sockaddr_in6 sin6;
|
|
|
|
in6_sin_2_v4mapsin6((struct sockaddr_in *)addr, &sin6);
|
|
memcpy(addr, &sin6, sizeof(struct sockaddr_in6));
|
|
}
|
|
}
|
|
splx(s);
|
|
return error;
|
|
}
|
|
|
|
struct pr_usrreqs sctp6_usrreqs = {
|
|
.pru_abort = sctp6_abort,
|
|
.pru_accept = sctp_accept,
|
|
.pru_attach = sctp6_attach,
|
|
.pru_bind = sctp6_bind,
|
|
.pru_connect = sctp6_connect,
|
|
.pru_control = in6_control,
|
|
.pru_close = sctp6_close,
|
|
.pru_detach = sctp6_close,
|
|
.pru_sopoll = sopoll_generic,
|
|
.pru_disconnect = sctp6_disconnect,
|
|
.pru_listen = sctp_listen,
|
|
.pru_peeraddr = sctp6_getpeeraddr,
|
|
.pru_send = sctp6_send,
|
|
.pru_shutdown = sctp_shutdown,
|
|
.pru_sockaddr = sctp6_in6getaddr,
|
|
.pru_sosend = sctp_sosend,
|
|
.pru_soreceive = sctp_soreceive
|
|
};
|