xref: /freebsd/sys/netinet/sctp_indata.c (revision 0d15140d6d3470db45d823e4f3a5ec05693b097d)
1f8829a4aSRandall Stewart /*-
251369649SPedro F. Giffuni  * SPDX-License-Identifier: BSD-3-Clause
351369649SPedro F. Giffuni  *
4b1006367SRandall Stewart  * Copyright (c) 2001-2007, by Cisco Systems, Inc. All rights reserved.
5807aad63SMichael Tuexen  * Copyright (c) 2008-2012, by Randall Stewart. All rights reserved.
6807aad63SMichael Tuexen  * Copyright (c) 2008-2012, by Michael Tuexen. All rights reserved.
7f8829a4aSRandall Stewart  *
8f8829a4aSRandall Stewart  * Redistribution and use in source and binary forms, with or without
9f8829a4aSRandall Stewart  * modification, are permitted provided that the following conditions are met:
10f8829a4aSRandall Stewart  *
11f8829a4aSRandall Stewart  * a) Redistributions of source code must retain the above copyright notice,
12f8829a4aSRandall Stewart  *    this list of conditions and the following disclaimer.
13f8829a4aSRandall Stewart  *
14f8829a4aSRandall Stewart  * b) Redistributions in binary form must reproduce the above copyright
15f8829a4aSRandall Stewart  *    notice, this list of conditions and the following disclaimer in
16f8829a4aSRandall Stewart  *    the documentation and/or other materials provided with the distribution.
17f8829a4aSRandall Stewart  *
18f8829a4aSRandall Stewart  * c) Neither the name of Cisco Systems, Inc. nor the names of its
19f8829a4aSRandall Stewart  *    contributors may be used to endorse or promote products derived
20f8829a4aSRandall Stewart  *    from this software without specific prior written permission.
21f8829a4aSRandall Stewart  *
22f8829a4aSRandall Stewart  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
23f8829a4aSRandall Stewart  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
24f8829a4aSRandall Stewart  * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
25f8829a4aSRandall Stewart  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
26f8829a4aSRandall Stewart  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
27f8829a4aSRandall Stewart  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
28f8829a4aSRandall Stewart  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
29f8829a4aSRandall Stewart  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
30f8829a4aSRandall Stewart  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
31f8829a4aSRandall Stewart  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
32f8829a4aSRandall Stewart  * THE POSSIBILITY OF SUCH DAMAGE.
33f8829a4aSRandall Stewart  */
34f8829a4aSRandall Stewart 
35f8829a4aSRandall Stewart #include <netinet/sctp_os.h>
3644249214SRandall Stewart #include <sys/proc.h>
37f8829a4aSRandall Stewart #include <netinet/sctp_var.h>
3842551e99SRandall Stewart #include <netinet/sctp_sysctl.h>
39f8829a4aSRandall Stewart #include <netinet/sctp_header.h>
4044249214SRandall Stewart #include <netinet/sctp_pcb.h>
41f8829a4aSRandall Stewart #include <netinet/sctputil.h>
42f8829a4aSRandall Stewart #include <netinet/sctp_output.h>
43f8829a4aSRandall Stewart #include <netinet/sctp_uio.h>
4444249214SRandall Stewart #include <netinet/sctp_auth.h>
45f8829a4aSRandall Stewart #include <netinet/sctp_timer.h>
4644249214SRandall Stewart #include <netinet/sctp_asconf.h>
4744249214SRandall Stewart #include <netinet/sctp_indata.h>
4844249214SRandall Stewart #include <netinet/sctp_bsd_addr.h>
4944249214SRandall Stewart #include <netinet/sctp_input.h>
5044249214SRandall Stewart #include <netinet/sctp_crc32.h>
5144249214SRandall Stewart #include <netinet/sctp_lock_bsd.h>
52f8829a4aSRandall Stewart /*
53f8829a4aSRandall Stewart  * NOTES: On the outbound side of things I need to check the sack timer to
54f8829a4aSRandall Stewart  * see if I should generate a sack into the chunk queue (if I have data to
55f8829a4aSRandall Stewart  * send that is and will be sending it .. for bundling.
56f8829a4aSRandall Stewart  *
57f8829a4aSRandall Stewart  * The callback in sctp_usrreq.c will get called when the socket is read from.
58f8829a4aSRandall Stewart  * This will cause sctp_service_queues() to get called on the top entry in
59f8829a4aSRandall Stewart  * the list.
60f8829a4aSRandall Stewart  */
6128cd0699SMichael Tuexen static uint32_t
6244249214SRandall Stewart sctp_add_chk_to_control(struct sctp_queued_to_read *control,
6344249214SRandall Stewart     struct sctp_stream_in *strm,
6444249214SRandall Stewart     struct sctp_tcb *stcb,
6544249214SRandall Stewart     struct sctp_association *asoc,
6644710431SMichael Tuexen     struct sctp_tmit_chunk *chk, int hold_rlock);
6744249214SRandall Stewart 
6872fb6fdbSRandall Stewart void
69f8829a4aSRandall Stewart sctp_set_rwnd(struct sctp_tcb *stcb, struct sctp_association *asoc)
70f8829a4aSRandall Stewart {
71b3f1ea41SRandall Stewart 	asoc->my_rwnd = sctp_calc_rwnd(stcb, asoc);
72f8829a4aSRandall Stewart }
73f8829a4aSRandall Stewart 
74f8829a4aSRandall Stewart /* Calculate what the rwnd would be */
7572fb6fdbSRandall Stewart uint32_t
76b0471b4bSMichael Tuexen sctp_calc_rwnd(struct sctp_tcb *stcb, struct sctp_association *asoc)
77b0471b4bSMichael Tuexen {
78b3f1ea41SRandall Stewart 	uint32_t calc = 0;
79f8829a4aSRandall Stewart 
80f8829a4aSRandall Stewart 	/*
81f8829a4aSRandall Stewart 	 * This is really set wrong with respect to a 1-2-m socket. Since
824e88d37aSMichael Tuexen 	 * the sb_cc is the count that everyone as put up. When we re-write
83f8829a4aSRandall Stewart 	 * sctp_soreceive then we will fix this so that ONLY this
84f8829a4aSRandall Stewart 	 * associations data is taken into account.
85f8829a4aSRandall Stewart 	 */
8644249214SRandall Stewart 	if (stcb->sctp_socket == NULL) {
87f8829a4aSRandall Stewart 		return (calc);
8844249214SRandall Stewart 	}
890053ed28SMichael Tuexen 
90253a63b8SMichael Tuexen 	KASSERT(asoc->cnt_on_reasm_queue > 0 || asoc->size_on_reasm_queue == 0,
91253a63b8SMichael Tuexen 	    ("size_on_reasm_queue is %u", asoc->size_on_reasm_queue));
92253a63b8SMichael Tuexen 	KASSERT(asoc->cnt_on_all_streams > 0 || asoc->size_on_all_streams == 0,
93253a63b8SMichael Tuexen 	    ("size_on_all_streams is %u", asoc->size_on_all_streams));
944e88d37aSMichael Tuexen 	if (stcb->asoc.sb_cc == 0 &&
95253a63b8SMichael Tuexen 	    asoc->cnt_on_reasm_queue == 0 &&
96253a63b8SMichael Tuexen 	    asoc->cnt_on_all_streams == 0) {
97f8829a4aSRandall Stewart 		/* Full rwnd granted */
98b3f1ea41SRandall Stewart 		calc = max(SCTP_SB_LIMIT_RCV(stcb->sctp_socket), SCTP_MINIMAL_RWND);
99f8829a4aSRandall Stewart 		return (calc);
100f8829a4aSRandall Stewart 	}
101f8829a4aSRandall Stewart 	/* get actual space */
102f8829a4aSRandall Stewart 	calc = (uint32_t)sctp_sbspace(&stcb->asoc, &stcb->sctp_socket->so_rcv);
103f8829a4aSRandall Stewart 	/*
104f8829a4aSRandall Stewart 	 * take out what has NOT been put on socket queue and we yet hold
105f8829a4aSRandall Stewart 	 * for putting up.
106f8829a4aSRandall Stewart 	 */
10744fbe462SRandall Stewart 	calc = sctp_sbspace_sub(calc, (uint32_t)(asoc->size_on_reasm_queue +
10844fbe462SRandall Stewart 	    asoc->cnt_on_reasm_queue * MSIZE));
10944fbe462SRandall Stewart 	calc = sctp_sbspace_sub(calc, (uint32_t)(asoc->size_on_all_streams +
11044fbe462SRandall Stewart 	    asoc->cnt_on_all_streams * MSIZE));
111f8829a4aSRandall Stewart 	if (calc == 0) {
112f8829a4aSRandall Stewart 		/* out of space */
113f8829a4aSRandall Stewart 		return (calc);
114f8829a4aSRandall Stewart 	}
1150053ed28SMichael Tuexen 
116f8829a4aSRandall Stewart 	/* what is the overhead of all these rwnd's */
1172afb3e84SRandall Stewart 	calc = sctp_sbspace_sub(calc, stcb->asoc.my_rwnd_control_len);
118b3f1ea41SRandall Stewart 	/*
119b3f1ea41SRandall Stewart 	 * If the window gets too small due to ctrl-stuff, reduce it to 1,
120b3f1ea41SRandall Stewart 	 * even it is 0. SWS engaged
121f8829a4aSRandall Stewart 	 */
122b3f1ea41SRandall Stewart 	if (calc < stcb->asoc.my_rwnd_control_len) {
123b3f1ea41SRandall Stewart 		calc = 1;
1242afb3e84SRandall Stewart 	}
125b3f1ea41SRandall Stewart 	return (calc);
126f8829a4aSRandall Stewart }
127f8829a4aSRandall Stewart 
128f8829a4aSRandall Stewart /*
129f8829a4aSRandall Stewart  * Build out our readq entry based on the incoming packet.
130f8829a4aSRandall Stewart  */
131f8829a4aSRandall Stewart struct sctp_queued_to_read *
132f8829a4aSRandall Stewart sctp_build_readq_entry(struct sctp_tcb *stcb,
133f8829a4aSRandall Stewart     struct sctp_nets *net,
134f8829a4aSRandall Stewart     uint32_t tsn, uint32_t ppid,
13549656eefSMichael Tuexen     uint32_t context, uint16_t sid,
13649656eefSMichael Tuexen     uint32_t mid, uint8_t flags,
137f8829a4aSRandall Stewart     struct mbuf *dm)
138f8829a4aSRandall Stewart {
139f8829a4aSRandall Stewart 	struct sctp_queued_to_read *read_queue_e = NULL;
140f8829a4aSRandall Stewart 
141f8829a4aSRandall Stewart 	sctp_alloc_a_readq(stcb, read_queue_e);
142f8829a4aSRandall Stewart 	if (read_queue_e == NULL) {
143f8829a4aSRandall Stewart 		goto failed_build;
144f8829a4aSRandall Stewart 	}
14544249214SRandall Stewart 	memset(read_queue_e, 0, sizeof(struct sctp_queued_to_read));
14649656eefSMichael Tuexen 	read_queue_e->sinfo_stream = sid;
147f8829a4aSRandall Stewart 	read_queue_e->sinfo_flags = (flags << 8);
148f8829a4aSRandall Stewart 	read_queue_e->sinfo_ppid = ppid;
1497215cc1bSMichael Tuexen 	read_queue_e->sinfo_context = context;
150f8829a4aSRandall Stewart 	read_queue_e->sinfo_tsn = tsn;
151f8829a4aSRandall Stewart 	read_queue_e->sinfo_cumtsn = tsn;
152f8829a4aSRandall Stewart 	read_queue_e->sinfo_assoc_id = sctp_get_associd(stcb);
15349656eefSMichael Tuexen 	read_queue_e->mid = mid;
15444249214SRandall Stewart 	read_queue_e->top_fsn = read_queue_e->fsn_included = 0xffffffff;
15544249214SRandall Stewart 	TAILQ_INIT(&read_queue_e->reasm);
156f8829a4aSRandall Stewart 	read_queue_e->whoFrom = net;
157f8829a4aSRandall Stewart 	atomic_add_int(&net->ref_count, 1);
158f8829a4aSRandall Stewart 	read_queue_e->data = dm;
159f8829a4aSRandall Stewart 	read_queue_e->stcb = stcb;
160f8829a4aSRandall Stewart 	read_queue_e->port_from = stcb->rport;
161daf14341SMichael Tuexen 	if (stcb->asoc.state & SCTP_STATE_ABOUT_TO_BE_FREED) {
162daf14341SMichael Tuexen 		read_queue_e->do_not_ref_stcb = 1;
163daf14341SMichael Tuexen 	}
164f8829a4aSRandall Stewart failed_build:
165f8829a4aSRandall Stewart 	return (read_queue_e);
166f8829a4aSRandall Stewart }
167f8829a4aSRandall Stewart 
168f8829a4aSRandall Stewart struct mbuf *
169e2e7c62eSMichael Tuexen sctp_build_ctl_nchunk(struct sctp_inpcb *inp, struct sctp_sndrcvinfo *sinfo)
170f8829a4aSRandall Stewart {
171e2e7c62eSMichael Tuexen 	struct sctp_extrcvinfo *seinfo;
172f8829a4aSRandall Stewart 	struct sctp_sndrcvinfo *outinfo;
173e2e7c62eSMichael Tuexen 	struct sctp_rcvinfo *rcvinfo;
174e2e7c62eSMichael Tuexen 	struct sctp_nxtinfo *nxtinfo;
175f8829a4aSRandall Stewart 	struct cmsghdr *cmh;
176f8829a4aSRandall Stewart 	struct mbuf *ret;
177f8829a4aSRandall Stewart 	int len;
178e2e7c62eSMichael Tuexen 	int use_extended;
179e2e7c62eSMichael Tuexen 	int provide_nxt;
180f8829a4aSRandall Stewart 
181e2e7c62eSMichael Tuexen 	if (sctp_is_feature_off(inp, SCTP_PCB_FLAGS_RECVDATAIOEVNT) &&
182e2e7c62eSMichael Tuexen 	    sctp_is_feature_off(inp, SCTP_PCB_FLAGS_RECVRCVINFO) &&
183e2e7c62eSMichael Tuexen 	    sctp_is_feature_off(inp, SCTP_PCB_FLAGS_RECVNXTINFO)) {
184e2e7c62eSMichael Tuexen 		/* user does not want any ancillary data */
185f8829a4aSRandall Stewart 		return (NULL);
186f8829a4aSRandall Stewart 	}
1870053ed28SMichael Tuexen 
188e2e7c62eSMichael Tuexen 	len = 0;
189e2e7c62eSMichael Tuexen 	if (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_RECVRCVINFO)) {
190e2e7c62eSMichael Tuexen 		len += CMSG_SPACE(sizeof(struct sctp_rcvinfo));
191e2e7c62eSMichael Tuexen 	}
192e2e7c62eSMichael Tuexen 	seinfo = (struct sctp_extrcvinfo *)sinfo;
193e2e7c62eSMichael Tuexen 	if (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_RECVNXTINFO) &&
194b70b526dSMichael Tuexen 	    (seinfo->serinfo_next_flags & SCTP_NEXT_MSG_AVAIL)) {
195e2e7c62eSMichael Tuexen 		provide_nxt = 1;
1960bfc52beSMichael Tuexen 		len += CMSG_SPACE(sizeof(struct sctp_nxtinfo));
197e2e7c62eSMichael Tuexen 	} else {
198e2e7c62eSMichael Tuexen 		provide_nxt = 0;
199e2e7c62eSMichael Tuexen 	}
200e2e7c62eSMichael Tuexen 	if (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_RECVDATAIOEVNT)) {
201f8829a4aSRandall Stewart 		if (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_EXT_RCVINFO)) {
202f8829a4aSRandall Stewart 			use_extended = 1;
203e2e7c62eSMichael Tuexen 			len += CMSG_SPACE(sizeof(struct sctp_extrcvinfo));
204f8829a4aSRandall Stewart 		} else {
205e2e7c62eSMichael Tuexen 			use_extended = 0;
206e2e7c62eSMichael Tuexen 			len += CMSG_SPACE(sizeof(struct sctp_sndrcvinfo));
207e2e7c62eSMichael Tuexen 		}
208e2e7c62eSMichael Tuexen 	} else {
209e2e7c62eSMichael Tuexen 		use_extended = 0;
210f8829a4aSRandall Stewart 	}
211f8829a4aSRandall Stewart 
212eb1b1807SGleb Smirnoff 	ret = sctp_get_mbuf_for_msg(len, 0, M_NOWAIT, 1, MT_DATA);
213f8829a4aSRandall Stewart 	if (ret == NULL) {
214f8829a4aSRandall Stewart 		/* No space */
215f8829a4aSRandall Stewart 		return (ret);
216f8829a4aSRandall Stewart 	}
217e2e7c62eSMichael Tuexen 	SCTP_BUF_LEN(ret) = 0;
218e2e7c62eSMichael Tuexen 
219f8829a4aSRandall Stewart 	/* We need a CMSG header followed by the struct */
220f8829a4aSRandall Stewart 	cmh = mtod(ret, struct cmsghdr *);
221e432298aSXin LI 	/*
222e432298aSXin LI 	 * Make sure that there is no un-initialized padding between the
223e432298aSXin LI 	 * cmsg header and cmsg data and after the cmsg data.
224e432298aSXin LI 	 */
225e432298aSXin LI 	memset(cmh, 0, len);
226e2e7c62eSMichael Tuexen 	if (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_RECVRCVINFO)) {
227f8829a4aSRandall Stewart 		cmh->cmsg_level = IPPROTO_SCTP;
228e2e7c62eSMichael Tuexen 		cmh->cmsg_len = CMSG_LEN(sizeof(struct sctp_rcvinfo));
229e2e7c62eSMichael Tuexen 		cmh->cmsg_type = SCTP_RCVINFO;
230e2e7c62eSMichael Tuexen 		rcvinfo = (struct sctp_rcvinfo *)CMSG_DATA(cmh);
231e2e7c62eSMichael Tuexen 		rcvinfo->rcv_sid = sinfo->sinfo_stream;
232e2e7c62eSMichael Tuexen 		rcvinfo->rcv_ssn = sinfo->sinfo_ssn;
233e2e7c62eSMichael Tuexen 		rcvinfo->rcv_flags = sinfo->sinfo_flags;
234e2e7c62eSMichael Tuexen 		rcvinfo->rcv_ppid = sinfo->sinfo_ppid;
235e2e7c62eSMichael Tuexen 		rcvinfo->rcv_tsn = sinfo->sinfo_tsn;
236e2e7c62eSMichael Tuexen 		rcvinfo->rcv_cumtsn = sinfo->sinfo_cumtsn;
237e2e7c62eSMichael Tuexen 		rcvinfo->rcv_context = sinfo->sinfo_context;
238e2e7c62eSMichael Tuexen 		rcvinfo->rcv_assoc_id = sinfo->sinfo_assoc_id;
239e2e7c62eSMichael Tuexen 		cmh = (struct cmsghdr *)((caddr_t)cmh + CMSG_SPACE(sizeof(struct sctp_rcvinfo)));
240e2e7c62eSMichael Tuexen 		SCTP_BUF_LEN(ret) += CMSG_SPACE(sizeof(struct sctp_rcvinfo));
241f8829a4aSRandall Stewart 	}
242e2e7c62eSMichael Tuexen 	if (provide_nxt) {
243e2e7c62eSMichael Tuexen 		cmh->cmsg_level = IPPROTO_SCTP;
244e2e7c62eSMichael Tuexen 		cmh->cmsg_len = CMSG_LEN(sizeof(struct sctp_nxtinfo));
245e2e7c62eSMichael Tuexen 		cmh->cmsg_type = SCTP_NXTINFO;
246e2e7c62eSMichael Tuexen 		nxtinfo = (struct sctp_nxtinfo *)CMSG_DATA(cmh);
247b70b526dSMichael Tuexen 		nxtinfo->nxt_sid = seinfo->serinfo_next_stream;
248e2e7c62eSMichael Tuexen 		nxtinfo->nxt_flags = 0;
249b70b526dSMichael Tuexen 		if (seinfo->serinfo_next_flags & SCTP_NEXT_MSG_IS_UNORDERED) {
250e2e7c62eSMichael Tuexen 			nxtinfo->nxt_flags |= SCTP_UNORDERED;
251e2e7c62eSMichael Tuexen 		}
252b70b526dSMichael Tuexen 		if (seinfo->serinfo_next_flags & SCTP_NEXT_MSG_IS_NOTIFICATION) {
253e2e7c62eSMichael Tuexen 			nxtinfo->nxt_flags |= SCTP_NOTIFICATION;
254e2e7c62eSMichael Tuexen 		}
255b70b526dSMichael Tuexen 		if (seinfo->serinfo_next_flags & SCTP_NEXT_MSG_ISCOMPLETE) {
256e2e7c62eSMichael Tuexen 			nxtinfo->nxt_flags |= SCTP_COMPLETE;
257e2e7c62eSMichael Tuexen 		}
258b70b526dSMichael Tuexen 		nxtinfo->nxt_ppid = seinfo->serinfo_next_ppid;
259b70b526dSMichael Tuexen 		nxtinfo->nxt_length = seinfo->serinfo_next_length;
260b70b526dSMichael Tuexen 		nxtinfo->nxt_assoc_id = seinfo->serinfo_next_aid;
261e2e7c62eSMichael Tuexen 		cmh = (struct cmsghdr *)((caddr_t)cmh + CMSG_SPACE(sizeof(struct sctp_nxtinfo)));
262e2e7c62eSMichael Tuexen 		SCTP_BUF_LEN(ret) += CMSG_SPACE(sizeof(struct sctp_nxtinfo));
263e2e7c62eSMichael Tuexen 	}
264e2e7c62eSMichael Tuexen 	if (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_RECVDATAIOEVNT)) {
265e2e7c62eSMichael Tuexen 		cmh->cmsg_level = IPPROTO_SCTP;
266e2e7c62eSMichael Tuexen 		outinfo = (struct sctp_sndrcvinfo *)CMSG_DATA(cmh);
267e2e7c62eSMichael Tuexen 		if (use_extended) {
268e2e7c62eSMichael Tuexen 			cmh->cmsg_len = CMSG_LEN(sizeof(struct sctp_extrcvinfo));
269e2e7c62eSMichael Tuexen 			cmh->cmsg_type = SCTP_EXTRCV;
270e2e7c62eSMichael Tuexen 			memcpy(outinfo, sinfo, sizeof(struct sctp_extrcvinfo));
271e2e7c62eSMichael Tuexen 			SCTP_BUF_LEN(ret) += CMSG_SPACE(sizeof(struct sctp_extrcvinfo));
272e2e7c62eSMichael Tuexen 		} else {
273e2e7c62eSMichael Tuexen 			cmh->cmsg_len = CMSG_LEN(sizeof(struct sctp_sndrcvinfo));
274e2e7c62eSMichael Tuexen 			cmh->cmsg_type = SCTP_SNDRCV;
275e2e7c62eSMichael Tuexen 			*outinfo = *sinfo;
276e2e7c62eSMichael Tuexen 			SCTP_BUF_LEN(ret) += CMSG_SPACE(sizeof(struct sctp_sndrcvinfo));
277e2e7c62eSMichael Tuexen 		}
278e2e7c62eSMichael Tuexen 	}
279f8829a4aSRandall Stewart 	return (ret);
280f8829a4aSRandall Stewart }
281f8829a4aSRandall Stewart 
28277acdc25SRandall Stewart static void
28377acdc25SRandall Stewart sctp_mark_non_revokable(struct sctp_association *asoc, uint32_t tsn)
28477acdc25SRandall Stewart {
285d0ed75b3SMichael Tuexen 	uint32_t gap, i;
286d0ed75b3SMichael Tuexen 	int in_r, in_nr;
28777acdc25SRandall Stewart 
28877acdc25SRandall Stewart 	if (SCTP_BASE_SYSCTL(sctp_do_drain) == 0) {
28977acdc25SRandall Stewart 		return;
29077acdc25SRandall Stewart 	}
291d0ed75b3SMichael Tuexen 	if (SCTP_TSN_GE(asoc->cumulative_tsn, tsn)) {
2929b2e0767SRandall Stewart 		/*
293d0ed75b3SMichael Tuexen 		 * This tsn is behind the cum ack and thus we don't need to
2949b2e0767SRandall Stewart 		 * worry about it being moved from one to the other.
2959b2e0767SRandall Stewart 		 */
2969b2e0767SRandall Stewart 		return;
2979b2e0767SRandall Stewart 	}
29877acdc25SRandall Stewart 	SCTP_CALC_TSN_TO_GAP(gap, tsn, asoc->mapping_array_base_tsn);
29944249214SRandall Stewart 	in_r = SCTP_IS_TSN_PRESENT(asoc->mapping_array, gap);
30044249214SRandall Stewart 	in_nr = SCTP_IS_TSN_PRESENT(asoc->nr_mapping_array, gap);
3019f2d6263SMichael Tuexen 	KASSERT(in_r || in_nr, ("%s: Things are really messed up now", __func__));
302d0ed75b3SMichael Tuexen 	if (!in_nr) {
30377acdc25SRandall Stewart 		SCTP_SET_TSN_PRESENT(asoc->nr_mapping_array, gap);
30420b07a4dSMichael Tuexen 		if (SCTP_TSN_GT(tsn, asoc->highest_tsn_inside_nr_map)) {
30577acdc25SRandall Stewart 			asoc->highest_tsn_inside_nr_map = tsn;
30677acdc25SRandall Stewart 		}
307d0ed75b3SMichael Tuexen 	}
308d0ed75b3SMichael Tuexen 	if (in_r) {
309d0ed75b3SMichael Tuexen 		SCTP_UNSET_TSN_PRESENT(asoc->mapping_array, gap);
31077acdc25SRandall Stewart 		if (tsn == asoc->highest_tsn_inside_map) {
311d0ed75b3SMichael Tuexen 			/* We must back down to see what the new highest is. */
31220b07a4dSMichael Tuexen 			for (i = tsn - 1; SCTP_TSN_GE(i, asoc->mapping_array_base_tsn); i--) {
31377acdc25SRandall Stewart 				SCTP_CALC_TSN_TO_GAP(gap, i, asoc->mapping_array_base_tsn);
31477acdc25SRandall Stewart 				if (SCTP_IS_TSN_PRESENT(asoc->mapping_array, gap)) {
31577acdc25SRandall Stewart 					asoc->highest_tsn_inside_map = i;
31677acdc25SRandall Stewart 					break;
31777acdc25SRandall Stewart 				}
31877acdc25SRandall Stewart 			}
319d0ed75b3SMichael Tuexen 			if (!SCTP_TSN_GE(i, asoc->mapping_array_base_tsn)) {
32077acdc25SRandall Stewart 				asoc->highest_tsn_inside_map = asoc->mapping_array_base_tsn - 1;
32177acdc25SRandall Stewart 			}
32277acdc25SRandall Stewart 		}
32377acdc25SRandall Stewart 	}
324d0ed75b3SMichael Tuexen }
32577acdc25SRandall Stewart 
32644249214SRandall Stewart static int
32744249214SRandall Stewart sctp_place_control_in_stream(struct sctp_stream_in *strm,
32844249214SRandall Stewart     struct sctp_association *asoc,
32944249214SRandall Stewart     struct sctp_queued_to_read *control)
330f8829a4aSRandall Stewart {
33144249214SRandall Stewart 	struct sctp_queued_to_read *at;
33244249214SRandall Stewart 	struct sctp_readhead *q;
3338b9c95f4SMichael Tuexen 	uint8_t flags, unordered;
334f8829a4aSRandall Stewart 
3358b9c95f4SMichael Tuexen 	flags = (control->sinfo_flags >> 8);
3368b9c95f4SMichael Tuexen 	unordered = flags & SCTP_DATA_UNORDERED;
33744249214SRandall Stewart 	if (unordered) {
33844249214SRandall Stewart 		q = &strm->uno_inqueue;
33944249214SRandall Stewart 		if (asoc->idata_supported == 0) {
34044249214SRandall Stewart 			if (!TAILQ_EMPTY(q)) {
341b7b84c0eSMichael Tuexen 				/*
342b7b84c0eSMichael Tuexen 				 * Only one stream can be here in old style
343b7b84c0eSMichael Tuexen 				 * -- abort
344b7b84c0eSMichael Tuexen 				 */
34544249214SRandall Stewart 				return (-1);
34644249214SRandall Stewart 			}
34744249214SRandall Stewart 			TAILQ_INSERT_TAIL(q, control, next_instrm);
34844249214SRandall Stewart 			control->on_strm_q = SCTP_ON_UNORDERED;
34944249214SRandall Stewart 			return (0);
35044249214SRandall Stewart 		}
35144249214SRandall Stewart 	} else {
35244249214SRandall Stewart 		q = &strm->inqueue;
35344249214SRandall Stewart 	}
3548b9c95f4SMichael Tuexen 	if ((flags & SCTP_DATA_NOT_FRAG) == SCTP_DATA_NOT_FRAG) {
3558b9c95f4SMichael Tuexen 		control->end_added = 1;
3568b9c95f4SMichael Tuexen 		control->first_frag_seen = 1;
3578b9c95f4SMichael Tuexen 		control->last_frag_seen = 1;
35844249214SRandall Stewart 	}
35944249214SRandall Stewart 	if (TAILQ_EMPTY(q)) {
36044249214SRandall Stewart 		/* Empty queue */
36144249214SRandall Stewart 		TAILQ_INSERT_HEAD(q, control, next_instrm);
36244249214SRandall Stewart 		if (unordered) {
36344249214SRandall Stewart 			control->on_strm_q = SCTP_ON_UNORDERED;
36444249214SRandall Stewart 		} else {
36544249214SRandall Stewart 			control->on_strm_q = SCTP_ON_ORDERED;
36644249214SRandall Stewart 		}
36744249214SRandall Stewart 		return (0);
36844249214SRandall Stewart 	} else {
36944249214SRandall Stewart 		TAILQ_FOREACH(at, q, next_instrm) {
37049656eefSMichael Tuexen 			if (SCTP_MID_GT(asoc->idata_supported, at->mid, control->mid)) {
37144249214SRandall Stewart 				/*
37244249214SRandall Stewart 				 * one in queue is bigger than the new one,
37344249214SRandall Stewart 				 * insert before this one
37444249214SRandall Stewart 				 */
37544249214SRandall Stewart 				TAILQ_INSERT_BEFORE(at, control, next_instrm);
37644249214SRandall Stewart 				if (unordered) {
37744249214SRandall Stewart 					control->on_strm_q = SCTP_ON_UNORDERED;
37844249214SRandall Stewart 				} else {
37944249214SRandall Stewart 					control->on_strm_q = SCTP_ON_ORDERED;
38044249214SRandall Stewart 				}
38144249214SRandall Stewart 				break;
38249656eefSMichael Tuexen 			} else if (SCTP_MID_EQ(asoc->idata_supported, at->mid, control->mid)) {
38344249214SRandall Stewart 				/*
38444249214SRandall Stewart 				 * Gak, He sent me a duplicate msg id
38544249214SRandall Stewart 				 * number?? return -1 to abort.
38644249214SRandall Stewart 				 */
38744249214SRandall Stewart 				return (-1);
38844249214SRandall Stewart 			} else {
38944249214SRandall Stewart 				if (TAILQ_NEXT(at, next_instrm) == NULL) {
39044249214SRandall Stewart 					/*
39144249214SRandall Stewart 					 * We are at the end, insert it
39244249214SRandall Stewart 					 * after this one
39344249214SRandall Stewart 					 */
39444249214SRandall Stewart 					if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_STR_LOGGING_ENABLE) {
39544249214SRandall Stewart 						sctp_log_strm_del(control, at,
39644249214SRandall Stewart 						    SCTP_STR_LOG_FROM_INSERT_TL);
39744249214SRandall Stewart 					}
3988b9c95f4SMichael Tuexen 					TAILQ_INSERT_AFTER(q, at, control, next_instrm);
39944249214SRandall Stewart 					if (unordered) {
40044249214SRandall Stewart 						control->on_strm_q = SCTP_ON_UNORDERED;
40144249214SRandall Stewart 					} else {
40244249214SRandall Stewart 						control->on_strm_q = SCTP_ON_ORDERED;
40344249214SRandall Stewart 					}
40444249214SRandall Stewart 					break;
40544249214SRandall Stewart 				}
40644249214SRandall Stewart 			}
40744249214SRandall Stewart 		}
40844249214SRandall Stewart 	}
40944249214SRandall Stewart 	return (0);
41044249214SRandall Stewart }
41144249214SRandall Stewart 
41244249214SRandall Stewart static void
41344249214SRandall Stewart sctp_abort_in_reasm(struct sctp_tcb *stcb,
41444249214SRandall Stewart     struct sctp_queued_to_read *control,
41544249214SRandall Stewart     struct sctp_tmit_chunk *chk,
41644249214SRandall Stewart     int *abort_flag, int opspot)
41744249214SRandall Stewart {
41844249214SRandall Stewart 	char msg[SCTP_DIAG_INFO_LEN];
41944249214SRandall Stewart 	struct mbuf *oper;
42044249214SRandall Stewart 
42144249214SRandall Stewart 	if (stcb->asoc.idata_supported) {
422999f86d6SMichael Tuexen 		SCTP_SNPRINTF(msg, sizeof(msg),
42344249214SRandall Stewart 		    "Reass %x,CF:%x,TSN=%8.8x,SID=%4.4x,FSN=%8.8x,MID:%8.8x",
42444249214SRandall Stewart 		    opspot,
42544249214SRandall Stewart 		    control->fsn_included,
42649656eefSMichael Tuexen 		    chk->rec.data.tsn,
42749656eefSMichael Tuexen 		    chk->rec.data.sid,
428821bae7cSMichael Tuexen 		    chk->rec.data.fsn, chk->rec.data.mid);
42944249214SRandall Stewart 	} else {
430999f86d6SMichael Tuexen 		SCTP_SNPRINTF(msg, sizeof(msg),
43144249214SRandall Stewart 		    "Reass %x,CI:%x,TSN=%8.8x,SID=%4.4x,FSN=%4.4x,SSN:%4.4x",
43244249214SRandall Stewart 		    opspot,
43344249214SRandall Stewart 		    control->fsn_included,
43449656eefSMichael Tuexen 		    chk->rec.data.tsn,
43549656eefSMichael Tuexen 		    chk->rec.data.sid,
43649656eefSMichael Tuexen 		    chk->rec.data.fsn,
437821bae7cSMichael Tuexen 		    (uint16_t)chk->rec.data.mid);
43844249214SRandall Stewart 	}
43944249214SRandall Stewart 	oper = sctp_generate_cause(SCTP_CAUSE_PROTOCOL_VIOLATION, msg);
440f8829a4aSRandall Stewart 	sctp_m_freem(chk->data);
441f8829a4aSRandall Stewart 	chk->data = NULL;
442689e6a5fSMichael Tuexen 	sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
44344249214SRandall Stewart 	stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_1;
444105b68b4SMichael Tuexen 	sctp_abort_an_association(stcb->sctp_ep, stcb, oper, false, SCTP_SO_NOT_LOCKED);
44544249214SRandall Stewart 	*abort_flag = 1;
446f8829a4aSRandall Stewart }
447f8829a4aSRandall Stewart 
44844249214SRandall Stewart static void
449d1ea5fa9SMichael Tuexen sctp_clean_up_control(struct sctp_tcb *stcb, struct sctp_queued_to_read *control)
45044249214SRandall Stewart {
451f8829a4aSRandall Stewart 	/*
45244249214SRandall Stewart 	 * The control could not be placed and must be cleaned.
453f8829a4aSRandall Stewart 	 */
45444249214SRandall Stewart 	struct sctp_tmit_chunk *chk, *nchk;
455df6e0cc3SRandall Stewart 
45644249214SRandall Stewart 	TAILQ_FOREACH_SAFE(chk, &control->reasm, sctp_next, nchk) {
45744249214SRandall Stewart 		TAILQ_REMOVE(&control->reasm, chk, sctp_next);
45844249214SRandall Stewart 		if (chk->data)
45944249214SRandall Stewart 			sctp_m_freem(chk->data);
460f8829a4aSRandall Stewart 		chk->data = NULL;
461689e6a5fSMichael Tuexen 		sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
462f8829a4aSRandall Stewart 	}
4632b861c15SMichael Tuexen 	sctp_free_remote_addr(control->whoFrom);
4642b861c15SMichael Tuexen 	if (control->data) {
4652b861c15SMichael Tuexen 		sctp_m_freem(control->data);
4662b861c15SMichael Tuexen 		control->data = NULL;
4672b861c15SMichael Tuexen 	}
46844249214SRandall Stewart 	sctp_free_a_readq(stcb, control);
469f8829a4aSRandall Stewart }
470f8829a4aSRandall Stewart 
471f8829a4aSRandall Stewart /*
472f8829a4aSRandall Stewart  * Queue the chunk either right into the socket buffer if it is the next one
473f8829a4aSRandall Stewart  * to go OR put it in the correct place in the delivery queue.  If we do
47444249214SRandall Stewart  * append to the so_buf, keep doing so until we are out of order as
47544249214SRandall Stewart  * long as the control's entered are non-fragmented.
476f8829a4aSRandall Stewart  */
477f8829a4aSRandall Stewart static void
47844249214SRandall Stewart sctp_queue_data_to_stream(struct sctp_tcb *stcb,
47944249214SRandall Stewart     struct sctp_association *asoc,
48044249214SRandall Stewart     struct sctp_queued_to_read *control, int *abort_flag, int *need_reasm)
481f8829a4aSRandall Stewart {
482f8829a4aSRandall Stewart 	/*
483f8829a4aSRandall Stewart 	 * FIX-ME maybe? What happens when the ssn wraps? If we are getting
484f8829a4aSRandall Stewart 	 * all the data in one stream this could happen quite rapidly. One
485f8829a4aSRandall Stewart 	 * could use the TSN to keep track of things, but this scheme breaks
486cd0a4ff6SPedro F. Giffuni 	 * down in the other type of stream usage that could occur. Send a
487f8829a4aSRandall Stewart 	 * single msg to stream 0, send 4Billion messages to stream 1, now
488f8829a4aSRandall Stewart 	 * send a message to stream 0. You have a situation where the TSN
489f8829a4aSRandall Stewart 	 * has wrapped but not in the stream. Is this worth worrying about
490f8829a4aSRandall Stewart 	 * or should we just change our queue sort at the bottom to be by
491f8829a4aSRandall Stewart 	 * TSN.
492f8829a4aSRandall Stewart 	 *
4935b495f17SMichael Tuexen 	 * Could it also be legal for a peer to send ssn 1 with TSN 2 and
4945b495f17SMichael Tuexen 	 * ssn 2 with TSN 1? If the peer is doing some sort of funky TSN/SSN
495f8829a4aSRandall Stewart 	 * assignment this could happen... and I don't see how this would be
496f8829a4aSRandall Stewart 	 * a violation. So for now I am undecided an will leave the sort by
497e7e65008SMichael Tuexen 	 * SSN alone. Maybe a hybrid approach is the answer
498f8829a4aSRandall Stewart 	 *
499f8829a4aSRandall Stewart 	 */
500f8829a4aSRandall Stewart 	struct sctp_queued_to_read *at;
501f8829a4aSRandall Stewart 	int queue_needed;
50244249214SRandall Stewart 	uint32_t nxt_todel;
503ff1ffd74SMichael Tuexen 	struct mbuf *op_err;
5043d6fe5d8SMichael Tuexen 	struct sctp_stream_in *strm;
505ff1ffd74SMichael Tuexen 	char msg[SCTP_DIAG_INFO_LEN];
506f8829a4aSRandall Stewart 
5073d6fe5d8SMichael Tuexen 	strm = &asoc->strmin[control->sinfo_stream];
508b3f1ea41SRandall Stewart 	if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_STR_LOGGING_ENABLE) {
509f8829a4aSRandall Stewart 		sctp_log_strm_del(control, NULL, SCTP_STR_LOG_FROM_INTO_STRD);
51080fefe0aSRandall Stewart 	}
51149656eefSMichael Tuexen 	if (SCTP_MID_GT((asoc->idata_supported), strm->last_mid_delivered, control->mid)) {
512f8829a4aSRandall Stewart 		/* The incoming sseq is behind where we last delivered? */
513f2ea2a2dSMichael Tuexen 		SCTPDBG(SCTP_DEBUG_INDATA1, "Duplicate S-SEQ: %u delivered: %u from peer, Abort association\n",
5143d6fe5d8SMichael Tuexen 		    strm->last_mid_delivered, control->mid);
515f8829a4aSRandall Stewart 		/*
516f8829a4aSRandall Stewart 		 * throw it in the stream so it gets cleaned up in
517f8829a4aSRandall Stewart 		 * association destruction
518f8829a4aSRandall Stewart 		 */
51944249214SRandall Stewart 		TAILQ_INSERT_HEAD(&strm->inqueue, control, next_instrm);
52049656eefSMichael Tuexen 		if (asoc->idata_supported) {
521999f86d6SMichael Tuexen 			SCTP_SNPRINTF(msg, sizeof(msg), "Delivered MID=%8.8x, got TSN=%8.8x, SID=%4.4x, MID=%8.8x",
52249656eefSMichael Tuexen 			    strm->last_mid_delivered, control->sinfo_tsn,
523821bae7cSMichael Tuexen 			    control->sinfo_stream, control->mid);
52449656eefSMichael Tuexen 		} else {
525999f86d6SMichael Tuexen 			SCTP_SNPRINTF(msg, sizeof(msg), "Delivered SSN=%4.4x, got TSN=%8.8x, SID=%4.4x, SSN=%4.4x",
52649656eefSMichael Tuexen 			    (uint16_t)strm->last_mid_delivered,
52749656eefSMichael Tuexen 			    control->sinfo_tsn,
52849656eefSMichael Tuexen 			    control->sinfo_stream,
529821bae7cSMichael Tuexen 			    (uint16_t)control->mid);
53049656eefSMichael Tuexen 		}
531ff1ffd74SMichael Tuexen 		op_err = sctp_generate_cause(SCTP_CAUSE_PROTOCOL_VIOLATION, msg);
53244249214SRandall Stewart 		stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_2;
533105b68b4SMichael Tuexen 		sctp_abort_an_association(stcb->sctp_ep, stcb, op_err, false, SCTP_SO_NOT_LOCKED);
534f8829a4aSRandall Stewart 		*abort_flag = 1;
535f8829a4aSRandall Stewart 		return;
536f8829a4aSRandall Stewart 	}
53744249214SRandall Stewart 	queue_needed = 1;
53844249214SRandall Stewart 	asoc->size_on_all_streams += control->length;
53944249214SRandall Stewart 	sctp_ucount_incr(asoc->cnt_on_all_streams);
54049656eefSMichael Tuexen 	nxt_todel = strm->last_mid_delivered + 1;
54149656eefSMichael Tuexen 	if (SCTP_MID_EQ(asoc->idata_supported, nxt_todel, control->mid)) {
542f8829a4aSRandall Stewart 		/* can be delivered right away? */
543b3f1ea41SRandall Stewart 		if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_STR_LOGGING_ENABLE) {
544f8829a4aSRandall Stewart 			sctp_log_strm_del(control, NULL, SCTP_STR_LOG_FROM_IMMED_DEL);
54580fefe0aSRandall Stewart 		}
546830d754dSRandall Stewart 		/* EY it wont be queued if it could be delivered directly */
547f8829a4aSRandall Stewart 		queue_needed = 0;
54828cd0699SMichael Tuexen 		if (asoc->size_on_all_streams >= control->length) {
549f8829a4aSRandall Stewart 			asoc->size_on_all_streams -= control->length;
55028cd0699SMichael Tuexen 		} else {
55128cd0699SMichael Tuexen #ifdef INVARIANTS
55228cd0699SMichael Tuexen 			panic("size_on_all_streams = %u smaller than control length %u", asoc->size_on_all_streams, control->length);
55328cd0699SMichael Tuexen #else
55428cd0699SMichael Tuexen 			asoc->size_on_all_streams = 0;
55528cd0699SMichael Tuexen #endif
55628cd0699SMichael Tuexen 		}
557f8829a4aSRandall Stewart 		sctp_ucount_decr(asoc->cnt_on_all_streams);
55849656eefSMichael Tuexen 		strm->last_mid_delivered++;
559b5c16493SMichael Tuexen 		sctp_mark_non_revokable(asoc, control->sinfo_tsn);
560f8829a4aSRandall Stewart 		sctp_add_to_readq(stcb->sctp_ep, stcb,
561f8829a4aSRandall Stewart 		    control,
562cfde3ff7SRandall Stewart 		    &stcb->sctp_socket->so_rcv, 1,
563574679afSMichael Tuexen 		    SCTP_READ_LOCK_NOT_HELD, SCTP_SO_LOCKED);
56444249214SRandall Stewart 		TAILQ_FOREACH_SAFE(control, &strm->inqueue, next_instrm, at) {
565f8829a4aSRandall Stewart 			/* all delivered */
56649656eefSMichael Tuexen 			nxt_todel = strm->last_mid_delivered + 1;
56749656eefSMichael Tuexen 			if (SCTP_MID_EQ(asoc->idata_supported, nxt_todel, control->mid) &&
56844249214SRandall Stewart 			    (((control->sinfo_flags >> 8) & SCTP_DATA_NOT_FRAG) == SCTP_DATA_NOT_FRAG)) {
56944249214SRandall Stewart 				if (control->on_strm_q == SCTP_ON_ORDERED) {
57044249214SRandall Stewart 					TAILQ_REMOVE(&strm->inqueue, control, next_instrm);
57128cd0699SMichael Tuexen 					if (asoc->size_on_all_streams >= control->length) {
57228cd0699SMichael Tuexen 						asoc->size_on_all_streams -= control->length;
57328cd0699SMichael Tuexen 					} else {
57428cd0699SMichael Tuexen #ifdef INVARIANTS
57528cd0699SMichael Tuexen 						panic("size_on_all_streams = %u smaller than control length %u", asoc->size_on_all_streams, control->length);
57628cd0699SMichael Tuexen #else
57728cd0699SMichael Tuexen 						asoc->size_on_all_streams = 0;
57828cd0699SMichael Tuexen #endif
57928cd0699SMichael Tuexen 					}
58028cd0699SMichael Tuexen 					sctp_ucount_decr(asoc->cnt_on_all_streams);
58198d5fd97SMichael Tuexen #ifdef INVARIANTS
58244249214SRandall Stewart 				} else {
58344249214SRandall Stewart 					panic("Huh control: %p is on_strm_q: %d",
58444249214SRandall Stewart 					    control, control->on_strm_q);
58598d5fd97SMichael Tuexen #endif
58644249214SRandall Stewart 				}
58744249214SRandall Stewart 				control->on_strm_q = 0;
58849656eefSMichael Tuexen 				strm->last_mid_delivered++;
589f8829a4aSRandall Stewart 				/*
590f8829a4aSRandall Stewart 				 * We ignore the return of deliver_data here
591f8829a4aSRandall Stewart 				 * since we always can hold the chunk on the
592f8829a4aSRandall Stewart 				 * d-queue. And we have a finite number that
593f8829a4aSRandall Stewart 				 * can be delivered from the strq.
594f8829a4aSRandall Stewart 				 */
595b3f1ea41SRandall Stewart 				if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_STR_LOGGING_ENABLE) {
596f8829a4aSRandall Stewart 					sctp_log_strm_del(control, NULL,
597f8829a4aSRandall Stewart 					    SCTP_STR_LOG_FROM_IMMED_DEL);
59880fefe0aSRandall Stewart 				}
599b5c16493SMichael Tuexen 				sctp_mark_non_revokable(asoc, control->sinfo_tsn);
600f8829a4aSRandall Stewart 				sctp_add_to_readq(stcb->sctp_ep, stcb,
601f8829a4aSRandall Stewart 				    control,
602cfde3ff7SRandall Stewart 				    &stcb->sctp_socket->so_rcv, 1,
603cfde3ff7SRandall Stewart 				    SCTP_READ_LOCK_NOT_HELD,
604574679afSMichael Tuexen 				    SCTP_SO_LOCKED);
605f8829a4aSRandall Stewart 				continue;
60649656eefSMichael Tuexen 			} else if (SCTP_MID_EQ(asoc->idata_supported, nxt_todel, control->mid)) {
60744249214SRandall Stewart 				*need_reasm = 1;
608f8829a4aSRandall Stewart 			}
609f8829a4aSRandall Stewart 			break;
610f8829a4aSRandall Stewart 		}
611f8829a4aSRandall Stewart 	}
612f8829a4aSRandall Stewart 	if (queue_needed) {
613f8829a4aSRandall Stewart 		/*
614f8829a4aSRandall Stewart 		 * Ok, we did not deliver this guy, find the correct place
615f8829a4aSRandall Stewart 		 * to put it on the queue.
616f8829a4aSRandall Stewart 		 */
61744249214SRandall Stewart 		if (sctp_place_control_in_stream(strm, asoc, control)) {
618999f86d6SMichael Tuexen 			SCTP_SNPRINTF(msg, sizeof(msg),
619999f86d6SMichael Tuexen 			    "Queue to str MID: %u duplicate", control->mid);
620d1ea5fa9SMichael Tuexen 			sctp_clean_up_control(stcb, control);
621b1deed45SMichael Tuexen 			op_err = sctp_generate_cause(SCTP_CAUSE_PROTOCOL_VIOLATION, msg);
62244249214SRandall Stewart 			stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_3;
623105b68b4SMichael Tuexen 			sctp_abort_an_association(stcb->sctp_ep, stcb, op_err, false, SCTP_SO_NOT_LOCKED);
62444249214SRandall Stewart 			*abort_flag = 1;
625f8829a4aSRandall Stewart 		}
626f8829a4aSRandall Stewart 	}
627f8829a4aSRandall Stewart }
628f8829a4aSRandall Stewart 
62944249214SRandall Stewart static void
63044249214SRandall Stewart sctp_setup_tail_pointer(struct sctp_queued_to_read *control)
631f8829a4aSRandall Stewart {
63244249214SRandall Stewart 	struct mbuf *m, *prev = NULL;
63344249214SRandall Stewart 	struct sctp_tcb *stcb;
634f8829a4aSRandall Stewart 
63544249214SRandall Stewart 	stcb = control->stcb;
63644249214SRandall Stewart 	control->held_length = 0;
63744249214SRandall Stewart 	control->length = 0;
63844249214SRandall Stewart 	m = control->data;
63944249214SRandall Stewart 	while (m) {
64044249214SRandall Stewart 		if (SCTP_BUF_LEN(m) == 0) {
64144249214SRandall Stewart 			/* Skip mbufs with NO length */
64244249214SRandall Stewart 			if (prev == NULL) {
64344249214SRandall Stewart 				/* First one */
64444249214SRandall Stewart 				control->data = sctp_m_free(m);
64544249214SRandall Stewart 				m = control->data;
64644249214SRandall Stewart 			} else {
64744249214SRandall Stewart 				SCTP_BUF_NEXT(prev) = sctp_m_free(m);
64844249214SRandall Stewart 				m = SCTP_BUF_NEXT(prev);
649f8829a4aSRandall Stewart 			}
65044249214SRandall Stewart 			if (m == NULL) {
65144249214SRandall Stewart 				control->tail_mbuf = prev;
652f8829a4aSRandall Stewart 			}
65344249214SRandall Stewart 			continue;
654f8829a4aSRandall Stewart 		}
65544249214SRandall Stewart 		prev = m;
65644249214SRandall Stewart 		atomic_add_int(&control->length, SCTP_BUF_LEN(m));
65744249214SRandall Stewart 		if (control->on_read_q) {
65844249214SRandall Stewart 			/*
65944249214SRandall Stewart 			 * On read queue so we must increment the SB stuff,
66044249214SRandall Stewart 			 * we assume caller has done any locks of SB.
66144249214SRandall Stewart 			 */
66244249214SRandall Stewart 			sctp_sballoc(stcb, &stcb->sctp_socket->so_rcv, m);
663f8829a4aSRandall Stewart 		}
66444249214SRandall Stewart 		m = SCTP_BUF_NEXT(m);
665f8829a4aSRandall Stewart 	}
66644249214SRandall Stewart 	if (prev) {
66744249214SRandall Stewart 		control->tail_mbuf = prev;
66844249214SRandall Stewart 	}
669f8829a4aSRandall Stewart }
670f8829a4aSRandall Stewart 
671f8829a4aSRandall Stewart static void
67228cd0699SMichael Tuexen sctp_add_to_tail_pointer(struct sctp_queued_to_read *control, struct mbuf *m, uint32_t *added)
673f8829a4aSRandall Stewart {
67444249214SRandall Stewart 	struct mbuf *prev = NULL;
67544249214SRandall Stewart 	struct sctp_tcb *stcb;
676f8829a4aSRandall Stewart 
67744249214SRandall Stewart 	stcb = control->stcb;
67844249214SRandall Stewart 	if (stcb == NULL) {
67998d5fd97SMichael Tuexen #ifdef INVARIANTS
68044249214SRandall Stewart 		panic("Control broken");
68198d5fd97SMichael Tuexen #else
68298d5fd97SMichael Tuexen 		return;
68398d5fd97SMichael Tuexen #endif
68444249214SRandall Stewart 	}
68544249214SRandall Stewart 	if (control->tail_mbuf == NULL) {
68644249214SRandall Stewart 		/* TSNH */
68763fb39baSMichael Tuexen 		sctp_m_freem(control->data);
68844249214SRandall Stewart 		control->data = m;
68944249214SRandall Stewart 		sctp_setup_tail_pointer(control);
690f8829a4aSRandall Stewart 		return;
691f8829a4aSRandall Stewart 	}
69244249214SRandall Stewart 	control->tail_mbuf->m_next = m;
69344249214SRandall Stewart 	while (m) {
69444249214SRandall Stewart 		if (SCTP_BUF_LEN(m) == 0) {
69544249214SRandall Stewart 			/* Skip mbufs with NO length */
69644249214SRandall Stewart 			if (prev == NULL) {
69744249214SRandall Stewart 				/* First one */
69844249214SRandall Stewart 				control->tail_mbuf->m_next = sctp_m_free(m);
69944249214SRandall Stewart 				m = control->tail_mbuf->m_next;
70044249214SRandall Stewart 			} else {
70144249214SRandall Stewart 				SCTP_BUF_NEXT(prev) = sctp_m_free(m);
70244249214SRandall Stewart 				m = SCTP_BUF_NEXT(prev);
70344249214SRandall Stewart 			}
70444249214SRandall Stewart 			if (m == NULL) {
70544249214SRandall Stewart 				control->tail_mbuf = prev;
70644249214SRandall Stewart 			}
70744249214SRandall Stewart 			continue;
70844249214SRandall Stewart 		}
70944249214SRandall Stewart 		prev = m;
71044249214SRandall Stewart 		if (control->on_read_q) {
711f8829a4aSRandall Stewart 			/*
71244249214SRandall Stewart 			 * On read queue so we must increment the SB stuff,
71344249214SRandall Stewart 			 * we assume caller has done any locks of SB.
714f8829a4aSRandall Stewart 			 */
71544249214SRandall Stewart 			sctp_sballoc(stcb, &stcb->sctp_socket->so_rcv, m);
71644249214SRandall Stewart 		}
71728cd0699SMichael Tuexen 		*added += SCTP_BUF_LEN(m);
71844249214SRandall Stewart 		atomic_add_int(&control->length, SCTP_BUF_LEN(m));
71944249214SRandall Stewart 		m = SCTP_BUF_NEXT(m);
72044249214SRandall Stewart 	}
72144249214SRandall Stewart 	if (prev) {
72244249214SRandall Stewart 		control->tail_mbuf = prev;
72344249214SRandall Stewart 	}
72444249214SRandall Stewart }
72544249214SRandall Stewart 
72644249214SRandall Stewart static void
72744249214SRandall Stewart sctp_build_readq_entry_from_ctl(struct sctp_queued_to_read *nc, struct sctp_queued_to_read *control)
72844249214SRandall Stewart {
72944249214SRandall Stewart 	memset(nc, 0, sizeof(struct sctp_queued_to_read));
73044249214SRandall Stewart 	nc->sinfo_stream = control->sinfo_stream;
73149656eefSMichael Tuexen 	nc->mid = control->mid;
73244249214SRandall Stewart 	TAILQ_INIT(&nc->reasm);
73344249214SRandall Stewart 	nc->top_fsn = control->top_fsn;
73449656eefSMichael Tuexen 	nc->mid = control->mid;
73544249214SRandall Stewart 	nc->sinfo_flags = control->sinfo_flags;
73644249214SRandall Stewart 	nc->sinfo_ppid = control->sinfo_ppid;
73744249214SRandall Stewart 	nc->sinfo_context = control->sinfo_context;
73844249214SRandall Stewart 	nc->fsn_included = 0xffffffff;
73944249214SRandall Stewart 	nc->sinfo_tsn = control->sinfo_tsn;
74044249214SRandall Stewart 	nc->sinfo_cumtsn = control->sinfo_cumtsn;
74144249214SRandall Stewart 	nc->sinfo_assoc_id = control->sinfo_assoc_id;
74244249214SRandall Stewart 	nc->whoFrom = control->whoFrom;
74344249214SRandall Stewart 	atomic_add_int(&nc->whoFrom->ref_count, 1);
74444249214SRandall Stewart 	nc->stcb = control->stcb;
74544249214SRandall Stewart 	nc->port_from = control->port_from;
746daf14341SMichael Tuexen 	nc->do_not_ref_stcb = control->do_not_ref_stcb;
74744249214SRandall Stewart }
74844249214SRandall Stewart 
749d1ea5fa9SMichael Tuexen static void
750d1ea5fa9SMichael Tuexen sctp_reset_a_control(struct sctp_queued_to_read *control,
751d1ea5fa9SMichael Tuexen     struct sctp_inpcb *inp, uint32_t tsn)
752d1ea5fa9SMichael Tuexen {
753d1ea5fa9SMichael Tuexen 	control->fsn_included = tsn;
754d1ea5fa9SMichael Tuexen 	if (control->on_read_q) {
755d1ea5fa9SMichael Tuexen 		/*
756d1ea5fa9SMichael Tuexen 		 * We have to purge it from there, hopefully this will work
757d1ea5fa9SMichael Tuexen 		 * :-)
758d1ea5fa9SMichael Tuexen 		 */
759d1ea5fa9SMichael Tuexen 		TAILQ_REMOVE(&inp->read_queue, control, next);
760d1ea5fa9SMichael Tuexen 		control->on_read_q = 0;
761d1ea5fa9SMichael Tuexen 	}
762d1ea5fa9SMichael Tuexen }
763d1ea5fa9SMichael Tuexen 
76444249214SRandall Stewart static int
765d1ea5fa9SMichael Tuexen sctp_handle_old_unordered_data(struct sctp_tcb *stcb,
766d1ea5fa9SMichael Tuexen     struct sctp_association *asoc,
767d1ea5fa9SMichael Tuexen     struct sctp_stream_in *strm,
768d1ea5fa9SMichael Tuexen     struct sctp_queued_to_read *control,
769d1ea5fa9SMichael Tuexen     uint32_t pd_point,
770d1ea5fa9SMichael Tuexen     int inp_read_lock_held)
77144249214SRandall Stewart {
77244249214SRandall Stewart 	/*
77344249214SRandall Stewart 	 * Special handling for the old un-ordered data chunk. All the
77449656eefSMichael Tuexen 	 * chunks/TSN's go to mid 0. So we have to do the old style watching
77549656eefSMichael Tuexen 	 * to see if we have it all. If you return one, no other control
77649656eefSMichael Tuexen 	 * entries on the un-ordered queue will be looked at. In theory
77749656eefSMichael Tuexen 	 * there should be no others entries in reality, unless the guy is
77849656eefSMichael Tuexen 	 * sending both unordered NDATA and unordered DATA...
77944249214SRandall Stewart 	 */
78044249214SRandall Stewart 	struct sctp_tmit_chunk *chk, *lchk, *tchk;
78144249214SRandall Stewart 	uint32_t fsn;
782643fd575SMichael Tuexen 	struct sctp_queued_to_read *nc;
78344249214SRandall Stewart 	int cnt_added;
78444249214SRandall Stewart 
78544249214SRandall Stewart 	if (control->first_frag_seen == 0) {
78644249214SRandall Stewart 		/* Nothing we can do, we have not seen the first piece yet */
78744249214SRandall Stewart 		return (1);
78844249214SRandall Stewart 	}
78944249214SRandall Stewart 	/* Collapse any we can */
79044249214SRandall Stewart 	cnt_added = 0;
79144249214SRandall Stewart restart:
79244249214SRandall Stewart 	fsn = control->fsn_included + 1;
79344249214SRandall Stewart 	/* Now what can we add? */
79444249214SRandall Stewart 	TAILQ_FOREACH_SAFE(chk, &control->reasm, sctp_next, lchk) {
79549656eefSMichael Tuexen 		if (chk->rec.data.fsn == fsn) {
79644249214SRandall Stewart 			/* Ok lets add it */
797643fd575SMichael Tuexen 			sctp_alloc_a_readq(stcb, nc);
798643fd575SMichael Tuexen 			if (nc == NULL) {
799643fd575SMichael Tuexen 				break;
800643fd575SMichael Tuexen 			}
801643fd575SMichael Tuexen 			memset(nc, 0, sizeof(struct sctp_queued_to_read));
80244249214SRandall Stewart 			TAILQ_REMOVE(&control->reasm, chk, sctp_next);
8038dc6a1edSMichael Tuexen 			sctp_add_chk_to_control(control, strm, stcb, asoc, chk, inp_read_lock_held);
80444249214SRandall Stewart 			fsn++;
80544249214SRandall Stewart 			cnt_added++;
80644249214SRandall Stewart 			chk = NULL;
80744249214SRandall Stewart 			if (control->end_added) {
80844249214SRandall Stewart 				/* We are done */
80944249214SRandall Stewart 				if (!TAILQ_EMPTY(&control->reasm)) {
81044249214SRandall Stewart 					/*
81144249214SRandall Stewart 					 * Ok we have to move anything left
81244249214SRandall Stewart 					 * on the control queue to a new
81344249214SRandall Stewart 					 * control.
81444249214SRandall Stewart 					 */
81544249214SRandall Stewart 					sctp_build_readq_entry_from_ctl(nc, control);
81644249214SRandall Stewart 					tchk = TAILQ_FIRST(&control->reasm);
81744249214SRandall Stewart 					if (tchk->rec.data.rcv_flags & SCTP_DATA_FIRST_FRAG) {
81844249214SRandall Stewart 						TAILQ_REMOVE(&control->reasm, tchk, sctp_next);
81928cd0699SMichael Tuexen 						if (asoc->size_on_reasm_queue >= tchk->send_size) {
8205cb91655SMichael Tuexen 							asoc->size_on_reasm_queue -= tchk->send_size;
82128cd0699SMichael Tuexen 						} else {
82228cd0699SMichael Tuexen #ifdef INVARIANTS
82328cd0699SMichael Tuexen 							panic("size_on_reasm_queue = %u smaller than chunk length %u", asoc->size_on_reasm_queue, tchk->send_size);
82428cd0699SMichael Tuexen #else
82528cd0699SMichael Tuexen 							asoc->size_on_reasm_queue = 0;
82628cd0699SMichael Tuexen #endif
82728cd0699SMichael Tuexen 						}
8285cb91655SMichael Tuexen 						sctp_ucount_decr(asoc->cnt_on_reasm_queue);
82944249214SRandall Stewart 						nc->first_frag_seen = 1;
83049656eefSMichael Tuexen 						nc->fsn_included = tchk->rec.data.fsn;
83144249214SRandall Stewart 						nc->data = tchk->data;
83249656eefSMichael Tuexen 						nc->sinfo_ppid = tchk->rec.data.ppid;
83349656eefSMichael Tuexen 						nc->sinfo_tsn = tchk->rec.data.tsn;
83449656eefSMichael Tuexen 						sctp_mark_non_revokable(asoc, tchk->rec.data.tsn);
83544249214SRandall Stewart 						tchk->data = NULL;
83644249214SRandall Stewart 						sctp_free_a_chunk(stcb, tchk, SCTP_SO_NOT_LOCKED);
83744249214SRandall Stewart 						sctp_setup_tail_pointer(nc);
83844249214SRandall Stewart 						tchk = TAILQ_FIRST(&control->reasm);
83944249214SRandall Stewart 					}
84044249214SRandall Stewart 					/* Spin the rest onto the queue */
84144249214SRandall Stewart 					while (tchk) {
84244249214SRandall Stewart 						TAILQ_REMOVE(&control->reasm, tchk, sctp_next);
84344249214SRandall Stewart 						TAILQ_INSERT_TAIL(&nc->reasm, tchk, sctp_next);
84444249214SRandall Stewart 						tchk = TAILQ_FIRST(&control->reasm);
84544249214SRandall Stewart 					}
846b7b84c0eSMichael Tuexen 					/*
847b7b84c0eSMichael Tuexen 					 * Now lets add it to the queue
848b7b84c0eSMichael Tuexen 					 * after removing control
849b7b84c0eSMichael Tuexen 					 */
85044249214SRandall Stewart 					TAILQ_INSERT_TAIL(&strm->uno_inqueue, nc, next_instrm);
85144249214SRandall Stewart 					nc->on_strm_q = SCTP_ON_UNORDERED;
85244249214SRandall Stewart 					if (control->on_strm_q) {
85344249214SRandall Stewart 						TAILQ_REMOVE(&strm->uno_inqueue, control, next_instrm);
85444249214SRandall Stewart 						control->on_strm_q = 0;
85544249214SRandall Stewart 					}
85644249214SRandall Stewart 				}
85744249214SRandall Stewart 				if (control->pdapi_started) {
85844249214SRandall Stewart 					strm->pd_api_started = 0;
85944249214SRandall Stewart 					control->pdapi_started = 0;
86044249214SRandall Stewart 				}
86144249214SRandall Stewart 				if (control->on_strm_q) {
86244249214SRandall Stewart 					TAILQ_REMOVE(&strm->uno_inqueue, control, next_instrm);
86344249214SRandall Stewart 					control->on_strm_q = 0;
86426f0250aSMichael Tuexen 					SCTP_STAT_INCR_COUNTER64(sctps_reasmusrmsgs);
86544249214SRandall Stewart 				}
866c09a1534SMichael Tuexen 				if (control->on_read_q == 0) {
867c09a1534SMichael Tuexen 					sctp_add_to_readq(stcb->sctp_ep, stcb, control,
868c09a1534SMichael Tuexen 					    &stcb->sctp_socket->so_rcv, control->end_added,
869d1ea5fa9SMichael Tuexen 					    inp_read_lock_held, SCTP_SO_NOT_LOCKED);
870c09a1534SMichael Tuexen 				}
871b1deed45SMichael Tuexen 				sctp_wakeup_the_read_socket(stcb->sctp_ep, stcb, SCTP_SO_NOT_LOCKED);
8720fa7377aSMichael Tuexen 				if ((nc->first_frag_seen) && !TAILQ_EMPTY(&nc->reasm)) {
873b7b84c0eSMichael Tuexen 					/*
874b7b84c0eSMichael Tuexen 					 * Switch to the new guy and
875b7b84c0eSMichael Tuexen 					 * continue
876b7b84c0eSMichael Tuexen 					 */
87744249214SRandall Stewart 					control = nc;
87844249214SRandall Stewart 					goto restart;
879643fd575SMichael Tuexen 				} else {
880d1ea5fa9SMichael Tuexen 					if (nc->on_strm_q == 0) {
881643fd575SMichael Tuexen 						sctp_free_a_readq(stcb, nc);
88244249214SRandall Stewart 					}
883d1ea5fa9SMichael Tuexen 				}
88444249214SRandall Stewart 				return (1);
885643fd575SMichael Tuexen 			} else {
886643fd575SMichael Tuexen 				sctp_free_a_readq(stcb, nc);
88744249214SRandall Stewart 			}
88844249214SRandall Stewart 		} else {
88944249214SRandall Stewart 			/* Can't add more */
89044249214SRandall Stewart 			break;
89144249214SRandall Stewart 		}
89244249214SRandall Stewart 	}
893f1903dc0SMichael Tuexen 	if (cnt_added && strm->pd_api_started) {
894f1903dc0SMichael Tuexen 		sctp_wakeup_the_read_socket(stcb->sctp_ep, stcb, SCTP_SO_NOT_LOCKED);
895f1903dc0SMichael Tuexen 	}
89644249214SRandall Stewart 	if ((control->length > pd_point) && (strm->pd_api_started == 0)) {
897c09a1534SMichael Tuexen 		strm->pd_api_started = 1;
898c09a1534SMichael Tuexen 		control->pdapi_started = 1;
89944249214SRandall Stewart 		sctp_add_to_readq(stcb->sctp_ep, stcb, control,
90044249214SRandall Stewart 		    &stcb->sctp_socket->so_rcv, control->end_added,
901d1ea5fa9SMichael Tuexen 		    inp_read_lock_held, SCTP_SO_NOT_LOCKED);
902b1deed45SMichael Tuexen 		sctp_wakeup_the_read_socket(stcb->sctp_ep, stcb, SCTP_SO_NOT_LOCKED);
90344249214SRandall Stewart 		return (0);
90444249214SRandall Stewart 	} else {
90544249214SRandall Stewart 		return (1);
90644249214SRandall Stewart 	}
90744249214SRandall Stewart }
90844249214SRandall Stewart 
90944249214SRandall Stewart static void
910d1ea5fa9SMichael Tuexen sctp_inject_old_unordered_data(struct sctp_tcb *stcb,
911d1ea5fa9SMichael Tuexen     struct sctp_association *asoc,
91244249214SRandall Stewart     struct sctp_queued_to_read *control,
91344249214SRandall Stewart     struct sctp_tmit_chunk *chk,
91444249214SRandall Stewart     int *abort_flag)
91544249214SRandall Stewart {
91644249214SRandall Stewart 	struct sctp_tmit_chunk *at;
917d1ea5fa9SMichael Tuexen 	int inserted;
91844249214SRandall Stewart 
91944249214SRandall Stewart 	/*
92044249214SRandall Stewart 	 * Here we need to place the chunk into the control structure sorted
92144249214SRandall Stewart 	 * in the correct order.
92244249214SRandall Stewart 	 */
92344249214SRandall Stewart 	if (chk->rec.data.rcv_flags & SCTP_DATA_FIRST_FRAG) {
92444249214SRandall Stewart 		/* Its the very first one. */
92544249214SRandall Stewart 		SCTPDBG(SCTP_DEBUG_XXX,
926f2ea2a2dSMichael Tuexen 		    "chunk is a first fsn: %u becomes fsn_included\n",
92749656eefSMichael Tuexen 		    chk->rec.data.fsn);
9282de5b904SMichael Tuexen 		at = TAILQ_FIRST(&control->reasm);
9292de5b904SMichael Tuexen 		if (at && SCTP_TSN_GT(chk->rec.data.fsn, at->rec.data.fsn)) {
9302de5b904SMichael Tuexen 			/*
9312de5b904SMichael Tuexen 			 * The first chunk in the reassembly is a smaller
9322de5b904SMichael Tuexen 			 * TSN than this one, even though this has a first,
9332de5b904SMichael Tuexen 			 * it must be from a subsequent msg.
9342de5b904SMichael Tuexen 			 */
9352de5b904SMichael Tuexen 			goto place_chunk;
9362de5b904SMichael Tuexen 		}
93744249214SRandall Stewart 		if (control->first_frag_seen) {
93844249214SRandall Stewart 			/*
93944249214SRandall Stewart 			 * In old un-ordered we can reassembly on one
94044249214SRandall Stewart 			 * control multiple messages. As long as the next
94144249214SRandall Stewart 			 * FIRST is greater then the old first (TSN i.e. FSN
94244249214SRandall Stewart 			 * wise)
94344249214SRandall Stewart 			 */
94444249214SRandall Stewart 			struct mbuf *tdata;
94544249214SRandall Stewart 			uint32_t tmp;
94644249214SRandall Stewart 
94749656eefSMichael Tuexen 			if (SCTP_TSN_GT(chk->rec.data.fsn, control->fsn_included)) {
948b7b84c0eSMichael Tuexen 				/*
949b7b84c0eSMichael Tuexen 				 * Easy way the start of a new guy beyond
950b7b84c0eSMichael Tuexen 				 * the lowest
951b7b84c0eSMichael Tuexen 				 */
95244249214SRandall Stewart 				goto place_chunk;
95344249214SRandall Stewart 			}
95449656eefSMichael Tuexen 			if ((chk->rec.data.fsn == control->fsn_included) ||
95544249214SRandall Stewart 			    (control->pdapi_started)) {
95644249214SRandall Stewart 				/*
95744249214SRandall Stewart 				 * Ok this should not happen, if it does we
95844249214SRandall Stewart 				 * started the pd-api on the higher TSN
95944249214SRandall Stewart 				 * (since the equals part is a TSN failure
96044249214SRandall Stewart 				 * it must be that).
96144249214SRandall Stewart 				 *
962e7e65008SMichael Tuexen 				 * We are completely hosed in that case
963e7e65008SMichael Tuexen 				 * since I have no way to recover. This
964e7e65008SMichael Tuexen 				 * really will only happen if we can get
965e7e65008SMichael Tuexen 				 * more TSN's higher before the
966e7e65008SMichael Tuexen 				 * pd-api-point.
96744249214SRandall Stewart 				 */
968b1deed45SMichael Tuexen 				sctp_abort_in_reasm(stcb, control, chk,
96944249214SRandall Stewart 				    abort_flag,
97044249214SRandall Stewart 				    SCTP_FROM_SCTP_INDATA + SCTP_LOC_4);
97144249214SRandall Stewart 
97244249214SRandall Stewart 				return;
97344249214SRandall Stewart 			}
97444249214SRandall Stewart 			/*
97544249214SRandall Stewart 			 * Ok we have two firsts and the one we just got is
97644249214SRandall Stewart 			 * smaller than the one we previously placed.. yuck!
97744249214SRandall Stewart 			 * We must swap them out.
97844249214SRandall Stewart 			 */
97944249214SRandall Stewart 			/* swap the mbufs */
98044249214SRandall Stewart 			tdata = control->data;
98144249214SRandall Stewart 			control->data = chk->data;
98244249214SRandall Stewart 			chk->data = tdata;
983d1ea5fa9SMichael Tuexen 			/* Save the lengths */
984d1ea5fa9SMichael Tuexen 			chk->send_size = control->length;
985d1ea5fa9SMichael Tuexen 			/* Recompute length of control and tail pointer */
986d1ea5fa9SMichael Tuexen 			sctp_setup_tail_pointer(control);
98744249214SRandall Stewart 			/* Fix the FSN included */
98844249214SRandall Stewart 			tmp = control->fsn_included;
98949656eefSMichael Tuexen 			control->fsn_included = chk->rec.data.fsn;
99049656eefSMichael Tuexen 			chk->rec.data.fsn = tmp;
991d1ea5fa9SMichael Tuexen 			/* Fix the TSN included */
992d1ea5fa9SMichael Tuexen 			tmp = control->sinfo_tsn;
99349656eefSMichael Tuexen 			control->sinfo_tsn = chk->rec.data.tsn;
99449656eefSMichael Tuexen 			chk->rec.data.tsn = tmp;
995d1ea5fa9SMichael Tuexen 			/* Fix the PPID included */
996d1ea5fa9SMichael Tuexen 			tmp = control->sinfo_ppid;
99749656eefSMichael Tuexen 			control->sinfo_ppid = chk->rec.data.ppid;
99849656eefSMichael Tuexen 			chk->rec.data.ppid = tmp;
999d1ea5fa9SMichael Tuexen 			/* Fix tail pointer */
100044249214SRandall Stewart 			goto place_chunk;
100144249214SRandall Stewart 		}
100244249214SRandall Stewart 		control->first_frag_seen = 1;
10038b9c95f4SMichael Tuexen 		control->fsn_included = chk->rec.data.fsn;
10048b9c95f4SMichael Tuexen 		control->top_fsn = chk->rec.data.fsn;
100549656eefSMichael Tuexen 		control->sinfo_tsn = chk->rec.data.tsn;
100649656eefSMichael Tuexen 		control->sinfo_ppid = chk->rec.data.ppid;
100744249214SRandall Stewart 		control->data = chk->data;
100849656eefSMichael Tuexen 		sctp_mark_non_revokable(asoc, chk->rec.data.tsn);
100944249214SRandall Stewart 		chk->data = NULL;
101044249214SRandall Stewart 		sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
101144249214SRandall Stewart 		sctp_setup_tail_pointer(control);
101244249214SRandall Stewart 		return;
101344249214SRandall Stewart 	}
101444249214SRandall Stewart place_chunk:
1015d1ea5fa9SMichael Tuexen 	inserted = 0;
101644249214SRandall Stewart 	TAILQ_FOREACH(at, &control->reasm, sctp_next) {
101749656eefSMichael Tuexen 		if (SCTP_TSN_GT(at->rec.data.fsn, chk->rec.data.fsn)) {
101844249214SRandall Stewart 			/*
101944249214SRandall Stewart 			 * This one in queue is bigger than the new one,
102044249214SRandall Stewart 			 * insert the new one before at.
102144249214SRandall Stewart 			 */
102244249214SRandall Stewart 			asoc->size_on_reasm_queue += chk->send_size;
102344249214SRandall Stewart 			sctp_ucount_incr(asoc->cnt_on_reasm_queue);
102444249214SRandall Stewart 			inserted = 1;
102544249214SRandall Stewart 			TAILQ_INSERT_BEFORE(at, chk, sctp_next);
102644249214SRandall Stewart 			break;
102749656eefSMichael Tuexen 		} else if (at->rec.data.fsn == chk->rec.data.fsn) {
102844249214SRandall Stewart 			/*
102944249214SRandall Stewart 			 * They sent a duplicate fsn number. This really
103044249214SRandall Stewart 			 * should not happen since the FSN is a TSN and it
103144249214SRandall Stewart 			 * should have been dropped earlier.
103244249214SRandall Stewart 			 */
1033b1deed45SMichael Tuexen 			sctp_abort_in_reasm(stcb, control, chk,
103444249214SRandall Stewart 			    abort_flag,
103544249214SRandall Stewart 			    SCTP_FROM_SCTP_INDATA + SCTP_LOC_5);
103644249214SRandall Stewart 			return;
103744249214SRandall Stewart 		}
103844249214SRandall Stewart 	}
103944249214SRandall Stewart 	if (inserted == 0) {
104044249214SRandall Stewart 		/* Its at the end */
104144249214SRandall Stewart 		asoc->size_on_reasm_queue += chk->send_size;
104244249214SRandall Stewart 		sctp_ucount_incr(asoc->cnt_on_reasm_queue);
104349656eefSMichael Tuexen 		control->top_fsn = chk->rec.data.fsn;
104444249214SRandall Stewart 		TAILQ_INSERT_TAIL(&control->reasm, chk, sctp_next);
104544249214SRandall Stewart 	}
104644249214SRandall Stewart }
104744249214SRandall Stewart 
104844249214SRandall Stewart static int
1049d1ea5fa9SMichael Tuexen sctp_deliver_reasm_check(struct sctp_tcb *stcb, struct sctp_association *asoc,
1050d1ea5fa9SMichael Tuexen     struct sctp_stream_in *strm, int inp_read_lock_held)
105144249214SRandall Stewart {
105244249214SRandall Stewart 	/*
105344249214SRandall Stewart 	 * Given a stream, strm, see if any of the SSN's on it that are
105444249214SRandall Stewart 	 * fragmented are ready to deliver. If so go ahead and place them on
105544249214SRandall Stewart 	 * the read queue. In so placing if we have hit the end, then we
105644249214SRandall Stewart 	 * need to remove them from the stream's queue.
105744249214SRandall Stewart 	 */
105844249214SRandall Stewart 	struct sctp_queued_to_read *control, *nctl = NULL;
105944249214SRandall Stewart 	uint32_t next_to_del;
106044249214SRandall Stewart 	uint32_t pd_point;
106144249214SRandall Stewart 	int ret = 0;
106244249214SRandall Stewart 
1063810ec536SMichael Tuexen 	if (stcb->sctp_socket) {
1064d4d23375SMichael Tuexen 		pd_point = min(SCTP_SB_LIMIT_RCV(stcb->sctp_socket) >> SCTP_PARTIAL_DELIVERY_SHIFT,
1065810ec536SMichael Tuexen 		    stcb->sctp_ep->partial_delivery_point);
1066810ec536SMichael Tuexen 	} else {
1067810ec536SMichael Tuexen 		pd_point = stcb->sctp_ep->partial_delivery_point;
1068810ec536SMichael Tuexen 	}
106944249214SRandall Stewart 	control = TAILQ_FIRST(&strm->uno_inqueue);
1070d1ea5fa9SMichael Tuexen 
10713d6fe5d8SMichael Tuexen 	if ((control != NULL) &&
107244249214SRandall Stewart 	    (asoc->idata_supported == 0)) {
107344249214SRandall Stewart 		/* Special handling needed for "old" data format */
1074d1ea5fa9SMichael Tuexen 		if (sctp_handle_old_unordered_data(stcb, asoc, strm, control, pd_point, inp_read_lock_held)) {
107544249214SRandall Stewart 			goto done_un;
1076f8829a4aSRandall Stewart 		}
1077f8829a4aSRandall Stewart 	}
107844249214SRandall Stewart 	if (strm->pd_api_started) {
107944249214SRandall Stewart 		/* Can't add more */
108044249214SRandall Stewart 		return (0);
108144249214SRandall Stewart 	}
108244249214SRandall Stewart 	while (control) {
1083f2ea2a2dSMichael Tuexen 		SCTPDBG(SCTP_DEBUG_XXX, "Looking at control: %p e(%d) ssn: %u top_fsn: %u inc_fsn: %u -uo\n",
108449656eefSMichael Tuexen 		    control, control->end_added, control->mid, control->top_fsn, control->fsn_included);
108544249214SRandall Stewart 		nctl = TAILQ_NEXT(control, next_instrm);
108644249214SRandall Stewart 		if (control->end_added) {
108744249214SRandall Stewart 			/* We just put the last bit on */
108844249214SRandall Stewart 			if (control->on_strm_q) {
108998d5fd97SMichael Tuexen #ifdef INVARIANTS
109044249214SRandall Stewart 				if (control->on_strm_q != SCTP_ON_UNORDERED) {
109144249214SRandall Stewart 					panic("Huh control: %p on_q: %d -- not unordered?",
109244249214SRandall Stewart 					    control, control->on_strm_q);
109344249214SRandall Stewart 				}
109498d5fd97SMichael Tuexen #endif
109526f0250aSMichael Tuexen 				SCTP_STAT_INCR_COUNTER64(sctps_reasmusrmsgs);
109644249214SRandall Stewart 				TAILQ_REMOVE(&strm->uno_inqueue, control, next_instrm);
1097132c0738SMichael Tuexen 				if (asoc->size_on_all_streams >= control->length) {
1098132c0738SMichael Tuexen 					asoc->size_on_all_streams -= control->length;
1099132c0738SMichael Tuexen 				} else {
1100132c0738SMichael Tuexen #ifdef INVARIANTS
1101132c0738SMichael Tuexen 					panic("size_on_all_streams = %u smaller than control length %u", asoc->size_on_all_streams, control->length);
1102132c0738SMichael Tuexen #else
1103132c0738SMichael Tuexen 					asoc->size_on_all_streams = 0;
1104132c0738SMichael Tuexen #endif
1105132c0738SMichael Tuexen 				}
1106132c0738SMichael Tuexen 				sctp_ucount_decr(asoc->cnt_on_all_streams);
110744249214SRandall Stewart 				control->on_strm_q = 0;
110844249214SRandall Stewart 			}
110944249214SRandall Stewart 			if (control->on_read_q == 0) {
111044249214SRandall Stewart 				sctp_add_to_readq(stcb->sctp_ep, stcb,
111144249214SRandall Stewart 				    control,
111244249214SRandall Stewart 				    &stcb->sctp_socket->so_rcv, control->end_added,
1113d1ea5fa9SMichael Tuexen 				    inp_read_lock_held, SCTP_SO_NOT_LOCKED);
111444249214SRandall Stewart 			}
1115f8829a4aSRandall Stewart 		} else {
111644249214SRandall Stewart 			/* Can we do a PD-API for this un-ordered guy? */
111744249214SRandall Stewart 			if ((control->length >= pd_point) && (strm->pd_api_started == 0)) {
111844249214SRandall Stewart 				strm->pd_api_started = 1;
111944249214SRandall Stewart 				control->pdapi_started = 1;
112044249214SRandall Stewart 				sctp_add_to_readq(stcb->sctp_ep, stcb,
112144249214SRandall Stewart 				    control,
112244249214SRandall Stewart 				    &stcb->sctp_socket->so_rcv, control->end_added,
1123d1ea5fa9SMichael Tuexen 				    inp_read_lock_held, SCTP_SO_NOT_LOCKED);
112444249214SRandall Stewart 
112544249214SRandall Stewart 				break;
1126139bc87fSRandall Stewart 			}
1127f8829a4aSRandall Stewart 		}
112844249214SRandall Stewart 		control = nctl;
112944249214SRandall Stewart 	}
113044249214SRandall Stewart done_un:
113144249214SRandall Stewart 	control = TAILQ_FIRST(&strm->inqueue);
113244249214SRandall Stewart 	if (strm->pd_api_started) {
113344249214SRandall Stewart 		/* Can't add more */
113444249214SRandall Stewart 		return (0);
113544249214SRandall Stewart 	}
113644249214SRandall Stewart 	if (control == NULL) {
113744249214SRandall Stewart 		return (ret);
113844249214SRandall Stewart 	}
113949656eefSMichael Tuexen 	if (SCTP_MID_EQ(asoc->idata_supported, strm->last_mid_delivered, control->mid)) {
114044249214SRandall Stewart 		/*
114144249214SRandall Stewart 		 * Ok the guy at the top was being partially delivered
114244249214SRandall Stewart 		 * completed, so we remove it. Note the pd_api flag was
114344249214SRandall Stewart 		 * taken off when the chunk was merged on in
114444249214SRandall Stewart 		 * sctp_queue_data_for_reasm below.
114544249214SRandall Stewart 		 */
114644249214SRandall Stewart 		nctl = TAILQ_NEXT(control, next_instrm);
114744249214SRandall Stewart 		SCTPDBG(SCTP_DEBUG_XXX,
1148f2ea2a2dSMichael Tuexen 		    "Looking at control: %p e(%d) ssn: %u top_fsn: %u inc_fsn: %u (lastdel: %u)- o\n",
114949656eefSMichael Tuexen 		    control, control->end_added, control->mid,
115044249214SRandall Stewart 		    control->top_fsn, control->fsn_included,
115149656eefSMichael Tuexen 		    strm->last_mid_delivered);
115244249214SRandall Stewart 		if (control->end_added) {
115344249214SRandall Stewart 			if (control->on_strm_q) {
115498d5fd97SMichael Tuexen #ifdef INVARIANTS
115544249214SRandall Stewart 				if (control->on_strm_q != SCTP_ON_ORDERED) {
115644249214SRandall Stewart 					panic("Huh control: %p on_q: %d -- not ordered?",
115744249214SRandall Stewart 					    control, control->on_strm_q);
115844249214SRandall Stewart 				}
115998d5fd97SMichael Tuexen #endif
116026f0250aSMichael Tuexen 				SCTP_STAT_INCR_COUNTER64(sctps_reasmusrmsgs);
116144249214SRandall Stewart 				TAILQ_REMOVE(&strm->inqueue, control, next_instrm);
116228cd0699SMichael Tuexen 				if (asoc->size_on_all_streams >= control->length) {
116328cd0699SMichael Tuexen 					asoc->size_on_all_streams -= control->length;
116428cd0699SMichael Tuexen 				} else {
116528cd0699SMichael Tuexen #ifdef INVARIANTS
116628cd0699SMichael Tuexen 					panic("size_on_all_streams = %u smaller than control length %u", asoc->size_on_all_streams, control->length);
116728cd0699SMichael Tuexen #else
116828cd0699SMichael Tuexen 					asoc->size_on_all_streams = 0;
116928cd0699SMichael Tuexen #endif
117028cd0699SMichael Tuexen 				}
117128cd0699SMichael Tuexen 				sctp_ucount_decr(asoc->cnt_on_all_streams);
117244249214SRandall Stewart 				control->on_strm_q = 0;
117344249214SRandall Stewart 			}
1174c09a1534SMichael Tuexen 			if (strm->pd_api_started && control->pdapi_started) {
1175c09a1534SMichael Tuexen 				control->pdapi_started = 0;
1176c09a1534SMichael Tuexen 				strm->pd_api_started = 0;
1177c09a1534SMichael Tuexen 			}
117844249214SRandall Stewart 			if (control->on_read_q == 0) {
117944249214SRandall Stewart 				sctp_add_to_readq(stcb->sctp_ep, stcb,
118044249214SRandall Stewart 				    control,
118144249214SRandall Stewart 				    &stcb->sctp_socket->so_rcv, control->end_added,
1182d1ea5fa9SMichael Tuexen 				    inp_read_lock_held, SCTP_SO_NOT_LOCKED);
118344249214SRandall Stewart 			}
118444249214SRandall Stewart 			control = nctl;
118544249214SRandall Stewart 		}
118644249214SRandall Stewart 	}
118744249214SRandall Stewart 	if (strm->pd_api_started) {
1188b7b84c0eSMichael Tuexen 		/*
1189b7b84c0eSMichael Tuexen 		 * Can't add more must have gotten an un-ordered above being
1190b7b84c0eSMichael Tuexen 		 * partially delivered.
1191b7b84c0eSMichael Tuexen 		 */
119244249214SRandall Stewart 		return (0);
119344249214SRandall Stewart 	}
119444249214SRandall Stewart deliver_more:
119549656eefSMichael Tuexen 	next_to_del = strm->last_mid_delivered + 1;
119644249214SRandall Stewart 	if (control) {
119744249214SRandall Stewart 		SCTPDBG(SCTP_DEBUG_XXX,
1198f2ea2a2dSMichael Tuexen 		    "Looking at control: %p e(%d) ssn: %u top_fsn: %u inc_fsn: %u (nxtdel: %u)- o\n",
119949656eefSMichael Tuexen 		    control, control->end_added, control->mid, control->top_fsn, control->fsn_included,
120044249214SRandall Stewart 		    next_to_del);
120144249214SRandall Stewart 		nctl = TAILQ_NEXT(control, next_instrm);
120249656eefSMichael Tuexen 		if (SCTP_MID_EQ(asoc->idata_supported, control->mid, next_to_del) &&
120344249214SRandall Stewart 		    (control->first_frag_seen)) {
1204c09a1534SMichael Tuexen 			int done;
1205c09a1534SMichael Tuexen 
120644249214SRandall Stewart 			/* Ok we can deliver it onto the stream. */
120744249214SRandall Stewart 			if (control->end_added) {
120844249214SRandall Stewart 				/* We are done with it afterwards */
120944249214SRandall Stewart 				if (control->on_strm_q) {
121098d5fd97SMichael Tuexen #ifdef INVARIANTS
121144249214SRandall Stewart 					if (control->on_strm_q != SCTP_ON_ORDERED) {
121244249214SRandall Stewart 						panic("Huh control: %p on_q: %d -- not ordered?",
121344249214SRandall Stewart 						    control, control->on_strm_q);
121444249214SRandall Stewart 					}
121598d5fd97SMichael Tuexen #endif
121626f0250aSMichael Tuexen 					SCTP_STAT_INCR_COUNTER64(sctps_reasmusrmsgs);
121744249214SRandall Stewart 					TAILQ_REMOVE(&strm->inqueue, control, next_instrm);
121828cd0699SMichael Tuexen 					if (asoc->size_on_all_streams >= control->length) {
121928cd0699SMichael Tuexen 						asoc->size_on_all_streams -= control->length;
122028cd0699SMichael Tuexen 					} else {
122128cd0699SMichael Tuexen #ifdef INVARIANTS
122228cd0699SMichael Tuexen 						panic("size_on_all_streams = %u smaller than control length %u", asoc->size_on_all_streams, control->length);
122328cd0699SMichael Tuexen #else
122428cd0699SMichael Tuexen 						asoc->size_on_all_streams = 0;
122528cd0699SMichael Tuexen #endif
122628cd0699SMichael Tuexen 					}
122728cd0699SMichael Tuexen 					sctp_ucount_decr(asoc->cnt_on_all_streams);
122844249214SRandall Stewart 					control->on_strm_q = 0;
122944249214SRandall Stewart 				}
123044249214SRandall Stewart 				ret++;
123144249214SRandall Stewart 			}
123244249214SRandall Stewart 			if (((control->sinfo_flags >> 8) & SCTP_DATA_NOT_FRAG) == SCTP_DATA_NOT_FRAG) {
1233b7b84c0eSMichael Tuexen 				/*
1234b7b84c0eSMichael Tuexen 				 * A singleton now slipping through - mark
1235b7b84c0eSMichael Tuexen 				 * it non-revokable too
1236b7b84c0eSMichael Tuexen 				 */
123744249214SRandall Stewart 				sctp_mark_non_revokable(asoc, control->sinfo_tsn);
123844249214SRandall Stewart 			} else if (control->end_added == 0) {
1239b7b84c0eSMichael Tuexen 				/*
1240b7b84c0eSMichael Tuexen 				 * Check if we can defer adding until its
1241b7b84c0eSMichael Tuexen 				 * all there
1242b7b84c0eSMichael Tuexen 				 */
124344249214SRandall Stewart 				if ((control->length < pd_point) || (strm->pd_api_started)) {
1244b7b84c0eSMichael Tuexen 					/*
1245b7b84c0eSMichael Tuexen 					 * Don't need it or cannot add more
1246b7b84c0eSMichael Tuexen 					 * (one being delivered that way)
1247b7b84c0eSMichael Tuexen 					 */
124844249214SRandall Stewart 					goto out;
124944249214SRandall Stewart 				}
125044249214SRandall Stewart 			}
1251c09a1534SMichael Tuexen 			done = (control->end_added) && (control->last_frag_seen);
125244249214SRandall Stewart 			if (control->on_read_q == 0) {
1253253a63b8SMichael Tuexen 				if (!done) {
1254253a63b8SMichael Tuexen 					if (asoc->size_on_all_streams >= control->length) {
1255253a63b8SMichael Tuexen 						asoc->size_on_all_streams -= control->length;
1256253a63b8SMichael Tuexen 					} else {
1257253a63b8SMichael Tuexen #ifdef INVARIANTS
1258253a63b8SMichael Tuexen 						panic("size_on_all_streams = %u smaller than control length %u", asoc->size_on_all_streams, control->length);
1259253a63b8SMichael Tuexen #else
1260253a63b8SMichael Tuexen 						asoc->size_on_all_streams = 0;
1261253a63b8SMichael Tuexen #endif
1262253a63b8SMichael Tuexen 					}
1263253a63b8SMichael Tuexen 					strm->pd_api_started = 1;
1264253a63b8SMichael Tuexen 					control->pdapi_started = 1;
1265253a63b8SMichael Tuexen 				}
126644249214SRandall Stewart 				sctp_add_to_readq(stcb->sctp_ep, stcb,
126744249214SRandall Stewart 				    control,
126844249214SRandall Stewart 				    &stcb->sctp_socket->so_rcv, control->end_added,
1269d1ea5fa9SMichael Tuexen 				    inp_read_lock_held, SCTP_SO_NOT_LOCKED);
127044249214SRandall Stewart 			}
127149656eefSMichael Tuexen 			strm->last_mid_delivered = next_to_del;
1272c09a1534SMichael Tuexen 			if (done) {
127344249214SRandall Stewart 				control = nctl;
127444249214SRandall Stewart 				goto deliver_more;
127544249214SRandall Stewart 			}
127644249214SRandall Stewart 		}
127744249214SRandall Stewart 	}
127844249214SRandall Stewart out:
127944249214SRandall Stewart 	return (ret);
128044249214SRandall Stewart }
128144249214SRandall Stewart 
128228cd0699SMichael Tuexen uint32_t
128344249214SRandall Stewart sctp_add_chk_to_control(struct sctp_queued_to_read *control,
128444249214SRandall Stewart     struct sctp_stream_in *strm,
128544249214SRandall Stewart     struct sctp_tcb *stcb, struct sctp_association *asoc,
1286b0471b4bSMichael Tuexen     struct sctp_tmit_chunk *chk, int hold_rlock)
1287b0471b4bSMichael Tuexen {
128844249214SRandall Stewart 	/*
128944249214SRandall Stewart 	 * Given a control and a chunk, merge the data from the chk onto the
129044249214SRandall Stewart 	 * control and free up the chunk resources.
129144249214SRandall Stewart 	 */
129228cd0699SMichael Tuexen 	uint32_t added = 0;
1293847fa61fSMichael Tuexen 	bool i_locked = false;
129444249214SRandall Stewart 
1295847fa61fSMichael Tuexen 	if (control->on_read_q) {
1296847fa61fSMichael Tuexen 		if (hold_rlock == 0) {
1297847fa61fSMichael Tuexen 			/* Its being pd-api'd so we must do some locks. */
129844249214SRandall Stewart 			SCTP_INP_READ_LOCK(stcb->sctp_ep);
1299847fa61fSMichael Tuexen 			i_locked = true;
1300847fa61fSMichael Tuexen 		}
1301847fa61fSMichael Tuexen 		if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_SOCKET_CANT_READ) {
1302847fa61fSMichael Tuexen 			goto out;
1303847fa61fSMichael Tuexen 		}
130444249214SRandall Stewart 	}
130544249214SRandall Stewart 	if (control->data == NULL) {
130644249214SRandall Stewart 		control->data = chk->data;
130744249214SRandall Stewart 		sctp_setup_tail_pointer(control);
130844249214SRandall Stewart 	} else {
130928cd0699SMichael Tuexen 		sctp_add_to_tail_pointer(control, chk->data, &added);
131044249214SRandall Stewart 	}
131149656eefSMichael Tuexen 	control->fsn_included = chk->rec.data.fsn;
131244249214SRandall Stewart 	asoc->size_on_reasm_queue -= chk->send_size;
131344249214SRandall Stewart 	sctp_ucount_decr(asoc->cnt_on_reasm_queue);
131449656eefSMichael Tuexen 	sctp_mark_non_revokable(asoc, chk->rec.data.tsn);
131544249214SRandall Stewart 	chk->data = NULL;
131644249214SRandall Stewart 	if (chk->rec.data.rcv_flags & SCTP_DATA_FIRST_FRAG) {
131744249214SRandall Stewart 		control->first_frag_seen = 1;
13188b9c95f4SMichael Tuexen 		control->sinfo_tsn = chk->rec.data.tsn;
13198b9c95f4SMichael Tuexen 		control->sinfo_ppid = chk->rec.data.ppid;
132044249214SRandall Stewart 	}
132144249214SRandall Stewart 	if (chk->rec.data.rcv_flags & SCTP_DATA_LAST_FRAG) {
132244249214SRandall Stewart 		/* Its complete */
132344249214SRandall Stewart 		if ((control->on_strm_q) && (control->on_read_q)) {
132444249214SRandall Stewart 			if (control->pdapi_started) {
132544249214SRandall Stewart 				control->pdapi_started = 0;
132644249214SRandall Stewart 				strm->pd_api_started = 0;
132744249214SRandall Stewart 			}
132844249214SRandall Stewart 			if (control->on_strm_q == SCTP_ON_UNORDERED) {
132944249214SRandall Stewart 				/* Unordered */
133044249214SRandall Stewart 				TAILQ_REMOVE(&strm->uno_inqueue, control, next_instrm);
133144249214SRandall Stewart 				control->on_strm_q = 0;
133244249214SRandall Stewart 			} else if (control->on_strm_q == SCTP_ON_ORDERED) {
133344249214SRandall Stewart 				/* Ordered */
133444249214SRandall Stewart 				TAILQ_REMOVE(&strm->inqueue, control, next_instrm);
1335253a63b8SMichael Tuexen 				/*
1336253a63b8SMichael Tuexen 				 * Don't need to decrement
1337253a63b8SMichael Tuexen 				 * size_on_all_streams, since control is on
1338253a63b8SMichael Tuexen 				 * the read queue.
1339253a63b8SMichael Tuexen 				 */
134028cd0699SMichael Tuexen 				sctp_ucount_decr(asoc->cnt_on_all_streams);
134144249214SRandall Stewart 				control->on_strm_q = 0;
134298d5fd97SMichael Tuexen #ifdef INVARIANTS
134344249214SRandall Stewart 			} else if (control->on_strm_q) {
134444249214SRandall Stewart 				panic("Unknown state on ctrl: %p on_strm_q: %d", control,
134544249214SRandall Stewart 				    control->on_strm_q);
134698d5fd97SMichael Tuexen #endif
134744249214SRandall Stewart 			}
134844249214SRandall Stewart 		}
134944249214SRandall Stewart 		control->end_added = 1;
135044249214SRandall Stewart 		control->last_frag_seen = 1;
135144249214SRandall Stewart 	}
1352847fa61fSMichael Tuexen out:
135344249214SRandall Stewart 	if (i_locked) {
135444249214SRandall Stewart 		SCTP_INP_READ_UNLOCK(stcb->sctp_ep);
135544249214SRandall Stewart 	}
135644249214SRandall Stewart 	sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
135728cd0699SMichael Tuexen 	return (added);
1358f8829a4aSRandall Stewart }
1359f8829a4aSRandall Stewart 
1360f8829a4aSRandall Stewart /*
1361f8829a4aSRandall Stewart  * Dump onto the re-assembly queue, in its proper place. After dumping on the
13622fb174d1SGordon Bergling  * queue, see if anything can be delivered. If so pull it off (or as much as
1363f8829a4aSRandall Stewart  * we can. If we run out of space then we must dump what we can and set the
1364f8829a4aSRandall Stewart  * appropriate flag to say we queued what we could.
1365f8829a4aSRandall Stewart  */
1366f8829a4aSRandall Stewart static void
1367f8829a4aSRandall Stewart sctp_queue_data_for_reasm(struct sctp_tcb *stcb, struct sctp_association *asoc,
136844249214SRandall Stewart     struct sctp_queued_to_read *control,
136944249214SRandall Stewart     struct sctp_tmit_chunk *chk,
137044249214SRandall Stewart     int created_control,
137144249214SRandall Stewart     int *abort_flag, uint32_t tsn)
1372f8829a4aSRandall Stewart {
137344249214SRandall Stewart 	uint32_t next_fsn;
137444249214SRandall Stewart 	struct sctp_tmit_chunk *at, *nat;
13753d6fe5d8SMichael Tuexen 	struct sctp_stream_in *strm;
1376c09a1534SMichael Tuexen 	int do_wakeup, unordered;
137728cd0699SMichael Tuexen 	uint32_t lenadded;
1378f8829a4aSRandall Stewart 
13793d6fe5d8SMichael Tuexen 	strm = &asoc->strmin[control->sinfo_stream];
1380f8829a4aSRandall Stewart 	/*
138144249214SRandall Stewart 	 * For old un-ordered data chunks.
1382f8829a4aSRandall Stewart 	 */
138344249214SRandall Stewart 	if ((control->sinfo_flags >> 8) & SCTP_DATA_UNORDERED) {
138444249214SRandall Stewart 		unordered = 1;
1385f8829a4aSRandall Stewart 	} else {
138644249214SRandall Stewart 		unordered = 0;
138744249214SRandall Stewart 	}
138844249214SRandall Stewart 	/* Must be added to the stream-in queue */
138944249214SRandall Stewart 	if (created_control) {
1390132c0738SMichael Tuexen 		if ((unordered == 0) || (asoc->idata_supported)) {
139128cd0699SMichael Tuexen 			sctp_ucount_incr(asoc->cnt_on_all_streams);
139228cd0699SMichael Tuexen 		}
139344249214SRandall Stewart 		if (sctp_place_control_in_stream(strm, asoc, control)) {
139444249214SRandall Stewart 			/* Duplicate SSN? */
1395b1deed45SMichael Tuexen 			sctp_abort_in_reasm(stcb, control, chk,
139644249214SRandall Stewart 			    abort_flag,
139744249214SRandall Stewart 			    SCTP_FROM_SCTP_INDATA + SCTP_LOC_6);
139853999485SMichael Tuexen 			sctp_clean_up_control(stcb, control);
139944249214SRandall Stewart 			return;
140044249214SRandall Stewart 		}
140144249214SRandall Stewart 		if ((tsn == (asoc->cumulative_tsn + 1) && (asoc->idata_supported == 0))) {
1402f8829a4aSRandall Stewart 			/*
140344249214SRandall Stewart 			 * Ok we created this control and now lets validate
140444249214SRandall Stewart 			 * that its legal i.e. there is a B bit set, if not
140544249214SRandall Stewart 			 * and we have up to the cum-ack then its invalid.
140644249214SRandall Stewart 			 */
140744249214SRandall Stewart 			if ((chk->rec.data.rcv_flags & SCTP_DATA_FIRST_FRAG) == 0) {
1408b1deed45SMichael Tuexen 				sctp_abort_in_reasm(stcb, control, chk,
140944249214SRandall Stewart 				    abort_flag,
141044249214SRandall Stewart 				    SCTP_FROM_SCTP_INDATA + SCTP_LOC_7);
141144249214SRandall Stewart 				return;
141244249214SRandall Stewart 			}
141344249214SRandall Stewart 		}
141444249214SRandall Stewart 	}
1415a39ddef0SMichael Tuexen 	if ((asoc->idata_supported == 0) && (unordered == 1)) {
1416d1ea5fa9SMichael Tuexen 		sctp_inject_old_unordered_data(stcb, asoc, control, chk, abort_flag);
141744249214SRandall Stewart 		return;
141844249214SRandall Stewart 	}
141944249214SRandall Stewart 	/*
142044249214SRandall Stewart 	 * Ok we must queue the chunk into the reasembly portion: o if its
142144249214SRandall Stewart 	 * the first it goes to the control mbuf. o if its not first but the
142244249214SRandall Stewart 	 * next in sequence it goes to the control, and each succeeding one
142344249214SRandall Stewart 	 * in order also goes. o if its not in order we place it on the list
142444249214SRandall Stewart 	 * in its place.
142544249214SRandall Stewart 	 */
142644249214SRandall Stewart 	if (chk->rec.data.rcv_flags & SCTP_DATA_FIRST_FRAG) {
142744249214SRandall Stewart 		/* Its the very first one. */
142844249214SRandall Stewart 		SCTPDBG(SCTP_DEBUG_XXX,
1429f2ea2a2dSMichael Tuexen 		    "chunk is a first fsn: %u becomes fsn_included\n",
143049656eefSMichael Tuexen 		    chk->rec.data.fsn);
143144249214SRandall Stewart 		if (control->first_frag_seen) {
143244249214SRandall Stewart 			/*
143344249214SRandall Stewart 			 * Error on senders part, they either sent us two
143444249214SRandall Stewart 			 * data chunks with FIRST, or they sent two
143544249214SRandall Stewart 			 * un-ordered chunks that were fragmented at the
143644249214SRandall Stewart 			 * same time in the same stream.
143744249214SRandall Stewart 			 */
1438b1deed45SMichael Tuexen 			sctp_abort_in_reasm(stcb, control, chk,
143944249214SRandall Stewart 			    abort_flag,
144044249214SRandall Stewart 			    SCTP_FROM_SCTP_INDATA + SCTP_LOC_8);
144144249214SRandall Stewart 			return;
144244249214SRandall Stewart 		}
144344249214SRandall Stewart 		control->first_frag_seen = 1;
14448b9c95f4SMichael Tuexen 		control->sinfo_ppid = chk->rec.data.ppid;
14458b9c95f4SMichael Tuexen 		control->sinfo_tsn = chk->rec.data.tsn;
144649656eefSMichael Tuexen 		control->fsn_included = chk->rec.data.fsn;
144744249214SRandall Stewart 		control->data = chk->data;
144849656eefSMichael Tuexen 		sctp_mark_non_revokable(asoc, chk->rec.data.tsn);
144944249214SRandall Stewart 		chk->data = NULL;
145044249214SRandall Stewart 		sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
145144249214SRandall Stewart 		sctp_setup_tail_pointer(control);
145228cd0699SMichael Tuexen 		asoc->size_on_all_streams += control->length;
145344249214SRandall Stewart 	} else {
145444249214SRandall Stewart 		/* Place the chunk in our list */
145544249214SRandall Stewart 		int inserted = 0;
145644249214SRandall Stewart 
145744249214SRandall Stewart 		if (control->last_frag_seen == 0) {
145844249214SRandall Stewart 			/* Still willing to raise highest FSN seen */
145949656eefSMichael Tuexen 			if (SCTP_TSN_GT(chk->rec.data.fsn, control->top_fsn)) {
146044249214SRandall Stewart 				SCTPDBG(SCTP_DEBUG_XXX,
1461f2ea2a2dSMichael Tuexen 				    "We have a new top_fsn: %u\n",
146249656eefSMichael Tuexen 				    chk->rec.data.fsn);
146349656eefSMichael Tuexen 				control->top_fsn = chk->rec.data.fsn;
146444249214SRandall Stewart 			}
146544249214SRandall Stewart 			if (chk->rec.data.rcv_flags & SCTP_DATA_LAST_FRAG) {
146644249214SRandall Stewart 				SCTPDBG(SCTP_DEBUG_XXX,
1467f2ea2a2dSMichael Tuexen 				    "The last fsn is now in place fsn: %u\n",
146849656eefSMichael Tuexen 				    chk->rec.data.fsn);
146944249214SRandall Stewart 				control->last_frag_seen = 1;
1470ec24a1b6SMichael Tuexen 				if (SCTP_TSN_GT(control->top_fsn, chk->rec.data.fsn)) {
1471ec24a1b6SMichael Tuexen 					SCTPDBG(SCTP_DEBUG_XXX,
1472ec24a1b6SMichael Tuexen 					    "New fsn: %u is not at top_fsn: %u -- abort\n",
1473ec24a1b6SMichael Tuexen 					    chk->rec.data.fsn,
1474ec24a1b6SMichael Tuexen 					    control->top_fsn);
1475ec24a1b6SMichael Tuexen 					sctp_abort_in_reasm(stcb, control, chk,
1476ec24a1b6SMichael Tuexen 					    abort_flag,
1477ec24a1b6SMichael Tuexen 					    SCTP_FROM_SCTP_INDATA + SCTP_LOC_9);
1478ec24a1b6SMichael Tuexen 					return;
1479ec24a1b6SMichael Tuexen 				}
148044249214SRandall Stewart 			}
148144249214SRandall Stewart 			if (asoc->idata_supported || control->first_frag_seen) {
148244249214SRandall Stewart 				/*
148344249214SRandall Stewart 				 * For IDATA we always check since we know
148444249214SRandall Stewart 				 * that the first fragment is 0. For old
148544249214SRandall Stewart 				 * DATA we have to receive the first before
1486cd0a4ff6SPedro F. Giffuni 				 * we know the first FSN (which is the TSN).
148744249214SRandall Stewart 				 */
148849656eefSMichael Tuexen 				if (SCTP_TSN_GE(control->fsn_included, chk->rec.data.fsn)) {
1489b7b84c0eSMichael Tuexen 					/*
1490b7b84c0eSMichael Tuexen 					 * We have already delivered up to
1491b7b84c0eSMichael Tuexen 					 * this so its a dup
1492b7b84c0eSMichael Tuexen 					 */
1493b1deed45SMichael Tuexen 					sctp_abort_in_reasm(stcb, control, chk,
149444249214SRandall Stewart 					    abort_flag,
1495ec24a1b6SMichael Tuexen 					    SCTP_FROM_SCTP_INDATA + SCTP_LOC_10);
149644249214SRandall Stewart 					return;
149744249214SRandall Stewart 				}
149844249214SRandall Stewart 			}
149944249214SRandall Stewart 		} else {
150044249214SRandall Stewart 			if (chk->rec.data.rcv_flags & SCTP_DATA_LAST_FRAG) {
150144249214SRandall Stewart 				/* Second last? huh? */
150244249214SRandall Stewart 				SCTPDBG(SCTP_DEBUG_XXX,
1503f2ea2a2dSMichael Tuexen 				    "Duplicate last fsn: %u (top: %u) -- abort\n",
150449656eefSMichael Tuexen 				    chk->rec.data.fsn, control->top_fsn);
1505b1deed45SMichael Tuexen 				sctp_abort_in_reasm(stcb, control,
150644249214SRandall Stewart 				    chk, abort_flag,
1507ec24a1b6SMichael Tuexen 				    SCTP_FROM_SCTP_INDATA + SCTP_LOC_11);
150844249214SRandall Stewart 				return;
150944249214SRandall Stewart 			}
151044249214SRandall Stewart 			if (asoc->idata_supported || control->first_frag_seen) {
151144249214SRandall Stewart 				/*
151244249214SRandall Stewart 				 * For IDATA we always check since we know
151344249214SRandall Stewart 				 * that the first fragment is 0. For old
151444249214SRandall Stewart 				 * DATA we have to receive the first before
1515cd0a4ff6SPedro F. Giffuni 				 * we know the first FSN (which is the TSN).
151644249214SRandall Stewart 				 */
151744249214SRandall Stewart 
151849656eefSMichael Tuexen 				if (SCTP_TSN_GE(control->fsn_included, chk->rec.data.fsn)) {
1519b7b84c0eSMichael Tuexen 					/*
1520b7b84c0eSMichael Tuexen 					 * We have already delivered up to
1521b7b84c0eSMichael Tuexen 					 * this so its a dup
1522b7b84c0eSMichael Tuexen 					 */
152344249214SRandall Stewart 					SCTPDBG(SCTP_DEBUG_XXX,
1524f2ea2a2dSMichael Tuexen 					    "New fsn: %u is already seen in included_fsn: %u -- abort\n",
152549656eefSMichael Tuexen 					    chk->rec.data.fsn, control->fsn_included);
1526b1deed45SMichael Tuexen 					sctp_abort_in_reasm(stcb, control, chk,
152744249214SRandall Stewart 					    abort_flag,
1528ec24a1b6SMichael Tuexen 					    SCTP_FROM_SCTP_INDATA + SCTP_LOC_12);
152944249214SRandall Stewart 					return;
153044249214SRandall Stewart 				}
153144249214SRandall Stewart 			}
1532b7b84c0eSMichael Tuexen 			/*
1533b7b84c0eSMichael Tuexen 			 * validate not beyond top FSN if we have seen last
1534b7b84c0eSMichael Tuexen 			 * one
1535b7b84c0eSMichael Tuexen 			 */
153649656eefSMichael Tuexen 			if (SCTP_TSN_GT(chk->rec.data.fsn, control->top_fsn)) {
153744249214SRandall Stewart 				SCTPDBG(SCTP_DEBUG_XXX,
1538f2ea2a2dSMichael Tuexen 				    "New fsn: %u is beyond or at top_fsn: %u -- abort\n",
153949656eefSMichael Tuexen 				    chk->rec.data.fsn,
154044249214SRandall Stewart 				    control->top_fsn);
1541b1deed45SMichael Tuexen 				sctp_abort_in_reasm(stcb, control, chk,
154244249214SRandall Stewart 				    abort_flag,
1543ec24a1b6SMichael Tuexen 				    SCTP_FROM_SCTP_INDATA + SCTP_LOC_13);
154444249214SRandall Stewart 				return;
154544249214SRandall Stewart 			}
154644249214SRandall Stewart 		}
154744249214SRandall Stewart 		/*
154844249214SRandall Stewart 		 * If we reach here, we need to place the new chunk in the
154944249214SRandall Stewart 		 * reassembly for this control.
155044249214SRandall Stewart 		 */
155144249214SRandall Stewart 		SCTPDBG(SCTP_DEBUG_XXX,
1552f2ea2a2dSMichael Tuexen 		    "chunk is a not first fsn: %u needs to be inserted\n",
155349656eefSMichael Tuexen 		    chk->rec.data.fsn);
155444249214SRandall Stewart 		TAILQ_FOREACH(at, &control->reasm, sctp_next) {
155549656eefSMichael Tuexen 			if (SCTP_TSN_GT(at->rec.data.fsn, chk->rec.data.fsn)) {
155691e04f9eSMichael Tuexen 				if (chk->rec.data.rcv_flags & SCTP_DATA_LAST_FRAG) {
155791e04f9eSMichael Tuexen 					/* Last not at the end? huh? */
155891e04f9eSMichael Tuexen 					SCTPDBG(SCTP_DEBUG_XXX,
155991e04f9eSMichael Tuexen 					    "Last fragment not last in list: -- abort\n");
156091e04f9eSMichael Tuexen 					sctp_abort_in_reasm(stcb, control,
156191e04f9eSMichael Tuexen 					    chk, abort_flag,
156291e04f9eSMichael Tuexen 					    SCTP_FROM_SCTP_INDATA + SCTP_LOC_14);
156391e04f9eSMichael Tuexen 					return;
156491e04f9eSMichael Tuexen 				}
156544249214SRandall Stewart 				/*
156644249214SRandall Stewart 				 * This one in queue is bigger than the new
156744249214SRandall Stewart 				 * one, insert the new one before at.
156844249214SRandall Stewart 				 */
156944249214SRandall Stewart 				SCTPDBG(SCTP_DEBUG_XXX,
1570f2ea2a2dSMichael Tuexen 				    "Insert it before fsn: %u\n",
157149656eefSMichael Tuexen 				    at->rec.data.fsn);
1572f8829a4aSRandall Stewart 				asoc->size_on_reasm_queue += chk->send_size;
1573f8829a4aSRandall Stewart 				sctp_ucount_incr(asoc->cnt_on_reasm_queue);
157444249214SRandall Stewart 				TAILQ_INSERT_BEFORE(at, chk, sctp_next);
157544249214SRandall Stewart 				inserted = 1;
157644249214SRandall Stewart 				break;
157749656eefSMichael Tuexen 			} else if (at->rec.data.fsn == chk->rec.data.fsn) {
1578b7b84c0eSMichael Tuexen 				/*
1579b7b84c0eSMichael Tuexen 				 * Gak, He sent me a duplicate str seq
1580b7b84c0eSMichael Tuexen 				 * number
1581b7b84c0eSMichael Tuexen 				 */
158244249214SRandall Stewart 				/*
158344249214SRandall Stewart 				 * foo bar, I guess I will just free this
158444249214SRandall Stewart 				 * new guy, should we abort too? FIX ME
158544249214SRandall Stewart 				 * MAYBE? Or it COULD be that the SSN's have
158644249214SRandall Stewart 				 * wrapped. Maybe I should compare to TSN
158744249214SRandall Stewart 				 * somehow... sigh for now just blow away
158844249214SRandall Stewart 				 * the chunk!
158944249214SRandall Stewart 				 */
159044249214SRandall Stewart 				SCTPDBG(SCTP_DEBUG_XXX,
1591f2ea2a2dSMichael Tuexen 				    "Duplicate to fsn: %u -- abort\n",
159249656eefSMichael Tuexen 				    at->rec.data.fsn);
1593b1deed45SMichael Tuexen 				sctp_abort_in_reasm(stcb, control,
159444249214SRandall Stewart 				    chk, abort_flag,
159591e04f9eSMichael Tuexen 				    SCTP_FROM_SCTP_INDATA + SCTP_LOC_15);
159644249214SRandall Stewart 				return;
159744249214SRandall Stewart 			}
159844249214SRandall Stewart 		}
159944249214SRandall Stewart 		if (inserted == 0) {
160044249214SRandall Stewart 			/* Goes on the end */
1601f2ea2a2dSMichael Tuexen 			SCTPDBG(SCTP_DEBUG_XXX, "Inserting at tail of list fsn: %u\n",
160249656eefSMichael Tuexen 			    chk->rec.data.fsn);
160344249214SRandall Stewart 			asoc->size_on_reasm_queue += chk->send_size;
160444249214SRandall Stewart 			sctp_ucount_incr(asoc->cnt_on_reasm_queue);
160544249214SRandall Stewart 			TAILQ_INSERT_TAIL(&control->reasm, chk, sctp_next);
160644249214SRandall Stewart 		}
160744249214SRandall Stewart 	}
160844249214SRandall Stewart 	/*
160944249214SRandall Stewart 	 * Ok lets see if we can suck any up into the control structure that
161044249214SRandall Stewart 	 * are in seq if it makes sense.
161144249214SRandall Stewart 	 */
1612c09a1534SMichael Tuexen 	do_wakeup = 0;
161344249214SRandall Stewart 	/*
161444249214SRandall Stewart 	 * If the first fragment has not been seen there is no sense in
161544249214SRandall Stewart 	 * looking.
161644249214SRandall Stewart 	 */
161744249214SRandall Stewart 	if (control->first_frag_seen) {
161844249214SRandall Stewart 		next_fsn = control->fsn_included + 1;
161944249214SRandall Stewart 		TAILQ_FOREACH_SAFE(at, &control->reasm, sctp_next, nat) {
162049656eefSMichael Tuexen 			if (at->rec.data.fsn == next_fsn) {
162144249214SRandall Stewart 				/* We can add this one now to the control */
162244249214SRandall Stewart 				SCTPDBG(SCTP_DEBUG_XXX,
1623f2ea2a2dSMichael Tuexen 				    "Adding more to control: %p at: %p fsn: %u next_fsn: %u included: %u\n",
162444249214SRandall Stewart 				    control, at,
162549656eefSMichael Tuexen 				    at->rec.data.fsn,
162644249214SRandall Stewart 				    next_fsn, control->fsn_included);
162744249214SRandall Stewart 				TAILQ_REMOVE(&control->reasm, at, sctp_next);
162828cd0699SMichael Tuexen 				lenadded = sctp_add_chk_to_control(control, strm, stcb, asoc, at, SCTP_READ_LOCK_NOT_HELD);
1629c09a1534SMichael Tuexen 				if (control->on_read_q) {
1630c09a1534SMichael Tuexen 					do_wakeup = 1;
163172e23abaSMichael Tuexen 				} else {
163272e23abaSMichael Tuexen 					/*
163372e23abaSMichael Tuexen 					 * We only add to the
163472e23abaSMichael Tuexen 					 * size-on-all-streams if its not on
163572e23abaSMichael Tuexen 					 * the read q. The read q flag will
163672e23abaSMichael Tuexen 					 * cause a sballoc so its accounted
163772e23abaSMichael Tuexen 					 * for there.
163872e23abaSMichael Tuexen 					 */
163972e23abaSMichael Tuexen 					asoc->size_on_all_streams += lenadded;
1640c09a1534SMichael Tuexen 				}
164144249214SRandall Stewart 				next_fsn++;
164244249214SRandall Stewart 				if (control->end_added && control->pdapi_started) {
164344249214SRandall Stewart 					if (strm->pd_api_started) {
164444249214SRandall Stewart 						strm->pd_api_started = 0;
164544249214SRandall Stewart 						control->pdapi_started = 0;
164644249214SRandall Stewart 					}
164744249214SRandall Stewart 					if (control->on_read_q == 0) {
164844249214SRandall Stewart 						sctp_add_to_readq(stcb->sctp_ep, stcb,
164944249214SRandall Stewart 						    control,
165044249214SRandall Stewart 						    &stcb->sctp_socket->so_rcv, control->end_added,
165144249214SRandall Stewart 						    SCTP_READ_LOCK_NOT_HELD, SCTP_SO_NOT_LOCKED);
165244249214SRandall Stewart 					}
165344249214SRandall Stewart 					break;
165444249214SRandall Stewart 				}
165544249214SRandall Stewart 			} else {
1656f8829a4aSRandall Stewart 				break;
1657f8829a4aSRandall Stewart 			}
1658f8829a4aSRandall Stewart 		}
1659f8829a4aSRandall Stewart 	}
1660c09a1534SMichael Tuexen 	if (do_wakeup) {
166144249214SRandall Stewart 		/* Need to wakeup the reader */
1662b1deed45SMichael Tuexen 		sctp_wakeup_the_read_socket(stcb->sctp_ep, stcb, SCTP_SO_NOT_LOCKED);
1663f8829a4aSRandall Stewart 	}
1664f8829a4aSRandall Stewart }
1665f8829a4aSRandall Stewart 
166644249214SRandall Stewart static struct sctp_queued_to_read *
166749656eefSMichael Tuexen sctp_find_reasm_entry(struct sctp_stream_in *strm, uint32_t mid, int ordered, int idata_supported)
1668f8829a4aSRandall Stewart {
1669c09a1534SMichael Tuexen 	struct sctp_queued_to_read *control;
1670f8829a4aSRandall Stewart 
167144249214SRandall Stewart 	if (ordered) {
1672c09a1534SMichael Tuexen 		TAILQ_FOREACH(control, &strm->inqueue, next_instrm) {
167349656eefSMichael Tuexen 			if (SCTP_MID_EQ(idata_supported, control->mid, mid)) {
167444249214SRandall Stewart 				break;
167544249214SRandall Stewart 			}
167644249214SRandall Stewart 		}
1677f8829a4aSRandall Stewart 	} else {
167849656eefSMichael Tuexen 		if (idata_supported) {
1679c09a1534SMichael Tuexen 			TAILQ_FOREACH(control, &strm->uno_inqueue, next_instrm) {
168049656eefSMichael Tuexen 				if (SCTP_MID_EQ(idata_supported, control->mid, mid)) {
168144249214SRandall Stewart 					break;
1682f8829a4aSRandall Stewart 				}
1683f8829a4aSRandall Stewart 			}
168449656eefSMichael Tuexen 		} else {
168549656eefSMichael Tuexen 			control = TAILQ_FIRST(&strm->uno_inqueue);
168649656eefSMichael Tuexen 		}
1687f8829a4aSRandall Stewart 	}
1688c09a1534SMichael Tuexen 	return (control);
1689f8829a4aSRandall Stewart }
169044249214SRandall Stewart 
1691f8829a4aSRandall Stewart static int
1692f8829a4aSRandall Stewart sctp_process_a_data_chunk(struct sctp_tcb *stcb, struct sctp_association *asoc,
169344249214SRandall Stewart     struct mbuf **m, int offset, int chk_length,
1694f8829a4aSRandall Stewart     struct sctp_nets *net, uint32_t *high_tsn, int *abort_flag,
16958b9c95f4SMichael Tuexen     int *break_flag, int last_chunk, uint8_t chk_type)
1696f8829a4aSRandall Stewart {
169795844fceSMichael Tuexen 	struct sctp_tmit_chunk *chk = NULL;	/* make gcc happy */
16986ddc8438SMichael Tuexen 	struct sctp_stream_in *strm;
169949656eefSMichael Tuexen 	uint32_t tsn, fsn, gap, mid;
1700f8829a4aSRandall Stewart 	struct mbuf *dmbuf;
17017215cc1bSMichael Tuexen 	int the_len;
1702139bc87fSRandall Stewart 	int need_reasm_check = 0;
170349656eefSMichael Tuexen 	uint16_t sid;
1704ff1ffd74SMichael Tuexen 	struct mbuf *op_err;
1705ff1ffd74SMichael Tuexen 	char msg[SCTP_DIAG_INFO_LEN];
170628cd0699SMichael Tuexen 	struct sctp_queued_to_read *control, *ncontrol;
170749656eefSMichael Tuexen 	uint32_t ppid;
17088b9c95f4SMichael Tuexen 	uint8_t chk_flags;
170917205eccSRandall Stewart 	struct sctp_stream_reset_list *liste;
171044249214SRandall Stewart 	int ordered;
171144249214SRandall Stewart 	size_t clen;
171244249214SRandall Stewart 	int created_control = 0;
1713f8829a4aSRandall Stewart 
17148b9c95f4SMichael Tuexen 	if (chk_type == SCTP_IDATA) {
17158b9c95f4SMichael Tuexen 		struct sctp_idata_chunk *chunk, chunk_buf;
17168b9c95f4SMichael Tuexen 
17178b9c95f4SMichael Tuexen 		chunk = (struct sctp_idata_chunk *)sctp_m_getptr(*m, offset,
171844249214SRandall Stewart 		    sizeof(struct sctp_idata_chunk), (uint8_t *)&chunk_buf);
17198b9c95f4SMichael Tuexen 		chk_flags = chunk->ch.chunk_flags;
172044249214SRandall Stewart 		clen = sizeof(struct sctp_idata_chunk);
17218b9c95f4SMichael Tuexen 		tsn = ntohl(chunk->dp.tsn);
17228b9c95f4SMichael Tuexen 		sid = ntohs(chunk->dp.sid);
17238b9c95f4SMichael Tuexen 		mid = ntohl(chunk->dp.mid);
17248b9c95f4SMichael Tuexen 		if (chk_flags & SCTP_DATA_FIRST_FRAG) {
172544249214SRandall Stewart 			fsn = 0;
17268b9c95f4SMichael Tuexen 			ppid = chunk->dp.ppid_fsn.ppid;
172744249214SRandall Stewart 		} else {
17288b9c95f4SMichael Tuexen 			fsn = ntohl(chunk->dp.ppid_fsn.fsn);
17298b9c95f4SMichael Tuexen 			ppid = 0xffffffff;	/* Use as an invalid value. */
173044249214SRandall Stewart 		}
17318b9c95f4SMichael Tuexen 	} else {
17328b9c95f4SMichael Tuexen 		struct sctp_data_chunk *chunk, chunk_buf;
17338b9c95f4SMichael Tuexen 
17348b9c95f4SMichael Tuexen 		chunk = (struct sctp_data_chunk *)sctp_m_getptr(*m, offset,
17358b9c95f4SMichael Tuexen 		    sizeof(struct sctp_data_chunk), (uint8_t *)&chunk_buf);
17368b9c95f4SMichael Tuexen 		chk_flags = chunk->ch.chunk_flags;
17378b9c95f4SMichael Tuexen 		clen = sizeof(struct sctp_data_chunk);
17388b9c95f4SMichael Tuexen 		tsn = ntohl(chunk->dp.tsn);
17398b9c95f4SMichael Tuexen 		sid = ntohs(chunk->dp.sid);
17408b9c95f4SMichael Tuexen 		mid = (uint32_t)(ntohs(chunk->dp.ssn));
17418b9c95f4SMichael Tuexen 		fsn = tsn;
17428b9c95f4SMichael Tuexen 		ppid = chunk->dp.ppid;
17438b9c95f4SMichael Tuexen 	}
174444249214SRandall Stewart 	if ((size_t)chk_length == clen) {
174544249214SRandall Stewart 		/*
174644249214SRandall Stewart 		 * Need to send an abort since we had a empty data chunk.
174744249214SRandall Stewart 		 */
17488b9c95f4SMichael Tuexen 		op_err = sctp_generate_no_user_data_cause(tsn);
174991e04f9eSMichael Tuexen 		stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_16;
1750105b68b4SMichael Tuexen 		sctp_abort_an_association(stcb->sctp_ep, stcb, op_err, false, SCTP_SO_NOT_LOCKED);
175144249214SRandall Stewart 		*abort_flag = 1;
175244249214SRandall Stewart 		return (0);
175344249214SRandall Stewart 	}
17548b9c95f4SMichael Tuexen 	if ((chk_flags & SCTP_DATA_SACK_IMMEDIATELY) == SCTP_DATA_SACK_IMMEDIATELY) {
1755b3f1ea41SRandall Stewart 		asoc->send_sack = 1;
1756b3f1ea41SRandall Stewart 	}
17578b9c95f4SMichael Tuexen 	ordered = ((chk_flags & SCTP_DATA_UNORDERED) == 0);
1758b3f1ea41SRandall Stewart 	if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MAP_LOGGING_ENABLE) {
1759c4739e2fSRandall Stewart 		sctp_log_map(tsn, asoc->cumulative_tsn, asoc->highest_tsn_inside_map, SCTP_MAP_TSN_ENTERS);
176080fefe0aSRandall Stewart 	}
1761ad81507eSRandall Stewart 	if (stcb == NULL) {
1762ad81507eSRandall Stewart 		return (0);
1763ad81507eSRandall Stewart 	}
17648b9c95f4SMichael Tuexen 	SCTP_LTRACE_CHK(stcb->sctp_ep, stcb, chk_type, tsn);
176520b07a4dSMichael Tuexen 	if (SCTP_TSN_GE(asoc->cumulative_tsn, tsn)) {
1766f8829a4aSRandall Stewart 		/* It is a duplicate */
1767f8829a4aSRandall Stewart 		SCTP_STAT_INCR(sctps_recvdupdata);
1768f8829a4aSRandall Stewart 		if (asoc->numduptsns < SCTP_MAX_DUP_TSNS) {
1769f8829a4aSRandall Stewart 			/* Record a dup for the next outbound sack */
1770f8829a4aSRandall Stewart 			asoc->dup_tsns[asoc->numduptsns] = tsn;
1771f8829a4aSRandall Stewart 			asoc->numduptsns++;
1772f8829a4aSRandall Stewart 		}
1773b201f536SRandall Stewart 		asoc->send_sack = 1;
1774f8829a4aSRandall Stewart 		return (0);
1775f8829a4aSRandall Stewart 	}
1776f8829a4aSRandall Stewart 	/* Calculate the number of TSN's between the base and this TSN */
1777d50c1d79SRandall Stewart 	SCTP_CALC_TSN_TO_GAP(gap, tsn, asoc->mapping_array_base_tsn);
1778f8829a4aSRandall Stewart 	if (gap >= (SCTP_MAPPING_ARRAY << 3)) {
1779f8829a4aSRandall Stewart 		/* Can't hold the bit in the mapping at max array, toss it */
1780f8829a4aSRandall Stewart 		return (0);
1781f8829a4aSRandall Stewart 	}
1782f8829a4aSRandall Stewart 	if (gap >= (uint32_t)(asoc->mapping_array_size << 3)) {
1783207304d4SRandall Stewart 		SCTP_TCB_LOCK_ASSERT(stcb);
17840696e120SRandall Stewart 		if (sctp_expand_mapping_array(asoc, gap)) {
1785f8829a4aSRandall Stewart 			/* Can't expand, drop it */
1786f8829a4aSRandall Stewart 			return (0);
1787f8829a4aSRandall Stewart 		}
1788f8829a4aSRandall Stewart 	}
178920b07a4dSMichael Tuexen 	if (SCTP_TSN_GT(tsn, *high_tsn)) {
1790f8829a4aSRandall Stewart 		*high_tsn = tsn;
1791f8829a4aSRandall Stewart 	}
1792f8829a4aSRandall Stewart 	/* See if we have received this one already */
179377acdc25SRandall Stewart 	if (SCTP_IS_TSN_PRESENT(asoc->mapping_array, gap) ||
179477acdc25SRandall Stewart 	    SCTP_IS_TSN_PRESENT(asoc->nr_mapping_array, gap)) {
1795f8829a4aSRandall Stewart 		SCTP_STAT_INCR(sctps_recvdupdata);
1796f8829a4aSRandall Stewart 		if (asoc->numduptsns < SCTP_MAX_DUP_TSNS) {
1797f8829a4aSRandall Stewart 			/* Record a dup for the next outbound sack */
1798f8829a4aSRandall Stewart 			asoc->dup_tsns[asoc->numduptsns] = tsn;
1799f8829a4aSRandall Stewart 			asoc->numduptsns++;
1800f8829a4aSRandall Stewart 		}
180142551e99SRandall Stewart 		asoc->send_sack = 1;
1802f8829a4aSRandall Stewart 		return (0);
1803f8829a4aSRandall Stewart 	}
1804f8829a4aSRandall Stewart 	/*
1805f8829a4aSRandall Stewart 	 * Check to see about the GONE flag, duplicates would cause a sack
1806f8829a4aSRandall Stewart 	 * to be sent up above
1807f8829a4aSRandall Stewart 	 */
1808ad81507eSRandall Stewart 	if (((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE) ||
1809f8829a4aSRandall Stewart 	    (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_SOCKET_ALLGONE) ||
1810ff1ffd74SMichael Tuexen 	    (stcb->asoc.state & SCTP_STATE_CLOSED_SOCKET))) {
1811f8829a4aSRandall Stewart 		/*
1812f8829a4aSRandall Stewart 		 * wait a minute, this guy is gone, there is no longer a
1813f8829a4aSRandall Stewart 		 * receiver. Send peer an ABORT!
1814f8829a4aSRandall Stewart 		 */
1815ff1ffd74SMichael Tuexen 		op_err = sctp_generate_cause(SCTP_CAUSE_OUT_OF_RESC, "");
1816105b68b4SMichael Tuexen 		sctp_abort_an_association(stcb->sctp_ep, stcb, op_err, false, SCTP_SO_NOT_LOCKED);
1817f8829a4aSRandall Stewart 		*abort_flag = 1;
1818f8829a4aSRandall Stewart 		return (0);
1819f8829a4aSRandall Stewart 	}
1820f8829a4aSRandall Stewart 	/*
1821f8829a4aSRandall Stewart 	 * Now before going further we see if there is room. If NOT then we
1822f8829a4aSRandall Stewart 	 * MAY let one through only IF this TSN is the one we are waiting
1823f8829a4aSRandall Stewart 	 * for on a partial delivery API.
1824f8829a4aSRandall Stewart 	 */
1825f8829a4aSRandall Stewart 
182644249214SRandall Stewart 	/* Is the stream valid? */
182749656eefSMichael Tuexen 	if (sid >= asoc->streamincnt) {
182886eda749SMichael Tuexen 		struct sctp_error_invalid_stream *cause;
1829f8829a4aSRandall Stewart 
183086eda749SMichael Tuexen 		op_err = sctp_get_mbuf_for_msg(sizeof(struct sctp_error_invalid_stream),
1831eb1b1807SGleb Smirnoff 		    0, M_NOWAIT, 1, MT_DATA);
183286eda749SMichael Tuexen 		if (op_err != NULL) {
1833f8829a4aSRandall Stewart 			/* add some space up front so prepend will work well */
183486eda749SMichael Tuexen 			SCTP_BUF_RESV_UF(op_err, sizeof(struct sctp_chunkhdr));
183586eda749SMichael Tuexen 			cause = mtod(op_err, struct sctp_error_invalid_stream *);
1836f8829a4aSRandall Stewart 			/*
1837f8829a4aSRandall Stewart 			 * Error causes are just param's and this one has
1838f8829a4aSRandall Stewart 			 * two back to back phdr, one with the error type
1839f8829a4aSRandall Stewart 			 * and size, the other with the streamid and a rsvd
1840f8829a4aSRandall Stewart 			 */
184186eda749SMichael Tuexen 			SCTP_BUF_LEN(op_err) = sizeof(struct sctp_error_invalid_stream);
184286eda749SMichael Tuexen 			cause->cause.code = htons(SCTP_CAUSE_INVALID_STREAM);
184386eda749SMichael Tuexen 			cause->cause.length = htons(sizeof(struct sctp_error_invalid_stream));
18448b9c95f4SMichael Tuexen 			cause->stream_id = htons(sid);
184586eda749SMichael Tuexen 			cause->reserved = htons(0);
184686eda749SMichael Tuexen 			sctp_queue_op_err(stcb, op_err);
1847f8829a4aSRandall Stewart 		}
1848f8829a4aSRandall Stewart 		SCTP_STAT_INCR(sctps_badsid);
1849207304d4SRandall Stewart 		SCTP_TCB_LOCK_ASSERT(stcb);
1850830d754dSRandall Stewart 		SCTP_SET_TSN_PRESENT(asoc->nr_mapping_array, gap);
185120b07a4dSMichael Tuexen 		if (SCTP_TSN_GT(tsn, asoc->highest_tsn_inside_nr_map)) {
1852830d754dSRandall Stewart 			asoc->highest_tsn_inside_nr_map = tsn;
1853d06c82f1SRandall Stewart 		}
1854d06c82f1SRandall Stewart 		if (tsn == (asoc->cumulative_tsn + 1)) {
1855d06c82f1SRandall Stewart 			/* Update cum-ack */
1856d06c82f1SRandall Stewart 			asoc->cumulative_tsn = tsn;
1857d06c82f1SRandall Stewart 		}
1858f8829a4aSRandall Stewart 		return (0);
1859f8829a4aSRandall Stewart 	}
1860f8829a4aSRandall Stewart 	/*
186144249214SRandall Stewart 	 * If its a fragmented message, lets see if we can find the control
186244249214SRandall Stewart 	 * on the reassembly queues.
1863f8829a4aSRandall Stewart 	 */
18648b9c95f4SMichael Tuexen 	if ((chk_type == SCTP_IDATA) &&
18658b9c95f4SMichael Tuexen 	    ((chk_flags & SCTP_DATA_FIRST_FRAG) == 0) &&
1866be46a7c5SMichael Tuexen 	    (fsn == 0)) {
186744249214SRandall Stewart 		/*
186844249214SRandall Stewart 		 * The first *must* be fsn 0, and other (middle/end) pieces
1869be46a7c5SMichael Tuexen 		 * can *not* be fsn 0. XXX: This can happen in case of a
1870be46a7c5SMichael Tuexen 		 * wrap around. Ignore is for now.
187144249214SRandall Stewart 		 */
1872999f86d6SMichael Tuexen 		SCTP_SNPRINTF(msg, sizeof(msg), "FSN zero for MID=%8.8x, but flags=%2.2x", mid, chk_flags);
187344249214SRandall Stewart 		goto err_out;
187444249214SRandall Stewart 	}
18753d6fe5d8SMichael Tuexen 	control = sctp_find_reasm_entry(&asoc->strmin[sid], mid, ordered, asoc->idata_supported);
187644249214SRandall Stewart 	SCTPDBG(SCTP_DEBUG_XXX, "chunk_flags:0x%x look for control on queues %p\n",
18778b9c95f4SMichael Tuexen 	    chk_flags, control);
18788b9c95f4SMichael Tuexen 	if ((chk_flags & SCTP_DATA_NOT_FRAG) != SCTP_DATA_NOT_FRAG) {
1879be46a7c5SMichael Tuexen 		/* See if we can find the re-assembly entity */
1880be46a7c5SMichael Tuexen 		if (control != NULL) {
188144249214SRandall Stewart 			/* We found something, does it belong? */
188249656eefSMichael Tuexen 			if (ordered && (mid != control->mid)) {
1883999f86d6SMichael Tuexen 				SCTP_SNPRINTF(msg, sizeof(msg), "Reassembly problem (MID=%8.8x)", mid);
188444249214SRandall Stewart 		err_out:
188544249214SRandall Stewart 				op_err = sctp_generate_cause(SCTP_CAUSE_PROTOCOL_VIOLATION, msg);
188691e04f9eSMichael Tuexen 				stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_17;
1887105b68b4SMichael Tuexen 				sctp_abort_an_association(stcb->sctp_ep, stcb, op_err, false, SCTP_SO_NOT_LOCKED);
188844249214SRandall Stewart 				*abort_flag = 1;
188944249214SRandall Stewart 				return (0);
189044249214SRandall Stewart 			}
189144249214SRandall Stewart 			if (ordered && ((control->sinfo_flags >> 8) & SCTP_DATA_UNORDERED)) {
1892b7b84c0eSMichael Tuexen 				/*
1893b7b84c0eSMichael Tuexen 				 * We can't have a switched order with an
1894b7b84c0eSMichael Tuexen 				 * unordered chunk
1895b7b84c0eSMichael Tuexen 				 */
1896999f86d6SMichael Tuexen 				SCTP_SNPRINTF(msg, sizeof(msg),
1897999f86d6SMichael Tuexen 				    "All fragments of a user message must be ordered or unordered (TSN=%8.8x)",
1898821bae7cSMichael Tuexen 				    tsn);
189944249214SRandall Stewart 				goto err_out;
190044249214SRandall Stewart 			}
190144249214SRandall Stewart 			if (!ordered && (((control->sinfo_flags >> 8) & SCTP_DATA_UNORDERED) == 0)) {
1902b7b84c0eSMichael Tuexen 				/*
1903b7b84c0eSMichael Tuexen 				 * We can't have a switched unordered with a
1904b7b84c0eSMichael Tuexen 				 * ordered chunk
1905b7b84c0eSMichael Tuexen 				 */
1906999f86d6SMichael Tuexen 				SCTP_SNPRINTF(msg, sizeof(msg),
1907999f86d6SMichael Tuexen 				    "All fragments of a user message must be ordered or unordered (TSN=%8.8x)",
1908821bae7cSMichael Tuexen 				    tsn);
190944249214SRandall Stewart 				goto err_out;
191044249214SRandall Stewart 			}
191144249214SRandall Stewart 		}
191244249214SRandall Stewart 	} else {
191344249214SRandall Stewart 		/*
191444249214SRandall Stewart 		 * Its a complete segment. Lets validate we don't have a
191544249214SRandall Stewart 		 * re-assembly going on with the same Stream/Seq (for
191644249214SRandall Stewart 		 * ordered) or in the same Stream for unordered.
191744249214SRandall Stewart 		 */
1918be46a7c5SMichael Tuexen 		if (control != NULL) {
191949656eefSMichael Tuexen 			if (ordered || asoc->idata_supported) {
192049656eefSMichael Tuexen 				SCTPDBG(SCTP_DEBUG_XXX, "chunk_flags: 0x%x dup detected on MID: %u\n",
19218b9c95f4SMichael Tuexen 				    chk_flags, mid);
1922999f86d6SMichael Tuexen 				SCTP_SNPRINTF(msg, sizeof(msg), "Duplicate MID=%8.8x detected.", mid);
192344249214SRandall Stewart 				goto err_out;
1924be46a7c5SMichael Tuexen 			} else {
1925be46a7c5SMichael Tuexen 				if ((tsn == control->fsn_included + 1) &&
1926be46a7c5SMichael Tuexen 				    (control->end_added == 0)) {
1927999f86d6SMichael Tuexen 					SCTP_SNPRINTF(msg, sizeof(msg),
1928999f86d6SMichael Tuexen 					    "Illegal message sequence, missing end for MID: %8.8x",
1929999f86d6SMichael Tuexen 					    control->fsn_included);
1930be46a7c5SMichael Tuexen 					goto err_out;
1931be46a7c5SMichael Tuexen 				} else {
1932be46a7c5SMichael Tuexen 					control = NULL;
1933be46a7c5SMichael Tuexen 				}
1934be46a7c5SMichael Tuexen 			}
193544249214SRandall Stewart 		}
193644249214SRandall Stewart 	}
193744249214SRandall Stewart 	/* now do the tests */
193844249214SRandall Stewart 	if (((asoc->cnt_on_all_streams +
193944249214SRandall Stewart 	    asoc->cnt_on_reasm_queue +
194044249214SRandall Stewart 	    asoc->cnt_msg_on_sb) >= SCTP_BASE_SYSCTL(sctp_max_chunks_on_queue)) ||
194144249214SRandall Stewart 	    (((int)asoc->my_rwnd) <= 0)) {
194244249214SRandall Stewart 		/*
194344249214SRandall Stewart 		 * When we have NO room in the rwnd we check to make sure
194444249214SRandall Stewart 		 * the reader is doing its job...
194544249214SRandall Stewart 		 */
1946edc5b6eaSMichael Tuexen 		if (SCTP_SBAVAIL(&stcb->sctp_socket->so_rcv) > 0) {
194744249214SRandall Stewart 			/* some to read, wake-up */
194844249214SRandall Stewart 			sctp_sorwakeup(stcb->sctp_ep, stcb->sctp_socket);
194944249214SRandall Stewart 		}
195044249214SRandall Stewart 		/* now is it in the mapping array of what we have accepted? */
19518b9c95f4SMichael Tuexen 		if (chk_type == SCTP_DATA) {
195244249214SRandall Stewart 			if (SCTP_TSN_GT(tsn, asoc->highest_tsn_inside_map) &&
195344249214SRandall Stewart 			    SCTP_TSN_GT(tsn, asoc->highest_tsn_inside_nr_map)) {
195444249214SRandall Stewart 				/* Nope not in the valid range dump it */
195544249214SRandall Stewart 		dump_packet:
195644249214SRandall Stewart 				sctp_set_rwnd(stcb, asoc);
195744249214SRandall Stewart 				if ((asoc->cnt_on_all_streams +
195844249214SRandall Stewart 				    asoc->cnt_on_reasm_queue +
195944249214SRandall Stewart 				    asoc->cnt_msg_on_sb) >= SCTP_BASE_SYSCTL(sctp_max_chunks_on_queue)) {
196044249214SRandall Stewart 					SCTP_STAT_INCR(sctps_datadropchklmt);
196144249214SRandall Stewart 				} else {
196244249214SRandall Stewart 					SCTP_STAT_INCR(sctps_datadroprwnd);
196344249214SRandall Stewart 				}
196444249214SRandall Stewart 				*break_flag = 1;
196544249214SRandall Stewart 				return (0);
196644249214SRandall Stewart 			}
196744249214SRandall Stewart 		} else {
196844249214SRandall Stewart 			if (control == NULL) {
196944249214SRandall Stewart 				goto dump_packet;
197044249214SRandall Stewart 			}
197144249214SRandall Stewart 			if (SCTP_TSN_GT(fsn, control->top_fsn)) {
197244249214SRandall Stewart 				goto dump_packet;
197344249214SRandall Stewart 			}
197444249214SRandall Stewart 		}
197544249214SRandall Stewart 	}
1976f42a358aSRandall Stewart #ifdef SCTP_ASOCLOG_OF_TSNS
197718e198d3SRandall Stewart 	SCTP_TCB_LOCK_ASSERT(stcb);
197818e198d3SRandall Stewart 	if (asoc->tsn_in_at >= SCTP_TSN_LOG_SIZE) {
197918e198d3SRandall Stewart 		asoc->tsn_in_at = 0;
198018e198d3SRandall Stewart 		asoc->tsn_in_wrapped = 1;
198118e198d3SRandall Stewart 	}
1982f42a358aSRandall Stewart 	asoc->in_tsnlog[asoc->tsn_in_at].tsn = tsn;
198349656eefSMichael Tuexen 	asoc->in_tsnlog[asoc->tsn_in_at].strm = sid;
198449656eefSMichael Tuexen 	asoc->in_tsnlog[asoc->tsn_in_at].seq = mid;
1985f1f73e57SRandall Stewart 	asoc->in_tsnlog[asoc->tsn_in_at].sz = chk_length;
1986f1f73e57SRandall Stewart 	asoc->in_tsnlog[asoc->tsn_in_at].flgs = chunk_flags;
198718e198d3SRandall Stewart 	asoc->in_tsnlog[asoc->tsn_in_at].stcb = (void *)stcb;
198818e198d3SRandall Stewart 	asoc->in_tsnlog[asoc->tsn_in_at].in_pos = asoc->tsn_in_at;
198918e198d3SRandall Stewart 	asoc->in_tsnlog[asoc->tsn_in_at].in_out = 1;
1990f42a358aSRandall Stewart 	asoc->tsn_in_at++;
1991f42a358aSRandall Stewart #endif
199244249214SRandall Stewart 	/*
199344249214SRandall Stewart 	 * Before we continue lets validate that we are not being fooled by
199444249214SRandall Stewart 	 * an evil attacker. We can only have Nk chunks based on our TSN
199544249214SRandall Stewart 	 * spread allowed by the mapping array N * 8 bits, so there is no
199644249214SRandall Stewart 	 * way our stream sequence numbers could have wrapped. We of course
199744249214SRandall Stewart 	 * only validate the FIRST fragment so the bit must be set.
199844249214SRandall Stewart 	 */
19998b9c95f4SMichael Tuexen 	if ((chk_flags & SCTP_DATA_FIRST_FRAG) &&
2000d61a0ae0SRandall Stewart 	    (TAILQ_EMPTY(&asoc->resetHead)) &&
20018b9c95f4SMichael Tuexen 	    (chk_flags & SCTP_DATA_UNORDERED) == 0 &&
200249656eefSMichael Tuexen 	    SCTP_MID_GE(asoc->idata_supported, asoc->strmin[sid].last_mid_delivered, mid)) {
2003f8829a4aSRandall Stewart 		/* The incoming sseq is behind where we last delivered? */
2004f2ea2a2dSMichael Tuexen 		SCTPDBG(SCTP_DEBUG_INDATA1, "EVIL/Broken-Dup S-SEQ: %u delivered: %u from peer, Abort!\n",
200549656eefSMichael Tuexen 		    mid, asoc->strmin[sid].last_mid_delivered);
2006f8829a4aSRandall Stewart 
200749656eefSMichael Tuexen 		if (asoc->idata_supported) {
2008999f86d6SMichael Tuexen 			SCTP_SNPRINTF(msg, sizeof(msg), "Delivered MID=%8.8x, got TSN=%8.8x, SID=%4.4x, MID=%8.8x",
200949656eefSMichael Tuexen 			    asoc->strmin[sid].last_mid_delivered,
201049656eefSMichael Tuexen 			    tsn,
201149656eefSMichael Tuexen 			    sid,
2012821bae7cSMichael Tuexen 			    mid);
201349656eefSMichael Tuexen 		} else {
2014999f86d6SMichael Tuexen 			SCTP_SNPRINTF(msg, sizeof(msg), "Delivered SSN=%4.4x, got TSN=%8.8x, SID=%4.4x, SSN=%4.4x",
201549656eefSMichael Tuexen 			    (uint16_t)asoc->strmin[sid].last_mid_delivered,
201649656eefSMichael Tuexen 			    tsn,
201749656eefSMichael Tuexen 			    sid,
2018821bae7cSMichael Tuexen 			    (uint16_t)mid);
201949656eefSMichael Tuexen 		}
2020ff1ffd74SMichael Tuexen 		op_err = sctp_generate_cause(SCTP_CAUSE_PROTOCOL_VIOLATION, msg);
202191e04f9eSMichael Tuexen 		stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_18;
2022105b68b4SMichael Tuexen 		sctp_abort_an_association(stcb->sctp_ep, stcb, op_err, false, SCTP_SO_NOT_LOCKED);
2023f8829a4aSRandall Stewart 		*abort_flag = 1;
2024f8829a4aSRandall Stewart 		return (0);
2025f8829a4aSRandall Stewart 	}
20268b9c95f4SMichael Tuexen 	if (chk_type == SCTP_IDATA) {
202744249214SRandall Stewart 		the_len = (chk_length - sizeof(struct sctp_idata_chunk));
202844249214SRandall Stewart 	} else {
2029f8829a4aSRandall Stewart 		the_len = (chk_length - sizeof(struct sctp_data_chunk));
203044249214SRandall Stewart 	}
2031f8829a4aSRandall Stewart 	if (last_chunk == 0) {
20328b9c95f4SMichael Tuexen 		if (chk_type == SCTP_IDATA) {
203344249214SRandall Stewart 			dmbuf = SCTP_M_COPYM(*m,
203444249214SRandall Stewart 			    (offset + sizeof(struct sctp_idata_chunk)),
203544249214SRandall Stewart 			    the_len, M_NOWAIT);
203644249214SRandall Stewart 		} else {
203744b7479bSRandall Stewart 			dmbuf = SCTP_M_COPYM(*m,
2038f8829a4aSRandall Stewart 			    (offset + sizeof(struct sctp_data_chunk)),
2039eb1b1807SGleb Smirnoff 			    the_len, M_NOWAIT);
204044249214SRandall Stewart 		}
2041f8829a4aSRandall Stewart #ifdef SCTP_MBUF_LOGGING
2042b3f1ea41SRandall Stewart 		if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
20434be807c4SMichael Tuexen 			sctp_log_mbc(dmbuf, SCTP_MBUF_ICOPY);
2044f8829a4aSRandall Stewart 		}
2045f8829a4aSRandall Stewart #endif
2046f8829a4aSRandall Stewart 	} else {
2047f8829a4aSRandall Stewart 		/* We can steal the last chunk */
2048139bc87fSRandall Stewart 		int l_len;
2049139bc87fSRandall Stewart 
2050f8829a4aSRandall Stewart 		dmbuf = *m;
2051f8829a4aSRandall Stewart 		/* lop off the top part */
20528b9c95f4SMichael Tuexen 		if (chk_type == SCTP_IDATA) {
205344249214SRandall Stewart 			m_adj(dmbuf, (offset + sizeof(struct sctp_idata_chunk)));
205444249214SRandall Stewart 		} else {
2055f8829a4aSRandall Stewart 			m_adj(dmbuf, (offset + sizeof(struct sctp_data_chunk)));
205644249214SRandall Stewart 		}
2057139bc87fSRandall Stewart 		if (SCTP_BUF_NEXT(dmbuf) == NULL) {
2058139bc87fSRandall Stewart 			l_len = SCTP_BUF_LEN(dmbuf);
2059139bc87fSRandall Stewart 		} else {
2060139bc87fSRandall Stewart 			/*
2061139bc87fSRandall Stewart 			 * need to count up the size hopefully does not hit
2062139bc87fSRandall Stewart 			 * this to often :-0
2063139bc87fSRandall Stewart 			 */
2064139bc87fSRandall Stewart 			struct mbuf *lat;
2065139bc87fSRandall Stewart 
2066139bc87fSRandall Stewart 			l_len = 0;
206760990c0cSMichael Tuexen 			for (lat = dmbuf; lat; lat = SCTP_BUF_NEXT(lat)) {
2068139bc87fSRandall Stewart 				l_len += SCTP_BUF_LEN(lat);
2069139bc87fSRandall Stewart 			}
2070139bc87fSRandall Stewart 		}
2071139bc87fSRandall Stewart 		if (l_len > the_len) {
2072f8829a4aSRandall Stewart 			/* Trim the end round bytes off  too */
2073139bc87fSRandall Stewart 			m_adj(dmbuf, -(l_len - the_len));
2074f8829a4aSRandall Stewart 		}
2075f8829a4aSRandall Stewart 	}
2076f8829a4aSRandall Stewart 	if (dmbuf == NULL) {
2077f8829a4aSRandall Stewart 		SCTP_STAT_INCR(sctps_nomem);
2078f8829a4aSRandall Stewart 		return (0);
2079f8829a4aSRandall Stewart 	}
208044249214SRandall Stewart 	/*
20818b9c95f4SMichael Tuexen 	 * Now no matter what, we need a control, get one if we don't have
208244249214SRandall Stewart 	 * one (we may have gotten it above when we found the message was
208344249214SRandall Stewart 	 * fragmented
208444249214SRandall Stewart 	 */
208544249214SRandall Stewart 	if (control == NULL) {
208644249214SRandall Stewart 		sctp_alloc_a_readq(stcb, control);
208744249214SRandall Stewart 		sctp_build_readq_entry_mac(control, stcb, asoc->context, net, tsn,
208849656eefSMichael Tuexen 		    ppid,
208949656eefSMichael Tuexen 		    sid,
20908b9c95f4SMichael Tuexen 		    chk_flags,
209149656eefSMichael Tuexen 		    NULL, fsn, mid);
209244249214SRandall Stewart 		if (control == NULL) {
209344249214SRandall Stewart 			SCTP_STAT_INCR(sctps_nomem);
209444249214SRandall Stewart 			return (0);
209544249214SRandall Stewart 		}
20968b9c95f4SMichael Tuexen 		if ((chk_flags & SCTP_DATA_NOT_FRAG) == SCTP_DATA_NOT_FRAG) {
20971f76872cSMichael Tuexen 			struct mbuf *mm;
209828cd0699SMichael Tuexen 
209944249214SRandall Stewart 			control->data = dmbuf;
210063fb39baSMichael Tuexen 			control->tail_mbuf = NULL;
21011f76872cSMichael Tuexen 			for (mm = control->data; mm; mm = mm->m_next) {
21021f76872cSMichael Tuexen 				control->length += SCTP_BUF_LEN(mm);
210363fb39baSMichael Tuexen 				if (SCTP_BUF_NEXT(mm) == NULL) {
210463fb39baSMichael Tuexen 					control->tail_mbuf = mm;
210528cd0699SMichael Tuexen 				}
210663fb39baSMichael Tuexen 			}
21078b9c95f4SMichael Tuexen 			control->end_added = 1;
21088b9c95f4SMichael Tuexen 			control->last_frag_seen = 1;
21098b9c95f4SMichael Tuexen 			control->first_frag_seen = 1;
21108b9c95f4SMichael Tuexen 			control->fsn_included = fsn;
21118b9c95f4SMichael Tuexen 			control->top_fsn = fsn;
211244249214SRandall Stewart 		}
211344249214SRandall Stewart 		created_control = 1;
211444249214SRandall Stewart 	}
211549656eefSMichael Tuexen 	SCTPDBG(SCTP_DEBUG_XXX, "chunk_flags: 0x%x ordered: %d MID: %u control: %p\n",
21168b9c95f4SMichael Tuexen 	    chk_flags, ordered, mid, control);
21178b9c95f4SMichael Tuexen 	if ((chk_flags & SCTP_DATA_NOT_FRAG) == SCTP_DATA_NOT_FRAG &&
2118f8829a4aSRandall Stewart 	    TAILQ_EMPTY(&asoc->resetHead) &&
2119f42a358aSRandall Stewart 	    ((ordered == 0) ||
212049656eefSMichael Tuexen 	    (SCTP_MID_EQ(asoc->idata_supported, asoc->strmin[sid].last_mid_delivered + 1, mid) &&
212149656eefSMichael Tuexen 	    TAILQ_EMPTY(&asoc->strmin[sid].inqueue)))) {
2122f8829a4aSRandall Stewart 		/* Candidate for express delivery */
2123f8829a4aSRandall Stewart 		/*
2124f8829a4aSRandall Stewart 		 * Its not fragmented, No PD-API is up, Nothing in the
2125f8829a4aSRandall Stewart 		 * delivery queue, Its un-ordered OR ordered and the next to
2126f8829a4aSRandall Stewart 		 * deliver AND nothing else is stuck on the stream queue,
2127f8829a4aSRandall Stewart 		 * And there is room for it in the socket buffer. Lets just
2128f8829a4aSRandall Stewart 		 * stuff it up the buffer....
2129f8829a4aSRandall Stewart 		 */
21301ea735c8SMichael Tuexen 		SCTP_SET_TSN_PRESENT(asoc->nr_mapping_array, gap);
213120b07a4dSMichael Tuexen 		if (SCTP_TSN_GT(tsn, asoc->highest_tsn_inside_nr_map)) {
21321ea735c8SMichael Tuexen 			asoc->highest_tsn_inside_nr_map = tsn;
21331ea735c8SMichael Tuexen 		}
213449656eefSMichael Tuexen 		SCTPDBG(SCTP_DEBUG_XXX, "Injecting control: %p to be read (MID: %u)\n",
213549656eefSMichael Tuexen 		    control, mid);
213644249214SRandall Stewart 
2137cfde3ff7SRandall Stewart 		sctp_add_to_readq(stcb->sctp_ep, stcb,
2138cfde3ff7SRandall Stewart 		    control, &stcb->sctp_socket->so_rcv,
2139cfde3ff7SRandall Stewart 		    1, SCTP_READ_LOCK_NOT_HELD, SCTP_SO_NOT_LOCKED);
2140830d754dSRandall Stewart 
21418b9c95f4SMichael Tuexen 		if ((chk_flags & SCTP_DATA_UNORDERED) == 0) {
2142f8829a4aSRandall Stewart 			/* for ordered, bump what we delivered */
21433d6fe5d8SMichael Tuexen 			asoc->strmin[sid].last_mid_delivered++;
2144f8829a4aSRandall Stewart 		}
2145f8829a4aSRandall Stewart 		SCTP_STAT_INCR(sctps_recvexpress);
2146b3f1ea41SRandall Stewart 		if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_STR_LOGGING_ENABLE) {
214749656eefSMichael Tuexen 			sctp_log_strm_del_alt(stcb, tsn, mid, sid,
2148f8829a4aSRandall Stewart 			    SCTP_STR_LOG_FROM_EXPRS_DEL);
214980fefe0aSRandall Stewart 		}
2150f8829a4aSRandall Stewart 		control = NULL;
2151f8829a4aSRandall Stewart 		goto finish_express_del;
2152f8829a4aSRandall Stewart 	}
21530053ed28SMichael Tuexen 
215444249214SRandall Stewart 	/* Now will we need a chunk too? */
21558b9c95f4SMichael Tuexen 	if ((chk_flags & SCTP_DATA_NOT_FRAG) != SCTP_DATA_NOT_FRAG) {
2156f8829a4aSRandall Stewart 		sctp_alloc_a_chunk(stcb, chk);
2157f8829a4aSRandall Stewart 		if (chk == NULL) {
2158f8829a4aSRandall Stewart 			/* No memory so we drop the chunk */
2159f8829a4aSRandall Stewart 			SCTP_STAT_INCR(sctps_nomem);
2160f8829a4aSRandall Stewart 			if (last_chunk == 0) {
2161f8829a4aSRandall Stewart 				/* we copied it, free the copy */
2162f8829a4aSRandall Stewart 				sctp_m_freem(dmbuf);
2163f8829a4aSRandall Stewart 			}
2164f8829a4aSRandall Stewart 			return (0);
2165f8829a4aSRandall Stewart 		}
216649656eefSMichael Tuexen 		chk->rec.data.tsn = tsn;
2167f8829a4aSRandall Stewart 		chk->no_fr_allowed = 0;
216849656eefSMichael Tuexen 		chk->rec.data.fsn = fsn;
216949656eefSMichael Tuexen 		chk->rec.data.mid = mid;
217049656eefSMichael Tuexen 		chk->rec.data.sid = sid;
217149656eefSMichael Tuexen 		chk->rec.data.ppid = ppid;
2172f8829a4aSRandall Stewart 		chk->rec.data.context = stcb->asoc.context;
2173f8829a4aSRandall Stewart 		chk->rec.data.doing_fast_retransmit = 0;
21748b9c95f4SMichael Tuexen 		chk->rec.data.rcv_flags = chk_flags;
2175f8829a4aSRandall Stewart 		chk->asoc = asoc;
2176f8829a4aSRandall Stewart 		chk->send_size = the_len;
2177f8829a4aSRandall Stewart 		chk->whoTo = net;
217849656eefSMichael Tuexen 		SCTPDBG(SCTP_DEBUG_XXX, "Building ck: %p for control: %p to be read (MID: %u)\n",
217944249214SRandall Stewart 		    chk,
218049656eefSMichael Tuexen 		    control, mid);
2181f8829a4aSRandall Stewart 		atomic_add_int(&net->ref_count, 1);
2182f8829a4aSRandall Stewart 		chk->data = dmbuf;
218344249214SRandall Stewart 	}
218444249214SRandall Stewart 	/* Set the appropriate TSN mark */
218544249214SRandall Stewart 	if (SCTP_BASE_SYSCTL(sctp_do_drain) == 0) {
218644249214SRandall Stewart 		SCTP_SET_TSN_PRESENT(asoc->nr_mapping_array, gap);
218744249214SRandall Stewart 		if (SCTP_TSN_GT(tsn, asoc->highest_tsn_inside_nr_map)) {
218844249214SRandall Stewart 			asoc->highest_tsn_inside_nr_map = tsn;
218944249214SRandall Stewart 		}
2190f8829a4aSRandall Stewart 	} else {
219144249214SRandall Stewart 		SCTP_SET_TSN_PRESENT(asoc->mapping_array, gap);
219244249214SRandall Stewart 		if (SCTP_TSN_GT(tsn, asoc->highest_tsn_inside_map)) {
219344249214SRandall Stewart 			asoc->highest_tsn_inside_map = tsn;
2194f8829a4aSRandall Stewart 		}
2195f8829a4aSRandall Stewart 	}
219644249214SRandall Stewart 	/* Now is it complete (i.e. not fragmented)? */
21978b9c95f4SMichael Tuexen 	if ((chk_flags & SCTP_DATA_NOT_FRAG) == SCTP_DATA_NOT_FRAG) {
2198f8829a4aSRandall Stewart 		/*
219944249214SRandall Stewart 		 * Special check for when streams are resetting. We could be
220044249214SRandall Stewart 		 * more smart about this and check the actual stream to see
220144249214SRandall Stewart 		 * if it is not being reset.. that way we would not create a
220244249214SRandall Stewart 		 * HOLB when amongst streams being reset and those not being
220344249214SRandall Stewart 		 * reset.
2204f8829a4aSRandall Stewart 		 *
2205f8829a4aSRandall Stewart 		 */
2206f8829a4aSRandall Stewart 		if (((liste = TAILQ_FIRST(&asoc->resetHead)) != NULL) &&
220720b07a4dSMichael Tuexen 		    SCTP_TSN_GT(tsn, liste->tsn)) {
2208f8829a4aSRandall Stewart 			/*
220944249214SRandall Stewart 			 * yep its past where we need to reset... go ahead
221044249214SRandall Stewart 			 * and queue it.
2211f8829a4aSRandall Stewart 			 */
2212f8829a4aSRandall Stewart 			if (TAILQ_EMPTY(&asoc->pending_reply_queue)) {
2213f8829a4aSRandall Stewart 				/* first one on */
2214f8829a4aSRandall Stewart 				TAILQ_INSERT_TAIL(&asoc->pending_reply_queue, control, next);
2215f8829a4aSRandall Stewart 			} else {
221628cd0699SMichael Tuexen 				struct sctp_queued_to_read *lcontrol, *nlcontrol;
2217f8829a4aSRandall Stewart 				unsigned char inserted = 0;
2218f8829a4aSRandall Stewart 
221928cd0699SMichael Tuexen 				TAILQ_FOREACH_SAFE(lcontrol, &asoc->pending_reply_queue, next, nlcontrol) {
222028cd0699SMichael Tuexen 					if (SCTP_TSN_GT(control->sinfo_tsn, lcontrol->sinfo_tsn)) {
22214a9ef3f8SMichael Tuexen 						continue;
2222f8829a4aSRandall Stewart 					} else {
2223f8829a4aSRandall Stewart 						/* found it */
222428cd0699SMichael Tuexen 						TAILQ_INSERT_BEFORE(lcontrol, control, next);
2225f8829a4aSRandall Stewart 						inserted = 1;
2226f8829a4aSRandall Stewart 						break;
2227f8829a4aSRandall Stewart 					}
2228f8829a4aSRandall Stewart 				}
2229f8829a4aSRandall Stewart 				if (inserted == 0) {
2230f8829a4aSRandall Stewart 					/*
223144249214SRandall Stewart 					 * must be put at end, use prevP
223244249214SRandall Stewart 					 * (all setup from loop) to setup
223344249214SRandall Stewart 					 * nextP.
2234f8829a4aSRandall Stewart 					 */
2235f8829a4aSRandall Stewart 					TAILQ_INSERT_TAIL(&asoc->pending_reply_queue, control, next);
2236f8829a4aSRandall Stewart 				}
2237f8829a4aSRandall Stewart 			}
223844249214SRandall Stewart 			goto finish_express_del;
223944249214SRandall Stewart 		}
22408b9c95f4SMichael Tuexen 		if (chk_flags & SCTP_DATA_UNORDERED) {
224144249214SRandall Stewart 			/* queue directly into socket buffer */
224249656eefSMichael Tuexen 			SCTPDBG(SCTP_DEBUG_XXX, "Unordered data to be read control: %p MID: %u\n",
224349656eefSMichael Tuexen 			    control, mid);
224444249214SRandall Stewart 			sctp_mark_non_revokable(asoc, control->sinfo_tsn);
224544249214SRandall Stewart 			sctp_add_to_readq(stcb->sctp_ep, stcb,
224644249214SRandall Stewart 			    control,
224744249214SRandall Stewart 			    &stcb->sctp_socket->so_rcv, 1,
224844249214SRandall Stewart 			    SCTP_READ_LOCK_NOT_HELD, SCTP_SO_NOT_LOCKED);
224944249214SRandall Stewart 
2250f8829a4aSRandall Stewart 		} else {
225149656eefSMichael Tuexen 			SCTPDBG(SCTP_DEBUG_XXX, "Queue control: %p for reordering MID: %u\n", control,
225249656eefSMichael Tuexen 			    mid);
22533d6fe5d8SMichael Tuexen 			sctp_queue_data_to_stream(stcb, asoc, control, abort_flag, &need_reasm_check);
2254f8829a4aSRandall Stewart 			if (*abort_flag) {
22558be0fd55SMichael Tuexen 				if (last_chunk) {
22568be0fd55SMichael Tuexen 					*m = NULL;
22578be0fd55SMichael Tuexen 				}
2258f8829a4aSRandall Stewart 				return (0);
2259f8829a4aSRandall Stewart 			}
2260f8829a4aSRandall Stewart 		}
226144249214SRandall Stewart 		goto finish_express_del;
2262f8829a4aSRandall Stewart 	}
226344249214SRandall Stewart 	/* If we reach here its a reassembly */
226444249214SRandall Stewart 	need_reasm_check = 1;
226544249214SRandall Stewart 	SCTPDBG(SCTP_DEBUG_XXX,
226649656eefSMichael Tuexen 	    "Queue data to stream for reasm control: %p MID: %u\n",
226749656eefSMichael Tuexen 	    control, mid);
22683d6fe5d8SMichael Tuexen 	sctp_queue_data_for_reasm(stcb, asoc, control, chk, created_control, abort_flag, tsn);
2269f8829a4aSRandall Stewart 	if (*abort_flag) {
2270a5d547adSRandall Stewart 		/*
227144249214SRandall Stewart 		 * the assoc is now gone and chk was put onto the reasm
227244249214SRandall Stewart 		 * queue, which has all been freed.
2273a5d547adSRandall Stewart 		 */
22748be0fd55SMichael Tuexen 		if (last_chunk) {
2275a5d547adSRandall Stewart 			*m = NULL;
22768be0fd55SMichael Tuexen 		}
2277f8829a4aSRandall Stewart 		return (0);
2278f8829a4aSRandall Stewart 	}
2279f8829a4aSRandall Stewart finish_express_del:
228044249214SRandall Stewart 	/* Here we tidy up things */
2281307b49efSMichael Tuexen 	if (tsn == (asoc->cumulative_tsn + 1)) {
2282307b49efSMichael Tuexen 		/* Update cum-ack */
2283307b49efSMichael Tuexen 		asoc->cumulative_tsn = tsn;
2284307b49efSMichael Tuexen 	}
2285f8829a4aSRandall Stewart 	if (last_chunk) {
2286f8829a4aSRandall Stewart 		*m = NULL;
2287f8829a4aSRandall Stewart 	}
2288f42a358aSRandall Stewart 	if (ordered) {
2289f8829a4aSRandall Stewart 		SCTP_STAT_INCR_COUNTER64(sctps_inorderchunks);
2290f8829a4aSRandall Stewart 	} else {
2291f8829a4aSRandall Stewart 		SCTP_STAT_INCR_COUNTER64(sctps_inunorderchunks);
2292f8829a4aSRandall Stewart 	}
2293f8829a4aSRandall Stewart 	SCTP_STAT_INCR(sctps_recvdata);
2294f8829a4aSRandall Stewart 	/* Set it present please */
2295b3f1ea41SRandall Stewart 	if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_STR_LOGGING_ENABLE) {
229649656eefSMichael Tuexen 		sctp_log_strm_del_alt(stcb, tsn, mid, sid, SCTP_STR_LOG_FROM_MARK_TSN);
229780fefe0aSRandall Stewart 	}
2298b3f1ea41SRandall Stewart 	if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MAP_LOGGING_ENABLE) {
2299f8829a4aSRandall Stewart 		sctp_log_map(asoc->mapping_array_base_tsn, asoc->cumulative_tsn,
2300f8829a4aSRandall Stewart 		    asoc->highest_tsn_inside_map, SCTP_MAP_PREPARE_SLIDE);
230180fefe0aSRandall Stewart 	}
23023d6fe5d8SMichael Tuexen 	if (need_reasm_check) {
23033d6fe5d8SMichael Tuexen 		(void)sctp_deliver_reasm_check(stcb, asoc, &asoc->strmin[sid], SCTP_READ_LOCK_NOT_HELD);
23043d6fe5d8SMichael Tuexen 		need_reasm_check = 0;
23053d6fe5d8SMichael Tuexen 	}
230617205eccSRandall Stewart 	/* check the special flag for stream resets */
230717205eccSRandall Stewart 	if (((liste = TAILQ_FIRST(&asoc->resetHead)) != NULL) &&
230820b07a4dSMichael Tuexen 	    SCTP_TSN_GE(asoc->cumulative_tsn, liste->tsn)) {
230917205eccSRandall Stewart 		/*
231017205eccSRandall Stewart 		 * we have finished working through the backlogged TSN's now
231117205eccSRandall Stewart 		 * time to reset streams. 1: call reset function. 2: free
231217205eccSRandall Stewart 		 * pending_reply space 3: distribute any chunks in
231317205eccSRandall Stewart 		 * pending_reply_queue.
231417205eccSRandall Stewart 		 */
2315a169d6ecSMichael Tuexen 		sctp_reset_in_stream(stcb, liste->number_entries, liste->list_of_streams);
231617205eccSRandall Stewart 		TAILQ_REMOVE(&asoc->resetHead, liste, next_resp);
23177cca1775SRandall Stewart 		sctp_send_deferred_reset_response(stcb, liste, SCTP_STREAM_RESET_RESULT_PERFORMED);
2318207304d4SRandall Stewart 		SCTP_FREE(liste, SCTP_M_STRESET);
23193c503c28SRandall Stewart 		/* sa_ignore FREED_MEMORY */
232017205eccSRandall Stewart 		liste = TAILQ_FIRST(&asoc->resetHead);
23214a9ef3f8SMichael Tuexen 		if (TAILQ_EMPTY(&asoc->resetHead)) {
232217205eccSRandall Stewart 			/* All can be removed */
232328cd0699SMichael Tuexen 			TAILQ_FOREACH_SAFE(control, &asoc->pending_reply_queue, next, ncontrol) {
232428cd0699SMichael Tuexen 				TAILQ_REMOVE(&asoc->pending_reply_queue, control, next);
23256ddc8438SMichael Tuexen 				strm = &asoc->strmin[control->sinfo_stream];
232628cd0699SMichael Tuexen 				sctp_queue_data_to_stream(stcb, asoc, control, abort_flag, &need_reasm_check);
232717205eccSRandall Stewart 				if (*abort_flag) {
232817205eccSRandall Stewart 					return (0);
232917205eccSRandall Stewart 				}
23303d6fe5d8SMichael Tuexen 				if (need_reasm_check) {
23316ddc8438SMichael Tuexen 					(void)sctp_deliver_reasm_check(stcb, asoc, strm, SCTP_READ_LOCK_NOT_HELD);
23323d6fe5d8SMichael Tuexen 					need_reasm_check = 0;
23333d6fe5d8SMichael Tuexen 				}
233417205eccSRandall Stewart 			}
23354a9ef3f8SMichael Tuexen 		} else {
233628cd0699SMichael Tuexen 			TAILQ_FOREACH_SAFE(control, &asoc->pending_reply_queue, next, ncontrol) {
233728cd0699SMichael Tuexen 				if (SCTP_TSN_GT(control->sinfo_tsn, liste->tsn)) {
23384a9ef3f8SMichael Tuexen 					break;
23394a9ef3f8SMichael Tuexen 				}
234017205eccSRandall Stewart 				/*
234128cd0699SMichael Tuexen 				 * if control->sinfo_tsn is <= liste->tsn we
234228cd0699SMichael Tuexen 				 * can process it which is the NOT of
234328cd0699SMichael Tuexen 				 * control->sinfo_tsn > liste->tsn
234417205eccSRandall Stewart 				 */
234528cd0699SMichael Tuexen 				TAILQ_REMOVE(&asoc->pending_reply_queue, control, next);
23466ddc8438SMichael Tuexen 				strm = &asoc->strmin[control->sinfo_stream];
234728cd0699SMichael Tuexen 				sctp_queue_data_to_stream(stcb, asoc, control, abort_flag, &need_reasm_check);
234817205eccSRandall Stewart 				if (*abort_flag) {
234917205eccSRandall Stewart 					return (0);
235017205eccSRandall Stewart 				}
23513d6fe5d8SMichael Tuexen 				if (need_reasm_check) {
23526ddc8438SMichael Tuexen 					(void)sctp_deliver_reasm_check(stcb, asoc, strm, SCTP_READ_LOCK_NOT_HELD);
235317205eccSRandall Stewart 					need_reasm_check = 0;
235417205eccSRandall Stewart 				}
23553d6fe5d8SMichael Tuexen 			}
23563d6fe5d8SMichael Tuexen 		}
2357139bc87fSRandall Stewart 	}
2358f8829a4aSRandall Stewart 	return (1);
2359f8829a4aSRandall Stewart }
2360f8829a4aSRandall Stewart 
2361ed654363SMichael Tuexen static const int8_t sctp_map_lookup_tab[256] = {
2362b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 3,
2363b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 4,
2364b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 3,
2365b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 5,
2366b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 3,
2367b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 4,
2368b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 3,
2369b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 6,
2370b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 3,
2371b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 4,
2372b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 3,
2373b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 5,
2374b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 3,
2375b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 4,
2376b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 3,
2377b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 7,
2378b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 3,
2379b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 4,
2380b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 3,
2381b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 5,
2382b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 3,
2383b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 4,
2384b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 3,
2385b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 6,
2386b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 3,
2387b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 4,
2388b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 3,
2389b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 5,
2390b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 3,
2391b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 4,
2392b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 3,
2393b5c16493SMichael Tuexen 	0, 1, 0, 2, 0, 1, 0, 8
2394f8829a4aSRandall Stewart };
2395f8829a4aSRandall Stewart 
2396f8829a4aSRandall Stewart void
2397b5c16493SMichael Tuexen sctp_slide_mapping_arrays(struct sctp_tcb *stcb)
2398f8829a4aSRandall Stewart {
2399f8829a4aSRandall Stewart 	/*
2400f8829a4aSRandall Stewart 	 * Now we also need to check the mapping array in a couple of ways.
2401f8829a4aSRandall Stewart 	 * 1) Did we move the cum-ack point?
240266bd30bdSRandall Stewart 	 *
24035b495f17SMichael Tuexen 	 * When you first glance at this you might think that all entries
24045b495f17SMichael Tuexen 	 * that make up the position of the cum-ack would be in the
24055b495f17SMichael Tuexen 	 * nr-mapping array only.. i.e. things up to the cum-ack are always
240666bd30bdSRandall Stewart 	 * deliverable. Thats true with one exception, when its a fragmented
240766bd30bdSRandall Stewart 	 * message we may not deliver the data until some threshold (or all
240866bd30bdSRandall Stewart 	 * of it) is in place. So we must OR the nr_mapping_array and
240966bd30bdSRandall Stewart 	 * mapping_array to get a true picture of the cum-ack.
2410f8829a4aSRandall Stewart 	 */
2411f8829a4aSRandall Stewart 	struct sctp_association *asoc;
2412b3f1ea41SRandall Stewart 	int at;
241366bd30bdSRandall Stewart 	uint8_t val;
2414f8829a4aSRandall Stewart 	int slide_from, slide_end, lgap, distance;
241577acdc25SRandall Stewart 	uint32_t old_cumack, old_base, old_highest, highest_tsn;
2416f8829a4aSRandall Stewart 
2417f8829a4aSRandall Stewart 	asoc = &stcb->asoc;
2418f8829a4aSRandall Stewart 
2419f8829a4aSRandall Stewart 	old_cumack = asoc->cumulative_tsn;
2420f8829a4aSRandall Stewart 	old_base = asoc->mapping_array_base_tsn;
2421f8829a4aSRandall Stewart 	old_highest = asoc->highest_tsn_inside_map;
2422f8829a4aSRandall Stewart 	/*
2423f8829a4aSRandall Stewart 	 * We could probably improve this a small bit by calculating the
2424f8829a4aSRandall Stewart 	 * offset of the current cum-ack as the starting point.
2425f8829a4aSRandall Stewart 	 */
2426f8829a4aSRandall Stewart 	at = 0;
2427b5c16493SMichael Tuexen 	for (slide_from = 0; slide_from < stcb->asoc.mapping_array_size; slide_from++) {
242866bd30bdSRandall Stewart 		val = asoc->nr_mapping_array[slide_from] | asoc->mapping_array[slide_from];
242966bd30bdSRandall Stewart 		if (val == 0xff) {
2430f8829a4aSRandall Stewart 			at += 8;
2431f8829a4aSRandall Stewart 		} else {
2432f8829a4aSRandall Stewart 			/* there is a 0 bit */
243366bd30bdSRandall Stewart 			at += sctp_map_lookup_tab[val];
2434f8829a4aSRandall Stewart 			break;
2435f8829a4aSRandall Stewart 		}
2436f8829a4aSRandall Stewart 	}
2437b5c16493SMichael Tuexen 	asoc->cumulative_tsn = asoc->mapping_array_base_tsn + (at - 1);
2438f8829a4aSRandall Stewart 
243920b07a4dSMichael Tuexen 	if (SCTP_TSN_GT(asoc->cumulative_tsn, asoc->highest_tsn_inside_map) &&
244020b07a4dSMichael Tuexen 	    SCTP_TSN_GT(asoc->cumulative_tsn, asoc->highest_tsn_inside_nr_map)) {
2441a5d547adSRandall Stewart #ifdef INVARIANTS
2442ceaad40aSRandall Stewart 		panic("huh, cumack 0x%x greater than high-tsn 0x%x in map",
2443ceaad40aSRandall Stewart 		    asoc->cumulative_tsn, asoc->highest_tsn_inside_map);
2444f8829a4aSRandall Stewart #else
2445ceaad40aSRandall Stewart 		SCTP_PRINTF("huh, cumack 0x%x greater than high-tsn 0x%x in map - should panic?\n",
2446ceaad40aSRandall Stewart 		    asoc->cumulative_tsn, asoc->highest_tsn_inside_map);
24470e13104dSRandall Stewart 		sctp_print_mapping_array(asoc);
2448b3f1ea41SRandall Stewart 		if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MAP_LOGGING_ENABLE) {
2449b3f1ea41SRandall Stewart 			sctp_log_map(0, 6, asoc->highest_tsn_inside_map, SCTP_MAP_SLIDE_RESULT);
2450b3f1ea41SRandall Stewart 		}
2451f8829a4aSRandall Stewart 		asoc->highest_tsn_inside_map = asoc->cumulative_tsn;
2452830d754dSRandall Stewart 		asoc->highest_tsn_inside_nr_map = asoc->cumulative_tsn;
2453f8829a4aSRandall Stewart #endif
2454f8829a4aSRandall Stewart 	}
245520b07a4dSMichael Tuexen 	if (SCTP_TSN_GT(asoc->highest_tsn_inside_nr_map, asoc->highest_tsn_inside_map)) {
245677acdc25SRandall Stewart 		highest_tsn = asoc->highest_tsn_inside_nr_map;
245777acdc25SRandall Stewart 	} else {
245877acdc25SRandall Stewart 		highest_tsn = asoc->highest_tsn_inside_map;
245977acdc25SRandall Stewart 	}
246077acdc25SRandall Stewart 	if ((asoc->cumulative_tsn == highest_tsn) && (at >= 8)) {
2461f8829a4aSRandall Stewart 		/* The complete array was completed by a single FR */
246277acdc25SRandall Stewart 		/* highest becomes the cum-ack */
246337f144ebSMichael Tuexen 		int clr;
246437f144ebSMichael Tuexen #ifdef INVARIANTS
246537f144ebSMichael Tuexen 		unsigned int i;
246637f144ebSMichael Tuexen #endif
2467f8829a4aSRandall Stewart 
2468f8829a4aSRandall Stewart 		/* clear the array */
2469b5c16493SMichael Tuexen 		clr = ((at + 7) >> 3);
2470c4739e2fSRandall Stewart 		if (clr > asoc->mapping_array_size) {
2471f8829a4aSRandall Stewart 			clr = asoc->mapping_array_size;
2472f8829a4aSRandall Stewart 		}
2473f8829a4aSRandall Stewart 		memset(asoc->mapping_array, 0, clr);
2474830d754dSRandall Stewart 		memset(asoc->nr_mapping_array, 0, clr);
247537f144ebSMichael Tuexen #ifdef INVARIANTS
2476b5c16493SMichael Tuexen 		for (i = 0; i < asoc->mapping_array_size; i++) {
2477b5c16493SMichael Tuexen 			if ((asoc->mapping_array[i]) || (asoc->nr_mapping_array[i])) {
2478cd3fd531SMichael Tuexen 				SCTP_PRINTF("Error Mapping array's not clean at clear\n");
2479b5c16493SMichael Tuexen 				sctp_print_mapping_array(asoc);
2480b5c16493SMichael Tuexen 			}
2481b5c16493SMichael Tuexen 		}
248237f144ebSMichael Tuexen #endif
248377acdc25SRandall Stewart 		asoc->mapping_array_base_tsn = asoc->cumulative_tsn + 1;
248477acdc25SRandall Stewart 		asoc->highest_tsn_inside_nr_map = asoc->highest_tsn_inside_map = asoc->cumulative_tsn;
2485f8829a4aSRandall Stewart 	} else if (at >= 8) {
2486f8829a4aSRandall Stewart 		/* we can slide the mapping array down */
2487b3f1ea41SRandall Stewart 		/* slide_from holds where we hit the first NON 0xff byte */
2488b3f1ea41SRandall Stewart 
2489f8829a4aSRandall Stewart 		/*
2490f8829a4aSRandall Stewart 		 * now calculate the ceiling of the move using our highest
2491f8829a4aSRandall Stewart 		 * TSN value
2492f8829a4aSRandall Stewart 		 */
249377acdc25SRandall Stewart 		SCTP_CALC_TSN_TO_GAP(lgap, highest_tsn, asoc->mapping_array_base_tsn);
249477acdc25SRandall Stewart 		slide_end = (lgap >> 3);
2495f8829a4aSRandall Stewart 		if (slide_end < slide_from) {
249677acdc25SRandall Stewart 			sctp_print_mapping_array(asoc);
2497d55b0b1bSRandall Stewart #ifdef INVARIANTS
2498f8829a4aSRandall Stewart 			panic("impossible slide");
2499d55b0b1bSRandall Stewart #else
2500cd3fd531SMichael Tuexen 			SCTP_PRINTF("impossible slide lgap: %x slide_end: %x slide_from: %x? at: %d\n",
250177acdc25SRandall Stewart 			    lgap, slide_end, slide_from, at);
2502d55b0b1bSRandall Stewart 			return;
2503d55b0b1bSRandall Stewart #endif
2504f8829a4aSRandall Stewart 		}
2505b3f1ea41SRandall Stewart 		if (slide_end > asoc->mapping_array_size) {
2506b3f1ea41SRandall Stewart #ifdef INVARIANTS
2507b3f1ea41SRandall Stewart 			panic("would overrun buffer");
2508b3f1ea41SRandall Stewart #else
2509cd3fd531SMichael Tuexen 			SCTP_PRINTF("Gak, would have overrun map end: %d slide_end: %d\n",
2510b3f1ea41SRandall Stewart 			    asoc->mapping_array_size, slide_end);
2511b3f1ea41SRandall Stewart 			slide_end = asoc->mapping_array_size;
2512b3f1ea41SRandall Stewart #endif
2513b3f1ea41SRandall Stewart 		}
2514f8829a4aSRandall Stewart 		distance = (slide_end - slide_from) + 1;
2515b3f1ea41SRandall Stewart 		if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MAP_LOGGING_ENABLE) {
2516f8829a4aSRandall Stewart 			sctp_log_map(old_base, old_cumack, old_highest,
2517f8829a4aSRandall Stewart 			    SCTP_MAP_PREPARE_SLIDE);
2518f8829a4aSRandall Stewart 			sctp_log_map((uint32_t)slide_from, (uint32_t)slide_end,
2519f8829a4aSRandall Stewart 			    (uint32_t)lgap, SCTP_MAP_SLIDE_FROM);
252080fefe0aSRandall Stewart 		}
2521f8829a4aSRandall Stewart 		if (distance + slide_from > asoc->mapping_array_size ||
2522f8829a4aSRandall Stewart 		    distance < 0) {
2523f8829a4aSRandall Stewart 			/*
2524f8829a4aSRandall Stewart 			 * Here we do NOT slide forward the array so that
2525f8829a4aSRandall Stewart 			 * hopefully when more data comes in to fill it up
2526f8829a4aSRandall Stewart 			 * we will be able to slide it forward. Really I
2527f8829a4aSRandall Stewart 			 * don't think this should happen :-0
2528f8829a4aSRandall Stewart 			 */
2529b3f1ea41SRandall Stewart 			if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MAP_LOGGING_ENABLE) {
2530f8829a4aSRandall Stewart 				sctp_log_map((uint32_t)distance, (uint32_t)slide_from,
2531f8829a4aSRandall Stewart 				    (uint32_t)asoc->mapping_array_size,
2532f8829a4aSRandall Stewart 				    SCTP_MAP_SLIDE_NONE);
253380fefe0aSRandall Stewart 			}
2534f8829a4aSRandall Stewart 		} else {
2535f8829a4aSRandall Stewart 			int ii;
2536f8829a4aSRandall Stewart 
2537f8829a4aSRandall Stewart 			for (ii = 0; ii < distance; ii++) {
253837f144ebSMichael Tuexen 				asoc->mapping_array[ii] = asoc->mapping_array[slide_from + ii];
253937f144ebSMichael Tuexen 				asoc->nr_mapping_array[ii] = asoc->nr_mapping_array[slide_from + ii];
2540f8829a4aSRandall Stewart 			}
2541aed5947cSMichael Tuexen 			for (ii = distance; ii < asoc->mapping_array_size; ii++) {
2542f8829a4aSRandall Stewart 				asoc->mapping_array[ii] = 0;
254377acdc25SRandall Stewart 				asoc->nr_mapping_array[ii] = 0;
2544f8829a4aSRandall Stewart 			}
2545ee94f0a2SMichael Tuexen 			if (asoc->highest_tsn_inside_map + 1 == asoc->mapping_array_base_tsn) {
2546ee94f0a2SMichael Tuexen 				asoc->highest_tsn_inside_map += (slide_from << 3);
2547ee94f0a2SMichael Tuexen 			}
2548ee94f0a2SMichael Tuexen 			if (asoc->highest_tsn_inside_nr_map + 1 == asoc->mapping_array_base_tsn) {
2549ee94f0a2SMichael Tuexen 				asoc->highest_tsn_inside_nr_map += (slide_from << 3);
2550ee94f0a2SMichael Tuexen 			}
2551f8829a4aSRandall Stewart 			asoc->mapping_array_base_tsn += (slide_from << 3);
2552b3f1ea41SRandall Stewart 			if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MAP_LOGGING_ENABLE) {
2553f8829a4aSRandall Stewart 				sctp_log_map(asoc->mapping_array_base_tsn,
2554f8829a4aSRandall Stewart 				    asoc->cumulative_tsn, asoc->highest_tsn_inside_map,
2555f8829a4aSRandall Stewart 				    SCTP_MAP_SLIDE_RESULT);
255680fefe0aSRandall Stewart 			}
2557830d754dSRandall Stewart 		}
2558830d754dSRandall Stewart 	}
2559b5c16493SMichael Tuexen }
2560b5c16493SMichael Tuexen 
2561b5c16493SMichael Tuexen void
25627215cc1bSMichael Tuexen sctp_sack_check(struct sctp_tcb *stcb, int was_a_gap)
2563b5c16493SMichael Tuexen {
2564b5c16493SMichael Tuexen 	struct sctp_association *asoc;
2565b5c16493SMichael Tuexen 	uint32_t highest_tsn;
2566ebecdad8SMichael Tuexen 	int is_a_gap;
2567b5c16493SMichael Tuexen 
2568ebecdad8SMichael Tuexen 	sctp_slide_mapping_arrays(stcb);
2569b5c16493SMichael Tuexen 	asoc = &stcb->asoc;
257020b07a4dSMichael Tuexen 	if (SCTP_TSN_GT(asoc->highest_tsn_inside_nr_map, asoc->highest_tsn_inside_map)) {
2571b5c16493SMichael Tuexen 		highest_tsn = asoc->highest_tsn_inside_nr_map;
2572b5c16493SMichael Tuexen 	} else {
2573b5c16493SMichael Tuexen 		highest_tsn = asoc->highest_tsn_inside_map;
2574b5c16493SMichael Tuexen 	}
2575ebecdad8SMichael Tuexen 	/* Is there a gap now? */
2576ebecdad8SMichael Tuexen 	is_a_gap = SCTP_TSN_GT(highest_tsn, stcb->asoc.cumulative_tsn);
2577b5c16493SMichael Tuexen 
2578830d754dSRandall Stewart 	/*
2579f8829a4aSRandall Stewart 	 * Now we need to see if we need to queue a sack or just start the
2580f8829a4aSRandall Stewart 	 * timer (if allowed).
2581f8829a4aSRandall Stewart 	 */
2582839d21d6SMichael Tuexen 	if (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_SENT) {
2583f8829a4aSRandall Stewart 		/*
2584b5c16493SMichael Tuexen 		 * Ok special case, in SHUTDOWN-SENT case. here we maker
2585b5c16493SMichael Tuexen 		 * sure SACK timer is off and instead send a SHUTDOWN and a
2586b5c16493SMichael Tuexen 		 * SACK
2587f8829a4aSRandall Stewart 		 */
2588139bc87fSRandall Stewart 		if (SCTP_OS_TIMER_PENDING(&stcb->asoc.dack_timer.timer)) {
2589f8829a4aSRandall Stewart 			sctp_timer_stop(SCTP_TIMER_TYPE_RECV,
2590b7d130beSMichael Tuexen 			    stcb->sctp_ep, stcb, NULL,
259191e04f9eSMichael Tuexen 			    SCTP_FROM_SCTP_INDATA + SCTP_LOC_19);
2592f8829a4aSRandall Stewart 		}
2593ca85e948SMichael Tuexen 		sctp_send_shutdown(stcb,
2594ca85e948SMichael Tuexen 		    ((stcb->asoc.alternate) ? stcb->asoc.alternate : stcb->asoc.primary_destination));
2595ebecdad8SMichael Tuexen 		if (is_a_gap) {
2596689e6a5fSMichael Tuexen 			sctp_send_sack(stcb, SCTP_SO_NOT_LOCKED);
2597ebecdad8SMichael Tuexen 		}
2598f8829a4aSRandall Stewart 	} else {
2599f8829a4aSRandall Stewart 		/*
2600b5c16493SMichael Tuexen 		 * CMT DAC algorithm: increase number of packets received
2601b5c16493SMichael Tuexen 		 * since last ack
2602f8829a4aSRandall Stewart 		 */
2603f8829a4aSRandall Stewart 		stcb->asoc.cmt_dac_pkts_rcvd++;
2604f8829a4aSRandall Stewart 
260542551e99SRandall Stewart 		if ((stcb->asoc.send_sack == 1) ||	/* We need to send a
260642551e99SRandall Stewart 							 * SACK */
2607f8829a4aSRandall Stewart 		    ((was_a_gap) && (is_a_gap == 0)) ||	/* was a gap, but no
2608f8829a4aSRandall Stewart 							 * longer is one */
2609f8829a4aSRandall Stewart 		    (stcb->asoc.numduptsns) ||	/* we have dup's */
2610f8829a4aSRandall Stewart 		    (is_a_gap) ||	/* is still a gap */
261142551e99SRandall Stewart 		    (stcb->asoc.delayed_ack == 0) ||	/* Delayed sack disabled */
2612b6db274dSMichael Tuexen 		    (stcb->asoc.data_pkts_seen >= stcb->asoc.sack_freq)) {	/* hit limit of pkts */
26137c99d56fSMichael Tuexen 			if ((stcb->asoc.sctp_cmt_on_off > 0) &&
2614b3f1ea41SRandall Stewart 			    (SCTP_BASE_SYSCTL(sctp_cmt_use_dac)) &&
261542551e99SRandall Stewart 			    (stcb->asoc.send_sack == 0) &&
2616f8829a4aSRandall Stewart 			    (stcb->asoc.numduptsns == 0) &&
2617f8829a4aSRandall Stewart 			    (stcb->asoc.delayed_ack) &&
2618139bc87fSRandall Stewart 			    (!SCTP_OS_TIMER_PENDING(&stcb->asoc.dack_timer.timer))) {
2619f8829a4aSRandall Stewart 				/*
2620b5c16493SMichael Tuexen 				 * CMT DAC algorithm: With CMT, delay acks
2621b6db274dSMichael Tuexen 				 * even in the face of reordering.
2622b6db274dSMichael Tuexen 				 * Therefore, if acks that do not have to be
2623b6db274dSMichael Tuexen 				 * sent because of the above reasons, will
2624b6db274dSMichael Tuexen 				 * be delayed. That is, acks that would have
2625b6db274dSMichael Tuexen 				 * been sent due to gap reports will be
2626b6db274dSMichael Tuexen 				 * delayed with DAC. Start the delayed ack
2627b6db274dSMichael Tuexen 				 * timer.
2628f8829a4aSRandall Stewart 				 */
2629f8829a4aSRandall Stewart 				sctp_timer_start(SCTP_TIMER_TYPE_RECV,
2630f8829a4aSRandall Stewart 				    stcb->sctp_ep, stcb, NULL);
2631f8829a4aSRandall Stewart 			} else {
2632f8829a4aSRandall Stewart 				/*
2633b5c16493SMichael Tuexen 				 * Ok we must build a SACK since the timer
2634b5c16493SMichael Tuexen 				 * is pending, we got our first packet OR
2635b5c16493SMichael Tuexen 				 * there are gaps or duplicates.
2636f8829a4aSRandall Stewart 				 */
26375555400aSMichael Tuexen 				sctp_timer_stop(SCTP_TIMER_TYPE_RECV, stcb->sctp_ep, stcb, NULL,
263891e04f9eSMichael Tuexen 				    SCTP_FROM_SCTP_INDATA + SCTP_LOC_20);
2639689e6a5fSMichael Tuexen 				sctp_send_sack(stcb, SCTP_SO_NOT_LOCKED);
2640f8829a4aSRandall Stewart 			}
2641f8829a4aSRandall Stewart 		} else {
264242551e99SRandall Stewart 			if (!SCTP_OS_TIMER_PENDING(&stcb->asoc.dack_timer.timer)) {
2643f8829a4aSRandall Stewart 				sctp_timer_start(SCTP_TIMER_TYPE_RECV,
2644f8829a4aSRandall Stewart 				    stcb->sctp_ep, stcb, NULL);
2645f8829a4aSRandall Stewart 			}
2646f8829a4aSRandall Stewart 		}
2647f8829a4aSRandall Stewart 	}
2648f8829a4aSRandall Stewart }
2649f8829a4aSRandall Stewart 
2650f8829a4aSRandall Stewart int
2651f8829a4aSRandall Stewart sctp_process_data(struct mbuf **mm, int iphlen, int *offset, int length,
2652e7e71dd7SMichael Tuexen     struct sctp_inpcb *inp, struct sctp_tcb *stcb,
2653e7e71dd7SMichael Tuexen     struct sctp_nets *net, uint32_t *high_tsn)
2654f8829a4aSRandall Stewart {
265544249214SRandall Stewart 	struct sctp_chunkhdr *ch, chunk_buf;
2656f8829a4aSRandall Stewart 	struct sctp_association *asoc;
2657f8829a4aSRandall Stewart 	int num_chunks = 0;	/* number of control chunks processed */
2658f8829a4aSRandall Stewart 	int stop_proc = 0;
2659af03054cSMichael Tuexen 	int break_flag, last_chunk;
26608f777478SMichael Tuexen 	int abort_flag = 0, was_a_gap;
2661f8829a4aSRandall Stewart 	struct mbuf *m;
26628f777478SMichael Tuexen 	uint32_t highest_tsn;
2663af03054cSMichael Tuexen 	uint16_t chk_length;
2664f8829a4aSRandall Stewart 
2665f8829a4aSRandall Stewart 	/* set the rwnd */
2666f8829a4aSRandall Stewart 	sctp_set_rwnd(stcb, &stcb->asoc);
2667f8829a4aSRandall Stewart 
2668f8829a4aSRandall Stewart 	m = *mm;
2669f8829a4aSRandall Stewart 	SCTP_TCB_LOCK_ASSERT(stcb);
2670f8829a4aSRandall Stewart 	asoc = &stcb->asoc;
267120b07a4dSMichael Tuexen 	if (SCTP_TSN_GT(asoc->highest_tsn_inside_nr_map, asoc->highest_tsn_inside_map)) {
26728f777478SMichael Tuexen 		highest_tsn = asoc->highest_tsn_inside_nr_map;
26738f777478SMichael Tuexen 	} else {
26748f777478SMichael Tuexen 		highest_tsn = asoc->highest_tsn_inside_map;
2675f8829a4aSRandall Stewart 	}
267620b07a4dSMichael Tuexen 	was_a_gap = SCTP_TSN_GT(highest_tsn, stcb->asoc.cumulative_tsn);
2677f8829a4aSRandall Stewart 	/*
2678f8829a4aSRandall Stewart 	 * setup where we got the last DATA packet from for any SACK that
2679f8829a4aSRandall Stewart 	 * may need to go out. Don't bump the net. This is done ONLY when a
2680f8829a4aSRandall Stewart 	 * chunk is assigned.
2681f8829a4aSRandall Stewart 	 */
2682f8829a4aSRandall Stewart 	asoc->last_data_chunk_from = net;
2683f8829a4aSRandall Stewart 
2684d06c82f1SRandall Stewart 	/*-
2685f8829a4aSRandall Stewart 	 * Now before we proceed we must figure out if this is a wasted
2686f8829a4aSRandall Stewart 	 * cluster... i.e. it is a small packet sent in and yet the driver
2687f8829a4aSRandall Stewart 	 * underneath allocated a full cluster for it. If so we must copy it
2688f8829a4aSRandall Stewart 	 * to a smaller mbuf and free up the cluster mbuf. This will help
26892cf33471SMichael Tuexen 	 * with cluster starvation.
2690f8829a4aSRandall Stewart 	 */
269144b7479bSRandall Stewart 	if (SCTP_BUF_LEN(m) < (long)MLEN && SCTP_BUF_NEXT(m) == NULL) {
2692f8829a4aSRandall Stewart 		/* we only handle mbufs that are singletons.. not chains */
2693eb1b1807SGleb Smirnoff 		m = sctp_get_mbuf_for_msg(SCTP_BUF_LEN(m), 0, M_NOWAIT, 1, MT_DATA);
2694f8829a4aSRandall Stewart 		if (m) {
2695f8829a4aSRandall Stewart 			/* ok lets see if we can copy the data up */
2696f8829a4aSRandall Stewart 			caddr_t *from, *to;
2697f8829a4aSRandall Stewart 
2698f8829a4aSRandall Stewart 			/* get the pointers and copy */
2699f8829a4aSRandall Stewart 			to = mtod(m, caddr_t *);
2700f8829a4aSRandall Stewart 			from = mtod((*mm), caddr_t *);
2701139bc87fSRandall Stewart 			memcpy(to, from, SCTP_BUF_LEN((*mm)));
2702f8829a4aSRandall Stewart 			/* copy the length and free up the old */
2703139bc87fSRandall Stewart 			SCTP_BUF_LEN(m) = SCTP_BUF_LEN((*mm));
2704f8829a4aSRandall Stewart 			sctp_m_freem(*mm);
2705cd0a4ff6SPedro F. Giffuni 			/* success, back copy */
2706f8829a4aSRandall Stewart 			*mm = m;
2707f8829a4aSRandall Stewart 		} else {
2708f8829a4aSRandall Stewart 			/* We are in trouble in the mbuf world .. yikes */
2709f8829a4aSRandall Stewart 			m = *mm;
2710f8829a4aSRandall Stewart 		}
2711f8829a4aSRandall Stewart 	}
2712f8829a4aSRandall Stewart 	/* get pointer to the first chunk header */
271344249214SRandall Stewart 	ch = (struct sctp_chunkhdr *)sctp_m_getptr(m, *offset,
27147f75695aSMichael Tuexen 	    sizeof(struct sctp_chunkhdr),
27157f75695aSMichael Tuexen 	    (uint8_t *)&chunk_buf);
2716f8829a4aSRandall Stewart 	if (ch == NULL) {
2717f8829a4aSRandall Stewart 		return (1);
2718f8829a4aSRandall Stewart 	}
2719f8829a4aSRandall Stewart 	/*
2720f8829a4aSRandall Stewart 	 * process all DATA chunks...
2721f8829a4aSRandall Stewart 	 */
2722f8829a4aSRandall Stewart 	*high_tsn = asoc->cumulative_tsn;
2723f8829a4aSRandall Stewart 	break_flag = 0;
272442551e99SRandall Stewart 	asoc->data_pkts_seen++;
2725f8829a4aSRandall Stewart 	while (stop_proc == 0) {
2726f8829a4aSRandall Stewart 		/* validate chunk length */
272744249214SRandall Stewart 		chk_length = ntohs(ch->chunk_length);
2728f8829a4aSRandall Stewart 		if (length - *offset < chk_length) {
2729f8829a4aSRandall Stewart 			/* all done, mutulated chunk */
2730f8829a4aSRandall Stewart 			stop_proc = 1;
273160990c0cSMichael Tuexen 			continue;
2732f8829a4aSRandall Stewart 		}
273344249214SRandall Stewart 		if ((asoc->idata_supported == 1) &&
273444249214SRandall Stewart 		    (ch->chunk_type == SCTP_DATA)) {
273544249214SRandall Stewart 			struct mbuf *op_err;
273644249214SRandall Stewart 			char msg[SCTP_DIAG_INFO_LEN];
273744249214SRandall Stewart 
2738ef9095c7SMichael Tuexen 			SCTP_SNPRINTF(msg, sizeof(msg), "%s", "DATA chunk received when I-DATA was negotiated");
273944249214SRandall Stewart 			op_err = sctp_generate_cause(SCTP_CAUSE_PROTOCOL_VIOLATION, msg);
274091e04f9eSMichael Tuexen 			stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_21;
2741105b68b4SMichael Tuexen 			sctp_abort_an_association(inp, stcb, op_err, false, SCTP_SO_NOT_LOCKED);
274244249214SRandall Stewart 			return (2);
274344249214SRandall Stewart 		}
274444249214SRandall Stewart 		if ((asoc->idata_supported == 0) &&
274544249214SRandall Stewart 		    (ch->chunk_type == SCTP_IDATA)) {
274644249214SRandall Stewart 			struct mbuf *op_err;
274744249214SRandall Stewart 			char msg[SCTP_DIAG_INFO_LEN];
274844249214SRandall Stewart 
2749ef9095c7SMichael Tuexen 			SCTP_SNPRINTF(msg, sizeof(msg), "%s", "I-DATA chunk received when DATA was negotiated");
275044249214SRandall Stewart 			op_err = sctp_generate_cause(SCTP_CAUSE_PROTOCOL_VIOLATION, msg);
275191e04f9eSMichael Tuexen 			stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_22;
2752105b68b4SMichael Tuexen 			sctp_abort_an_association(inp, stcb, op_err, false, SCTP_SO_NOT_LOCKED);
275344249214SRandall Stewart 			return (2);
275444249214SRandall Stewart 		}
275544249214SRandall Stewart 		if ((ch->chunk_type == SCTP_DATA) ||
275644249214SRandall Stewart 		    (ch->chunk_type == SCTP_IDATA)) {
2757af03054cSMichael Tuexen 			uint16_t clen;
275844249214SRandall Stewart 
275944249214SRandall Stewart 			if (ch->chunk_type == SCTP_DATA) {
276044249214SRandall Stewart 				clen = sizeof(struct sctp_data_chunk);
276144249214SRandall Stewart 			} else {
276244249214SRandall Stewart 				clen = sizeof(struct sctp_idata_chunk);
276344249214SRandall Stewart 			}
2764f8ee69bfSMichael Tuexen 			if (chk_length < clen) {
2765f8829a4aSRandall Stewart 				/*
2766f8829a4aSRandall Stewart 				 * Need to send an abort since we had a
2767f8829a4aSRandall Stewart 				 * invalid data chunk.
2768f8829a4aSRandall Stewart 				 */
2769f8829a4aSRandall Stewart 				struct mbuf *op_err;
2770ff1ffd74SMichael Tuexen 				char msg[SCTP_DIAG_INFO_LEN];
2771f8829a4aSRandall Stewart 
2772999f86d6SMichael Tuexen 				SCTP_SNPRINTF(msg, sizeof(msg), "%s chunk of length %u",
27737f75695aSMichael Tuexen 				    ch->chunk_type == SCTP_DATA ? "DATA" : "I-DATA",
2774821bae7cSMichael Tuexen 				    chk_length);
2775ff1ffd74SMichael Tuexen 				op_err = sctp_generate_cause(SCTP_CAUSE_PROTOCOL_VIOLATION, msg);
277691e04f9eSMichael Tuexen 				stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_23;
2777105b68b4SMichael Tuexen 				sctp_abort_an_association(inp, stcb, op_err, false, SCTP_SO_NOT_LOCKED);
277832451da4SMichael Tuexen 				return (2);
277932451da4SMichael Tuexen 			}
2780f8829a4aSRandall Stewart #ifdef SCTP_AUDITING_ENABLED
2781f8829a4aSRandall Stewart 			sctp_audit_log(0xB1, 0);
2782f8829a4aSRandall Stewart #endif
2783f8829a4aSRandall Stewart 			if (SCTP_SIZE32(chk_length) == (length - *offset)) {
2784f8829a4aSRandall Stewart 				last_chunk = 1;
2785f8829a4aSRandall Stewart 			} else {
2786f8829a4aSRandall Stewart 				last_chunk = 0;
2787f8829a4aSRandall Stewart 			}
278844249214SRandall Stewart 			if (sctp_process_a_data_chunk(stcb, asoc, mm, *offset,
2789f8829a4aSRandall Stewart 			    chk_length, net, high_tsn, &abort_flag, &break_flag,
279044249214SRandall Stewart 			    last_chunk, ch->chunk_type)) {
2791f8829a4aSRandall Stewart 				num_chunks++;
2792f8829a4aSRandall Stewart 			}
2793f8829a4aSRandall Stewart 			if (abort_flag)
2794f8829a4aSRandall Stewart 				return (2);
2795f8829a4aSRandall Stewart 
2796f8829a4aSRandall Stewart 			if (break_flag) {
2797f8829a4aSRandall Stewart 				/*
2798f8829a4aSRandall Stewart 				 * Set because of out of rwnd space and no
2799f8829a4aSRandall Stewart 				 * drop rep space left.
2800f8829a4aSRandall Stewart 				 */
2801f8829a4aSRandall Stewart 				stop_proc = 1;
280260990c0cSMichael Tuexen 				continue;
2803f8829a4aSRandall Stewart 			}
2804f8829a4aSRandall Stewart 		} else {
2805f8829a4aSRandall Stewart 			/* not a data chunk in the data region */
280644249214SRandall Stewart 			switch (ch->chunk_type) {
2807f8829a4aSRandall Stewart 			case SCTP_INITIATION:
2808f8829a4aSRandall Stewart 			case SCTP_INITIATION_ACK:
2809f8829a4aSRandall Stewart 			case SCTP_SELECTIVE_ACK:
281060990c0cSMichael Tuexen 			case SCTP_NR_SELECTIVE_ACK:
2811f8829a4aSRandall Stewart 			case SCTP_HEARTBEAT_REQUEST:
2812f8829a4aSRandall Stewart 			case SCTP_HEARTBEAT_ACK:
2813f8829a4aSRandall Stewart 			case SCTP_ABORT_ASSOCIATION:
2814f8829a4aSRandall Stewart 			case SCTP_SHUTDOWN:
2815f8829a4aSRandall Stewart 			case SCTP_SHUTDOWN_ACK:
2816f8829a4aSRandall Stewart 			case SCTP_OPERATION_ERROR:
2817f8829a4aSRandall Stewart 			case SCTP_COOKIE_ECHO:
2818f8829a4aSRandall Stewart 			case SCTP_COOKIE_ACK:
2819f8829a4aSRandall Stewart 			case SCTP_ECN_ECHO:
2820f8829a4aSRandall Stewart 			case SCTP_ECN_CWR:
2821f8829a4aSRandall Stewart 			case SCTP_SHUTDOWN_COMPLETE:
2822f8829a4aSRandall Stewart 			case SCTP_AUTHENTICATION:
2823f8829a4aSRandall Stewart 			case SCTP_ASCONF_ACK:
2824f8829a4aSRandall Stewart 			case SCTP_PACKET_DROPPED:
2825f8829a4aSRandall Stewart 			case SCTP_STREAM_RESET:
2826f8829a4aSRandall Stewart 			case SCTP_FORWARD_CUM_TSN:
2827f8829a4aSRandall Stewart 			case SCTP_ASCONF:
2828fd60718dSMichael Tuexen 				{
2829f8829a4aSRandall Stewart 					/*
2830fd60718dSMichael Tuexen 					 * Now, what do we do with KNOWN
2831fd60718dSMichael Tuexen 					 * chunks that are NOT in the right
2832fd60718dSMichael Tuexen 					 * place?
2833f8829a4aSRandall Stewart 					 *
2834fd60718dSMichael Tuexen 					 * For now, I do nothing but ignore
2835fd60718dSMichael Tuexen 					 * them. We may later want to add
2836fd60718dSMichael Tuexen 					 * sysctl stuff to switch out and do
2837fd60718dSMichael Tuexen 					 * either an ABORT() or possibly
2838fd60718dSMichael Tuexen 					 * process them.
2839f8829a4aSRandall Stewart 					 */
2840f8829a4aSRandall Stewart 					struct mbuf *op_err;
2841267dbe63SMichael Tuexen 					char msg[SCTP_DIAG_INFO_LEN];
2842f8829a4aSRandall Stewart 
2843999f86d6SMichael Tuexen 					SCTP_SNPRINTF(msg, sizeof(msg), "DATA chunk followed by chunk of type %2.2x",
2844821bae7cSMichael Tuexen 					    ch->chunk_type);
2845267dbe63SMichael Tuexen 					op_err = sctp_generate_cause(SCTP_CAUSE_PROTOCOL_VIOLATION, msg);
2846105b68b4SMichael Tuexen 					sctp_abort_an_association(inp, stcb, op_err, false, SCTP_SO_NOT_LOCKED);
2847f8829a4aSRandall Stewart 					return (2);
2848f8829a4aSRandall Stewart 				}
2849f8829a4aSRandall Stewart 			default:
28507f75695aSMichael Tuexen 				/*
28517f75695aSMichael Tuexen 				 * Unknown chunk type: use bit rules after
28527f75695aSMichael Tuexen 				 * checking length
28537f75695aSMichael Tuexen 				 */
28547f75695aSMichael Tuexen 				if (chk_length < sizeof(struct sctp_chunkhdr)) {
28557f75695aSMichael Tuexen 					/*
28567f75695aSMichael Tuexen 					 * Need to send an abort since we
28577f75695aSMichael Tuexen 					 * had a invalid chunk.
28587f75695aSMichael Tuexen 					 */
28597f75695aSMichael Tuexen 					struct mbuf *op_err;
28607f75695aSMichael Tuexen 					char msg[SCTP_DIAG_INFO_LEN];
28617f75695aSMichael Tuexen 
2862999f86d6SMichael Tuexen 					SCTP_SNPRINTF(msg, sizeof(msg), "Chunk of length %u", chk_length);
28637f75695aSMichael Tuexen 					op_err = sctp_generate_cause(SCTP_CAUSE_PROTOCOL_VIOLATION, msg);
286491e04f9eSMichael Tuexen 					stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_24;
2865105b68b4SMichael Tuexen 					sctp_abort_an_association(inp, stcb, op_err, false, SCTP_SO_NOT_LOCKED);
28667f75695aSMichael Tuexen 					return (2);
28677f75695aSMichael Tuexen 				}
286844249214SRandall Stewart 				if (ch->chunk_type & 0x40) {
2869f8829a4aSRandall Stewart 					/* Add a error report to the queue */
287086eda749SMichael Tuexen 					struct mbuf *op_err;
287186eda749SMichael Tuexen 					struct sctp_gen_error_cause *cause;
2872f8829a4aSRandall Stewart 
287386eda749SMichael Tuexen 					op_err = sctp_get_mbuf_for_msg(sizeof(struct sctp_gen_error_cause),
287486eda749SMichael Tuexen 					    0, M_NOWAIT, 1, MT_DATA);
287586eda749SMichael Tuexen 					if (op_err != NULL) {
287686eda749SMichael Tuexen 						cause = mtod(op_err, struct sctp_gen_error_cause *);
287786eda749SMichael Tuexen 						cause->code = htons(SCTP_CAUSE_UNRECOG_CHUNK);
28789a8e3088SMichael Tuexen 						cause->length = htons((uint16_t)(chk_length + sizeof(struct sctp_gen_error_cause)));
287986eda749SMichael Tuexen 						SCTP_BUF_LEN(op_err) = sizeof(struct sctp_gen_error_cause);
288086eda749SMichael Tuexen 						SCTP_BUF_NEXT(op_err) = SCTP_M_COPYM(m, *offset, chk_length, M_NOWAIT);
288186eda749SMichael Tuexen 						if (SCTP_BUF_NEXT(op_err) != NULL) {
288286eda749SMichael Tuexen 							sctp_queue_op_err(stcb, op_err);
2883f8829a4aSRandall Stewart 						} else {
288486eda749SMichael Tuexen 							sctp_m_freem(op_err);
2885f8829a4aSRandall Stewart 						}
2886f8829a4aSRandall Stewart 					}
2887f8829a4aSRandall Stewart 				}
288844249214SRandall Stewart 				if ((ch->chunk_type & 0x80) == 0) {
2889f8829a4aSRandall Stewart 					/* discard the rest of this packet */
2890f8829a4aSRandall Stewart 					stop_proc = 1;
2891f8829a4aSRandall Stewart 				}	/* else skip this bad chunk and
2892b7b84c0eSMichael Tuexen 					 * continue... */
2893b7b84c0eSMichael Tuexen 				break;
289460990c0cSMichael Tuexen 			}	/* switch of chunk type */
2895f8829a4aSRandall Stewart 		}
2896f8829a4aSRandall Stewart 		*offset += SCTP_SIZE32(chk_length);
2897f8829a4aSRandall Stewart 		if ((*offset >= length) || stop_proc) {
2898f8829a4aSRandall Stewart 			/* no more data left in the mbuf chain */
2899f8829a4aSRandall Stewart 			stop_proc = 1;
2900f8829a4aSRandall Stewart 			continue;
2901f8829a4aSRandall Stewart 		}
290244249214SRandall Stewart 		ch = (struct sctp_chunkhdr *)sctp_m_getptr(m, *offset,
29037f75695aSMichael Tuexen 		    sizeof(struct sctp_chunkhdr),
29047f75695aSMichael Tuexen 		    (uint8_t *)&chunk_buf);
2905f8829a4aSRandall Stewart 		if (ch == NULL) {
2906f8829a4aSRandall Stewart 			*offset = length;
2907f8829a4aSRandall Stewart 			stop_proc = 1;
290860990c0cSMichael Tuexen 			continue;
2909f8829a4aSRandall Stewart 		}
291060990c0cSMichael Tuexen 	}
2911f8829a4aSRandall Stewart 	if (break_flag) {
2912f8829a4aSRandall Stewart 		/*
2913f8829a4aSRandall Stewart 		 * we need to report rwnd overrun drops.
2914f8829a4aSRandall Stewart 		 */
291520cc2188SMichael Tuexen 		sctp_send_packet_dropped(stcb, net, *mm, length, iphlen, 0);
2916f8829a4aSRandall Stewart 	}
2917f8829a4aSRandall Stewart 	if (num_chunks) {
2918f8829a4aSRandall Stewart 		/*
2919ceaad40aSRandall Stewart 		 * Did we get data, if so update the time for auto-close and
2920f8829a4aSRandall Stewart 		 * give peer credit for being alive.
2921f8829a4aSRandall Stewart 		 */
2922f8829a4aSRandall Stewart 		SCTP_STAT_INCR(sctps_recvpktwithdata);
2923b3f1ea41SRandall Stewart 		if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_THRESHOLD_LOGGING) {
2924c4739e2fSRandall Stewart 			sctp_misc_ints(SCTP_THRESHOLD_CLEAR,
2925c4739e2fSRandall Stewart 			    stcb->asoc.overall_error_count,
2926c4739e2fSRandall Stewart 			    0,
2927c4739e2fSRandall Stewart 			    SCTP_FROM_SCTP_INDATA,
2928c4739e2fSRandall Stewart 			    __LINE__);
2929c4739e2fSRandall Stewart 		}
2930f8829a4aSRandall Stewart 		stcb->asoc.overall_error_count = 0;
29316e55db54SRandall Stewart 		(void)SCTP_GETTIME_TIMEVAL(&stcb->asoc.time_last_rcvd);
2932f8829a4aSRandall Stewart 	}
2933f8829a4aSRandall Stewart 	/* now service all of the reassm queue if needed */
2934839d21d6SMichael Tuexen 	if (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_SENT) {
293542551e99SRandall Stewart 		/* Assure that we ack right away */
293642551e99SRandall Stewart 		stcb->asoc.send_sack = 1;
2937f8829a4aSRandall Stewart 	}
2938f8829a4aSRandall Stewart 	/* Start a sack timer or QUEUE a SACK for sending */
29397215cc1bSMichael Tuexen 	sctp_sack_check(stcb, was_a_gap);
2940f8829a4aSRandall Stewart 	return (0);
2941f8829a4aSRandall Stewart }
2942f8829a4aSRandall Stewart 
29430fa753b3SRandall Stewart static int
29440fa753b3SRandall Stewart sctp_process_segment_range(struct sctp_tcb *stcb, struct sctp_tmit_chunk **p_tp1, uint32_t last_tsn,
29450fa753b3SRandall Stewart     uint16_t frag_strt, uint16_t frag_end, int nr_sacking,
29460fa753b3SRandall Stewart     int *num_frs,
29470fa753b3SRandall Stewart     uint32_t *biggest_newly_acked_tsn,
29480fa753b3SRandall Stewart     uint32_t *this_sack_lowest_newack,
29497215cc1bSMichael Tuexen     int *rto_ok)
29500fa753b3SRandall Stewart {
29510fa753b3SRandall Stewart 	struct sctp_tmit_chunk *tp1;
29520fa753b3SRandall Stewart 	unsigned int theTSN;
2953b5c16493SMichael Tuexen 	int j, wake_him = 0, circled = 0;
29540fa753b3SRandall Stewart 
29550fa753b3SRandall Stewart 	/* Recover the tp1 we last saw */
29560fa753b3SRandall Stewart 	tp1 = *p_tp1;
29570fa753b3SRandall Stewart 	if (tp1 == NULL) {
29580fa753b3SRandall Stewart 		tp1 = TAILQ_FIRST(&stcb->asoc.sent_queue);
29590fa753b3SRandall Stewart 	}
29600fa753b3SRandall Stewart 	for (j = frag_strt; j <= frag_end; j++) {
29610fa753b3SRandall Stewart 		theTSN = j + last_tsn;
29620fa753b3SRandall Stewart 		while (tp1) {
29630fa753b3SRandall Stewart 			if (tp1->rec.data.doing_fast_retransmit)
29640fa753b3SRandall Stewart 				(*num_frs) += 1;
29650fa753b3SRandall Stewart 
29660fa753b3SRandall Stewart 			/*-
29670fa753b3SRandall Stewart 			 * CMT: CUCv2 algorithm. For each TSN being
29680fa753b3SRandall Stewart 			 * processed from the sent queue, track the
29690fa753b3SRandall Stewart 			 * next expected pseudo-cumack, or
29700fa753b3SRandall Stewart 			 * rtx_pseudo_cumack, if required. Separate
29710fa753b3SRandall Stewart 			 * cumack trackers for first transmissions,
29720fa753b3SRandall Stewart 			 * and retransmissions.
29730fa753b3SRandall Stewart 			 */
29748427b3fdSMichael Tuexen 			if ((tp1->sent < SCTP_DATAGRAM_RESEND) &&
29758427b3fdSMichael Tuexen 			    (tp1->whoTo->find_pseudo_cumack == 1) &&
29760fa753b3SRandall Stewart 			    (tp1->snd_count == 1)) {
297749656eefSMichael Tuexen 				tp1->whoTo->pseudo_cumack = tp1->rec.data.tsn;
29780fa753b3SRandall Stewart 				tp1->whoTo->find_pseudo_cumack = 0;
29790fa753b3SRandall Stewart 			}
29808427b3fdSMichael Tuexen 			if ((tp1->sent < SCTP_DATAGRAM_RESEND) &&
29818427b3fdSMichael Tuexen 			    (tp1->whoTo->find_rtx_pseudo_cumack == 1) &&
29820fa753b3SRandall Stewart 			    (tp1->snd_count > 1)) {
298349656eefSMichael Tuexen 				tp1->whoTo->rtx_pseudo_cumack = tp1->rec.data.tsn;
29840fa753b3SRandall Stewart 				tp1->whoTo->find_rtx_pseudo_cumack = 0;
29850fa753b3SRandall Stewart 			}
298649656eefSMichael Tuexen 			if (tp1->rec.data.tsn == theTSN) {
29870fa753b3SRandall Stewart 				if (tp1->sent != SCTP_DATAGRAM_UNSENT) {
29880fa753b3SRandall Stewart 					/*-
29890fa753b3SRandall Stewart 					 * must be held until
29900fa753b3SRandall Stewart 					 * cum-ack passes
29910fa753b3SRandall Stewart 					 */
29920fa753b3SRandall Stewart 					if (tp1->sent < SCTP_DATAGRAM_RESEND) {
29930fa753b3SRandall Stewart 						/*-
29940fa753b3SRandall Stewart 						 * If it is less than RESEND, it is
29950fa753b3SRandall Stewart 						 * now no-longer in flight.
29960fa753b3SRandall Stewart 						 * Higher values may already be set
29970fa753b3SRandall Stewart 						 * via previous Gap Ack Blocks...
29980fa753b3SRandall Stewart 						 * i.e. ACKED or RESEND.
29990fa753b3SRandall Stewart 						 */
300049656eefSMichael Tuexen 						if (SCTP_TSN_GT(tp1->rec.data.tsn,
300120b07a4dSMichael Tuexen 						    *biggest_newly_acked_tsn)) {
300249656eefSMichael Tuexen 							*biggest_newly_acked_tsn = tp1->rec.data.tsn;
30030fa753b3SRandall Stewart 						}
30040fa753b3SRandall Stewart 						/*-
30050fa753b3SRandall Stewart 						 * CMT: SFR algo (and HTNA) - set
30060fa753b3SRandall Stewart 						 * saw_newack to 1 for dest being
30070fa753b3SRandall Stewart 						 * newly acked. update
30080fa753b3SRandall Stewart 						 * this_sack_highest_newack if
30090fa753b3SRandall Stewart 						 * appropriate.
30100fa753b3SRandall Stewart 						 */
30110fa753b3SRandall Stewart 						if (tp1->rec.data.chunk_was_revoked == 0)
30120fa753b3SRandall Stewart 							tp1->whoTo->saw_newack = 1;
30130fa753b3SRandall Stewart 
301449656eefSMichael Tuexen 						if (SCTP_TSN_GT(tp1->rec.data.tsn,
301520b07a4dSMichael Tuexen 						    tp1->whoTo->this_sack_highest_newack)) {
30160fa753b3SRandall Stewart 							tp1->whoTo->this_sack_highest_newack =
301749656eefSMichael Tuexen 							    tp1->rec.data.tsn;
30180fa753b3SRandall Stewart 						}
30190fa753b3SRandall Stewart 						/*-
30200fa753b3SRandall Stewart 						 * CMT DAC algo: also update
30210fa753b3SRandall Stewart 						 * this_sack_lowest_newack
30220fa753b3SRandall Stewart 						 */
30230fa753b3SRandall Stewart 						if (*this_sack_lowest_newack == 0) {
30240fa753b3SRandall Stewart 							if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_SACK_LOGGING_ENABLE) {
30250fa753b3SRandall Stewart 								sctp_log_sack(*this_sack_lowest_newack,
30260fa753b3SRandall Stewart 								    last_tsn,
302749656eefSMichael Tuexen 								    tp1->rec.data.tsn,
30280fa753b3SRandall Stewart 								    0,
30290fa753b3SRandall Stewart 								    0,
30300fa753b3SRandall Stewart 								    SCTP_LOG_TSN_ACKED);
30310fa753b3SRandall Stewart 							}
303249656eefSMichael Tuexen 							*this_sack_lowest_newack = tp1->rec.data.tsn;
30330fa753b3SRandall Stewart 						}
30340fa753b3SRandall Stewart 						/*-
30350fa753b3SRandall Stewart 						 * CMT: CUCv2 algorithm. If (rtx-)pseudo-cumack for corresp
30360fa753b3SRandall Stewart 						 * dest is being acked, then we have a new (rtx-)pseudo-cumack. Set
30370fa753b3SRandall Stewart 						 * new_(rtx_)pseudo_cumack to TRUE so that the cwnd for this dest can be
30380fa753b3SRandall Stewart 						 * updated. Also trigger search for the next expected (rtx-)pseudo-cumack.
30390fa753b3SRandall Stewart 						 * Separate pseudo_cumack trackers for first transmissions and
30400fa753b3SRandall Stewart 						 * retransmissions.
30410fa753b3SRandall Stewart 						 */
304249656eefSMichael Tuexen 						if (tp1->rec.data.tsn == tp1->whoTo->pseudo_cumack) {
30430fa753b3SRandall Stewart 							if (tp1->rec.data.chunk_was_revoked == 0) {
30440fa753b3SRandall Stewart 								tp1->whoTo->new_pseudo_cumack = 1;
30450fa753b3SRandall Stewart 							}
30460fa753b3SRandall Stewart 							tp1->whoTo->find_pseudo_cumack = 1;
30470fa753b3SRandall Stewart 						}
30480fa753b3SRandall Stewart 						if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
304949656eefSMichael Tuexen 							sctp_log_cwnd(stcb, tp1->whoTo, tp1->rec.data.tsn, SCTP_CWND_LOG_FROM_SACK);
30500fa753b3SRandall Stewart 						}
305149656eefSMichael Tuexen 						if (tp1->rec.data.tsn == tp1->whoTo->rtx_pseudo_cumack) {
30520fa753b3SRandall Stewart 							if (tp1->rec.data.chunk_was_revoked == 0) {
30530fa753b3SRandall Stewart 								tp1->whoTo->new_pseudo_cumack = 1;
30540fa753b3SRandall Stewart 							}
30550fa753b3SRandall Stewart 							tp1->whoTo->find_rtx_pseudo_cumack = 1;
30560fa753b3SRandall Stewart 						}
30570fa753b3SRandall Stewart 						if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_SACK_LOGGING_ENABLE) {
30580fa753b3SRandall Stewart 							sctp_log_sack(*biggest_newly_acked_tsn,
30590fa753b3SRandall Stewart 							    last_tsn,
306049656eefSMichael Tuexen 							    tp1->rec.data.tsn,
30610fa753b3SRandall Stewart 							    frag_strt,
30620fa753b3SRandall Stewart 							    frag_end,
30630fa753b3SRandall Stewart 							    SCTP_LOG_TSN_ACKED);
30640fa753b3SRandall Stewart 						}
30650fa753b3SRandall Stewart 						if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FLIGHT_LOGGING_ENABLE) {
30660fa753b3SRandall Stewart 							sctp_misc_ints(SCTP_FLIGHT_LOG_DOWN_GAP,
30670fa753b3SRandall Stewart 							    tp1->whoTo->flight_size,
30680fa753b3SRandall Stewart 							    tp1->book_size,
30699a8e3088SMichael Tuexen 							    (uint32_t)(uintptr_t)tp1->whoTo,
307049656eefSMichael Tuexen 							    tp1->rec.data.tsn);
30710fa753b3SRandall Stewart 						}
30720fa753b3SRandall Stewart 						sctp_flight_size_decrease(tp1);
3073299108c5SRandall Stewart 						if (stcb->asoc.cc_functions.sctp_cwnd_update_tsn_acknowledged) {
3074299108c5SRandall Stewart 							(*stcb->asoc.cc_functions.sctp_cwnd_update_tsn_acknowledged) (tp1->whoTo,
3075299108c5SRandall Stewart 							    tp1);
3076299108c5SRandall Stewart 						}
30770fa753b3SRandall Stewart 						sctp_total_flight_decrease(stcb, tp1);
30780fa753b3SRandall Stewart 
30790fa753b3SRandall Stewart 						tp1->whoTo->net_ack += tp1->send_size;
30800fa753b3SRandall Stewart 						if (tp1->snd_count < 2) {
30810fa753b3SRandall Stewart 							/*-
3082ab9ed8a1SDevin Teske 							 * True non-retransmitted chunk
30830fa753b3SRandall Stewart 							 */
30840fa753b3SRandall Stewart 							tp1->whoTo->net_ack2 += tp1->send_size;
30850fa753b3SRandall Stewart 
30860fa753b3SRandall Stewart 							/*-
30870fa753b3SRandall Stewart 							 * update RTO too ?
30880fa753b3SRandall Stewart 							 */
30890fa753b3SRandall Stewart 							if (tp1->do_rtt) {
309044f2a327SMichael Tuexen 								if (*rto_ok &&
30910fa753b3SRandall Stewart 								    sctp_calculate_rto(stcb,
30920fa753b3SRandall Stewart 								    &stcb->asoc,
30930fa753b3SRandall Stewart 								    tp1->whoTo,
30940fa753b3SRandall Stewart 								    &tp1->sent_rcv_time,
309544f2a327SMichael Tuexen 								    SCTP_RTT_FROM_DATA)) {
3096f79aab18SRandall Stewart 									*rto_ok = 0;
3097f79aab18SRandall Stewart 								}
3098f79aab18SRandall Stewart 								if (tp1->whoTo->rto_needed == 0) {
3099f79aab18SRandall Stewart 									tp1->whoTo->rto_needed = 1;
3100f79aab18SRandall Stewart 								}
31010fa753b3SRandall Stewart 								tp1->do_rtt = 0;
31020fa753b3SRandall Stewart 							}
31030fa753b3SRandall Stewart 						}
31040fa753b3SRandall Stewart 					}
31050fa753b3SRandall Stewart 					if (tp1->sent <= SCTP_DATAGRAM_RESEND) {
310649656eefSMichael Tuexen 						if (SCTP_TSN_GT(tp1->rec.data.tsn,
310720b07a4dSMichael Tuexen 						    stcb->asoc.this_sack_highest_gap)) {
31080fa753b3SRandall Stewart 							stcb->asoc.this_sack_highest_gap =
310949656eefSMichael Tuexen 							    tp1->rec.data.tsn;
31100fa753b3SRandall Stewart 						}
31110fa753b3SRandall Stewart 						if (tp1->sent == SCTP_DATAGRAM_RESEND) {
31120fa753b3SRandall Stewart 							sctp_ucount_decr(stcb->asoc.sent_queue_retran_cnt);
31130fa753b3SRandall Stewart #ifdef SCTP_AUDITING_ENABLED
31140fa753b3SRandall Stewart 							sctp_audit_log(0xB2,
31150fa753b3SRandall Stewart 							    (stcb->asoc.sent_queue_retran_cnt & 0x000000ff));
31160fa753b3SRandall Stewart #endif
31170fa753b3SRandall Stewart 						}
31180fa753b3SRandall Stewart 					}
31190fa753b3SRandall Stewart 					/*-
31200fa753b3SRandall Stewart 					 * All chunks NOT UNSENT fall through here and are marked
31210fa753b3SRandall Stewart 					 * (leave PR-SCTP ones that are to skip alone though)
31220fa753b3SRandall Stewart 					 */
31232a498584SMichael Tuexen 					if ((tp1->sent != SCTP_FORWARD_TSN_SKIP) &&
3124325c8c46SMichael Tuexen 					    (tp1->sent != SCTP_DATAGRAM_NR_ACKED)) {
31250fa753b3SRandall Stewart 						tp1->sent = SCTP_DATAGRAM_MARKED;
31262a498584SMichael Tuexen 					}
31270fa753b3SRandall Stewart 					if (tp1->rec.data.chunk_was_revoked) {
31280fa753b3SRandall Stewart 						/* deflate the cwnd */
31290fa753b3SRandall Stewart 						tp1->whoTo->cwnd -= tp1->book_size;
31300fa753b3SRandall Stewart 						tp1->rec.data.chunk_was_revoked = 0;
31310fa753b3SRandall Stewart 					}
31320fa753b3SRandall Stewart 					/* NR Sack code here */
3133325c8c46SMichael Tuexen 					if (nr_sacking &&
3134325c8c46SMichael Tuexen 					    (tp1->sent != SCTP_DATAGRAM_NR_ACKED)) {
313549656eefSMichael Tuexen 						if (stcb->asoc.strmout[tp1->rec.data.sid].chunks_on_queues > 0) {
313649656eefSMichael Tuexen 							stcb->asoc.strmout[tp1->rec.data.sid].chunks_on_queues--;
3137325c8c46SMichael Tuexen #ifdef INVARIANTS
3138325c8c46SMichael Tuexen 						} else {
313949656eefSMichael Tuexen 							panic("No chunks on the queues for sid %u.", tp1->rec.data.sid);
3140325c8c46SMichael Tuexen #endif
3141325c8c46SMichael Tuexen 						}
314249656eefSMichael Tuexen 						if ((stcb->asoc.strmout[tp1->rec.data.sid].chunks_on_queues == 0) &&
314349656eefSMichael Tuexen 						    (stcb->asoc.strmout[tp1->rec.data.sid].state == SCTP_STREAM_RESET_PENDING) &&
314449656eefSMichael Tuexen 						    TAILQ_EMPTY(&stcb->asoc.strmout[tp1->rec.data.sid].outqueue)) {
3145d96bef9cSMichael Tuexen 							stcb->asoc.trigger_reset = 1;
3146d96bef9cSMichael Tuexen 						}
3147325c8c46SMichael Tuexen 						tp1->sent = SCTP_DATAGRAM_NR_ACKED;
31480fa753b3SRandall Stewart 						if (tp1->data) {
3149b7b84c0eSMichael Tuexen 							/*
3150b7b84c0eSMichael Tuexen 							 * sa_ignore
3151b7b84c0eSMichael Tuexen 							 * NO_NULL_CHK
3152b7b84c0eSMichael Tuexen 							 */
31530fa753b3SRandall Stewart 							sctp_free_bufspace(stcb, &stcb->asoc, tp1, 1);
31540fa753b3SRandall Stewart 							sctp_m_freem(tp1->data);
31550fa753b3SRandall Stewart 							tp1->data = NULL;
3156b5c16493SMichael Tuexen 						}
31570fa753b3SRandall Stewart 						wake_him++;
31580fa753b3SRandall Stewart 					}
31590fa753b3SRandall Stewart 				}
31600fa753b3SRandall Stewart 				break;
3161b7b84c0eSMichael Tuexen 			}	/* if (tp1->tsn == theTSN) */
3162b7b84c0eSMichael Tuexen 			if (SCTP_TSN_GT(tp1->rec.data.tsn, theTSN)) {
31630fa753b3SRandall Stewart 				break;
316420b07a4dSMichael Tuexen 			}
31650fa753b3SRandall Stewart 			tp1 = TAILQ_NEXT(tp1, sctp_next);
3166b5c16493SMichael Tuexen 			if ((tp1 == NULL) && (circled == 0)) {
3167b5c16493SMichael Tuexen 				circled++;
31680fa753b3SRandall Stewart 				tp1 = TAILQ_FIRST(&stcb->asoc.sent_queue);
31690fa753b3SRandall Stewart 			}
3170b5c16493SMichael Tuexen 		}		/* end while (tp1) */
3171b5c16493SMichael Tuexen 		if (tp1 == NULL) {
3172b5c16493SMichael Tuexen 			circled = 0;
3173b5c16493SMichael Tuexen 			tp1 = TAILQ_FIRST(&stcb->asoc.sent_queue);
3174b5c16493SMichael Tuexen 		}
3175b5c16493SMichael Tuexen 		/* In case the fragments were not in order we must reset */
31760fa753b3SRandall Stewart 	}			/* end for (j = fragStart */
31770fa753b3SRandall Stewart 	*p_tp1 = tp1;
31780fa753b3SRandall Stewart 	return (wake_him);	/* Return value only used for nr-sack */
31790fa753b3SRandall Stewart }
31800fa753b3SRandall Stewart 
3181cd554309SMichael Tuexen static int
3182458303daSRandall Stewart sctp_handle_segments(struct mbuf *m, int *offset, struct sctp_tcb *stcb, struct sctp_association *asoc,
3183cd554309SMichael Tuexen     uint32_t last_tsn, uint32_t *biggest_tsn_acked,
3184139bc87fSRandall Stewart     uint32_t *biggest_newly_acked_tsn, uint32_t *this_sack_lowest_newack,
31857215cc1bSMichael Tuexen     int num_seg, int num_nr_seg, int *rto_ok)
3186f8829a4aSRandall Stewart {
3187458303daSRandall Stewart 	struct sctp_gap_ack_block *frag, block;
3188f8829a4aSRandall Stewart 	struct sctp_tmit_chunk *tp1;
31890fa753b3SRandall Stewart 	int i;
3190f8829a4aSRandall Stewart 	int num_frs = 0;
3191cd554309SMichael Tuexen 	int chunk_freed;
3192cd554309SMichael Tuexen 	int non_revocable;
3193d9c5cfeaSMichael Tuexen 	uint16_t frag_strt, frag_end, prev_frag_end;
3194f8829a4aSRandall Stewart 
3195d9c5cfeaSMichael Tuexen 	tp1 = TAILQ_FIRST(&asoc->sent_queue);
3196d9c5cfeaSMichael Tuexen 	prev_frag_end = 0;
3197cd554309SMichael Tuexen 	chunk_freed = 0;
3198f8829a4aSRandall Stewart 
3199cd554309SMichael Tuexen 	for (i = 0; i < (num_seg + num_nr_seg); i++) {
3200d9c5cfeaSMichael Tuexen 		if (i == num_seg) {
3201d9c5cfeaSMichael Tuexen 			prev_frag_end = 0;
3202d9c5cfeaSMichael Tuexen 			tp1 = TAILQ_FIRST(&asoc->sent_queue);
3203d9c5cfeaSMichael Tuexen 		}
3204458303daSRandall Stewart 		frag = (struct sctp_gap_ack_block *)sctp_m_getptr(m, *offset,
3205458303daSRandall Stewart 		    sizeof(struct sctp_gap_ack_block), (uint8_t *)&block);
3206458303daSRandall Stewart 		*offset += sizeof(block);
3207458303daSRandall Stewart 		if (frag == NULL) {
3208cd554309SMichael Tuexen 			return (chunk_freed);
3209458303daSRandall Stewart 		}
3210f8829a4aSRandall Stewart 		frag_strt = ntohs(frag->start);
3211f8829a4aSRandall Stewart 		frag_end = ntohs(frag->end);
3212d9c5cfeaSMichael Tuexen 
3213f8829a4aSRandall Stewart 		if (frag_strt > frag_end) {
3214d9c5cfeaSMichael Tuexen 			/* This gap report is malformed, skip it. */
3215f8829a4aSRandall Stewart 			continue;
3216f8829a4aSRandall Stewart 		}
3217d9c5cfeaSMichael Tuexen 		if (frag_strt <= prev_frag_end) {
3218d9c5cfeaSMichael Tuexen 			/* This gap report is not in order, so restart. */
3219f8829a4aSRandall Stewart 			tp1 = TAILQ_FIRST(&asoc->sent_queue);
3220f8829a4aSRandall Stewart 		}
322120b07a4dSMichael Tuexen 		if (SCTP_TSN_GT((last_tsn + frag_end), *biggest_tsn_acked)) {
3222d9c5cfeaSMichael Tuexen 			*biggest_tsn_acked = last_tsn + frag_end;
3223f8829a4aSRandall Stewart 		}
3224cd554309SMichael Tuexen 		if (i < num_seg) {
3225cd554309SMichael Tuexen 			non_revocable = 0;
3226cd554309SMichael Tuexen 		} else {
3227cd554309SMichael Tuexen 			non_revocable = 1;
3228cd554309SMichael Tuexen 		}
3229cd554309SMichael Tuexen 		if (sctp_process_segment_range(stcb, &tp1, last_tsn, frag_strt, frag_end,
3230cd554309SMichael Tuexen 		    non_revocable, &num_frs, biggest_newly_acked_tsn,
32317215cc1bSMichael Tuexen 		    this_sack_lowest_newack, rto_ok)) {
3232cd554309SMichael Tuexen 			chunk_freed = 1;
3233458303daSRandall Stewart 		}
3234d9c5cfeaSMichael Tuexen 		prev_frag_end = frag_end;
3235f8829a4aSRandall Stewart 	}
3236b3f1ea41SRandall Stewart 	if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FR_LOGGING_ENABLE) {
323780fefe0aSRandall Stewart 		if (num_frs)
323880fefe0aSRandall Stewart 			sctp_log_fr(*biggest_tsn_acked,
323980fefe0aSRandall Stewart 			    *biggest_newly_acked_tsn,
324080fefe0aSRandall Stewart 			    last_tsn, SCTP_FR_LOG_BIGGEST_TSNS);
324180fefe0aSRandall Stewart 	}
3242cd554309SMichael Tuexen 	return (chunk_freed);
3243f8829a4aSRandall Stewart }
3244f8829a4aSRandall Stewart 
3245f8829a4aSRandall Stewart static void
3246c105859eSRandall Stewart sctp_check_for_revoked(struct sctp_tcb *stcb,
3247c105859eSRandall Stewart     struct sctp_association *asoc, uint32_t cumack,
324863eda93dSMichael Tuexen     uint32_t biggest_tsn_acked)
3249f8829a4aSRandall Stewart {
3250f8829a4aSRandall Stewart 	struct sctp_tmit_chunk *tp1;
3251f8829a4aSRandall Stewart 
32524a9ef3f8SMichael Tuexen 	TAILQ_FOREACH(tp1, &asoc->sent_queue, sctp_next) {
325349656eefSMichael Tuexen 		if (SCTP_TSN_GT(tp1->rec.data.tsn, cumack)) {
3254f8829a4aSRandall Stewart 			/*
3255f8829a4aSRandall Stewart 			 * ok this guy is either ACK or MARKED. If it is
3256f8829a4aSRandall Stewart 			 * ACKED it has been previously acked but not this
3257f8829a4aSRandall Stewart 			 * time i.e. revoked.  If it is MARKED it was ACK'ed
3258f8829a4aSRandall Stewart 			 * again.
3259f8829a4aSRandall Stewart 			 */
326049656eefSMichael Tuexen 			if (SCTP_TSN_GT(tp1->rec.data.tsn, biggest_tsn_acked)) {
3261d06c82f1SRandall Stewart 				break;
326220b07a4dSMichael Tuexen 			}
3263f8829a4aSRandall Stewart 			if (tp1->sent == SCTP_DATAGRAM_ACKED) {
3264f8829a4aSRandall Stewart 				/* it has been revoked */
3265f8829a4aSRandall Stewart 				tp1->sent = SCTP_DATAGRAM_SENT;
3266f8829a4aSRandall Stewart 				tp1->rec.data.chunk_was_revoked = 1;
3267a5d547adSRandall Stewart 				/*
326842551e99SRandall Stewart 				 * We must add this stuff back in to assure
326942551e99SRandall Stewart 				 * timers and such get started.
3270a5d547adSRandall Stewart 				 */
3271b3f1ea41SRandall Stewart 				if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FLIGHT_LOGGING_ENABLE) {
3272c105859eSRandall Stewart 					sctp_misc_ints(SCTP_FLIGHT_LOG_UP_REVOKE,
3273c105859eSRandall Stewart 					    tp1->whoTo->flight_size,
3274c105859eSRandall Stewart 					    tp1->book_size,
32759a8e3088SMichael Tuexen 					    (uint32_t)(uintptr_t)tp1->whoTo,
327649656eefSMichael Tuexen 					    tp1->rec.data.tsn);
327780fefe0aSRandall Stewart 				}
3278c105859eSRandall Stewart 				sctp_flight_size_increase(tp1);
3279c105859eSRandall Stewart 				sctp_total_flight_increase(stcb, tp1);
328042551e99SRandall Stewart 				/*
328142551e99SRandall Stewart 				 * We inflate the cwnd to compensate for our
328242551e99SRandall Stewart 				 * artificial inflation of the flight_size.
328342551e99SRandall Stewart 				 */
328442551e99SRandall Stewart 				tp1->whoTo->cwnd += tp1->book_size;
3285b3f1ea41SRandall Stewart 				if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_SACK_LOGGING_ENABLE) {
3286f8829a4aSRandall Stewart 					sctp_log_sack(asoc->last_acked_seq,
3287f8829a4aSRandall Stewart 					    cumack,
328849656eefSMichael Tuexen 					    tp1->rec.data.tsn,
3289f8829a4aSRandall Stewart 					    0,
3290f8829a4aSRandall Stewart 					    0,
3291f8829a4aSRandall Stewart 					    SCTP_LOG_TSN_REVOKED);
329280fefe0aSRandall Stewart 				}
3293f8829a4aSRandall Stewart 			} else if (tp1->sent == SCTP_DATAGRAM_MARKED) {
3294f8829a4aSRandall Stewart 				/* it has been re-acked in this SACK */
3295f8829a4aSRandall Stewart 				tp1->sent = SCTP_DATAGRAM_ACKED;
3296f8829a4aSRandall Stewart 			}
3297f8829a4aSRandall Stewart 		}
3298f8829a4aSRandall Stewart 		if (tp1->sent == SCTP_DATAGRAM_UNSENT)
3299f8829a4aSRandall Stewart 			break;
3300f8829a4aSRandall Stewart 	}
3301f8829a4aSRandall Stewart }
3302f8829a4aSRandall Stewart 
3303f8829a4aSRandall Stewart static void
3304f8829a4aSRandall Stewart sctp_strike_gap_ack_chunks(struct sctp_tcb *stcb, struct sctp_association *asoc,
330563eda93dSMichael Tuexen     uint32_t biggest_tsn_acked, uint32_t biggest_tsn_newly_acked, uint32_t this_sack_lowest_newack, int accum_moved)
3306f8829a4aSRandall Stewart {
3307f8829a4aSRandall Stewart 	struct sctp_tmit_chunk *tp1;
3308f8829a4aSRandall Stewart 	int strike_flag = 0;
3309f8829a4aSRandall Stewart 	struct timeval now;
3310f8829a4aSRandall Stewart 	uint32_t sending_seq;
3311f8829a4aSRandall Stewart 	struct sctp_nets *net;
3312f8829a4aSRandall Stewart 	int num_dests_sacked = 0;
3313f8829a4aSRandall Stewart 
3314f8829a4aSRandall Stewart 	/*
3315f8829a4aSRandall Stewart 	 * select the sending_seq, this is either the next thing ready to be
3316f8829a4aSRandall Stewart 	 * sent but not transmitted, OR, the next seq we assign.
3317f8829a4aSRandall Stewart 	 */
3318f8829a4aSRandall Stewart 	tp1 = TAILQ_FIRST(&stcb->asoc.send_queue);
3319f8829a4aSRandall Stewart 	if (tp1 == NULL) {
3320f8829a4aSRandall Stewart 		sending_seq = asoc->sending_seq;
3321f8829a4aSRandall Stewart 	} else {
332249656eefSMichael Tuexen 		sending_seq = tp1->rec.data.tsn;
3323f8829a4aSRandall Stewart 	}
3324f8829a4aSRandall Stewart 
3325f8829a4aSRandall Stewart 	/* CMT DAC algo: finding out if SACK is a mixed SACK */
33267c99d56fSMichael Tuexen 	if ((asoc->sctp_cmt_on_off > 0) &&
332720083c2eSMichael Tuexen 	    SCTP_BASE_SYSCTL(sctp_cmt_use_dac)) {
3328f8829a4aSRandall Stewart 		TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
3329f8829a4aSRandall Stewart 			if (net->saw_newack)
3330f8829a4aSRandall Stewart 				num_dests_sacked++;
3331f8829a4aSRandall Stewart 		}
3332f8829a4aSRandall Stewart 	}
3333dd973b0eSMichael Tuexen 	if (stcb->asoc.prsctp_supported) {
33346e55db54SRandall Stewart 		(void)SCTP_GETTIME_TIMEVAL(&now);
3335f8829a4aSRandall Stewart 	}
33364a9ef3f8SMichael Tuexen 	TAILQ_FOREACH(tp1, &asoc->sent_queue, sctp_next) {
3337f8829a4aSRandall Stewart 		strike_flag = 0;
3338f8829a4aSRandall Stewart 		if (tp1->no_fr_allowed) {
3339f8829a4aSRandall Stewart 			/* this one had a timeout or something */
3340f8829a4aSRandall Stewart 			continue;
3341f8829a4aSRandall Stewart 		}
3342b3f1ea41SRandall Stewart 		if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FR_LOGGING_ENABLE) {
3343f8829a4aSRandall Stewart 			if (tp1->sent < SCTP_DATAGRAM_RESEND)
3344f8829a4aSRandall Stewart 				sctp_log_fr(biggest_tsn_newly_acked,
334549656eefSMichael Tuexen 				    tp1->rec.data.tsn,
3346f8829a4aSRandall Stewart 				    tp1->sent,
3347f8829a4aSRandall Stewart 				    SCTP_FR_LOG_CHECK_STRIKE);
334880fefe0aSRandall Stewart 		}
334949656eefSMichael Tuexen 		if (SCTP_TSN_GT(tp1->rec.data.tsn, biggest_tsn_acked) ||
3350f8829a4aSRandall Stewart 		    tp1->sent == SCTP_DATAGRAM_UNSENT) {
3351f8829a4aSRandall Stewart 			/* done */
3352f8829a4aSRandall Stewart 			break;
3353f8829a4aSRandall Stewart 		}
3354dd973b0eSMichael Tuexen 		if (stcb->asoc.prsctp_supported) {
3355f8829a4aSRandall Stewart 			if ((PR_SCTP_TTL_ENABLED(tp1->flags)) && tp1->sent < SCTP_DATAGRAM_ACKED) {
3356f8829a4aSRandall Stewart 				/* Is it expired? */
335799ddc825SMichael Tuexen 				if (timevalcmp(&now, &tp1->rec.data.timetodrop, >)) {
3358f8829a4aSRandall Stewart 					/* Yes so drop it */
3359f8829a4aSRandall Stewart 					if (tp1->data != NULL) {
33601edc9dbaSMichael Tuexen 						(void)sctp_release_pr_sctp_chunk(stcb, tp1, 1,
33610c0982b8SRandall Stewart 						    SCTP_SO_NOT_LOCKED);
3362f8829a4aSRandall Stewart 					}
3363f8829a4aSRandall Stewart 					continue;
3364f8829a4aSRandall Stewart 				}
3365f8829a4aSRandall Stewart 			}
3366f8829a4aSRandall Stewart 		}
3367e9a3a1b1SMichael Tuexen 		if (SCTP_TSN_GT(tp1->rec.data.tsn, asoc->this_sack_highest_gap) &&
3368e9a3a1b1SMichael Tuexen 		    !(accum_moved && asoc->fast_retran_loss_recovery)) {
3369f8829a4aSRandall Stewart 			/* we are beyond the tsn in the sack  */
3370f8829a4aSRandall Stewart 			break;
3371f8829a4aSRandall Stewart 		}
3372f8829a4aSRandall Stewart 		if (tp1->sent >= SCTP_DATAGRAM_RESEND) {
3373f8829a4aSRandall Stewart 			/* either a RESEND, ACKED, or MARKED */
3374f8829a4aSRandall Stewart 			/* skip */
337544fbe462SRandall Stewart 			if (tp1->sent == SCTP_FORWARD_TSN_SKIP) {
337644fbe462SRandall Stewart 				/* Continue strikin FWD-TSN chunks */
337744fbe462SRandall Stewart 				tp1->rec.data.fwd_tsn_cnt++;
337844fbe462SRandall Stewart 			}
3379f8829a4aSRandall Stewart 			continue;
3380f8829a4aSRandall Stewart 		}
3381f8829a4aSRandall Stewart 		/*
3382f8829a4aSRandall Stewart 		 * CMT : SFR algo (covers part of DAC and HTNA as well)
3383f8829a4aSRandall Stewart 		 */
3384ad81507eSRandall Stewart 		if (tp1->whoTo && tp1->whoTo->saw_newack == 0) {
3385f8829a4aSRandall Stewart 			/*
3386e7e65008SMichael Tuexen 			 * No new acks were received for data sent to this
3387f8829a4aSRandall Stewart 			 * dest. Therefore, according to the SFR algo for
3388f8829a4aSRandall Stewart 			 * CMT, no data sent to this dest can be marked for
3389c105859eSRandall Stewart 			 * FR using this SACK.
3390f8829a4aSRandall Stewart 			 */
3391f8829a4aSRandall Stewart 			continue;
3392e9a3a1b1SMichael Tuexen 		} else if (tp1->whoTo &&
3393e9a3a1b1SMichael Tuexen 			    SCTP_TSN_GT(tp1->rec.data.tsn,
3394e9a3a1b1SMichael Tuexen 			    tp1->whoTo->this_sack_highest_newack) &&
3395e9a3a1b1SMichael Tuexen 		    !(accum_moved && asoc->fast_retran_loss_recovery)) {
3396f8829a4aSRandall Stewart 			/*
3397e7e65008SMichael Tuexen 			 * CMT: New acks were received for data sent to this
3398e7e65008SMichael Tuexen 			 * dest. But no new acks were seen for data sent
3399e7e65008SMichael Tuexen 			 * after tp1. Therefore, according to the SFR algo
3400e7e65008SMichael Tuexen 			 * for CMT, tp1 cannot be marked for FR using this
3401e7e65008SMichael Tuexen 			 * SACK. This step covers part of the DAC algo and
3402e7e65008SMichael Tuexen 			 * the HTNA algo as well.
3403f8829a4aSRandall Stewart 			 */
3404f8829a4aSRandall Stewart 			continue;
3405f8829a4aSRandall Stewart 		}
3406f8829a4aSRandall Stewart 		/*
3407f8829a4aSRandall Stewart 		 * Here we check to see if we were have already done a FR
3408f8829a4aSRandall Stewart 		 * and if so we see if the biggest TSN we saw in the sack is
3409f8829a4aSRandall Stewart 		 * smaller than the recovery point. If so we don't strike
3410f8829a4aSRandall Stewart 		 * the tsn... otherwise we CAN strike the TSN.
3411f8829a4aSRandall Stewart 		 */
3412f8829a4aSRandall Stewart 		/*
341342551e99SRandall Stewart 		 * @@@ JRI: Check for CMT if (accum_moved &&
341442551e99SRandall Stewart 		 * asoc->fast_retran_loss_recovery && (sctp_cmt_on_off ==
341542551e99SRandall Stewart 		 * 0)) {
3416f8829a4aSRandall Stewart 		 */
341742551e99SRandall Stewart 		if (accum_moved && asoc->fast_retran_loss_recovery) {
3418f8829a4aSRandall Stewart 			/*
3419f8829a4aSRandall Stewart 			 * Strike the TSN if in fast-recovery and cum-ack
3420f8829a4aSRandall Stewart 			 * moved.
3421f8829a4aSRandall Stewart 			 */
3422b3f1ea41SRandall Stewart 			if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FR_LOGGING_ENABLE) {
3423f8829a4aSRandall Stewart 				sctp_log_fr(biggest_tsn_newly_acked,
342449656eefSMichael Tuexen 				    tp1->rec.data.tsn,
3425f8829a4aSRandall Stewart 				    tp1->sent,
3426f8829a4aSRandall Stewart 				    SCTP_FR_LOG_STRIKE_CHUNK);
342780fefe0aSRandall Stewart 			}
34285e54f665SRandall Stewart 			if (tp1->sent < SCTP_DATAGRAM_RESEND) {
3429f8829a4aSRandall Stewart 				tp1->sent++;
34305e54f665SRandall Stewart 			}
34317c99d56fSMichael Tuexen 			if ((asoc->sctp_cmt_on_off > 0) &&
343220083c2eSMichael Tuexen 			    SCTP_BASE_SYSCTL(sctp_cmt_use_dac)) {
3433f8829a4aSRandall Stewart 				/*
3434f8829a4aSRandall Stewart 				 * CMT DAC algorithm: If SACK flag is set to
3435f8829a4aSRandall Stewart 				 * 0, then lowest_newack test will not pass
3436f8829a4aSRandall Stewart 				 * because it would have been set to the
3437f8829a4aSRandall Stewart 				 * cumack earlier. If not already to be
3438f8829a4aSRandall Stewart 				 * rtx'd, If not a mixed sack and if tp1 is
3439f8829a4aSRandall Stewart 				 * not between two sacked TSNs, then mark by
3440c105859eSRandall Stewart 				 * one more. NOTE that we are marking by one
3441c105859eSRandall Stewart 				 * additional time since the SACK DAC flag
3442c105859eSRandall Stewart 				 * indicates that two packets have been
3443c105859eSRandall Stewart 				 * received after this missing TSN.
34445e54f665SRandall Stewart 				 */
34455e54f665SRandall Stewart 				if ((tp1->sent < SCTP_DATAGRAM_RESEND) && (num_dests_sacked == 1) &&
344649656eefSMichael Tuexen 				    SCTP_TSN_GT(this_sack_lowest_newack, tp1->rec.data.tsn)) {
3447b3f1ea41SRandall Stewart 					if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FR_LOGGING_ENABLE) {
3448f8829a4aSRandall Stewart 						sctp_log_fr(16 + num_dests_sacked,
344949656eefSMichael Tuexen 						    tp1->rec.data.tsn,
3450f8829a4aSRandall Stewart 						    tp1->sent,
3451f8829a4aSRandall Stewart 						    SCTP_FR_LOG_STRIKE_CHUNK);
345280fefe0aSRandall Stewart 					}
3453f8829a4aSRandall Stewart 					tp1->sent++;
3454f8829a4aSRandall Stewart 				}
3455f8829a4aSRandall Stewart 			}
345620083c2eSMichael Tuexen 		} else if ((tp1->rec.data.doing_fast_retransmit) &&
345720083c2eSMichael Tuexen 		    (asoc->sctp_cmt_on_off == 0)) {
3458f8829a4aSRandall Stewart 			/*
3459f8829a4aSRandall Stewart 			 * For those that have done a FR we must take
3460f8829a4aSRandall Stewart 			 * special consideration if we strike. I.e the
3461f8829a4aSRandall Stewart 			 * biggest_newly_acked must be higher than the
3462f8829a4aSRandall Stewart 			 * sending_seq at the time we did the FR.
3463f8829a4aSRandall Stewart 			 */
34645e54f665SRandall Stewart 			if (
3465f8829a4aSRandall Stewart #ifdef SCTP_FR_TO_ALTERNATE
3466f8829a4aSRandall Stewart 			/*
3467f8829a4aSRandall Stewart 			 * If FR's go to new networks, then we must only do
3468f8829a4aSRandall Stewart 			 * this for singly homed asoc's. However if the FR's
3469f8829a4aSRandall Stewart 			 * go to the same network (Armando's work) then its
3470f8829a4aSRandall Stewart 			 * ok to FR multiple times.
3471f8829a4aSRandall Stewart 			 */
34725e54f665SRandall Stewart 			    (asoc->numnets < 2)
3473f8829a4aSRandall Stewart #else
34745e54f665SRandall Stewart 			    (1)
3475f8829a4aSRandall Stewart #endif
34765e54f665SRandall Stewart 			    ) {
347720b07a4dSMichael Tuexen 				if (SCTP_TSN_GE(biggest_tsn_newly_acked,
3478f8829a4aSRandall Stewart 				    tp1->rec.data.fast_retran_tsn)) {
3479f8829a4aSRandall Stewart 					/*
3480f8829a4aSRandall Stewart 					 * Strike the TSN, since this ack is
3481f8829a4aSRandall Stewart 					 * beyond where things were when we
3482f8829a4aSRandall Stewart 					 * did a FR.
3483f8829a4aSRandall Stewart 					 */
3484b3f1ea41SRandall Stewart 					if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FR_LOGGING_ENABLE) {
3485f8829a4aSRandall Stewart 						sctp_log_fr(biggest_tsn_newly_acked,
348649656eefSMichael Tuexen 						    tp1->rec.data.tsn,
3487f8829a4aSRandall Stewart 						    tp1->sent,
3488f8829a4aSRandall Stewart 						    SCTP_FR_LOG_STRIKE_CHUNK);
348980fefe0aSRandall Stewart 					}
34905e54f665SRandall Stewart 					if (tp1->sent < SCTP_DATAGRAM_RESEND) {
3491f8829a4aSRandall Stewart 						tp1->sent++;
34925e54f665SRandall Stewart 					}
3493f8829a4aSRandall Stewart 					strike_flag = 1;
34947c99d56fSMichael Tuexen 					if ((asoc->sctp_cmt_on_off > 0) &&
349520083c2eSMichael Tuexen 					    SCTP_BASE_SYSCTL(sctp_cmt_use_dac)) {
3496f8829a4aSRandall Stewart 						/*
3497f8829a4aSRandall Stewart 						 * CMT DAC algorithm: If
3498f8829a4aSRandall Stewart 						 * SACK flag is set to 0,
3499f8829a4aSRandall Stewart 						 * then lowest_newack test
3500f8829a4aSRandall Stewart 						 * will not pass because it
3501f8829a4aSRandall Stewart 						 * would have been set to
3502f8829a4aSRandall Stewart 						 * the cumack earlier. If
3503f8829a4aSRandall Stewart 						 * not already to be rtx'd,
3504f8829a4aSRandall Stewart 						 * If not a mixed sack and
3505f8829a4aSRandall Stewart 						 * if tp1 is not between two
3506f8829a4aSRandall Stewart 						 * sacked TSNs, then mark by
3507c105859eSRandall Stewart 						 * one more. NOTE that we
3508c105859eSRandall Stewart 						 * are marking by one
3509c105859eSRandall Stewart 						 * additional time since the
3510c105859eSRandall Stewart 						 * SACK DAC flag indicates
3511c105859eSRandall Stewart 						 * that two packets have
3512c105859eSRandall Stewart 						 * been received after this
3513c105859eSRandall Stewart 						 * missing TSN.
3514f8829a4aSRandall Stewart 						 */
35155e54f665SRandall Stewart 						if ((tp1->sent < SCTP_DATAGRAM_RESEND) &&
35165e54f665SRandall Stewart 						    (num_dests_sacked == 1) &&
351720b07a4dSMichael Tuexen 						    SCTP_TSN_GT(this_sack_lowest_newack,
351849656eefSMichael Tuexen 						    tp1->rec.data.tsn)) {
3519b3f1ea41SRandall Stewart 							if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FR_LOGGING_ENABLE) {
3520f8829a4aSRandall Stewart 								sctp_log_fr(32 + num_dests_sacked,
352149656eefSMichael Tuexen 								    tp1->rec.data.tsn,
3522f8829a4aSRandall Stewart 								    tp1->sent,
3523f8829a4aSRandall Stewart 								    SCTP_FR_LOG_STRIKE_CHUNK);
352480fefe0aSRandall Stewart 							}
35255e54f665SRandall Stewart 							if (tp1->sent < SCTP_DATAGRAM_RESEND) {
3526f8829a4aSRandall Stewart 								tp1->sent++;
35275e54f665SRandall Stewart 							}
3528f8829a4aSRandall Stewart 						}
3529f8829a4aSRandall Stewart 					}
3530f8829a4aSRandall Stewart 				}
3531f8829a4aSRandall Stewart 			}
3532f8829a4aSRandall Stewart 			/*
353342551e99SRandall Stewart 			 * JRI: TODO: remove code for HTNA algo. CMT's SFR
353442551e99SRandall Stewart 			 * algo covers HTNA.
3535f8829a4aSRandall Stewart 			 */
353649656eefSMichael Tuexen 		} else if (SCTP_TSN_GT(tp1->rec.data.tsn,
353720b07a4dSMichael Tuexen 		    biggest_tsn_newly_acked)) {
3538f8829a4aSRandall Stewart 			/*
3539f8829a4aSRandall Stewart 			 * We don't strike these: This is the  HTNA
3540f8829a4aSRandall Stewart 			 * algorithm i.e. we don't strike If our TSN is
3541f8829a4aSRandall Stewart 			 * larger than the Highest TSN Newly Acked.
3542f8829a4aSRandall Stewart 			 */
3543f8829a4aSRandall Stewart 			;
3544f8829a4aSRandall Stewart 		} else {
3545f8829a4aSRandall Stewart 			/* Strike the TSN */
3546b3f1ea41SRandall Stewart 			if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FR_LOGGING_ENABLE) {
3547f8829a4aSRandall Stewart 				sctp_log_fr(biggest_tsn_newly_acked,
354849656eefSMichael Tuexen 				    tp1->rec.data.tsn,
3549f8829a4aSRandall Stewart 				    tp1->sent,
3550f8829a4aSRandall Stewart 				    SCTP_FR_LOG_STRIKE_CHUNK);
355180fefe0aSRandall Stewart 			}
35525e54f665SRandall Stewart 			if (tp1->sent < SCTP_DATAGRAM_RESEND) {
3553f8829a4aSRandall Stewart 				tp1->sent++;
35545e54f665SRandall Stewart 			}
35557c99d56fSMichael Tuexen 			if ((asoc->sctp_cmt_on_off > 0) &&
355620083c2eSMichael Tuexen 			    SCTP_BASE_SYSCTL(sctp_cmt_use_dac)) {
3557f8829a4aSRandall Stewart 				/*
3558f8829a4aSRandall Stewart 				 * CMT DAC algorithm: If SACK flag is set to
3559f8829a4aSRandall Stewart 				 * 0, then lowest_newack test will not pass
3560f8829a4aSRandall Stewart 				 * because it would have been set to the
3561f8829a4aSRandall Stewart 				 * cumack earlier. If not already to be
3562f8829a4aSRandall Stewart 				 * rtx'd, If not a mixed sack and if tp1 is
3563f8829a4aSRandall Stewart 				 * not between two sacked TSNs, then mark by
3564c105859eSRandall Stewart 				 * one more. NOTE that we are marking by one
3565c105859eSRandall Stewart 				 * additional time since the SACK DAC flag
3566c105859eSRandall Stewart 				 * indicates that two packets have been
3567c105859eSRandall Stewart 				 * received after this missing TSN.
3568f8829a4aSRandall Stewart 				 */
35695e54f665SRandall Stewart 				if ((tp1->sent < SCTP_DATAGRAM_RESEND) && (num_dests_sacked == 1) &&
357049656eefSMichael Tuexen 				    SCTP_TSN_GT(this_sack_lowest_newack, tp1->rec.data.tsn)) {
3571b3f1ea41SRandall Stewart 					if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FR_LOGGING_ENABLE) {
3572f8829a4aSRandall Stewart 						sctp_log_fr(48 + num_dests_sacked,
357349656eefSMichael Tuexen 						    tp1->rec.data.tsn,
3574f8829a4aSRandall Stewart 						    tp1->sent,
3575f8829a4aSRandall Stewart 						    SCTP_FR_LOG_STRIKE_CHUNK);
357680fefe0aSRandall Stewart 					}
3577f8829a4aSRandall Stewart 					tp1->sent++;
3578f8829a4aSRandall Stewart 				}
3579f8829a4aSRandall Stewart 			}
3580f8829a4aSRandall Stewart 		}
3581f8829a4aSRandall Stewart 		if (tp1->sent == SCTP_DATAGRAM_RESEND) {
3582f8829a4aSRandall Stewart 			struct sctp_nets *alt;
3583f8829a4aSRandall Stewart 
3584544e35bdSRandall Stewart 			/* fix counts and things */
3585544e35bdSRandall Stewart 			if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FLIGHT_LOGGING_ENABLE) {
3586544e35bdSRandall Stewart 				sctp_misc_ints(SCTP_FLIGHT_LOG_DOWN_RSND,
3587544e35bdSRandall Stewart 				    (tp1->whoTo ? (tp1->whoTo->flight_size) : 0),
3588544e35bdSRandall Stewart 				    tp1->book_size,
35899a8e3088SMichael Tuexen 				    (uint32_t)(uintptr_t)tp1->whoTo,
359049656eefSMichael Tuexen 				    tp1->rec.data.tsn);
3591544e35bdSRandall Stewart 			}
3592544e35bdSRandall Stewart 			if (tp1->whoTo) {
3593544e35bdSRandall Stewart 				tp1->whoTo->net_ack++;
3594544e35bdSRandall Stewart 				sctp_flight_size_decrease(tp1);
3595299108c5SRandall Stewart 				if (stcb->asoc.cc_functions.sctp_cwnd_update_tsn_acknowledged) {
3596299108c5SRandall Stewart 					(*stcb->asoc.cc_functions.sctp_cwnd_update_tsn_acknowledged) (tp1->whoTo,
3597299108c5SRandall Stewart 					    tp1);
3598299108c5SRandall Stewart 				}
3599544e35bdSRandall Stewart 			}
36000053ed28SMichael Tuexen 
3601544e35bdSRandall Stewart 			if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_RWND_ENABLE) {
3602544e35bdSRandall Stewart 				sctp_log_rwnd(SCTP_INCREASE_PEER_RWND,
3603544e35bdSRandall Stewart 				    asoc->peers_rwnd, tp1->send_size, SCTP_BASE_SYSCTL(sctp_peer_chunk_oh));
3604544e35bdSRandall Stewart 			}
3605544e35bdSRandall Stewart 			/* add back to the rwnd */
3606544e35bdSRandall Stewart 			asoc->peers_rwnd += (tp1->send_size + SCTP_BASE_SYSCTL(sctp_peer_chunk_oh));
3607544e35bdSRandall Stewart 
3608544e35bdSRandall Stewart 			/* remove from the total flight */
3609544e35bdSRandall Stewart 			sctp_total_flight_decrease(stcb, tp1);
3610544e35bdSRandall Stewart 
3611dd973b0eSMichael Tuexen 			if ((stcb->asoc.prsctp_supported) &&
3612475d0674SMichael Tuexen 			    (PR_SCTP_RTX_ENABLED(tp1->flags))) {
3613b7b84c0eSMichael Tuexen 				/*
3614b7b84c0eSMichael Tuexen 				 * Has it been retransmitted tv_sec times? -
3615b7b84c0eSMichael Tuexen 				 * we store the retran count there.
3616b7b84c0eSMichael Tuexen 				 */
3617475d0674SMichael Tuexen 				if (tp1->snd_count > tp1->rec.data.timetodrop.tv_sec) {
3618475d0674SMichael Tuexen 					/* Yes, so drop it */
3619475d0674SMichael Tuexen 					if (tp1->data != NULL) {
36201edc9dbaSMichael Tuexen 						(void)sctp_release_pr_sctp_chunk(stcb, tp1, 1,
3621475d0674SMichael Tuexen 						    SCTP_SO_NOT_LOCKED);
3622475d0674SMichael Tuexen 					}
3623475d0674SMichael Tuexen 					/* Make sure to flag we had a FR */
362467e8b08bSMichael Tuexen 					if (tp1->whoTo != NULL) {
3625475d0674SMichael Tuexen 						tp1->whoTo->net_ack++;
362667e8b08bSMichael Tuexen 					}
3627475d0674SMichael Tuexen 					continue;
3628475d0674SMichael Tuexen 				}
3629475d0674SMichael Tuexen 			}
3630b7b84c0eSMichael Tuexen 			/*
3631b7b84c0eSMichael Tuexen 			 * SCTP_PRINTF("OK, we are now ready to FR this
3632b7b84c0eSMichael Tuexen 			 * guy\n");
3633b7b84c0eSMichael Tuexen 			 */
3634b3f1ea41SRandall Stewart 			if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FR_LOGGING_ENABLE) {
363549656eefSMichael Tuexen 				sctp_log_fr(tp1->rec.data.tsn, tp1->snd_count,
3636f8829a4aSRandall Stewart 				    0, SCTP_FR_MARKED);
363780fefe0aSRandall Stewart 			}
3638f8829a4aSRandall Stewart 			if (strike_flag) {
3639f8829a4aSRandall Stewart 				/* This is a subsequent FR */
3640f8829a4aSRandall Stewart 				SCTP_STAT_INCR(sctps_sendmultfastretrans);
3641f8829a4aSRandall Stewart 			}
36425e54f665SRandall Stewart 			sctp_ucount_incr(stcb->asoc.sent_queue_retran_cnt);
36437c99d56fSMichael Tuexen 			if (asoc->sctp_cmt_on_off > 0) {
3644f8829a4aSRandall Stewart 				/*
3645f8829a4aSRandall Stewart 				 * CMT: Using RTX_SSTHRESH policy for CMT.
3646f8829a4aSRandall Stewart 				 * If CMT is being used, then pick dest with
3647f8829a4aSRandall Stewart 				 * largest ssthresh for any retransmission.
3648f8829a4aSRandall Stewart 				 */
3649f8829a4aSRandall Stewart 				tp1->no_fr_allowed = 1;
3650f8829a4aSRandall Stewart 				alt = tp1->whoTo;
36513c503c28SRandall Stewart 				/* sa_ignore NO_NULL_CHK */
365220083c2eSMichael Tuexen 				if (asoc->sctp_cmt_pf > 0) {
3653b7b84c0eSMichael Tuexen 					/*
3654b7b84c0eSMichael Tuexen 					 * JRS 5/18/07 - If CMT PF is on,
3655b54d3a6cSRandall Stewart 					 * use the PF version of
3656b7b84c0eSMichael Tuexen 					 * find_alt_net()
3657b7b84c0eSMichael Tuexen 					 */
3658b54d3a6cSRandall Stewart 					alt = sctp_find_alternate_net(stcb, alt, 2);
3659b54d3a6cSRandall Stewart 				} else {
3660b7b84c0eSMichael Tuexen 					/*
3661b7b84c0eSMichael Tuexen 					 * JRS 5/18/07 - If only CMT is on,
3662b54d3a6cSRandall Stewart 					 * use the CMT version of
3663b7b84c0eSMichael Tuexen 					 * find_alt_net()
3664b7b84c0eSMichael Tuexen 					 */
366552be287eSRandall Stewart 					/* sa_ignore NO_NULL_CHK */
3666f8829a4aSRandall Stewart 					alt = sctp_find_alternate_net(stcb, alt, 1);
3667b54d3a6cSRandall Stewart 				}
3668ad81507eSRandall Stewart 				if (alt == NULL) {
3669ad81507eSRandall Stewart 					alt = tp1->whoTo;
3670ad81507eSRandall Stewart 				}
3671f8829a4aSRandall Stewart 				/*
3672f8829a4aSRandall Stewart 				 * CUCv2: If a different dest is picked for
3673f8829a4aSRandall Stewart 				 * the retransmission, then new
3674f8829a4aSRandall Stewart 				 * (rtx-)pseudo_cumack needs to be tracked
3675f8829a4aSRandall Stewart 				 * for orig dest. Let CUCv2 track new (rtx-)
3676f8829a4aSRandall Stewart 				 * pseudo-cumack always.
3677f8829a4aSRandall Stewart 				 */
3678ad81507eSRandall Stewart 				if (tp1->whoTo) {
3679f8829a4aSRandall Stewart 					tp1->whoTo->find_pseudo_cumack = 1;
3680f8829a4aSRandall Stewart 					tp1->whoTo->find_rtx_pseudo_cumack = 1;
3681ad81507eSRandall Stewart 				}
3682f8829a4aSRandall Stewart 			} else {	/* CMT is OFF */
3683f8829a4aSRandall Stewart #ifdef SCTP_FR_TO_ALTERNATE
3684f8829a4aSRandall Stewart 				/* Can we find an alternate? */
3685f8829a4aSRandall Stewart 				alt = sctp_find_alternate_net(stcb, tp1->whoTo, 0);
3686f8829a4aSRandall Stewart #else
3687f8829a4aSRandall Stewart 				/*
3688f8829a4aSRandall Stewart 				 * default behavior is to NOT retransmit
3689f8829a4aSRandall Stewart 				 * FR's to an alternate. Armando Caro's
3690f8829a4aSRandall Stewart 				 * paper details why.
3691f8829a4aSRandall Stewart 				 */
3692f8829a4aSRandall Stewart 				alt = tp1->whoTo;
3693f8829a4aSRandall Stewart #endif
3694f8829a4aSRandall Stewart 			}
3695f8829a4aSRandall Stewart 
3696f8829a4aSRandall Stewart 			tp1->rec.data.doing_fast_retransmit = 1;
3697f8829a4aSRandall Stewart 			/* mark the sending seq for possible subsequent FR's */
3698f8829a4aSRandall Stewart 			/*
3699cd3fd531SMichael Tuexen 			 * SCTP_PRINTF("Marking TSN for FR new value %x\n",
370049656eefSMichael Tuexen 			 * (uint32_t)tpi->rec.data.tsn);
3701f8829a4aSRandall Stewart 			 */
3702f8829a4aSRandall Stewart 			if (TAILQ_EMPTY(&asoc->send_queue)) {
3703f8829a4aSRandall Stewart 				/*
3704f8829a4aSRandall Stewart 				 * If the queue of send is empty then its
3705f8829a4aSRandall Stewart 				 * the next sequence number that will be
3706f8829a4aSRandall Stewart 				 * assigned so we subtract one from this to
3707f8829a4aSRandall Stewart 				 * get the one we last sent.
3708f8829a4aSRandall Stewart 				 */
3709f8829a4aSRandall Stewart 				tp1->rec.data.fast_retran_tsn = sending_seq;
3710f8829a4aSRandall Stewart 			} else {
3711f8829a4aSRandall Stewart 				/*
3712f8829a4aSRandall Stewart 				 * If there are chunks on the send queue
3713f8829a4aSRandall Stewart 				 * (unsent data that has made it from the
3714f8829a4aSRandall Stewart 				 * stream queues but not out the door, we
3715f8829a4aSRandall Stewart 				 * take the first one (which will have the
3716f8829a4aSRandall Stewart 				 * lowest TSN) and subtract one to get the
3717f8829a4aSRandall Stewart 				 * one we last sent.
3718f8829a4aSRandall Stewart 				 */
3719f8829a4aSRandall Stewart 				struct sctp_tmit_chunk *ttt;
3720f8829a4aSRandall Stewart 
3721f8829a4aSRandall Stewart 				ttt = TAILQ_FIRST(&asoc->send_queue);
3722f8829a4aSRandall Stewart 				tp1->rec.data.fast_retran_tsn =
372349656eefSMichael Tuexen 				    ttt->rec.data.tsn;
3724f8829a4aSRandall Stewart 			}
3725f8829a4aSRandall Stewart 
3726f8829a4aSRandall Stewart 			if (tp1->do_rtt) {
3727f8829a4aSRandall Stewart 				/*
3728f8829a4aSRandall Stewart 				 * this guy had a RTO calculation pending on
3729f8829a4aSRandall Stewart 				 * it, cancel it
3730f8829a4aSRandall Stewart 				 */
373160990c0cSMichael Tuexen 				if ((tp1->whoTo != NULL) &&
373260990c0cSMichael Tuexen 				    (tp1->whoTo->rto_needed == 0)) {
3733f79aab18SRandall Stewart 					tp1->whoTo->rto_needed = 1;
3734f79aab18SRandall Stewart 				}
3735f8829a4aSRandall Stewart 				tp1->do_rtt = 0;
3736f8829a4aSRandall Stewart 			}
3737f8829a4aSRandall Stewart 			if (alt != tp1->whoTo) {
3738f8829a4aSRandall Stewart 				/* yes, there is an alternate. */
3739f8829a4aSRandall Stewart 				sctp_free_remote_addr(tp1->whoTo);
37403c503c28SRandall Stewart 				/* sa_ignore FREED_MEMORY */
3741f8829a4aSRandall Stewart 				tp1->whoTo = alt;
3742f8829a4aSRandall Stewart 				atomic_add_int(&alt->ref_count, 1);
3743f8829a4aSRandall Stewart 			}
3744f8829a4aSRandall Stewart 		}
37454a9ef3f8SMichael Tuexen 	}
3746f8829a4aSRandall Stewart }
3747f8829a4aSRandall Stewart 
3748f8829a4aSRandall Stewart struct sctp_tmit_chunk *
3749f8829a4aSRandall Stewart sctp_try_advance_peer_ack_point(struct sctp_tcb *stcb,
3750f8829a4aSRandall Stewart     struct sctp_association *asoc)
3751f8829a4aSRandall Stewart {
3752f8829a4aSRandall Stewart 	struct sctp_tmit_chunk *tp1, *tp2, *a_adv = NULL;
3753f8829a4aSRandall Stewart 	struct timeval now;
3754f8829a4aSRandall Stewart 	int now_filled = 0;
3755f8829a4aSRandall Stewart 
3756dd973b0eSMichael Tuexen 	if (asoc->prsctp_supported == 0) {
3757f8829a4aSRandall Stewart 		return (NULL);
3758f8829a4aSRandall Stewart 	}
37594a9ef3f8SMichael Tuexen 	TAILQ_FOREACH_SAFE(tp1, &asoc->sent_queue, sctp_next, tp2) {
3760f8829a4aSRandall Stewart 		if (tp1->sent != SCTP_FORWARD_TSN_SKIP &&
376198f2956cSMichael Tuexen 		    tp1->sent != SCTP_DATAGRAM_RESEND &&
3762325c8c46SMichael Tuexen 		    tp1->sent != SCTP_DATAGRAM_NR_ACKED) {
3763f8829a4aSRandall Stewart 			/* no chance to advance, out of here */
3764f8829a4aSRandall Stewart 			break;
3765f8829a4aSRandall Stewart 		}
37660c0982b8SRandall Stewart 		if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_TRY_ADVANCE) {
37672a498584SMichael Tuexen 			if ((tp1->sent == SCTP_FORWARD_TSN_SKIP) ||
3768325c8c46SMichael Tuexen 			    (tp1->sent == SCTP_DATAGRAM_NR_ACKED)) {
37690c0982b8SRandall Stewart 				sctp_misc_ints(SCTP_FWD_TSN_CHECK,
37700c0982b8SRandall Stewart 				    asoc->advanced_peer_ack_point,
377149656eefSMichael Tuexen 				    tp1->rec.data.tsn, 0, 0);
37720c0982b8SRandall Stewart 			}
37730c0982b8SRandall Stewart 		}
3774f8829a4aSRandall Stewart 		if (!PR_SCTP_ENABLED(tp1->flags)) {
3775f8829a4aSRandall Stewart 			/*
3776f8829a4aSRandall Stewart 			 * We can't fwd-tsn past any that are reliable aka
3777f8829a4aSRandall Stewart 			 * retransmitted until the asoc fails.
3778f8829a4aSRandall Stewart 			 */
3779f8829a4aSRandall Stewart 			break;
3780f8829a4aSRandall Stewart 		}
3781f8829a4aSRandall Stewart 		if (!now_filled) {
37826e55db54SRandall Stewart 			(void)SCTP_GETTIME_TIMEVAL(&now);
3783f8829a4aSRandall Stewart 			now_filled = 1;
3784f8829a4aSRandall Stewart 		}
3785f8829a4aSRandall Stewart 		/*
3786f8829a4aSRandall Stewart 		 * now we got a chunk which is marked for another
3787f8829a4aSRandall Stewart 		 * retransmission to a PR-stream but has run out its chances
3788f8829a4aSRandall Stewart 		 * already maybe OR has been marked to skip now. Can we skip
3789f8829a4aSRandall Stewart 		 * it if its a resend?
3790f8829a4aSRandall Stewart 		 */
3791f8829a4aSRandall Stewart 		if (tp1->sent == SCTP_DATAGRAM_RESEND &&
3792f8829a4aSRandall Stewart 		    (PR_SCTP_TTL_ENABLED(tp1->flags))) {
3793f8829a4aSRandall Stewart 			/*
3794f8829a4aSRandall Stewart 			 * Now is this one marked for resend and its time is
3795f8829a4aSRandall Stewart 			 * now up?
3796f8829a4aSRandall Stewart 			 */
3797f8829a4aSRandall Stewart 			if (timevalcmp(&now, &tp1->rec.data.timetodrop, >)) {
3798f8829a4aSRandall Stewart 				/* Yes so drop it */
3799f8829a4aSRandall Stewart 				if (tp1->data) {
3800ad81507eSRandall Stewart 					(void)sctp_release_pr_sctp_chunk(stcb, tp1,
38011edc9dbaSMichael Tuexen 					    1, SCTP_SO_NOT_LOCKED);
3802f8829a4aSRandall Stewart 				}
3803f8829a4aSRandall Stewart 			} else {
3804f8829a4aSRandall Stewart 				/*
3805f8829a4aSRandall Stewart 				 * No, we are done when hit one for resend
3806f8829a4aSRandall Stewart 				 * whos time as not expired.
3807f8829a4aSRandall Stewart 				 */
3808f8829a4aSRandall Stewart 				break;
3809f8829a4aSRandall Stewart 			}
3810f8829a4aSRandall Stewart 		}
3811f8829a4aSRandall Stewart 		/*
3812f8829a4aSRandall Stewart 		 * Ok now if this chunk is marked to drop it we can clean up
3813f8829a4aSRandall Stewart 		 * the chunk, advance our peer ack point and we can check
3814f8829a4aSRandall Stewart 		 * the next chunk.
3815f8829a4aSRandall Stewart 		 */
381698f2956cSMichael Tuexen 		if ((tp1->sent == SCTP_FORWARD_TSN_SKIP) ||
3817325c8c46SMichael Tuexen 		    (tp1->sent == SCTP_DATAGRAM_NR_ACKED)) {
3818f8829a4aSRandall Stewart 			/* advance PeerAckPoint goes forward */
381949656eefSMichael Tuexen 			if (SCTP_TSN_GT(tp1->rec.data.tsn, asoc->advanced_peer_ack_point)) {
382049656eefSMichael Tuexen 				asoc->advanced_peer_ack_point = tp1->rec.data.tsn;
3821f8829a4aSRandall Stewart 				a_adv = tp1;
382249656eefSMichael Tuexen 			} else if (tp1->rec.data.tsn == asoc->advanced_peer_ack_point) {
38230c0982b8SRandall Stewart 				/* No update but we do save the chk */
38240c0982b8SRandall Stewart 				a_adv = tp1;
38250c0982b8SRandall Stewart 			}
3826f8829a4aSRandall Stewart 		} else {
3827f8829a4aSRandall Stewart 			/*
3828f8829a4aSRandall Stewart 			 * If it is still in RESEND we can advance no
3829f8829a4aSRandall Stewart 			 * further
3830f8829a4aSRandall Stewart 			 */
3831f8829a4aSRandall Stewart 			break;
3832f8829a4aSRandall Stewart 		}
3833f8829a4aSRandall Stewart 	}
3834f8829a4aSRandall Stewart 	return (a_adv);
3835f8829a4aSRandall Stewart }
3836f8829a4aSRandall Stewart 
38370c0982b8SRandall Stewart static int
3838c105859eSRandall Stewart sctp_fs_audit(struct sctp_association *asoc)
3839bff64a4dSRandall Stewart {
3840bff64a4dSRandall Stewart 	struct sctp_tmit_chunk *chk;
3841979bc32cSMichael Tuexen 	int inflight = 0, resend = 0, inbetween = 0, acked = 0, above = 0;
3842548f47a8SMichael Tuexen 	int ret;
3843548f47a8SMichael Tuexen #ifndef INVARIANTS
3844548f47a8SMichael Tuexen 	int entry_flight, entry_cnt;
3845548f47a8SMichael Tuexen #endif
3846548f47a8SMichael Tuexen 
3847548f47a8SMichael Tuexen 	ret = 0;
3848548f47a8SMichael Tuexen #ifndef INVARIANTS
38490c0982b8SRandall Stewart 	entry_flight = asoc->total_flight;
38500c0982b8SRandall Stewart 	entry_cnt = asoc->total_flight_count;
3851548f47a8SMichael Tuexen #endif
38520c0982b8SRandall Stewart 	if (asoc->pr_sctp_cnt >= asoc->sent_queue_cnt)
38530c0982b8SRandall Stewart 		return (0);
3854bff64a4dSRandall Stewart 
3855bff64a4dSRandall Stewart 	TAILQ_FOREACH(chk, &asoc->sent_queue, sctp_next) {
3856bff64a4dSRandall Stewart 		if (chk->sent < SCTP_DATAGRAM_RESEND) {
3857cd3fd531SMichael Tuexen 			SCTP_PRINTF("Chk TSN: %u size: %d inflight cnt: %d\n",
385849656eefSMichael Tuexen 			    chk->rec.data.tsn,
38590c0982b8SRandall Stewart 			    chk->send_size,
3860cd3fd531SMichael Tuexen 			    chk->snd_count);
3861bff64a4dSRandall Stewart 			inflight++;
3862bff64a4dSRandall Stewart 		} else if (chk->sent == SCTP_DATAGRAM_RESEND) {
3863bff64a4dSRandall Stewart 			resend++;
3864bff64a4dSRandall Stewart 		} else if (chk->sent < SCTP_DATAGRAM_ACKED) {
3865bff64a4dSRandall Stewart 			inbetween++;
3866bff64a4dSRandall Stewart 		} else if (chk->sent > SCTP_DATAGRAM_ACKED) {
3867bff64a4dSRandall Stewart 			above++;
3868bff64a4dSRandall Stewart 		} else {
3869bff64a4dSRandall Stewart 			acked++;
3870bff64a4dSRandall Stewart 		}
3871bff64a4dSRandall Stewart 	}
3872f1f73e57SRandall Stewart 
3873c105859eSRandall Stewart 	if ((inflight > 0) || (inbetween > 0)) {
3874f1f73e57SRandall Stewart #ifdef INVARIANTS
3875979bc32cSMichael Tuexen 		panic("Flight size-express incorrect F: %d I: %d R: %d Ab: %d ACK: %d",
3876979bc32cSMichael Tuexen 		    inflight, inbetween, resend, above, acked);
3877f1f73e57SRandall Stewart #else
3878cd3fd531SMichael Tuexen 		SCTP_PRINTF("asoc->total_flight: %d cnt: %d\n",
38790c0982b8SRandall Stewart 		    entry_flight, entry_cnt);
38800c0982b8SRandall Stewart 		SCTP_PRINTF("Flight size-express incorrect F: %d I: %d R: %d Ab: %d ACK: %d\n",
38810c0982b8SRandall Stewart 		    inflight, inbetween, resend, above, acked);
38820c0982b8SRandall Stewart 		ret = 1;
3883f1f73e57SRandall Stewart #endif
3884bff64a4dSRandall Stewart 	}
38850c0982b8SRandall Stewart 	return (ret);
3886c105859eSRandall Stewart }
3887c105859eSRandall Stewart 
3888c105859eSRandall Stewart static void
3889c105859eSRandall Stewart sctp_window_probe_recovery(struct sctp_tcb *stcb,
3890c105859eSRandall Stewart     struct sctp_association *asoc,
3891c105859eSRandall Stewart     struct sctp_tmit_chunk *tp1)
3892c105859eSRandall Stewart {
3893dfb11ef8SRandall Stewart 	tp1->window_probe = 0;
38945171328bSRandall Stewart 	if ((tp1->sent >= SCTP_DATAGRAM_ACKED) || (tp1->data == NULL)) {
3895dfb11ef8SRandall Stewart 		/* TSN's skipped we do NOT move back. */
3896dfb11ef8SRandall Stewart 		sctp_misc_ints(SCTP_FLIGHT_LOG_DWN_WP_FWD,
38978427b3fdSMichael Tuexen 		    tp1->whoTo ? tp1->whoTo->flight_size : 0,
3898dfb11ef8SRandall Stewart 		    tp1->book_size,
38999a8e3088SMichael Tuexen 		    (uint32_t)(uintptr_t)tp1->whoTo,
390049656eefSMichael Tuexen 		    tp1->rec.data.tsn);
3901dfb11ef8SRandall Stewart 		return;
3902dfb11ef8SRandall Stewart 	}
39035171328bSRandall Stewart 	/* First setup this by shrinking flight */
3904299108c5SRandall Stewart 	if (stcb->asoc.cc_functions.sctp_cwnd_update_tsn_acknowledged) {
3905299108c5SRandall Stewart 		(*stcb->asoc.cc_functions.sctp_cwnd_update_tsn_acknowledged) (tp1->whoTo,
3906299108c5SRandall Stewart 		    tp1);
3907299108c5SRandall Stewart 	}
39085171328bSRandall Stewart 	sctp_flight_size_decrease(tp1);
39095171328bSRandall Stewart 	sctp_total_flight_decrease(stcb, tp1);
39105171328bSRandall Stewart 	/* Now mark for resend */
39115171328bSRandall Stewart 	tp1->sent = SCTP_DATAGRAM_RESEND;
3912791437b5SRandall Stewart 	sctp_ucount_incr(asoc->sent_queue_retran_cnt);
3913791437b5SRandall Stewart 
3914b3f1ea41SRandall Stewart 	if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FLIGHT_LOGGING_ENABLE) {
3915c105859eSRandall Stewart 		sctp_misc_ints(SCTP_FLIGHT_LOG_DOWN_WP,
3916c105859eSRandall Stewart 		    tp1->whoTo->flight_size,
3917c105859eSRandall Stewart 		    tp1->book_size,
39189a8e3088SMichael Tuexen 		    (uint32_t)(uintptr_t)tp1->whoTo,
391949656eefSMichael Tuexen 		    tp1->rec.data.tsn);
392080fefe0aSRandall Stewart 	}
3921c105859eSRandall Stewart }
3922c105859eSRandall Stewart 
3923f8829a4aSRandall Stewart void
3924f8829a4aSRandall Stewart sctp_express_handle_sack(struct sctp_tcb *stcb, uint32_t cumack,
3925899288aeSRandall Stewart     uint32_t rwnd, int *abort_now, int ecne_seen)
3926f8829a4aSRandall Stewart {
3927f8829a4aSRandall Stewart 	struct sctp_nets *net;
3928f8829a4aSRandall Stewart 	struct sctp_association *asoc;
3929f8829a4aSRandall Stewart 	struct sctp_tmit_chunk *tp1, *tp2;
39305e54f665SRandall Stewart 	uint32_t old_rwnd;
39315e54f665SRandall Stewart 	int win_probe_recovery = 0;
3932c105859eSRandall Stewart 	int win_probe_recovered = 0;
3933d06c82f1SRandall Stewart 	int j, done_once = 0;
3934f79aab18SRandall Stewart 	int rto_ok = 1;
3935fd60718dSMichael Tuexen 	uint32_t send_s;
3936f8829a4aSRandall Stewart 
3937b3f1ea41SRandall Stewart 	if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_SACK_ARRIVALS_ENABLE) {
3938d06c82f1SRandall Stewart 		sctp_misc_ints(SCTP_SACK_LOG_EXPRESS, cumack,
3939d06c82f1SRandall Stewart 		    rwnd, stcb->asoc.last_acked_seq, stcb->asoc.peers_rwnd);
394080fefe0aSRandall Stewart 	}
3941f8829a4aSRandall Stewart 	SCTP_TCB_LOCK_ASSERT(stcb);
394218e198d3SRandall Stewart #ifdef SCTP_ASOCLOG_OF_TSNS
394318e198d3SRandall Stewart 	stcb->asoc.cumack_log[stcb->asoc.cumack_log_at] = cumack;
394418e198d3SRandall Stewart 	stcb->asoc.cumack_log_at++;
394518e198d3SRandall Stewart 	if (stcb->asoc.cumack_log_at > SCTP_TSN_LOG_SIZE) {
394618e198d3SRandall Stewart 		stcb->asoc.cumack_log_at = 0;
394718e198d3SRandall Stewart 	}
394818e198d3SRandall Stewart #endif
3949f8829a4aSRandall Stewart 	asoc = &stcb->asoc;
3950d06c82f1SRandall Stewart 	old_rwnd = asoc->peers_rwnd;
395120b07a4dSMichael Tuexen 	if (SCTP_TSN_GT(asoc->last_acked_seq, cumack)) {
39525e54f665SRandall Stewart 		/* old ack */
39535e54f665SRandall Stewart 		return;
3954d06c82f1SRandall Stewart 	} else if (asoc->last_acked_seq == cumack) {
3955d06c82f1SRandall Stewart 		/* Window update sack */
3956d06c82f1SRandall Stewart 		asoc->peers_rwnd = sctp_sbspace_sub(rwnd,
395744fbe462SRandall Stewart 		    (uint32_t)(asoc->total_flight + (asoc->total_flight_count * SCTP_BASE_SYSCTL(sctp_peer_chunk_oh))));
3958d06c82f1SRandall Stewart 		if (asoc->peers_rwnd < stcb->sctp_ep->sctp_ep.sctp_sws_sender) {
3959d06c82f1SRandall Stewart 			/* SWS sender side engages */
3960d06c82f1SRandall Stewart 			asoc->peers_rwnd = 0;
3961d06c82f1SRandall Stewart 		}
3962d06c82f1SRandall Stewart 		if (asoc->peers_rwnd > old_rwnd) {
3963d06c82f1SRandall Stewart 			goto again;
3964d06c82f1SRandall Stewart 		}
3965d06c82f1SRandall Stewart 		return;
39665e54f665SRandall Stewart 	}
39670053ed28SMichael Tuexen 
3968f8829a4aSRandall Stewart 	/* First setup for CC stuff */
3969f8829a4aSRandall Stewart 	TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
3970a21779f0SRandall Stewart 		if (SCTP_TSN_GT(cumack, net->cwr_window_tsn)) {
3971a21779f0SRandall Stewart 			/* Drag along the window_tsn for cwr's */
3972a21779f0SRandall Stewart 			net->cwr_window_tsn = cumack;
3973a21779f0SRandall Stewart 		}
3974f8829a4aSRandall Stewart 		net->prev_cwnd = net->cwnd;
3975f8829a4aSRandall Stewart 		net->net_ack = 0;
3976f8829a4aSRandall Stewart 		net->net_ack2 = 0;
3977132dea7dSRandall Stewart 
3978132dea7dSRandall Stewart 		/*
3979132dea7dSRandall Stewart 		 * CMT: Reset CUC and Fast recovery algo variables before
3980132dea7dSRandall Stewart 		 * SACK processing
3981132dea7dSRandall Stewart 		 */
3982132dea7dSRandall Stewart 		net->new_pseudo_cumack = 0;
3983132dea7dSRandall Stewart 		net->will_exit_fast_recovery = 0;
3984299108c5SRandall Stewart 		if (stcb->asoc.cc_functions.sctp_cwnd_prepare_net_for_sack) {
3985299108c5SRandall Stewart 			(*stcb->asoc.cc_functions.sctp_cwnd_prepare_net_for_sack) (stcb, net);
3986299108c5SRandall Stewart 		}
3987f8829a4aSRandall Stewart 	}
3988c105859eSRandall Stewart 	if (!TAILQ_EMPTY(&asoc->sent_queue)) {
3989c105859eSRandall Stewart 		tp1 = TAILQ_LAST(&asoc->sent_queue,
3990c105859eSRandall Stewart 		    sctpchunk_listhead);
399149656eefSMichael Tuexen 		send_s = tp1->rec.data.tsn + 1;
3992139bc87fSRandall Stewart 	} else {
3993c105859eSRandall Stewart 		send_s = asoc->sending_seq;
3994139bc87fSRandall Stewart 	}
399520b07a4dSMichael Tuexen 	if (SCTP_TSN_GE(cumack, send_s)) {
3996ff1ffd74SMichael Tuexen 		struct mbuf *op_err;
3997ff1ffd74SMichael Tuexen 		char msg[SCTP_DIAG_INFO_LEN];
3998139bc87fSRandall Stewart 
3999139bc87fSRandall Stewart 		*abort_now = 1;
4000139bc87fSRandall Stewart 		/* XXX */
4001999f86d6SMichael Tuexen 		SCTP_SNPRINTF(msg, sizeof(msg),
4002999f86d6SMichael Tuexen 		    "Cum ack %8.8x greater or equal than TSN %8.8x",
4003821bae7cSMichael Tuexen 		    cumack, send_s);
4004ff1ffd74SMichael Tuexen 		op_err = sctp_generate_cause(SCTP_CAUSE_PROTOCOL_VIOLATION, msg);
400591e04f9eSMichael Tuexen 		stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_25;
4006105b68b4SMichael Tuexen 		sctp_abort_an_association(stcb->sctp_ep, stcb, op_err, false, SCTP_SO_NOT_LOCKED);
4007139bc87fSRandall Stewart 		return;
4008139bc87fSRandall Stewart 	}
4009f8829a4aSRandall Stewart 	asoc->this_sack_highest_gap = cumack;
4010b3f1ea41SRandall Stewart 	if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_THRESHOLD_LOGGING) {
4011c4739e2fSRandall Stewart 		sctp_misc_ints(SCTP_THRESHOLD_CLEAR,
4012c4739e2fSRandall Stewart 		    stcb->asoc.overall_error_count,
4013c4739e2fSRandall Stewart 		    0,
4014c4739e2fSRandall Stewart 		    SCTP_FROM_SCTP_INDATA,
4015c4739e2fSRandall Stewart 		    __LINE__);
4016c4739e2fSRandall Stewart 	}
4017f8829a4aSRandall Stewart 	stcb->asoc.overall_error_count = 0;
401820b07a4dSMichael Tuexen 	if (SCTP_TSN_GT(cumack, asoc->last_acked_seq)) {
4019f8829a4aSRandall Stewart 		/* process the new consecutive TSN first */
40204a9ef3f8SMichael Tuexen 		TAILQ_FOREACH_SAFE(tp1, &asoc->sent_queue, sctp_next, tp2) {
402149656eefSMichael Tuexen 			if (SCTP_TSN_GE(cumack, tp1->rec.data.tsn)) {
402218e198d3SRandall Stewart 				if (tp1->sent == SCTP_DATAGRAM_UNSENT) {
4023cd3fd531SMichael Tuexen 					SCTP_PRINTF("Warning, an unsent is now acked?\n");
402418e198d3SRandall Stewart 				}
4025f8829a4aSRandall Stewart 				if (tp1->sent < SCTP_DATAGRAM_ACKED) {
4026f8829a4aSRandall Stewart 					/*
402718e198d3SRandall Stewart 					 * If it is less than ACKED, it is
402818e198d3SRandall Stewart 					 * now no-longer in flight. Higher
402918e198d3SRandall Stewart 					 * values may occur during marking
4030f8829a4aSRandall Stewart 					 */
4031c105859eSRandall Stewart 					if (tp1->sent < SCTP_DATAGRAM_RESEND) {
4032b3f1ea41SRandall Stewart 						if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FLIGHT_LOGGING_ENABLE) {
4033c105859eSRandall Stewart 							sctp_misc_ints(SCTP_FLIGHT_LOG_DOWN_CA,
4034a5d547adSRandall Stewart 							    tp1->whoTo->flight_size,
4035a5d547adSRandall Stewart 							    tp1->book_size,
40369a8e3088SMichael Tuexen 							    (uint32_t)(uintptr_t)tp1->whoTo,
403749656eefSMichael Tuexen 							    tp1->rec.data.tsn);
403880fefe0aSRandall Stewart 						}
4039c105859eSRandall Stewart 						sctp_flight_size_decrease(tp1);
4040299108c5SRandall Stewart 						if (stcb->asoc.cc_functions.sctp_cwnd_update_tsn_acknowledged) {
4041299108c5SRandall Stewart 							(*stcb->asoc.cc_functions.sctp_cwnd_update_tsn_acknowledged) (tp1->whoTo,
4042299108c5SRandall Stewart 							    tp1);
4043299108c5SRandall Stewart 						}
404404ee05e8SRandall Stewart 						/* sa_ignore NO_NULL_CHK */
4045c105859eSRandall Stewart 						sctp_total_flight_decrease(stcb, tp1);
4046f8829a4aSRandall Stewart 					}
4047f8829a4aSRandall Stewart 					tp1->whoTo->net_ack += tp1->send_size;
4048f8829a4aSRandall Stewart 					if (tp1->snd_count < 2) {
4049f8829a4aSRandall Stewart 						/*
4050ab9ed8a1SDevin Teske 						 * True non-retransmitted
4051f8829a4aSRandall Stewart 						 * chunk
4052f8829a4aSRandall Stewart 						 */
4053f8829a4aSRandall Stewart 						tp1->whoTo->net_ack2 +=
4054f8829a4aSRandall Stewart 						    tp1->send_size;
4055f8829a4aSRandall Stewart 
4056f8829a4aSRandall Stewart 						/* update RTO too? */
405762c1ff9cSRandall Stewart 						if (tp1->do_rtt) {
405844f2a327SMichael Tuexen 							if (rto_ok &&
4059f8829a4aSRandall Stewart 							    sctp_calculate_rto(stcb,
406044f2a327SMichael Tuexen 							    &stcb->asoc,
406144f2a327SMichael Tuexen 							    tp1->whoTo,
406218e198d3SRandall Stewart 							    &tp1->sent_rcv_time,
406344f2a327SMichael Tuexen 							    SCTP_RTT_FROM_DATA)) {
4064f79aab18SRandall Stewart 								rto_ok = 0;
4065f79aab18SRandall Stewart 							}
4066f79aab18SRandall Stewart 							if (tp1->whoTo->rto_needed == 0) {
4067f79aab18SRandall Stewart 								tp1->whoTo->rto_needed = 1;
4068f79aab18SRandall Stewart 							}
4069f8829a4aSRandall Stewart 							tp1->do_rtt = 0;
4070f8829a4aSRandall Stewart 						}
4071f8829a4aSRandall Stewart 					}
4072132dea7dSRandall Stewart 					/*
407318e198d3SRandall Stewart 					 * CMT: CUCv2 algorithm. From the
407418e198d3SRandall Stewart 					 * cumack'd TSNs, for each TSN being
407518e198d3SRandall Stewart 					 * acked for the first time, set the
407618e198d3SRandall Stewart 					 * following variables for the
407718e198d3SRandall Stewart 					 * corresp destination.
407818e198d3SRandall Stewart 					 * new_pseudo_cumack will trigger a
407918e198d3SRandall Stewart 					 * cwnd update.
408018e198d3SRandall Stewart 					 * find_(rtx_)pseudo_cumack will
408118e198d3SRandall Stewart 					 * trigger search for the next
408218e198d3SRandall Stewart 					 * expected (rtx-)pseudo-cumack.
4083132dea7dSRandall Stewart 					 */
4084132dea7dSRandall Stewart 					tp1->whoTo->new_pseudo_cumack = 1;
4085132dea7dSRandall Stewart 					tp1->whoTo->find_pseudo_cumack = 1;
4086132dea7dSRandall Stewart 					tp1->whoTo->find_rtx_pseudo_cumack = 1;
4087b3f1ea41SRandall Stewart 					if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
408804ee05e8SRandall Stewart 						/* sa_ignore NO_NULL_CHK */
408949656eefSMichael Tuexen 						sctp_log_cwnd(stcb, tp1->whoTo, tp1->rec.data.tsn, SCTP_CWND_LOG_FROM_SACK);
409080fefe0aSRandall Stewart 					}
4091f8829a4aSRandall Stewart 				}
4092f8829a4aSRandall Stewart 				if (tp1->sent == SCTP_DATAGRAM_RESEND) {
4093f8829a4aSRandall Stewart 					sctp_ucount_decr(asoc->sent_queue_retran_cnt);
4094f8829a4aSRandall Stewart 				}
409542551e99SRandall Stewart 				if (tp1->rec.data.chunk_was_revoked) {
409642551e99SRandall Stewart 					/* deflate the cwnd */
409742551e99SRandall Stewart 					tp1->whoTo->cwnd -= tp1->book_size;
409842551e99SRandall Stewart 					tp1->rec.data.chunk_was_revoked = 0;
409942551e99SRandall Stewart 				}
4100325c8c46SMichael Tuexen 				if (tp1->sent != SCTP_DATAGRAM_NR_ACKED) {
410149656eefSMichael Tuexen 					if (asoc->strmout[tp1->rec.data.sid].chunks_on_queues > 0) {
410249656eefSMichael Tuexen 						asoc->strmout[tp1->rec.data.sid].chunks_on_queues--;
4103a7ad6026SMichael Tuexen #ifdef INVARIANTS
4104a7ad6026SMichael Tuexen 					} else {
410549656eefSMichael Tuexen 						panic("No chunks on the queues for sid %u.", tp1->rec.data.sid);
4106a7ad6026SMichael Tuexen #endif
4107a7ad6026SMichael Tuexen 					}
4108a7ad6026SMichael Tuexen 				}
410949656eefSMichael Tuexen 				if ((asoc->strmout[tp1->rec.data.sid].chunks_on_queues == 0) &&
411049656eefSMichael Tuexen 				    (asoc->strmout[tp1->rec.data.sid].state == SCTP_STREAM_RESET_PENDING) &&
411149656eefSMichael Tuexen 				    TAILQ_EMPTY(&asoc->strmout[tp1->rec.data.sid].outqueue)) {
4112d96bef9cSMichael Tuexen 					asoc->trigger_reset = 1;
4113d96bef9cSMichael Tuexen 				}
4114f8829a4aSRandall Stewart 				TAILQ_REMOVE(&asoc->sent_queue, tp1, sctp_next);
4115f8829a4aSRandall Stewart 				if (tp1->data) {
411604ee05e8SRandall Stewart 					/* sa_ignore NO_NULL_CHK */
4117f8829a4aSRandall Stewart 					sctp_free_bufspace(stcb, asoc, tp1, 1);
4118f8829a4aSRandall Stewart 					sctp_m_freem(tp1->data);
41194a9ef3f8SMichael Tuexen 					tp1->data = NULL;
4120f8829a4aSRandall Stewart 				}
4121b3f1ea41SRandall Stewart 				if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_SACK_LOGGING_ENABLE) {
4122f8829a4aSRandall Stewart 					sctp_log_sack(asoc->last_acked_seq,
4123f8829a4aSRandall Stewart 					    cumack,
412449656eefSMichael Tuexen 					    tp1->rec.data.tsn,
4125f8829a4aSRandall Stewart 					    0,
4126f8829a4aSRandall Stewart 					    0,
4127f8829a4aSRandall Stewart 					    SCTP_LOG_FREE_SENT);
412880fefe0aSRandall Stewart 				}
4129f8829a4aSRandall Stewart 				asoc->sent_queue_cnt--;
4130689e6a5fSMichael Tuexen 				sctp_free_a_chunk(stcb, tp1, SCTP_SO_NOT_LOCKED);
413118e198d3SRandall Stewart 			} else {
413218e198d3SRandall Stewart 				break;
4133f8829a4aSRandall Stewart 			}
41345e54f665SRandall Stewart 		}
413518e198d3SRandall Stewart 	}
413604ee05e8SRandall Stewart 	/* sa_ignore NO_NULL_CHK */
4137f8829a4aSRandall Stewart 	if (stcb->sctp_socket) {
4138f8829a4aSRandall Stewart 		SOCKBUF_LOCK(&stcb->sctp_socket->so_snd);
4139b3f1ea41SRandall Stewart 		if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_WAKE_LOGGING_ENABLE) {
414004ee05e8SRandall Stewart 			/* sa_ignore NO_NULL_CHK */
41417215cc1bSMichael Tuexen 			sctp_wakeup_log(stcb, 1, SCTP_WAKESND_FROM_SACK);
414280fefe0aSRandall Stewart 		}
4143f8829a4aSRandall Stewart 		sctp_sowwakeup_locked(stcb->sctp_ep, stcb->sctp_socket);
4144f8829a4aSRandall Stewart 	} else {
4145b3f1ea41SRandall Stewart 		if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_WAKE_LOGGING_ENABLE) {
41467215cc1bSMichael Tuexen 			sctp_wakeup_log(stcb, 1, SCTP_NOWAKE_FROM_SACK);
414780fefe0aSRandall Stewart 		}
4148f8829a4aSRandall Stewart 	}
4149f8829a4aSRandall Stewart 
4150b54d3a6cSRandall Stewart 	/* JRS - Use the congestion control given in the CC module */
4151ca85e948SMichael Tuexen 	if ((asoc->last_acked_seq != cumack) && (ecne_seen == 0)) {
4152ca85e948SMichael Tuexen 		TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
4153ca85e948SMichael Tuexen 			if (net->net_ack2 > 0) {
4154ca85e948SMichael Tuexen 				/*
4155ca85e948SMichael Tuexen 				 * Karn's rule applies to clearing error
4156ca85e948SMichael Tuexen 				 * count, this is optional.
4157ca85e948SMichael Tuexen 				 */
4158ca85e948SMichael Tuexen 				net->error_count = 0;
41599b2a35b3SMichael Tuexen 				if ((net->dest_state & SCTP_ADDR_REACHABLE) == 0) {
4160ca85e948SMichael Tuexen 					/* addr came good */
4161ca85e948SMichael Tuexen 					net->dest_state |= SCTP_ADDR_REACHABLE;
4162ca85e948SMichael Tuexen 					sctp_ulp_notify(SCTP_NOTIFY_INTERFACE_UP, stcb,
41634b1f78e1SMichael Tuexen 					    0, (void *)net, SCTP_SO_NOT_LOCKED);
4164ca85e948SMichael Tuexen 				}
4165ca85e948SMichael Tuexen 				if (net == stcb->asoc.primary_destination) {
4166ca85e948SMichael Tuexen 					if (stcb->asoc.alternate) {
4167b7b84c0eSMichael Tuexen 						/*
4168b7b84c0eSMichael Tuexen 						 * release the alternate,
4169b7b84c0eSMichael Tuexen 						 * primary is good
4170b7b84c0eSMichael Tuexen 						 */
4171ca85e948SMichael Tuexen 						sctp_free_remote_addr(stcb->asoc.alternate);
4172ca85e948SMichael Tuexen 						stcb->asoc.alternate = NULL;
4173ca85e948SMichael Tuexen 					}
4174ca85e948SMichael Tuexen 				}
4175ca85e948SMichael Tuexen 				if (net->dest_state & SCTP_ADDR_PF) {
4176ca85e948SMichael Tuexen 					net->dest_state &= ~SCTP_ADDR_PF;
4177b7d130beSMichael Tuexen 					sctp_timer_stop(SCTP_TIMER_TYPE_HEARTBEAT,
4178b7d130beSMichael Tuexen 					    stcb->sctp_ep, stcb, net,
417991e04f9eSMichael Tuexen 					    SCTP_FROM_SCTP_INDATA + SCTP_LOC_26);
4180ca85e948SMichael Tuexen 					sctp_timer_start(SCTP_TIMER_TYPE_HEARTBEAT, stcb->sctp_ep, stcb, net);
4181ca85e948SMichael Tuexen 					asoc->cc_functions.sctp_cwnd_update_exit_pf(stcb, net);
4182ca85e948SMichael Tuexen 					/* Done with this net */
4183ca85e948SMichael Tuexen 					net->net_ack = 0;
4184ca85e948SMichael Tuexen 				}
4185ca85e948SMichael Tuexen 				/* restore any doubled timers */
4186ca85e948SMichael Tuexen 				net->RTO = (net->lastsa >> SCTP_RTT_SHIFT) + net->lastsv;
4187ca85e948SMichael Tuexen 				if (net->RTO < stcb->asoc.minrto) {
4188ca85e948SMichael Tuexen 					net->RTO = stcb->asoc.minrto;
4189ca85e948SMichael Tuexen 				}
4190ca85e948SMichael Tuexen 				if (net->RTO > stcb->asoc.maxrto) {
4191ca85e948SMichael Tuexen 					net->RTO = stcb->asoc.maxrto;
4192ca85e948SMichael Tuexen 				}
4193ca85e948SMichael Tuexen 			}
4194ca85e948SMichael Tuexen 		}
4195b54d3a6cSRandall Stewart 		asoc->cc_functions.sctp_cwnd_update_after_sack(stcb, asoc, 1, 0, 0);
4196ca85e948SMichael Tuexen 	}
4197f8829a4aSRandall Stewart 	asoc->last_acked_seq = cumack;
41985e54f665SRandall Stewart 
4199f8829a4aSRandall Stewart 	if (TAILQ_EMPTY(&asoc->sent_queue)) {
4200f8829a4aSRandall Stewart 		/* nothing left in-flight */
4201f8829a4aSRandall Stewart 		TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
4202f8829a4aSRandall Stewart 			net->flight_size = 0;
4203f8829a4aSRandall Stewart 			net->partial_bytes_acked = 0;
4204f8829a4aSRandall Stewart 		}
4205f8829a4aSRandall Stewart 		asoc->total_flight = 0;
4206f8829a4aSRandall Stewart 		asoc->total_flight_count = 0;
4207f8829a4aSRandall Stewart 	}
42080053ed28SMichael Tuexen 
4209f8829a4aSRandall Stewart 	/* RWND update */
4210f8829a4aSRandall Stewart 	asoc->peers_rwnd = sctp_sbspace_sub(rwnd,
421144fbe462SRandall Stewart 	    (uint32_t)(asoc->total_flight + (asoc->total_flight_count * SCTP_BASE_SYSCTL(sctp_peer_chunk_oh))));
4212f8829a4aSRandall Stewart 	if (asoc->peers_rwnd < stcb->sctp_ep->sctp_ep.sctp_sws_sender) {
4213f8829a4aSRandall Stewart 		/* SWS sender side engages */
4214f8829a4aSRandall Stewart 		asoc->peers_rwnd = 0;
4215f8829a4aSRandall Stewart 	}
42165e54f665SRandall Stewart 	if (asoc->peers_rwnd > old_rwnd) {
42175e54f665SRandall Stewart 		win_probe_recovery = 1;
42185e54f665SRandall Stewart 	}
4219f8829a4aSRandall Stewart 	/* Now assure a timer where data is queued at */
4220a5d547adSRandall Stewart again:
4221a5d547adSRandall Stewart 	j = 0;
4222f8829a4aSRandall Stewart 	TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
42235e54f665SRandall Stewart 		if (win_probe_recovery && (net->window_probe)) {
4224c105859eSRandall Stewart 			win_probe_recovered = 1;
42255e54f665SRandall Stewart 			/*
42265e54f665SRandall Stewart 			 * Find first chunk that was used with window probe
42275e54f665SRandall Stewart 			 * and clear the sent
42285e54f665SRandall Stewart 			 */
42293c503c28SRandall Stewart 			/* sa_ignore FREED_MEMORY */
42305e54f665SRandall Stewart 			TAILQ_FOREACH(tp1, &asoc->sent_queue, sctp_next) {
42315e54f665SRandall Stewart 				if (tp1->window_probe) {
4232cd554309SMichael Tuexen 					/* move back to data send queue */
42337215cc1bSMichael Tuexen 					sctp_window_probe_recovery(stcb, asoc, tp1);
42345e54f665SRandall Stewart 					break;
42355e54f665SRandall Stewart 				}
42365e54f665SRandall Stewart 			}
42375e54f665SRandall Stewart 		}
42385171328bSRandall Stewart 		if (net->flight_size) {
4239a5d547adSRandall Stewart 			j++;
424072e23abaSMichael Tuexen 			sctp_timer_start(SCTP_TIMER_TYPE_SEND, stcb->sctp_ep, stcb, net);
42415171328bSRandall Stewart 			if (net->window_probe) {
42425171328bSRandall Stewart 				net->window_probe = 0;
42435171328bSRandall Stewart 			}
4244f8829a4aSRandall Stewart 		} else {
42455171328bSRandall Stewart 			if (net->window_probe) {
4246b7b84c0eSMichael Tuexen 				/*
4247b7b84c0eSMichael Tuexen 				 * In window probes we must assure a timer
4248b7b84c0eSMichael Tuexen 				 * is still running there
4249b7b84c0eSMichael Tuexen 				 */
42505171328bSRandall Stewart 				net->window_probe = 0;
42515171328bSRandall Stewart 				if (!SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer)) {
425272e23abaSMichael Tuexen 					sctp_timer_start(SCTP_TIMER_TYPE_SEND, stcb->sctp_ep, stcb, net);
42535171328bSRandall Stewart 				}
42545171328bSRandall Stewart 			} else if (SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer)) {
4255f8829a4aSRandall Stewart 				sctp_timer_stop(SCTP_TIMER_TYPE_SEND, stcb->sctp_ep,
4256a5d547adSRandall Stewart 				    stcb, net,
425791e04f9eSMichael Tuexen 				    SCTP_FROM_SCTP_INDATA + SCTP_LOC_27);
4258f8829a4aSRandall Stewart 			}
4259f8829a4aSRandall Stewart 		}
4260f8829a4aSRandall Stewart 	}
4261bff64a4dSRandall Stewart 	if ((j == 0) &&
4262bff64a4dSRandall Stewart 	    (!TAILQ_EMPTY(&asoc->sent_queue)) &&
4263bff64a4dSRandall Stewart 	    (asoc->sent_queue_retran_cnt == 0) &&
4264c105859eSRandall Stewart 	    (win_probe_recovered == 0) &&
4265bff64a4dSRandall Stewart 	    (done_once == 0)) {
42660c0982b8SRandall Stewart 		/*
42670c0982b8SRandall Stewart 		 * huh, this should not happen unless all packets are
42680c0982b8SRandall Stewart 		 * PR-SCTP and marked to skip of course.
42690c0982b8SRandall Stewart 		 */
42700c0982b8SRandall Stewart 		if (sctp_fs_audit(asoc)) {
4271a5d547adSRandall Stewart 			TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
4272a5d547adSRandall Stewart 				net->flight_size = 0;
4273a5d547adSRandall Stewart 			}
4274a5d547adSRandall Stewart 			asoc->total_flight = 0;
4275a5d547adSRandall Stewart 			asoc->total_flight_count = 0;
4276a5d547adSRandall Stewart 			asoc->sent_queue_retran_cnt = 0;
4277a5d547adSRandall Stewart 			TAILQ_FOREACH(tp1, &asoc->sent_queue, sctp_next) {
4278a5d547adSRandall Stewart 				if (tp1->sent < SCTP_DATAGRAM_RESEND) {
4279c105859eSRandall Stewart 					sctp_flight_size_increase(tp1);
4280c105859eSRandall Stewart 					sctp_total_flight_increase(stcb, tp1);
4281a5d547adSRandall Stewart 				} else if (tp1->sent == SCTP_DATAGRAM_RESEND) {
4282791437b5SRandall Stewart 					sctp_ucount_incr(asoc->sent_queue_retran_cnt);
4283a5d547adSRandall Stewart 				}
4284a5d547adSRandall Stewart 			}
42850c0982b8SRandall Stewart 		}
4286bff64a4dSRandall Stewart 		done_once = 1;
4287a5d547adSRandall Stewart 		goto again;
4288a5d547adSRandall Stewart 	}
4289f8829a4aSRandall Stewart 	/**********************************/
4290f8829a4aSRandall Stewart 	/* Now what about shutdown issues */
4291f8829a4aSRandall Stewart 	/**********************************/
4292f8829a4aSRandall Stewart 	if (TAILQ_EMPTY(&asoc->send_queue) && TAILQ_EMPTY(&asoc->sent_queue)) {
4293f8829a4aSRandall Stewart 		/* nothing left on sendqueue.. consider done */
4294f8829a4aSRandall Stewart 		/* clean up */
4295f8829a4aSRandall Stewart 		if ((asoc->stream_queue_cnt == 1) &&
4296f8829a4aSRandall Stewart 		    ((asoc->state & SCTP_STATE_SHUTDOWN_PENDING) ||
4297839d21d6SMichael Tuexen 		    (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED)) &&
4298d1ea5fa9SMichael Tuexen 		    ((*asoc->ss_functions.sctp_ss_is_user_msgs_incomplete) (stcb, asoc))) {
4299839d21d6SMichael Tuexen 			SCTP_ADD_SUBSTATE(stcb, SCTP_STATE_PARTIAL_MSG_LEFT);
43002afb3e84SRandall Stewart 		}
4301bbc9dfbcSMichael Tuexen 		if (((asoc->state & SCTP_STATE_SHUTDOWN_PENDING) ||
4302839d21d6SMichael Tuexen 		    (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED)) &&
4303bbc9dfbcSMichael Tuexen 		    (asoc->stream_queue_cnt == 1) &&
4304bbc9dfbcSMichael Tuexen 		    (asoc->state & SCTP_STATE_PARTIAL_MSG_LEFT)) {
4305ff1ffd74SMichael Tuexen 			struct mbuf *op_err;
4306f8829a4aSRandall Stewart 
4307f8829a4aSRandall Stewart 			*abort_now = 1;
4308f8829a4aSRandall Stewart 			/* XXX */
4309ff1ffd74SMichael Tuexen 			op_err = sctp_generate_cause(SCTP_CAUSE_USER_INITIATED_ABT, "");
431091e04f9eSMichael Tuexen 			stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_28;
4311105b68b4SMichael Tuexen 			sctp_abort_an_association(stcb->sctp_ep, stcb, op_err, false, SCTP_SO_NOT_LOCKED);
4312fe4a59b3SMichael Tuexen 			return;
4313bbc9dfbcSMichael Tuexen 		}
4314bbc9dfbcSMichael Tuexen 		if ((asoc->state & SCTP_STATE_SHUTDOWN_PENDING) &&
4315bbc9dfbcSMichael Tuexen 		    (asoc->stream_queue_cnt == 0)) {
4316ca85e948SMichael Tuexen 			struct sctp_nets *netp;
4317ca85e948SMichael Tuexen 
4318839d21d6SMichael Tuexen 			if ((SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) ||
4319839d21d6SMichael Tuexen 			    (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED)) {
4320f8829a4aSRandall Stewart 				SCTP_STAT_DECR_GAUGE32(sctps_currestab);
4321f42a358aSRandall Stewart 			}
4322839d21d6SMichael Tuexen 			SCTP_SET_STATE(stcb, SCTP_STATE_SHUTDOWN_SENT);
4323f8829a4aSRandall Stewart 			sctp_stop_timers_for_shutdown(stcb);
4324ca85e948SMichael Tuexen 			if (asoc->alternate) {
4325ca85e948SMichael Tuexen 				netp = asoc->alternate;
4326ca85e948SMichael Tuexen 			} else {
4327ca85e948SMichael Tuexen 				netp = asoc->primary_destination;
4328ca85e948SMichael Tuexen 			}
4329ca85e948SMichael Tuexen 			sctp_send_shutdown(stcb, netp);
4330f8829a4aSRandall Stewart 			sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWN,
4331ca85e948SMichael Tuexen 			    stcb->sctp_ep, stcb, netp);
4332f8829a4aSRandall Stewart 			sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNGUARD,
43336fb7b4fbSMichael Tuexen 			    stcb->sctp_ep, stcb, NULL);
4334839d21d6SMichael Tuexen 		} else if ((SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED) &&
4335f8829a4aSRandall Stewart 		    (asoc->stream_queue_cnt == 0)) {
4336ca85e948SMichael Tuexen 			struct sctp_nets *netp;
4337ca85e948SMichael Tuexen 
4338f8829a4aSRandall Stewart 			SCTP_STAT_DECR_GAUGE32(sctps_currestab);
4339839d21d6SMichael Tuexen 			SCTP_SET_STATE(stcb, SCTP_STATE_SHUTDOWN_ACK_SENT);
434012af6654SMichael Tuexen 			sctp_stop_timers_for_shutdown(stcb);
4341c39cfa1fSMichael Tuexen 			if (asoc->alternate) {
4342c39cfa1fSMichael Tuexen 				netp = asoc->alternate;
4343c39cfa1fSMichael Tuexen 			} else {
4344c39cfa1fSMichael Tuexen 				netp = asoc->primary_destination;
4345c39cfa1fSMichael Tuexen 			}
4346c39cfa1fSMichael Tuexen 			sctp_send_shutdown_ack(stcb, netp);
4347f8829a4aSRandall Stewart 			sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNACK,
4348ca85e948SMichael Tuexen 			    stcb->sctp_ep, stcb, netp);
4349f8829a4aSRandall Stewart 		}
4350f8829a4aSRandall Stewart 	}
4351dfb11ef8SRandall Stewart 	/*********************************************/
4352dfb11ef8SRandall Stewart 	/* Here we perform PR-SCTP procedures        */
4353dfb11ef8SRandall Stewart 	/* (section 4.2)                             */
4354dfb11ef8SRandall Stewart 	/*********************************************/
4355dfb11ef8SRandall Stewart 	/* C1. update advancedPeerAckPoint */
435620b07a4dSMichael Tuexen 	if (SCTP_TSN_GT(cumack, asoc->advanced_peer_ack_point)) {
4357dfb11ef8SRandall Stewart 		asoc->advanced_peer_ack_point = cumack;
4358dfb11ef8SRandall Stewart 	}
4359830d754dSRandall Stewart 	/* PR-Sctp issues need to be addressed too */
4360dd973b0eSMichael Tuexen 	if ((asoc->prsctp_supported) && (asoc->pr_sctp_cnt > 0)) {
4361830d754dSRandall Stewart 		struct sctp_tmit_chunk *lchk;
4362830d754dSRandall Stewart 		uint32_t old_adv_peer_ack_point;
4363830d754dSRandall Stewart 
4364830d754dSRandall Stewart 		old_adv_peer_ack_point = asoc->advanced_peer_ack_point;
4365830d754dSRandall Stewart 		lchk = sctp_try_advance_peer_ack_point(stcb, asoc);
4366830d754dSRandall Stewart 		/* C3. See if we need to send a Fwd-TSN */
436720b07a4dSMichael Tuexen 		if (SCTP_TSN_GT(asoc->advanced_peer_ack_point, cumack)) {
4368830d754dSRandall Stewart 			/*
4369493d8e5aSRandall Stewart 			 * ISSUE with ECN, see FWD-TSN processing.
4370830d754dSRandall Stewart 			 */
437120b07a4dSMichael Tuexen 			if (SCTP_TSN_GT(asoc->advanced_peer_ack_point, old_adv_peer_ack_point)) {
4372830d754dSRandall Stewart 				send_forward_tsn(stcb, asoc);
43730c0982b8SRandall Stewart 			} else if (lchk) {
43740c0982b8SRandall Stewart 				/* try to FR fwd-tsn's that get lost too */
437544fbe462SRandall Stewart 				if (lchk->rec.data.fwd_tsn_cnt >= 3) {
43760c0982b8SRandall Stewart 					send_forward_tsn(stcb, asoc);
43770c0982b8SRandall Stewart 				}
4378830d754dSRandall Stewart 			}
4379830d754dSRandall Stewart 		}
4380efd5e692SMichael Tuexen 		for (; lchk != NULL; lchk = TAILQ_NEXT(lchk, sctp_next)) {
4381efd5e692SMichael Tuexen 			if (lchk->whoTo != NULL) {
4382efd5e692SMichael Tuexen 				break;
4383efd5e692SMichael Tuexen 			}
4384efd5e692SMichael Tuexen 		}
4385efd5e692SMichael Tuexen 		if (lchk != NULL) {
4386830d754dSRandall Stewart 			/* Assure a timer is up */
4387830d754dSRandall Stewart 			sctp_timer_start(SCTP_TIMER_TYPE_SEND,
4388830d754dSRandall Stewart 			    stcb->sctp_ep, stcb, lchk->whoTo);
4389830d754dSRandall Stewart 		}
4390830d754dSRandall Stewart 	}
4391b3f1ea41SRandall Stewart 	if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_SACK_RWND_LOGGING_ENABLE) {
4392f8829a4aSRandall Stewart 		sctp_misc_ints(SCTP_SACK_RWND_UPDATE,
4393f8829a4aSRandall Stewart 		    rwnd,
4394f8829a4aSRandall Stewart 		    stcb->asoc.peers_rwnd,
4395f8829a4aSRandall Stewart 		    stcb->asoc.total_flight,
4396f8829a4aSRandall Stewart 		    stcb->asoc.total_output_queue_size);
439780fefe0aSRandall Stewart 	}
4398f8829a4aSRandall Stewart }
4399f8829a4aSRandall Stewart 
4400f8829a4aSRandall Stewart void
4401cd554309SMichael Tuexen sctp_handle_sack(struct mbuf *m, int offset_seg, int offset_dup,
44027215cc1bSMichael Tuexen     struct sctp_tcb *stcb,
4403cd554309SMichael Tuexen     uint16_t num_seg, uint16_t num_nr_seg, uint16_t num_dup,
4404cd554309SMichael Tuexen     int *abort_now, uint8_t flags,
4405899288aeSRandall Stewart     uint32_t cum_ack, uint32_t rwnd, int ecne_seen)
4406f8829a4aSRandall Stewart {
4407f8829a4aSRandall Stewart 	struct sctp_association *asoc;
4408f8829a4aSRandall Stewart 	struct sctp_tmit_chunk *tp1, *tp2;
4409cd554309SMichael Tuexen 	uint32_t last_tsn, biggest_tsn_acked, biggest_tsn_newly_acked, this_sack_lowest_newack;
4410f8829a4aSRandall Stewart 	uint16_t wake_him = 0;
4411c105859eSRandall Stewart 	uint32_t send_s = 0;
4412f8829a4aSRandall Stewart 	long j;
4413f8829a4aSRandall Stewart 	int accum_moved = 0;
4414f8829a4aSRandall Stewart 	int will_exit_fast_recovery = 0;
44155e54f665SRandall Stewart 	uint32_t a_rwnd, old_rwnd;
44165e54f665SRandall Stewart 	int win_probe_recovery = 0;
4417c105859eSRandall Stewart 	int win_probe_recovered = 0;
4418f8829a4aSRandall Stewart 	struct sctp_nets *net = NULL;
4419bff64a4dSRandall Stewart 	int done_once;
4420f79aab18SRandall Stewart 	int rto_ok = 1;
4421f8829a4aSRandall Stewart 	uint8_t reneged_all = 0;
4422f8829a4aSRandall Stewart 	uint8_t cmt_dac_flag;
4423f8829a4aSRandall Stewart 
4424f8829a4aSRandall Stewart 	/*
4425f8829a4aSRandall Stewart 	 * we take any chance we can to service our queues since we cannot
4426f8829a4aSRandall Stewart 	 * get awoken when the socket is read from :<
4427f8829a4aSRandall Stewart 	 */
4428f8829a4aSRandall Stewart 	/*
4429f8829a4aSRandall Stewart 	 * Now perform the actual SACK handling: 1) Verify that it is not an
4430f8829a4aSRandall Stewart 	 * old sack, if so discard. 2) If there is nothing left in the send
4431f8829a4aSRandall Stewart 	 * queue (cum-ack is equal to last acked) then you have a duplicate
4432f8829a4aSRandall Stewart 	 * too, update any rwnd change and verify no timers are running.
4433e7e65008SMichael Tuexen 	 * then return. 3) Process any new consecutive data i.e. cum-ack
4434f8829a4aSRandall Stewart 	 * moved process these first and note that it moved. 4) Process any
4435f8829a4aSRandall Stewart 	 * sack blocks. 5) Drop any acked from the queue. 6) Check for any
4436f8829a4aSRandall Stewart 	 * revoked blocks and mark. 7) Update the cwnd. 8) Nothing left,
4437f8829a4aSRandall Stewart 	 * sync up flightsizes and things, stop all timers and also check
4438f8829a4aSRandall Stewart 	 * for shutdown_pending state. If so then go ahead and send off the
4439f8829a4aSRandall Stewart 	 * shutdown. If in shutdown recv, send off the shutdown-ack and
4440f8829a4aSRandall Stewart 	 * start that timer, Ret. 9) Strike any non-acked things and do FR
4441f8829a4aSRandall Stewart 	 * procedure if needed being sure to set the FR flag. 10) Do pr-sctp
4442f8829a4aSRandall Stewart 	 * procedures. 11) Apply any FR penalties. 12) Assure we will SACK
4443f8829a4aSRandall Stewart 	 * if in shutdown_recv state.
4444f8829a4aSRandall Stewart 	 */
4445f8829a4aSRandall Stewart 	SCTP_TCB_LOCK_ASSERT(stcb);
4446f8829a4aSRandall Stewart 	/* CMT DAC algo */
4447f8829a4aSRandall Stewart 	this_sack_lowest_newack = 0;
4448f8829a4aSRandall Stewart 	SCTP_STAT_INCR(sctps_slowpath_sack);
4449cd554309SMichael Tuexen 	last_tsn = cum_ack;
4450cd554309SMichael Tuexen 	cmt_dac_flag = flags & SCTP_SACK_CMT_DAC;
445118e198d3SRandall Stewart #ifdef SCTP_ASOCLOG_OF_TSNS
445218e198d3SRandall Stewart 	stcb->asoc.cumack_log[stcb->asoc.cumack_log_at] = cum_ack;
445318e198d3SRandall Stewart 	stcb->asoc.cumack_log_at++;
445418e198d3SRandall Stewart 	if (stcb->asoc.cumack_log_at > SCTP_TSN_LOG_SIZE) {
445518e198d3SRandall Stewart 		stcb->asoc.cumack_log_at = 0;
445618e198d3SRandall Stewart 	}
445718e198d3SRandall Stewart #endif
4458d06c82f1SRandall Stewart 	a_rwnd = rwnd;
4459f8829a4aSRandall Stewart 
4460cd554309SMichael Tuexen 	if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_SACK_ARRIVALS_ENABLE) {
4461cd554309SMichael Tuexen 		sctp_misc_ints(SCTP_SACK_LOG_NORMAL, cum_ack,
4462cd554309SMichael Tuexen 		    rwnd, stcb->asoc.last_acked_seq, stcb->asoc.peers_rwnd);
4463cd554309SMichael Tuexen 	}
44640053ed28SMichael Tuexen 
44655e54f665SRandall Stewart 	old_rwnd = stcb->asoc.peers_rwnd;
4466b3f1ea41SRandall Stewart 	if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_THRESHOLD_LOGGING) {
4467c4739e2fSRandall Stewart 		sctp_misc_ints(SCTP_THRESHOLD_CLEAR,
4468c4739e2fSRandall Stewart 		    stcb->asoc.overall_error_count,
4469c4739e2fSRandall Stewart 		    0,
4470c4739e2fSRandall Stewart 		    SCTP_FROM_SCTP_INDATA,
4471c4739e2fSRandall Stewart 		    __LINE__);
4472c4739e2fSRandall Stewart 	}
4473f8829a4aSRandall Stewart 	stcb->asoc.overall_error_count = 0;
4474f8829a4aSRandall Stewart 	asoc = &stcb->asoc;
4475b3f1ea41SRandall Stewart 	if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_SACK_LOGGING_ENABLE) {
4476f8829a4aSRandall Stewart 		sctp_log_sack(asoc->last_acked_seq,
4477f8829a4aSRandall Stewart 		    cum_ack,
4478f8829a4aSRandall Stewart 		    0,
4479f8829a4aSRandall Stewart 		    num_seg,
4480f8829a4aSRandall Stewart 		    num_dup,
4481f8829a4aSRandall Stewart 		    SCTP_LOG_NEW_SACK);
448280fefe0aSRandall Stewart 	}
4483ca85e948SMichael Tuexen 	if ((num_dup) && (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FR_LOGGING_ENABLE)) {
4484cd554309SMichael Tuexen 		uint16_t i;
4485458303daSRandall Stewart 		uint32_t *dupdata, dblock;
4486f8829a4aSRandall Stewart 
4487cd554309SMichael Tuexen 		for (i = 0; i < num_dup; i++) {
4488cd554309SMichael Tuexen 			dupdata = (uint32_t *)sctp_m_getptr(m, offset_dup + i * sizeof(uint32_t),
4489458303daSRandall Stewart 			    sizeof(uint32_t), (uint8_t *)&dblock);
4490cd554309SMichael Tuexen 			if (dupdata == NULL) {
4491458303daSRandall Stewart 				break;
4492458303daSRandall Stewart 			}
4493cd554309SMichael Tuexen 			sctp_log_fr(*dupdata, 0, 0, SCTP_FR_DUPED);
4494f8829a4aSRandall Stewart 		}
4495f8829a4aSRandall Stewart 	}
4496c105859eSRandall Stewart 	/* reality check */
4497c105859eSRandall Stewart 	if (!TAILQ_EMPTY(&asoc->sent_queue)) {
4498c105859eSRandall Stewart 		tp1 = TAILQ_LAST(&asoc->sent_queue,
4499c105859eSRandall Stewart 		    sctpchunk_listhead);
450049656eefSMichael Tuexen 		send_s = tp1->rec.data.tsn + 1;
4501c105859eSRandall Stewart 	} else {
4502b5c16493SMichael Tuexen 		tp1 = NULL;
4503c105859eSRandall Stewart 		send_s = asoc->sending_seq;
4504c105859eSRandall Stewart 	}
450520b07a4dSMichael Tuexen 	if (SCTP_TSN_GE(cum_ack, send_s)) {
4506ff1ffd74SMichael Tuexen 		struct mbuf *op_err;
4507ff1ffd74SMichael Tuexen 		char msg[SCTP_DIAG_INFO_LEN];
4508c105859eSRandall Stewart 
4509f8829a4aSRandall Stewart 		/*
4510fd60718dSMichael Tuexen 		 * no way, we have not even sent this TSN out yet. Peer is
4511fd60718dSMichael Tuexen 		 * hopelessly messed up with us.
4512f8829a4aSRandall Stewart 		 */
4513cd3fd531SMichael Tuexen 		SCTP_PRINTF("NEW cum_ack:%x send_s:%x is smaller or equal\n",
4514b5c16493SMichael Tuexen 		    cum_ack, send_s);
4515b5c16493SMichael Tuexen 		if (tp1) {
4516cd3fd531SMichael Tuexen 			SCTP_PRINTF("Got send_s from tsn:%x + 1 of tp1: %p\n",
451749656eefSMichael Tuexen 			    tp1->rec.data.tsn, (void *)tp1);
4518b5c16493SMichael Tuexen 		}
4519f8829a4aSRandall Stewart hopeless_peer:
4520f8829a4aSRandall Stewart 		*abort_now = 1;
4521f8829a4aSRandall Stewart 		/* XXX */
4522999f86d6SMichael Tuexen 		SCTP_SNPRINTF(msg, sizeof(msg),
4523999f86d6SMichael Tuexen 		    "Cum ack %8.8x greater or equal than TSN %8.8x",
4524821bae7cSMichael Tuexen 		    cum_ack, send_s);
4525ff1ffd74SMichael Tuexen 		op_err = sctp_generate_cause(SCTP_CAUSE_PROTOCOL_VIOLATION, msg);
452691e04f9eSMichael Tuexen 		stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_29;
4527105b68b4SMichael Tuexen 		sctp_abort_an_association(stcb->sctp_ep, stcb, op_err, false, SCTP_SO_NOT_LOCKED);
4528f8829a4aSRandall Stewart 		return;
4529f8829a4aSRandall Stewart 	}
4530f8829a4aSRandall Stewart 	/**********************/
4531f8829a4aSRandall Stewart 	/* 1) check the range */
4532f8829a4aSRandall Stewart 	/**********************/
453320b07a4dSMichael Tuexen 	if (SCTP_TSN_GT(asoc->last_acked_seq, last_tsn)) {
4534f8829a4aSRandall Stewart 		/* acking something behind */
4535f8829a4aSRandall Stewart 		return;
4536f8829a4aSRandall Stewart 	}
45370053ed28SMichael Tuexen 
4538f8829a4aSRandall Stewart 	/* update the Rwnd of the peer */
4539f8829a4aSRandall Stewart 	if (TAILQ_EMPTY(&asoc->sent_queue) &&
4540f8829a4aSRandall Stewart 	    TAILQ_EMPTY(&asoc->send_queue) &&
4541cd554309SMichael Tuexen 	    (asoc->stream_queue_cnt == 0)) {
4542f8829a4aSRandall Stewart 		/* nothing left on send/sent and strmq */
4543b3f1ea41SRandall Stewart 		if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_RWND_ENABLE) {
4544f8829a4aSRandall Stewart 			sctp_log_rwnd_set(SCTP_SET_PEER_RWND_VIA_SACK,
4545f8829a4aSRandall Stewart 			    asoc->peers_rwnd, 0, 0, a_rwnd);
454680fefe0aSRandall Stewart 		}
4547f8829a4aSRandall Stewart 		asoc->peers_rwnd = a_rwnd;
4548f8829a4aSRandall Stewart 		if (asoc->sent_queue_retran_cnt) {
4549f8829a4aSRandall Stewart 			asoc->sent_queue_retran_cnt = 0;
4550f8829a4aSRandall Stewart 		}
4551f8829a4aSRandall Stewart 		if (asoc->peers_rwnd < stcb->sctp_ep->sctp_ep.sctp_sws_sender) {
4552f8829a4aSRandall Stewart 			/* SWS sender side engages */
4553f8829a4aSRandall Stewart 			asoc->peers_rwnd = 0;
4554f8829a4aSRandall Stewart 		}
4555f8829a4aSRandall Stewart 		/* stop any timers */
4556f8829a4aSRandall Stewart 		TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
4557f8829a4aSRandall Stewart 			sctp_timer_stop(SCTP_TIMER_TYPE_SEND, stcb->sctp_ep,
455891e04f9eSMichael Tuexen 			    stcb, net, SCTP_FROM_SCTP_INDATA + SCTP_LOC_30);
4559f8829a4aSRandall Stewart 			net->partial_bytes_acked = 0;
4560f8829a4aSRandall Stewart 			net->flight_size = 0;
4561f8829a4aSRandall Stewart 		}
4562f8829a4aSRandall Stewart 		asoc->total_flight = 0;
4563f8829a4aSRandall Stewart 		asoc->total_flight_count = 0;
4564f8829a4aSRandall Stewart 		return;
4565f8829a4aSRandall Stewart 	}
4566f8829a4aSRandall Stewart 	/*
4567f8829a4aSRandall Stewart 	 * We init netAckSz and netAckSz2 to 0. These are used to track 2
4568f8829a4aSRandall Stewart 	 * things. The total byte count acked is tracked in netAckSz AND
4569f8829a4aSRandall Stewart 	 * netAck2 is used to track the total bytes acked that are un-
4570e7e65008SMichael Tuexen 	 * ambiguous and were never retransmitted. We track these on a per
4571f8829a4aSRandall Stewart 	 * destination address basis.
4572f8829a4aSRandall Stewart 	 */
4573f8829a4aSRandall Stewart 	TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
4574a21779f0SRandall Stewart 		if (SCTP_TSN_GT(cum_ack, net->cwr_window_tsn)) {
4575a21779f0SRandall Stewart 			/* Drag along the window_tsn for cwr's */
4576a21779f0SRandall Stewart 			net->cwr_window_tsn = cum_ack;
4577a21779f0SRandall Stewart 		}
4578f8829a4aSRandall Stewart 		net->prev_cwnd = net->cwnd;
4579f8829a4aSRandall Stewart 		net->net_ack = 0;
4580f8829a4aSRandall Stewart 		net->net_ack2 = 0;
4581f8829a4aSRandall Stewart 
4582f8829a4aSRandall Stewart 		/*
458342551e99SRandall Stewart 		 * CMT: Reset CUC and Fast recovery algo variables before
458442551e99SRandall Stewart 		 * SACK processing
4585f8829a4aSRandall Stewart 		 */
4586f8829a4aSRandall Stewart 		net->new_pseudo_cumack = 0;
4587f8829a4aSRandall Stewart 		net->will_exit_fast_recovery = 0;
4588299108c5SRandall Stewart 		if (stcb->asoc.cc_functions.sctp_cwnd_prepare_net_for_sack) {
4589299108c5SRandall Stewart 			(*stcb->asoc.cc_functions.sctp_cwnd_prepare_net_for_sack) (stcb, net);
4590299108c5SRandall Stewart 		}
45910053ed28SMichael Tuexen 
4592e9a3a1b1SMichael Tuexen 		/*
4593e9a3a1b1SMichael Tuexen 		 * CMT: SFR algo (and HTNA) - this_sack_highest_newack has
4594e9a3a1b1SMichael Tuexen 		 * to be greater than the cumack. Also reset saw_newack to 0
4595e9a3a1b1SMichael Tuexen 		 * for all dests.
4596e9a3a1b1SMichael Tuexen 		 */
4597e9a3a1b1SMichael Tuexen 		net->saw_newack = 0;
4598e9a3a1b1SMichael Tuexen 		net->this_sack_highest_newack = last_tsn;
4599f8829a4aSRandall Stewart 	}
4600f8829a4aSRandall Stewart 	/* process the new consecutive TSN first */
46014a9ef3f8SMichael Tuexen 	TAILQ_FOREACH(tp1, &asoc->sent_queue, sctp_next) {
460249656eefSMichael Tuexen 		if (SCTP_TSN_GE(last_tsn, tp1->rec.data.tsn)) {
4603f8829a4aSRandall Stewart 			if (tp1->sent != SCTP_DATAGRAM_UNSENT) {
4604f8829a4aSRandall Stewart 				accum_moved = 1;
4605f8829a4aSRandall Stewart 				if (tp1->sent < SCTP_DATAGRAM_ACKED) {
4606f8829a4aSRandall Stewart 					/*
4607f8829a4aSRandall Stewart 					 * If it is less than ACKED, it is
4608f8829a4aSRandall Stewart 					 * now no-longer in flight. Higher
4609f8829a4aSRandall Stewart 					 * values may occur during marking
4610f8829a4aSRandall Stewart 					 */
4611f8829a4aSRandall Stewart 					if ((tp1->whoTo->dest_state &
4612f8829a4aSRandall Stewart 					    SCTP_ADDR_UNCONFIRMED) &&
4613f8829a4aSRandall Stewart 					    (tp1->snd_count < 2)) {
4614f8829a4aSRandall Stewart 						/*
4615f8829a4aSRandall Stewart 						 * If there was no retran
4616f8829a4aSRandall Stewart 						 * and the address is
4617f8829a4aSRandall Stewart 						 * un-confirmed and we sent
4618f8829a4aSRandall Stewart 						 * there and are now
4619f8829a4aSRandall Stewart 						 * sacked.. its confirmed,
4620f8829a4aSRandall Stewart 						 * mark it so.
4621f8829a4aSRandall Stewart 						 */
4622f8829a4aSRandall Stewart 						tp1->whoTo->dest_state &=
4623f8829a4aSRandall Stewart 						    ~SCTP_ADDR_UNCONFIRMED;
4624f8829a4aSRandall Stewart 					}
4625c105859eSRandall Stewart 					if (tp1->sent < SCTP_DATAGRAM_RESEND) {
4626b3f1ea41SRandall Stewart 						if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FLIGHT_LOGGING_ENABLE) {
4627c105859eSRandall Stewart 							sctp_misc_ints(SCTP_FLIGHT_LOG_DOWN_CA,
4628a5d547adSRandall Stewart 							    tp1->whoTo->flight_size,
4629a5d547adSRandall Stewart 							    tp1->book_size,
46309a8e3088SMichael Tuexen 							    (uint32_t)(uintptr_t)tp1->whoTo,
463149656eefSMichael Tuexen 							    tp1->rec.data.tsn);
463280fefe0aSRandall Stewart 						}
4633c105859eSRandall Stewart 						sctp_flight_size_decrease(tp1);
4634c105859eSRandall Stewart 						sctp_total_flight_decrease(stcb, tp1);
4635299108c5SRandall Stewart 						if (stcb->asoc.cc_functions.sctp_cwnd_update_tsn_acknowledged) {
4636299108c5SRandall Stewart 							(*stcb->asoc.cc_functions.sctp_cwnd_update_tsn_acknowledged) (tp1->whoTo,
4637299108c5SRandall Stewart 							    tp1);
4638299108c5SRandall Stewart 						}
4639f8829a4aSRandall Stewart 					}
4640f8829a4aSRandall Stewart 					tp1->whoTo->net_ack += tp1->send_size;
4641f8829a4aSRandall Stewart 
4642f8829a4aSRandall Stewart 					/* CMT SFR and DAC algos */
464349656eefSMichael Tuexen 					this_sack_lowest_newack = tp1->rec.data.tsn;
4644f8829a4aSRandall Stewart 					tp1->whoTo->saw_newack = 1;
4645f8829a4aSRandall Stewart 
4646f8829a4aSRandall Stewart 					if (tp1->snd_count < 2) {
4647f8829a4aSRandall Stewart 						/*
4648ab9ed8a1SDevin Teske 						 * True non-retransmitted
4649f8829a4aSRandall Stewart 						 * chunk
4650f8829a4aSRandall Stewart 						 */
4651f8829a4aSRandall Stewart 						tp1->whoTo->net_ack2 +=
4652f8829a4aSRandall Stewart 						    tp1->send_size;
4653f8829a4aSRandall Stewart 
4654f8829a4aSRandall Stewart 						/* update RTO too? */
4655f8829a4aSRandall Stewart 						if (tp1->do_rtt) {
465644f2a327SMichael Tuexen 							if (rto_ok &&
4657f8829a4aSRandall Stewart 							    sctp_calculate_rto(stcb,
465844f2a327SMichael Tuexen 							    &stcb->asoc,
465944f2a327SMichael Tuexen 							    tp1->whoTo,
466018e198d3SRandall Stewart 							    &tp1->sent_rcv_time,
466144f2a327SMichael Tuexen 							    SCTP_RTT_FROM_DATA)) {
4662f79aab18SRandall Stewart 								rto_ok = 0;
4663f79aab18SRandall Stewart 							}
4664f79aab18SRandall Stewart 							if (tp1->whoTo->rto_needed == 0) {
4665f79aab18SRandall Stewart 								tp1->whoTo->rto_needed = 1;
4666f79aab18SRandall Stewart 							}
4667f8829a4aSRandall Stewart 							tp1->do_rtt = 0;
4668f8829a4aSRandall Stewart 						}
4669f8829a4aSRandall Stewart 					}
4670f8829a4aSRandall Stewart 					/*
4671f8829a4aSRandall Stewart 					 * CMT: CUCv2 algorithm. From the
4672f8829a4aSRandall Stewart 					 * cumack'd TSNs, for each TSN being
4673f8829a4aSRandall Stewart 					 * acked for the first time, set the
4674f8829a4aSRandall Stewart 					 * following variables for the
4675f8829a4aSRandall Stewart 					 * corresp destination.
4676f8829a4aSRandall Stewart 					 * new_pseudo_cumack will trigger a
4677f8829a4aSRandall Stewart 					 * cwnd update.
4678f8829a4aSRandall Stewart 					 * find_(rtx_)pseudo_cumack will
4679f8829a4aSRandall Stewart 					 * trigger search for the next
4680f8829a4aSRandall Stewart 					 * expected (rtx-)pseudo-cumack.
4681f8829a4aSRandall Stewart 					 */
4682f8829a4aSRandall Stewart 					tp1->whoTo->new_pseudo_cumack = 1;
4683f8829a4aSRandall Stewart 					tp1->whoTo->find_pseudo_cumack = 1;
4684f8829a4aSRandall Stewart 					tp1->whoTo->find_rtx_pseudo_cumack = 1;
4685b3f1ea41SRandall Stewart 					if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_SACK_LOGGING_ENABLE) {
4686f8829a4aSRandall Stewart 						sctp_log_sack(asoc->last_acked_seq,
4687f8829a4aSRandall Stewart 						    cum_ack,
468849656eefSMichael Tuexen 						    tp1->rec.data.tsn,
4689f8829a4aSRandall Stewart 						    0,
4690f8829a4aSRandall Stewart 						    0,
4691f8829a4aSRandall Stewart 						    SCTP_LOG_TSN_ACKED);
469280fefe0aSRandall Stewart 					}
4693b3f1ea41SRandall Stewart 					if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
469449656eefSMichael Tuexen 						sctp_log_cwnd(stcb, tp1->whoTo, tp1->rec.data.tsn, SCTP_CWND_LOG_FROM_SACK);
469580fefe0aSRandall Stewart 					}
4696f8829a4aSRandall Stewart 				}
4697f8829a4aSRandall Stewart 				if (tp1->sent == SCTP_DATAGRAM_RESEND) {
4698f8829a4aSRandall Stewart 					sctp_ucount_decr(asoc->sent_queue_retran_cnt);
4699f8829a4aSRandall Stewart #ifdef SCTP_AUDITING_ENABLED
4700f8829a4aSRandall Stewart 					sctp_audit_log(0xB3,
4701f8829a4aSRandall Stewart 					    (asoc->sent_queue_retran_cnt & 0x000000ff));
4702f8829a4aSRandall Stewart #endif
4703f8829a4aSRandall Stewart 				}
470442551e99SRandall Stewart 				if (tp1->rec.data.chunk_was_revoked) {
470542551e99SRandall Stewart 					/* deflate the cwnd */
470642551e99SRandall Stewart 					tp1->whoTo->cwnd -= tp1->book_size;
470742551e99SRandall Stewart 					tp1->rec.data.chunk_was_revoked = 0;
470842551e99SRandall Stewart 				}
4709325c8c46SMichael Tuexen 				if (tp1->sent != SCTP_DATAGRAM_NR_ACKED) {
4710f8829a4aSRandall Stewart 					tp1->sent = SCTP_DATAGRAM_ACKED;
4711f8829a4aSRandall Stewart 				}
4712325c8c46SMichael Tuexen 			}
4713f8829a4aSRandall Stewart 		} else {
4714f8829a4aSRandall Stewart 			break;
4715f8829a4aSRandall Stewart 		}
4716f8829a4aSRandall Stewart 	}
4717f8829a4aSRandall Stewart 	biggest_tsn_newly_acked = biggest_tsn_acked = last_tsn;
4718f8829a4aSRandall Stewart 	/* always set this up to cum-ack */
4719f8829a4aSRandall Stewart 	asoc->this_sack_highest_gap = last_tsn;
4720f8829a4aSRandall Stewart 
4721cd554309SMichael Tuexen 	if ((num_seg > 0) || (num_nr_seg > 0)) {
4722f8829a4aSRandall Stewart 		/*
4723f8829a4aSRandall Stewart 		 * thisSackHighestGap will increase while handling NEW
4724f8829a4aSRandall Stewart 		 * segments this_sack_highest_newack will increase while
4725f8829a4aSRandall Stewart 		 * handling NEWLY ACKED chunks. this_sack_lowest_newack is
4726f8829a4aSRandall Stewart 		 * used for CMT DAC algo. saw_newack will also change.
4727f8829a4aSRandall Stewart 		 */
4728cd554309SMichael Tuexen 		if (sctp_handle_segments(m, &offset_seg, stcb, asoc, last_tsn, &biggest_tsn_acked,
4729cd554309SMichael Tuexen 		    &biggest_tsn_newly_acked, &this_sack_lowest_newack,
47307215cc1bSMichael Tuexen 		    num_seg, num_nr_seg, &rto_ok)) {
4731cd554309SMichael Tuexen 			wake_him++;
4732cd554309SMichael Tuexen 		}
4733f8829a4aSRandall Stewart 		/*
4734fd60718dSMichael Tuexen 		 * validate the biggest_tsn_acked in the gap acks if strict
4735fd60718dSMichael Tuexen 		 * adherence is wanted.
4736f8829a4aSRandall Stewart 		 */
473720b07a4dSMichael Tuexen 		if (SCTP_TSN_GE(biggest_tsn_acked, send_s)) {
4738f8829a4aSRandall Stewart 			/*
4739fd60718dSMichael Tuexen 			 * peer is either confused or we are under attack.
4740fd60718dSMichael Tuexen 			 * We must abort.
4741f8829a4aSRandall Stewart 			 */
4742cd3fd531SMichael Tuexen 			SCTP_PRINTF("Hopeless peer! biggest_tsn_acked:%x largest seq:%x\n",
4743cd3fd531SMichael Tuexen 			    biggest_tsn_acked, send_s);
4744f8829a4aSRandall Stewart 			goto hopeless_peer;
4745f8829a4aSRandall Stewart 		}
4746f8829a4aSRandall Stewart 	}
4747f8829a4aSRandall Stewart 	/*******************************************/
4748f8829a4aSRandall Stewart 	/* cancel ALL T3-send timer if accum moved */
4749f8829a4aSRandall Stewart 	/*******************************************/
47507c99d56fSMichael Tuexen 	if (asoc->sctp_cmt_on_off > 0) {
4751f8829a4aSRandall Stewart 		TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
4752f8829a4aSRandall Stewart 			if (net->new_pseudo_cumack)
4753f8829a4aSRandall Stewart 				sctp_timer_stop(SCTP_TIMER_TYPE_SEND, stcb->sctp_ep,
4754a5d547adSRandall Stewart 				    stcb, net,
475591e04f9eSMichael Tuexen 				    SCTP_FROM_SCTP_INDATA + SCTP_LOC_31);
4756f8829a4aSRandall Stewart 		}
4757f8829a4aSRandall Stewart 	} else {
4758f8829a4aSRandall Stewart 		if (accum_moved) {
4759f8829a4aSRandall Stewart 			TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
4760f8829a4aSRandall Stewart 				sctp_timer_stop(SCTP_TIMER_TYPE_SEND, stcb->sctp_ep,
476191e04f9eSMichael Tuexen 				    stcb, net, SCTP_FROM_SCTP_INDATA + SCTP_LOC_32);
4762f8829a4aSRandall Stewart 			}
4763f8829a4aSRandall Stewart 		}
4764f8829a4aSRandall Stewart 	}
4765f8829a4aSRandall Stewart 	/********************************************/
4766d9c5cfeaSMichael Tuexen 	/* drop the acked chunks from the sentqueue */
4767f8829a4aSRandall Stewart 	/********************************************/
4768f8829a4aSRandall Stewart 	asoc->last_acked_seq = cum_ack;
4769f8829a4aSRandall Stewart 
47707c99d56fSMichael Tuexen 	TAILQ_FOREACH_SAFE(tp1, &asoc->sent_queue, sctp_next, tp2) {
477149656eefSMichael Tuexen 		if (SCTP_TSN_GT(tp1->rec.data.tsn, cum_ack)) {
4772f8829a4aSRandall Stewart 			break;
4773f8829a4aSRandall Stewart 		}
4774325c8c46SMichael Tuexen 		if (tp1->sent != SCTP_DATAGRAM_NR_ACKED) {
477549656eefSMichael Tuexen 			if (asoc->strmout[tp1->rec.data.sid].chunks_on_queues > 0) {
477649656eefSMichael Tuexen 				asoc->strmout[tp1->rec.data.sid].chunks_on_queues--;
4777a7ad6026SMichael Tuexen #ifdef INVARIANTS
4778a7ad6026SMichael Tuexen 			} else {
477949656eefSMichael Tuexen 				panic("No chunks on the queues for sid %u.", tp1->rec.data.sid);
4780a7ad6026SMichael Tuexen #endif
4781a7ad6026SMichael Tuexen 			}
4782f8829a4aSRandall Stewart 		}
478349656eefSMichael Tuexen 		if ((asoc->strmout[tp1->rec.data.sid].chunks_on_queues == 0) &&
478449656eefSMichael Tuexen 		    (asoc->strmout[tp1->rec.data.sid].state == SCTP_STREAM_RESET_PENDING) &&
478549656eefSMichael Tuexen 		    TAILQ_EMPTY(&asoc->strmout[tp1->rec.data.sid].outqueue)) {
4786d96bef9cSMichael Tuexen 			asoc->trigger_reset = 1;
4787d96bef9cSMichael Tuexen 		}
4788f8829a4aSRandall Stewart 		TAILQ_REMOVE(&asoc->sent_queue, tp1, sctp_next);
47890ddb4299SMichael Tuexen 		if (PR_SCTP_ENABLED(tp1->flags)) {
4790f8829a4aSRandall Stewart 			if (asoc->pr_sctp_cnt != 0)
4791f8829a4aSRandall Stewart 				asoc->pr_sctp_cnt--;
4792f8829a4aSRandall Stewart 		}
47937c99d56fSMichael Tuexen 		asoc->sent_queue_cnt--;
4794f8829a4aSRandall Stewart 		if (tp1->data) {
479504ee05e8SRandall Stewart 			/* sa_ignore NO_NULL_CHK */
4796f8829a4aSRandall Stewart 			sctp_free_bufspace(stcb, asoc, tp1, 1);
4797f8829a4aSRandall Stewart 			sctp_m_freem(tp1->data);
47987c99d56fSMichael Tuexen 			tp1->data = NULL;
4799dd973b0eSMichael Tuexen 			if (asoc->prsctp_supported && PR_SCTP_BUF_ENABLED(tp1->flags)) {
4800f8829a4aSRandall Stewart 				asoc->sent_queue_cnt_removeable--;
4801f8829a4aSRandall Stewart 			}
4802f8829a4aSRandall Stewart 		}
4803b3f1ea41SRandall Stewart 		if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_SACK_LOGGING_ENABLE) {
4804f8829a4aSRandall Stewart 			sctp_log_sack(asoc->last_acked_seq,
4805f8829a4aSRandall Stewart 			    cum_ack,
480649656eefSMichael Tuexen 			    tp1->rec.data.tsn,
4807f8829a4aSRandall Stewart 			    0,
4808f8829a4aSRandall Stewart 			    0,
4809f8829a4aSRandall Stewart 			    SCTP_LOG_FREE_SENT);
481080fefe0aSRandall Stewart 		}
4811689e6a5fSMichael Tuexen 		sctp_free_a_chunk(stcb, tp1, SCTP_SO_NOT_LOCKED);
4812f8829a4aSRandall Stewart 		wake_him++;
48137c99d56fSMichael Tuexen 	}
48147c99d56fSMichael Tuexen 	if (TAILQ_EMPTY(&asoc->sent_queue) && (asoc->total_flight > 0)) {
48157c99d56fSMichael Tuexen #ifdef INVARIANTS
4816cd0a4ff6SPedro F. Giffuni 		panic("Warning flight size is positive and should be 0");
48177c99d56fSMichael Tuexen #else
48187c99d56fSMichael Tuexen 		SCTP_PRINTF("Warning flight size incorrect should be 0 is %d\n",
48197c99d56fSMichael Tuexen 		    asoc->total_flight);
48207c99d56fSMichael Tuexen #endif
48217c99d56fSMichael Tuexen 		asoc->total_flight = 0;
48227c99d56fSMichael Tuexen 	}
48230053ed28SMichael Tuexen 
482404ee05e8SRandall Stewart 	/* sa_ignore NO_NULL_CHK */
4825f8829a4aSRandall Stewart 	if ((wake_him) && (stcb->sctp_socket)) {
4826f8829a4aSRandall Stewart 		SOCKBUF_LOCK(&stcb->sctp_socket->so_snd);
4827b3f1ea41SRandall Stewart 		if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_WAKE_LOGGING_ENABLE) {
48287215cc1bSMichael Tuexen 			sctp_wakeup_log(stcb, wake_him, SCTP_WAKESND_FROM_SACK);
482980fefe0aSRandall Stewart 		}
4830f8829a4aSRandall Stewart 		sctp_sowwakeup_locked(stcb->sctp_ep, stcb->sctp_socket);
4831f8829a4aSRandall Stewart 	} else {
4832b3f1ea41SRandall Stewart 		if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_WAKE_LOGGING_ENABLE) {
48337215cc1bSMichael Tuexen 			sctp_wakeup_log(stcb, wake_him, SCTP_NOWAKE_FROM_SACK);
483480fefe0aSRandall Stewart 		}
4835f8829a4aSRandall Stewart 	}
4836f8829a4aSRandall Stewart 
483742551e99SRandall Stewart 	if (asoc->fast_retran_loss_recovery && accum_moved) {
483820b07a4dSMichael Tuexen 		if (SCTP_TSN_GE(asoc->last_acked_seq, asoc->fast_recovery_tsn)) {
4839f8829a4aSRandall Stewart 			/* Setup so we will exit RFC2582 fast recovery */
4840f8829a4aSRandall Stewart 			will_exit_fast_recovery = 1;
4841f8829a4aSRandall Stewart 		}
4842f8829a4aSRandall Stewart 	}
4843f8829a4aSRandall Stewart 	/*
4844f8829a4aSRandall Stewart 	 * Check for revoked fragments:
4845f8829a4aSRandall Stewart 	 *
4846f8829a4aSRandall Stewart 	 * if Previous sack - Had no frags then we can't have any revoked if
4847f8829a4aSRandall Stewart 	 * Previous sack - Had frag's then - If we now have frags aka
4848f8829a4aSRandall Stewart 	 * num_seg > 0 call sctp_check_for_revoked() to tell if peer revoked
4849f8829a4aSRandall Stewart 	 * some of them. else - The peer revoked all ACKED fragments, since
4850f8829a4aSRandall Stewart 	 * we had some before and now we have NONE.
4851f8829a4aSRandall Stewart 	 */
4852f8829a4aSRandall Stewart 
4853d9c5cfeaSMichael Tuexen 	if (num_seg) {
4854c105859eSRandall Stewart 		sctp_check_for_revoked(stcb, asoc, cum_ack, biggest_tsn_acked);
4855d9c5cfeaSMichael Tuexen 		asoc->saw_sack_with_frags = 1;
4856d9c5cfeaSMichael Tuexen 	} else if (asoc->saw_sack_with_frags) {
4857f8829a4aSRandall Stewart 		int cnt_revoked = 0;
4858f8829a4aSRandall Stewart 
4859f8829a4aSRandall Stewart 		/* Peer revoked all dg's marked or acked */
4860f8829a4aSRandall Stewart 		TAILQ_FOREACH(tp1, &asoc->sent_queue, sctp_next) {
4861b5c16493SMichael Tuexen 			if (tp1->sent == SCTP_DATAGRAM_ACKED) {
4862f8829a4aSRandall Stewart 				tp1->sent = SCTP_DATAGRAM_SENT;
4863b3f1ea41SRandall Stewart 				if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FLIGHT_LOGGING_ENABLE) {
4864c105859eSRandall Stewart 					sctp_misc_ints(SCTP_FLIGHT_LOG_UP_REVOKE,
4865c105859eSRandall Stewart 					    tp1->whoTo->flight_size,
4866c105859eSRandall Stewart 					    tp1->book_size,
48679a8e3088SMichael Tuexen 					    (uint32_t)(uintptr_t)tp1->whoTo,
486849656eefSMichael Tuexen 					    tp1->rec.data.tsn);
486980fefe0aSRandall Stewart 				}
4870c105859eSRandall Stewart 				sctp_flight_size_increase(tp1);
4871c105859eSRandall Stewart 				sctp_total_flight_increase(stcb, tp1);
4872a5d547adSRandall Stewart 				tp1->rec.data.chunk_was_revoked = 1;
487342551e99SRandall Stewart 				/*
487442551e99SRandall Stewart 				 * To ensure that this increase in
48754a9ef3f8SMichael Tuexen 				 * flightsize, which is artificial, does not
48764a9ef3f8SMichael Tuexen 				 * throttle the sender, we also increase the
48774a9ef3f8SMichael Tuexen 				 * cwnd artificially.
487842551e99SRandall Stewart 				 */
487942551e99SRandall Stewart 				tp1->whoTo->cwnd += tp1->book_size;
4880f8829a4aSRandall Stewart 				cnt_revoked++;
4881f8829a4aSRandall Stewart 			}
4882f8829a4aSRandall Stewart 		}
4883f8829a4aSRandall Stewart 		if (cnt_revoked) {
4884f8829a4aSRandall Stewart 			reneged_all = 1;
4885f8829a4aSRandall Stewart 		}
4886f8829a4aSRandall Stewart 		asoc->saw_sack_with_frags = 0;
4887f8829a4aSRandall Stewart 	}
4888d9c5cfeaSMichael Tuexen 	if (num_nr_seg > 0)
4889d9c5cfeaSMichael Tuexen 		asoc->saw_sack_with_nr_frags = 1;
4890f8829a4aSRandall Stewart 	else
4891d9c5cfeaSMichael Tuexen 		asoc->saw_sack_with_nr_frags = 0;
4892f8829a4aSRandall Stewart 
4893b54d3a6cSRandall Stewart 	/* JRS - Use the congestion control given in the CC module */
4894ca85e948SMichael Tuexen 	if (ecne_seen == 0) {
4895ca85e948SMichael Tuexen 		TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
4896ca85e948SMichael Tuexen 			if (net->net_ack2 > 0) {
4897ca85e948SMichael Tuexen 				/*
4898ca85e948SMichael Tuexen 				 * Karn's rule applies to clearing error
4899ca85e948SMichael Tuexen 				 * count, this is optional.
4900ca85e948SMichael Tuexen 				 */
4901ca85e948SMichael Tuexen 				net->error_count = 0;
49029b2a35b3SMichael Tuexen 				if ((net->dest_state & SCTP_ADDR_REACHABLE) == 0) {
4903ca85e948SMichael Tuexen 					/* addr came good */
4904ca85e948SMichael Tuexen 					net->dest_state |= SCTP_ADDR_REACHABLE;
4905ca85e948SMichael Tuexen 					sctp_ulp_notify(SCTP_NOTIFY_INTERFACE_UP, stcb,
49064b1f78e1SMichael Tuexen 					    0, (void *)net, SCTP_SO_NOT_LOCKED);
4907ca85e948SMichael Tuexen 				}
49080053ed28SMichael Tuexen 
4909ca85e948SMichael Tuexen 				if (net == stcb->asoc.primary_destination) {
4910ca85e948SMichael Tuexen 					if (stcb->asoc.alternate) {
4911b7b84c0eSMichael Tuexen 						/*
4912b7b84c0eSMichael Tuexen 						 * release the alternate,
4913b7b84c0eSMichael Tuexen 						 * primary is good
4914b7b84c0eSMichael Tuexen 						 */
4915ca85e948SMichael Tuexen 						sctp_free_remote_addr(stcb->asoc.alternate);
4916ca85e948SMichael Tuexen 						stcb->asoc.alternate = NULL;
4917ca85e948SMichael Tuexen 					}
4918ca85e948SMichael Tuexen 				}
49190053ed28SMichael Tuexen 
4920ca85e948SMichael Tuexen 				if (net->dest_state & SCTP_ADDR_PF) {
4921ca85e948SMichael Tuexen 					net->dest_state &= ~SCTP_ADDR_PF;
4922b7d130beSMichael Tuexen 					sctp_timer_stop(SCTP_TIMER_TYPE_HEARTBEAT,
4923b7d130beSMichael Tuexen 					    stcb->sctp_ep, stcb, net,
492491e04f9eSMichael Tuexen 					    SCTP_FROM_SCTP_INDATA + SCTP_LOC_33);
4925ca85e948SMichael Tuexen 					sctp_timer_start(SCTP_TIMER_TYPE_HEARTBEAT, stcb->sctp_ep, stcb, net);
4926ca85e948SMichael Tuexen 					asoc->cc_functions.sctp_cwnd_update_exit_pf(stcb, net);
4927ca85e948SMichael Tuexen 					/* Done with this net */
4928ca85e948SMichael Tuexen 					net->net_ack = 0;
4929ca85e948SMichael Tuexen 				}
4930ca85e948SMichael Tuexen 				/* restore any doubled timers */
4931ca85e948SMichael Tuexen 				net->RTO = (net->lastsa >> SCTP_RTT_SHIFT) + net->lastsv;
4932ca85e948SMichael Tuexen 				if (net->RTO < stcb->asoc.minrto) {
4933ca85e948SMichael Tuexen 					net->RTO = stcb->asoc.minrto;
4934ca85e948SMichael Tuexen 				}
4935ca85e948SMichael Tuexen 				if (net->RTO > stcb->asoc.maxrto) {
4936ca85e948SMichael Tuexen 					net->RTO = stcb->asoc.maxrto;
4937ca85e948SMichael Tuexen 				}
4938ca85e948SMichael Tuexen 			}
4939ca85e948SMichael Tuexen 		}
4940b54d3a6cSRandall Stewart 		asoc->cc_functions.sctp_cwnd_update_after_sack(stcb, asoc, accum_moved, reneged_all, will_exit_fast_recovery);
4941ca85e948SMichael Tuexen 	}
49420053ed28SMichael Tuexen 
4943f8829a4aSRandall Stewart 	if (TAILQ_EMPTY(&asoc->sent_queue)) {
4944f8829a4aSRandall Stewart 		/* nothing left in-flight */
4945f8829a4aSRandall Stewart 		TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
4946f8829a4aSRandall Stewart 			/* stop all timers */
4947f8829a4aSRandall Stewart 			sctp_timer_stop(SCTP_TIMER_TYPE_SEND, stcb->sctp_ep,
4948b7d130beSMichael Tuexen 			    stcb, net,
494991e04f9eSMichael Tuexen 			    SCTP_FROM_SCTP_INDATA + SCTP_LOC_34);
4950f8829a4aSRandall Stewart 			net->flight_size = 0;
4951f8829a4aSRandall Stewart 			net->partial_bytes_acked = 0;
4952f8829a4aSRandall Stewart 		}
4953f8829a4aSRandall Stewart 		asoc->total_flight = 0;
4954f8829a4aSRandall Stewart 		asoc->total_flight_count = 0;
4955f8829a4aSRandall Stewart 	}
49560053ed28SMichael Tuexen 
4957f8829a4aSRandall Stewart 	/**********************************/
4958f8829a4aSRandall Stewart 	/* Now what about shutdown issues */
4959f8829a4aSRandall Stewart 	/**********************************/
4960f8829a4aSRandall Stewart 	if (TAILQ_EMPTY(&asoc->send_queue) && TAILQ_EMPTY(&asoc->sent_queue)) {
4961f8829a4aSRandall Stewart 		/* nothing left on sendqueue.. consider done */
4962b3f1ea41SRandall Stewart 		if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_RWND_ENABLE) {
4963f8829a4aSRandall Stewart 			sctp_log_rwnd_set(SCTP_SET_PEER_RWND_VIA_SACK,
4964f8829a4aSRandall Stewart 			    asoc->peers_rwnd, 0, 0, a_rwnd);
496580fefe0aSRandall Stewart 		}
4966f8829a4aSRandall Stewart 		asoc->peers_rwnd = a_rwnd;
4967f8829a4aSRandall Stewart 		if (asoc->peers_rwnd < stcb->sctp_ep->sctp_ep.sctp_sws_sender) {
4968f8829a4aSRandall Stewart 			/* SWS sender side engages */
4969f8829a4aSRandall Stewart 			asoc->peers_rwnd = 0;
4970f8829a4aSRandall Stewart 		}
4971f8829a4aSRandall Stewart 		/* clean up */
4972f8829a4aSRandall Stewart 		if ((asoc->stream_queue_cnt == 1) &&
4973f8829a4aSRandall Stewart 		    ((asoc->state & SCTP_STATE_SHUTDOWN_PENDING) ||
4974839d21d6SMichael Tuexen 		    (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED)) &&
4975d1ea5fa9SMichael Tuexen 		    ((*asoc->ss_functions.sctp_ss_is_user_msgs_incomplete) (stcb, asoc))) {
4976839d21d6SMichael Tuexen 			SCTP_ADD_SUBSTATE(stcb, SCTP_STATE_PARTIAL_MSG_LEFT);
4977f8829a4aSRandall Stewart 		}
4978bbc9dfbcSMichael Tuexen 		if (((asoc->state & SCTP_STATE_SHUTDOWN_PENDING) ||
4979839d21d6SMichael Tuexen 		    (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED)) &&
4980bbc9dfbcSMichael Tuexen 		    (asoc->stream_queue_cnt == 1) &&
4981bbc9dfbcSMichael Tuexen 		    (asoc->state & SCTP_STATE_PARTIAL_MSG_LEFT)) {
4982ff1ffd74SMichael Tuexen 			struct mbuf *op_err;
4983f8829a4aSRandall Stewart 
4984f8829a4aSRandall Stewart 			*abort_now = 1;
4985f8829a4aSRandall Stewart 			/* XXX */
4986ff1ffd74SMichael Tuexen 			op_err = sctp_generate_cause(SCTP_CAUSE_USER_INITIATED_ABT, "");
498791e04f9eSMichael Tuexen 			stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_35;
4988105b68b4SMichael Tuexen 			sctp_abort_an_association(stcb->sctp_ep, stcb, op_err, false, SCTP_SO_NOT_LOCKED);
4989f8829a4aSRandall Stewart 			return;
4990bbc9dfbcSMichael Tuexen 		}
4991bbc9dfbcSMichael Tuexen 		if ((asoc->state & SCTP_STATE_SHUTDOWN_PENDING) &&
4992bbc9dfbcSMichael Tuexen 		    (asoc->stream_queue_cnt == 0)) {
4993ca85e948SMichael Tuexen 			struct sctp_nets *netp;
4994ca85e948SMichael Tuexen 
4995839d21d6SMichael Tuexen 			if ((SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) ||
4996839d21d6SMichael Tuexen 			    (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED)) {
4997f8829a4aSRandall Stewart 				SCTP_STAT_DECR_GAUGE32(sctps_currestab);
4998f42a358aSRandall Stewart 			}
4999839d21d6SMichael Tuexen 			SCTP_SET_STATE(stcb, SCTP_STATE_SHUTDOWN_SENT);
5000f8829a4aSRandall Stewart 			sctp_stop_timers_for_shutdown(stcb);
5001c39cfa1fSMichael Tuexen 			if (asoc->alternate) {
5002c39cfa1fSMichael Tuexen 				netp = asoc->alternate;
5003c39cfa1fSMichael Tuexen 			} else {
5004c39cfa1fSMichael Tuexen 				netp = asoc->primary_destination;
5005c39cfa1fSMichael Tuexen 			}
5006ca85e948SMichael Tuexen 			sctp_send_shutdown(stcb, netp);
5007f8829a4aSRandall Stewart 			sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWN,
5008ca85e948SMichael Tuexen 			    stcb->sctp_ep, stcb, netp);
5009f8829a4aSRandall Stewart 			sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNGUARD,
50106fb7b4fbSMichael Tuexen 			    stcb->sctp_ep, stcb, NULL);
5011f8829a4aSRandall Stewart 			return;
5012839d21d6SMichael Tuexen 		} else if ((SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED) &&
5013f8829a4aSRandall Stewart 		    (asoc->stream_queue_cnt == 0)) {
5014ca85e948SMichael Tuexen 			struct sctp_nets *netp;
5015ca85e948SMichael Tuexen 
5016f8829a4aSRandall Stewart 			SCTP_STAT_DECR_GAUGE32(sctps_currestab);
5017839d21d6SMichael Tuexen 			SCTP_SET_STATE(stcb, SCTP_STATE_SHUTDOWN_ACK_SENT);
501812af6654SMichael Tuexen 			sctp_stop_timers_for_shutdown(stcb);
5019c39cfa1fSMichael Tuexen 			if (asoc->alternate) {
5020c39cfa1fSMichael Tuexen 				netp = asoc->alternate;
5021c39cfa1fSMichael Tuexen 			} else {
5022c39cfa1fSMichael Tuexen 				netp = asoc->primary_destination;
5023c39cfa1fSMichael Tuexen 			}
5024c39cfa1fSMichael Tuexen 			sctp_send_shutdown_ack(stcb, netp);
5025f8829a4aSRandall Stewart 			sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNACK,
5026ca85e948SMichael Tuexen 			    stcb->sctp_ep, stcb, netp);
5027f8829a4aSRandall Stewart 			return;
5028f8829a4aSRandall Stewart 		}
5029f8829a4aSRandall Stewart 	}
5030f8829a4aSRandall Stewart 	/*
5031f8829a4aSRandall Stewart 	 * Now here we are going to recycle net_ack for a different use...
5032f8829a4aSRandall Stewart 	 * HEADS UP.
5033f8829a4aSRandall Stewart 	 */
5034f8829a4aSRandall Stewart 	TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
5035f8829a4aSRandall Stewart 		net->net_ack = 0;
5036f8829a4aSRandall Stewart 	}
5037f8829a4aSRandall Stewart 
5038f8829a4aSRandall Stewart 	/*
5039f8829a4aSRandall Stewart 	 * CMT DAC algorithm: If SACK DAC flag was 0, then no extra marking
5040f8829a4aSRandall Stewart 	 * to be done. Setting this_sack_lowest_newack to the cum_ack will
5041f8829a4aSRandall Stewart 	 * automatically ensure that.
5042f8829a4aSRandall Stewart 	 */
50437c99d56fSMichael Tuexen 	if ((asoc->sctp_cmt_on_off > 0) &&
504420083c2eSMichael Tuexen 	    SCTP_BASE_SYSCTL(sctp_cmt_use_dac) &&
504520083c2eSMichael Tuexen 	    (cmt_dac_flag == 0)) {
5046f8829a4aSRandall Stewart 		this_sack_lowest_newack = cum_ack;
5047f8829a4aSRandall Stewart 	}
5048cd554309SMichael Tuexen 	if ((num_seg > 0) || (num_nr_seg > 0)) {
5049f8829a4aSRandall Stewart 		sctp_strike_gap_ack_chunks(stcb, asoc, biggest_tsn_acked,
5050f8829a4aSRandall Stewart 		    biggest_tsn_newly_acked, this_sack_lowest_newack, accum_moved);
5051f8829a4aSRandall Stewart 	}
5052b54d3a6cSRandall Stewart 	/* JRS - Use the congestion control given in the CC module */
5053b54d3a6cSRandall Stewart 	asoc->cc_functions.sctp_cwnd_update_after_fr(stcb, asoc);
5054f8829a4aSRandall Stewart 
5055f8829a4aSRandall Stewart 	/* Now are we exiting loss recovery ? */
5056f8829a4aSRandall Stewart 	if (will_exit_fast_recovery) {
5057f8829a4aSRandall Stewart 		/* Ok, we must exit fast recovery */
5058f8829a4aSRandall Stewart 		asoc->fast_retran_loss_recovery = 0;
5059f8829a4aSRandall Stewart 	}
5060f8829a4aSRandall Stewart 	if ((asoc->sat_t3_loss_recovery) &&
506120b07a4dSMichael Tuexen 	    SCTP_TSN_GE(asoc->last_acked_seq, asoc->sat_t3_recovery_tsn)) {
5062f8829a4aSRandall Stewart 		/* end satellite t3 loss recovery */
5063f8829a4aSRandall Stewart 		asoc->sat_t3_loss_recovery = 0;
5064f8829a4aSRandall Stewart 	}
506542551e99SRandall Stewart 	/*
506642551e99SRandall Stewart 	 * CMT Fast recovery
506742551e99SRandall Stewart 	 */
5068f8829a4aSRandall Stewart 	TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
5069f8829a4aSRandall Stewart 		if (net->will_exit_fast_recovery) {
5070f8829a4aSRandall Stewart 			/* Ok, we must exit fast recovery */
5071f8829a4aSRandall Stewart 			net->fast_retran_loss_recovery = 0;
5072f8829a4aSRandall Stewart 		}
5073f8829a4aSRandall Stewart 	}
5074f8829a4aSRandall Stewart 
5075f8829a4aSRandall Stewart 	/* Adjust and set the new rwnd value */
5076b3f1ea41SRandall Stewart 	if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_RWND_ENABLE) {
5077f8829a4aSRandall Stewart 		sctp_log_rwnd_set(SCTP_SET_PEER_RWND_VIA_SACK,
507844fbe462SRandall Stewart 		    asoc->peers_rwnd, asoc->total_flight, (asoc->total_flight_count * SCTP_BASE_SYSCTL(sctp_peer_chunk_oh)), a_rwnd);
507980fefe0aSRandall Stewart 	}
5080f8829a4aSRandall Stewart 	asoc->peers_rwnd = sctp_sbspace_sub(a_rwnd,
508144fbe462SRandall Stewart 	    (uint32_t)(asoc->total_flight + (asoc->total_flight_count * SCTP_BASE_SYSCTL(sctp_peer_chunk_oh))));
5082f8829a4aSRandall Stewart 	if (asoc->peers_rwnd < stcb->sctp_ep->sctp_ep.sctp_sws_sender) {
5083f8829a4aSRandall Stewart 		/* SWS sender side engages */
5084f8829a4aSRandall Stewart 		asoc->peers_rwnd = 0;
5085f8829a4aSRandall Stewart 	}
50865e54f665SRandall Stewart 	if (asoc->peers_rwnd > old_rwnd) {
50875e54f665SRandall Stewart 		win_probe_recovery = 1;
50885e54f665SRandall Stewart 	}
50890053ed28SMichael Tuexen 
5090f8829a4aSRandall Stewart 	/*
5091f8829a4aSRandall Stewart 	 * Now we must setup so we have a timer up for anyone with
5092f8829a4aSRandall Stewart 	 * outstanding data.
5093f8829a4aSRandall Stewart 	 */
5094bff64a4dSRandall Stewart 	done_once = 0;
5095a5d547adSRandall Stewart again:
5096a5d547adSRandall Stewart 	j = 0;
5097f8829a4aSRandall Stewart 	TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
50985e54f665SRandall Stewart 		if (win_probe_recovery && (net->window_probe)) {
5099c105859eSRandall Stewart 			win_probe_recovered = 1;
51005e54f665SRandall Stewart 			/*-
51015e54f665SRandall Stewart 			 * Find first chunk that was used with
51025e54f665SRandall Stewart 			 * window probe and clear the event. Put
51035e54f665SRandall Stewart 			 * it back into the send queue as if has
51045e54f665SRandall Stewart 			 * not been sent.
51055e54f665SRandall Stewart 			 */
51065e54f665SRandall Stewart 			TAILQ_FOREACH(tp1, &asoc->sent_queue, sctp_next) {
51075e54f665SRandall Stewart 				if (tp1->window_probe) {
51087215cc1bSMichael Tuexen 					sctp_window_probe_recovery(stcb, asoc, tp1);
51095e54f665SRandall Stewart 					break;
51105e54f665SRandall Stewart 				}
51115e54f665SRandall Stewart 			}
51125e54f665SRandall Stewart 		}
5113f8829a4aSRandall Stewart 		if (net->flight_size) {
5114a5d547adSRandall Stewart 			j++;
5115cd554309SMichael Tuexen 			if (!SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer)) {
5116f8829a4aSRandall Stewart 				sctp_timer_start(SCTP_TIMER_TYPE_SEND,
5117f8829a4aSRandall Stewart 				    stcb->sctp_ep, stcb, net);
5118cd554309SMichael Tuexen 			}
51195171328bSRandall Stewart 			if (net->window_probe) {
5120cd554309SMichael Tuexen 				net->window_probe = 0;
51215171328bSRandall Stewart 			}
5122c105859eSRandall Stewart 		} else {
51235171328bSRandall Stewart 			if (net->window_probe) {
5124b7b84c0eSMichael Tuexen 				/*
5125b7b84c0eSMichael Tuexen 				 * In window probes we must assure a timer
5126b7b84c0eSMichael Tuexen 				 * is still running there
5127b7b84c0eSMichael Tuexen 				 */
51285171328bSRandall Stewart 				if (!SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer)) {
51295171328bSRandall Stewart 					sctp_timer_start(SCTP_TIMER_TYPE_SEND,
51305171328bSRandall Stewart 					    stcb->sctp_ep, stcb, net);
51315171328bSRandall Stewart 				}
51325171328bSRandall Stewart 			} else if (SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer)) {
5133c105859eSRandall Stewart 				sctp_timer_stop(SCTP_TIMER_TYPE_SEND, stcb->sctp_ep,
5134c105859eSRandall Stewart 				    stcb, net,
513591e04f9eSMichael Tuexen 				    SCTP_FROM_SCTP_INDATA + SCTP_LOC_36);
5136c105859eSRandall Stewart 			}
5137f8829a4aSRandall Stewart 		}
5138f8829a4aSRandall Stewart 	}
5139bff64a4dSRandall Stewart 	if ((j == 0) &&
5140bff64a4dSRandall Stewart 	    (!TAILQ_EMPTY(&asoc->sent_queue)) &&
5141bff64a4dSRandall Stewart 	    (asoc->sent_queue_retran_cnt == 0) &&
5142c105859eSRandall Stewart 	    (win_probe_recovered == 0) &&
5143bff64a4dSRandall Stewart 	    (done_once == 0)) {
51440c0982b8SRandall Stewart 		/*
51450c0982b8SRandall Stewart 		 * huh, this should not happen unless all packets are
51460c0982b8SRandall Stewart 		 * PR-SCTP and marked to skip of course.
51470c0982b8SRandall Stewart 		 */
51480c0982b8SRandall Stewart 		if (sctp_fs_audit(asoc)) {
5149a5d547adSRandall Stewart 			TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
5150a5d547adSRandall Stewart 				net->flight_size = 0;
5151a5d547adSRandall Stewart 			}
5152a5d547adSRandall Stewart 			asoc->total_flight = 0;
5153a5d547adSRandall Stewart 			asoc->total_flight_count = 0;
5154a5d547adSRandall Stewart 			asoc->sent_queue_retran_cnt = 0;
5155a5d547adSRandall Stewart 			TAILQ_FOREACH(tp1, &asoc->sent_queue, sctp_next) {
5156a5d547adSRandall Stewart 				if (tp1->sent < SCTP_DATAGRAM_RESEND) {
5157c105859eSRandall Stewart 					sctp_flight_size_increase(tp1);
5158c105859eSRandall Stewart 					sctp_total_flight_increase(stcb, tp1);
5159a5d547adSRandall Stewart 				} else if (tp1->sent == SCTP_DATAGRAM_RESEND) {
5160791437b5SRandall Stewart 					sctp_ucount_incr(asoc->sent_queue_retran_cnt);
5161a5d547adSRandall Stewart 				}
5162a5d547adSRandall Stewart 			}
51630c0982b8SRandall Stewart 		}
5164bff64a4dSRandall Stewart 		done_once = 1;
5165a5d547adSRandall Stewart 		goto again;
5166a5d547adSRandall Stewart 	}
5167cd554309SMichael Tuexen 	/*********************************************/
5168cd554309SMichael Tuexen 	/* Here we perform PR-SCTP procedures        */
5169cd554309SMichael Tuexen 	/* (section 4.2)                             */
5170cd554309SMichael Tuexen 	/*********************************************/
5171cd554309SMichael Tuexen 	/* C1. update advancedPeerAckPoint */
517220b07a4dSMichael Tuexen 	if (SCTP_TSN_GT(cum_ack, asoc->advanced_peer_ack_point)) {
5173dfb11ef8SRandall Stewart 		asoc->advanced_peer_ack_point = cum_ack;
5174dfb11ef8SRandall Stewart 	}
5175830d754dSRandall Stewart 	/* C2. try to further move advancedPeerAckPoint ahead */
5176dd973b0eSMichael Tuexen 	if ((asoc->prsctp_supported) && (asoc->pr_sctp_cnt > 0)) {
5177830d754dSRandall Stewart 		struct sctp_tmit_chunk *lchk;
5178830d754dSRandall Stewart 		uint32_t old_adv_peer_ack_point;
5179830d754dSRandall Stewart 
5180830d754dSRandall Stewart 		old_adv_peer_ack_point = asoc->advanced_peer_ack_point;
5181830d754dSRandall Stewart 		lchk = sctp_try_advance_peer_ack_point(stcb, asoc);
5182830d754dSRandall Stewart 		/* C3. See if we need to send a Fwd-TSN */
518320b07a4dSMichael Tuexen 		if (SCTP_TSN_GT(asoc->advanced_peer_ack_point, cum_ack)) {
5184830d754dSRandall Stewart 			/*
5185493d8e5aSRandall Stewart 			 * ISSUE with ECN, see FWD-TSN processing.
5186830d754dSRandall Stewart 			 */
51870c0982b8SRandall Stewart 			if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_TRY_ADVANCE) {
51880c0982b8SRandall Stewart 				sctp_misc_ints(SCTP_FWD_TSN_CHECK,
51890c0982b8SRandall Stewart 				    0xee, cum_ack, asoc->advanced_peer_ack_point,
51900c0982b8SRandall Stewart 				    old_adv_peer_ack_point);
51910c0982b8SRandall Stewart 			}
519220b07a4dSMichael Tuexen 			if (SCTP_TSN_GT(asoc->advanced_peer_ack_point, old_adv_peer_ack_point)) {
5193830d754dSRandall Stewart 				send_forward_tsn(stcb, asoc);
51940c0982b8SRandall Stewart 			} else if (lchk) {
51950c0982b8SRandall Stewart 				/* try to FR fwd-tsn's that get lost too */
519644fbe462SRandall Stewart 				if (lchk->rec.data.fwd_tsn_cnt >= 3) {
51970c0982b8SRandall Stewart 					send_forward_tsn(stcb, asoc);
51980c0982b8SRandall Stewart 				}
5199830d754dSRandall Stewart 			}
5200830d754dSRandall Stewart 		}
5201efd5e692SMichael Tuexen 		for (; lchk != NULL; lchk = TAILQ_NEXT(lchk, sctp_next)) {
5202efd5e692SMichael Tuexen 			if (lchk->whoTo != NULL) {
5203efd5e692SMichael Tuexen 				break;
5204efd5e692SMichael Tuexen 			}
5205efd5e692SMichael Tuexen 		}
5206efd5e692SMichael Tuexen 		if (lchk != NULL) {
5207830d754dSRandall Stewart 			/* Assure a timer is up */
5208830d754dSRandall Stewart 			sctp_timer_start(SCTP_TIMER_TYPE_SEND,
5209830d754dSRandall Stewart 			    stcb->sctp_ep, stcb, lchk->whoTo);
5210830d754dSRandall Stewart 		}
5211830d754dSRandall Stewart 	}
5212b3f1ea41SRandall Stewart 	if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_SACK_RWND_LOGGING_ENABLE) {
5213f8829a4aSRandall Stewart 		sctp_misc_ints(SCTP_SACK_RWND_UPDATE,
5214f8829a4aSRandall Stewart 		    a_rwnd,
5215f8829a4aSRandall Stewart 		    stcb->asoc.peers_rwnd,
5216f8829a4aSRandall Stewart 		    stcb->asoc.total_flight,
5217f8829a4aSRandall Stewart 		    stcb->asoc.total_output_queue_size);
521880fefe0aSRandall Stewart 	}
5219f8829a4aSRandall Stewart }
5220f8829a4aSRandall Stewart 
5221f8829a4aSRandall Stewart void
52227215cc1bSMichael Tuexen sctp_update_acked(struct sctp_tcb *stcb, struct sctp_shutdown_chunk *cp, int *abort_flag)
5223f8829a4aSRandall Stewart {
5224f8829a4aSRandall Stewart 	/* Copy cum-ack */
5225f8829a4aSRandall Stewart 	uint32_t cum_ack, a_rwnd;
5226f8829a4aSRandall Stewart 
5227f8829a4aSRandall Stewart 	cum_ack = ntohl(cp->cumulative_tsn_ack);
5228f8829a4aSRandall Stewart 	/* Arrange so a_rwnd does NOT change */
5229f8829a4aSRandall Stewart 	a_rwnd = stcb->asoc.peers_rwnd + stcb->asoc.total_flight;
5230f8829a4aSRandall Stewart 
5231f8829a4aSRandall Stewart 	/* Now call the express sack handling */
5232899288aeSRandall Stewart 	sctp_express_handle_sack(stcb, cum_ack, a_rwnd, abort_flag, 0);
5233f8829a4aSRandall Stewart }
5234f8829a4aSRandall Stewart 
5235f8829a4aSRandall Stewart static void
5236f8829a4aSRandall Stewart sctp_kick_prsctp_reorder_queue(struct sctp_tcb *stcb,
5237f8829a4aSRandall Stewart     struct sctp_stream_in *strmin)
5238f8829a4aSRandall Stewart {
523928cd0699SMichael Tuexen 	struct sctp_queued_to_read *control, *ncontrol;
5240f8829a4aSRandall Stewart 	struct sctp_association *asoc;
524149656eefSMichael Tuexen 	uint32_t mid;
524249656eefSMichael Tuexen 	int need_reasm_check = 0;
5243f8829a4aSRandall Stewart 
5244*0d15140dSMichael Tuexen 	KASSERT(stcb != NULL, ("stcb == NULL"));
5245*0d15140dSMichael Tuexen 	SCTP_TCB_LOCK_ASSERT(stcb);
5246*0d15140dSMichael Tuexen 	SCTP_INP_READ_LOCK_ASSERT(stcb->sctp_ep);
5247*0d15140dSMichael Tuexen 
5248f8829a4aSRandall Stewart 	asoc = &stcb->asoc;
524949656eefSMichael Tuexen 	mid = strmin->last_mid_delivered;
5250f8829a4aSRandall Stewart 	/*
5251f8829a4aSRandall Stewart 	 * First deliver anything prior to and including the stream no that
525244249214SRandall Stewart 	 * came in.
5253f8829a4aSRandall Stewart 	 */
525428cd0699SMichael Tuexen 	TAILQ_FOREACH_SAFE(control, &strmin->inqueue, next_instrm, ncontrol) {
525528cd0699SMichael Tuexen 		if (SCTP_MID_GE(asoc->idata_supported, mid, control->mid)) {
5256f8829a4aSRandall Stewart 			/* this is deliverable now */
525728cd0699SMichael Tuexen 			if (((control->sinfo_flags >> 8) & SCTP_DATA_NOT_FRAG) == SCTP_DATA_NOT_FRAG) {
525828cd0699SMichael Tuexen 				if (control->on_strm_q) {
525928cd0699SMichael Tuexen 					if (control->on_strm_q == SCTP_ON_ORDERED) {
526028cd0699SMichael Tuexen 						TAILQ_REMOVE(&strmin->inqueue, control, next_instrm);
526128cd0699SMichael Tuexen 					} else if (control->on_strm_q == SCTP_ON_UNORDERED) {
526228cd0699SMichael Tuexen 						TAILQ_REMOVE(&strmin->uno_inqueue, control, next_instrm);
526398d5fd97SMichael Tuexen #ifdef INVARIANTS
526444249214SRandall Stewart 					} else {
526544249214SRandall Stewart 						panic("strmin: %p ctl: %p unknown %d",
526628cd0699SMichael Tuexen 						    strmin, control, control->on_strm_q);
526798d5fd97SMichael Tuexen #endif
526844249214SRandall Stewart 					}
526928cd0699SMichael Tuexen 					control->on_strm_q = 0;
527044249214SRandall Stewart 				}
5271f8829a4aSRandall Stewart 				/* subtract pending on streams */
527228cd0699SMichael Tuexen 				if (asoc->size_on_all_streams >= control->length) {
527328cd0699SMichael Tuexen 					asoc->size_on_all_streams -= control->length;
527428cd0699SMichael Tuexen 				} else {
527528cd0699SMichael Tuexen #ifdef INVARIANTS
527628cd0699SMichael Tuexen 					panic("size_on_all_streams = %u smaller than control length %u", asoc->size_on_all_streams, control->length);
527728cd0699SMichael Tuexen #else
527828cd0699SMichael Tuexen 					asoc->size_on_all_streams = 0;
527928cd0699SMichael Tuexen #endif
528028cd0699SMichael Tuexen 				}
5281f8829a4aSRandall Stewart 				sctp_ucount_decr(asoc->cnt_on_all_streams);
5282f8829a4aSRandall Stewart 				/* deliver it to at least the delivery-q */
5283f8829a4aSRandall Stewart 				if (stcb->sctp_socket) {
528428cd0699SMichael Tuexen 					sctp_mark_non_revokable(asoc, control->sinfo_tsn);
5285*0d15140dSMichael Tuexen 					sctp_add_to_readq(stcb->sctp_ep, stcb, control,
5286*0d15140dSMichael Tuexen 					    &stcb->sctp_socket->so_rcv, 1,
5287*0d15140dSMichael Tuexen 					    SCTP_READ_LOCK_HELD, SCTP_SO_NOT_LOCKED);
528844249214SRandall Stewart 				}
528944249214SRandall Stewart 			} else {
529044249214SRandall Stewart 				/* Its a fragmented message */
529128cd0699SMichael Tuexen 				if (control->first_frag_seen) {
5292b7b84c0eSMichael Tuexen 					/*
5293b7b84c0eSMichael Tuexen 					 * Make it so this is next to
5294b7b84c0eSMichael Tuexen 					 * deliver, we restore later
5295b7b84c0eSMichael Tuexen 					 */
529628cd0699SMichael Tuexen 					strmin->last_mid_delivered = control->mid - 1;
529744249214SRandall Stewart 					need_reasm_check = 1;
529844249214SRandall Stewart 					break;
529944249214SRandall Stewart 				}
5300f8829a4aSRandall Stewart 			}
5301f8829a4aSRandall Stewart 		} else {
5302f8829a4aSRandall Stewart 			/* no more delivery now. */
5303f8829a4aSRandall Stewart 			break;
5304f8829a4aSRandall Stewart 		}
5305f8829a4aSRandall Stewart 	}
530644249214SRandall Stewart 	if (need_reasm_check) {
530744249214SRandall Stewart 		int ret;
530844249214SRandall Stewart 
5309d1ea5fa9SMichael Tuexen 		ret = sctp_deliver_reasm_check(stcb, &stcb->asoc, strmin, SCTP_READ_LOCK_HELD);
531049656eefSMichael Tuexen 		if (SCTP_MID_GT(asoc->idata_supported, mid, strmin->last_mid_delivered)) {
531144249214SRandall Stewart 			/* Restore the next to deliver unless we are ahead */
531249656eefSMichael Tuexen 			strmin->last_mid_delivered = mid;
531344249214SRandall Stewart 		}
531444249214SRandall Stewart 		if (ret == 0) {
531544249214SRandall Stewart 			/* Left the front Partial one on */
531644249214SRandall Stewart 			return;
531744249214SRandall Stewart 		}
531844249214SRandall Stewart 		need_reasm_check = 0;
531944249214SRandall Stewart 	}
5320f8829a4aSRandall Stewart 	/*
5321f8829a4aSRandall Stewart 	 * now we must deliver things in queue the normal way  if any are
5322f8829a4aSRandall Stewart 	 * now ready.
5323f8829a4aSRandall Stewart 	 */
532449656eefSMichael Tuexen 	mid = strmin->last_mid_delivered + 1;
532528cd0699SMichael Tuexen 	TAILQ_FOREACH_SAFE(control, &strmin->inqueue, next_instrm, ncontrol) {
532628cd0699SMichael Tuexen 		if (SCTP_MID_EQ(asoc->idata_supported, mid, control->mid)) {
532728cd0699SMichael Tuexen 			if (((control->sinfo_flags >> 8) & SCTP_DATA_NOT_FRAG) == SCTP_DATA_NOT_FRAG) {
5328f8829a4aSRandall Stewart 				/* this is deliverable now */
532928cd0699SMichael Tuexen 				if (control->on_strm_q) {
533028cd0699SMichael Tuexen 					if (control->on_strm_q == SCTP_ON_ORDERED) {
533128cd0699SMichael Tuexen 						TAILQ_REMOVE(&strmin->inqueue, control, next_instrm);
533228cd0699SMichael Tuexen 					} else if (control->on_strm_q == SCTP_ON_UNORDERED) {
533328cd0699SMichael Tuexen 						TAILQ_REMOVE(&strmin->uno_inqueue, control, next_instrm);
533498d5fd97SMichael Tuexen #ifdef INVARIANTS
533544249214SRandall Stewart 					} else {
533644249214SRandall Stewart 						panic("strmin: %p ctl: %p unknown %d",
533728cd0699SMichael Tuexen 						    strmin, control, control->on_strm_q);
533898d5fd97SMichael Tuexen #endif
533944249214SRandall Stewart 					}
534028cd0699SMichael Tuexen 					control->on_strm_q = 0;
534144249214SRandall Stewart 				}
5342f8829a4aSRandall Stewart 				/* subtract pending on streams */
534328cd0699SMichael Tuexen 				if (asoc->size_on_all_streams >= control->length) {
534428cd0699SMichael Tuexen 					asoc->size_on_all_streams -= control->length;
534528cd0699SMichael Tuexen 				} else {
534628cd0699SMichael Tuexen #ifdef INVARIANTS
534728cd0699SMichael Tuexen 					panic("size_on_all_streams = %u smaller than control length %u", asoc->size_on_all_streams, control->length);
534828cd0699SMichael Tuexen #else
534928cd0699SMichael Tuexen 					asoc->size_on_all_streams = 0;
535028cd0699SMichael Tuexen #endif
535128cd0699SMichael Tuexen 				}
5352f8829a4aSRandall Stewart 				sctp_ucount_decr(asoc->cnt_on_all_streams);
5353f8829a4aSRandall Stewart 				/* deliver it to at least the delivery-q */
535428cd0699SMichael Tuexen 				strmin->last_mid_delivered = control->mid;
5355f8829a4aSRandall Stewart 				if (stcb->sctp_socket) {
535628cd0699SMichael Tuexen 					sctp_mark_non_revokable(asoc, control->sinfo_tsn);
5357*0d15140dSMichael Tuexen 					sctp_add_to_readq(stcb->sctp_ep, stcb, control,
535844249214SRandall Stewart 					    &stcb->sctp_socket->so_rcv, 1,
535944249214SRandall Stewart 					    SCTP_READ_LOCK_HELD, SCTP_SO_NOT_LOCKED);
5360f8829a4aSRandall Stewart 				}
536149656eefSMichael Tuexen 				mid = strmin->last_mid_delivered + 1;
5362f8829a4aSRandall Stewart 			} else {
536344249214SRandall Stewart 				/* Its a fragmented message */
536428cd0699SMichael Tuexen 				if (control->first_frag_seen) {
5365b7b84c0eSMichael Tuexen 					/*
5366b7b84c0eSMichael Tuexen 					 * Make it so this is next to
5367b7b84c0eSMichael Tuexen 					 * deliver
5368b7b84c0eSMichael Tuexen 					 */
536928cd0699SMichael Tuexen 					strmin->last_mid_delivered = control->mid - 1;
537044249214SRandall Stewart 					need_reasm_check = 1;
5371f8829a4aSRandall Stewart 					break;
5372f8829a4aSRandall Stewart 				}
5373f8829a4aSRandall Stewart 			}
537444249214SRandall Stewart 		} else {
537544249214SRandall Stewart 			break;
537644249214SRandall Stewart 		}
537744249214SRandall Stewart 	}
537844249214SRandall Stewart 	if (need_reasm_check) {
5379d1ea5fa9SMichael Tuexen 		(void)sctp_deliver_reasm_check(stcb, &stcb->asoc, strmin, SCTP_READ_LOCK_HELD);
538044249214SRandall Stewart 	}
5381f8829a4aSRandall Stewart }
5382f8829a4aSRandall Stewart 
53838933fa13SRandall Stewart static void
53848933fa13SRandall Stewart sctp_flush_reassm_for_str_seq(struct sctp_tcb *stcb,
5385b6734d8fSMichael Tuexen     struct sctp_association *asoc, struct sctp_stream_in *strm,
5386b6734d8fSMichael Tuexen     struct sctp_queued_to_read *control, int ordered, uint32_t cumtsn)
53878933fa13SRandall Stewart {
53884a9ef3f8SMichael Tuexen 	struct sctp_tmit_chunk *chk, *nchk;
53898933fa13SRandall Stewart 
53908933fa13SRandall Stewart 	/*
539144249214SRandall Stewart 	 * For now large messages held on the stream reasm that are complete
53924a9ef3f8SMichael Tuexen 	 * will be tossed too. We could in theory do more work to spin
53934a9ef3f8SMichael Tuexen 	 * through and stop after dumping one msg aka seeing the start of a
53944a9ef3f8SMichael Tuexen 	 * new msg at the head, and call the delivery function... to see if
53954a9ef3f8SMichael Tuexen 	 * it can be delivered... But for now we just dump everything on the
53964a9ef3f8SMichael Tuexen 	 * queue.
53978933fa13SRandall Stewart 	 */
5398*0d15140dSMichael Tuexen 
5399*0d15140dSMichael Tuexen 	KASSERT(stcb != NULL, ("stcb == NULL"));
5400*0d15140dSMichael Tuexen 	SCTP_TCB_LOCK_ASSERT(stcb);
5401*0d15140dSMichael Tuexen 	SCTP_INP_READ_LOCK_ASSERT(stcb->sctp_ep);
5402*0d15140dSMichael Tuexen 
54038f269b82SMichael Tuexen 	if (!asoc->idata_supported && !ordered &&
54048f269b82SMichael Tuexen 	    control->first_frag_seen &&
54058f269b82SMichael Tuexen 	    SCTP_TSN_GT(control->fsn_included, cumtsn)) {
54065cb91655SMichael Tuexen 		return;
54075cb91655SMichael Tuexen 	}
540844249214SRandall Stewart 	TAILQ_FOREACH_SAFE(chk, &control->reasm, sctp_next, nchk) {
540944249214SRandall Stewart 		/* Purge hanging chunks */
54101d1b4bceSMichael Tuexen 		if (!asoc->idata_supported && !ordered) {
541149656eefSMichael Tuexen 			if (SCTP_TSN_GT(chk->rec.data.tsn, cumtsn)) {
5412d1ea5fa9SMichael Tuexen 				break;
5413d1ea5fa9SMichael Tuexen 			}
5414d1ea5fa9SMichael Tuexen 		}
541544249214SRandall Stewart 		TAILQ_REMOVE(&control->reasm, chk, sctp_next);
541628cd0699SMichael Tuexen 		if (asoc->size_on_reasm_queue >= chk->send_size) {
54178933fa13SRandall Stewart 			asoc->size_on_reasm_queue -= chk->send_size;
541828cd0699SMichael Tuexen 		} else {
541928cd0699SMichael Tuexen #ifdef INVARIANTS
542028cd0699SMichael Tuexen 			panic("size_on_reasm_queue = %u smaller than chunk length %u", asoc->size_on_reasm_queue, chk->send_size);
542128cd0699SMichael Tuexen #else
542228cd0699SMichael Tuexen 			asoc->size_on_reasm_queue = 0;
542328cd0699SMichael Tuexen #endif
542428cd0699SMichael Tuexen 		}
54258933fa13SRandall Stewart 		sctp_ucount_decr(asoc->cnt_on_reasm_queue);
54268933fa13SRandall Stewart 		if (chk->data) {
54278933fa13SRandall Stewart 			sctp_m_freem(chk->data);
54288933fa13SRandall Stewart 			chk->data = NULL;
54298933fa13SRandall Stewart 		}
5430689e6a5fSMichael Tuexen 		sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
54318933fa13SRandall Stewart 	}
5432d1ea5fa9SMichael Tuexen 	if (!TAILQ_EMPTY(&control->reasm)) {
5433d1ea5fa9SMichael Tuexen 		/* This has to be old data, unordered */
5434d1ea5fa9SMichael Tuexen 		if (control->data) {
5435d1ea5fa9SMichael Tuexen 			sctp_m_freem(control->data);
5436d1ea5fa9SMichael Tuexen 			control->data = NULL;
5437d1ea5fa9SMichael Tuexen 		}
5438d1ea5fa9SMichael Tuexen 		sctp_reset_a_control(control, stcb->sctp_ep, cumtsn);
5439d1ea5fa9SMichael Tuexen 		chk = TAILQ_FIRST(&control->reasm);
5440d1ea5fa9SMichael Tuexen 		if (chk->rec.data.rcv_flags & SCTP_DATA_FIRST_FRAG) {
5441d1ea5fa9SMichael Tuexen 			TAILQ_REMOVE(&control->reasm, chk, sctp_next);
5442d1ea5fa9SMichael Tuexen 			sctp_add_chk_to_control(control, strm, stcb, asoc,
5443d1ea5fa9SMichael Tuexen 			    chk, SCTP_READ_LOCK_HELD);
5444d1ea5fa9SMichael Tuexen 		}
5445d1ea5fa9SMichael Tuexen 		sctp_deliver_reasm_check(stcb, asoc, strm, SCTP_READ_LOCK_HELD);
5446d1ea5fa9SMichael Tuexen 		return;
5447d1ea5fa9SMichael Tuexen 	}
5448d1ea5fa9SMichael Tuexen 	if (control->on_strm_q == SCTP_ON_ORDERED) {
544944249214SRandall Stewart 		TAILQ_REMOVE(&strm->inqueue, control, next_instrm);
545028cd0699SMichael Tuexen 		if (asoc->size_on_all_streams >= control->length) {
545128cd0699SMichael Tuexen 			asoc->size_on_all_streams -= control->length;
545228cd0699SMichael Tuexen 		} else {
545328cd0699SMichael Tuexen #ifdef INVARIANTS
545428cd0699SMichael Tuexen 			panic("size_on_all_streams = %u smaller than control length %u", asoc->size_on_all_streams, control->length);
545528cd0699SMichael Tuexen #else
545628cd0699SMichael Tuexen 			asoc->size_on_all_streams = 0;
545728cd0699SMichael Tuexen #endif
545828cd0699SMichael Tuexen 		}
545928cd0699SMichael Tuexen 		sctp_ucount_decr(asoc->cnt_on_all_streams);
5460d1ea5fa9SMichael Tuexen 		control->on_strm_q = 0;
5461d1ea5fa9SMichael Tuexen 	} else if (control->on_strm_q == SCTP_ON_UNORDERED) {
5462d1ea5fa9SMichael Tuexen 		TAILQ_REMOVE(&strm->uno_inqueue, control, next_instrm);
5463d1ea5fa9SMichael Tuexen 		control->on_strm_q = 0;
5464d1ea5fa9SMichael Tuexen #ifdef INVARIANTS
5465d1ea5fa9SMichael Tuexen 	} else if (control->on_strm_q) {
5466d1ea5fa9SMichael Tuexen 		panic("strm: %p ctl: %p unknown %d",
5467d1ea5fa9SMichael Tuexen 		    strm, control, control->on_strm_q);
5468d1ea5fa9SMichael Tuexen #endif
5469d1ea5fa9SMichael Tuexen 	}
5470d1ea5fa9SMichael Tuexen 	control->on_strm_q = 0;
547144249214SRandall Stewart 	if (control->on_read_q == 0) {
547244249214SRandall Stewart 		sctp_free_remote_addr(control->whoFrom);
547344249214SRandall Stewart 		if (control->data) {
547444249214SRandall Stewart 			sctp_m_freem(control->data);
547544249214SRandall Stewart 			control->data = NULL;
547644249214SRandall Stewart 		}
547744249214SRandall Stewart 		sctp_free_a_readq(stcb, control);
54788933fa13SRandall Stewart 	}
54798933fa13SRandall Stewart }
54808933fa13SRandall Stewart 
5481f8829a4aSRandall Stewart void
5482f8829a4aSRandall Stewart sctp_handle_forward_tsn(struct sctp_tcb *stcb,
5483b5c16493SMichael Tuexen     struct sctp_forward_tsn_chunk *fwd,
5484b5c16493SMichael Tuexen     int *abort_flag, struct mbuf *m, int offset)
5485f8829a4aSRandall Stewart {
5486f8829a4aSRandall Stewart 	/* The pr-sctp fwd tsn */
5487f8829a4aSRandall Stewart 	/*
5488f8829a4aSRandall Stewart 	 * here we will perform all the data receiver side steps for
5489f8829a4aSRandall Stewart 	 * processing FwdTSN, as required in by pr-sctp draft:
5490f8829a4aSRandall Stewart 	 *
5491f8829a4aSRandall Stewart 	 * Assume we get FwdTSN(x):
5492f8829a4aSRandall Stewart 	 *
54935b495f17SMichael Tuexen 	 * 1) update local cumTSN to x 2) try to further advance cumTSN to x
54945b495f17SMichael Tuexen 	 * + others we have 3) examine and update re-ordering queue on
5495f8829a4aSRandall Stewart 	 * pr-in-streams 4) clean up re-assembly queue 5) Send a sack to
5496f8829a4aSRandall Stewart 	 * report where we are.
5497f8829a4aSRandall Stewart 	 */
5498f8829a4aSRandall Stewart 	struct sctp_association *asoc;
54997898f408SRandall Stewart 	uint32_t new_cum_tsn, gap;
55007215cc1bSMichael Tuexen 	unsigned int i, fwd_sz, m_size;
5501f8829a4aSRandall Stewart 	struct sctp_stream_in *strm;
5502749a7fb5SMichael Tuexen 	struct sctp_queued_to_read *control, *ncontrol;
5503f8829a4aSRandall Stewart 
5504f8829a4aSRandall Stewart 	asoc = &stcb->asoc;
5505f8829a4aSRandall Stewart 	if ((fwd_sz = ntohs(fwd->ch.chunk_length)) < sizeof(struct sctp_forward_tsn_chunk)) {
5506ad81507eSRandall Stewart 		SCTPDBG(SCTP_DEBUG_INDATA1,
5507ad81507eSRandall Stewart 		    "Bad size too small/big fwd-tsn\n");
5508f8829a4aSRandall Stewart 		return;
5509f8829a4aSRandall Stewart 	}
5510f8829a4aSRandall Stewart 	m_size = (stcb->asoc.mapping_array_size << 3);
5511f8829a4aSRandall Stewart 	/*************************************************************/
5512f8829a4aSRandall Stewart 	/* 1. Here we update local cumTSN and shift the bitmap array */
5513f8829a4aSRandall Stewart 	/*************************************************************/
5514f8829a4aSRandall Stewart 	new_cum_tsn = ntohl(fwd->new_cumulative_tsn);
5515f8829a4aSRandall Stewart 
551620b07a4dSMichael Tuexen 	if (SCTP_TSN_GE(asoc->cumulative_tsn, new_cum_tsn)) {
5517f8829a4aSRandall Stewart 		/* Already got there ... */
5518f8829a4aSRandall Stewart 		return;
5519f8829a4aSRandall Stewart 	}
5520f8829a4aSRandall Stewart 	/*
5521f8829a4aSRandall Stewart 	 * now we know the new TSN is more advanced, let's find the actual
5522f8829a4aSRandall Stewart 	 * gap
5523f8829a4aSRandall Stewart 	 */
5524b5c16493SMichael Tuexen 	SCTP_CALC_TSN_TO_GAP(gap, new_cum_tsn, asoc->mapping_array_base_tsn);
552577acdc25SRandall Stewart 	asoc->cumulative_tsn = new_cum_tsn;
55262afb3e84SRandall Stewart 	if (gap >= m_size) {
5527f8829a4aSRandall Stewart 		if ((long)gap > sctp_sbspace(&stcb->asoc, &stcb->sctp_socket->so_rcv)) {
5528ff1ffd74SMichael Tuexen 			struct mbuf *op_err;
5529ff1ffd74SMichael Tuexen 			char msg[SCTP_DIAG_INFO_LEN];
553017205eccSRandall Stewart 
5531f8829a4aSRandall Stewart 			/*
5532f8829a4aSRandall Stewart 			 * out of range (of single byte chunks in the rwnd I
553317205eccSRandall Stewart 			 * give out). This must be an attacker.
5534f8829a4aSRandall Stewart 			 */
553517205eccSRandall Stewart 			*abort_flag = 1;
5536999f86d6SMichael Tuexen 			SCTP_SNPRINTF(msg, sizeof(msg),
5537ff1ffd74SMichael Tuexen 			    "New cum ack %8.8x too high, highest TSN %8.8x",
5538821bae7cSMichael Tuexen 			    new_cum_tsn, asoc->highest_tsn_inside_map);
5539ff1ffd74SMichael Tuexen 			op_err = sctp_generate_cause(SCTP_CAUSE_PROTOCOL_VIOLATION, msg);
554091e04f9eSMichael Tuexen 			stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_37;
5541105b68b4SMichael Tuexen 			sctp_abort_an_association(stcb->sctp_ep, stcb, op_err, false, SCTP_SO_NOT_LOCKED);
5542f8829a4aSRandall Stewart 			return;
5543f8829a4aSRandall Stewart 		}
5544207304d4SRandall Stewart 		SCTP_STAT_INCR(sctps_fwdtsn_map_over);
554577acdc25SRandall Stewart 
55462afb3e84SRandall Stewart 		memset(stcb->asoc.mapping_array, 0, stcb->asoc.mapping_array_size);
55472afb3e84SRandall Stewart 		asoc->mapping_array_base_tsn = new_cum_tsn + 1;
554877acdc25SRandall Stewart 		asoc->highest_tsn_inside_map = new_cum_tsn;
554977acdc25SRandall Stewart 
5550b5c16493SMichael Tuexen 		memset(stcb->asoc.nr_mapping_array, 0, stcb->asoc.mapping_array_size);
5551830d754dSRandall Stewart 		asoc->highest_tsn_inside_nr_map = new_cum_tsn;
555277acdc25SRandall Stewart 
5553b3f1ea41SRandall Stewart 		if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MAP_LOGGING_ENABLE) {
5554f8829a4aSRandall Stewart 			sctp_log_map(0, 3, asoc->highest_tsn_inside_map, SCTP_MAP_SLIDE_RESULT);
555580fefe0aSRandall Stewart 		}
55562afb3e84SRandall Stewart 	} else {
55572afb3e84SRandall Stewart 		SCTP_TCB_LOCK_ASSERT(stcb);
55582afb3e84SRandall Stewart 		for (i = 0; i <= gap; i++) {
55597898f408SRandall Stewart 			if (!SCTP_IS_TSN_PRESENT(asoc->mapping_array, i) &&
55607898f408SRandall Stewart 			    !SCTP_IS_TSN_PRESENT(asoc->nr_mapping_array, i)) {
55618933fa13SRandall Stewart 				SCTP_SET_TSN_PRESENT(asoc->nr_mapping_array, i);
556220b07a4dSMichael Tuexen 				if (SCTP_TSN_GT(asoc->mapping_array_base_tsn + i, asoc->highest_tsn_inside_nr_map)) {
55637898f408SRandall Stewart 					asoc->highest_tsn_inside_nr_map = asoc->mapping_array_base_tsn + i;
5564b5c16493SMichael Tuexen 				}
5565b5c16493SMichael Tuexen 			}
5566b5c16493SMichael Tuexen 		}
5567f8829a4aSRandall Stewart 	}
5568f8829a4aSRandall Stewart 	/*************************************************************/
5569f8829a4aSRandall Stewart 	/* 2. Clear up re-assembly queue                             */
5570f8829a4aSRandall Stewart 	/*************************************************************/
5571f8829a4aSRandall Stewart 
557244249214SRandall Stewart 	/* This is now done as part of clearing up the stream/seq */
5573d1ea5fa9SMichael Tuexen 	if (asoc->idata_supported == 0) {
5574d1ea5fa9SMichael Tuexen 		uint16_t sid;
557544249214SRandall Stewart 
5576d1ea5fa9SMichael Tuexen 		/* Flush all the un-ordered data based on cum-tsn */
5577d1ea5fa9SMichael Tuexen 		SCTP_INP_READ_LOCK(stcb->sctp_ep);
5578d1ea5fa9SMichael Tuexen 		for (sid = 0; sid < asoc->streamincnt; sid++) {
5579b6734d8fSMichael Tuexen 			strm = &asoc->strmin[sid];
5580b6734d8fSMichael Tuexen 			if (!TAILQ_EMPTY(&strm->uno_inqueue)) {
5581b6734d8fSMichael Tuexen 				sctp_flush_reassm_for_str_seq(stcb, asoc, strm, TAILQ_FIRST(&strm->uno_inqueue), 0, new_cum_tsn);
5582b6734d8fSMichael Tuexen 			}
5583d1ea5fa9SMichael Tuexen 		}
5584d1ea5fa9SMichael Tuexen 		SCTP_INP_READ_UNLOCK(stcb->sctp_ep);
5585d1ea5fa9SMichael Tuexen 	}
55868933fa13SRandall Stewart 	/*******************************************************/
55878933fa13SRandall Stewart 	/* 3. Update the PR-stream re-ordering queues and fix  */
55888933fa13SRandall Stewart 	/* delivery issues as needed.                       */
55898933fa13SRandall Stewart 	/*******************************************************/
5590f8829a4aSRandall Stewart 	fwd_sz -= sizeof(*fwd);
5591671d309cSRandall Stewart 	if (m && fwd_sz) {
5592f8829a4aSRandall Stewart 		/* New method. */
5593d61a0ae0SRandall Stewart 		unsigned int num_str;
5594b6734d8fSMichael Tuexen 		uint32_t mid;
559549656eefSMichael Tuexen 		uint16_t sid;
55968e1b295fSMichael Tuexen 		uint16_t ordered, flags;
5597671d309cSRandall Stewart 		struct sctp_strseq *stseq, strseqbuf;
559844249214SRandall Stewart 		struct sctp_strseq_mid *stseq_m, strseqbuf_m;
5599671d309cSRandall Stewart 
5600671d309cSRandall Stewart 		offset += sizeof(*fwd);
5601f8829a4aSRandall Stewart 
56028933fa13SRandall Stewart 		SCTP_INP_READ_LOCK(stcb->sctp_ep);
560344249214SRandall Stewart 		if (asoc->idata_supported) {
560444249214SRandall Stewart 			num_str = fwd_sz / sizeof(struct sctp_strseq_mid);
560544249214SRandall Stewart 		} else {
5606f8829a4aSRandall Stewart 			num_str = fwd_sz / sizeof(struct sctp_strseq);
560744249214SRandall Stewart 		}
5608f8829a4aSRandall Stewart 		for (i = 0; i < num_str; i++) {
560944249214SRandall Stewart 			if (asoc->idata_supported) {
561044249214SRandall Stewart 				stseq_m = (struct sctp_strseq_mid *)sctp_m_getptr(m, offset,
561144249214SRandall Stewart 				    sizeof(struct sctp_strseq_mid),
561244249214SRandall Stewart 				    (uint8_t *)&strseqbuf_m);
561344249214SRandall Stewart 				offset += sizeof(struct sctp_strseq_mid);
561444249214SRandall Stewart 				if (stseq_m == NULL) {
561544249214SRandall Stewart 					break;
561644249214SRandall Stewart 				}
561749656eefSMichael Tuexen 				sid = ntohs(stseq_m->sid);
561849656eefSMichael Tuexen 				mid = ntohl(stseq_m->mid);
56198e1b295fSMichael Tuexen 				flags = ntohs(stseq_m->flags);
56208e1b295fSMichael Tuexen 				if (flags & PR_SCTP_UNORDERED_FLAG) {
56218e1b295fSMichael Tuexen 					ordered = 0;
56228e1b295fSMichael Tuexen 				} else {
56238e1b295fSMichael Tuexen 					ordered = 1;
56248e1b295fSMichael Tuexen 				}
562544249214SRandall Stewart 			} else {
5626671d309cSRandall Stewart 				stseq = (struct sctp_strseq *)sctp_m_getptr(m, offset,
5627671d309cSRandall Stewart 				    sizeof(struct sctp_strseq),
5628671d309cSRandall Stewart 				    (uint8_t *)&strseqbuf);
5629671d309cSRandall Stewart 				offset += sizeof(struct sctp_strseq);
56302afb3e84SRandall Stewart 				if (stseq == NULL) {
5631671d309cSRandall Stewart 					break;
56322afb3e84SRandall Stewart 				}
563349656eefSMichael Tuexen 				sid = ntohs(stseq->sid);
563449656eefSMichael Tuexen 				mid = (uint32_t)ntohs(stseq->ssn);
56358e1b295fSMichael Tuexen 				ordered = 1;
563644249214SRandall Stewart 			}
5637f8829a4aSRandall Stewart 			/* Convert */
56388933fa13SRandall Stewart 
5639f8829a4aSRandall Stewart 			/* now process */
56408933fa13SRandall Stewart 
56418933fa13SRandall Stewart 			/*
56428933fa13SRandall Stewart 			 * Ok we now look for the stream/seq on the read
56438933fa13SRandall Stewart 			 * queue where its not all delivered. If we find it
56448933fa13SRandall Stewart 			 * we transmute the read entry into a PDI_ABORTED.
56458933fa13SRandall Stewart 			 */
564649656eefSMichael Tuexen 			if (sid >= asoc->streamincnt) {
56472afb3e84SRandall Stewart 				/* screwed up streams, stop!  */
56482afb3e84SRandall Stewart 				break;
5649f8829a4aSRandall Stewart 			}
565049656eefSMichael Tuexen 			if ((asoc->str_of_pdapi == sid) &&
565149656eefSMichael Tuexen 			    (asoc->ssn_of_pdapi == mid)) {
56528933fa13SRandall Stewart 				/*
56538933fa13SRandall Stewart 				 * If this is the one we were partially
56548933fa13SRandall Stewart 				 * delivering now then we no longer are.
56558933fa13SRandall Stewart 				 * Note this will change with the reassembly
56568933fa13SRandall Stewart 				 * re-write.
56578933fa13SRandall Stewart 				 */
56588933fa13SRandall Stewart 				asoc->fragmented_delivery_inprogress = 0;
56598933fa13SRandall Stewart 			}
566049656eefSMichael Tuexen 			strm = &asoc->strmin[sid];
5661b6734d8fSMichael Tuexen 			if (ordered) {
5662e597bae4SMichael Tuexen 				TAILQ_FOREACH_SAFE(control, &strm->inqueue, next_instrm, ncontrol) {
5663b6734d8fSMichael Tuexen 					if (SCTP_MID_GE(asoc->idata_supported, mid, control->mid)) {
5664b6734d8fSMichael Tuexen 						sctp_flush_reassm_for_str_seq(stcb, asoc, strm, control, ordered, new_cum_tsn);
5665b6734d8fSMichael Tuexen 					}
5666b6734d8fSMichael Tuexen 				}
5667b6734d8fSMichael Tuexen 			} else {
5668b6734d8fSMichael Tuexen 				if (asoc->idata_supported) {
5669e597bae4SMichael Tuexen 					TAILQ_FOREACH_SAFE(control, &strm->uno_inqueue, next_instrm, ncontrol) {
5670b6734d8fSMichael Tuexen 						if (SCTP_MID_GE(asoc->idata_supported, mid, control->mid)) {
5671b6734d8fSMichael Tuexen 							sctp_flush_reassm_for_str_seq(stcb, asoc, strm, control, ordered, new_cum_tsn);
5672b6734d8fSMichael Tuexen 						}
5673b6734d8fSMichael Tuexen 					}
5674b6734d8fSMichael Tuexen 				} else {
5675b6734d8fSMichael Tuexen 					if (!TAILQ_EMPTY(&strm->uno_inqueue)) {
5676b6734d8fSMichael Tuexen 						sctp_flush_reassm_for_str_seq(stcb, asoc, strm, TAILQ_FIRST(&strm->uno_inqueue), ordered, new_cum_tsn);
5677b6734d8fSMichael Tuexen 					}
5678b6734d8fSMichael Tuexen 				}
5679d1ea5fa9SMichael Tuexen 			}
568028cd0699SMichael Tuexen 			TAILQ_FOREACH(control, &stcb->sctp_ep->read_queue, next) {
568128cd0699SMichael Tuexen 				if ((control->sinfo_stream == sid) &&
568228cd0699SMichael Tuexen 				    (SCTP_MID_EQ(asoc->idata_supported, control->mid, mid))) {
568328cd0699SMichael Tuexen 					control->pdapi_aborted = 1;
568428cd0699SMichael Tuexen 					control->end_added = 1;
568528cd0699SMichael Tuexen 					if (control->on_strm_q == SCTP_ON_ORDERED) {
568628cd0699SMichael Tuexen 						TAILQ_REMOVE(&strm->inqueue, control, next_instrm);
568728cd0699SMichael Tuexen 						if (asoc->size_on_all_streams >= control->length) {
568828cd0699SMichael Tuexen 							asoc->size_on_all_streams -= control->length;
568928cd0699SMichael Tuexen 						} else {
569098d5fd97SMichael Tuexen #ifdef INVARIANTS
569128cd0699SMichael Tuexen 							panic("size_on_all_streams = %u smaller than control length %u", asoc->size_on_all_streams, control->length);
569228cd0699SMichael Tuexen #else
569328cd0699SMichael Tuexen 							asoc->size_on_all_streams = 0;
569498d5fd97SMichael Tuexen #endif
569544249214SRandall Stewart 						}
569628cd0699SMichael Tuexen 						sctp_ucount_decr(asoc->cnt_on_all_streams);
569728cd0699SMichael Tuexen 					} else if (control->on_strm_q == SCTP_ON_UNORDERED) {
569828cd0699SMichael Tuexen 						TAILQ_REMOVE(&strm->uno_inqueue, control, next_instrm);
569928cd0699SMichael Tuexen #ifdef INVARIANTS
570028cd0699SMichael Tuexen 					} else if (control->on_strm_q) {
570128cd0699SMichael Tuexen 						panic("strm: %p ctl: %p unknown %d",
570228cd0699SMichael Tuexen 						    strm, control, control->on_strm_q);
570328cd0699SMichael Tuexen #endif
570428cd0699SMichael Tuexen 					}
570528cd0699SMichael Tuexen 					control->on_strm_q = 0;
5706810ec536SMichael Tuexen 					sctp_ulp_notify(SCTP_NOTIFY_PARTIAL_DELVIERY_INDICATION,
5707810ec536SMichael Tuexen 					    stcb,
57088933fa13SRandall Stewart 					    SCTP_PARTIAL_DELIVERY_ABORTED,
5709749a7fb5SMichael Tuexen 					    (void *)control,
5710810ec536SMichael Tuexen 					    SCTP_SO_NOT_LOCKED);
57118933fa13SRandall Stewart 					break;
571228cd0699SMichael Tuexen 				} else if ((control->sinfo_stream == sid) &&
571328cd0699SMichael Tuexen 				    SCTP_MID_GT(asoc->idata_supported, control->mid, mid)) {
57148933fa13SRandall Stewart 					/* We are past our victim SSN */
57158933fa13SRandall Stewart 					break;
57168933fa13SRandall Stewart 				}
57178933fa13SRandall Stewart 			}
571849656eefSMichael Tuexen 			if (SCTP_MID_GT(asoc->idata_supported, mid, strm->last_mid_delivered)) {
5719f8829a4aSRandall Stewart 				/* Update the sequence number */
572049656eefSMichael Tuexen 				strm->last_mid_delivered = mid;
5721f8829a4aSRandall Stewart 			}
5722f8829a4aSRandall Stewart 			/* now kick the stream the new way */
572304ee05e8SRandall Stewart 			/* sa_ignore NO_NULL_CHK */
5724f8829a4aSRandall Stewart 			sctp_kick_prsctp_reorder_queue(stcb, strm);
5725f8829a4aSRandall Stewart 		}
57268933fa13SRandall Stewart 		SCTP_INP_READ_UNLOCK(stcb->sctp_ep);
5727f8829a4aSRandall Stewart 	}
57287898f408SRandall Stewart 	/*
57297898f408SRandall Stewart 	 * Now slide thing forward.
57307898f408SRandall Stewart 	 */
57317898f408SRandall Stewart 	sctp_slide_mapping_arrays(stcb);
5732f8829a4aSRandall Stewart }
5733