Logo Search packages:      
Sourcecode: kfreebsd-7 version File versions  Download package

sctputil.c

/*-
 * Copyright (c) 2001-2007, by 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: sctputil.c,v 1.37 2005/03/07 23:26:09 itojun Exp $       */

#include <sys/cdefs.h>
__FBSDID("$FreeBSD: src/sys/netinet/sctputil.c,v 1.65.2.4.2.1 2008/02/02 12:44:13 rwatson Exp $");

#include <netinet/sctp_os.h>
#include <netinet/sctp_pcb.h>
#include <netinet/sctputil.h>
#include <netinet/sctp_var.h>
#include <netinet/sctp_sysctl.h>
#ifdef INET6
#include <netinet6/sctp6_var.h>
#endif
#include <netinet/sctp_header.h>
#include <netinet/sctp_output.h>
#include <netinet/sctp_uio.h>
#include <netinet/sctp_timer.h>
#include <netinet/sctp_crc32.h>
#include <netinet/sctp_indata.h>/* for sctp_deliver_data() */
#include <netinet/sctp_auth.h>
#include <netinet/sctp_asconf.h>
#include <netinet/sctp_cc_functions.h>

#define NUMBER_OF_MTU_SIZES 18


#ifndef KTR_SCTP
#define KTR_SCTP KTR_SUBSYS
#endif

void
sctp_sblog(struct sockbuf *sb,
    struct sctp_tcb *stcb, int from, int incr)
{
      struct sctp_cwnd_log sctp_clog;

      sctp_clog.x.sb.stcb = stcb;
      sctp_clog.x.sb.so_sbcc = sb->sb_cc;
      if (stcb)
            sctp_clog.x.sb.stcb_sbcc = stcb->asoc.sb_cc;
      else
            sctp_clog.x.sb.stcb_sbcc = 0;
      sctp_clog.x.sb.incr = incr;
      SCTP_CTR6(KTR_SCTP, "SCTP:%d[%d]:%x-%x-%x-%x",
          SCTP_LOG_EVENT_SB,
          from,
          sctp_clog.x.misc.log1,
          sctp_clog.x.misc.log2,
          sctp_clog.x.misc.log3,
          sctp_clog.x.misc.log4);
}

void
sctp_log_closing(struct sctp_inpcb *inp, struct sctp_tcb *stcb, int16_t loc)
{
      struct sctp_cwnd_log sctp_clog;

      sctp_clog.x.close.inp = (void *)inp;
      sctp_clog.x.close.sctp_flags = inp->sctp_flags;
      if (stcb) {
            sctp_clog.x.close.stcb = (void *)stcb;
            sctp_clog.x.close.state = (uint16_t) stcb->asoc.state;
      } else {
            sctp_clog.x.close.stcb = 0;
            sctp_clog.x.close.state = 0;
      }
      sctp_clog.x.close.loc = loc;
      SCTP_CTR6(KTR_SCTP, "SCTP:%d[%d]:%x-%x-%x-%x",
          SCTP_LOG_EVENT_CLOSE,
          0,
          sctp_clog.x.misc.log1,
          sctp_clog.x.misc.log2,
          sctp_clog.x.misc.log3,
          sctp_clog.x.misc.log4);
}


void
rto_logging(struct sctp_nets *net, int from)
{
      struct sctp_cwnd_log sctp_clog;

      sctp_clog.x.rto.net = (void *)net;
      sctp_clog.x.rto.rtt = net->prev_rtt;
      SCTP_CTR6(KTR_SCTP, "SCTP:%d[%d]:%x-%x-%x-%x",
          SCTP_LOG_EVENT_RTT,
          from,
          sctp_clog.x.misc.log1,
          sctp_clog.x.misc.log2,
          sctp_clog.x.misc.log3,
          sctp_clog.x.misc.log4);

}

void
sctp_log_strm_del_alt(struct sctp_tcb *stcb, uint32_t tsn, uint16_t sseq, uint16_t stream, int from)
{
      struct sctp_cwnd_log sctp_clog;

      sctp_clog.x.strlog.stcb = stcb;
      sctp_clog.x.strlog.n_tsn = tsn;
      sctp_clog.x.strlog.n_sseq = sseq;
      sctp_clog.x.strlog.e_tsn = 0;
      sctp_clog.x.strlog.e_sseq = 0;
      sctp_clog.x.strlog.strm = stream;
      SCTP_CTR6(KTR_SCTP, "SCTP:%d[%d]:%x-%x-%x-%x",
          SCTP_LOG_EVENT_STRM,
          from,
          sctp_clog.x.misc.log1,
          sctp_clog.x.misc.log2,
          sctp_clog.x.misc.log3,
          sctp_clog.x.misc.log4);

}

void
sctp_log_nagle_event(struct sctp_tcb *stcb, int action)
{
      struct sctp_cwnd_log sctp_clog;

      sctp_clog.x.nagle.stcb = (void *)stcb;
      sctp_clog.x.nagle.total_flight = stcb->asoc.total_flight;
      sctp_clog.x.nagle.total_in_queue = stcb->asoc.total_output_queue_size;
      sctp_clog.x.nagle.count_in_queue = stcb->asoc.chunks_on_out_queue;
      sctp_clog.x.nagle.count_in_flight = stcb->asoc.total_flight_count;
      SCTP_CTR6(KTR_SCTP, "SCTP:%d[%d]:%x-%x-%x-%x",
          SCTP_LOG_EVENT_NAGLE,
          action,
          sctp_clog.x.misc.log1,
          sctp_clog.x.misc.log2,
          sctp_clog.x.misc.log3,
          sctp_clog.x.misc.log4);
}


void
sctp_log_sack(uint32_t old_cumack, uint32_t cumack, uint32_t tsn, uint16_t gaps, uint16_t dups, int from)
{
      struct sctp_cwnd_log sctp_clog;

      sctp_clog.x.sack.cumack = cumack;
      sctp_clog.x.sack.oldcumack = old_cumack;
      sctp_clog.x.sack.tsn = tsn;
      sctp_clog.x.sack.numGaps = gaps;
      sctp_clog.x.sack.numDups = dups;
      SCTP_CTR6(KTR_SCTP, "SCTP:%d[%d]:%x-%x-%x-%x",
          SCTP_LOG_EVENT_SACK,
          from,
          sctp_clog.x.misc.log1,
          sctp_clog.x.misc.log2,
          sctp_clog.x.misc.log3,
          sctp_clog.x.misc.log4);
}

void
sctp_log_map(uint32_t map, uint32_t cum, uint32_t high, int from)
{
      struct sctp_cwnd_log sctp_clog;

      sctp_clog.x.map.base = map;
      sctp_clog.x.map.cum = cum;
      sctp_clog.x.map.high = high;
      SCTP_CTR6(KTR_SCTP, "SCTP:%d[%d]:%x-%x-%x-%x",
          SCTP_LOG_EVENT_MAP,
          from,
          sctp_clog.x.misc.log1,
          sctp_clog.x.misc.log2,
          sctp_clog.x.misc.log3,
          sctp_clog.x.misc.log4);
}

void
sctp_log_fr(uint32_t biggest_tsn, uint32_t biggest_new_tsn, uint32_t tsn,
    int from)
{
      struct sctp_cwnd_log sctp_clog;

      sctp_clog.x.fr.largest_tsn = biggest_tsn;
      sctp_clog.x.fr.largest_new_tsn = biggest_new_tsn;
      sctp_clog.x.fr.tsn = tsn;
      SCTP_CTR6(KTR_SCTP, "SCTP:%d[%d]:%x-%x-%x-%x",
          SCTP_LOG_EVENT_FR,
          from,
          sctp_clog.x.misc.log1,
          sctp_clog.x.misc.log2,
          sctp_clog.x.misc.log3,
          sctp_clog.x.misc.log4);

}


void
sctp_log_mb(struct mbuf *m, int from)
{
      struct sctp_cwnd_log sctp_clog;

      sctp_clog.x.mb.mp = m;
      sctp_clog.x.mb.mbuf_flags = (uint8_t) (SCTP_BUF_GET_FLAGS(m));
      sctp_clog.x.mb.size = (uint16_t) (SCTP_BUF_LEN(m));
      sctp_clog.x.mb.data = SCTP_BUF_AT(m, 0);
      if (SCTP_BUF_IS_EXTENDED(m)) {
            sctp_clog.x.mb.ext = SCTP_BUF_EXTEND_BASE(m);
            sctp_clog.x.mb.refcnt = (uint8_t) (SCTP_BUF_EXTEND_REFCNT(m));
      } else {
            sctp_clog.x.mb.ext = 0;
            sctp_clog.x.mb.refcnt = 0;
      }
      SCTP_CTR6(KTR_SCTP, "SCTP:%d[%d]:%x-%x-%x-%x",
          SCTP_LOG_EVENT_MBUF,
          from,
          sctp_clog.x.misc.log1,
          sctp_clog.x.misc.log2,
          sctp_clog.x.misc.log3,
          sctp_clog.x.misc.log4);
}


void
sctp_log_strm_del(struct sctp_queued_to_read *control, struct sctp_queued_to_read *poschk,
    int from)
{
      struct sctp_cwnd_log sctp_clog;

      if (control == NULL) {
            SCTP_PRINTF("Gak log of NULL?\n");
            return;
      }
      sctp_clog.x.strlog.stcb = control->stcb;
      sctp_clog.x.strlog.n_tsn = control->sinfo_tsn;
      sctp_clog.x.strlog.n_sseq = control->sinfo_ssn;
      sctp_clog.x.strlog.strm = control->sinfo_stream;
      if (poschk != NULL) {
            sctp_clog.x.strlog.e_tsn = poschk->sinfo_tsn;
            sctp_clog.x.strlog.e_sseq = poschk->sinfo_ssn;
      } else {
            sctp_clog.x.strlog.e_tsn = 0;
            sctp_clog.x.strlog.e_sseq = 0;
      }
      SCTP_CTR6(KTR_SCTP, "SCTP:%d[%d]:%x-%x-%x-%x",
          SCTP_LOG_EVENT_STRM,
          from,
          sctp_clog.x.misc.log1,
          sctp_clog.x.misc.log2,
          sctp_clog.x.misc.log3,
          sctp_clog.x.misc.log4);

}

void
sctp_log_cwnd(struct sctp_tcb *stcb, struct sctp_nets *net, int augment, uint8_t from)
{
      struct sctp_cwnd_log sctp_clog;

      sctp_clog.x.cwnd.net = net;
      if (stcb->asoc.send_queue_cnt > 255)
            sctp_clog.x.cwnd.cnt_in_send = 255;
      else
            sctp_clog.x.cwnd.cnt_in_send = stcb->asoc.send_queue_cnt;
      if (stcb->asoc.stream_queue_cnt > 255)
            sctp_clog.x.cwnd.cnt_in_str = 255;
      else
            sctp_clog.x.cwnd.cnt_in_str = stcb->asoc.stream_queue_cnt;

      if (net) {
            sctp_clog.x.cwnd.cwnd_new_value = net->cwnd;
            sctp_clog.x.cwnd.inflight = net->flight_size;
            sctp_clog.x.cwnd.pseudo_cumack = net->pseudo_cumack;
            sctp_clog.x.cwnd.meets_pseudo_cumack = net->new_pseudo_cumack;
            sctp_clog.x.cwnd.need_new_pseudo_cumack = net->find_pseudo_cumack;
      }
      if (SCTP_CWNDLOG_PRESEND == from) {
            sctp_clog.x.cwnd.meets_pseudo_cumack = stcb->asoc.peers_rwnd;
      }
      sctp_clog.x.cwnd.cwnd_augment = augment;
      SCTP_CTR6(KTR_SCTP, "SCTP:%d[%d]:%x-%x-%x-%x",
          SCTP_LOG_EVENT_CWND,
          from,
          sctp_clog.x.misc.log1,
          sctp_clog.x.misc.log2,
          sctp_clog.x.misc.log3,
          sctp_clog.x.misc.log4);

}

void
sctp_log_lock(struct sctp_inpcb *inp, struct sctp_tcb *stcb, uint8_t from)
{
      struct sctp_cwnd_log sctp_clog;

      if (inp) {
            sctp_clog.x.lock.sock = (void *)inp->sctp_socket;

      } else {
            sctp_clog.x.lock.sock = (void *)NULL;
      }
      sctp_clog.x.lock.inp = (void *)inp;
      if (stcb) {
            sctp_clog.x.lock.tcb_lock = mtx_owned(&stcb->tcb_mtx);
      } else {
            sctp_clog.x.lock.tcb_lock = SCTP_LOCK_UNKNOWN;
      }
      if (inp) {
            sctp_clog.x.lock.inp_lock = mtx_owned(&inp->inp_mtx);
            sctp_clog.x.lock.create_lock = mtx_owned(&inp->inp_create_mtx);
      } else {
            sctp_clog.x.lock.inp_lock = SCTP_LOCK_UNKNOWN;
            sctp_clog.x.lock.create_lock = SCTP_LOCK_UNKNOWN;
      }
      sctp_clog.x.lock.info_lock = rw_wowned(&sctppcbinfo.ipi_ep_mtx);
      if (inp->sctp_socket) {
            sctp_clog.x.lock.sock_lock = mtx_owned(&(inp->sctp_socket->so_rcv.sb_mtx));
            sctp_clog.x.lock.sockrcvbuf_lock = mtx_owned(&(inp->sctp_socket->so_rcv.sb_mtx));
            sctp_clog.x.lock.socksndbuf_lock = mtx_owned(&(inp->sctp_socket->so_snd.sb_mtx));
      } else {
            sctp_clog.x.lock.sock_lock = SCTP_LOCK_UNKNOWN;
            sctp_clog.x.lock.sockrcvbuf_lock = SCTP_LOCK_UNKNOWN;
            sctp_clog.x.lock.socksndbuf_lock = SCTP_LOCK_UNKNOWN;
      }
      SCTP_CTR6(KTR_SCTP, "SCTP:%d[%d]:%x-%x-%x-%x",
          SCTP_LOG_LOCK_EVENT,
          from,
          sctp_clog.x.misc.log1,
          sctp_clog.x.misc.log2,
          sctp_clog.x.misc.log3,
          sctp_clog.x.misc.log4);

}

void
sctp_log_maxburst(struct sctp_tcb *stcb, struct sctp_nets *net, int error, int burst, uint8_t from)
{
      struct sctp_cwnd_log sctp_clog;

      sctp_clog.x.cwnd.net = net;
      sctp_clog.x.cwnd.cwnd_new_value = error;
      sctp_clog.x.cwnd.inflight = net->flight_size;
      sctp_clog.x.cwnd.cwnd_augment = burst;
      if (stcb->asoc.send_queue_cnt > 255)
            sctp_clog.x.cwnd.cnt_in_send = 255;
      else
            sctp_clog.x.cwnd.cnt_in_send = stcb->asoc.send_queue_cnt;
      if (stcb->asoc.stream_queue_cnt > 255)
            sctp_clog.x.cwnd.cnt_in_str = 255;
      else
            sctp_clog.x.cwnd.cnt_in_str = stcb->asoc.stream_queue_cnt;
      SCTP_CTR6(KTR_SCTP, "SCTP:%d[%d]:%x-%x-%x-%x",
          SCTP_LOG_EVENT_MAXBURST,
          from,
          sctp_clog.x.misc.log1,
          sctp_clog.x.misc.log2,
          sctp_clog.x.misc.log3,
          sctp_clog.x.misc.log4);

}

void
sctp_log_rwnd(uint8_t from, uint32_t peers_rwnd, uint32_t snd_size, uint32_t overhead)
{
      struct sctp_cwnd_log sctp_clog;

      sctp_clog.x.rwnd.rwnd = peers_rwnd;
      sctp_clog.x.rwnd.send_size = snd_size;
      sctp_clog.x.rwnd.overhead = overhead;
      sctp_clog.x.rwnd.new_rwnd = 0;
      SCTP_CTR6(KTR_SCTP, "SCTP:%d[%d]:%x-%x-%x-%x",
          SCTP_LOG_EVENT_RWND,
          from,
          sctp_clog.x.misc.log1,
          sctp_clog.x.misc.log2,
          sctp_clog.x.misc.log3,
          sctp_clog.x.misc.log4);
}

void
sctp_log_rwnd_set(uint8_t from, uint32_t peers_rwnd, uint32_t flight_size, uint32_t overhead, uint32_t a_rwndval)
{
      struct sctp_cwnd_log sctp_clog;

      sctp_clog.x.rwnd.rwnd = peers_rwnd;
      sctp_clog.x.rwnd.send_size = flight_size;
      sctp_clog.x.rwnd.overhead = overhead;
      sctp_clog.x.rwnd.new_rwnd = a_rwndval;
      SCTP_CTR6(KTR_SCTP, "SCTP:%d[%d]:%x-%x-%x-%x",
          SCTP_LOG_EVENT_RWND,
          from,
          sctp_clog.x.misc.log1,
          sctp_clog.x.misc.log2,
          sctp_clog.x.misc.log3,
          sctp_clog.x.misc.log4);
}

void
sctp_log_mbcnt(uint8_t from, uint32_t total_oq, uint32_t book, uint32_t total_mbcnt_q, uint32_t mbcnt)
{
      struct sctp_cwnd_log sctp_clog;

      sctp_clog.x.mbcnt.total_queue_size = total_oq;
      sctp_clog.x.mbcnt.size_change = book;
      sctp_clog.x.mbcnt.total_queue_mb_size = total_mbcnt_q;
      sctp_clog.x.mbcnt.mbcnt_change = mbcnt;
      SCTP_CTR6(KTR_SCTP, "SCTP:%d[%d]:%x-%x-%x-%x",
          SCTP_LOG_EVENT_MBCNT,
          from,
          sctp_clog.x.misc.log1,
          sctp_clog.x.misc.log2,
          sctp_clog.x.misc.log3,
          sctp_clog.x.misc.log4);

}

void
sctp_misc_ints(uint8_t from, uint32_t a, uint32_t b, uint32_t c, uint32_t d)
{
      SCTP_CTR6(KTR_SCTP, "SCTP:%d[%d]:%x-%x-%x-%x",
          SCTP_LOG_MISC_EVENT,
          from,
          a, b, c, d);
}

void
sctp_wakeup_log(struct sctp_tcb *stcb, uint32_t cumtsn, uint32_t wake_cnt, int from)
{
      struct sctp_cwnd_log sctp_clog;

      sctp_clog.x.wake.stcb = (void *)stcb;
      sctp_clog.x.wake.wake_cnt = wake_cnt;
      sctp_clog.x.wake.flight = stcb->asoc.total_flight_count;
      sctp_clog.x.wake.send_q = stcb->asoc.send_queue_cnt;
      sctp_clog.x.wake.sent_q = stcb->asoc.sent_queue_cnt;

      if (stcb->asoc.stream_queue_cnt < 0xff)
            sctp_clog.x.wake.stream_qcnt = (uint8_t) stcb->asoc.stream_queue_cnt;
      else
            sctp_clog.x.wake.stream_qcnt = 0xff;

      if (stcb->asoc.chunks_on_out_queue < 0xff)
            sctp_clog.x.wake.chunks_on_oque = (uint8_t) stcb->asoc.chunks_on_out_queue;
      else
            sctp_clog.x.wake.chunks_on_oque = 0xff;

      sctp_clog.x.wake.sctpflags = 0;
      /* set in the defered mode stuff */
      if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_DONT_WAKE)
            sctp_clog.x.wake.sctpflags |= 1;
      if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_WAKEOUTPUT)
            sctp_clog.x.wake.sctpflags |= 2;
      if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_WAKEINPUT)
            sctp_clog.x.wake.sctpflags |= 4;
      /* what about the sb */
      if (stcb->sctp_socket) {
            struct socket *so = stcb->sctp_socket;

            sctp_clog.x.wake.sbflags = (uint8_t) ((so->so_snd.sb_flags & 0x00ff));
      } else {
            sctp_clog.x.wake.sbflags = 0xff;
      }
      SCTP_CTR6(KTR_SCTP, "SCTP:%d[%d]:%x-%x-%x-%x",
          SCTP_LOG_EVENT_WAKE,
          from,
          sctp_clog.x.misc.log1,
          sctp_clog.x.misc.log2,
          sctp_clog.x.misc.log3,
          sctp_clog.x.misc.log4);

}

void
sctp_log_block(uint8_t from, struct socket *so, struct sctp_association *asoc, int sendlen)
{
      struct sctp_cwnd_log sctp_clog;

      sctp_clog.x.blk.onsb = asoc->total_output_queue_size;
      sctp_clog.x.blk.send_sent_qcnt = (uint16_t) (asoc->send_queue_cnt + asoc->sent_queue_cnt);
      sctp_clog.x.blk.peer_rwnd = asoc->peers_rwnd;
      sctp_clog.x.blk.stream_qcnt = (uint16_t) asoc->stream_queue_cnt;
      sctp_clog.x.blk.chunks_on_oque = (uint16_t) asoc->chunks_on_out_queue;
      sctp_clog.x.blk.flight_size = (uint16_t) (asoc->total_flight / 1024);
      sctp_clog.x.blk.sndlen = sendlen;
      SCTP_CTR6(KTR_SCTP, "SCTP:%d[%d]:%x-%x-%x-%x",
          SCTP_LOG_EVENT_BLOCK,
          from,
          sctp_clog.x.misc.log1,
          sctp_clog.x.misc.log2,
          sctp_clog.x.misc.log3,
          sctp_clog.x.misc.log4);

}

int
sctp_fill_stat_log(void *optval, size_t *optsize)
{
      /* May need to fix this if ktrdump does not work */
      return (0);
}

#ifdef SCTP_AUDITING_ENABLED
uint8_t sctp_audit_data[SCTP_AUDIT_SIZE][2];
static int sctp_audit_indx = 0;

static
void
sctp_print_audit_report(void)
{
      int i;
      int cnt;

      cnt = 0;
      for (i = sctp_audit_indx; i < SCTP_AUDIT_SIZE; i++) {
            if ((sctp_audit_data[i][0] == 0xe0) &&
                (sctp_audit_data[i][1] == 0x01)) {
                  cnt = 0;
                  SCTP_PRINTF("\n");
            } else if (sctp_audit_data[i][0] == 0xf0) {
                  cnt = 0;
                  SCTP_PRINTF("\n");
            } else if ((sctp_audit_data[i][0] == 0xc0) &&
                (sctp_audit_data[i][1] == 0x01)) {
                  SCTP_PRINTF("\n");
                  cnt = 0;
            }
            SCTP_PRINTF("%2.2x%2.2x ", (uint32_t) sctp_audit_data[i][0],
                (uint32_t) sctp_audit_data[i][1]);
            cnt++;
            if ((cnt % 14) == 0)
                  SCTP_PRINTF("\n");
      }
      for (i = 0; i < sctp_audit_indx; i++) {
            if ((sctp_audit_data[i][0] == 0xe0) &&
                (sctp_audit_data[i][1] == 0x01)) {
                  cnt = 0;
                  SCTP_PRINTF("\n");
            } else if (sctp_audit_data[i][0] == 0xf0) {
                  cnt = 0;
                  SCTP_PRINTF("\n");
            } else if ((sctp_audit_data[i][0] == 0xc0) &&
                (sctp_audit_data[i][1] == 0x01)) {
                  SCTP_PRINTF("\n");
                  cnt = 0;
            }
            SCTP_PRINTF("%2.2x%2.2x ", (uint32_t) sctp_audit_data[i][0],
                (uint32_t) sctp_audit_data[i][1]);
            cnt++;
            if ((cnt % 14) == 0)
                  SCTP_PRINTF("\n");
      }
      SCTP_PRINTF("\n");
}

void
sctp_auditing(int from, struct sctp_inpcb *inp, struct sctp_tcb *stcb,
    struct sctp_nets *net)
{
      int resend_cnt, tot_out, rep, tot_book_cnt;
      struct sctp_nets *lnet;
      struct sctp_tmit_chunk *chk;

      sctp_audit_data[sctp_audit_indx][0] = 0xAA;
      sctp_audit_data[sctp_audit_indx][1] = 0x000000ff & from;
      sctp_audit_indx++;
      if (sctp_audit_indx >= SCTP_AUDIT_SIZE) {
            sctp_audit_indx = 0;
      }
      if (inp == NULL) {
            sctp_audit_data[sctp_audit_indx][0] = 0xAF;
            sctp_audit_data[sctp_audit_indx][1] = 0x01;
            sctp_audit_indx++;
            if (sctp_audit_indx >= SCTP_AUDIT_SIZE) {
                  sctp_audit_indx = 0;
            }
            return;
      }
      if (stcb == NULL) {
            sctp_audit_data[sctp_audit_indx][0] = 0xAF;
            sctp_audit_data[sctp_audit_indx][1] = 0x02;
            sctp_audit_indx++;
            if (sctp_audit_indx >= SCTP_AUDIT_SIZE) {
                  sctp_audit_indx = 0;
            }
            return;
      }
      sctp_audit_data[sctp_audit_indx][0] = 0xA1;
      sctp_audit_data[sctp_audit_indx][1] =
          (0x000000ff & stcb->asoc.sent_queue_retran_cnt);
      sctp_audit_indx++;
      if (sctp_audit_indx >= SCTP_AUDIT_SIZE) {
            sctp_audit_indx = 0;
      }
      rep = 0;
      tot_book_cnt = 0;
      resend_cnt = tot_out = 0;
      TAILQ_FOREACH(chk, &stcb->asoc.sent_queue, sctp_next) {
            if (chk->sent == SCTP_DATAGRAM_RESEND) {
                  resend_cnt++;
            } else if (chk->sent < SCTP_DATAGRAM_RESEND) {
                  tot_out += chk->book_size;
                  tot_book_cnt++;
            }
      }
      if (resend_cnt != stcb->asoc.sent_queue_retran_cnt) {
            sctp_audit_data[sctp_audit_indx][0] = 0xAF;
            sctp_audit_data[sctp_audit_indx][1] = 0xA1;
            sctp_audit_indx++;
            if (sctp_audit_indx >= SCTP_AUDIT_SIZE) {
                  sctp_audit_indx = 0;
            }
            SCTP_PRINTF("resend_cnt:%d asoc-tot:%d\n",
                resend_cnt, stcb->asoc.sent_queue_retran_cnt);
            rep = 1;
            stcb->asoc.sent_queue_retran_cnt = resend_cnt;
            sctp_audit_data[sctp_audit_indx][0] = 0xA2;
            sctp_audit_data[sctp_audit_indx][1] =
                (0x000000ff & stcb->asoc.sent_queue_retran_cnt);
            sctp_audit_indx++;
            if (sctp_audit_indx >= SCTP_AUDIT_SIZE) {
                  sctp_audit_indx = 0;
            }
      }
      if (tot_out != stcb->asoc.total_flight) {
            sctp_audit_data[sctp_audit_indx][0] = 0xAF;
            sctp_audit_data[sctp_audit_indx][1] = 0xA2;
            sctp_audit_indx++;
            if (sctp_audit_indx >= SCTP_AUDIT_SIZE) {
                  sctp_audit_indx = 0;
            }
            rep = 1;
            SCTP_PRINTF("tot_flt:%d asoc_tot:%d\n", tot_out,
                (int)stcb->asoc.total_flight);
            stcb->asoc.total_flight = tot_out;
      }
      if (tot_book_cnt != stcb->asoc.total_flight_count) {
            sctp_audit_data[sctp_audit_indx][0] = 0xAF;
            sctp_audit_data[sctp_audit_indx][1] = 0xA5;
            sctp_audit_indx++;
            if (sctp_audit_indx >= SCTP_AUDIT_SIZE) {
                  sctp_audit_indx = 0;
            }
            rep = 1;
            SCTP_PRINTF("tot_flt_book:%d\n", tot_book);

            stcb->asoc.total_flight_count = tot_book_cnt;
      }
      tot_out = 0;
      TAILQ_FOREACH(lnet, &stcb->asoc.nets, sctp_next) {
            tot_out += lnet->flight_size;
      }
      if (tot_out != stcb->asoc.total_flight) {
            sctp_audit_data[sctp_audit_indx][0] = 0xAF;
            sctp_audit_data[sctp_audit_indx][1] = 0xA3;
            sctp_audit_indx++;
            if (sctp_audit_indx >= SCTP_AUDIT_SIZE) {
                  sctp_audit_indx = 0;
            }
            rep = 1;
            SCTP_PRINTF("real flight:%d net total was %d\n",
                stcb->asoc.total_flight, tot_out);
            /* now corrective action */
            TAILQ_FOREACH(lnet, &stcb->asoc.nets, sctp_next) {

                  tot_out = 0;
                  TAILQ_FOREACH(chk, &stcb->asoc.sent_queue, sctp_next) {
                        if ((chk->whoTo == lnet) &&
                            (chk->sent < SCTP_DATAGRAM_RESEND)) {
                              tot_out += chk->book_size;
                        }
                  }
                  if (lnet->flight_size != tot_out) {
                        SCTP_PRINTF("net:%x flight was %d corrected to %d\n",
                            (uint32_t) lnet, lnet->flight_size,
                            tot_out);
                        lnet->flight_size = tot_out;
                  }
            }
      }
      if (rep) {
            sctp_print_audit_report();
      }
}

void
sctp_audit_log(uint8_t ev, uint8_t fd)
{

      sctp_audit_data[sctp_audit_indx][0] = ev;
      sctp_audit_data[sctp_audit_indx][1] = fd;
      sctp_audit_indx++;
      if (sctp_audit_indx >= SCTP_AUDIT_SIZE) {
            sctp_audit_indx = 0;
      }
}

#endif

/*
 * a list of sizes based on typical mtu's, used only if next hop size not
 * returned.
 */
static int sctp_mtu_sizes[] = {
      68,
      296,
      508,
      512,
      544,
      576,
      1006,
      1492,
      1500,
      1536,
      2002,
      2048,
      4352,
      4464,
      8166,
      17914,
      32000,
      65535
};

void
sctp_stop_timers_for_shutdown(struct sctp_tcb *stcb)
{
      struct sctp_association *asoc;
      struct sctp_nets *net;

      asoc = &stcb->asoc;

      (void)SCTP_OS_TIMER_STOP(&asoc->hb_timer.timer);
      (void)SCTP_OS_TIMER_STOP(&asoc->dack_timer.timer);
      (void)SCTP_OS_TIMER_STOP(&asoc->strreset_timer.timer);
      (void)SCTP_OS_TIMER_STOP(&asoc->asconf_timer.timer);
      (void)SCTP_OS_TIMER_STOP(&asoc->autoclose_timer.timer);
      (void)SCTP_OS_TIMER_STOP(&asoc->delayed_event_timer.timer);
      TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
            (void)SCTP_OS_TIMER_STOP(&net->fr_timer.timer);
            (void)SCTP_OS_TIMER_STOP(&net->pmtu_timer.timer);
      }
}

int
find_next_best_mtu(int totsz)
{
      int i, perfer;

      /*
       * if we are in here we must find the next best fit based on the
       * size of the dg that failed to be sent.
       */
      perfer = 0;
      for (i = 0; i < NUMBER_OF_MTU_SIZES; i++) {
            if (totsz < sctp_mtu_sizes[i]) {
                  perfer = i - 1;
                  if (perfer < 0)
                        perfer = 0;
                  break;
            }
      }
      return (sctp_mtu_sizes[perfer]);
}

void
sctp_fill_random_store(struct sctp_pcb *m)
{
      /*
       * Here we use the MD5/SHA-1 to hash with our good randomNumbers and
       * our counter. The result becomes our good random numbers and we
       * then setup to give these out. Note that we do no locking to
       * protect this. This is ok, since if competing folks call this we
       * will get more gobbled gook in the random store which is what we
       * want. There is a danger that two guys will use the same random
       * numbers, but thats ok too since that is random as well :->
       */
      m->store_at = 0;
      (void)sctp_hmac(SCTP_HMAC, (uint8_t *) m->random_numbers,
          sizeof(m->random_numbers), (uint8_t *) & m->random_counter,
          sizeof(m->random_counter), (uint8_t *) m->random_store);
      m->random_counter++;
}

uint32_t
sctp_select_initial_TSN(struct sctp_pcb *inp)
{
      /*
       * A true implementation should use random selection process to get
       * the initial stream sequence number, using RFC1750 as a good
       * guideline
       */
      uint32_t x, *xp;
      uint8_t *p;
      int store_at, new_store;

      if (inp->initial_sequence_debug != 0) {
            uint32_t ret;

            ret = inp->initial_sequence_debug;
            inp->initial_sequence_debug++;
            return (ret);
      }
retry:
      store_at = inp->store_at;
      new_store = store_at + sizeof(uint32_t);
      if (new_store >= (SCTP_SIGNATURE_SIZE - 3)) {
            new_store = 0;
      }
      if (!atomic_cmpset_int(&inp->store_at, store_at, new_store)) {
            goto retry;
      }
      if (new_store == 0) {
            /* Refill the random store */
            sctp_fill_random_store(inp);
      }
      p = &inp->random_store[store_at];
      xp = (uint32_t *) p;
      x = *xp;
      return (x);
}

uint32_t
sctp_select_a_tag(struct sctp_inpcb *inp, int save_in_twait)
{
      u_long x, not_done;
      struct timeval now;

      (void)SCTP_GETTIME_TIMEVAL(&now);
      not_done = 1;
      while (not_done) {
            x = sctp_select_initial_TSN(&inp->sctp_ep);
            if (x == 0) {
                  /* we never use 0 */
                  continue;
            }
            if (sctp_is_vtag_good(inp, x, &now, save_in_twait)) {
                  not_done = 0;
            }
      }
      return (x);
}

int
sctp_init_asoc(struct sctp_inpcb *m, struct sctp_tcb *stcb,
    int for_a_init, uint32_t override_tag, uint32_t vrf_id)
{
      struct sctp_association *asoc;

      /*
       * Anything set to zero is taken care of by the allocation routine's
       * bzero
       */

      /*
       * Up front select what scoping to apply on addresses I tell my peer
       * Not sure what to do with these right now, we will need to come up
       * with a way to set them. We may need to pass them through from the
       * caller in the sctp_aloc_assoc() function.
       */
      int i;

      asoc = &stcb->asoc;
      /* init all variables to a known value. */
      SCTP_SET_STATE(&stcb->asoc, SCTP_STATE_INUSE);
      asoc->max_burst = m->sctp_ep.max_burst;
      asoc->heart_beat_delay = TICKS_TO_MSEC(m->sctp_ep.sctp_timeoutticks[SCTP_TIMER_HEARTBEAT]);
      asoc->cookie_life = m->sctp_ep.def_cookie_life;
      asoc->sctp_cmt_on_off = (uint8_t) sctp_cmt_on_off;
      /* JRS 5/21/07 - Init CMT PF variables */
      asoc->sctp_cmt_pf = (uint8_t) sctp_cmt_pf;
      asoc->sctp_frag_point = m->sctp_frag_point;
#ifdef INET
      asoc->default_tos = m->ip_inp.inp.inp_ip_tos;
#else
      asoc->default_tos = 0;
#endif

#ifdef INET6
      asoc->default_flowlabel = ((struct in6pcb *)m)->in6p_flowinfo;
#else
      asoc->default_flowlabel = 0;
#endif
      asoc->sb_send_resv = 0;
      if (override_tag) {
            struct timeval now;

            (void)SCTP_GETTIME_TIMEVAL(&now);
            if (sctp_is_in_timewait(override_tag)) {
                  /*
                   * It must be in the time-wait hash, we put it there
                   * when we aloc one. If not the peer is playing
                   * games.
                   */
                  asoc->my_vtag = override_tag;
            } else {
                  SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTPUTIL, ENOMEM);
                  panic("Huh is_in_timewait fails");
                  return (ENOMEM);
            }

      } else {
            asoc->my_vtag = sctp_select_a_tag(m, 1);
      }
      /* Get the nonce tags */
      asoc->my_vtag_nonce = sctp_select_a_tag(m, 0);
      asoc->peer_vtag_nonce = sctp_select_a_tag(m, 0);
      asoc->vrf_id = vrf_id;

      if (sctp_is_feature_on(m, SCTP_PCB_FLAGS_DONOT_HEARTBEAT))
            asoc->hb_is_disabled = 1;
      else
            asoc->hb_is_disabled = 0;

#ifdef SCTP_ASOCLOG_OF_TSNS
      asoc->tsn_in_at = 0;
      asoc->tsn_out_at = 0;
      asoc->tsn_in_wrapped = 0;
      asoc->tsn_out_wrapped = 0;
      asoc->cumack_log_at = 0;
      asoc->cumack_log_atsnt = 0;
#endif
#ifdef SCTP_FS_SPEC_LOG
      asoc->fs_index = 0;
#endif
      asoc->refcnt = 0;
      asoc->assoc_up_sent = 0;
      asoc->assoc_id = asoc->my_vtag;
      asoc->asconf_seq_out = asoc->str_reset_seq_out = asoc->init_seq_number = asoc->sending_seq =
          sctp_select_initial_TSN(&m->sctp_ep);
      /* we are optimisitic here */
      asoc->peer_supports_pktdrop = 1;

      asoc->sent_queue_retran_cnt = 0;

      /* for CMT */
      asoc->last_net_data_came_from = NULL;

      /* This will need to be adjusted */
      asoc->last_cwr_tsn = asoc->init_seq_number - 1;
      asoc->last_acked_seq = asoc->init_seq_number - 1;
      asoc->advanced_peer_ack_point = asoc->last_acked_seq;
      asoc->asconf_seq_in = asoc->last_acked_seq;

      /* here we are different, we hold the next one we expect */
      asoc->str_reset_seq_in = asoc->last_acked_seq + 1;

      asoc->initial_init_rto_max = m->sctp_ep.initial_init_rto_max;
      asoc->initial_rto = m->sctp_ep.initial_rto;

      asoc->max_init_times = m->sctp_ep.max_init_times;
      asoc->max_send_times = m->sctp_ep.max_send_times;
      asoc->def_net_failure = m->sctp_ep.def_net_failure;
      asoc->free_chunk_cnt = 0;

      asoc->iam_blocking = 0;
      /* ECN Nonce initialization */
      asoc->context = m->sctp_context;
      asoc->def_send = m->def_send;
      asoc->ecn_nonce_allowed = 0;
      asoc->receiver_nonce_sum = 1;
      asoc->nonce_sum_expect_base = 1;
      asoc->nonce_sum_check = 1;
      asoc->nonce_resync_tsn = 0;
      asoc->nonce_wait_for_ecne = 0;
      asoc->nonce_wait_tsn = 0;
      asoc->delayed_ack = TICKS_TO_MSEC(m->sctp_ep.sctp_timeoutticks[SCTP_TIMER_RECV]);
      asoc->sack_freq = m->sctp_ep.sctp_sack_freq;
      asoc->pr_sctp_cnt = 0;
      asoc->total_output_queue_size = 0;

      if (m->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) {
            struct in6pcb *inp6;

            /* Its a V6 socket */
            inp6 = (struct in6pcb *)m;
            asoc->ipv6_addr_legal = 1;
            /* Now look at the binding flag to see if V4 will be legal */
            if (SCTP_IPV6_V6ONLY(inp6) == 0) {
                  asoc->ipv4_addr_legal = 1;
            } else {
                  /* V4 addresses are NOT legal on the association */
                  asoc->ipv4_addr_legal = 0;
            }
      } else {
            /* Its a V4 socket, no - V6 */
            asoc->ipv4_addr_legal = 1;
            asoc->ipv6_addr_legal = 0;
      }

      asoc->my_rwnd = max(SCTP_SB_LIMIT_RCV(m->sctp_socket), SCTP_MINIMAL_RWND);
      asoc->peers_rwnd = SCTP_SB_LIMIT_RCV(m->sctp_socket);

      asoc->smallest_mtu = m->sctp_frag_point;
#ifdef SCTP_PRINT_FOR_B_AND_M
      SCTP_PRINTF("smallest_mtu init'd with asoc to :%d\n",
          asoc->smallest_mtu);
#endif
      asoc->minrto = m->sctp_ep.sctp_minrto;
      asoc->maxrto = m->sctp_ep.sctp_maxrto;

      asoc->locked_on_sending = NULL;
      asoc->stream_locked_on = 0;
      asoc->ecn_echo_cnt_onq = 0;
      asoc->stream_locked = 0;

      asoc->send_sack = 1;

      LIST_INIT(&asoc->sctp_restricted_addrs);

      TAILQ_INIT(&asoc->nets);
      TAILQ_INIT(&asoc->pending_reply_queue);
      TAILQ_INIT(&asoc->asconf_ack_sent);
      /* Setup to fill the hb random cache at first HB */
      asoc->hb_random_idx = 4;

      asoc->sctp_autoclose_ticks = m->sctp_ep.auto_close_time;

      /*
       * JRS - Pick the default congestion control module based on the
       * sysctl.
       */
      switch (m->sctp_ep.sctp_default_cc_module) {
            /* JRS - Standard TCP congestion control */
      case SCTP_CC_RFC2581:
            {
                  stcb->asoc.congestion_control_module = SCTP_CC_RFC2581;
                  stcb->asoc.cc_functions.sctp_set_initial_cc_param = &sctp_set_initial_cc_param;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_sack = &sctp_cwnd_update_after_sack;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_fr = &sctp_cwnd_update_after_fr;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_timeout = &sctp_cwnd_update_after_timeout;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_ecn_echo = &sctp_cwnd_update_after_ecn_echo;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_packet_dropped = &sctp_cwnd_update_after_packet_dropped;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_output = &sctp_cwnd_update_after_output;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_fr_timer = &sctp_cwnd_update_after_fr_timer;
                  break;
            }
            /* JRS - High Speed TCP congestion control (Floyd) */
      case SCTP_CC_HSTCP:
            {
                  stcb->asoc.congestion_control_module = SCTP_CC_HSTCP;
                  stcb->asoc.cc_functions.sctp_set_initial_cc_param = &sctp_set_initial_cc_param;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_sack = &sctp_hs_cwnd_update_after_sack;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_fr = &sctp_hs_cwnd_update_after_fr;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_timeout = &sctp_cwnd_update_after_timeout;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_ecn_echo = &sctp_cwnd_update_after_ecn_echo;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_packet_dropped = &sctp_cwnd_update_after_packet_dropped;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_output = &sctp_cwnd_update_after_output;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_fr_timer = &sctp_cwnd_update_after_fr_timer;
                  break;
            }
            /* JRS - HTCP congestion control */
      case SCTP_CC_HTCP:
            {
                  stcb->asoc.congestion_control_module = SCTP_CC_HTCP;
                  stcb->asoc.cc_functions.sctp_set_initial_cc_param = &sctp_htcp_set_initial_cc_param;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_sack = &sctp_htcp_cwnd_update_after_sack;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_fr = &sctp_htcp_cwnd_update_after_fr;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_timeout = &sctp_htcp_cwnd_update_after_timeout;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_ecn_echo = &sctp_htcp_cwnd_update_after_ecn_echo;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_packet_dropped = &sctp_cwnd_update_after_packet_dropped;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_output = &sctp_cwnd_update_after_output;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_fr_timer = &sctp_htcp_cwnd_update_after_fr_timer;
                  break;
            }
            /* JRS - By default, use RFC2581 */
      default:
            {
                  stcb->asoc.congestion_control_module = SCTP_CC_RFC2581;
                  stcb->asoc.cc_functions.sctp_set_initial_cc_param = &sctp_set_initial_cc_param;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_sack = &sctp_cwnd_update_after_sack;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_fr = &sctp_cwnd_update_after_fr;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_timeout = &sctp_cwnd_update_after_timeout;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_ecn_echo = &sctp_cwnd_update_after_ecn_echo;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_packet_dropped = &sctp_cwnd_update_after_packet_dropped;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_output = &sctp_cwnd_update_after_output;
                  stcb->asoc.cc_functions.sctp_cwnd_update_after_fr_timer = &sctp_cwnd_update_after_fr_timer;
                  break;
            }
      }

      /*
       * Now the stream parameters, here we allocate space for all streams
       * that we request by default.
       */
      asoc->streamoutcnt = asoc->pre_open_streams =
          m->sctp_ep.pre_open_stream_count;
      SCTP_MALLOC(asoc->strmout, struct sctp_stream_out *,
          asoc->streamoutcnt * sizeof(struct sctp_stream_out),
          SCTP_M_STRMO);
      if (asoc->strmout == NULL) {
            /* big trouble no memory */
            SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTPUTIL, ENOMEM);
            return (ENOMEM);
      }
      for (i = 0; i < asoc->streamoutcnt; i++) {
            /*
             * inbound side must be set to 0xffff, also NOTE when we get
             * the INIT-ACK back (for INIT sender) we MUST reduce the
             * count (streamoutcnt) but first check if we sent to any of
             * the upper streams that were dropped (if some were). Those
             * that were dropped must be notified to the upper layer as
             * failed to send.
             */
            asoc->strmout[i].next_sequence_sent = 0x0;
            TAILQ_INIT(&asoc->strmout[i].outqueue);
            asoc->strmout[i].stream_no = i;
            asoc->strmout[i].last_msg_incomplete = 0;
            asoc->strmout[i].next_spoke.tqe_next = 0;
            asoc->strmout[i].next_spoke.tqe_prev = 0;
      }
      /* Now the mapping array */
      asoc->mapping_array_size = SCTP_INITIAL_MAPPING_ARRAY;
      SCTP_MALLOC(asoc->mapping_array, uint8_t *, asoc->mapping_array_size,
          SCTP_M_MAP);
      if (asoc->mapping_array == NULL) {
            SCTP_FREE(asoc->strmout, SCTP_M_STRMO);
            SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTPUTIL, ENOMEM);
            return (ENOMEM);
      }
      memset(asoc->mapping_array, 0, asoc->mapping_array_size);
      /* Now the init of the other outqueues */
      TAILQ_INIT(&asoc->free_chunks);
      TAILQ_INIT(&asoc->out_wheel);
      TAILQ_INIT(&asoc->control_send_queue);
      TAILQ_INIT(&asoc->send_queue);
      TAILQ_INIT(&asoc->sent_queue);
      TAILQ_INIT(&asoc->reasmqueue);
      TAILQ_INIT(&asoc->resetHead);
      asoc->max_inbound_streams = m->sctp_ep.max_open_streams_intome;
      TAILQ_INIT(&asoc->asconf_queue);
      /* authentication fields */
      asoc->authinfo.random = NULL;
      asoc->authinfo.assoc_key = NULL;
      asoc->authinfo.assoc_keyid = 0;
      asoc->authinfo.recv_key = NULL;
      asoc->authinfo.recv_keyid = 0;
      LIST_INIT(&asoc->shared_keys);
      asoc->marked_retrans = 0;
      asoc->timoinit = 0;
      asoc->timodata = 0;
      asoc->timosack = 0;
      asoc->timoshutdown = 0;
      asoc->timoheartbeat = 0;
      asoc->timocookie = 0;
      asoc->timoshutdownack = 0;
      (void)SCTP_GETTIME_TIMEVAL(&asoc->start_time);
      asoc->discontinuity_time = asoc->start_time;
      /*
       * sa_ignore MEMLEAK {memory is put in the assoc mapping array and
       * freed later whe the association is freed.
       */
      return (0);
}

int
sctp_expand_mapping_array(struct sctp_association *asoc, uint32_t needed)
{
      /* mapping array needs to grow */
      uint8_t *new_array;
      uint32_t new_size;

      new_size = asoc->mapping_array_size + ((needed + 7) / 8 + SCTP_MAPPING_ARRAY_INCR);
      SCTP_MALLOC(new_array, uint8_t *, new_size, SCTP_M_MAP);
      if (new_array == NULL) {
            /* can't get more, forget it */
            SCTP_PRINTF("No memory for expansion of SCTP mapping array %d\n",
                new_size);
            return (-1);
      }
      memset(new_array, 0, new_size);
      memcpy(new_array, asoc->mapping_array, asoc->mapping_array_size);
      SCTP_FREE(asoc->mapping_array, SCTP_M_MAP);
      asoc->mapping_array = new_array;
      asoc->mapping_array_size = new_size;
      return (0);
}

#if defined(SCTP_USE_THREAD_BASED_ITERATOR)
static void
sctp_iterator_work(struct sctp_iterator *it)
{
      int iteration_count = 0;
      int inp_skip = 0;

      SCTP_ITERATOR_LOCK();
      if (it->inp) {
            SCTP_INP_DECR_REF(it->inp);
      }
      if (it->inp == NULL) {
            /* iterator is complete */
done_with_iterator:
            SCTP_ITERATOR_UNLOCK();
            if (it->function_atend != NULL) {
                  (*it->function_atend) (it->pointer, it->val);
            }
            SCTP_FREE(it, SCTP_M_ITER);
            return;
      }
select_a_new_ep:
      SCTP_INP_WLOCK(it->inp);
      while (((it->pcb_flags) &&
          ((it->inp->sctp_flags & it->pcb_flags) != it->pcb_flags)) ||
          ((it->pcb_features) &&
          ((it->inp->sctp_features & it->pcb_features) != it->pcb_features))) {
            /* endpoint flags or features don't match, so keep looking */
            if (it->iterator_flags & SCTP_ITERATOR_DO_SINGLE_INP) {
                  SCTP_INP_WUNLOCK(it->inp);
                  goto done_with_iterator;
            }
            SCTP_INP_WUNLOCK(it->inp);
            it->inp = LIST_NEXT(it->inp, sctp_list);
            if (it->inp == NULL) {
                  goto done_with_iterator;
            }
            SCTP_INP_WLOCK(it->inp);
      }

      SCTP_INP_WUNLOCK(it->inp);
      SCTP_INP_RLOCK(it->inp);

      /* now go through each assoc which is in the desired state */
      if (it->done_current_ep == 0) {
            if (it->function_inp != NULL)
                  inp_skip = (*it->function_inp) (it->inp, it->pointer, it->val);
            it->done_current_ep = 1;
      }
      if (it->stcb == NULL) {
            /* run the per instance function */
            it->stcb = LIST_FIRST(&it->inp->sctp_asoc_list);
      }
      if ((inp_skip) || it->stcb == NULL) {
            if (it->function_inp_end != NULL) {
                  inp_skip = (*it->function_inp_end) (it->inp,
                      it->pointer,
                      it->val);
            }
            SCTP_INP_RUNLOCK(it->inp);
            goto no_stcb;
      }
      while (it->stcb) {
            SCTP_TCB_LOCK(it->stcb);
            if (it->asoc_state && ((it->stcb->asoc.state & it->asoc_state) != it->asoc_state)) {
                  /* not in the right state... keep looking */
                  SCTP_TCB_UNLOCK(it->stcb);
                  goto next_assoc;
            }
            /* see if we have limited out the iterator loop */
            iteration_count++;
            if (iteration_count > SCTP_ITERATOR_MAX_AT_ONCE) {
                  /* Pause to let others grab the lock */
                  atomic_add_int(&it->stcb->asoc.refcnt, 1);
                  SCTP_TCB_UNLOCK(it->stcb);

                  SCTP_INP_INCR_REF(it->inp);
                  SCTP_INP_RUNLOCK(it->inp);
                  SCTP_ITERATOR_UNLOCK();
                  SCTP_ITERATOR_LOCK();
                  SCTP_INP_RLOCK(it->inp);

                  SCTP_INP_DECR_REF(it->inp);
                  SCTP_TCB_LOCK(it->stcb);
                  atomic_add_int(&it->stcb->asoc.refcnt, -1);
                  iteration_count = 0;
            }
            /* run function on this one */
            (*it->function_assoc) (it->inp, it->stcb, it->pointer, it->val);

            /*
             * we lie here, it really needs to have its own type but
             * first I must verify that this won't effect things :-0
             */
            if (it->no_chunk_output == 0)
                  sctp_chunk_output(it->inp, it->stcb, SCTP_OUTPUT_FROM_T3, SCTP_SO_NOT_LOCKED);

            SCTP_TCB_UNLOCK(it->stcb);
next_assoc:
            it->stcb = LIST_NEXT(it->stcb, sctp_tcblist);
            if (it->stcb == NULL) {
                  /* Run last function */
                  if (it->function_inp_end != NULL) {
                        inp_skip = (*it->function_inp_end) (it->inp,
                            it->pointer,
                            it->val);
                  }
            }
      }
      SCTP_INP_RUNLOCK(it->inp);
no_stcb:
      /* done with all assocs on this endpoint, move on to next endpoint */
      it->done_current_ep = 0;
      SCTP_INP_WLOCK(it->inp);
      SCTP_INP_WUNLOCK(it->inp);
      if (it->iterator_flags & SCTP_ITERATOR_DO_SINGLE_INP) {
            it->inp = NULL;
      } else {
            SCTP_INP_INFO_RLOCK();
            it->inp = LIST_NEXT(it->inp, sctp_list);
            SCTP_INP_INFO_RUNLOCK();
      }
      if (it->inp == NULL) {
            goto done_with_iterator;
      }
      goto select_a_new_ep;
}

void
sctp_iterator_worker(void)
{
      struct sctp_iterator *it = NULL;

      /* This function is called with the WQ lock in place */

      sctppcbinfo.iterator_running = 1;
again:
      it = TAILQ_FIRST(&sctppcbinfo.iteratorhead);
      while (it) {
            /* now lets work on this one */
            TAILQ_REMOVE(&sctppcbinfo.iteratorhead, it, sctp_nxt_itr);
            SCTP_IPI_ITERATOR_WQ_UNLOCK();
            sctp_iterator_work(it);
            SCTP_IPI_ITERATOR_WQ_LOCK();
            /* sa_ignore FREED_MEMORY */
            it = TAILQ_FIRST(&sctppcbinfo.iteratorhead);
      }
      if (TAILQ_FIRST(&sctppcbinfo.iteratorhead)) {
            goto again;
      }
      sctppcbinfo.iterator_running = 0;
      return;
}

#endif


static void
sctp_handle_addr_wq(void)
{
      /* deal with the ADDR wq from the rtsock calls */
      struct sctp_laddr *wi;
      struct sctp_asconf_iterator *asc;

      SCTP_MALLOC(asc, struct sctp_asconf_iterator *,
          sizeof(struct sctp_asconf_iterator), SCTP_M_ASC_IT);
      if (asc == NULL) {
            /* Try later, no memory */
            sctp_timer_start(SCTP_TIMER_TYPE_ADDR_WQ,
                (struct sctp_inpcb *)NULL,
                (struct sctp_tcb *)NULL,
                (struct sctp_nets *)NULL);
            return;
      }
      LIST_INIT(&asc->list_of_work);
      asc->cnt = 0;
      SCTP_IPI_ITERATOR_WQ_LOCK();
      wi = LIST_FIRST(&sctppcbinfo.addr_wq);
      while (wi != NULL) {
            LIST_REMOVE(wi, sctp_nxt_addr);
            LIST_INSERT_HEAD(&asc->list_of_work, wi, sctp_nxt_addr);
            asc->cnt++;
            wi = LIST_FIRST(&sctppcbinfo.addr_wq);
      }
      SCTP_IPI_ITERATOR_WQ_UNLOCK();
      if (asc->cnt == 0) {
            SCTP_FREE(asc, SCTP_M_ASC_IT);
      } else {
            (void)sctp_initiate_iterator(sctp_asconf_iterator_ep,
                sctp_asconf_iterator_stcb,
                NULL,   /* No ep end for boundall */
                SCTP_PCB_FLAGS_BOUNDALL,
                SCTP_PCB_ANY_FEATURES,
                SCTP_ASOC_ANY_STATE,
                (void *)asc, 0,
                sctp_asconf_iterator_end, NULL, 0);
      }
}

int retcode = 0;
int cur_oerr = 0;

void
sctp_timeout_handler(void *t)
{
      struct sctp_inpcb *inp;
      struct sctp_tcb *stcb;
      struct sctp_nets *net;
      struct sctp_timer *tmr;

#if defined (__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
      struct socket *so;

#endif
      int did_output;
      struct sctp_iterator *it = NULL;

      tmr = (struct sctp_timer *)t;
      inp = (struct sctp_inpcb *)tmr->ep;
      stcb = (struct sctp_tcb *)tmr->tcb;
      net = (struct sctp_nets *)tmr->net;
      did_output = 1;

#ifdef SCTP_AUDITING_ENABLED
      sctp_audit_log(0xF0, (uint8_t) tmr->type);
      sctp_auditing(3, inp, stcb, net);
#endif

      /* sanity checks... */
      if (tmr->self != (void *)tmr) {
            /*
             * SCTP_PRINTF("Stale SCTP timer fired (%p), ignoring...\n",
             * tmr);
             */
            return;
      }
      tmr->stopped_from = 0xa001;
      if (!SCTP_IS_TIMER_TYPE_VALID(tmr->type)) {
            /*
             * SCTP_PRINTF("SCTP timer fired with invalid type: 0x%x\n",
             * tmr->type);
             */
            return;
      }
      tmr->stopped_from = 0xa002;
      if ((tmr->type != SCTP_TIMER_TYPE_ADDR_WQ) && (inp == NULL)) {
            return;
      }
      /* if this is an iterator timeout, get the struct and clear inp */
      tmr->stopped_from = 0xa003;
      if (tmr->type == SCTP_TIMER_TYPE_ITERATOR) {
            it = (struct sctp_iterator *)inp;
            inp = NULL;
      }
      if (inp) {
            SCTP_INP_INCR_REF(inp);
            if ((inp->sctp_socket == 0) &&
                ((tmr->type != SCTP_TIMER_TYPE_INPKILL) &&
                (tmr->type != SCTP_TIMER_TYPE_SHUTDOWN) &&
                (tmr->type != SCTP_TIMER_TYPE_SHUTDOWNACK) &&
                (tmr->type != SCTP_TIMER_TYPE_SHUTDOWNGUARD) &&
                (tmr->type != SCTP_TIMER_TYPE_ASOCKILL))
                ) {
                  SCTP_INP_DECR_REF(inp);
                  return;
            }
      }
      tmr->stopped_from = 0xa004;
      if (stcb) {
            atomic_add_int(&stcb->asoc.refcnt, 1);
            if (stcb->asoc.state == 0) {
                  atomic_add_int(&stcb->asoc.refcnt, -1);
                  if (inp) {
                        SCTP_INP_DECR_REF(inp);
                  }
                  return;
            }
      }
      tmr->stopped_from = 0xa005;
      SCTPDBG(SCTP_DEBUG_TIMER1, "Timer type %d goes off\n", tmr->type);
      if (!SCTP_OS_TIMER_ACTIVE(&tmr->timer)) {
            if (inp) {
                  SCTP_INP_DECR_REF(inp);
            }
            if (stcb) {
                  atomic_add_int(&stcb->asoc.refcnt, -1);
            }
            return;
      }
      tmr->stopped_from = 0xa006;

      if (stcb) {
            SCTP_TCB_LOCK(stcb);
            atomic_add_int(&stcb->asoc.refcnt, -1);
            if ((tmr->type != SCTP_TIMER_TYPE_ASOCKILL) &&
                ((stcb->asoc.state == 0) ||
                (stcb->asoc.state & SCTP_STATE_ABOUT_TO_BE_FREED))) {
                  SCTP_TCB_UNLOCK(stcb);
                  if (inp) {
                        SCTP_INP_DECR_REF(inp);
                  }
                  return;
            }
      }
      /* record in stopped what t-o occured */
      tmr->stopped_from = tmr->type;

      /* mark as being serviced now */
      if (SCTP_OS_TIMER_PENDING(&tmr->timer)) {
            /*
             * Callout has been rescheduled.
             */
            goto get_out;
      }
      if (!SCTP_OS_TIMER_ACTIVE(&tmr->timer)) {
            /*
             * Not active, so no action.
             */
            goto get_out;
      }
      SCTP_OS_TIMER_DEACTIVATE(&tmr->timer);

      /* call the handler for the appropriate timer type */
      switch (tmr->type) {
      case SCTP_TIMER_TYPE_ZERO_COPY:
            if (inp == NULL) {
                  break;
            }
            if (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_ZERO_COPY_ACTIVE)) {
                  SCTP_ZERO_COPY_EVENT(inp, inp->sctp_socket);
            }
            break;
      case SCTP_TIMER_TYPE_ZCOPY_SENDQ:
            if (inp == NULL) {
                  break;
            }
            if (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_ZERO_COPY_ACTIVE)) {
                  SCTP_ZERO_COPY_SENDQ_EVENT(inp, inp->sctp_socket);
            }
            break;
      case SCTP_TIMER_TYPE_ADDR_WQ:
            sctp_handle_addr_wq();
            break;
      case SCTP_TIMER_TYPE_ITERATOR:
            SCTP_STAT_INCR(sctps_timoiterator);
            sctp_iterator_timer(it);
            break;
      case SCTP_TIMER_TYPE_SEND:
            if ((stcb == NULL) || (inp == NULL)) {
                  break;
            }
            SCTP_STAT_INCR(sctps_timodata);
            stcb->asoc.timodata++;
            stcb->asoc.num_send_timers_up--;
            if (stcb->asoc.num_send_timers_up < 0) {
                  stcb->asoc.num_send_timers_up = 0;
            }
            SCTP_TCB_LOCK_ASSERT(stcb);
            cur_oerr = stcb->asoc.overall_error_count;
            retcode = sctp_t3rxt_timer(inp, stcb, net);
            if (retcode) {
                  /* no need to unlock on tcb its gone */

                  goto out_decr;
            }
            SCTP_TCB_LOCK_ASSERT(stcb);
#ifdef SCTP_AUDITING_ENABLED
            sctp_auditing(4, inp, stcb, net);
#endif
            sctp_chunk_output(inp, stcb, SCTP_OUTPUT_FROM_T3, SCTP_SO_NOT_LOCKED);
            if ((stcb->asoc.num_send_timers_up == 0) &&
                (stcb->asoc.sent_queue_cnt > 0)
                ) {
                  struct sctp_tmit_chunk *chk;

                  /*
                   * safeguard. If there on some on the sent queue
                   * somewhere but no timers running something is
                   * wrong... so we start a timer on the first chunk
                   * on the send queue on whatever net it is sent to.
                   */
                  chk = TAILQ_FIRST(&stcb->asoc.sent_queue);
                  sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb,
                      chk->whoTo);
            }
            break;
      case SCTP_TIMER_TYPE_INIT:
            if ((stcb == NULL) || (inp == NULL)) {
                  break;
            }
            SCTP_STAT_INCR(sctps_timoinit);
            stcb->asoc.timoinit++;
            if (sctp_t1init_timer(inp, stcb, net)) {
                  /* no need to unlock on tcb its gone */
                  goto out_decr;
            }
            /* We do output but not here */
            did_output = 0;
            break;
      case SCTP_TIMER_TYPE_RECV:
            if ((stcb == NULL) || (inp == NULL)) {
                  break;
            } {
                  int abort_flag;

                  SCTP_STAT_INCR(sctps_timosack);
                  stcb->asoc.timosack++;
                  if (stcb->asoc.cumulative_tsn != stcb->asoc.highest_tsn_inside_map)
                        sctp_sack_check(stcb, 0, 0, &abort_flag);
                  sctp_send_sack(stcb);
            }
#ifdef SCTP_AUDITING_ENABLED
            sctp_auditing(4, inp, stcb, net);
#endif
            sctp_chunk_output(inp, stcb, SCTP_OUTPUT_FROM_SACK_TMR, SCTP_SO_NOT_LOCKED);
            break;
      case SCTP_TIMER_TYPE_SHUTDOWN:
            if ((stcb == NULL) || (inp == NULL)) {
                  break;
            }
            if (sctp_shutdown_timer(inp, stcb, net)) {
                  /* no need to unlock on tcb its gone */
                  goto out_decr;
            }
            SCTP_STAT_INCR(sctps_timoshutdown);
            stcb->asoc.timoshutdown++;
#ifdef SCTP_AUDITING_ENABLED
            sctp_auditing(4, inp, stcb, net);
#endif
            sctp_chunk_output(inp, stcb, SCTP_OUTPUT_FROM_SHUT_TMR, SCTP_SO_NOT_LOCKED);
            break;
      case SCTP_TIMER_TYPE_HEARTBEAT:
            {
                  struct sctp_nets *lnet;
                  int cnt_of_unconf = 0;

                  if ((stcb == NULL) || (inp == NULL)) {
                        break;
                  }
                  SCTP_STAT_INCR(sctps_timoheartbeat);
                  stcb->asoc.timoheartbeat++;
                  TAILQ_FOREACH(lnet, &stcb->asoc.nets, sctp_next) {
                        if ((lnet->dest_state & SCTP_ADDR_UNCONFIRMED) &&
                            (lnet->dest_state & SCTP_ADDR_REACHABLE)) {
                              cnt_of_unconf++;
                        }
                  }
                  if (cnt_of_unconf == 0) {
                        if (sctp_heartbeat_timer(inp, stcb, lnet,
                            cnt_of_unconf)) {
                              /* no need to unlock on tcb its gone */
                              goto out_decr;
                        }
                  }
#ifdef SCTP_AUDITING_ENABLED
                  sctp_auditing(4, inp, stcb, lnet);
#endif
                  sctp_timer_start(SCTP_TIMER_TYPE_HEARTBEAT,
                      stcb->sctp_ep, stcb, lnet);
                  sctp_chunk_output(inp, stcb, SCTP_OUTPUT_FROM_HB_TMR, SCTP_SO_NOT_LOCKED);
            }
            break;
      case SCTP_TIMER_TYPE_COOKIE:
            if ((stcb == NULL) || (inp == NULL)) {
                  break;
            }
            if (sctp_cookie_timer(inp, stcb, net)) {
                  /* no need to unlock on tcb its gone */
                  goto out_decr;
            }
            SCTP_STAT_INCR(sctps_timocookie);
            stcb->asoc.timocookie++;
#ifdef SCTP_AUDITING_ENABLED
            sctp_auditing(4, inp, stcb, net);
#endif
            /*
             * We consider T3 and Cookie timer pretty much the same with
             * respect to where from in chunk_output.
             */
            sctp_chunk_output(inp, stcb, SCTP_OUTPUT_FROM_T3, SCTP_SO_NOT_LOCKED);
            break;
      case SCTP_TIMER_TYPE_NEWCOOKIE:
            {
                  struct timeval tv;
                  int i, secret;

                  if (inp == NULL) {
                        break;
                  }
                  SCTP_STAT_INCR(sctps_timosecret);
                  (void)SCTP_GETTIME_TIMEVAL(&tv);
                  SCTP_INP_WLOCK(inp);
                  inp->sctp_ep.time_of_secret_change = tv.tv_sec;
                  inp->sctp_ep.last_secret_number =
                      inp->sctp_ep.current_secret_number;
                  inp->sctp_ep.current_secret_number++;
                  if (inp->sctp_ep.current_secret_number >=
                      SCTP_HOW_MANY_SECRETS) {
                        inp->sctp_ep.current_secret_number = 0;
                  }
                  secret = (int)inp->sctp_ep.current_secret_number;
                  for (i = 0; i < SCTP_NUMBER_OF_SECRETS; i++) {
                        inp->sctp_ep.secret_key[secret][i] =
                            sctp_select_initial_TSN(&inp->sctp_ep);
                  }
                  SCTP_INP_WUNLOCK(inp);
                  sctp_timer_start(SCTP_TIMER_TYPE_NEWCOOKIE, inp, stcb, net);
            }
            did_output = 0;
            break;
      case SCTP_TIMER_TYPE_PATHMTURAISE:
            if ((stcb == NULL) || (inp == NULL)) {
                  break;
            }
            SCTP_STAT_INCR(sctps_timopathmtu);
            sctp_pathmtu_timer(inp, stcb, net);
            did_output = 0;
            break;
      case SCTP_TIMER_TYPE_SHUTDOWNACK:
            if ((stcb == NULL) || (inp == NULL)) {
                  break;
            }
            if (sctp_shutdownack_timer(inp, stcb, net)) {
                  /* no need to unlock on tcb its gone */
                  goto out_decr;
            }
            SCTP_STAT_INCR(sctps_timoshutdownack);
            stcb->asoc.timoshutdownack++;
#ifdef SCTP_AUDITING_ENABLED
            sctp_auditing(4, inp, stcb, net);
#endif
            sctp_chunk_output(inp, stcb, SCTP_OUTPUT_FROM_SHUT_ACK_TMR, SCTP_SO_NOT_LOCKED);
            break;
      case SCTP_TIMER_TYPE_SHUTDOWNGUARD:
            if ((stcb == NULL) || (inp == NULL)) {
                  break;
            }
            SCTP_STAT_INCR(sctps_timoshutdownguard);
            sctp_abort_an_association(inp, stcb,
                SCTP_SHUTDOWN_GUARD_EXPIRES, NULL, SCTP_SO_NOT_LOCKED);
            /* no need to unlock on tcb its gone */
            goto out_decr;

      case SCTP_TIMER_TYPE_STRRESET:
            if ((stcb == NULL) || (inp == NULL)) {
                  break;
            }
            if (sctp_strreset_timer(inp, stcb, net)) {
                  /* no need to unlock on tcb its gone */
                  goto out_decr;
            }
            SCTP_STAT_INCR(sctps_timostrmrst);
            sctp_chunk_output(inp, stcb, SCTP_OUTPUT_FROM_STRRST_TMR, SCTP_SO_NOT_LOCKED);
            break;
      case SCTP_TIMER_TYPE_EARLYFR:
            /* Need to do FR of things for net */
            if ((stcb == NULL) || (inp == NULL)) {
                  break;
            }
            SCTP_STAT_INCR(sctps_timoearlyfr);
            sctp_early_fr_timer(inp, stcb, net);
            break;
      case SCTP_TIMER_TYPE_ASCONF:
            if ((stcb == NULL) || (inp == NULL)) {
                  break;
            }
            if (sctp_asconf_timer(inp, stcb, net)) {
                  /* no need to unlock on tcb its gone */
                  goto out_decr;
            }
            SCTP_STAT_INCR(sctps_timoasconf);
#ifdef SCTP_AUDITING_ENABLED
            sctp_auditing(4, inp, stcb, net);
#endif
            sctp_chunk_output(inp, stcb, SCTP_OUTPUT_FROM_ASCONF_TMR, SCTP_SO_NOT_LOCKED);
            break;
      case SCTP_TIMER_TYPE_PRIM_DELETED:
            if ((stcb == NULL) || (inp == NULL)) {
                  break;
            }
            sctp_delete_prim_timer(inp, stcb, net);
            SCTP_STAT_INCR(sctps_timodelprim);
            break;

      case SCTP_TIMER_TYPE_AUTOCLOSE:
            if ((stcb == NULL) || (inp == NULL)) {
                  break;
            }
            SCTP_STAT_INCR(sctps_timoautoclose);
            sctp_autoclose_timer(inp, stcb, net);
            sctp_chunk_output(inp, stcb, SCTP_OUTPUT_FROM_AUTOCLOSE_TMR, SCTP_SO_NOT_LOCKED);
            did_output = 0;
            break;
      case SCTP_TIMER_TYPE_ASOCKILL:
            if ((stcb == NULL) || (inp == NULL)) {
                  break;
            }
            SCTP_STAT_INCR(sctps_timoassockill);
            /* Can we free it yet? */
            SCTP_INP_DECR_REF(inp);
            sctp_timer_stop(SCTP_TIMER_TYPE_ASOCKILL, inp, stcb, NULL, SCTP_FROM_SCTPUTIL + SCTP_LOC_1);
#if defined (__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
            so = SCTP_INP_SO(inp);
            atomic_add_int(&stcb->asoc.refcnt, 1);
            SCTP_TCB_UNLOCK(stcb);
            SCTP_SOCKET_LOCK(so, 1);
            SCTP_TCB_LOCK(stcb);
            atomic_subtract_int(&stcb->asoc.refcnt, 1);
#endif
            (void)sctp_free_assoc(inp, stcb, SCTP_NORMAL_PROC, SCTP_FROM_SCTPUTIL + SCTP_LOC_2);
#if defined (__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
            SCTP_SOCKET_UNLOCK(so, 1);
#endif
            /*
             * free asoc, always unlocks (or destroy's) so prevent
             * duplicate unlock or unlock of a free mtx :-0
             */
            stcb = NULL;
            goto out_no_decr;
      case SCTP_TIMER_TYPE_INPKILL:
            SCTP_STAT_INCR(sctps_timoinpkill);
            if (inp == NULL) {
                  break;
            }
            /*
             * special case, take away our increment since WE are the
             * killer
             */
            SCTP_INP_DECR_REF(inp);
            sctp_timer_stop(SCTP_TIMER_TYPE_INPKILL, inp, NULL, NULL, SCTP_FROM_SCTPUTIL + SCTP_LOC_3);
            sctp_inpcb_free(inp, SCTP_FREE_SHOULD_USE_ABORT,
                SCTP_CALLED_DIRECTLY_NOCMPSET);
            goto out_no_decr;
      default:
            SCTPDBG(SCTP_DEBUG_TIMER1, "sctp_timeout_handler:unknown timer %d\n",
                tmr->type);
            break;
      };
#ifdef SCTP_AUDITING_ENABLED
      sctp_audit_log(0xF1, (uint8_t) tmr->type);
      if (inp)
            sctp_auditing(5, inp, stcb, net);
#endif
      if ((did_output) && stcb) {
            /*
             * Now we need to clean up the control chunk chain if an
             * ECNE is on it. It must be marked as UNSENT again so next
             * call will continue to send it until such time that we get
             * a CWR, to remove it. It is, however, less likely that we
             * will find a ecn echo on the chain though.
             */
            sctp_fix_ecn_echo(&stcb->asoc);
      }
get_out:
      if (stcb) {
            SCTP_TCB_UNLOCK(stcb);
      }
out_decr:
      if (inp) {
            SCTP_INP_DECR_REF(inp);
      }
out_no_decr:
      SCTPDBG(SCTP_DEBUG_TIMER1, "Timer now complete (type %d)\n",
          tmr->type);
      if (inp) {
      }
}

void
sctp_timer_start(int t_type, struct sctp_inpcb *inp, struct sctp_tcb *stcb,
    struct sctp_nets *net)
{
      int to_ticks;
      struct sctp_timer *tmr;

      if ((t_type != SCTP_TIMER_TYPE_ADDR_WQ) && (inp == NULL))
            return;

      to_ticks = 0;

      tmr = NULL;
      if (stcb) {
            SCTP_TCB_LOCK_ASSERT(stcb);
      }
      switch (t_type) {
      case SCTP_TIMER_TYPE_ZERO_COPY:
            tmr = &inp->sctp_ep.zero_copy_timer;
            to_ticks = SCTP_ZERO_COPY_TICK_DELAY;
            break;
      case SCTP_TIMER_TYPE_ZCOPY_SENDQ:
            tmr = &inp->sctp_ep.zero_copy_sendq_timer;
            to_ticks = SCTP_ZERO_COPY_SENDQ_TICK_DELAY;
            break;
      case SCTP_TIMER_TYPE_ADDR_WQ:
            /* Only 1 tick away :-) */
            tmr = &sctppcbinfo.addr_wq_timer;
            to_ticks = SCTP_ADDRESS_TICK_DELAY;
            break;
      case SCTP_TIMER_TYPE_ITERATOR:
            {
                  struct sctp_iterator *it;

                  it = (struct sctp_iterator *)inp;
                  tmr = &it->tmr;
                  to_ticks = SCTP_ITERATOR_TICKS;
            }
            break;
      case SCTP_TIMER_TYPE_SEND:
            /* Here we use the RTO timer */
            {
                  int rto_val;

                  if ((stcb == NULL) || (net == NULL)) {
                        return;
                  }
                  tmr = &net->rxt_timer;
                  if (net->RTO == 0) {
                        rto_val = stcb->asoc.initial_rto;
                  } else {
                        rto_val = net->RTO;
                  }
                  to_ticks = MSEC_TO_TICKS(rto_val);
            }
            break;
      case SCTP_TIMER_TYPE_INIT:
            /*
             * Here we use the INIT timer default usually about 1
             * minute.
             */
            if ((stcb == NULL) || (net == NULL)) {
                  return;
            }
            tmr = &net->rxt_timer;
            if (net->RTO == 0) {
                  to_ticks = MSEC_TO_TICKS(stcb->asoc.initial_rto);
            } else {
                  to_ticks = MSEC_TO_TICKS(net->RTO);
            }
            break;
      case SCTP_TIMER_TYPE_RECV:
            /*
             * Here we use the Delayed-Ack timer value from the inp
             * ususually about 200ms.
             */
            if (stcb == NULL) {
                  return;
            }
            tmr = &stcb->asoc.dack_timer;
            to_ticks = MSEC_TO_TICKS(stcb->asoc.delayed_ack);
            break;
      case SCTP_TIMER_TYPE_SHUTDOWN:
            /* Here we use the RTO of the destination. */
            if ((stcb == NULL) || (net == NULL)) {
                  return;
            }
            if (net->RTO == 0) {
                  to_ticks = MSEC_TO_TICKS(stcb->asoc.initial_rto);
            } else {
                  to_ticks = MSEC_TO_TICKS(net->RTO);
            }
            tmr = &net->rxt_timer;
            break;
      case SCTP_TIMER_TYPE_HEARTBEAT:
            /*
             * the net is used here so that we can add in the RTO. Even
             * though we use a different timer. We also add the HB timer
             * PLUS a random jitter.
             */
            if ((inp == NULL) || (stcb == NULL)) {
                  return;
            } else {
                  uint32_t rndval;
                  uint8_t this_random;
                  int cnt_of_unconf = 0;
                  struct sctp_nets *lnet;

                  TAILQ_FOREACH(lnet, &stcb->asoc.nets, sctp_next) {
                        if ((lnet->dest_state & SCTP_ADDR_UNCONFIRMED) &&
                            (lnet->dest_state & SCTP_ADDR_REACHABLE)) {
                              cnt_of_unconf++;
                        }
                  }
                  if (cnt_of_unconf) {
                        net = lnet = NULL;
                        (void)sctp_heartbeat_timer(inp, stcb, lnet, cnt_of_unconf);
                  }
                  if (stcb->asoc.hb_random_idx > 3) {
                        rndval = sctp_select_initial_TSN(&inp->sctp_ep);
                        memcpy(stcb->asoc.hb_random_values, &rndval,
                            sizeof(stcb->asoc.hb_random_values));
                        stcb->asoc.hb_random_idx = 0;
                  }
                  this_random = stcb->asoc.hb_random_values[stcb->asoc.hb_random_idx];
                  stcb->asoc.hb_random_idx++;
                  stcb->asoc.hb_ect_randombit = 0;
                  /*
                   * this_random will be 0 - 256 ms RTO is in ms.
                   */
                  if ((stcb->asoc.hb_is_disabled) &&
                      (cnt_of_unconf == 0)) {
                        return;
                  }
                  if (net) {
                        int delay;

                        delay = stcb->asoc.heart_beat_delay;
                        TAILQ_FOREACH(lnet, &stcb->asoc.nets, sctp_next) {
                              if ((lnet->dest_state & SCTP_ADDR_UNCONFIRMED) &&
                                  ((lnet->dest_state & SCTP_ADDR_OUT_OF_SCOPE) == 0) &&
                                  (lnet->dest_state & SCTP_ADDR_REACHABLE)) {
                                    delay = 0;
                              }
                        }
                        if (net->RTO == 0) {
                              /* Never been checked */
                              to_ticks = this_random + stcb->asoc.initial_rto + delay;
                        } else {
                              /* set rto_val to the ms */
                              to_ticks = delay + net->RTO + this_random;
                        }
                  } else {
                        if (cnt_of_unconf) {
                              to_ticks = this_random + stcb->asoc.initial_rto;
                        } else {
                              to_ticks = stcb->asoc.heart_beat_delay + this_random + stcb->asoc.initial_rto;
                        }
                  }
                  /*
                   * Now we must convert the to_ticks that are now in
                   * ms to ticks.
                   */
                  to_ticks = MSEC_TO_TICKS(to_ticks);
                  tmr = &stcb->asoc.hb_timer;
            }
            break;
      case SCTP_TIMER_TYPE_COOKIE:
            /*
             * Here we can use the RTO timer from the network since one
             * RTT was compelete. If a retran happened then we will be
             * using the RTO initial value.
             */
            if ((stcb == NULL) || (net == NULL)) {
                  return;
            }
            if (net->RTO == 0) {
                  to_ticks = MSEC_TO_TICKS(stcb->asoc.initial_rto);
            } else {
                  to_ticks = MSEC_TO_TICKS(net->RTO);
            }
            tmr = &net->rxt_timer;
            break;
      case SCTP_TIMER_TYPE_NEWCOOKIE:
            /*
             * nothing needed but the endpoint here ususually about 60
             * minutes.
             */
            if (inp == NULL) {
                  return;
            }
            tmr = &inp->sctp_ep.signature_change;
            to_ticks = inp->sctp_ep.sctp_timeoutticks[SCTP_TIMER_SIGNATURE];
            break;
      case SCTP_TIMER_TYPE_ASOCKILL:
            if (stcb == NULL) {
                  return;
            }
            tmr = &stcb->asoc.strreset_timer;
            to_ticks = MSEC_TO_TICKS(SCTP_ASOC_KILL_TIMEOUT);
            break;
      case SCTP_TIMER_TYPE_INPKILL:
            /*
             * The inp is setup to die. We re-use the signature_chage
             * timer since that has stopped and we are in the GONE
             * state.
             */
            if (inp == NULL) {
                  return;
            }
            tmr = &inp->sctp_ep.signature_change;
            to_ticks = MSEC_TO_TICKS(SCTP_INP_KILL_TIMEOUT);
            break;
      case SCTP_TIMER_TYPE_PATHMTURAISE:
            /*
             * Here we use the value found in the EP for PMTU ususually
             * about 10 minutes.
             */
            if ((stcb == NULL) || (inp == NULL)) {
                  return;
            }
            if (net == NULL) {
                  return;
            }
            to_ticks = inp->sctp_ep.sctp_timeoutticks[SCTP_TIMER_PMTU];
            tmr = &net->pmtu_timer;
            break;
      case SCTP_TIMER_TYPE_SHUTDOWNACK:
            /* Here we use the RTO of the destination */
            if ((stcb == NULL) || (net == NULL)) {
                  return;
            }
            if (net->RTO == 0) {
                  to_ticks = MSEC_TO_TICKS(stcb->asoc.initial_rto);
            } else {
                  to_ticks = MSEC_TO_TICKS(net->RTO);
            }
            tmr = &net->rxt_timer;
            break;
      case SCTP_TIMER_TYPE_SHUTDOWNGUARD:
            /*
             * Here we use the endpoints shutdown guard timer usually
             * about 3 minutes.
             */
            if ((inp == NULL) || (stcb == NULL)) {
                  return;
            }
            to_ticks = inp->sctp_ep.sctp_timeoutticks[SCTP_TIMER_MAXSHUTDOWN];
            tmr = &stcb->asoc.shut_guard_timer;
            break;
      case SCTP_TIMER_TYPE_STRRESET:
            /*
             * Here the timer comes from the stcb but its value is from
             * the net's RTO.
             */
            if ((stcb == NULL) || (net == NULL)) {
                  return;
            }
            if (net->RTO == 0) {
                  to_ticks = MSEC_TO_TICKS(stcb->asoc.initial_rto);
            } else {
                  to_ticks = MSEC_TO_TICKS(net->RTO);
            }
            tmr = &stcb->asoc.strreset_timer;
            break;

      case SCTP_TIMER_TYPE_EARLYFR:
            {
                  unsigned int msec;

                  if ((stcb == NULL) || (net == NULL)) {
                        return;
                  }
                  if (net->flight_size > net->cwnd) {
                        /* no need to start */
                        return;
                  }
                  SCTP_STAT_INCR(sctps_earlyfrstart);
                  if (net->lastsa == 0) {
                        /* Hmm no rtt estimate yet? */
                        msec = stcb->asoc.initial_rto >> 2;
                  } else {
                        msec = ((net->lastsa >> 2) + net->lastsv) >> 1;
                  }
                  if (msec < sctp_early_fr_msec) {
                        msec = sctp_early_fr_msec;
                        if (msec < SCTP_MINFR_MSEC_FLOOR) {
                              msec = SCTP_MINFR_MSEC_FLOOR;
                        }
                  }
                  to_ticks = MSEC_TO_TICKS(msec);
                  tmr = &net->fr_timer;
            }
            break;
      case SCTP_TIMER_TYPE_ASCONF:
            /*
             * Here the timer comes from the stcb but its value is from
             * the net's RTO.
             */
            if ((stcb == NULL) || (net == NULL)) {
                  return;
            }
            if (net->RTO == 0) {
                  to_ticks = MSEC_TO_TICKS(stcb->asoc.initial_rto);
            } else {
                  to_ticks = MSEC_TO_TICKS(net->RTO);
            }
            tmr = &stcb->asoc.asconf_timer;
            break;
      case SCTP_TIMER_TYPE_PRIM_DELETED:
            if ((stcb == NULL) || (net != NULL)) {
                  return;
            }
            to_ticks = MSEC_TO_TICKS(stcb->asoc.initial_rto);
            tmr = &stcb->asoc.delete_prim_timer;
            break;
      case SCTP_TIMER_TYPE_AUTOCLOSE:
            if (stcb == NULL) {
                  return;
            }
            if (stcb->asoc.sctp_autoclose_ticks == 0) {
                  /*
                   * Really an error since stcb is NOT set to
                   * autoclose
                   */
                  return;
            }
            to_ticks = stcb->asoc.sctp_autoclose_ticks;
            tmr = &stcb->asoc.autoclose_timer;
            break;
      default:
            SCTPDBG(SCTP_DEBUG_TIMER1, "%s: Unknown timer type %d\n",
                __FUNCTION__, t_type);
            return;
            break;
      };
      if ((to_ticks <= 0) || (tmr == NULL)) {
            SCTPDBG(SCTP_DEBUG_TIMER1, "%s: %d:software error to_ticks:%d tmr:%p not set ??\n",
                __FUNCTION__, t_type, to_ticks, tmr);
            return;
      }
      if (SCTP_OS_TIMER_PENDING(&tmr->timer)) {
            /*
             * we do NOT allow you to have it already running. if it is
             * we leave the current one up unchanged
             */
            return;
      }
      /* At this point we can proceed */
      if (t_type == SCTP_TIMER_TYPE_SEND) {
            stcb->asoc.num_send_timers_up++;
      }
      tmr->stopped_from = 0;
      tmr->type = t_type;
      tmr->ep = (void *)inp;
      tmr->tcb = (void *)stcb;
      tmr->net = (void *)net;
      tmr->self = (void *)tmr;
      tmr->ticks = sctp_get_tick_count();
      (void)SCTP_OS_TIMER_START(&tmr->timer, to_ticks, sctp_timeout_handler, tmr);
      return;
}

void
sctp_timer_stop(int t_type, struct sctp_inpcb *inp, struct sctp_tcb *stcb,
    struct sctp_nets *net, uint32_t from)
{
      struct sctp_timer *tmr;

      if ((t_type != SCTP_TIMER_TYPE_ADDR_WQ) &&
          (inp == NULL))
            return;

      tmr = NULL;
      if (stcb) {
            SCTP_TCB_LOCK_ASSERT(stcb);
      }
      switch (t_type) {
      case SCTP_TIMER_TYPE_ZERO_COPY:
            tmr = &inp->sctp_ep.zero_copy_timer;
            break;
      case SCTP_TIMER_TYPE_ZCOPY_SENDQ:
            tmr = &inp->sctp_ep.zero_copy_sendq_timer;
            break;
      case SCTP_TIMER_TYPE_ADDR_WQ:
            tmr = &sctppcbinfo.addr_wq_timer;
            break;
      case SCTP_TIMER_TYPE_EARLYFR:
            if ((stcb == NULL) || (net == NULL)) {
                  return;
            }
            tmr = &net->fr_timer;
            SCTP_STAT_INCR(sctps_earlyfrstop);
            break;
      case SCTP_TIMER_TYPE_ITERATOR:
            {
                  struct sctp_iterator *it;

                  it = (struct sctp_iterator *)inp;
                  tmr = &it->tmr;
            }
            break;
      case SCTP_TIMER_TYPE_SEND:
            if ((stcb == NULL) || (net == NULL)) {
                  return;
            }
            tmr = &net->rxt_timer;
            break;
      case SCTP_TIMER_TYPE_INIT:
            if ((stcb == NULL) || (net == NULL)) {
                  return;
            }
            tmr = &net->rxt_timer;
            break;
      case SCTP_TIMER_TYPE_RECV:
            if (stcb == NULL) {
                  return;
            }
            tmr = &stcb->asoc.dack_timer;
            break;
      case SCTP_TIMER_TYPE_SHUTDOWN:
            if ((stcb == NULL) || (net == NULL)) {
                  return;
            }
            tmr = &net->rxt_timer;
            break;
      case SCTP_TIMER_TYPE_HEARTBEAT:
            if (stcb == NULL) {
                  return;
            }
            tmr = &stcb->asoc.hb_timer;
            break;
      case SCTP_TIMER_TYPE_COOKIE:
            if ((stcb == NULL) || (net == NULL)) {
                  return;
            }
            tmr = &net->rxt_timer;
            break;
      case SCTP_TIMER_TYPE_NEWCOOKIE:
            /* nothing needed but the endpoint here */
            tmr = &inp->sctp_ep.signature_change;
            /*
             * We re-use the newcookie timer for the INP kill timer. We
             * must assure that we do not kill it by accident.
             */
            break;
      case SCTP_TIMER_TYPE_ASOCKILL:
            /*
             * Stop the asoc kill timer.
             */
            if (stcb == NULL) {
                  return;
            }
            tmr = &stcb->asoc.strreset_timer;
            break;

      case SCTP_TIMER_TYPE_INPKILL:
            /*
             * The inp is setup to die. We re-use the signature_chage
             * timer since that has stopped and we are in the GONE
             * state.
             */
            tmr = &inp->sctp_ep.signature_change;
            break;
      case SCTP_TIMER_TYPE_PATHMTURAISE:
            if ((stcb == NULL) || (net == NULL)) {
                  return;
            }
            tmr = &net->pmtu_timer;
            break;
      case SCTP_TIMER_TYPE_SHUTDOWNACK:
            if ((stcb == NULL) || (net == NULL)) {
                  return;
            }
            tmr = &net->rxt_timer;
            break;
      case SCTP_TIMER_TYPE_SHUTDOWNGUARD:
            if (stcb == NULL) {
                  return;
            }
            tmr = &stcb->asoc.shut_guard_timer;
            break;
      case SCTP_TIMER_TYPE_STRRESET:
            if (stcb == NULL) {
                  return;
            }
            tmr = &stcb->asoc.strreset_timer;
            break;
      case SCTP_TIMER_TYPE_ASCONF:
            if (stcb == NULL) {
                  return;
            }
            tmr = &stcb->asoc.asconf_timer;
            break;
      case SCTP_TIMER_TYPE_PRIM_DELETED:
            if (stcb == NULL) {
                  return;
            }
            tmr = &stcb->asoc.delete_prim_timer;
            break;
      case SCTP_TIMER_TYPE_AUTOCLOSE:
            if (stcb == NULL) {
                  return;
            }
            tmr = &stcb->asoc.autoclose_timer;
            break;
      default:
            SCTPDBG(SCTP_DEBUG_TIMER1, "%s: Unknown timer type %d\n",
                __FUNCTION__, t_type);
            break;
      };
      if (tmr == NULL) {
            return;
      }
      if ((tmr->type != t_type) && tmr->type) {
            /*
             * Ok we have a timer that is under joint use. Cookie timer
             * per chance with the SEND timer. We therefore are NOT
             * running the timer that the caller wants stopped.  So just
             * return.
             */
            return;
      }
      if ((t_type == SCTP_TIMER_TYPE_SEND) && (stcb != NULL)) {
            stcb->asoc.num_send_timers_up--;
            if (stcb->asoc.num_send_timers_up < 0) {
                  stcb->asoc.num_send_timers_up = 0;
            }
      }
      tmr->self = NULL;
      tmr->stopped_from = from;
      (void)SCTP_OS_TIMER_STOP(&tmr->timer);
      return;
}

#ifdef SCTP_USE_ADLER32
static uint32_t
update_adler32(uint32_t adler, uint8_t * buf, int32_t len)
{
      uint32_t s1 = adler & 0xffff;
      uint32_t s2 = (adler >> 16) & 0xffff;
      int n;

      for (n = 0; n < len; n++, buf++) {
            /* s1 = (s1 + buf[n]) % BASE */
            /* first we add */
            s1 = (s1 + *buf);
            /*
             * now if we need to, we do a mod by subtracting. It seems a
             * bit faster since I really will only ever do one subtract
             * at the MOST, since buf[n] is a max of 255.
             */
            if (s1 >= SCTP_ADLER32_BASE) {
                  s1 -= SCTP_ADLER32_BASE;
            }
            /* s2 = (s2 + s1) % BASE */
            /* first we add */
            s2 = (s2 + s1);
            /*
             * again, it is more efficent (it seems) to subtract since
             * the most s2 will ever be is (BASE-1 + BASE-1) in the
             * worse case. This would then be (2 * BASE) - 2, which will
             * still only do one subtract. On Intel this is much better
             * to do this way and avoid the divide. Have not -pg'd on
             * sparc.
             */
            if (s2 >= SCTP_ADLER32_BASE) {
                  s2 -= SCTP_ADLER32_BASE;
            }
      }
      /* Return the adler32 of the bytes buf[0..len-1] */
      return ((s2 << 16) + s1);
}

#endif


uint32_t
sctp_calculate_len(struct mbuf *m)
{
      uint32_t tlen = 0;
      struct mbuf *at;

      at = m;
      while (at) {
            tlen += SCTP_BUF_LEN(at);
            at = SCTP_BUF_NEXT(at);
      }
      return (tlen);
}

#if defined(SCTP_WITH_NO_CSUM)

uint32_t
sctp_calculate_sum(struct mbuf *m, int32_t * pktlen, uint32_t offset)
{
      /*
       * given a mbuf chain with a packetheader offset by 'offset'
       * pointing at a sctphdr (with csum set to 0) go through the chain
       * of SCTP_BUF_NEXT()'s and calculate the SCTP checksum. This also
       * has a side bonus as it will calculate the total length of the
       * mbuf chain. Note: if offset is greater than the total mbuf
       * length, checksum=1, pktlen=0 is returned (ie. no real error code)
       */
      if (pktlen == NULL)
            return (0);
      *pktlen = sctp_calculate_len(m);
      return (0);
}

#elif defined(SCTP_USE_INCHKSUM)

#include <machine/in_cksum.h>

uint32_t
sctp_calculate_sum(struct mbuf *m, int32_t * pktlen, uint32_t offset)
{
      /*
       * given a mbuf chain with a packetheader offset by 'offset'
       * pointing at a sctphdr (with csum set to 0) go through the chain
       * of SCTP_BUF_NEXT()'s and calculate the SCTP checksum. This also
       * has a side bonus as it will calculate the total length of the
       * mbuf chain. Note: if offset is greater than the total mbuf
       * length, checksum=1, pktlen=0 is returned (ie. no real error code)
       */
      int32_t tlen = 0;
      struct mbuf *at;
      uint32_t the_sum, retsum;

      at = m;
      while (at) {
            tlen += SCTP_BUF_LEN(at);
            at = SCTP_BUF_NEXT(at);
      }
      the_sum = (uint32_t) (in_cksum_skip(m, tlen, offset));
      if (pktlen != NULL)
            *pktlen = (tlen - offset);
      retsum = htons(the_sum);
      return (the_sum);
}

#else

uint32_t
sctp_calculate_sum(struct mbuf *m, int32_t * pktlen, uint32_t offset)
{
      /*
       * given a mbuf chain with a packetheader offset by 'offset'
       * pointing at a sctphdr (with csum set to 0) go through the chain
       * of SCTP_BUF_NEXT()'s and calculate the SCTP checksum. This also
       * has a side bonus as it will calculate the total length of the
       * mbuf chain. Note: if offset is greater than the total mbuf
       * length, checksum=1, pktlen=0 is returned (ie. no real error code)
       */
      int32_t tlen = 0;

#ifdef SCTP_USE_ADLER32
      uint32_t base = 1L;

#else
      uint32_t base = 0xffffffff;

#endif
      struct mbuf *at;

      at = m;
      /* find the correct mbuf and offset into mbuf */
      while ((at != NULL) && (offset > (uint32_t) SCTP_BUF_LEN(at))) {
            offset -= SCTP_BUF_LEN(at);   /* update remaining offset
                                     * left */
            at = SCTP_BUF_NEXT(at);
      }
      while (at != NULL) {
            if ((SCTP_BUF_LEN(at) - offset) > 0) {
#ifdef SCTP_USE_ADLER32
                  base = update_adler32(base,
                      (unsigned char *)(SCTP_BUF_AT(at, offset)),
                      (unsigned int)(SCTP_BUF_LEN(at) - offset));
#else
                  if ((SCTP_BUF_LEN(at) - offset) < 4) {
                        /* Use old method if less than 4 bytes */
                        base = old_update_crc32(base,
                            (unsigned char *)(SCTP_BUF_AT(at, offset)),
                            (unsigned int)(SCTP_BUF_LEN(at) - offset));
                  } else {
                        base = update_crc32(base,
                            (unsigned char *)(SCTP_BUF_AT(at, offset)),
                            (unsigned int)(SCTP_BUF_LEN(at) - offset));
                  }
#endif
                  tlen += SCTP_BUF_LEN(at) - offset;
                  /* we only offset once into the first mbuf */
            }
            if (offset) {
                  if (offset < (uint32_t) SCTP_BUF_LEN(at))
                        offset = 0;
                  else
                        offset -= SCTP_BUF_LEN(at);
            }
            at = SCTP_BUF_NEXT(at);
      }
      if (pktlen != NULL) {
            *pktlen = tlen;
      }
#ifdef SCTP_USE_ADLER32
      /* Adler32 */
      base = htonl(base);
#else
      /* CRC-32c */
      base = sctp_csum_finalize(base);
#endif
      return (base);
}


#endif

void
sctp_mtu_size_reset(struct sctp_inpcb *inp,
    struct sctp_association *asoc, uint32_t mtu)
{
      /*
       * Reset the P-MTU size on this association, this involves changing
       * the asoc MTU, going through ANY chunk+overhead larger than mtu to
       * allow the DF flag to be cleared.
       */
      struct sctp_tmit_chunk *chk;
      unsigned int eff_mtu, ovh;

#ifdef SCTP_PRINT_FOR_B_AND_M
      SCTP_PRINTF("sctp_mtu_size_reset(%p, asoc:%p mtu:%d\n",
          inp, asoc, mtu);
#endif
      asoc->smallest_mtu = mtu;
      if (inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) {
            ovh = SCTP_MIN_OVERHEAD;
      } else {
            ovh = SCTP_MIN_V4_OVERHEAD;
      }
      eff_mtu = mtu - ovh;
      TAILQ_FOREACH(chk, &asoc->send_queue, sctp_next) {

            if (chk->send_size > eff_mtu) {
                  chk->flags |= CHUNK_FLAGS_FRAGMENT_OK;
            }
      }
      TAILQ_FOREACH(chk, &asoc->sent_queue, sctp_next) {
            if (chk->send_size > eff_mtu) {
                  chk->flags |= CHUNK_FLAGS_FRAGMENT_OK;
            }
      }
}


/*
 * given an association and starting time of the current RTT period return
 * RTO in number of msecs net should point to the current network
 */
uint32_t
sctp_calculate_rto(struct sctp_tcb *stcb,
    struct sctp_association *asoc,
    struct sctp_nets *net,
    struct timeval *told,
    int safe)
{
      /*-
       * given an association and the starting time of the current RTT
       * period (in value1/value2) return RTO in number of msecs.
       */
      int calc_time = 0;
      int o_calctime;
      uint32_t new_rto = 0;
      int first_measure = 0;
      struct timeval now, then, *old;

      /* Copy it out for sparc64 */
      if (safe == sctp_align_unsafe_makecopy) {
            old = &then;
            memcpy(&then, told, sizeof(struct timeval));
      } else if (safe == sctp_align_safe_nocopy) {
            old = told;
      } else {
            /* error */
            SCTP_PRINTF("Huh, bad rto calc call\n");
            return (0);
      }
      /************************/
      /* 1. calculate new RTT */
      /************************/
      /* get the current time */
      (void)SCTP_GETTIME_TIMEVAL(&now);
      /* compute the RTT value */
      if ((u_long)now.tv_sec > (u_long)old->tv_sec) {
            calc_time = ((u_long)now.tv_sec - (u_long)old->tv_sec) * 1000;
            if ((u_long)now.tv_usec > (u_long)old->tv_usec) {
                  calc_time += (((u_long)now.tv_usec -
                      (u_long)old->tv_usec) / 1000);
            } else if ((u_long)now.tv_usec < (u_long)old->tv_usec) {
                  /* Borrow 1,000ms from current calculation */
                  calc_time -= 1000;
                  /* Add in the slop over */
                  calc_time += ((int)now.tv_usec / 1000);
                  /* Add in the pre-second ms's */
                  calc_time += (((int)1000000 - (int)old->tv_usec) / 1000);
            }
      } else if ((u_long)now.tv_sec == (u_long)old->tv_sec) {
            if ((u_long)now.tv_usec > (u_long)old->tv_usec) {
                  calc_time = ((u_long)now.tv_usec -
                      (u_long)old->tv_usec) / 1000;
            } else if ((u_long)now.tv_usec < (u_long)old->tv_usec) {
                  /* impossible .. garbage in nothing out */
                  goto calc_rto;
            } else if ((u_long)now.tv_usec == (u_long)old->tv_usec) {
                  /*
                   * We have to have 1 usec :-D this must be the
                   * loopback.
                   */
                  calc_time = 1;
            } else {
                  /* impossible .. garbage in nothing out */
                  goto calc_rto;
            }
      } else {
            /* Clock wrapped? */
            goto calc_rto;
      }
      /***************************/
      /* 2. update RTTVAR & SRTT */
      /***************************/
      o_calctime = calc_time;
      /* this is Van Jacobson's integer version */
      if (net->RTO_measured) {
            calc_time -= (net->lastsa >> SCTP_RTT_SHIFT);   /* take away 1/8th when
                                                 * shift=3 */
            if (sctp_logging_level & SCTP_RTTVAR_LOGGING_ENABLE) {
                  rto_logging(net, SCTP_LOG_RTTVAR);
            }
            net->prev_rtt = o_calctime;
            net->lastsa += calc_time;     /* add 7/8th into sa when
                                     * shift=3 */
            if (calc_time < 0) {
                  calc_time = -calc_time;
            }
            calc_time -= (net->lastsv >> SCTP_RTT_VAR_SHIFT);     /* take away 1/4 when
                                                       * VAR shift=2 */
            net->lastsv += calc_time;
            if (net->lastsv == 0) {
                  net->lastsv = SCTP_CLOCK_GRANULARITY;
            }
      } else {
            /* First RTO measurment */
            net->RTO_measured = 1;
            net->lastsa = calc_time << SCTP_RTT_SHIFT;      /* Multiply by 8 when
                                                 * shift=3 */
            net->lastsv = calc_time;
            if (net->lastsv == 0) {
                  net->lastsv = SCTP_CLOCK_GRANULARITY;
            }
            first_measure = 1;
            net->prev_rtt = o_calctime;
            if (sctp_logging_level & SCTP_RTTVAR_LOGGING_ENABLE) {
                  rto_logging(net, SCTP_LOG_INITIAL_RTT);
            }
      }
calc_rto:
      new_rto = (net->lastsa >> SCTP_RTT_SHIFT) + net->lastsv;
      if ((new_rto > SCTP_SAT_NETWORK_MIN) &&
          (stcb->asoc.sat_network_lockout == 0)) {
            stcb->asoc.sat_network = 1;
      } else if ((!first_measure) && stcb->asoc.sat_network) {
            stcb->asoc.sat_network = 0;
            stcb->asoc.sat_network_lockout = 1;
      }
      /* bound it, per C6/C7 in Section 5.3.1 */
      if (new_rto < stcb->asoc.minrto) {
            new_rto = stcb->asoc.minrto;
      }
      if (new_rto > stcb->asoc.maxrto) {
            new_rto = stcb->asoc.maxrto;
      }
      /* we are now returning the RTO */
      return (new_rto);
}

/*
 * return a pointer to a contiguous piece of data from the given mbuf chain
 * starting at 'off' for 'len' bytes.  If the desired piece spans more than
 * one mbuf, a copy is made at 'ptr'. caller must ensure that the buffer size
 * is >= 'len' returns NULL if there there isn't 'len' bytes in the chain.
 */
caddr_t
sctp_m_getptr(struct mbuf *m, int off, int len, uint8_t * in_ptr)
{
      uint32_t count;
      uint8_t *ptr;

      ptr = in_ptr;
      if ((off < 0) || (len <= 0))
            return (NULL);

      /* find the desired start location */
      while ((m != NULL) && (off > 0)) {
            if (off < SCTP_BUF_LEN(m))
                  break;
            off -= SCTP_BUF_LEN(m);
            m = SCTP_BUF_NEXT(m);
      }
      if (m == NULL)
            return (NULL);

      /* is the current mbuf large enough (eg. contiguous)? */
      if ((SCTP_BUF_LEN(m) - off) >= len) {
            return (mtod(m, caddr_t)+off);
      } else {
            /* else, it spans more than one mbuf, so save a temp copy... */
            while ((m != NULL) && (len > 0)) {
                  count = min(SCTP_BUF_LEN(m) - off, len);
                  bcopy(mtod(m, caddr_t)+off, ptr, count);
                  len -= count;
                  ptr += count;
                  off = 0;
                  m = SCTP_BUF_NEXT(m);
            }
            if ((m == NULL) && (len > 0))
                  return (NULL);
            else
                  return ((caddr_t)in_ptr);
      }
}



struct sctp_paramhdr *
sctp_get_next_param(struct mbuf *m,
    int offset,
    struct sctp_paramhdr *pull,
    int pull_limit)
{
      /* This just provides a typed signature to Peter's Pull routine */
      return ((struct sctp_paramhdr *)sctp_m_getptr(m, offset, pull_limit,
          (uint8_t *) pull));
}


int
sctp_add_pad_tombuf(struct mbuf *m, int padlen)
{
      /*
       * add padlen bytes of 0 filled padding to the end of the mbuf. If
       * padlen is > 3 this routine will fail.
       */
      uint8_t *dp;
      int i;

      if (padlen > 3) {
            SCTP_LTRACE_ERR_RET_PKT(m, NULL, NULL, NULL, SCTP_FROM_SCTPUTIL, ENOBUFS);
            return (ENOBUFS);
      }
      if (padlen <= M_TRAILINGSPACE(m)) {
            /*
             * The easy way. We hope the majority of the time we hit
             * here :)
             */
            dp = (uint8_t *) (mtod(m, caddr_t)+SCTP_BUF_LEN(m));
            SCTP_BUF_LEN(m) += padlen;
      } else {
            /* Hard way we must grow the mbuf */
            struct mbuf *tmp;

            tmp = sctp_get_mbuf_for_msg(padlen, 0, M_DONTWAIT, 1, MT_DATA);
            if (tmp == NULL) {
                  /* Out of space GAK! we are in big trouble. */
                  SCTP_LTRACE_ERR_RET_PKT(m, NULL, NULL, NULL, SCTP_FROM_SCTPUTIL, EINVAL);
                  return (ENOSPC);
            }
            /* setup and insert in middle */
            SCTP_BUF_LEN(tmp) = padlen;
            SCTP_BUF_NEXT(tmp) = NULL;
            SCTP_BUF_NEXT(m) = tmp;
            dp = mtod(tmp, uint8_t *);
      }
      /* zero out the pad */
      for (i = 0; i < padlen; i++) {
            *dp = 0;
            dp++;
      }
      return (0);
}

int
sctp_pad_lastmbuf(struct mbuf *m, int padval, struct mbuf *last_mbuf)
{
      /* find the last mbuf in chain and pad it */
      struct mbuf *m_at;

      m_at = m;
      if (last_mbuf) {
            return (sctp_add_pad_tombuf(last_mbuf, padval));
      } else {
            while (m_at) {
                  if (SCTP_BUF_NEXT(m_at) == NULL) {
                        return (sctp_add_pad_tombuf(m_at, padval));
                  }
                  m_at = SCTP_BUF_NEXT(m_at);
            }
      }
      SCTP_LTRACE_ERR_RET_PKT(m, NULL, NULL, NULL, SCTP_FROM_SCTPUTIL, EFAULT);
      return (EFAULT);
}

int sctp_asoc_change_wake = 0;

static void
sctp_notify_assoc_change(uint32_t event, struct sctp_tcb *stcb,
    uint32_t error, void *data, int so_locked
#if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
    SCTP_UNUSED
#endif
)
{
      struct mbuf *m_notify;
      struct sctp_assoc_change *sac;
      struct sctp_queued_to_read *control;

#if defined (__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
      struct socket *so;

#endif

      /*
       * First if we are are going down dump everything we can to the
       * socket rcv queue.
       */

      if ((stcb == NULL) ||
          (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE) ||
          (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_SOCKET_ALLGONE) ||
          (stcb->asoc.state & SCTP_STATE_CLOSED_SOCKET)
          ) {
            /* If the socket is gone we are out of here */
            return;
      }
      /*
       * For TCP model AND UDP connected sockets we will send an error up
       * when an ABORT comes in.
       */
      if (((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) ||
          (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_IN_TCPPOOL)) &&
          ((event == SCTP_COMM_LOST) || (event == SCTP_CANT_STR_ASSOC))) {
            if (SCTP_GET_STATE(&stcb->asoc) == SCTP_STATE_COOKIE_WAIT) {
                  SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTPUTIL, ECONNREFUSED);
                  stcb->sctp_socket->so_error = ECONNREFUSED;
            } else {
                  SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTPUTIL, ECONNRESET);
                  stcb->sctp_socket->so_error = ECONNRESET;
            }
            /* Wake ANY sleepers */
#if defined (__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
            so = SCTP_INP_SO(stcb->sctp_ep);
            if (!so_locked) {
                  atomic_add_int(&stcb->asoc.refcnt, 1);
                  SCTP_TCB_UNLOCK(stcb);
                  SCTP_SOCKET_LOCK(so, 1);
                  SCTP_TCB_LOCK(stcb);
                  atomic_subtract_int(&stcb->asoc.refcnt, 1);
                  if (stcb->asoc.state & SCTP_STATE_CLOSED_SOCKET) {
                        SCTP_SOCKET_UNLOCK(so, 1);
                        return;
                  }
            }
#endif
            sorwakeup(stcb->sctp_socket);
            sowwakeup(stcb->sctp_socket);
#if defined (__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
            if (!so_locked) {
                  SCTP_SOCKET_UNLOCK(so, 1);
            }
#endif
            sctp_asoc_change_wake++;
      }
      if (sctp_is_feature_off(stcb->sctp_ep, SCTP_PCB_FLAGS_RECVASSOCEVNT)) {
            /* event not enabled */
            return;
      }
      m_notify = sctp_get_mbuf_for_msg(sizeof(struct sctp_assoc_change), 0, M_DONTWAIT, 1, MT_DATA);
      if (m_notify == NULL)
            /* no space left */
            return;
      SCTP_BUF_LEN(m_notify) = 0;

      sac = mtod(m_notify, struct sctp_assoc_change *);
      sac->sac_type = SCTP_ASSOC_CHANGE;
      sac->sac_flags = 0;
      sac->sac_length = sizeof(struct sctp_assoc_change);
      sac->sac_state = event;
      sac->sac_error = error;
      /* XXX verify these stream counts */
      sac->sac_outbound_streams = stcb->asoc.streamoutcnt;
      sac->sac_inbound_streams = stcb->asoc.streamincnt;
      sac->sac_assoc_id = sctp_get_associd(stcb);
      SCTP_BUF_LEN(m_notify) = sizeof(struct sctp_assoc_change);
      SCTP_BUF_NEXT(m_notify) = NULL;
      control = sctp_build_readq_entry(stcb, stcb->asoc.primary_destination,
          0, 0, 0, 0, 0, 0,
          m_notify);
      if (control == NULL) {
            /* no memory */
            sctp_m_freem(m_notify);
            return;
      }
      control->length = SCTP_BUF_LEN(m_notify);
      /* not that we need this */
      control->tail_mbuf = m_notify;
      control->spec_flags = M_NOTIFICATION;
      sctp_add_to_readq(stcb->sctp_ep, stcb,
          control,
          &stcb->sctp_socket->so_rcv, 1, so_locked);
      if (event == SCTP_COMM_LOST) {
            /* Wake up any sleeper */
#if defined (__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
            so = SCTP_INP_SO(stcb->sctp_ep);
            if (!so_locked) {
                  atomic_add_int(&stcb->asoc.refcnt, 1);
                  SCTP_TCB_UNLOCK(stcb);
                  SCTP_SOCKET_LOCK(so, 1);
                  SCTP_TCB_LOCK(stcb);
                  atomic_subtract_int(&stcb->asoc.refcnt, 1);
                  if (stcb->asoc.state & SCTP_STATE_CLOSED_SOCKET) {
                        SCTP_SOCKET_UNLOCK(so, 1);
                        return;
                  }
            }
#endif
            sctp_sowwakeup(stcb->sctp_ep, stcb->sctp_socket);
#if defined (__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
            if (!so_locked) {
                  SCTP_SOCKET_UNLOCK(so, 1);
            }
#endif
      }
}

static void
sctp_notify_peer_addr_change(struct sctp_tcb *stcb, uint32_t state,
    struct sockaddr *sa, uint32_t error)
{
      struct mbuf *m_notify;
      struct sctp_paddr_change *spc;
      struct sctp_queued_to_read *control;

      if ((stcb == NULL) || (sctp_is_feature_off(stcb->sctp_ep, SCTP_PCB_FLAGS_RECVPADDREVNT)))
            /* event not enabled */
            return;

      m_notify = sctp_get_mbuf_for_msg(sizeof(struct sctp_paddr_change), 0, M_DONTWAIT, 1, MT_DATA);
      if (m_notify == NULL)
            return;
      SCTP_BUF_LEN(m_notify) = 0;
      spc = mtod(m_notify, struct sctp_paddr_change *);
      spc->spc_type = SCTP_PEER_ADDR_CHANGE;
      spc->spc_flags = 0;
      spc->spc_length = sizeof(struct sctp_paddr_change);
      if (sa->sa_family == AF_INET) {
            memcpy(&spc->spc_aaddr, sa, sizeof(struct sockaddr_in));
      } else {
            struct sockaddr_in6 *sin6;

            memcpy(&spc->spc_aaddr, sa, sizeof(struct sockaddr_in6));

            sin6 = (struct sockaddr_in6 *)&spc->spc_aaddr;
            if (IN6_IS_SCOPE_LINKLOCAL(&sin6->sin6_addr)) {
                  if (sin6->sin6_scope_id == 0) {
                        /* recover scope_id for user */
                        (void)sa6_recoverscope(sin6);
                  } else {
                        /* clear embedded scope_id for user */
                        in6_clearscope(&sin6->sin6_addr);
                  }
            }
      }
      spc->spc_state = state;
      spc->spc_error = error;
      spc->spc_assoc_id = sctp_get_associd(stcb);

      SCTP_BUF_LEN(m_notify) = sizeof(struct sctp_paddr_change);
      SCTP_BUF_NEXT(m_notify) = NULL;

      /* append to socket */
      control = sctp_build_readq_entry(stcb, stcb->asoc.primary_destination,
          0, 0, 0, 0, 0, 0,
          m_notify);
      if (control == NULL) {
            /* no memory */
            sctp_m_freem(m_notify);
            return;
      }
      control->length = SCTP_BUF_LEN(m_notify);
      control->spec_flags = M_NOTIFICATION;
      /* not that we need this */
      control->tail_mbuf = m_notify;
      sctp_add_to_readq(stcb->sctp_ep, stcb,
          control,
          &stcb->sctp_socket->so_rcv, 1, SCTP_SO_NOT_LOCKED);
}


static void
sctp_notify_send_failed(struct sctp_tcb *stcb, uint32_t error,
    struct sctp_tmit_chunk *chk, int so_locked
#if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
    SCTP_UNUSED
#endif
)
{
      struct mbuf *m_notify;
      struct sctp_send_failed *ssf;
      struct sctp_queued_to_read *control;
      int length;

      if ((stcb == NULL) || (sctp_is_feature_off(stcb->sctp_ep, SCTP_PCB_FLAGS_RECVSENDFAILEVNT)))
            /* event not enabled */
            return;

      length = sizeof(struct sctp_send_failed) + chk->send_size;
      m_notify = sctp_get_mbuf_for_msg(sizeof(struct sctp_send_failed), 0, M_DONTWAIT, 1, MT_DATA);
      if (m_notify == NULL)
            /* no space left */
            return;
      SCTP_BUF_LEN(m_notify) = 0;
      ssf = mtod(m_notify, struct sctp_send_failed *);
      ssf->ssf_type = SCTP_SEND_FAILED;
      if (error == SCTP_NOTIFY_DATAGRAM_UNSENT)
            ssf->ssf_flags = SCTP_DATA_UNSENT;
      else
            ssf->ssf_flags = SCTP_DATA_SENT;
      ssf->ssf_length = length;
      ssf->ssf_error = error;
      /* not exactly what the user sent in, but should be close :) */
      bzero(&ssf->ssf_info, sizeof(ssf->ssf_info));
      ssf->ssf_info.sinfo_stream = chk->rec.data.stream_number;
      ssf->ssf_info.sinfo_ssn = chk->rec.data.stream_seq;
      ssf->ssf_info.sinfo_flags = chk->rec.data.rcv_flags;
      ssf->ssf_info.sinfo_ppid = chk->rec.data.payloadtype;
      ssf->ssf_info.sinfo_context = chk->rec.data.context;
      ssf->ssf_info.sinfo_assoc_id = sctp_get_associd(stcb);
      ssf->ssf_assoc_id = sctp_get_associd(stcb);
      SCTP_BUF_NEXT(m_notify) = chk->data;
      SCTP_BUF_LEN(m_notify) = sizeof(struct sctp_send_failed);

      /* Steal off the mbuf */
      chk->data = NULL;
      /*
       * For this case, we check the actual socket buffer, since the assoc
       * is going away we don't want to overfill the socket buffer for a
       * non-reader
       */
      if (sctp_sbspace_failedmsgs(&stcb->sctp_socket->so_rcv) < SCTP_BUF_LEN(m_notify)) {
            sctp_m_freem(m_notify);
            return;
      }
      /* append to socket */
      control = sctp_build_readq_entry(stcb, stcb->asoc.primary_destination,
          0, 0, 0, 0, 0, 0,
          m_notify);
      if (control == NULL) {
            /* no memory */
            sctp_m_freem(m_notify);
            return;
      }
      control->spec_flags = M_NOTIFICATION;
      sctp_add_to_readq(stcb->sctp_ep, stcb,
          control,
          &stcb->sctp_socket->so_rcv, 1, so_locked);
}


static void
sctp_notify_send_failed2(struct sctp_tcb *stcb, uint32_t error,
    struct sctp_stream_queue_pending *sp, int so_locked
#if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
    SCTP_UNUSED
#endif
)
{
      struct mbuf *m_notify;
      struct sctp_send_failed *ssf;
      struct sctp_queued_to_read *control;
      int length;

      if ((stcb == NULL) || (sctp_is_feature_off(stcb->sctp_ep, SCTP_PCB_FLAGS_RECVSENDFAILEVNT)))
            /* event not enabled */
            return;

      length = sizeof(struct sctp_send_failed) + sp->length;
      m_notify = sctp_get_mbuf_for_msg(sizeof(struct sctp_send_failed), 0, M_DONTWAIT, 1, MT_DATA);
      if (m_notify == NULL)
            /* no space left */
            return;
      SCTP_BUF_LEN(m_notify) = 0;
      ssf = mtod(m_notify, struct sctp_send_failed *);
      ssf->ssf_type = SCTP_SEND_FAILED;
      if (error == SCTP_NOTIFY_DATAGRAM_UNSENT)
            ssf->ssf_flags = SCTP_DATA_UNSENT;
      else
            ssf->ssf_flags = SCTP_DATA_SENT;
      ssf->ssf_length = length;
      ssf->ssf_error = error;
      /* not exactly what the user sent in, but should be close :) */
      bzero(&ssf->ssf_info, sizeof(ssf->ssf_info));
      ssf->ssf_info.sinfo_stream = sp->stream;
      ssf->ssf_info.sinfo_ssn = sp->strseq;
      ssf->ssf_info.sinfo_flags = sp->sinfo_flags;
      ssf->ssf_info.sinfo_ppid = sp->ppid;
      ssf->ssf_info.sinfo_context = sp->context;
      ssf->ssf_info.sinfo_assoc_id = sctp_get_associd(stcb);
      ssf->ssf_assoc_id = sctp_get_associd(stcb);
      SCTP_BUF_NEXT(m_notify) = sp->data;
      SCTP_BUF_LEN(m_notify) = sizeof(struct sctp_send_failed);

      /* Steal off the mbuf */
      sp->data = NULL;
      /*
       * For this case, we check the actual socket buffer, since the assoc
       * is going away we don't want to overfill the socket buffer for a
       * non-reader
       */
      if (sctp_sbspace_failedmsgs(&stcb->sctp_socket->so_rcv) < SCTP_BUF_LEN(m_notify)) {
            sctp_m_freem(m_notify);
            return;
      }
      /* append to socket */
      control = sctp_build_readq_entry(stcb, stcb->asoc.primary_destination,
          0, 0, 0, 0, 0, 0,
          m_notify);
      if (control == NULL) {
            /* no memory */
            sctp_m_freem(m_notify);
            return;
      }
      control->spec_flags = M_NOTIFICATION;
      sctp_add_to_readq(stcb->sctp_ep, stcb,
          control,
          &stcb->sctp_socket->so_rcv, 1, so_locked);
}



static void
sctp_notify_adaptation_layer(struct sctp_tcb *stcb,
    uint32_t error)
{
      struct mbuf *m_notify;
      struct sctp_adaptation_event *sai;
      struct sctp_queued_to_read *control;

      if ((stcb == NULL) || (sctp_is_feature_off(stcb->sctp_ep, SCTP_PCB_FLAGS_ADAPTATIONEVNT)))
            /* event not enabled */
            return;

      m_notify = sctp_get_mbuf_for_msg(sizeof(struct sctp_adaption_event), 0, M_DONTWAIT, 1, MT_DATA);
      if (m_notify == NULL)
            /* no space left */
            return;
      SCTP_BUF_LEN(m_notify) = 0;
      sai = mtod(m_notify, struct sctp_adaptation_event *);
      sai->sai_type = SCTP_ADAPTATION_INDICATION;
      sai->sai_flags = 0;
      sai->sai_length = sizeof(struct sctp_adaptation_event);
      sai->sai_adaptation_ind = stcb->asoc.peers_adaptation;
      sai->sai_assoc_id = sctp_get_associd(stcb);

      SCTP_BUF_LEN(m_notify) = sizeof(struct sctp_adaptation_event);
      SCTP_BUF_NEXT(m_notify) = NULL;

      /* append to socket */
      control = sctp_build_readq_entry(stcb, stcb->asoc.primary_destination,
          0, 0, 0, 0, 0, 0,
          m_notify);
      if (control == NULL) {
            /* no memory */
            sctp_m_freem(m_notify);
            return;
      }
      control->length = SCTP_BUF_LEN(m_notify);
      control->spec_flags = M_NOTIFICATION;
      /* not that we need this */
      control->tail_mbuf = m_notify;
      sctp_add_to_readq(stcb->sctp_ep, stcb,
          control,
          &stcb->sctp_socket->so_rcv, 1, SCTP_SO_NOT_LOCKED);
}

/* This always must be called with the read-queue LOCKED in the INP */
void
sctp_notify_partial_delivery_indication(struct sctp_tcb *stcb, uint32_t error,
    int nolock, uint32_t val)
{
      struct mbuf *m_notify;
      struct sctp_pdapi_event *pdapi;
      struct sctp_queued_to_read *control;
      struct sockbuf *sb;

      if ((stcb == NULL) || (stcb->sctp_socket == NULL) ||
          sctp_is_feature_off(stcb->sctp_ep, SCTP_PCB_FLAGS_PDAPIEVNT))
            /* event not enabled */
            return;

      m_notify = sctp_get_mbuf_for_msg(sizeof(struct sctp_pdapi_event), 0, M_DONTWAIT, 1, MT_DATA);
      if (m_notify == NULL)
            /* no space left */
            return;
      SCTP_BUF_LEN(m_notify) = 0;
      pdapi = mtod(m_notify, struct sctp_pdapi_event *);
      pdapi->pdapi_type = SCTP_PARTIAL_DELIVERY_EVENT;
      pdapi->pdapi_flags = 0;
      pdapi->pdapi_length = sizeof(struct sctp_pdapi_event);
      pdapi->pdapi_indication = error;
      pdapi->pdapi_stream = (val >> 16);
      pdapi->pdapi_seq = (val & 0x0000ffff);
      pdapi->pdapi_assoc_id = sctp_get_associd(stcb);

      SCTP_BUF_LEN(m_notify) = sizeof(struct sctp_pdapi_event);
      SCTP_BUF_NEXT(m_notify) = NULL;
      control = sctp_build_readq_entry(stcb, stcb->asoc.primary_destination,
          0, 0, 0, 0, 0, 0,
          m_notify);
      if (control == NULL) {
            /* no memory */
            sctp_m_freem(m_notify);
            return;
      }
      control->spec_flags = M_NOTIFICATION;
      control->length = SCTP_BUF_LEN(m_notify);
      /* not that we need this */
      control->tail_mbuf = m_notify;
      control->held_length = 0;
      control->length = 0;
      if (nolock == 0) {
            SCTP_INP_READ_LOCK(stcb->sctp_ep);
      }
      sb = &stcb->sctp_socket->so_rcv;
      if (sctp_logging_level & SCTP_SB_LOGGING_ENABLE) {
            sctp_sblog(sb, control->do_not_ref_stcb ? NULL : stcb, SCTP_LOG_SBALLOC, SCTP_BUF_LEN(m_notify));
      }
      sctp_sballoc(stcb, sb, m_notify);
      if (sctp_logging_level & SCTP_SB_LOGGING_ENABLE) {
            sctp_sblog(sb, control->do_not_ref_stcb ? NULL : stcb, SCTP_LOG_SBRESULT, 0);
      }
      atomic_add_int(&control->length, SCTP_BUF_LEN(m_notify));
      control->end_added = 1;
      if (stcb->asoc.control_pdapi)
            TAILQ_INSERT_AFTER(&stcb->sctp_ep->read_queue, stcb->asoc.control_pdapi, control, next);
      else {
            /* we really should not see this case */
            TAILQ_INSERT_TAIL(&stcb->sctp_ep->read_queue, control, next);
      }
      if (nolock == 0) {
            SCTP_INP_READ_UNLOCK(stcb->sctp_ep);
      }
      if (stcb->sctp_ep && stcb->sctp_socket) {
            /* This should always be the case */
            sctp_sorwakeup(stcb->sctp_ep, stcb->sctp_socket);
      }
}

static void
sctp_notify_shutdown_event(struct sctp_tcb *stcb)
{
      struct mbuf *m_notify;
      struct sctp_shutdown_event *sse;
      struct sctp_queued_to_read *control;

      /*
       * For TCP model AND UDP connected sockets we will send an error up
       * when an SHUTDOWN completes
       */
      if (stcb == NULL) {
            return;
      }
      if ((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) ||
          (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_IN_TCPPOOL)) {
            /* mark socket closed for read/write and wakeup! */
#if defined (__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
            struct socket *so;

            so = SCTP_INP_SO(stcb->sctp_ep);
            atomic_add_int(&stcb->asoc.refcnt, 1);
            SCTP_TCB_UNLOCK(stcb);
            SCTP_SOCKET_LOCK(so, 1);
            SCTP_TCB_LOCK(stcb);
            atomic_subtract_int(&stcb->asoc.refcnt, 1);
            if (stcb->asoc.state & SCTP_STATE_CLOSED_SOCKET) {
                  SCTP_SOCKET_UNLOCK(so, 1);
                  return;
            }
#endif
            socantsendmore(stcb->sctp_socket);
            socantrcvmore(stcb->sctp_socket);
#if defined (__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
            SCTP_SOCKET_UNLOCK(so, 1);
#endif
      }
      if (sctp_is_feature_off(stcb->sctp_ep, SCTP_PCB_FLAGS_RECVSHUTDOWNEVNT))
            /* event not enabled */
            return;

      m_notify = sctp_get_mbuf_for_msg(sizeof(struct sctp_shutdown_event), 0, M_DONTWAIT, 1, MT_DATA);
      if (m_notify == NULL)
            /* no space left */
            return;
      sse = mtod(m_notify, struct sctp_shutdown_event *);
      sse->sse_type = SCTP_SHUTDOWN_EVENT;
      sse->sse_flags = 0;
      sse->sse_length = sizeof(struct sctp_shutdown_event);
      sse->sse_assoc_id = sctp_get_associd(stcb);

      SCTP_BUF_LEN(m_notify) = sizeof(struct sctp_shutdown_event);
      SCTP_BUF_NEXT(m_notify) = NULL;

      /* append to socket */
      control = sctp_build_readq_entry(stcb, stcb->asoc.primary_destination,
          0, 0, 0, 0, 0, 0,
          m_notify);
      if (control == NULL) {
            /* no memory */
            sctp_m_freem(m_notify);
            return;
      }
      control->spec_flags = M_NOTIFICATION;
      control->length = SCTP_BUF_LEN(m_notify);
      /* not that we need this */
      control->tail_mbuf = m_notify;
      sctp_add_to_readq(stcb->sctp_ep, stcb,
          control,
          &stcb->sctp_socket->so_rcv, 1, SCTP_SO_NOT_LOCKED);
}

static void
sctp_notify_stream_reset(struct sctp_tcb *stcb,
    int number_entries, uint16_t * list, int flag)
{
      struct mbuf *m_notify;
      struct sctp_queued_to_read *control;
      struct sctp_stream_reset_event *strreset;
      int len;

      if (stcb == NULL) {
            return;
      }
      if (sctp_is_feature_off(stcb->sctp_ep, SCTP_PCB_FLAGS_STREAM_RESETEVNT))
            /* event not enabled */
            return;

      m_notify = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_DONTWAIT, 1, MT_DATA);
      if (m_notify == NULL)
            /* no space left */
            return;
      SCTP_BUF_LEN(m_notify) = 0;
      len = sizeof(struct sctp_stream_reset_event) + (number_entries * sizeof(uint16_t));
      if (len > M_TRAILINGSPACE(m_notify)) {
            /* never enough room */
            sctp_m_freem(m_notify);
            return;
      }
      strreset = mtod(m_notify, struct sctp_stream_reset_event *);
      strreset->strreset_type = SCTP_STREAM_RESET_EVENT;
      if (number_entries == 0) {
            strreset->strreset_flags = flag | SCTP_STRRESET_ALL_STREAMS;
      } else {
            strreset->strreset_flags = flag | SCTP_STRRESET_STREAM_LIST;
      }
      strreset->strreset_length = len;
      strreset->strreset_assoc_id = sctp_get_associd(stcb);
      if (number_entries) {
            int i;

            for (i = 0; i < number_entries; i++) {
                  strreset->strreset_list[i] = ntohs(list[i]);
            }
      }
      SCTP_BUF_LEN(m_notify) = len;
      SCTP_BUF_NEXT(m_notify) = NULL;
      if (sctp_sbspace(&stcb->asoc, &stcb->sctp_socket->so_rcv) < SCTP_BUF_LEN(m_notify)) {
            /* no space */
            sctp_m_freem(m_notify);
            return;
      }
      /* append to socket */
      control = sctp_build_readq_entry(stcb, stcb->asoc.primary_destination,
          0, 0, 0, 0, 0, 0,
          m_notify);
      if (control == NULL) {
            /* no memory */
            sctp_m_freem(m_notify);
            return;
      }
      control->spec_flags = M_NOTIFICATION;
      control->length = SCTP_BUF_LEN(m_notify);
      /* not that we need this */
      control->tail_mbuf = m_notify;
      sctp_add_to_readq(stcb->sctp_ep, stcb,
          control,
          &stcb->sctp_socket->so_rcv, 1, SCTP_SO_NOT_LOCKED);
}


void
sctp_ulp_notify(uint32_t notification, struct sctp_tcb *stcb,
    uint32_t error, void *data, int so_locked
#if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
    SCTP_UNUSED
#endif
)
{
      if (stcb == NULL) {
            /* unlikely but */
            return;
      }
      if ((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE) ||
          (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_SOCKET_ALLGONE) ||
          (stcb->asoc.state & SCTP_STATE_CLOSED_SOCKET)
          ) {
            /* No notifications up when we are in a no socket state */
            return;
      }
      if (stcb->asoc.state & SCTP_STATE_CLOSED_SOCKET) {
            /* Can't send up to a closed socket any notifications */
            return;
      }
      if (stcb && ((stcb->asoc.state & SCTP_STATE_COOKIE_WAIT) ||
          (stcb->asoc.state & SCTP_STATE_COOKIE_ECHOED))) {
            if ((notification == SCTP_NOTIFY_INTERFACE_DOWN) ||
                (notification == SCTP_NOTIFY_INTERFACE_UP) ||
                (notification == SCTP_NOTIFY_INTERFACE_CONFIRMED)) {
                  /* Don't report these in front states */
                  return;
            }
      }
      switch (notification) {
      case SCTP_NOTIFY_ASSOC_UP:
            if (stcb->asoc.assoc_up_sent == 0) {
                  sctp_notify_assoc_change(SCTP_COMM_UP, stcb, error, NULL, so_locked);
                  stcb->asoc.assoc_up_sent = 1;
            }
            if (stcb->asoc.adaptation_needed && (stcb->asoc.adaptation_sent == 0)) {
                  sctp_notify_adaptation_layer(stcb, error);
            }
            break;
      case SCTP_NOTIFY_ASSOC_DOWN:
            sctp_notify_assoc_change(SCTP_SHUTDOWN_COMP, stcb, error, NULL, so_locked);
            break;
      case SCTP_NOTIFY_INTERFACE_DOWN:
            {
                  struct sctp_nets *net;

                  net = (struct sctp_nets *)data;
                  sctp_notify_peer_addr_change(stcb, SCTP_ADDR_UNREACHABLE,
                      (struct sockaddr *)&net->ro._l_addr, error);
                  break;
            }
      case SCTP_NOTIFY_INTERFACE_UP:
            {
                  struct sctp_nets *net;

                  net = (struct sctp_nets *)data;
                  sctp_notify_peer_addr_change(stcb, SCTP_ADDR_AVAILABLE,
                      (struct sockaddr *)&net->ro._l_addr, error);
                  break;
            }
      case SCTP_NOTIFY_INTERFACE_CONFIRMED:
            {
                  struct sctp_nets *net;

                  net = (struct sctp_nets *)data;
                  sctp_notify_peer_addr_change(stcb, SCTP_ADDR_CONFIRMED,
                      (struct sockaddr *)&net->ro._l_addr, error);
                  break;
            }
      case SCTP_NOTIFY_SPECIAL_SP_FAIL:
            sctp_notify_send_failed2(stcb, error,
                (struct sctp_stream_queue_pending *)data, so_locked);
            break;
      case SCTP_NOTIFY_DG_FAIL:
            sctp_notify_send_failed(stcb, error,
                (struct sctp_tmit_chunk *)data, so_locked);
            break;
      case SCTP_NOTIFY_PARTIAL_DELVIERY_INDICATION:
            {
                  uint32_t val;

                  val = *((uint32_t *) data);

                  sctp_notify_partial_delivery_indication(stcb, error, 0, val);
            }
            break;
      case SCTP_NOTIFY_STRDATA_ERR:
            break;
      case SCTP_NOTIFY_ASSOC_ABORTED:
            if ((stcb) && (((stcb->asoc.state & SCTP_STATE_MASK) == SCTP_STATE_COOKIE_WAIT) ||
                ((stcb->asoc.state & SCTP_STATE_MASK) == SCTP_STATE_COOKIE_ECHOED))) {
                  sctp_notify_assoc_change(SCTP_CANT_STR_ASSOC, stcb, error, NULL, so_locked);
            } else {
                  sctp_notify_assoc_change(SCTP_COMM_LOST, stcb, error, NULL, so_locked);
            }
            break;
      case SCTP_NOTIFY_PEER_OPENED_STREAM:
            break;
      case SCTP_NOTIFY_STREAM_OPENED_OK:
            break;
      case SCTP_NOTIFY_ASSOC_RESTART:
            sctp_notify_assoc_change(SCTP_RESTART, stcb, error, data, so_locked);
            break;
      case SCTP_NOTIFY_HB_RESP:
            break;
      case SCTP_NOTIFY_STR_RESET_SEND:
            sctp_notify_stream_reset(stcb, error, ((uint16_t *) data), SCTP_STRRESET_OUTBOUND_STR);
            break;
      case SCTP_NOTIFY_STR_RESET_RECV:
            sctp_notify_stream_reset(stcb, error, ((uint16_t *) data), SCTP_STRRESET_INBOUND_STR);
            break;
      case SCTP_NOTIFY_STR_RESET_FAILED_OUT:
            sctp_notify_stream_reset(stcb, error, ((uint16_t *) data), (SCTP_STRRESET_OUTBOUND_STR | SCTP_STRRESET_FAILED));
            break;

      case SCTP_NOTIFY_STR_RESET_FAILED_IN:
            sctp_notify_stream_reset(stcb, error, ((uint16_t *) data), (SCTP_STRRESET_INBOUND_STR | SCTP_STRRESET_FAILED));
            break;

      case SCTP_NOTIFY_ASCONF_ADD_IP:
            sctp_notify_peer_addr_change(stcb, SCTP_ADDR_ADDED, data,
                error);
            break;
      case SCTP_NOTIFY_ASCONF_DELETE_IP:
            sctp_notify_peer_addr_change(stcb, SCTP_ADDR_REMOVED, data,
                error);
            break;
      case SCTP_NOTIFY_ASCONF_SET_PRIMARY:
            sctp_notify_peer_addr_change(stcb, SCTP_ADDR_MADE_PRIM, data,
                error);
            break;
      case SCTP_NOTIFY_ASCONF_SUCCESS:
            break;
      case SCTP_NOTIFY_ASCONF_FAILED:
            break;
      case SCTP_NOTIFY_PEER_SHUTDOWN:
            sctp_notify_shutdown_event(stcb);
            break;
      case SCTP_NOTIFY_AUTH_NEW_KEY:
            sctp_notify_authentication(stcb, SCTP_AUTH_NEWKEY, error,
                (uint16_t) (uintptr_t) data);
            break;
#if 0
      case SCTP_NOTIFY_AUTH_KEY_CONFLICT:
            sctp_notify_authentication(stcb, SCTP_AUTH_KEY_CONFLICT,
                error, (uint16_t) (uintptr_t) data);
            break;
#endif                        /* not yet? remove? */


      default:
            SCTPDBG(SCTP_DEBUG_UTIL1, "%s: unknown notification %xh (%u)\n",
                __FUNCTION__, notification, notification);
            break;
      }                 /* end switch */
}

void
sctp_report_all_outbound(struct sctp_tcb *stcb, int holds_lock, int so_locked
#if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
    SCTP_UNUSED
#endif
)
{
      struct sctp_association *asoc;
      struct sctp_stream_out *outs;
      struct sctp_tmit_chunk *chk;
      struct sctp_stream_queue_pending *sp;
      int i;

      asoc = &stcb->asoc;

      if (stcb == NULL) {
            return;
      }
      if ((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE) ||
          (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_SOCKET_ALLGONE) ||
          (stcb->asoc.state & SCTP_STATE_CLOSED_SOCKET)) {
            return;
      }
      /* now through all the gunk freeing chunks */
      if (holds_lock == 0) {
            SCTP_TCB_SEND_LOCK(stcb);
      }
      /* sent queue SHOULD be empty */
      if (!TAILQ_EMPTY(&asoc->sent_queue)) {
            chk = TAILQ_FIRST(&asoc->sent_queue);
            while (chk) {
                  TAILQ_REMOVE(&asoc->sent_queue, chk, sctp_next);
                  asoc->sent_queue_cnt--;
                  if (chk->data) {
                        /*
                         * trim off the sctp chunk header(it should
                         * be there)
                         */
                        if (chk->send_size >= sizeof(struct sctp_data_chunk)) {
                              m_adj(chk->data, sizeof(struct sctp_data_chunk));
                              sctp_mbuf_crush(chk->data);
                              chk->send_size -= sizeof(struct sctp_data_chunk);
                        }
                  }
                  sctp_free_bufspace(stcb, asoc, chk, 1);
                  sctp_ulp_notify(SCTP_NOTIFY_DG_FAIL, stcb,
                      SCTP_NOTIFY_DATAGRAM_SENT, chk, so_locked);
                  if (chk->data) {
                        sctp_m_freem(chk->data);
                        chk->data = NULL;
                  }
                  sctp_free_a_chunk(stcb, chk);
                  /* sa_ignore FREED_MEMORY */
                  chk = TAILQ_FIRST(&asoc->sent_queue);
            }
      }
      /* pending send queue SHOULD be empty */
      if (!TAILQ_EMPTY(&asoc->send_queue)) {
            chk = TAILQ_FIRST(&asoc->send_queue);
            while (chk) {
                  TAILQ_REMOVE(&asoc->send_queue, chk, sctp_next);
                  asoc->send_queue_cnt--;
                  if (chk->data) {
                        /*
                         * trim off the sctp chunk header(it should
                         * be there)
                         */
                        if (chk->send_size >= sizeof(struct sctp_data_chunk)) {
                              m_adj(chk->data, sizeof(struct sctp_data_chunk));
                              sctp_mbuf_crush(chk->data);
                              chk->send_size -= sizeof(struct sctp_data_chunk);
                        }
                  }
                  sctp_free_bufspace(stcb, asoc, chk, 1);
                  sctp_ulp_notify(SCTP_NOTIFY_DG_FAIL, stcb, SCTP_NOTIFY_DATAGRAM_UNSENT, chk, so_locked);
                  if (chk->data) {
                        sctp_m_freem(chk->data);
                        chk->data = NULL;
                  }
                  sctp_free_a_chunk(stcb, chk);
                  /* sa_ignore FREED_MEMORY */
                  chk = TAILQ_FIRST(&asoc->send_queue);
            }
      }
      for (i = 0; i < stcb->asoc.streamoutcnt; i++) {
            /* For each stream */
            outs = &stcb->asoc.strmout[i];
            /* clean up any sends there */
            stcb->asoc.locked_on_sending = NULL;
            sp = TAILQ_FIRST(&outs->outqueue);
            while (sp) {
                  stcb->asoc.stream_queue_cnt--;
                  TAILQ_REMOVE(&outs->outqueue, sp, next);
                  sctp_free_spbufspace(stcb, asoc, sp);
                  sctp_ulp_notify(SCTP_NOTIFY_SPECIAL_SP_FAIL, stcb,
                      SCTP_NOTIFY_DATAGRAM_UNSENT, (void *)sp, so_locked);
                  if (sp->data) {
                        sctp_m_freem(sp->data);
                        sp->data = NULL;
                  }
                  if (sp->net)
                        sctp_free_remote_addr(sp->net);
                  sp->net = NULL;
                  /* Free the chunk */
                  sctp_free_a_strmoq(stcb, sp);
                  /* sa_ignore FREED_MEMORY */
                  sp = TAILQ_FIRST(&outs->outqueue);
            }
      }

      if (holds_lock == 0) {
            SCTP_TCB_SEND_UNLOCK(stcb);
      }
}

void
sctp_abort_notification(struct sctp_tcb *stcb, int error, int so_locked
#if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
    SCTP_UNUSED
#endif
)
{

      if (stcb == NULL) {
            return;
      }
      if ((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE) ||
          (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_SOCKET_ALLGONE) ||
          (stcb->asoc.state & SCTP_STATE_CLOSED_SOCKET)) {
            return;
      }
      /* Tell them we lost the asoc */
      sctp_report_all_outbound(stcb, 1, so_locked);
      if ((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_IN_TCPPOOL) ||
          ((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) &&
          (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_CONNECTED))) {
            stcb->sctp_ep->sctp_flags |= SCTP_PCB_FLAGS_WAS_ABORTED;
      }
      sctp_ulp_notify(SCTP_NOTIFY_ASSOC_ABORTED, stcb, error, NULL, so_locked);
}

void
sctp_abort_association(struct sctp_inpcb *inp, struct sctp_tcb *stcb,
    struct mbuf *m, int iphlen, struct sctphdr *sh, struct mbuf *op_err,
    uint32_t vrf_id)
{
      uint32_t vtag;

#if defined (__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
      struct socket *so;

#endif

      vtag = 0;
      if (stcb != NULL) {
            /* We have a TCB to abort, send notification too */
            vtag = stcb->asoc.peer_vtag;
            sctp_abort_notification(stcb, 0, SCTP_SO_NOT_LOCKED);
            /* get the assoc vrf id and table id */
            vrf_id = stcb->asoc.vrf_id;
            stcb->asoc.state |= SCTP_STATE_WAS_ABORTED;
      }
      sctp_send_abort(m, iphlen, sh, vtag, op_err, vrf_id);
      if (stcb != NULL) {
            /* Ok, now lets free it */
#if defined (__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
            so = SCTP_INP_SO(inp);
            atomic_add_int(&stcb->asoc.refcnt, 1);
            SCTP_TCB_UNLOCK(stcb);
            SCTP_SOCKET_LOCK(so, 1);
            SCTP_TCB_LOCK(stcb);
            atomic_subtract_int(&stcb->asoc.refcnt, 1);
#endif
            (void)sctp_free_assoc(inp, stcb, SCTP_NORMAL_PROC, SCTP_FROM_SCTPUTIL + SCTP_LOC_4);
#if defined (__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
            SCTP_SOCKET_UNLOCK(so, 1);
#endif
      } else {
            if (inp->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE) {
                  if (LIST_FIRST(&inp->sctp_asoc_list) == NULL) {
                        sctp_inpcb_free(inp, SCTP_FREE_SHOULD_USE_ABORT,
                            SCTP_CALLED_DIRECTLY_NOCMPSET);
                  }
            }
      }
}

#ifdef SCTP_ASOCLOG_OF_TSNS
void
sctp_print_out_track_log(struct sctp_tcb *stcb)
{
#ifdef NOSIY_PRINTS
      int i;

      SCTP_PRINTF("Last ep reason:%x\n", stcb->sctp_ep->last_abort_code);
      SCTP_PRINTF("IN bound TSN log-aaa\n");
      if ((stcb->asoc.tsn_in_at == 0) && (stcb->asoc.tsn_in_wrapped == 0)) {
            SCTP_PRINTF("None rcvd\n");
            goto none_in;
      }
      if (stcb->asoc.tsn_in_wrapped) {
            for (i = stcb->asoc.tsn_in_at; i < SCTP_TSN_LOG_SIZE; i++) {
                  SCTP_PRINTF("TSN:%x strm:%d seq:%d flags:%x sz:%d\n",
                      stcb->asoc.in_tsnlog[i].tsn,
                      stcb->asoc.in_tsnlog[i].strm,
                      stcb->asoc.in_tsnlog[i].seq,
                      stcb->asoc.in_tsnlog[i].flgs,
                      stcb->asoc.in_tsnlog[i].sz);
            }
      }
      if (stcb->asoc.tsn_in_at) {
            for (i = 0; i < stcb->asoc.tsn_in_at; i++) {
                  SCTP_PRINTF("TSN:%x strm:%d seq:%d flags:%x sz:%d\n",
                      stcb->asoc.in_tsnlog[i].tsn,
                      stcb->asoc.in_tsnlog[i].strm,
                      stcb->asoc.in_tsnlog[i].seq,
                      stcb->asoc.in_tsnlog[i].flgs,
                      stcb->asoc.in_tsnlog[i].sz);
            }
      }
none_in:
      SCTP_PRINTF("OUT bound TSN log-aaa\n");
      if ((stcb->asoc.tsn_out_at == 0) &&
          (stcb->asoc.tsn_out_wrapped == 0)) {
            SCTP_PRINTF("None sent\n");
      }
      if (stcb->asoc.tsn_out_wrapped) {
            for (i = stcb->asoc.tsn_out_at; i < SCTP_TSN_LOG_SIZE; i++) {
                  SCTP_PRINTF("TSN:%x strm:%d seq:%d flags:%x sz:%d\n",
                      stcb->asoc.out_tsnlog[i].tsn,
                      stcb->asoc.out_tsnlog[i].strm,
                      stcb->asoc.out_tsnlog[i].seq,
                      stcb->asoc.out_tsnlog[i].flgs,
                      stcb->asoc.out_tsnlog[i].sz);
            }
      }
      if (stcb->asoc.tsn_out_at) {
            for (i = 0; i < stcb->asoc.tsn_out_at; i++) {
                  SCTP_PRINTF("TSN:%x strm:%d seq:%d flags:%x sz:%d\n",
                      stcb->asoc.out_tsnlog[i].tsn,
                      stcb->asoc.out_tsnlog[i].strm,
                      stcb->asoc.out_tsnlog[i].seq,
                      stcb->asoc.out_tsnlog[i].flgs,
                      stcb->asoc.out_tsnlog[i].sz);
            }
      }
#endif
}

#endif

void
sctp_abort_an_association(struct sctp_inpcb *inp, struct sctp_tcb *stcb,
    int error, struct mbuf *op_err,
    int so_locked
#if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
    SCTP_UNUSED
#endif
)
{
      uint32_t vtag;

#if defined (__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
      struct socket *so;

#endif

#if defined (__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
      so = SCTP_INP_SO(inp);
#endif
      if (stcb == NULL) {
            /* Got to have a TCB */
            if (inp->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE) {
                  if (LIST_FIRST(&inp->sctp_asoc_list) == NULL) {
                        sctp_inpcb_free(inp, SCTP_FREE_SHOULD_USE_ABORT,
                            SCTP_CALLED_DIRECTLY_NOCMPSET);
                  }
            }
            return;
      } else {
            stcb->asoc.state |= SCTP_STATE_WAS_ABORTED;
      }
      vtag = stcb->asoc.peer_vtag;
      /* notify the ulp */
      if ((inp->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE) == 0)
            sctp_abort_notification(stcb, error, so_locked);
      /* notify the peer */
#if defined(SCTP_PANIC_ON_ABORT)
      panic("aborting an association");
#endif
      sctp_send_abort_tcb(stcb, op_err, so_locked);
      SCTP_STAT_INCR_COUNTER32(sctps_aborted);
      if ((SCTP_GET_STATE(&stcb->asoc) == SCTP_STATE_OPEN) ||
          (SCTP_GET_STATE(&stcb->asoc) == SCTP_STATE_SHUTDOWN_RECEIVED)) {
            SCTP_STAT_DECR_GAUGE32(sctps_currestab);
      }
      /* now free the asoc */
#ifdef SCTP_ASOCLOG_OF_TSNS
      sctp_print_out_track_log(stcb);
#endif
#if defined (__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
      if (!so_locked) {
            atomic_add_int(&stcb->asoc.refcnt, 1);
            SCTP_TCB_UNLOCK(stcb);
            SCTP_SOCKET_LOCK(so, 1);
            SCTP_TCB_LOCK(stcb);
            atomic_subtract_int(&stcb->asoc.refcnt, 1);
      }
#endif
      (void)sctp_free_assoc(inp, stcb, SCTP_NORMAL_PROC, SCTP_FROM_SCTPUTIL + SCTP_LOC_5);
#if defined (__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
      if (!so_locked) {
            SCTP_SOCKET_UNLOCK(so, 1);
      }
#endif
}

void
sctp_handle_ootb(struct mbuf *m, int iphlen, int offset, struct sctphdr *sh,
    struct sctp_inpcb *inp, struct mbuf *op_err, uint32_t vrf_id)
{
      struct sctp_chunkhdr *ch, chunk_buf;
      unsigned int chk_length;

      SCTP_STAT_INCR_COUNTER32(sctps_outoftheblue);
      /* Generate a TO address for future reference */
      if (inp && (inp->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE)) {
            if (LIST_FIRST(&inp->sctp_asoc_list) == NULL) {
                  sctp_inpcb_free(inp, SCTP_FREE_SHOULD_USE_ABORT,
                      SCTP_CALLED_DIRECTLY_NOCMPSET);
            }
      }
      ch = (struct sctp_chunkhdr *)sctp_m_getptr(m, offset,
          sizeof(*ch), (uint8_t *) & chunk_buf);
      while (ch != NULL) {
            chk_length = ntohs(ch->chunk_length);
            if (chk_length < sizeof(*ch)) {
                  /* break to abort land */
                  break;
            }
            switch (ch->chunk_type) {
            case SCTP_COOKIE_ECHO:
                  /* We hit here only if the assoc is being freed */
                  return;
            case SCTP_PACKET_DROPPED:
                  /* we don't respond to pkt-dropped */
                  return;
            case SCTP_ABORT_ASSOCIATION:
                  /* we don't respond with an ABORT to an ABORT */
                  return;
            case SCTP_SHUTDOWN_COMPLETE:
                  /*
                   * we ignore it since we are not waiting for it and
                   * peer is gone
                   */
                  return;
            case SCTP_SHUTDOWN_ACK:
                  sctp_send_shutdown_complete2(m, iphlen, sh, vrf_id);
                  return;
            default:
                  break;
            }
            offset += SCTP_SIZE32(chk_length);
            ch = (struct sctp_chunkhdr *)sctp_m_getptr(m, offset,
                sizeof(*ch), (uint8_t *) & chunk_buf);
      }
      sctp_send_abort(m, iphlen, sh, 0, op_err, vrf_id);
}

/*
 * check the inbound datagram to make sure there is not an abort inside it,
 * if there is return 1, else return 0.
 */
int
sctp_is_there_an_abort_here(struct mbuf *m, int iphlen, uint32_t * vtagfill)
{
      struct sctp_chunkhdr *ch;
      struct sctp_init_chunk *init_chk, chunk_buf;
      int offset;
      unsigned int chk_length;

      offset = iphlen + sizeof(struct sctphdr);
      ch = (struct sctp_chunkhdr *)sctp_m_getptr(m, offset, sizeof(*ch),
          (uint8_t *) & chunk_buf);
      while (ch != NULL) {
            chk_length = ntohs(ch->chunk_length);
            if (chk_length < sizeof(*ch)) {
                  /* packet is probably corrupt */
                  break;
            }
            /* we seem to be ok, is it an abort? */
            if (ch->chunk_type == SCTP_ABORT_ASSOCIATION) {
                  /* yep, tell them */
                  return (1);
            }
            if (ch->chunk_type == SCTP_INITIATION) {
                  /* need to update the Vtag */
                  init_chk = (struct sctp_init_chunk *)sctp_m_getptr(m,
                      offset, sizeof(*init_chk), (uint8_t *) & chunk_buf);
                  if (init_chk != NULL) {
                        *vtagfill = ntohl(init_chk->init.initiate_tag);
                  }
            }
            /* Nope, move to the next chunk */
            offset += SCTP_SIZE32(chk_length);
            ch = (struct sctp_chunkhdr *)sctp_m_getptr(m, offset,
                sizeof(*ch), (uint8_t *) & chunk_buf);
      }
      return (0);
}

/*
 * currently (2/02), ifa_addr embeds scope_id's and don't have sin6_scope_id
 * set (i.e. it's 0) so, create this function to compare link local scopes
 */
uint32_t
sctp_is_same_scope(struct sockaddr_in6 *addr1, struct sockaddr_in6 *addr2)
{
      struct sockaddr_in6 a, b;

      /* save copies */
      a = *addr1;
      b = *addr2;

      if (a.sin6_scope_id == 0)
            if (sa6_recoverscope(&a)) {
                  /* can't get scope, so can't match */
                  return (0);
            }
      if (b.sin6_scope_id == 0)
            if (sa6_recoverscope(&b)) {
                  /* can't get scope, so can't match */
                  return (0);
            }
      if (a.sin6_scope_id != b.sin6_scope_id)
            return (0);

      return (1);
}

/*
 * returns a sockaddr_in6 with embedded scope recovered and removed
 */
struct sockaddr_in6 *
sctp_recover_scope(struct sockaddr_in6 *addr, struct sockaddr_in6 *store)
{
      /* check and strip embedded scope junk */
      if (addr->sin6_family == AF_INET6) {
            if (IN6_IS_SCOPE_LINKLOCAL(&addr->sin6_addr)) {
                  if (addr->sin6_scope_id == 0) {
                        *store = *addr;
                        if (!sa6_recoverscope(store)) {
                              /* use the recovered scope */
                              addr = store;
                        }
                  } else {
                        /* else, return the original "to" addr */
                        in6_clearscope(&addr->sin6_addr);
                  }
            }
      }
      return (addr);
}

/*
 * are the two addresses the same?  currently a "scopeless" check returns: 1
 * if same, 0 if not
 */
int
sctp_cmpaddr(struct sockaddr *sa1, struct sockaddr *sa2)
{

      /* must be valid */
      if (sa1 == NULL || sa2 == NULL)
            return (0);

      /* must be the same family */
      if (sa1->sa_family != sa2->sa_family)
            return (0);

      if (sa1->sa_family == AF_INET6) {
            /* IPv6 addresses */
            struct sockaddr_in6 *sin6_1, *sin6_2;

            sin6_1 = (struct sockaddr_in6 *)sa1;
            sin6_2 = (struct sockaddr_in6 *)sa2;
            return (SCTP6_ARE_ADDR_EQUAL(&sin6_1->sin6_addr,
                &sin6_2->sin6_addr));
      } else if (sa1->sa_family == AF_INET) {
            /* IPv4 addresses */
            struct sockaddr_in *sin_1, *sin_2;

            sin_1 = (struct sockaddr_in *)sa1;
            sin_2 = (struct sockaddr_in *)sa2;
            return (sin_1->sin_addr.s_addr == sin_2->sin_addr.s_addr);
      } else {
            /* we don't do these... */
            return (0);
      }
}

void
sctp_print_address(struct sockaddr *sa)
{
      char ip6buf[INET6_ADDRSTRLEN];

      ip6buf[0] = 0;
      if (sa->sa_family == AF_INET6) {
            struct sockaddr_in6 *sin6;

            sin6 = (struct sockaddr_in6 *)sa;
            SCTP_PRINTF("IPv6 address: %s:port:%d scope:%u\n",
                ip6_sprintf(ip6buf, &sin6->sin6_addr),
                ntohs(sin6->sin6_port),
                sin6->sin6_scope_id);
      } else if (sa->sa_family == AF_INET) {
            struct sockaddr_in *sin;
            unsigned char *p;

            sin = (struct sockaddr_in *)sa;
            p = (unsigned char *)&sin->sin_addr;
            SCTP_PRINTF("IPv4 address: %u.%u.%u.%u:%d\n",
                p[0], p[1], p[2], p[3], ntohs(sin->sin_port));
      } else {
            SCTP_PRINTF("?\n");
      }
}

void
sctp_print_address_pkt(struct ip *iph, struct sctphdr *sh)
{
      if (iph->ip_v == IPVERSION) {
            struct sockaddr_in lsa, fsa;

            bzero(&lsa, sizeof(lsa));
            lsa.sin_len = sizeof(lsa);
            lsa.sin_family = AF_INET;
            lsa.sin_addr = iph->ip_src;
            lsa.sin_port = sh->src_port;
            bzero(&fsa, sizeof(fsa));
            fsa.sin_len = sizeof(fsa);
            fsa.sin_family = AF_INET;
            fsa.sin_addr = iph->ip_dst;
            fsa.sin_port = sh->dest_port;
            SCTP_PRINTF("src: ");
            sctp_print_address((struct sockaddr *)&lsa);
            SCTP_PRINTF("dest: ");
            sctp_print_address((struct sockaddr *)&fsa);
      } else if (iph->ip_v == (IPV6_VERSION >> 4)) {
            struct ip6_hdr *ip6;
            struct sockaddr_in6 lsa6, fsa6;

            ip6 = (struct ip6_hdr *)iph;
            bzero(&lsa6, sizeof(lsa6));
            lsa6.sin6_len = sizeof(lsa6);
            lsa6.sin6_family = AF_INET6;
            lsa6.sin6_addr = ip6->ip6_src;
            lsa6.sin6_port = sh->src_port;
            bzero(&fsa6, sizeof(fsa6));
            fsa6.sin6_len = sizeof(fsa6);
            fsa6.sin6_family = AF_INET6;
            fsa6.sin6_addr = ip6->ip6_dst;
            fsa6.sin6_port = sh->dest_port;
            SCTP_PRINTF("src: ");
            sctp_print_address((struct sockaddr *)&lsa6);
            SCTP_PRINTF("dest: ");
            sctp_print_address((struct sockaddr *)&fsa6);
      }
}

void
sctp_pull_off_control_to_new_inp(struct sctp_inpcb *old_inp,
    struct sctp_inpcb *new_inp,
    struct sctp_tcb *stcb,
    int waitflags)
{
      /*
       * go through our old INP and pull off any control structures that
       * belong to stcb and move then to the new inp.
       */
      struct socket *old_so, *new_so;
      struct sctp_queued_to_read *control, *nctl;
      struct sctp_readhead tmp_queue;
      struct mbuf *m;
      int error = 0;

      old_so = old_inp->sctp_socket;
      new_so = new_inp->sctp_socket;
      TAILQ_INIT(&tmp_queue);
      error = sblock(&old_so->so_rcv, waitflags);
      if (error) {
            /*
             * Gak, can't get sblock, we have a problem. data will be
             * left stranded.. and we don't dare look at it since the
             * other thread may be reading something. Oh well, its a
             * screwed up app that does a peeloff OR a accept while
             * reading from the main socket... actually its only the
             * peeloff() case, since I think read will fail on a
             * listening socket..
             */
            return;
      }
      /* lock the socket buffers */
      SCTP_INP_READ_LOCK(old_inp);
      control = TAILQ_FIRST(&old_inp->read_queue);
      /* Pull off all for out target stcb */
      while (control) {
            nctl = TAILQ_NEXT(control, next);
            if (control->stcb == stcb) {
                  /* remove it we want it */
                  TAILQ_REMOVE(&old_inp->read_queue, control, next);
                  TAILQ_INSERT_TAIL(&tmp_queue, control, next);
                  m = control->data;
                  while (m) {
                        if (sctp_logging_level & SCTP_SB_LOGGING_ENABLE) {
                              sctp_sblog(&old_so->so_rcv, control->do_not_ref_stcb ? NULL : stcb, SCTP_LOG_SBFREE, SCTP_BUF_LEN(m));
                        }
                        sctp_sbfree(control, stcb, &old_so->so_rcv, m);
                        if (sctp_logging_level & SCTP_SB_LOGGING_ENABLE) {
                              sctp_sblog(&old_so->so_rcv, control->do_not_ref_stcb ? NULL : stcb, SCTP_LOG_SBRESULT, 0);
                        }
                        m = SCTP_BUF_NEXT(m);
                  }
            }
            control = nctl;
      }
      SCTP_INP_READ_UNLOCK(old_inp);
      /* Remove the sb-lock on the old socket */

      sbunlock(&old_so->so_rcv);
      /* Now we move them over to the new socket buffer */
      control = TAILQ_FIRST(&tmp_queue);
      SCTP_INP_READ_LOCK(new_inp);
      while (control) {
            nctl = TAILQ_NEXT(control, next);
            TAILQ_INSERT_TAIL(&new_inp->read_queue, control, next);
            m = control->data;
            while (m) {
                  if (sctp_logging_level & SCTP_SB_LOGGING_ENABLE) {
                        sctp_sblog(&new_so->so_rcv, control->do_not_ref_stcb ? NULL : stcb, SCTP_LOG_SBALLOC, SCTP_BUF_LEN(m));
                  }
                  sctp_sballoc(stcb, &new_so->so_rcv, m);
                  if (sctp_logging_level & SCTP_SB_LOGGING_ENABLE) {
                        sctp_sblog(&new_so->so_rcv, control->do_not_ref_stcb ? NULL : stcb, SCTP_LOG_SBRESULT, 0);
                  }
                  m = SCTP_BUF_NEXT(m);
            }
            control = nctl;
      }
      SCTP_INP_READ_UNLOCK(new_inp);
}


void
sctp_add_to_readq(struct sctp_inpcb *inp,
    struct sctp_tcb *stcb,
    struct sctp_queued_to_read *control,
    struct sockbuf *sb,
    int end,
    int so_locked
#if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
    SCTP_UNUSED
#endif
)
{
      /*
       * Here we must place the control on the end of the socket read
       * queue AND increment sb_cc so that select will work properly on
       * read.
       */
      struct mbuf *m, *prev = NULL;

      if (inp == NULL) {
            /* Gak, TSNH!! */
#ifdef INVARIANTS
            panic("Gak, inp NULL on add_to_readq");
#endif
            return;
      }
      SCTP_INP_READ_LOCK(inp);
      if (!(control->spec_flags & M_NOTIFICATION)) {
            atomic_add_int(&inp->total_recvs, 1);
            if (!control->do_not_ref_stcb) {
                  atomic_add_int(&stcb->total_recvs, 1);
            }
      }
      m = control->data;
      control->held_length = 0;
      control->length = 0;
      while (m) {
            if (SCTP_BUF_LEN(m) == 0) {
                  /* Skip mbufs with NO length */
                  if (prev == NULL) {
                        /* First one */
                        control->data = sctp_m_free(m);
                        m = control->data;
                  } else {
                        SCTP_BUF_NEXT(prev) = sctp_m_free(m);
                        m = SCTP_BUF_NEXT(prev);
                  }
                  if (m == NULL) {
                        control->tail_mbuf = prev;;
                  }
                  continue;
            }
            prev = m;
            if (sctp_logging_level & SCTP_SB_LOGGING_ENABLE) {
                  sctp_sblog(sb, control->do_not_ref_stcb ? NULL : stcb, SCTP_LOG_SBALLOC, SCTP_BUF_LEN(m));
            }
            sctp_sballoc(stcb, sb, m);
            if (sctp_logging_level & SCTP_SB_LOGGING_ENABLE) {
                  sctp_sblog(sb, control->do_not_ref_stcb ? NULL : stcb, SCTP_LOG_SBRESULT, 0);
            }
            atomic_add_int(&control->length, SCTP_BUF_LEN(m));
            m = SCTP_BUF_NEXT(m);
      }
      if (prev != NULL) {
            control->tail_mbuf = prev;
      } else {
            /* Everything got collapsed out?? */
            return;
      }
      if (end) {
            control->end_added = 1;
      }
      TAILQ_INSERT_TAIL(&inp->read_queue, control, next);
      SCTP_INP_READ_UNLOCK(inp);
      if (inp && inp->sctp_socket) {
            if (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_ZERO_COPY_ACTIVE)) {
                  SCTP_ZERO_COPY_EVENT(inp, inp->sctp_socket);
            } else {
#if defined (__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
                  struct socket *so;

                  so = SCTP_INP_SO(inp);
                  if (!so_locked) {
                        atomic_add_int(&stcb->asoc.refcnt, 1);
                        SCTP_TCB_UNLOCK(stcb);
                        SCTP_SOCKET_LOCK(so, 1);
                        SCTP_TCB_LOCK(stcb);
                        atomic_subtract_int(&stcb->asoc.refcnt, 1);
                        if (inp->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE) {
                              SCTP_SOCKET_UNLOCK(so, 1);
                              return;
                        }
                  }
#endif
                  sctp_sorwakeup(inp, inp->sctp_socket);
#if defined (__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
                  if (!so_locked) {
                        SCTP_SOCKET_UNLOCK(so, 1);
                  }
#endif
            }
      }
}


int
sctp_append_to_readq(struct sctp_inpcb *inp,
    struct sctp_tcb *stcb,
    struct sctp_queued_to_read *control,
    struct mbuf *m,
    int end,
    int ctls_cumack,
    struct sockbuf *sb)
{
      /*
       * A partial delivery API event is underway. OR we are appending on
       * the reassembly queue.
       * 
       * If PDAPI this means we need to add m to the end of the data.
       * Increase the length in the control AND increment the sb_cc.
       * Otherwise sb is NULL and all we need to do is put it at the end
       * of the mbuf chain.
       */
      int len = 0;
      struct mbuf *mm, *tail = NULL, *prev = NULL;

      if (inp) {
            SCTP_INP_READ_LOCK(inp);
      }
      if (control == NULL) {
get_out:
            if (inp) {
                  SCTP_INP_READ_UNLOCK(inp);
            }
            return (-1);
      }
      if (control->end_added) {
            /* huh this one is complete? */
            goto get_out;
      }
      mm = m;
      if (mm == NULL) {
            goto get_out;
      }
      while (mm) {
            if (SCTP_BUF_LEN(mm) == 0) {
                  /* Skip mbufs with NO lenght */
                  if (prev == NULL) {
                        /* First one */
                        m = sctp_m_free(mm);
                        mm = m;
                  } else {
                        SCTP_BUF_NEXT(prev) = sctp_m_free(mm);
                        mm = SCTP_BUF_NEXT(prev);
                  }
                  continue;
            }
            prev = mm;
            len += SCTP_BUF_LEN(mm);
            if (sb) {
                  if (sctp_logging_level & SCTP_SB_LOGGING_ENABLE) {
                        sctp_sblog(sb, control->do_not_ref_stcb ? NULL : stcb, SCTP_LOG_SBALLOC, SCTP_BUF_LEN(mm));
                  }
                  sctp_sballoc(stcb, sb, mm);
                  if (sctp_logging_level & SCTP_SB_LOGGING_ENABLE) {
                        sctp_sblog(sb, control->do_not_ref_stcb ? NULL : stcb, SCTP_LOG_SBRESULT, 0);
                  }
            }
            mm = SCTP_BUF_NEXT(mm);
      }
      if (prev) {
            tail = prev;
      } else {
            /* Really there should always be a prev */
            if (m == NULL) {
                  /* Huh nothing left? */
#ifdef INVARIANTS
                  panic("Nothing left to add?");
#else
                  goto get_out;
#endif
            }
            tail = m;
      }
      if (control->tail_mbuf) {
            /* append */
            SCTP_BUF_NEXT(control->tail_mbuf) = m;
            control->tail_mbuf = tail;
      } else {
            /* nothing there */
#ifdef INVARIANTS
            if (control->data != NULL) {
                  panic("This should NOT happen");
            }
#endif
            control->data = m;
            control->tail_mbuf = tail;
      }
      atomic_add_int(&control->length, len);
      if (end) {
            /* message is complete */
            if (stcb && (control == stcb->asoc.control_pdapi)) {
                  stcb->asoc.control_pdapi = NULL;
            }
            control->held_length = 0;
            control->end_added = 1;
      }
      if (stcb == NULL) {
            control->do_not_ref_stcb = 1;
      }
      /*
       * When we are appending in partial delivery, the cum-ack is used
       * for the actual pd-api highest tsn on this mbuf. The true cum-ack
       * is populated in the outbound sinfo structure from the true cumack
       * if the association exists...
       */
      control->sinfo_tsn = control->sinfo_cumtsn = ctls_cumack;
      if (inp) {
            SCTP_INP_READ_UNLOCK(inp);
      }
      if (inp && inp->sctp_socket) {
            if (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_ZERO_COPY_ACTIVE)) {
                  SCTP_ZERO_COPY_EVENT(inp, inp->sctp_socket);
            } else {
#if defined (__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
                  struct socket *so;

                  so = SCTP_INP_SO(inp);
                  atomic_add_int(&stcb->asoc.refcnt, 1);
                  SCTP_TCB_UNLOCK(stcb);
                  SCTP_SOCKET_LOCK(so, 1);
                  SCTP_TCB_LOCK(stcb);
                  atomic_subtract_int(&stcb->asoc.refcnt, 1);
                  if (inp->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE) {
                        SCTP_SOCKET_UNLOCK(so, 1);
                        return (0);
                  }
#endif
                  sctp_sorwakeup(inp, inp->sctp_socket);
#if defined (__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
                  SCTP_SOCKET_UNLOCK(so, 1);
#endif
            }
      }
      return (0);
}



/*************HOLD THIS COMMENT FOR PATCH FILE OF
 *************ALTERNATE ROUTING CODE
 */

/*************HOLD THIS COMMENT FOR END OF PATCH FILE OF
 *************ALTERNATE ROUTING CODE
 */

struct mbuf *
sctp_generate_invmanparam(int err)
{
      /* Return a MBUF with a invalid mandatory parameter */
      struct mbuf *m;

      m = sctp_get_mbuf_for_msg(sizeof(struct sctp_paramhdr), 0, M_DONTWAIT, 1, MT_DATA);
      if (m) {
            struct sctp_paramhdr *ph;

            SCTP_BUF_LEN(m) = sizeof(struct sctp_paramhdr);
            ph = mtod(m, struct sctp_paramhdr *);
            ph->param_length = htons(sizeof(struct sctp_paramhdr));
            ph->param_type = htons(err);
      }
      return (m);
}

#ifdef SCTP_MBCNT_LOGGING
void
sctp_free_bufspace(struct sctp_tcb *stcb, struct sctp_association *asoc,
    struct sctp_tmit_chunk *tp1, int chk_cnt)
{
      if (tp1->data == NULL) {
            return;
      }
      asoc->chunks_on_out_queue -= chk_cnt;
      if (sctp_logging_level & SCTP_MBCNT_LOGGING_ENABLE) {
            sctp_log_mbcnt(SCTP_LOG_MBCNT_DECREASE,
                asoc->total_output_queue_size,
                tp1->book_size,
                0,
                tp1->mbcnt);
      }
      if (asoc->total_output_queue_size >= tp1->book_size) {
            atomic_add_int(&asoc->total_output_queue_size, -tp1->book_size);
      } else {
            asoc->total_output_queue_size = 0;
      }

      if (stcb->sctp_socket && (((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_IN_TCPPOOL)) ||
          ((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE)))) {
            if (stcb->sctp_socket->so_snd.sb_cc >= tp1->book_size) {
                  stcb->sctp_socket->so_snd.sb_cc -= tp1->book_size;
            } else {
                  stcb->sctp_socket->so_snd.sb_cc = 0;

            }
      }
}

#endif

int
sctp_release_pr_sctp_chunk(struct sctp_tcb *stcb, struct sctp_tmit_chunk *tp1,
    int reason, struct sctpchunk_listhead *queue, int so_locked
#if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
    SCTP_UNUSED
#endif
)
{
      int ret_sz = 0;
      int notdone;
      uint8_t foundeom = 0;

      do {
            ret_sz += tp1->book_size;
            tp1->sent = SCTP_FORWARD_TSN_SKIP;
            if (tp1->data) {
#if defined (__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
                  struct socket *so;

#endif
                  sctp_free_bufspace(stcb, &stcb->asoc, tp1, 1);
                  sctp_ulp_notify(SCTP_NOTIFY_DG_FAIL, stcb, reason, tp1, SCTP_SO_NOT_LOCKED);
                  sctp_m_freem(tp1->data);
                  tp1->data = NULL;
#if defined (__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
                  so = SCTP_INP_SO(stcb->sctp_ep);
                  if (!so_locked) {
                        atomic_add_int(&stcb->asoc.refcnt, 1);
                        SCTP_TCB_UNLOCK(stcb);
                        SCTP_SOCKET_LOCK(so, 1);
                        SCTP_TCB_LOCK(stcb);
                        atomic_subtract_int(&stcb->asoc.refcnt, 1);
                        if (stcb->asoc.state & SCTP_STATE_CLOSED_SOCKET) {
                              /*
                               * assoc was freed while we were
                               * unlocked
                               */
                              SCTP_SOCKET_UNLOCK(so, 1);
                              return (ret_sz);
                        }
                  }
#endif
                  sctp_sowwakeup(stcb->sctp_ep, stcb->sctp_socket);
#if defined (__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
                  if (!so_locked) {
                        SCTP_SOCKET_UNLOCK(so, 1);
                  }
#endif
            }
            if (PR_SCTP_BUF_ENABLED(tp1->flags)) {
                  stcb->asoc.sent_queue_cnt_removeable--;
            }
            if (queue == &stcb->asoc.send_queue) {
                  TAILQ_REMOVE(&stcb->asoc.send_queue, tp1, sctp_next);
                  /* on to the sent queue */
                  TAILQ_INSERT_TAIL(&stcb->asoc.sent_queue, tp1,
                      sctp_next);
                  stcb->asoc.sent_queue_cnt++;
            }
            if ((tp1->rec.data.rcv_flags & SCTP_DATA_NOT_FRAG) ==
                SCTP_DATA_NOT_FRAG) {
                  /* not frag'ed we ae done   */
                  notdone = 0;
                  foundeom = 1;
            } else if (tp1->rec.data.rcv_flags & SCTP_DATA_LAST_FRAG) {
                  /* end of frag, we are done */
                  notdone = 0;
                  foundeom = 1;
            } else {
                  /*
                   * Its a begin or middle piece, we must mark all of
                   * it
                   */
                  notdone = 1;
                  tp1 = TAILQ_NEXT(tp1, sctp_next);
            }
      } while (tp1 && notdone);
      if ((foundeom == 0) && (queue == &stcb->asoc.sent_queue)) {
            /*
             * The multi-part message was scattered across the send and
             * sent queue.
             */
            tp1 = TAILQ_FIRST(&stcb->asoc.send_queue);
            /*
             * recurse throught the send_queue too, starting at the
             * beginning.
             */
            if (tp1) {
                  ret_sz += sctp_release_pr_sctp_chunk(stcb, tp1, reason,
                      &stcb->asoc.send_queue, so_locked);
            } else {
                  SCTP_PRINTF("hmm, nothing on the send queue and no EOM?\n");
            }
      }
      return (ret_sz);
}

/*
 * checks to see if the given address, sa, is one that is currently known by
 * the kernel note: can't distinguish the same address on multiple interfaces
 * and doesn't handle multiple addresses with different zone/scope id's note:
 * ifa_ifwithaddr() compares the entire sockaddr struct
 */
struct sctp_ifa *
sctp_find_ifa_in_ep(struct sctp_inpcb *inp, struct sockaddr *addr,
    int holds_lock)
{
      struct sctp_laddr *laddr;

      if (holds_lock == 0) {
            SCTP_INP_RLOCK(inp);
      }
      LIST_FOREACH(laddr, &inp->sctp_addr_list, sctp_nxt_addr) {
            if (laddr->ifa == NULL)
                  continue;
            if (addr->sa_family != laddr->ifa->address.sa.sa_family)
                  continue;
            if (addr->sa_family == AF_INET) {
                  if (((struct sockaddr_in *)addr)->sin_addr.s_addr ==
                      laddr->ifa->address.sin.sin_addr.s_addr) {
                        /* found him. */
                        if (holds_lock == 0) {
                              SCTP_INP_RUNLOCK(inp);
                        }
                        return (laddr->ifa);
                        break;
                  }
            } else if (addr->sa_family == AF_INET6) {
                  if (SCTP6_ARE_ADDR_EQUAL(&((struct sockaddr_in6 *)addr)->sin6_addr,
                      &laddr->ifa->address.sin6.sin6_addr)) {
                        /* found him. */
                        if (holds_lock == 0) {
                              SCTP_INP_RUNLOCK(inp);
                        }
                        return (laddr->ifa);
                        break;
                  }
            }
      }
      if (holds_lock == 0) {
            SCTP_INP_RUNLOCK(inp);
      }
      return (NULL);
}

uint32_t
sctp_get_ifa_hash_val(struct sockaddr *addr)
{
      if (addr->sa_family == AF_INET) {
            struct sockaddr_in *sin;

            sin = (struct sockaddr_in *)addr;
            return (sin->sin_addr.s_addr ^ (sin->sin_addr.s_addr >> 16));
      } else if (addr->sa_family == AF_INET6) {
            struct sockaddr_in6 *sin6;
            uint32_t hash_of_addr;

            sin6 = (struct sockaddr_in6 *)addr;
            hash_of_addr = (sin6->sin6_addr.s6_addr32[0] +
                sin6->sin6_addr.s6_addr32[1] +
                sin6->sin6_addr.s6_addr32[2] +
                sin6->sin6_addr.s6_addr32[3]);
            hash_of_addr = (hash_of_addr ^ (hash_of_addr >> 16));
            return (hash_of_addr);
      }
      return (0);
}

struct sctp_ifa *
sctp_find_ifa_by_addr(struct sockaddr *addr, uint32_t vrf_id, int holds_lock)
{
      struct sctp_ifa *sctp_ifap;
      struct sctp_vrf *vrf;
      struct sctp_ifalist *hash_head;
      uint32_t hash_of_addr;

      if (holds_lock == 0)
            SCTP_IPI_ADDR_RLOCK();

      vrf = sctp_find_vrf(vrf_id);
      if (vrf == NULL) {
            if (holds_lock == 0)
                  SCTP_IPI_ADDR_RUNLOCK();
            return (NULL);
      }
      hash_of_addr = sctp_get_ifa_hash_val(addr);

      hash_head = &vrf->vrf_addr_hash[(hash_of_addr & vrf->vrf_addr_hashmark)];
      if (hash_head == NULL) {
            SCTP_PRINTF("hash_of_addr:%x mask:%x table:%x - ",
                hash_of_addr, (uint32_t) vrf->vrf_addr_hashmark,
                (uint32_t) (hash_of_addr & vrf->vrf_addr_hashmark));
            sctp_print_address(addr);
            SCTP_PRINTF("No such bucket for address\n");
            if (holds_lock == 0)
                  SCTP_IPI_ADDR_RUNLOCK();

            return (NULL);
      }
      LIST_FOREACH(sctp_ifap, hash_head, next_bucket) {
            if (sctp_ifap == NULL) {
                  panic("Huh LIST_FOREACH corrupt");
            }
            if (addr->sa_family != sctp_ifap->address.sa.sa_family)
                  continue;
            if (addr->sa_family == AF_INET) {
                  if (((struct sockaddr_in *)addr)->sin_addr.s_addr ==
                      sctp_ifap->address.sin.sin_addr.s_addr) {
                        /* found him. */
                        if (holds_lock == 0)
                              SCTP_IPI_ADDR_RUNLOCK();
                        return (sctp_ifap);
                        break;
                  }
            } else if (addr->sa_family == AF_INET6) {
                  if (SCTP6_ARE_ADDR_EQUAL(&((struct sockaddr_in6 *)addr)->sin6_addr,
                      &sctp_ifap->address.sin6.sin6_addr)) {
                        /* found him. */
                        if (holds_lock == 0)
                              SCTP_IPI_ADDR_RUNLOCK();
                        return (sctp_ifap);
                        break;
                  }
            }
      }
      if (holds_lock == 0)
            SCTP_IPI_ADDR_RUNLOCK();
      return (NULL);
}

static void
sctp_user_rcvd(struct sctp_tcb *stcb, uint32_t * freed_so_far, int hold_rlock,
    uint32_t rwnd_req)
{
      /* User pulled some data, do we need a rwnd update? */
      int r_unlocked = 0;
      uint32_t dif, rwnd;
      struct socket *so = NULL;

      if (stcb == NULL)
            return;

      atomic_add_int(&stcb->asoc.refcnt, 1);

      if (stcb->asoc.state & (SCTP_STATE_ABOUT_TO_BE_FREED |
          SCTP_STATE_SHUTDOWN_RECEIVED |
          SCTP_STATE_SHUTDOWN_ACK_SENT)) {
            /* Pre-check If we are freeing no update */
            goto no_lock;
      }
      SCTP_INP_INCR_REF(stcb->sctp_ep);
      if ((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE) ||
          (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_SOCKET_ALLGONE)) {
            goto out;
      }
      so = stcb->sctp_socket;
      if (so == NULL) {
            goto out;
      }
      atomic_add_int(&stcb->freed_by_sorcv_sincelast, *freed_so_far);
      /* Have you have freed enough to look */
      *freed_so_far = 0;
      /* Yep, its worth a look and the lock overhead */

      /* Figure out what the rwnd would be */
      rwnd = sctp_calc_rwnd(stcb, &stcb->asoc);
      if (rwnd >= stcb->asoc.my_last_reported_rwnd) {
            dif = rwnd - stcb->asoc.my_last_reported_rwnd;
      } else {
            dif = 0;
      }
      if (dif >= rwnd_req) {
            if (hold_rlock) {
                  SCTP_INP_READ_UNLOCK(stcb->sctp_ep);
                  r_unlocked = 1;
            }
            if (stcb->asoc.state & SCTP_STATE_ABOUT_TO_BE_FREED) {
                  /*
                   * One last check before we allow the guy possibly
                   * to get in. There is a race, where the guy has not
                   * reached the gate. In that case
                   */
                  goto out;
            }
            SCTP_TCB_LOCK(stcb);
            if (stcb->asoc.state & SCTP_STATE_ABOUT_TO_BE_FREED) {
                  /* No reports here */
                  SCTP_TCB_UNLOCK(stcb);
                  goto out;
            }
            SCTP_STAT_INCR(sctps_wu_sacks_sent);
            sctp_send_sack(stcb);
            sctp_chunk_output(stcb->sctp_ep, stcb,
                SCTP_OUTPUT_FROM_USR_RCVD, SCTP_SO_LOCKED);
            /* make sure no timer is running */
            sctp_timer_stop(SCTP_TIMER_TYPE_RECV, stcb->sctp_ep, stcb, NULL, SCTP_FROM_SCTPUTIL + SCTP_LOC_6);
            SCTP_TCB_UNLOCK(stcb);
      } else {
            /* Update how much we have pending */
            stcb->freed_by_sorcv_sincelast = dif;
      }
out:
      if (so && r_unlocked && hold_rlock) {
            SCTP_INP_READ_LOCK(stcb->sctp_ep);
      }
      SCTP_INP_DECR_REF(stcb->sctp_ep);
no_lock:
      atomic_add_int(&stcb->asoc.refcnt, -1);
      return;
}

int
sctp_sorecvmsg(struct socket *so,
    struct uio *uio,
    struct mbuf **mp,
    struct sockaddr *from,
    int fromlen,
    int *msg_flags,
    struct sctp_sndrcvinfo *sinfo,
    int filling_sinfo)
{
      /*
       * MSG flags we will look at MSG_DONTWAIT - non-blocking IO.
       * MSG_PEEK - Look don't touch :-D (only valid with OUT mbuf copy
       * mp=NULL thus uio is the copy method to userland) MSG_WAITALL - ??
       * On the way out we may send out any combination of:
       * MSG_NOTIFICATION MSG_EOR
       * 
       */
      struct sctp_inpcb *inp = NULL;
      int my_len = 0;
      int cp_len = 0, error = 0;
      struct sctp_queued_to_read *control = NULL, *ctl = NULL, *nxt = NULL;
      struct mbuf *m = NULL, *embuf = NULL;
      struct sctp_tcb *stcb = NULL;
      int wakeup_read_socket = 0;
      int freecnt_applied = 0;
      int out_flags = 0, in_flags = 0;
      int block_allowed = 1;
      uint32_t freed_so_far = 0;
      uint32_t copied_so_far = 0;
      int in_eeor_mode = 0;
      int no_rcv_needed = 0;
      uint32_t rwnd_req = 0;
      int hold_sblock = 0;
      int hold_rlock = 0;
      int slen = 0;
      uint32_t held_length = 0;
      int sockbuf_lock = 0;

      if (uio == NULL) {
            SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, EINVAL);
            return (EINVAL);
      }
      if (msg_flags) {
            in_flags = *msg_flags;
            if (in_flags & MSG_PEEK)
                  SCTP_STAT_INCR(sctps_read_peeks);
      } else {
            in_flags = 0;
      }
      slen = uio->uio_resid;

      /* Pull in and set up our int flags */
      if (in_flags & MSG_OOB) {
            /* Out of band's NOT supported */
            return (EOPNOTSUPP);
      }
      if ((in_flags & MSG_PEEK) && (mp != NULL)) {
            SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, EINVAL);
            return (EINVAL);
      }
      if ((in_flags & (MSG_DONTWAIT
          | MSG_NBIO
          )) ||
          SCTP_SO_IS_NBIO(so)) {
            block_allowed = 0;
      }
      /* setup the endpoint */
      inp = (struct sctp_inpcb *)so->so_pcb;
      if (inp == NULL) {
            SCTP_LTRACE_ERR_RET(NULL, NULL, NULL, SCTP_FROM_SCTPUTIL, EFAULT);
            return (EFAULT);
      }
      rwnd_req = (SCTP_SB_LIMIT_RCV(so) >> SCTP_RWND_HIWAT_SHIFT);
      /* Must be at least a MTU's worth */
      if (rwnd_req < SCTP_MIN_RWND)
            rwnd_req = SCTP_MIN_RWND;
      in_eeor_mode = sctp_is_feature_on(inp, SCTP_PCB_FLAGS_EXPLICIT_EOR);
      if (sctp_logging_level & SCTP_RECV_RWND_LOGGING_ENABLE) {
            sctp_misc_ints(SCTP_SORECV_ENTER,
                rwnd_req, in_eeor_mode, so->so_rcv.sb_cc, uio->uio_resid);
      }
      if (sctp_logging_level & SCTP_RECV_RWND_LOGGING_ENABLE) {
            sctp_misc_ints(SCTP_SORECV_ENTERPL,
                rwnd_req, block_allowed, so->so_rcv.sb_cc, uio->uio_resid);
      }
      error = sblock(&so->so_rcv, (block_allowed ? SBL_WAIT : 0));
      sockbuf_lock = 1;
      if (error) {
            goto release_unlocked;
      }
restart:


restart_nosblocks:
      if (hold_sblock == 0) {
            SOCKBUF_LOCK(&so->so_rcv);
            hold_sblock = 1;
      }
      if ((inp->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE) ||
          (inp->sctp_flags & SCTP_PCB_FLAGS_SOCKET_ALLGONE)) {
            goto out;
      }
      if (so->so_rcv.sb_state & SBS_CANTRCVMORE) {
            if (so->so_error) {
                  error = so->so_error;
                  if ((in_flags & MSG_PEEK) == 0)
                        so->so_error = 0;
                  goto out;
            } else {
                  if (so->so_rcv.sb_cc == 0) {
                        SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, ENOTCONN);
                        /* indicate EOF */
                        error = 0;
                        goto out;
                  }
            }
      }
      if ((so->so_rcv.sb_cc <= held_length) && block_allowed) {
            /* we need to wait for data */
            if ((so->so_rcv.sb_cc == 0) &&
                ((inp->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) ||
                (inp->sctp_flags & SCTP_PCB_FLAGS_IN_TCPPOOL))) {
                  if ((inp->sctp_flags & SCTP_PCB_FLAGS_CONNECTED) == 0) {
                        /*
                         * For active open side clear flags for
                         * re-use passive open is blocked by
                         * connect.
                         */
                        if (inp->sctp_flags & SCTP_PCB_FLAGS_WAS_ABORTED) {
                              /*
                               * You were aborted, passive side
                               * always hits here
                               */
                              SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, ECONNRESET);
                              error = ECONNRESET;
                              /*
                               * You get this once if you are
                               * active open side
                               */
                              if (!(inp->sctp_flags & SCTP_PCB_FLAGS_IN_TCPPOOL)) {
                                    /*
                                     * Remove flag if on the
                                     * active open side
                                     */
                                    inp->sctp_flags &= ~SCTP_PCB_FLAGS_WAS_ABORTED;
                              }
                        }
                        so->so_state &= ~(SS_ISCONNECTING |
                            SS_ISDISCONNECTING |
                            SS_ISCONFIRMING |
                            SS_ISCONNECTED);
                        if (error == 0) {
                              if ((inp->sctp_flags & SCTP_PCB_FLAGS_WAS_CONNECTED) == 0) {
                                    SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, ENOTCONN);
                                    error = ENOTCONN;
                              } else {
                                    inp->sctp_flags &= ~SCTP_PCB_FLAGS_WAS_CONNECTED;
                              }
                        }
                        goto out;
                  }
            }
            error = sbwait(&so->so_rcv);
            if (error) {
                  goto out;
            }
            held_length = 0;
            goto restart_nosblocks;
      } else if (so->so_rcv.sb_cc == 0) {
            if (so->so_error) {
                  error = so->so_error;
                  if ((in_flags & MSG_PEEK) == 0)
                        so->so_error = 0;
            } else {
                  if ((inp->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) ||
                      (inp->sctp_flags & SCTP_PCB_FLAGS_IN_TCPPOOL)) {
                        if ((inp->sctp_flags & SCTP_PCB_FLAGS_CONNECTED) == 0) {
                              /*
                               * For active open side clear flags
                               * for re-use passive open is
                               * blocked by connect.
                               */
                              if (inp->sctp_flags & SCTP_PCB_FLAGS_WAS_ABORTED) {
                                    /*
                                     * You were aborted, passive
                                     * side always hits here
                                     */
                                    SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, ECONNRESET);
                                    error = ECONNRESET;
                                    /*
                                     * You get this once if you
                                     * are active open side
                                     */
                                    if (!(inp->sctp_flags & SCTP_PCB_FLAGS_IN_TCPPOOL)) {
                                          /*
                                           * Remove flag if on
                                           * the active open
                                           * side
                                           */
                                          inp->sctp_flags &= ~SCTP_PCB_FLAGS_WAS_ABORTED;
                                    }
                              }
                              so->so_state &= ~(SS_ISCONNECTING |
                                  SS_ISDISCONNECTING |
                                  SS_ISCONFIRMING |
                                  SS_ISCONNECTED);
                              if (error == 0) {
                                    if ((inp->sctp_flags & SCTP_PCB_FLAGS_WAS_CONNECTED) == 0) {
                                          SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, ENOTCONN);
                                          error = ENOTCONN;
                                    } else {
                                          inp->sctp_flags &= ~SCTP_PCB_FLAGS_WAS_CONNECTED;
                                    }
                              }
                              goto out;
                        }
                  }
                  SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, EWOULDBLOCK);
                  error = EWOULDBLOCK;
            }
            goto out;
      }
      if (hold_sblock == 1) {
            SOCKBUF_UNLOCK(&so->so_rcv);
            hold_sblock = 0;
      }
      /* we possibly have data we can read */
      /* sa_ignore FREED_MEMORY */
      control = TAILQ_FIRST(&inp->read_queue);
      if (control == NULL) {
            /*
             * This could be happening since the appender did the
             * increment but as not yet did the tailq insert onto the
             * read_queue
             */
            if (hold_rlock == 0) {
                  SCTP_INP_READ_LOCK(inp);
                  hold_rlock = 1;
            }
            control = TAILQ_FIRST(&inp->read_queue);
            if ((control == NULL) && (so->so_rcv.sb_cc != 0)) {
#ifdef INVARIANTS
                  panic("Huh, its non zero and nothing on control?");
#endif
                  so->so_rcv.sb_cc = 0;
            }
            SCTP_INP_READ_UNLOCK(inp);
            hold_rlock = 0;
            goto restart;
      }
      if ((control->length == 0) &&
          (control->do_not_ref_stcb)) {
            /*
             * Clean up code for freeing assoc that left behind a
             * pdapi.. maybe a peer in EEOR that just closed after
             * sending and never indicated a EOR.
             */
            if (hold_rlock == 0) {
                  hold_rlock = 1;
                  SCTP_INP_READ_LOCK(inp);
            }
            control->held_length = 0;
            if (control->data) {
                  /* Hmm there is data here .. fix */
                  struct mbuf *m_tmp;
                  int cnt = 0;

                  m_tmp = control->data;
                  while (m_tmp) {
                        cnt += SCTP_BUF_LEN(m_tmp);
                        if (SCTP_BUF_NEXT(m_tmp) == NULL) {
                              control->tail_mbuf = m_tmp;
                              control->end_added = 1;
                        }
                        m_tmp = SCTP_BUF_NEXT(m_tmp);
                  }
                  control->length = cnt;
            } else {
                  /* remove it */
                  TAILQ_REMOVE(&inp->read_queue, control, next);
                  /* Add back any hiddend data */
                  sctp_free_remote_addr(control->whoFrom);
                  sctp_free_a_readq(stcb, control);
            }
            if (hold_rlock) {
                  hold_rlock = 0;
                  SCTP_INP_READ_UNLOCK(inp);
            }
            goto restart;
      }
      if (control->length == 0) {
            if ((sctp_is_feature_on(inp, SCTP_PCB_FLAGS_FRAG_INTERLEAVE)) &&
                (filling_sinfo)) {
                  /* find a more suitable one then this */
                  ctl = TAILQ_NEXT(control, next);
                  while (ctl) {
                        if ((ctl->stcb != control->stcb) && (ctl->length) &&
                            (ctl->some_taken ||
                            (ctl->spec_flags & M_NOTIFICATION) ||
                            ((ctl->do_not_ref_stcb == 0) &&
                            (ctl->stcb->asoc.strmin[ctl->sinfo_stream].delivery_started == 0)))
                            ) {
                              /*-
                               * If we have a different TCB next, and there is data
                               * present. If we have already taken some (pdapi), OR we can
                               * ref the tcb and no delivery as started on this stream, we
                               * take it. Note we allow a notification on a different
                               * assoc to be delivered..
                               */
                              control = ctl;
                              goto found_one;
                        } else if ((sctp_is_feature_on(inp, SCTP_PCB_FLAGS_INTERLEAVE_STRMS)) &&
                                  (ctl->length) &&
                                  ((ctl->some_taken) ||
                                  ((ctl->do_not_ref_stcb == 0) &&
                                  ((ctl->spec_flags & M_NOTIFICATION) == 0) &&
                                  (ctl->stcb->asoc.strmin[ctl->sinfo_stream].delivery_started == 0)))
                            ) {
                              /*-
                               * If we have the same tcb, and there is data present, and we
                               * have the strm interleave feature present. Then if we have
                               * taken some (pdapi) or we can refer to tht tcb AND we have
                               * not started a delivery for this stream, we can take it.
                               * Note we do NOT allow a notificaiton on the same assoc to
                               * be delivered.
                               */
                              control = ctl;
                              goto found_one;
                        }
                        ctl = TAILQ_NEXT(ctl, next);
                  }
            }
            /*
             * if we reach here, not suitable replacement is available
             * <or> fragment interleave is NOT on. So stuff the sb_cc
             * into the our held count, and its time to sleep again.
             */
            held_length = so->so_rcv.sb_cc;
            control->held_length = so->so_rcv.sb_cc;
            goto restart;
      }
      /* Clear the held length since there is something to read */
      control->held_length = 0;
      if (hold_rlock) {
            SCTP_INP_READ_UNLOCK(inp);
            hold_rlock = 0;
      }
found_one:
      /*
       * If we reach here, control has a some data for us to read off.
       * Note that stcb COULD be NULL.
       */
      control->some_taken++;
      if (hold_sblock) {
            SOCKBUF_UNLOCK(&so->so_rcv);
            hold_sblock = 0;
      }
      stcb = control->stcb;
      if (stcb) {
            if ((control->do_not_ref_stcb == 0) &&
                (stcb->asoc.state & SCTP_STATE_ABOUT_TO_BE_FREED)) {
                  if (freecnt_applied == 0)
                        stcb = NULL;
            } else if (control->do_not_ref_stcb == 0) {
                  /* you can't free it on me please */
                  /*
                   * The lock on the socket buffer protects us so the
                   * free code will stop. But since we used the
                   * socketbuf lock and the sender uses the tcb_lock
                   * to increment, we need to use the atomic add to
                   * the refcnt
                   */
                  if (freecnt_applied) {
#ifdef INVARIANTS
                        panic("refcnt already incremented");
#else
                        printf("refcnt already incremented?\n");
#endif
                  } else {
                        atomic_add_int(&stcb->asoc.refcnt, 1);
                        freecnt_applied = 1;
                  }
                  /*
                   * Setup to remember how much we have not yet told
                   * the peer our rwnd has opened up. Note we grab the
                   * value from the tcb from last time. Note too that
                   * sack sending clears this when a sack is sent,
                   * which is fine. Once we hit the rwnd_req, we then
                   * will go to the sctp_user_rcvd() that will not
                   * lock until it KNOWs it MUST send a WUP-SACK.
                   */
                  freed_so_far = stcb->freed_by_sorcv_sincelast;
                  stcb->freed_by_sorcv_sincelast = 0;
            }
      }
      if (stcb &&
          ((control->spec_flags & M_NOTIFICATION) == 0) &&
          control->do_not_ref_stcb == 0) {
            stcb->asoc.strmin[control->sinfo_stream].delivery_started = 1;
      }
      /* First lets get off the sinfo and sockaddr info */
      if ((sinfo) && filling_sinfo) {
            memcpy(sinfo, control, sizeof(struct sctp_nonpad_sndrcvinfo));
            nxt = TAILQ_NEXT(control, next);
            if (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_EXT_RCVINFO)) {
                  struct sctp_extrcvinfo *s_extra;

                  s_extra = (struct sctp_extrcvinfo *)sinfo;
                  if ((nxt) &&
                      (nxt->length)) {
                        s_extra->sreinfo_next_flags = SCTP_NEXT_MSG_AVAIL;
                        if (nxt->sinfo_flags & SCTP_UNORDERED) {
                              s_extra->sreinfo_next_flags |= SCTP_NEXT_MSG_IS_UNORDERED;
                        }
                        if (nxt->spec_flags & M_NOTIFICATION) {
                              s_extra->sreinfo_next_flags |= SCTP_NEXT_MSG_IS_NOTIFICATION;
                        }
                        s_extra->sreinfo_next_aid = nxt->sinfo_assoc_id;
                        s_extra->sreinfo_next_length = nxt->length;
                        s_extra->sreinfo_next_ppid = nxt->sinfo_ppid;
                        s_extra->sreinfo_next_stream = nxt->sinfo_stream;
                        if (nxt->tail_mbuf != NULL) {
                              if (nxt->end_added) {
                                    s_extra->sreinfo_next_flags |= SCTP_NEXT_MSG_ISCOMPLETE;
                              }
                        }
                  } else {
                        /*
                         * we explicitly 0 this, since the memcpy
                         * got some other things beyond the older
                         * sinfo_ that is on the control's structure
                         * :-D
                         */
                        nxt = NULL;
                        s_extra->sreinfo_next_flags = SCTP_NO_NEXT_MSG;
                        s_extra->sreinfo_next_aid = 0;
                        s_extra->sreinfo_next_length = 0;
                        s_extra->sreinfo_next_ppid = 0;
                        s_extra->sreinfo_next_stream = 0;
                  }
            }
            /*
             * update off the real current cum-ack, if we have an stcb.
             */
            if ((control->do_not_ref_stcb == 0) && stcb)
                  sinfo->sinfo_cumtsn = stcb->asoc.cumulative_tsn;
            /*
             * mask off the high bits, we keep the actual chunk bits in
             * there.
             */
            sinfo->sinfo_flags &= 0x00ff;
            if ((control->sinfo_flags >> 8) & SCTP_DATA_UNORDERED) {
                  sinfo->sinfo_flags |= SCTP_UNORDERED;
            }
      }
#ifdef SCTP_ASOCLOG_OF_TSNS
      {
            int index, newindex;
            struct sctp_pcbtsn_rlog *entry;

            do {
                  index = inp->readlog_index;
                  newindex = index + 1;
                  if (newindex >= SCTP_READ_LOG_SIZE) {
                        newindex = 0;
                  }
            } while (atomic_cmpset_int(&inp->readlog_index, index, newindex) == 0);
            entry = &inp->readlog[index];
            entry->vtag = control->sinfo_assoc_id;
            entry->strm = control->sinfo_stream;
            entry->seq = control->sinfo_ssn;
            entry->sz = control->length;
            entry->flgs = control->sinfo_flags;
      }
#endif
      if (fromlen && from) {
            struct sockaddr *to;

#ifdef INET
            cp_len = min((size_t)fromlen, (size_t)control->whoFrom->ro._l_addr.sin.sin_len);
            memcpy(from, &control->whoFrom->ro._l_addr, cp_len);
            ((struct sockaddr_in *)from)->sin_port = control->port_from;
#else
            /* No AF_INET use AF_INET6 */
            cp_len = min((size_t)fromlen, (size_t)control->whoFrom->ro._l_addr.sin6.sin6_len);
            memcpy(from, &control->whoFrom->ro._l_addr, cp_len);
            ((struct sockaddr_in6 *)from)->sin6_port = control->port_from;
#endif

            to = from;
#if defined(INET) && defined(INET6)
            if ((inp->sctp_flags & SCTP_PCB_FLAGS_NEEDS_MAPPED_V4) &&
                (to->sa_family == AF_INET) &&
                ((size_t)fromlen >= sizeof(struct sockaddr_in6))) {
                  struct sockaddr_in *sin;
                  struct sockaddr_in6 sin6;

                  sin = (struct sockaddr_in *)to;
                  bzero(&sin6, sizeof(sin6));
                  sin6.sin6_family = AF_INET6;
                  sin6.sin6_len = sizeof(struct sockaddr_in6);
                  sin6.sin6_addr.s6_addr16[2] = 0xffff;
                  bcopy(&sin->sin_addr,
                      &sin6.sin6_addr.s6_addr16[3],
                      sizeof(sin6.sin6_addr.s6_addr16[3]));
                  sin6.sin6_port = sin->sin_port;
                  memcpy(from, (caddr_t)&sin6, sizeof(sin6));
            }
#endif
#if defined(INET6)
            {
                  struct sockaddr_in6 lsa6, *to6;

                  to6 = (struct sockaddr_in6 *)to;
                  sctp_recover_scope_mac(to6, (&lsa6));
            }
#endif
      }
      /* now copy out what data we can */
      if (mp == NULL) {
            /* copy out each mbuf in the chain up to length */
get_more_data:
            m = control->data;
            while (m) {
                  /* Move out all we can */
                  cp_len = (int)uio->uio_resid;
                  my_len = (int)SCTP_BUF_LEN(m);
                  if (cp_len > my_len) {
                        /* not enough in this buf */
                        cp_len = my_len;
                  }
                  if (hold_rlock) {
                        SCTP_INP_READ_UNLOCK(inp);
                        hold_rlock = 0;
                  }
                  if (cp_len > 0)
                        error = uiomove(mtod(m, char *), cp_len, uio);
                  /* re-read */
                  if (inp->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE) {
                        goto release;
                  }
                  if ((control->do_not_ref_stcb == 0) && stcb &&
                      stcb->asoc.state & SCTP_STATE_ABOUT_TO_BE_FREED) {
                        no_rcv_needed = 1;
                  }
                  if (error) {
                        /* error we are out of here */
                        goto release;
                  }
                  if ((SCTP_BUF_NEXT(m) == NULL) &&
                      (cp_len >= SCTP_BUF_LEN(m)) &&
                      ((control->end_added == 0) ||
                      (control->end_added &&
                      (TAILQ_NEXT(control, next) == NULL)))
                      ) {
                        SCTP_INP_READ_LOCK(inp);
                        hold_rlock = 1;
                  }
                  if (cp_len == SCTP_BUF_LEN(m)) {
                        if ((SCTP_BUF_NEXT(m) == NULL) &&
                            (control->end_added)) {
                              out_flags |= MSG_EOR;
                              if ((control->do_not_ref_stcb == 0) && ((control->spec_flags & M_NOTIFICATION) == 0))
                                    control->stcb->asoc.strmin[control->sinfo_stream].delivery_started = 0;
                        }
                        if (control->spec_flags & M_NOTIFICATION) {
                              out_flags |= MSG_NOTIFICATION;
                        }
                        /* we ate up the mbuf */
                        if (in_flags & MSG_PEEK) {
                              /* just looking */
                              m = SCTP_BUF_NEXT(m);
                              copied_so_far += cp_len;
                        } else {
                              /* dispose of the mbuf */
                              if (sctp_logging_level & SCTP_SB_LOGGING_ENABLE) {
                                    sctp_sblog(&so->so_rcv,
                                        control->do_not_ref_stcb ? NULL : stcb, SCTP_LOG_SBFREE, SCTP_BUF_LEN(m));
                              }
                              sctp_sbfree(control, stcb, &so->so_rcv, m);
                              if (sctp_logging_level & SCTP_SB_LOGGING_ENABLE) {
                                    sctp_sblog(&so->so_rcv,
                                        control->do_not_ref_stcb ? NULL : stcb, SCTP_LOG_SBRESULT, 0);
                              }
                              embuf = m;
                              copied_so_far += cp_len;
                              freed_so_far += cp_len;
                              freed_so_far += MSIZE;
                              atomic_subtract_int(&control->length, cp_len);
                              control->data = sctp_m_free(m);
                              m = control->data;
                              /*
                               * been through it all, must hold sb
                               * lock ok to null tail
                               */
                              if (control->data == NULL) {
#ifdef INVARIANTS
                                    if ((control->end_added == 0) ||
                                        (TAILQ_NEXT(control, next) == NULL)) {
                                          /*
                                           * If the end is not
                                           * added, OR the
                                           * next is NOT null
                                           * we MUST have the
                                           * lock.
                                           */
                                          if (mtx_owned(&inp->inp_rdata_mtx) == 0) {
                                                panic("Hmm we don't own the lock?");
                                          }
                                    }
#endif
                                    control->tail_mbuf = NULL;
#ifdef INVARIANTS
                                    if ((control->end_added) && ((out_flags & MSG_EOR) == 0)) {
                                          panic("end_added, nothing left and no MSG_EOR");
                                    }
#endif
                              }
                        }
                  } else {
                        /* Do we need to trim the mbuf? */
                        if (control->spec_flags & M_NOTIFICATION) {
                              out_flags |= MSG_NOTIFICATION;
                        }
                        if ((in_flags & MSG_PEEK) == 0) {
                              SCTP_BUF_RESV_UF(m, cp_len);
                              SCTP_BUF_LEN(m) -= cp_len;
                              if (sctp_logging_level & SCTP_SB_LOGGING_ENABLE) {
                                    sctp_sblog(&so->so_rcv, control->do_not_ref_stcb ? NULL : stcb, SCTP_LOG_SBFREE, cp_len);
                              }
                              atomic_subtract_int(&so->so_rcv.sb_cc, cp_len);
                              if ((control->do_not_ref_stcb == 0) &&
                                  stcb) {
                                    atomic_subtract_int(&stcb->asoc.sb_cc, cp_len);
                              }
                              copied_so_far += cp_len;
                              embuf = m;
                              freed_so_far += cp_len;
                              freed_so_far += MSIZE;
                              if (sctp_logging_level & SCTP_SB_LOGGING_ENABLE) {
                                    sctp_sblog(&so->so_rcv, control->do_not_ref_stcb ? NULL : stcb,
                                        SCTP_LOG_SBRESULT, 0);
                              }
                              atomic_subtract_int(&control->length, cp_len);
                        } else {
                              copied_so_far += cp_len;
                        }
                  }
                  if ((out_flags & MSG_EOR) || (uio->uio_resid == 0)) {
                        break;
                  }
                  if (((stcb) && (in_flags & MSG_PEEK) == 0) &&
                      (control->do_not_ref_stcb == 0) &&
                      (freed_so_far >= rwnd_req)) {
                        sctp_user_rcvd(stcb, &freed_so_far, hold_rlock, rwnd_req);
                  }
            }           /* end while(m) */
            /*
             * At this point we have looked at it all and we either have
             * a MSG_EOR/or read all the user wants... <OR>
             * control->length == 0.
             */
            if ((out_flags & MSG_EOR) && ((in_flags & MSG_PEEK) == 0)) {
                  /* we are done with this control */
                  if (control->length == 0) {
                        if (control->data) {
#ifdef INVARIANTS
                              panic("control->data not null at read eor?");
#else
                              SCTP_PRINTF("Strange, data left in the control buffer .. invarients would panic?\n");
                              sctp_m_freem(control->data);
                              control->data = NULL;
#endif
                        }
            done_with_control:
                        if (TAILQ_NEXT(control, next) == NULL) {
                              /*
                               * If we don't have a next we need a
                               * lock, if there is a next
                               * interrupt is filling ahead of us
                               * and we don't need a lock to
                               * remove this guy (which is the
                               * head of the queue).
                               */
                              if (hold_rlock == 0) {
                                    SCTP_INP_READ_LOCK(inp);
                                    hold_rlock = 1;
                              }
                        }
                        TAILQ_REMOVE(&inp->read_queue, control, next);
                        /* Add back any hiddend data */
                        if (control->held_length) {
                              held_length = 0;
                              control->held_length = 0;
                              wakeup_read_socket = 1;
                        }
                        if (control->aux_data) {
                              sctp_m_free(control->aux_data);
                              control->aux_data = NULL;
                        }
                        no_rcv_needed = control->do_not_ref_stcb;
                        sctp_free_remote_addr(control->whoFrom);
                        control->data = NULL;
                        sctp_free_a_readq(stcb, control);
                        control = NULL;
                        if ((freed_so_far >= rwnd_req) &&
                            (no_rcv_needed == 0))
                              sctp_user_rcvd(stcb, &freed_so_far, hold_rlock, rwnd_req);

                  } else {
                        /*
                         * The user did not read all of this
                         * message, turn off the returned MSG_EOR
                         * since we are leaving more behind on the
                         * control to read.
                         */
#ifdef INVARIANTS
                        if (control->end_added &&
                            (control->data == NULL) &&
                            (control->tail_mbuf == NULL)) {
                              panic("Gak, control->length is corrupt?");
                        }
#endif
                        no_rcv_needed = control->do_not_ref_stcb;
                        out_flags &= ~MSG_EOR;
                  }
            }
            if (out_flags & MSG_EOR) {
                  goto release;
            }
            if ((uio->uio_resid == 0) ||
                ((in_eeor_mode) && (copied_so_far >= max(so->so_rcv.sb_lowat, 1)))
                ) {
                  goto release;
            }
            /*
             * If I hit here the receiver wants more and this message is
             * NOT done (pd-api). So two questions. Can we block? if not
             * we are done. Did the user NOT set MSG_WAITALL?
             */
            if (block_allowed == 0) {
                  goto release;
            }
            /*
             * We need to wait for more data a few things: - We don't
             * sbunlock() so we don't get someone else reading. - We
             * must be sure to account for the case where what is added
             * is NOT to our control when we wakeup.
             */

            /*
             * Do we need to tell the transport a rwnd update might be
             * needed before we go to sleep?
             */
            if (((stcb) && (in_flags & MSG_PEEK) == 0) &&
                ((freed_so_far >= rwnd_req) &&
                (control->do_not_ref_stcb == 0) &&
                (no_rcv_needed == 0))) {
                  sctp_user_rcvd(stcb, &freed_so_far, hold_rlock, rwnd_req);
            }
wait_some_more:
            if (so->so_rcv.sb_state & SBS_CANTRCVMORE) {
                  goto release;
            }
            if (inp->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE)
                  goto release;

            if (hold_rlock == 1) {
                  SCTP_INP_READ_UNLOCK(inp);
                  hold_rlock = 0;
            }
            if (hold_sblock == 0) {
                  SOCKBUF_LOCK(&so->so_rcv);
                  hold_sblock = 1;
            }
            if ((copied_so_far) && (control->length == 0) &&
                (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_FRAG_INTERLEAVE))
                ) {
                  goto release;
            }
            if (so->so_rcv.sb_cc <= control->held_length) {
                  error = sbwait(&so->so_rcv);
                  if (error) {
                        goto release;
                  }
                  control->held_length = 0;
            }
            if (hold_sblock) {
                  SOCKBUF_UNLOCK(&so->so_rcv);
                  hold_sblock = 0;
            }
            if (control->length == 0) {
                  /* still nothing here */
                  if (control->end_added == 1) {
                        /* he aborted, or is done i.e.did a shutdown */
                        out_flags |= MSG_EOR;
                        if (control->pdapi_aborted) {
                              if ((control->do_not_ref_stcb == 0) && ((control->spec_flags & M_NOTIFICATION) == 0))
                                    control->stcb->asoc.strmin[control->sinfo_stream].delivery_started = 0;

                              out_flags |= MSG_TRUNC;
                        } else {
                              if ((control->do_not_ref_stcb == 0) && ((control->spec_flags & M_NOTIFICATION) == 0))
                                    control->stcb->asoc.strmin[control->sinfo_stream].delivery_started = 0;
                        }
                        goto done_with_control;
                  }
                  if (so->so_rcv.sb_cc > held_length) {
                        control->held_length = so->so_rcv.sb_cc;
                        held_length = 0;
                  }
                  goto wait_some_more;
            } else if (control->data == NULL) {
                  /*
                   * we must re-sync since data is probably being
                   * added
                   */
                  SCTP_INP_READ_LOCK(inp);
                  if ((control->length > 0) && (control->data == NULL)) {
                        /*
                         * big trouble.. we have the lock and its
                         * corrupt?
                         */
#ifdef INVARIANTS
                        panic("Impossible data==NULL length !=0");
#endif
                        out_flags |= MSG_EOR;
                        out_flags |= MSG_TRUNC;
                        control->length = 0;
                        SCTP_INP_READ_UNLOCK(inp);
                        goto done_with_control;
                  }
                  SCTP_INP_READ_UNLOCK(inp);
                  /* We will fall around to get more data */
            }
            goto get_more_data;
      } else {
            /*-
             * Give caller back the mbuf chain,
             * store in uio_resid the length
             */
            wakeup_read_socket = 0;
            if ((control->end_added == 0) ||
                (TAILQ_NEXT(control, next) == NULL)) {
                  /* Need to get rlock */
                  if (hold_rlock == 0) {
                        SCTP_INP_READ_LOCK(inp);
                        hold_rlock = 1;
                  }
            }
            if (control->end_added) {
                  out_flags |= MSG_EOR;
                  if ((control->do_not_ref_stcb == 0) && ((control->spec_flags & M_NOTIFICATION) == 0))
                        control->stcb->asoc.strmin[control->sinfo_stream].delivery_started = 0;
            }
            if (control->spec_flags & M_NOTIFICATION) {
                  out_flags |= MSG_NOTIFICATION;
            }
            uio->uio_resid = control->length;
            *mp = control->data;
            m = control->data;
            while (m) {
                  if (sctp_logging_level & SCTP_SB_LOGGING_ENABLE) {
                        sctp_sblog(&so->so_rcv,
                            control->do_not_ref_stcb ? NULL : stcb, SCTP_LOG_SBFREE, SCTP_BUF_LEN(m));
                  }
                  sctp_sbfree(control, stcb, &so->so_rcv, m);
                  freed_so_far += SCTP_BUF_LEN(m);
                  freed_so_far += MSIZE;
                  if (sctp_logging_level & SCTP_SB_LOGGING_ENABLE) {
                        sctp_sblog(&so->so_rcv,
                            control->do_not_ref_stcb ? NULL : stcb, SCTP_LOG_SBRESULT, 0);
                  }
                  m = SCTP_BUF_NEXT(m);
            }
            control->data = control->tail_mbuf = NULL;
            control->length = 0;
            if (out_flags & MSG_EOR) {
                  /* Done with this control */
                  goto done_with_control;
            }
      }
release:
      if (hold_rlock == 1) {
            SCTP_INP_READ_UNLOCK(inp);
            hold_rlock = 0;
      }
      if (hold_sblock == 1) {
            SOCKBUF_UNLOCK(&so->so_rcv);
            hold_sblock = 0;
      }
      sbunlock(&so->so_rcv);
      sockbuf_lock = 0;

release_unlocked:
      if (hold_sblock) {
            SOCKBUF_UNLOCK(&so->so_rcv);
            hold_sblock = 0;
      }
      if ((stcb) && (in_flags & MSG_PEEK) == 0) {
            if ((freed_so_far >= rwnd_req) &&
                (control && (control->do_not_ref_stcb == 0)) &&
                (no_rcv_needed == 0))
                  sctp_user_rcvd(stcb, &freed_so_far, hold_rlock, rwnd_req);
      }
      if (msg_flags)
            *msg_flags = out_flags;
out:
      if (((out_flags & MSG_EOR) == 0) &&
          ((in_flags & MSG_PEEK) == 0) &&
          (sinfo) &&
          (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_EXT_RCVINFO))) {
            struct sctp_extrcvinfo *s_extra;

            s_extra = (struct sctp_extrcvinfo *)sinfo;
            s_extra->sreinfo_next_flags = SCTP_NO_NEXT_MSG;
      }
      if (hold_rlock == 1) {
            SCTP_INP_READ_UNLOCK(inp);
            hold_rlock = 0;
      }
      if (hold_sblock) {
            SOCKBUF_UNLOCK(&so->so_rcv);
            hold_sblock = 0;
      }
      if (sockbuf_lock) {
            sbunlock(&so->so_rcv);
      }
      if (freecnt_applied) {
            /*
             * The lock on the socket buffer protects us so the free
             * code will stop. But since we used the socketbuf lock and
             * the sender uses the tcb_lock to increment, we need to use
             * the atomic add to the refcnt.
             */
            if (stcb == NULL) {
                  panic("stcb for refcnt has gone NULL?");
            }
            atomic_add_int(&stcb->asoc.refcnt, -1);
            freecnt_applied = 0;
            /* Save the value back for next time */
            stcb->freed_by_sorcv_sincelast = freed_so_far;
      }
      if (sctp_logging_level & SCTP_RECV_RWND_LOGGING_ENABLE) {
            if (stcb) {
                  sctp_misc_ints(SCTP_SORECV_DONE,
                      freed_so_far,
                      ((uio) ? (slen - uio->uio_resid) : slen),
                      stcb->asoc.my_rwnd,
                      so->so_rcv.sb_cc);
            } else {
                  sctp_misc_ints(SCTP_SORECV_DONE,
                      freed_so_far,
                      ((uio) ? (slen - uio->uio_resid) : slen),
                      0,
                      so->so_rcv.sb_cc);
            }
      }
      if (wakeup_read_socket) {
            sctp_sorwakeup(inp, so);
      }
      return (error);
}


#ifdef SCTP_MBUF_LOGGING
struct mbuf *
sctp_m_free(struct mbuf *m)
{
      if (sctp_logging_level & SCTP_MBUF_LOGGING_ENABLE) {
            if (SCTP_BUF_IS_EXTENDED(m)) {
                  sctp_log_mb(m, SCTP_MBUF_IFREE);
            }
      }
      return (m_free(m));
}

void 
sctp_m_freem(struct mbuf *mb)
{
      while (mb != NULL)
            mb = sctp_m_free(mb);
}

#endif

int
sctp_dynamic_set_primary(struct sockaddr *sa, uint32_t vrf_id)
{
      /*
       * Given a local address. For all associations that holds the
       * address, request a peer-set-primary.
       */
      struct sctp_ifa *ifa;
      struct sctp_laddr *wi;

      ifa = sctp_find_ifa_by_addr(sa, vrf_id, 0);
      if (ifa == NULL) {
            SCTP_LTRACE_ERR_RET(NULL, NULL, NULL, SCTP_FROM_SCTPUTIL, EADDRNOTAVAIL);
            return (EADDRNOTAVAIL);
      }
      /*
       * Now that we have the ifa we must awaken the iterator with this
       * message.
       */
      wi = SCTP_ZONE_GET(sctppcbinfo.ipi_zone_laddr, struct sctp_laddr);
      if (wi == NULL) {
            SCTP_LTRACE_ERR_RET(NULL, NULL, NULL, SCTP_FROM_SCTPUTIL, ENOMEM);
            return (ENOMEM);
      }
      /* Now incr the count and int wi structure */
      SCTP_INCR_LADDR_COUNT();
      bzero(wi, sizeof(*wi));
      (void)SCTP_GETTIME_TIMEVAL(&wi->start_time);
      wi->ifa = ifa;
      wi->action = SCTP_SET_PRIM_ADDR;
      atomic_add_int(&ifa->refcount, 1);

      /* Now add it to the work queue */
      SCTP_IPI_ITERATOR_WQ_LOCK();
      /*
       * Should this really be a tailq? As it is we will process the
       * newest first :-0
       */
      LIST_INSERT_HEAD(&sctppcbinfo.addr_wq, wi, sctp_nxt_addr);
      sctp_timer_start(SCTP_TIMER_TYPE_ADDR_WQ,
          (struct sctp_inpcb *)NULL,
          (struct sctp_tcb *)NULL,
          (struct sctp_nets *)NULL);
      SCTP_IPI_ITERATOR_WQ_UNLOCK();
      return (0);
}




int
sctp_soreceive(struct socket *so,
    struct sockaddr **psa,
    struct uio *uio,
    struct mbuf **mp0,
    struct mbuf **controlp,
    int *flagsp)
{
      int error, fromlen;
      uint8_t sockbuf[256];
      struct sockaddr *from;
      struct sctp_extrcvinfo sinfo;
      int filling_sinfo = 1;
      struct sctp_inpcb *inp;

      inp = (struct sctp_inpcb *)so->so_pcb;
      /* pickup the assoc we are reading from */
      if (inp == NULL) {
            SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, EINVAL);
            return (EINVAL);
      }
      if ((sctp_is_feature_off(inp,
          SCTP_PCB_FLAGS_RECVDATAIOEVNT)) ||
          (controlp == NULL)) {
            /* user does not want the sndrcv ctl */
            filling_sinfo = 0;
      }
      if (psa) {
            from = (struct sockaddr *)sockbuf;
            fromlen = sizeof(sockbuf);
            from->sa_len = 0;
      } else {
            from = NULL;
            fromlen = 0;
      }

      error = sctp_sorecvmsg(so, uio, mp0, from, fromlen, flagsp,
          (struct sctp_sndrcvinfo *)&sinfo, filling_sinfo);
      if ((controlp) && (filling_sinfo)) {
            /* copy back the sinfo in a CMSG format */
            if (filling_sinfo)
                  *controlp = sctp_build_ctl_nchunk(inp,
                      (struct sctp_sndrcvinfo *)&sinfo);
            else
                  *controlp = NULL;
      }
      if (psa) {
            /* copy back the address info */
            if (from && from->sa_len) {
                  *psa = sodupsockaddr(from, M_NOWAIT);
            } else {
                  *psa = NULL;
            }
      }
      return (error);
}


int 
sctp_l_soreceive(struct socket *so,
    struct sockaddr **name,
    struct uio *uio,
    char **controlp,
    int *controllen,
    int *flag)
{
      int error, fromlen;
      uint8_t sockbuf[256];
      struct sockaddr *from;
      struct sctp_extrcvinfo sinfo;
      int filling_sinfo = 1;
      struct sctp_inpcb *inp;

      inp = (struct sctp_inpcb *)so->so_pcb;
      /* pickup the assoc we are reading from */
      if (inp == NULL) {
            SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, EINVAL);
            return (EINVAL);
      }
      if ((sctp_is_feature_off(inp,
          SCTP_PCB_FLAGS_RECVDATAIOEVNT)) ||
          (controlp == NULL)) {
            /* user does not want the sndrcv ctl */
            filling_sinfo = 0;
      }
      if (name) {
            from = (struct sockaddr *)sockbuf;
            fromlen = sizeof(sockbuf);
            from->sa_len = 0;
      } else {
            from = NULL;
            fromlen = 0;
      }

      error = sctp_sorecvmsg(so, uio,
          (struct mbuf **)NULL,
          from, fromlen, flag,
          (struct sctp_sndrcvinfo *)&sinfo,
          filling_sinfo);
      if ((controlp) && (filling_sinfo)) {
            /*
             * copy back the sinfo in a CMSG format note that the caller
             * has reponsibility for freeing the memory.
             */
            if (filling_sinfo)
                  *controlp = sctp_build_ctl_cchunk(inp,
                      controllen,
                      (struct sctp_sndrcvinfo *)&sinfo);
      }
      if (name) {
            /* copy back the address info */
            if (from && from->sa_len) {
                  *name = sodupsockaddr(from, M_WAIT);
            } else {
                  *name = NULL;
            }
      }
      return (error);
}







int
sctp_connectx_helper_add(struct sctp_tcb *stcb, struct sockaddr *addr,
    int totaddr, int *error)
{
      int added = 0;
      int i;
      struct sctp_inpcb *inp;
      struct sockaddr *sa;
      size_t incr = 0;

      sa = addr;
      inp = stcb->sctp_ep;
      *error = 0;
      for (i = 0; i < totaddr; i++) {
            if (sa->sa_family == AF_INET) {
                  incr = sizeof(struct sockaddr_in);
                  if (sctp_add_remote_addr(stcb, sa, SCTP_DONOT_SETSCOPE, SCTP_ADDR_IS_CONFIRMED)) {
                        /* assoc gone no un-lock */
                        SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTPUTIL, ENOBUFS);
                        (void)sctp_free_assoc(inp, stcb, SCTP_NORMAL_PROC, SCTP_FROM_SCTP_USRREQ + SCTP_LOC_7);
                        *error = ENOBUFS;
                        goto out_now;
                  }
                  added++;
            } else if (sa->sa_family == AF_INET6) {
                  incr = sizeof(struct sockaddr_in6);
                  if (sctp_add_remote_addr(stcb, sa, SCTP_DONOT_SETSCOPE, SCTP_ADDR_IS_CONFIRMED)) {
                        /* assoc gone no un-lock */
                        SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTPUTIL, ENOBUFS);
                        (void)sctp_free_assoc(inp, stcb, SCTP_NORMAL_PROC, SCTP_FROM_SCTP_USRREQ + SCTP_LOC_8);
                        *error = ENOBUFS;
                        goto out_now;
                  }
                  added++;
            }
            sa = (struct sockaddr *)((caddr_t)sa + incr);
      }
out_now:
      return (added);
}

struct sctp_tcb *
sctp_connectx_helper_find(struct sctp_inpcb *inp, struct sockaddr *addr,
    int *totaddr, int *num_v4, int *num_v6, int *error,
    int limit, int *bad_addr)
{
      struct sockaddr *sa;
      struct sctp_tcb *stcb = NULL;
      size_t incr, at, i;

      at = incr = 0;
      sa = addr;
      *error = *num_v6 = *num_v4 = 0;
      /* account and validate addresses */
      for (i = 0; i < (size_t)*totaddr; i++) {
            if (sa->sa_family == AF_INET) {
                  (*num_v4) += 1;
                  incr = sizeof(struct sockaddr_in);
                  if (sa->sa_len != incr) {
                        SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, EINVAL);
                        *error = EINVAL;
                        *bad_addr = 1;
                        return (NULL);
                  }
            } else if (sa->sa_family == AF_INET6) {
                  struct sockaddr_in6 *sin6;

                  sin6 = (struct sockaddr_in6 *)sa;
                  if (IN6_IS_ADDR_V4MAPPED(&sin6->sin6_addr)) {
                        /* Must be non-mapped for connectx */
                        SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, EINVAL);
                        *error = EINVAL;
                        *bad_addr = 1;
                        return (NULL);
                  }
                  (*num_v6) += 1;
                  incr = sizeof(struct sockaddr_in6);
                  if (sa->sa_len != incr) {
                        SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, EINVAL);
                        *error = EINVAL;
                        *bad_addr = 1;
                        return (NULL);
                  }
            } else {
                  *totaddr = i;
                  /* we are done */
                  break;
            }
            SCTP_INP_INCR_REF(inp);
            stcb = sctp_findassociation_ep_addr(&inp, sa, NULL, NULL, NULL);
            if (stcb != NULL) {
                  /* Already have or am bring up an association */
                  return (stcb);
            } else {
                  SCTP_INP_DECR_REF(inp);
            }
            if ((at + incr) > (size_t)limit) {
                  *totaddr = i;
                  break;
            }
            sa = (struct sockaddr *)((caddr_t)sa + incr);
      }
      return ((struct sctp_tcb *)NULL);
}

/*
 * sctp_bindx(ADD) for one address.
 * assumes all arguments are valid/checked by caller.
 */
void
sctp_bindx_add_address(struct socket *so, struct sctp_inpcb *inp,
    struct sockaddr *sa, sctp_assoc_t assoc_id,
    uint32_t vrf_id, int *error, void *p)
{
      struct sockaddr *addr_touse;
      struct sockaddr_in sin;

      /* see if we're bound all already! */
      if (inp->sctp_flags & SCTP_PCB_FLAGS_BOUNDALL) {
            SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, EINVAL);
            *error = EINVAL;
            return;
      }
      addr_touse = sa;
#if defined(INET6)
      if (sa->sa_family == AF_INET6) {
            struct sockaddr_in6 *sin6;

            if (sa->sa_len != sizeof(struct sockaddr_in6)) {
                  SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, EINVAL);
                  *error = EINVAL;
                  return;
            }
            if ((inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) == 0) {
                  /* can only bind v6 on PF_INET6 sockets */
                  SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, EINVAL);
                  *error = EINVAL;
                  return;
            }
            sin6 = (struct sockaddr_in6 *)addr_touse;
            if (IN6_IS_ADDR_V4MAPPED(&sin6->sin6_addr)) {
                  if ((inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) &&
                      SCTP_IPV6_V6ONLY(inp)) {
                        /* can't bind v4-mapped on PF_INET sockets */
                        SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, EINVAL);
                        *error = EINVAL;
                        return;
                  }
                  in6_sin6_2_sin(&sin, sin6);
                  addr_touse = (struct sockaddr *)&sin;
            }
      }
#endif
      if (sa->sa_family == AF_INET) {
            if (sa->sa_len != sizeof(struct sockaddr_in)) {
                  SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, EINVAL);
                  *error = EINVAL;
                  return;
            }
            if ((inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) &&
                SCTP_IPV6_V6ONLY(inp)) {
                  /* can't bind v4 on PF_INET sockets */
                  SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, EINVAL);
                  *error = EINVAL;
                  return;
            }
      }
      if (inp->sctp_flags & SCTP_PCB_FLAGS_UNBOUND) {
            if (p == NULL) {
                  /* Can't get proc for Net/Open BSD */
                  SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, EINVAL);
                  *error = EINVAL;
                  return;
            }
            *error = sctp_inpcb_bind(so, addr_touse, NULL, p);
            return;
      }
      /*
       * No locks required here since bind and mgmt_ep_sa all do their own
       * locking. If we do something for the FIX: below we may need to
       * lock in that case.
       */
      if (assoc_id == 0) {
            /* add the address */
            struct sctp_inpcb *lep;
            struct sockaddr_in *lsin = (struct sockaddr_in *)addr_touse;

            /* validate the incoming port */
            if ((lsin->sin_port != 0) &&
                (lsin->sin_port != inp->sctp_lport)) {
                  SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, EINVAL);
                  *error = EINVAL;
                  return;
            } else {
                  /* user specified 0 port, set it to existing port */
                  lsin->sin_port = inp->sctp_lport;
            }

            lep = sctp_pcb_findep(addr_touse, 1, 0, vrf_id);
            if (lep != NULL) {
                  /*
                   * We must decrement the refcount since we have the
                   * ep already and are binding. No remove going on
                   * here.
                   */
                  SCTP_INP_DECR_REF(inp);
            }
            if (lep == inp) {
                  /* already bound to it.. ok */
                  return;
            } else if (lep == NULL) {
                  ((struct sockaddr_in *)addr_touse)->sin_port = 0;
                  *error = sctp_addr_mgmt_ep_sa(inp, addr_touse,
                      SCTP_ADD_IP_ADDRESS,
                      vrf_id, NULL);
            } else {
                  *error = EADDRINUSE;
            }
            if (*error)
                  return;
      } else {
            /*
             * FIX: decide whether we allow assoc based bindx
             */
      }
}

/*
 * sctp_bindx(DELETE) for one address.
 * assumes all arguments are valid/checked by caller.
 */
void
sctp_bindx_delete_address(struct socket *so, struct sctp_inpcb *inp,
    struct sockaddr *sa, sctp_assoc_t assoc_id,
    uint32_t vrf_id, int *error)
{
      struct sockaddr *addr_touse;
      struct sockaddr_in sin;

      /* see if we're bound all already! */
      if (inp->sctp_flags & SCTP_PCB_FLAGS_BOUNDALL) {
            SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, EINVAL);
            *error = EINVAL;
            return;
      }
      addr_touse = sa;
#if defined(INET6)
      if (sa->sa_family == AF_INET6) {
            struct sockaddr_in6 *sin6;

            if (sa->sa_len != sizeof(struct sockaddr_in6)) {
                  SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, EINVAL);
                  *error = EINVAL;
                  return;
            }
            if ((inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) == 0) {
                  /* can only bind v6 on PF_INET6 sockets */
                  SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, EINVAL);
                  *error = EINVAL;
                  return;
            }
            sin6 = (struct sockaddr_in6 *)addr_touse;
            if (IN6_IS_ADDR_V4MAPPED(&sin6->sin6_addr)) {
                  if ((inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) &&
                      SCTP_IPV6_V6ONLY(inp)) {
                        /* can't bind mapped-v4 on PF_INET sockets */
                        SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, EINVAL);
                        *error = EINVAL;
                        return;
                  }
                  in6_sin6_2_sin(&sin, sin6);
                  addr_touse = (struct sockaddr *)&sin;
            }
      }
#endif
      if (sa->sa_family == AF_INET) {
            if (sa->sa_len != sizeof(struct sockaddr_in)) {
                  SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, EINVAL);
                  *error = EINVAL;
                  return;
            }
            if ((inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) &&
                SCTP_IPV6_V6ONLY(inp)) {
                  /* can't bind v4 on PF_INET sockets */
                  SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTPUTIL, EINVAL);
                  *error = EINVAL;
                  return;
            }
      }
      /*
       * No lock required mgmt_ep_sa does its own locking. If the FIX:
       * below is ever changed we may need to lock before calling
       * association level binding.
       */
      if (assoc_id == 0) {
            /* delete the address */
            *error = sctp_addr_mgmt_ep_sa(inp, addr_touse,
                SCTP_DEL_IP_ADDRESS,
                vrf_id, NULL);
      } else {
            /*
             * FIX: decide whether we allow assoc based bindx
             */
      }
}

/*
 * returns the valid local address count for an assoc, taking into account
 * all scoping rules
 */
int
sctp_local_addr_count(struct sctp_tcb *stcb)
{
      int loopback_scope, ipv4_local_scope, local_scope, site_scope;
      int ipv4_addr_legal, ipv6_addr_legal;
      struct sctp_vrf *vrf;
      struct sctp_ifn *sctp_ifn;
      struct sctp_ifa *sctp_ifa;
      int count = 0;

      /* Turn on all the appropriate scopes */
      loopback_scope = stcb->asoc.loopback_scope;
      ipv4_local_scope = stcb->asoc.ipv4_local_scope;
      local_scope = stcb->asoc.local_scope;
      site_scope = stcb->asoc.site_scope;
      ipv4_addr_legal = ipv6_addr_legal = 0;
      if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) {
            ipv6_addr_legal = 1;
            if (SCTP_IPV6_V6ONLY(stcb->sctp_ep) == 0) {
                  ipv4_addr_legal = 1;
            }
      } else {
            ipv4_addr_legal = 1;
      }

      SCTP_IPI_ADDR_RLOCK();
      vrf = sctp_find_vrf(stcb->asoc.vrf_id);
      if (vrf == NULL) {
            /* no vrf, no addresses */
            SCTP_IPI_ADDR_RUNLOCK();
            return (0);
      }
      if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_BOUNDALL) {
            /*
             * bound all case: go through all ifns on the vrf
             */
            LIST_FOREACH(sctp_ifn, &vrf->ifnlist, next_ifn) {
                  if ((loopback_scope == 0) &&
                      SCTP_IFN_IS_IFT_LOOP(sctp_ifn)) {
                        continue;
                  }
                  LIST_FOREACH(sctp_ifa, &sctp_ifn->ifalist, next_ifa) {
                        if (sctp_is_addr_restricted(stcb, sctp_ifa))
                              continue;

                        if ((sctp_ifa->address.sa.sa_family == AF_INET) &&
                            (ipv4_addr_legal)) {
                              struct sockaddr_in *sin;

                              sin = (struct sockaddr_in *)&sctp_ifa->address.sa;
                              if (sin->sin_addr.s_addr == 0) {
                                    /* skip unspecified addrs */
                                    continue;
                              }
                              if ((ipv4_local_scope == 0) &&
                                  (IN4_ISPRIVATE_ADDRESS(&sin->sin_addr))) {
                                    continue;
                              }
                              /* count this one */
                              count++;
                        } else if ((sctp_ifa->address.sa.sa_family == AF_INET6) &&
                            (ipv6_addr_legal)) {
                              struct sockaddr_in6 *sin6;

                              sin6 = (struct sockaddr_in6 *)&sctp_ifa->address.sa;
                              if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr)) {
                                    continue;
                              }
                              if (IN6_IS_ADDR_LINKLOCAL(&sin6->sin6_addr)) {
                                    if (local_scope == 0)
                                          continue;
                                    if (sin6->sin6_scope_id == 0) {
                                          if (sa6_recoverscope(sin6) != 0)
                                                /*
                                                 * bad link
                                                 * local
                                                 * address
                                                 */
                                                continue;
                                    }
                              }
                              if ((site_scope == 0) &&
                                  (IN6_IS_ADDR_SITELOCAL(&sin6->sin6_addr))) {
                                    continue;
                              }
                              /* count this one */
                              count++;
                        }
                  }
            }
      } else {
            /*
             * subset bound case
             */
            struct sctp_laddr *laddr;

            LIST_FOREACH(laddr, &stcb->sctp_ep->sctp_addr_list,
                sctp_nxt_addr) {
                  if (sctp_is_addr_restricted(stcb, laddr->ifa)) {
                        continue;
                  }
                  /* count this one */
                  count++;
            }
      }
      SCTP_IPI_ADDR_RUNLOCK();
      return (count);
}

#if defined(SCTP_LOCAL_TRACE_BUF)

void
sctp_log_trace(uint32_t subsys, const char *str SCTP_UNUSED, uint32_t a, uint32_t b, uint32_t c, uint32_t d, uint32_t e, uint32_t f)
{
      uint32_t saveindex, newindex;

      do {
            saveindex = sctp_log.index;
            if (saveindex >= SCTP_MAX_LOGGING_SIZE) {
                  newindex = 1;
            } else {
                  newindex = saveindex + 1;
            }
      } while (atomic_cmpset_int(&sctp_log.index, saveindex, newindex) == 0);
      if (saveindex >= SCTP_MAX_LOGGING_SIZE) {
            saveindex = 0;
      }
      sctp_log.entry[saveindex].timestamp = SCTP_GET_CYCLECOUNT;
      sctp_log.entry[saveindex].subsys = subsys;
      sctp_log.entry[saveindex].params[0] = a;
      sctp_log.entry[saveindex].params[1] = b;
      sctp_log.entry[saveindex].params[2] = c;
      sctp_log.entry[saveindex].params[3] = d;
      sctp_log.entry[saveindex].params[4] = e;
      sctp_log.entry[saveindex].params[5] = f;
}

#endif

Generated by  Doxygen 1.6.0   Back to index