xref: /freebsd/sys/netinet/sctp_indata.c (revision f1f73e57181121beb7ddf1fe5cf67609cf6eadc1)
1f8829a4aSRandall Stewart /*-
242551e99SRandall Stewart  * Copyright (c) 2001-2007, Cisco Systems, Inc. All rights reserved.
3f8829a4aSRandall Stewart  *
4f8829a4aSRandall Stewart  * Redistribution and use in source and binary forms, with or without
5f8829a4aSRandall Stewart  * modification, are permitted provided that the following conditions are met:
6f8829a4aSRandall Stewart  *
7f8829a4aSRandall Stewart  * a) Redistributions of source code must retain the above copyright notice,
8f8829a4aSRandall Stewart  *   this list of conditions and the following disclaimer.
9f8829a4aSRandall Stewart  *
10f8829a4aSRandall Stewart  * b) Redistributions in binary form must reproduce the above copyright
11f8829a4aSRandall Stewart  *    notice, this list of conditions and the following disclaimer in
12f8829a4aSRandall Stewart  *   the documentation and/or other materials provided with the distribution.
13f8829a4aSRandall Stewart  *
14f8829a4aSRandall Stewart  * c) Neither the name of Cisco Systems, Inc. nor the names of its
15f8829a4aSRandall Stewart  *    contributors may be used to endorse or promote products derived
16f8829a4aSRandall Stewart  *    from this software without specific prior written permission.
17f8829a4aSRandall Stewart  *
18f8829a4aSRandall Stewart  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
19f8829a4aSRandall Stewart  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
20f8829a4aSRandall Stewart  * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21f8829a4aSRandall Stewart  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
22f8829a4aSRandall Stewart  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
23f8829a4aSRandall Stewart  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
24f8829a4aSRandall Stewart  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
25f8829a4aSRandall Stewart  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
26f8829a4aSRandall Stewart  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
27f8829a4aSRandall Stewart  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
28f8829a4aSRandall Stewart  * THE POSSIBILITY OF SUCH DAMAGE.
29f8829a4aSRandall Stewart  */
30f8829a4aSRandall Stewart 
31a5d547adSRandall Stewart /* $KAME: sctp_indata.c,v 1.36 2005/03/06 16:04:17 itojun Exp $	 */
32f8829a4aSRandall Stewart 
33f8829a4aSRandall Stewart #include <sys/cdefs.h>
34f8829a4aSRandall Stewart __FBSDID("$FreeBSD$");
35f8829a4aSRandall Stewart 
36f8829a4aSRandall Stewart #include <netinet/sctp_os.h>
37f8829a4aSRandall Stewart #include <netinet/sctp_var.h>
3842551e99SRandall Stewart #include <netinet/sctp_sysctl.h>
39f8829a4aSRandall Stewart #include <netinet/sctp_pcb.h>
40f8829a4aSRandall Stewart #include <netinet/sctp_header.h>
41f8829a4aSRandall Stewart #include <netinet/sctputil.h>
42f8829a4aSRandall Stewart #include <netinet/sctp_output.h>
43f8829a4aSRandall Stewart #include <netinet/sctp_input.h>
44f8829a4aSRandall Stewart #include <netinet/sctp_indata.h>
45f8829a4aSRandall Stewart #include <netinet/sctp_uio.h>
46f8829a4aSRandall Stewart #include <netinet/sctp_timer.h>
47f8829a4aSRandall Stewart 
48f8829a4aSRandall Stewart 
49f8829a4aSRandall Stewart /*
50f8829a4aSRandall Stewart  * NOTES: On the outbound side of things I need to check the sack timer to
51f8829a4aSRandall Stewart  * see if I should generate a sack into the chunk queue (if I have data to
52f8829a4aSRandall Stewart  * send that is and will be sending it .. for bundling.
53f8829a4aSRandall Stewart  *
54f8829a4aSRandall Stewart  * The callback in sctp_usrreq.c will get called when the socket is read from.
55f8829a4aSRandall Stewart  * This will cause sctp_service_queues() to get called on the top entry in
56f8829a4aSRandall Stewart  * the list.
57f8829a4aSRandall Stewart  */
58f8829a4aSRandall Stewart 
59f8829a4aSRandall Stewart __inline void
60f8829a4aSRandall Stewart sctp_set_rwnd(struct sctp_tcb *stcb, struct sctp_association *asoc)
61f8829a4aSRandall Stewart {
62f8829a4aSRandall Stewart 	uint32_t calc, calc_w_oh;
63f8829a4aSRandall Stewart 
64f8829a4aSRandall Stewart 	/*
65f8829a4aSRandall Stewart 	 * This is really set wrong with respect to a 1-2-m socket. Since
66f8829a4aSRandall Stewart 	 * the sb_cc is the count that everyone as put up. When we re-write
67f8829a4aSRandall Stewart 	 * sctp_soreceive then we will fix this so that ONLY this
68f8829a4aSRandall Stewart 	 * associations data is taken into account.
69f8829a4aSRandall Stewart 	 */
70f8829a4aSRandall Stewart 	if (stcb->sctp_socket == NULL)
71f8829a4aSRandall Stewart 		return;
72f8829a4aSRandall Stewart 
73f8829a4aSRandall Stewart 	if (stcb->asoc.sb_cc == 0 &&
74f8829a4aSRandall Stewart 	    asoc->size_on_reasm_queue == 0 &&
75f8829a4aSRandall Stewart 	    asoc->size_on_all_streams == 0) {
76f8829a4aSRandall Stewart 		/* Full rwnd granted */
7762c1ff9cSRandall Stewart 		asoc->my_rwnd = max(SCTP_SB_LIMIT_RCV(stcb->sctp_socket),
78f8829a4aSRandall Stewart 		    SCTP_MINIMAL_RWND);
79f8829a4aSRandall Stewart 		return;
80f8829a4aSRandall Stewart 	}
81f8829a4aSRandall Stewart 	/* get actual space */
82f8829a4aSRandall Stewart 	calc = (uint32_t) sctp_sbspace(&stcb->asoc, &stcb->sctp_socket->so_rcv);
83f8829a4aSRandall Stewart 
84f8829a4aSRandall Stewart 	/*
85f8829a4aSRandall Stewart 	 * take out what has NOT been put on socket queue and we yet hold
86f8829a4aSRandall Stewart 	 * for putting up.
87f8829a4aSRandall Stewart 	 */
88f8829a4aSRandall Stewart 	calc = sctp_sbspace_sub(calc, (uint32_t) asoc->size_on_reasm_queue);
89f8829a4aSRandall Stewart 	calc = sctp_sbspace_sub(calc, (uint32_t) asoc->size_on_all_streams);
90f8829a4aSRandall Stewart 
91f8829a4aSRandall Stewart 	if (calc == 0) {
92f8829a4aSRandall Stewart 		/* out of space */
93f8829a4aSRandall Stewart 		asoc->my_rwnd = 0;
94f8829a4aSRandall Stewart 		return;
95f8829a4aSRandall Stewart 	}
96f8829a4aSRandall Stewart 	/* what is the overhead of all these rwnd's */
97f8829a4aSRandall Stewart 	calc_w_oh = sctp_sbspace_sub(calc, stcb->asoc.my_rwnd_control_len);
98f8829a4aSRandall Stewart 	asoc->my_rwnd = calc;
99f8829a4aSRandall Stewart 	if (calc_w_oh == 0) {
100f8829a4aSRandall Stewart 		/*
101f8829a4aSRandall Stewart 		 * If our overhead is greater than the advertised rwnd, we
102f8829a4aSRandall Stewart 		 * clamp the rwnd to 1. This lets us still accept inbound
103f8829a4aSRandall Stewart 		 * segments, but hopefully will shut the sender down when he
104f8829a4aSRandall Stewart 		 * finally gets the message.
105f8829a4aSRandall Stewart 		 */
106f8829a4aSRandall Stewart 		asoc->my_rwnd = 1;
107f8829a4aSRandall Stewart 	} else {
108f8829a4aSRandall Stewart 		/* SWS threshold */
109f8829a4aSRandall Stewart 		if (asoc->my_rwnd &&
110f8829a4aSRandall Stewart 		    (asoc->my_rwnd < stcb->sctp_ep->sctp_ep.sctp_sws_receiver)) {
111f8829a4aSRandall Stewart 			/* SWS engaged, tell peer none left */
112f8829a4aSRandall Stewart 			asoc->my_rwnd = 1;
113f8829a4aSRandall Stewart 		}
114f8829a4aSRandall Stewart 	}
115f8829a4aSRandall Stewart }
116f8829a4aSRandall Stewart 
117f8829a4aSRandall Stewart /* Calculate what the rwnd would be */
118f8829a4aSRandall Stewart 
119f8829a4aSRandall Stewart __inline uint32_t
120f8829a4aSRandall Stewart sctp_calc_rwnd(struct sctp_tcb *stcb, struct sctp_association *asoc)
121f8829a4aSRandall Stewart {
122f8829a4aSRandall Stewart 	uint32_t calc = 0, calc_w_oh;
123f8829a4aSRandall Stewart 
124f8829a4aSRandall Stewart 	/*
125f8829a4aSRandall Stewart 	 * This is really set wrong with respect to a 1-2-m socket. Since
126f8829a4aSRandall Stewart 	 * the sb_cc is the count that everyone as put up. When we re-write
127f8829a4aSRandall Stewart 	 * sctp_soreceive then we will fix this so that ONLY this
128f8829a4aSRandall Stewart 	 * associations data is taken into account.
129f8829a4aSRandall Stewart 	 */
130f8829a4aSRandall Stewart 	if (stcb->sctp_socket == NULL)
131f8829a4aSRandall Stewart 		return (calc);
132f8829a4aSRandall Stewart 
133f8829a4aSRandall Stewart 	if (stcb->asoc.sb_cc == 0 &&
134f8829a4aSRandall Stewart 	    asoc->size_on_reasm_queue == 0 &&
135f8829a4aSRandall Stewart 	    asoc->size_on_all_streams == 0) {
136f8829a4aSRandall Stewart 		/* Full rwnd granted */
13762c1ff9cSRandall Stewart 		calc = max(SCTP_SB_LIMIT_RCV(stcb->sctp_socket),
138f8829a4aSRandall Stewart 		    SCTP_MINIMAL_RWND);
139f8829a4aSRandall Stewart 		return (calc);
140f8829a4aSRandall Stewart 	}
141f8829a4aSRandall Stewart 	/* get actual space */
142f8829a4aSRandall Stewart 	calc = (uint32_t) sctp_sbspace(&stcb->asoc, &stcb->sctp_socket->so_rcv);
143f8829a4aSRandall Stewart 
144f8829a4aSRandall Stewart 	/*
145f8829a4aSRandall Stewart 	 * take out what has NOT been put on socket queue and we yet hold
146f8829a4aSRandall Stewart 	 * for putting up.
147f8829a4aSRandall Stewart 	 */
148f8829a4aSRandall Stewart 	calc = sctp_sbspace_sub(calc, (uint32_t) asoc->size_on_reasm_queue);
149f8829a4aSRandall Stewart 	calc = sctp_sbspace_sub(calc, (uint32_t) asoc->size_on_all_streams);
150f8829a4aSRandall Stewart 
151f8829a4aSRandall Stewart 	if (calc == 0) {
152f8829a4aSRandall Stewart 		/* out of space */
153f8829a4aSRandall Stewart 		return (calc);
154f8829a4aSRandall Stewart 	}
155f8829a4aSRandall Stewart 	/* what is the overhead of all these rwnd's */
156f8829a4aSRandall Stewart 	calc_w_oh = sctp_sbspace_sub(calc, stcb->asoc.my_rwnd_control_len);
157f8829a4aSRandall Stewart 	if (calc_w_oh == 0) {
158f8829a4aSRandall Stewart 		/*
159f8829a4aSRandall Stewart 		 * If our overhead is greater than the advertised rwnd, we
160f8829a4aSRandall Stewart 		 * clamp the rwnd to 1. This lets us still accept inbound
161f8829a4aSRandall Stewart 		 * segments, but hopefully will shut the sender down when he
162f8829a4aSRandall Stewart 		 * finally gets the message.
163f8829a4aSRandall Stewart 		 */
164f8829a4aSRandall Stewart 		calc = 1;
165f8829a4aSRandall Stewart 	} else {
166f8829a4aSRandall Stewart 		/* SWS threshold */
167f8829a4aSRandall Stewart 		if (calc &&
168f8829a4aSRandall Stewart 		    (calc < stcb->sctp_ep->sctp_ep.sctp_sws_receiver)) {
169f8829a4aSRandall Stewart 			/* SWS engaged, tell peer none left */
170f8829a4aSRandall Stewart 			calc = 1;
171f8829a4aSRandall Stewart 		}
172f8829a4aSRandall Stewart 	}
173f8829a4aSRandall Stewart 	return (calc);
174f8829a4aSRandall Stewart }
175f8829a4aSRandall Stewart 
176f8829a4aSRandall Stewart 
177f8829a4aSRandall Stewart 
178f8829a4aSRandall Stewart /*
179f8829a4aSRandall Stewart  * Build out our readq entry based on the incoming packet.
180f8829a4aSRandall Stewart  */
181f8829a4aSRandall Stewart struct sctp_queued_to_read *
182f8829a4aSRandall Stewart sctp_build_readq_entry(struct sctp_tcb *stcb,
183f8829a4aSRandall Stewart     struct sctp_nets *net,
184f8829a4aSRandall Stewart     uint32_t tsn, uint32_t ppid,
185f8829a4aSRandall Stewart     uint32_t context, uint16_t stream_no,
186f8829a4aSRandall Stewart     uint16_t stream_seq, uint8_t flags,
187f8829a4aSRandall Stewart     struct mbuf *dm)
188f8829a4aSRandall Stewart {
189f8829a4aSRandall Stewart 	struct sctp_queued_to_read *read_queue_e = NULL;
190f8829a4aSRandall Stewart 
191f8829a4aSRandall Stewart 	sctp_alloc_a_readq(stcb, read_queue_e);
192f8829a4aSRandall Stewart 	if (read_queue_e == NULL) {
193f8829a4aSRandall Stewart 		goto failed_build;
194f8829a4aSRandall Stewart 	}
195f8829a4aSRandall Stewart 	read_queue_e->sinfo_stream = stream_no;
196f8829a4aSRandall Stewart 	read_queue_e->sinfo_ssn = stream_seq;
197f8829a4aSRandall Stewart 	read_queue_e->sinfo_flags = (flags << 8);
198f8829a4aSRandall Stewart 	read_queue_e->sinfo_ppid = ppid;
199f8829a4aSRandall Stewart 	read_queue_e->sinfo_context = stcb->asoc.context;
200f8829a4aSRandall Stewart 	read_queue_e->sinfo_timetolive = 0;
201f8829a4aSRandall Stewart 	read_queue_e->sinfo_tsn = tsn;
202f8829a4aSRandall Stewart 	read_queue_e->sinfo_cumtsn = tsn;
203f8829a4aSRandall Stewart 	read_queue_e->sinfo_assoc_id = sctp_get_associd(stcb);
204f8829a4aSRandall Stewart 	read_queue_e->whoFrom = net;
205f8829a4aSRandall Stewart 	read_queue_e->length = 0;
206f8829a4aSRandall Stewart 	atomic_add_int(&net->ref_count, 1);
207f8829a4aSRandall Stewart 	read_queue_e->data = dm;
208139bc87fSRandall Stewart 	read_queue_e->spec_flags = 0;
209f8829a4aSRandall Stewart 	read_queue_e->tail_mbuf = NULL;
210f8829a4aSRandall Stewart 	read_queue_e->stcb = stcb;
211f8829a4aSRandall Stewart 	read_queue_e->port_from = stcb->rport;
212f8829a4aSRandall Stewart 	read_queue_e->do_not_ref_stcb = 0;
213f8829a4aSRandall Stewart 	read_queue_e->end_added = 0;
21403b0b021SRandall Stewart 	read_queue_e->pdapi_aborted = 0;
215f8829a4aSRandall Stewart failed_build:
216f8829a4aSRandall Stewart 	return (read_queue_e);
217f8829a4aSRandall Stewart }
218f8829a4aSRandall Stewart 
219f8829a4aSRandall Stewart 
220f8829a4aSRandall Stewart /*
221f8829a4aSRandall Stewart  * Build out our readq entry based on the incoming packet.
222f8829a4aSRandall Stewart  */
223f8829a4aSRandall Stewart static struct sctp_queued_to_read *
224f8829a4aSRandall Stewart sctp_build_readq_entry_chk(struct sctp_tcb *stcb,
225f8829a4aSRandall Stewart     struct sctp_tmit_chunk *chk)
226f8829a4aSRandall Stewart {
227f8829a4aSRandall Stewart 	struct sctp_queued_to_read *read_queue_e = NULL;
228f8829a4aSRandall Stewart 
229f8829a4aSRandall Stewart 	sctp_alloc_a_readq(stcb, read_queue_e);
230f8829a4aSRandall Stewart 	if (read_queue_e == NULL) {
231f8829a4aSRandall Stewart 		goto failed_build;
232f8829a4aSRandall Stewart 	}
233f8829a4aSRandall Stewart 	read_queue_e->sinfo_stream = chk->rec.data.stream_number;
234f8829a4aSRandall Stewart 	read_queue_e->sinfo_ssn = chk->rec.data.stream_seq;
235f8829a4aSRandall Stewart 	read_queue_e->sinfo_flags = (chk->rec.data.rcv_flags << 8);
236f8829a4aSRandall Stewart 	read_queue_e->sinfo_ppid = chk->rec.data.payloadtype;
237f8829a4aSRandall Stewart 	read_queue_e->sinfo_context = stcb->asoc.context;
238f8829a4aSRandall Stewart 	read_queue_e->sinfo_timetolive = 0;
239f8829a4aSRandall Stewart 	read_queue_e->sinfo_tsn = chk->rec.data.TSN_seq;
240f8829a4aSRandall Stewart 	read_queue_e->sinfo_cumtsn = chk->rec.data.TSN_seq;
241f8829a4aSRandall Stewart 	read_queue_e->sinfo_assoc_id = sctp_get_associd(stcb);
242f8829a4aSRandall Stewart 	read_queue_e->whoFrom = chk->whoTo;
243f8829a4aSRandall Stewart 	read_queue_e->length = 0;
244f8829a4aSRandall Stewart 	atomic_add_int(&chk->whoTo->ref_count, 1);
245f8829a4aSRandall Stewart 	read_queue_e->data = chk->data;
246f8829a4aSRandall Stewart 	read_queue_e->tail_mbuf = NULL;
247f8829a4aSRandall Stewart 	read_queue_e->stcb = stcb;
248f8829a4aSRandall Stewart 	read_queue_e->port_from = stcb->rport;
249139bc87fSRandall Stewart 	read_queue_e->spec_flags = 0;
250f8829a4aSRandall Stewart 	read_queue_e->do_not_ref_stcb = 0;
251f8829a4aSRandall Stewart 	read_queue_e->end_added = 0;
25203b0b021SRandall Stewart 	read_queue_e->pdapi_aborted = 0;
253f8829a4aSRandall Stewart failed_build:
254f8829a4aSRandall Stewart 	return (read_queue_e);
255f8829a4aSRandall Stewart }
256f8829a4aSRandall Stewart 
257f8829a4aSRandall Stewart 
258f8829a4aSRandall Stewart struct mbuf *
259f8829a4aSRandall Stewart sctp_build_ctl_nchunk(struct sctp_inpcb *inp,
260f8829a4aSRandall Stewart     struct sctp_sndrcvinfo *sinfo)
261f8829a4aSRandall Stewart {
262f8829a4aSRandall Stewart 	struct sctp_sndrcvinfo *outinfo;
263f8829a4aSRandall Stewart 	struct cmsghdr *cmh;
264f8829a4aSRandall Stewart 	struct mbuf *ret;
265f8829a4aSRandall Stewart 	int len;
266f8829a4aSRandall Stewart 	int use_extended = 0;
267f8829a4aSRandall Stewart 
268f8829a4aSRandall Stewart 	if (sctp_is_feature_off(inp, SCTP_PCB_FLAGS_RECVDATAIOEVNT)) {
269f8829a4aSRandall Stewart 		/* user does not want the sndrcv ctl */
270f8829a4aSRandall Stewart 		return (NULL);
271f8829a4aSRandall Stewart 	}
272f8829a4aSRandall Stewart 	if (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_EXT_RCVINFO)) {
273f8829a4aSRandall Stewart 		use_extended = 1;
274f8829a4aSRandall Stewart 		len = CMSG_LEN(sizeof(struct sctp_extrcvinfo));
275f8829a4aSRandall Stewart 	} else {
276f8829a4aSRandall Stewart 		len = CMSG_LEN(sizeof(struct sctp_sndrcvinfo));
277f8829a4aSRandall Stewart 	}
278f8829a4aSRandall Stewart 
279f8829a4aSRandall Stewart 
280f8829a4aSRandall Stewart 	ret = sctp_get_mbuf_for_msg(len,
281139bc87fSRandall Stewart 	    0, M_DONTWAIT, 1, MT_DATA);
282f8829a4aSRandall Stewart 
283f8829a4aSRandall Stewart 	if (ret == NULL) {
284f8829a4aSRandall Stewart 		/* No space */
285f8829a4aSRandall Stewart 		return (ret);
286f8829a4aSRandall Stewart 	}
287f8829a4aSRandall Stewart 	/* We need a CMSG header followed by the struct  */
288f8829a4aSRandall Stewart 	cmh = mtod(ret, struct cmsghdr *);
289f8829a4aSRandall Stewart 	outinfo = (struct sctp_sndrcvinfo *)CMSG_DATA(cmh);
290f8829a4aSRandall Stewart 	cmh->cmsg_level = IPPROTO_SCTP;
291f8829a4aSRandall Stewart 	if (use_extended) {
292f8829a4aSRandall Stewart 		cmh->cmsg_type = SCTP_EXTRCV;
293f8829a4aSRandall Stewart 		cmh->cmsg_len = len;
294f8829a4aSRandall Stewart 		memcpy(outinfo, sinfo, len);
295f8829a4aSRandall Stewart 	} else {
296f8829a4aSRandall Stewart 		cmh->cmsg_type = SCTP_SNDRCV;
297f8829a4aSRandall Stewart 		cmh->cmsg_len = len;
298f8829a4aSRandall Stewart 		*outinfo = *sinfo;
299f8829a4aSRandall Stewart 	}
300139bc87fSRandall Stewart 	SCTP_BUF_LEN(ret) = cmh->cmsg_len;
301f8829a4aSRandall Stewart 	return (ret);
302f8829a4aSRandall Stewart }
303f8829a4aSRandall Stewart 
304139bc87fSRandall Stewart 
305f8829a4aSRandall Stewart /*
306f8829a4aSRandall Stewart  * We are delivering currently from the reassembly queue. We must continue to
307f8829a4aSRandall Stewart  * deliver until we either: 1) run out of space. 2) run out of sequential
308f8829a4aSRandall Stewart  * TSN's 3) hit the SCTP_DATA_LAST_FRAG flag.
309f8829a4aSRandall Stewart  */
310f8829a4aSRandall Stewart static void
311f8829a4aSRandall Stewart sctp_service_reassembly(struct sctp_tcb *stcb, struct sctp_association *asoc)
312f8829a4aSRandall Stewart {
313f8829a4aSRandall Stewart 	struct sctp_tmit_chunk *chk;
314f8829a4aSRandall Stewart 	uint16_t nxt_todel;
315f8829a4aSRandall Stewart 	uint16_t stream_no;
316f8829a4aSRandall Stewart 	int end = 0;
317f8829a4aSRandall Stewart 	int cntDel;
318f8829a4aSRandall Stewart 	struct sctp_queued_to_read *control, *ctl, *ctlat;
319f8829a4aSRandall Stewart 
320f42a358aSRandall Stewart 	cntDel = stream_no = 0;
321f42a358aSRandall Stewart 	if (stcb &&
322f42a358aSRandall Stewart 	    ((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE) ||
323f42a358aSRandall Stewart 	    (stcb->asoc.state & SCTP_STATE_CLOSED_SOCKET))) {
324f8829a4aSRandall Stewart 		/* socket above is long gone */
325f8829a4aSRandall Stewart 		asoc->fragmented_delivery_inprogress = 0;
326f8829a4aSRandall Stewart 		chk = TAILQ_FIRST(&asoc->reasmqueue);
327f8829a4aSRandall Stewart 		while (chk) {
328f8829a4aSRandall Stewart 			TAILQ_REMOVE(&asoc->reasmqueue, chk, sctp_next);
329f8829a4aSRandall Stewart 			asoc->size_on_reasm_queue -= chk->send_size;
330f8829a4aSRandall Stewart 			sctp_ucount_decr(asoc->cnt_on_reasm_queue);
331f8829a4aSRandall Stewart 			/*
332f8829a4aSRandall Stewart 			 * Lose the data pointer, since its in the socket
333f8829a4aSRandall Stewart 			 * buffer
334f8829a4aSRandall Stewart 			 */
335f8829a4aSRandall Stewart 			if (chk->data) {
336f8829a4aSRandall Stewart 				sctp_m_freem(chk->data);
337f8829a4aSRandall Stewart 				chk->data = NULL;
338f8829a4aSRandall Stewart 			}
339f8829a4aSRandall Stewart 			/* Now free the address and data */
340f8829a4aSRandall Stewart 			sctp_free_remote_addr(chk->whoTo);
341f8829a4aSRandall Stewart 			sctp_free_a_chunk(stcb, chk);
342f8829a4aSRandall Stewart 			chk = TAILQ_FIRST(&asoc->reasmqueue);
343f8829a4aSRandall Stewart 		}
344f8829a4aSRandall Stewart 		return;
345f8829a4aSRandall Stewart 	}
346f8829a4aSRandall Stewart 	SCTP_TCB_LOCK_ASSERT(stcb);
347f8829a4aSRandall Stewart 	do {
348f8829a4aSRandall Stewart 		chk = TAILQ_FIRST(&asoc->reasmqueue);
349f8829a4aSRandall Stewart 		if (chk == NULL) {
350f8829a4aSRandall Stewart 			return;
351f8829a4aSRandall Stewart 		}
352f8829a4aSRandall Stewart 		if (chk->rec.data.TSN_seq != (asoc->tsn_last_delivered + 1)) {
353f8829a4aSRandall Stewart 			/* Can't deliver more :< */
354f8829a4aSRandall Stewart 			return;
355f8829a4aSRandall Stewart 		}
356f8829a4aSRandall Stewart 		stream_no = chk->rec.data.stream_number;
357f8829a4aSRandall Stewart 		nxt_todel = asoc->strmin[stream_no].last_sequence_delivered + 1;
358f8829a4aSRandall Stewart 		if (nxt_todel != chk->rec.data.stream_seq &&
359f8829a4aSRandall Stewart 		    (chk->rec.data.rcv_flags & SCTP_DATA_UNORDERED) == 0) {
360f8829a4aSRandall Stewart 			/*
361f8829a4aSRandall Stewart 			 * Not the next sequence to deliver in its stream OR
362f8829a4aSRandall Stewart 			 * unordered
363f8829a4aSRandall Stewart 			 */
364f8829a4aSRandall Stewart 			return;
365f8829a4aSRandall Stewart 		}
366f8829a4aSRandall Stewart 		if (chk->rec.data.rcv_flags & SCTP_DATA_FIRST_FRAG) {
367f8829a4aSRandall Stewart 
368f8829a4aSRandall Stewart 			control = sctp_build_readq_entry_chk(stcb, chk);
369f8829a4aSRandall Stewart 			if (control == NULL) {
370f8829a4aSRandall Stewart 				/* out of memory? */
371f8829a4aSRandall Stewart 				return;
372f8829a4aSRandall Stewart 			}
373f8829a4aSRandall Stewart 			/* save it off for our future deliveries */
374f8829a4aSRandall Stewart 			stcb->asoc.control_pdapi = control;
375f8829a4aSRandall Stewart 			if (chk->rec.data.rcv_flags & SCTP_DATA_LAST_FRAG)
376f8829a4aSRandall Stewart 				end = 1;
377f8829a4aSRandall Stewart 			else
378f8829a4aSRandall Stewart 				end = 0;
379f8829a4aSRandall Stewart 			sctp_add_to_readq(stcb->sctp_ep,
380f8829a4aSRandall Stewart 			    stcb, control, &stcb->sctp_socket->so_rcv, end);
381f8829a4aSRandall Stewart 			cntDel++;
382f8829a4aSRandall Stewart 		} else {
383f8829a4aSRandall Stewart 			if (chk->rec.data.rcv_flags & SCTP_DATA_LAST_FRAG)
384f8829a4aSRandall Stewart 				end = 1;
385f8829a4aSRandall Stewart 			else
386f8829a4aSRandall Stewart 				end = 0;
387f8829a4aSRandall Stewart 			if (sctp_append_to_readq(stcb->sctp_ep, stcb,
388f8829a4aSRandall Stewart 			    stcb->asoc.control_pdapi,
389f8829a4aSRandall Stewart 			    chk->data, end, chk->rec.data.TSN_seq,
390f8829a4aSRandall Stewart 			    &stcb->sctp_socket->so_rcv)) {
391f8829a4aSRandall Stewart 				/*
392f8829a4aSRandall Stewart 				 * something is very wrong, either
393f8829a4aSRandall Stewart 				 * control_pdapi is NULL, or the tail_mbuf
394f8829a4aSRandall Stewart 				 * is corrupt, or there is a EOM already on
395f8829a4aSRandall Stewart 				 * the mbuf chain.
396f8829a4aSRandall Stewart 				 */
397f8829a4aSRandall Stewart 				if (stcb->asoc.control_pdapi == NULL) {
398f8829a4aSRandall Stewart 					panic("This should not happen control_pdapi NULL?");
399f8829a4aSRandall Stewart 				}
400f8829a4aSRandall Stewart 				if (stcb->asoc.control_pdapi->tail_mbuf == NULL) {
401f8829a4aSRandall Stewart 					panic("This should not happen, tail_mbuf not being maintained?");
402f8829a4aSRandall Stewart 				}
403f8829a4aSRandall Stewart 				/* if we did not panic, it was a EOM */
404f8829a4aSRandall Stewart 				panic("Bad chunking ??");
405f8829a4aSRandall Stewart 			}
406f8829a4aSRandall Stewart 			cntDel++;
407f8829a4aSRandall Stewart 		}
408f8829a4aSRandall Stewart 		/* pull it we did it */
409f8829a4aSRandall Stewart 		TAILQ_REMOVE(&asoc->reasmqueue, chk, sctp_next);
410f8829a4aSRandall Stewart 		if (chk->rec.data.rcv_flags & SCTP_DATA_LAST_FRAG) {
411f8829a4aSRandall Stewart 			asoc->fragmented_delivery_inprogress = 0;
412f8829a4aSRandall Stewart 			if ((chk->rec.data.rcv_flags & SCTP_DATA_UNORDERED) == 0) {
413f8829a4aSRandall Stewart 				asoc->strmin[stream_no].last_sequence_delivered++;
414f8829a4aSRandall Stewart 			}
415f8829a4aSRandall Stewart 			if ((chk->rec.data.rcv_flags & SCTP_DATA_FIRST_FRAG) == 0) {
416f8829a4aSRandall Stewart 				SCTP_STAT_INCR_COUNTER64(sctps_reasmusrmsgs);
417f8829a4aSRandall Stewart 			}
418f8829a4aSRandall Stewart 		} else if (chk->rec.data.rcv_flags & SCTP_DATA_FIRST_FRAG) {
419f8829a4aSRandall Stewart 			/*
420f8829a4aSRandall Stewart 			 * turn the flag back on since we just  delivered
421f8829a4aSRandall Stewart 			 * yet another one.
422f8829a4aSRandall Stewart 			 */
423f8829a4aSRandall Stewart 			asoc->fragmented_delivery_inprogress = 1;
424f8829a4aSRandall Stewart 		}
425f8829a4aSRandall Stewart 		asoc->tsn_of_pdapi_last_delivered = chk->rec.data.TSN_seq;
426f8829a4aSRandall Stewart 		asoc->last_flags_delivered = chk->rec.data.rcv_flags;
427f8829a4aSRandall Stewart 		asoc->last_strm_seq_delivered = chk->rec.data.stream_seq;
428f8829a4aSRandall Stewart 		asoc->last_strm_no_delivered = chk->rec.data.stream_number;
429f8829a4aSRandall Stewart 
430f8829a4aSRandall Stewart 		asoc->tsn_last_delivered = chk->rec.data.TSN_seq;
431f8829a4aSRandall Stewart 		asoc->size_on_reasm_queue -= chk->send_size;
432f8829a4aSRandall Stewart 		sctp_ucount_decr(asoc->cnt_on_reasm_queue);
433f8829a4aSRandall Stewart 		/* free up the chk */
434f8829a4aSRandall Stewart 		chk->data = NULL;
435f8829a4aSRandall Stewart 		sctp_free_remote_addr(chk->whoTo);
436f8829a4aSRandall Stewart 		sctp_free_a_chunk(stcb, chk);
437f8829a4aSRandall Stewart 
438f8829a4aSRandall Stewart 		if (asoc->fragmented_delivery_inprogress == 0) {
439f8829a4aSRandall Stewart 			/*
440f8829a4aSRandall Stewart 			 * Now lets see if we can deliver the next one on
441f8829a4aSRandall Stewart 			 * the stream
442f8829a4aSRandall Stewart 			 */
443f8829a4aSRandall Stewart 			uint16_t nxt_todel;
444f8829a4aSRandall Stewart 			struct sctp_stream_in *strm;
445f8829a4aSRandall Stewart 
446f8829a4aSRandall Stewart 			strm = &asoc->strmin[stream_no];
447f8829a4aSRandall Stewart 			nxt_todel = strm->last_sequence_delivered + 1;
448f8829a4aSRandall Stewart 			ctl = TAILQ_FIRST(&strm->inqueue);
449f8829a4aSRandall Stewart 			if (ctl && (nxt_todel == ctl->sinfo_ssn)) {
450f8829a4aSRandall Stewart 				while (ctl != NULL) {
451f8829a4aSRandall Stewart 					/* Deliver more if we can. */
452f8829a4aSRandall Stewart 					if (nxt_todel == ctl->sinfo_ssn) {
453f8829a4aSRandall Stewart 						ctlat = TAILQ_NEXT(ctl, next);
454f8829a4aSRandall Stewart 						TAILQ_REMOVE(&strm->inqueue, ctl, next);
455f8829a4aSRandall Stewart 						asoc->size_on_all_streams -= ctl->length;
456f8829a4aSRandall Stewart 						sctp_ucount_decr(asoc->cnt_on_all_streams);
457f8829a4aSRandall Stewart 						strm->last_sequence_delivered++;
458f8829a4aSRandall Stewart 						sctp_add_to_readq(stcb->sctp_ep, stcb,
459f8829a4aSRandall Stewart 						    ctl,
460f8829a4aSRandall Stewart 						    &stcb->sctp_socket->so_rcv, 1);
461f8829a4aSRandall Stewart 						ctl = ctlat;
462f8829a4aSRandall Stewart 					} else {
463f8829a4aSRandall Stewart 						break;
464f8829a4aSRandall Stewart 					}
465f8829a4aSRandall Stewart 					nxt_todel = strm->last_sequence_delivered + 1;
466f8829a4aSRandall Stewart 				}
467f8829a4aSRandall Stewart 			}
468139bc87fSRandall Stewart 			break;
469f8829a4aSRandall Stewart 		}
470f8829a4aSRandall Stewart 		chk = TAILQ_FIRST(&asoc->reasmqueue);
471f8829a4aSRandall Stewart 	} while (chk);
472f8829a4aSRandall Stewart }
473f8829a4aSRandall Stewart 
474f8829a4aSRandall Stewart /*
475f8829a4aSRandall Stewart  * Queue the chunk either right into the socket buffer if it is the next one
476f8829a4aSRandall Stewart  * to go OR put it in the correct place in the delivery queue.  If we do
477f8829a4aSRandall Stewart  * append to the so_buf, keep doing so until we are out of order. One big
478f8829a4aSRandall Stewart  * question still remains, what to do when the socket buffer is FULL??
479f8829a4aSRandall Stewart  */
480f8829a4aSRandall Stewart static void
481f8829a4aSRandall Stewart sctp_queue_data_to_stream(struct sctp_tcb *stcb, struct sctp_association *asoc,
482f8829a4aSRandall Stewart     struct sctp_queued_to_read *control, int *abort_flag)
483f8829a4aSRandall Stewart {
484f8829a4aSRandall Stewart 	/*
485f8829a4aSRandall Stewart 	 * FIX-ME maybe? What happens when the ssn wraps? If we are getting
486f8829a4aSRandall Stewart 	 * all the data in one stream this could happen quite rapidly. One
487f8829a4aSRandall Stewart 	 * could use the TSN to keep track of things, but this scheme breaks
488f8829a4aSRandall Stewart 	 * down in the other type of stream useage that could occur. Send a
489f8829a4aSRandall Stewart 	 * single msg to stream 0, send 4Billion messages to stream 1, now
490f8829a4aSRandall Stewart 	 * send a message to stream 0. You have a situation where the TSN
491f8829a4aSRandall Stewart 	 * has wrapped but not in the stream. Is this worth worrying about
492f8829a4aSRandall Stewart 	 * or should we just change our queue sort at the bottom to be by
493f8829a4aSRandall Stewart 	 * TSN.
494f8829a4aSRandall Stewart 	 *
495f8829a4aSRandall Stewart 	 * Could it also be legal for a peer to send ssn 1 with TSN 2 and ssn 2
496f8829a4aSRandall Stewart 	 * with TSN 1? If the peer is doing some sort of funky TSN/SSN
497f8829a4aSRandall Stewart 	 * assignment this could happen... and I don't see how this would be
498f8829a4aSRandall Stewart 	 * a violation. So for now I am undecided an will leave the sort by
499f8829a4aSRandall Stewart 	 * SSN alone. Maybe a hybred approach is the answer
500f8829a4aSRandall Stewart 	 *
501f8829a4aSRandall Stewart 	 */
502f8829a4aSRandall Stewart 	struct sctp_stream_in *strm;
503f8829a4aSRandall Stewart 	struct sctp_queued_to_read *at;
504f8829a4aSRandall Stewart 	int queue_needed;
505f8829a4aSRandall Stewart 	uint16_t nxt_todel;
506f8829a4aSRandall Stewart 	struct mbuf *oper;
507f8829a4aSRandall Stewart 
508f8829a4aSRandall Stewart 	queue_needed = 1;
509f8829a4aSRandall Stewart 	asoc->size_on_all_streams += control->length;
510f8829a4aSRandall Stewart 	sctp_ucount_incr(asoc->cnt_on_all_streams);
511f8829a4aSRandall Stewart 	strm = &asoc->strmin[control->sinfo_stream];
512f8829a4aSRandall Stewart 	nxt_todel = strm->last_sequence_delivered + 1;
513f8829a4aSRandall Stewart #ifdef SCTP_STR_LOGGING
514f8829a4aSRandall Stewart 	sctp_log_strm_del(control, NULL, SCTP_STR_LOG_FROM_INTO_STRD);
515f8829a4aSRandall Stewart #endif
516f8829a4aSRandall Stewart #ifdef SCTP_DEBUG
517f8829a4aSRandall Stewart 	if (sctp_debug_on & SCTP_DEBUG_INDATA1) {
518f8829a4aSRandall Stewart 		printf("queue to stream called for ssn:%u lastdel:%u nxt:%u\n",
519f8829a4aSRandall Stewart 		    (uint32_t) control->sinfo_stream,
520f8829a4aSRandall Stewart 		    (uint32_t) strm->last_sequence_delivered, (uint32_t) nxt_todel);
521f8829a4aSRandall Stewart 	}
522f8829a4aSRandall Stewart #endif
523f8829a4aSRandall Stewart 	if (compare_with_wrap(strm->last_sequence_delivered,
524f8829a4aSRandall Stewart 	    control->sinfo_ssn, MAX_SEQ) ||
525f8829a4aSRandall Stewart 	    (strm->last_sequence_delivered == control->sinfo_ssn)) {
526f8829a4aSRandall Stewart 		/* The incoming sseq is behind where we last delivered? */
527f8829a4aSRandall Stewart #ifdef SCTP_DEBUG
528f8829a4aSRandall Stewart 		if (sctp_debug_on & SCTP_DEBUG_INDATA1) {
529f8829a4aSRandall Stewart 			printf("Duplicate S-SEQ:%d delivered:%d from peer, Abort  association\n",
530f8829a4aSRandall Stewart 			    control->sinfo_ssn,
531f8829a4aSRandall Stewart 			    strm->last_sequence_delivered);
532f8829a4aSRandall Stewart 		}
533f8829a4aSRandall Stewart #endif
534f8829a4aSRandall Stewart 		/*
535f8829a4aSRandall Stewart 		 * throw it in the stream so it gets cleaned up in
536f8829a4aSRandall Stewart 		 * association destruction
537f8829a4aSRandall Stewart 		 */
538f8829a4aSRandall Stewart 		TAILQ_INSERT_HEAD(&strm->inqueue, control, next);
539139bc87fSRandall Stewart 		oper = sctp_get_mbuf_for_msg((sizeof(struct sctp_paramhdr) + 3 * sizeof(uint32_t)),
540f8829a4aSRandall Stewart 		    0, M_DONTWAIT, 1, MT_DATA);
541f8829a4aSRandall Stewart 		if (oper) {
542f8829a4aSRandall Stewart 			struct sctp_paramhdr *ph;
543f8829a4aSRandall Stewart 			uint32_t *ippp;
544f8829a4aSRandall Stewart 
545139bc87fSRandall Stewart 			SCTP_BUF_LEN(oper) = sizeof(struct sctp_paramhdr) +
546f8829a4aSRandall Stewart 			    (sizeof(uint32_t) * 3);
547f8829a4aSRandall Stewart 			ph = mtod(oper, struct sctp_paramhdr *);
548f8829a4aSRandall Stewart 			ph->param_type = htons(SCTP_CAUSE_PROTOCOL_VIOLATION);
549139bc87fSRandall Stewart 			ph->param_length = htons(SCTP_BUF_LEN(oper));
550f8829a4aSRandall Stewart 			ippp = (uint32_t *) (ph + 1);
551a5d547adSRandall Stewart 			*ippp = htonl(SCTP_FROM_SCTP_INDATA + SCTP_LOC_1);
552f8829a4aSRandall Stewart 			ippp++;
553f8829a4aSRandall Stewart 			*ippp = control->sinfo_tsn;
554f8829a4aSRandall Stewart 			ippp++;
555f8829a4aSRandall Stewart 			*ippp = ((control->sinfo_stream << 16) | control->sinfo_ssn);
556f8829a4aSRandall Stewart 		}
557a5d547adSRandall Stewart 		stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_1;
558f8829a4aSRandall Stewart 		sctp_abort_an_association(stcb->sctp_ep, stcb,
559f8829a4aSRandall Stewart 		    SCTP_PEER_FAULTY, oper);
560f8829a4aSRandall Stewart 
561f8829a4aSRandall Stewart 		*abort_flag = 1;
562f8829a4aSRandall Stewart 		return;
563f8829a4aSRandall Stewart 
564f8829a4aSRandall Stewart 	}
565f8829a4aSRandall Stewart 	if (nxt_todel == control->sinfo_ssn) {
566f8829a4aSRandall Stewart 		/* can be delivered right away? */
567f8829a4aSRandall Stewart #ifdef SCTP_STR_LOGGING
568f8829a4aSRandall Stewart 		sctp_log_strm_del(control, NULL, SCTP_STR_LOG_FROM_IMMED_DEL);
569f8829a4aSRandall Stewart #endif
570f8829a4aSRandall Stewart 		queue_needed = 0;
571f8829a4aSRandall Stewart 		asoc->size_on_all_streams -= control->length;
572f8829a4aSRandall Stewart 		sctp_ucount_decr(asoc->cnt_on_all_streams);
573f8829a4aSRandall Stewart 		strm->last_sequence_delivered++;
574f8829a4aSRandall Stewart 		sctp_add_to_readq(stcb->sctp_ep, stcb,
575f8829a4aSRandall Stewart 		    control,
576f8829a4aSRandall Stewart 		    &stcb->sctp_socket->so_rcv, 1);
577f8829a4aSRandall Stewart 		control = TAILQ_FIRST(&strm->inqueue);
578f8829a4aSRandall Stewart 		while (control != NULL) {
579f8829a4aSRandall Stewart 			/* all delivered */
580f8829a4aSRandall Stewart 			nxt_todel = strm->last_sequence_delivered + 1;
581f8829a4aSRandall Stewart 			if (nxt_todel == control->sinfo_ssn) {
582f8829a4aSRandall Stewart 				at = TAILQ_NEXT(control, next);
583f8829a4aSRandall Stewart 				TAILQ_REMOVE(&strm->inqueue, control, next);
584f8829a4aSRandall Stewart 				asoc->size_on_all_streams -= control->length;
585f8829a4aSRandall Stewart 				sctp_ucount_decr(asoc->cnt_on_all_streams);
586f8829a4aSRandall Stewart 				strm->last_sequence_delivered++;
587f8829a4aSRandall Stewart 				/*
588f8829a4aSRandall Stewart 				 * We ignore the return of deliver_data here
589f8829a4aSRandall Stewart 				 * since we always can hold the chunk on the
590f8829a4aSRandall Stewart 				 * d-queue. And we have a finite number that
591f8829a4aSRandall Stewart 				 * can be delivered from the strq.
592f8829a4aSRandall Stewart 				 */
593f8829a4aSRandall Stewart #ifdef SCTP_STR_LOGGING
594f8829a4aSRandall Stewart 				sctp_log_strm_del(control, NULL,
595f8829a4aSRandall Stewart 				    SCTP_STR_LOG_FROM_IMMED_DEL);
596f8829a4aSRandall Stewart #endif
597f8829a4aSRandall Stewart 				sctp_add_to_readq(stcb->sctp_ep, stcb,
598f8829a4aSRandall Stewart 				    control,
599f8829a4aSRandall Stewart 				    &stcb->sctp_socket->so_rcv, 1);
600f8829a4aSRandall Stewart 				control = at;
601f8829a4aSRandall Stewart 				continue;
602f8829a4aSRandall Stewart 			}
603f8829a4aSRandall Stewart 			break;
604f8829a4aSRandall Stewart 		}
605f8829a4aSRandall Stewart 	}
606f8829a4aSRandall Stewart 	if (queue_needed) {
607f8829a4aSRandall Stewart 		/*
608f8829a4aSRandall Stewart 		 * Ok, we did not deliver this guy, find the correct place
609f8829a4aSRandall Stewart 		 * to put it on the queue.
610f8829a4aSRandall Stewart 		 */
611f8829a4aSRandall Stewart 		if (TAILQ_EMPTY(&strm->inqueue)) {
612f8829a4aSRandall Stewart 			/* Empty queue */
613f8829a4aSRandall Stewart #ifdef SCTP_STR_LOGGING
614f8829a4aSRandall Stewart 			sctp_log_strm_del(control, NULL, SCTP_STR_LOG_FROM_INSERT_HD);
615f8829a4aSRandall Stewart #endif
616f8829a4aSRandall Stewart 			TAILQ_INSERT_HEAD(&strm->inqueue, control, next);
617f8829a4aSRandall Stewart 		} else {
618f8829a4aSRandall Stewart 			TAILQ_FOREACH(at, &strm->inqueue, next) {
619f8829a4aSRandall Stewart 				if (compare_with_wrap(at->sinfo_ssn,
620f8829a4aSRandall Stewart 				    control->sinfo_ssn, MAX_SEQ)) {
621f8829a4aSRandall Stewart 					/*
622f8829a4aSRandall Stewart 					 * one in queue is bigger than the
623f8829a4aSRandall Stewart 					 * new one, insert before this one
624f8829a4aSRandall Stewart 					 */
625f8829a4aSRandall Stewart #ifdef SCTP_STR_LOGGING
626f8829a4aSRandall Stewart 					sctp_log_strm_del(control, at,
627f8829a4aSRandall Stewart 					    SCTP_STR_LOG_FROM_INSERT_MD);
628f8829a4aSRandall Stewart #endif
629f8829a4aSRandall Stewart 					TAILQ_INSERT_BEFORE(at, control, next);
630f8829a4aSRandall Stewart 					break;
631f8829a4aSRandall Stewart 				} else if (at->sinfo_ssn == control->sinfo_ssn) {
632f8829a4aSRandall Stewart 					/*
633f8829a4aSRandall Stewart 					 * Gak, He sent me a duplicate str
634f8829a4aSRandall Stewart 					 * seq number
635f8829a4aSRandall Stewart 					 */
636f8829a4aSRandall Stewart 					/*
637f8829a4aSRandall Stewart 					 * foo bar, I guess I will just free
638f8829a4aSRandall Stewart 					 * this new guy, should we abort
639f8829a4aSRandall Stewart 					 * too? FIX ME MAYBE? Or it COULD be
640f8829a4aSRandall Stewart 					 * that the SSN's have wrapped.
641f8829a4aSRandall Stewart 					 * Maybe I should compare to TSN
642f8829a4aSRandall Stewart 					 * somehow... sigh for now just blow
643f8829a4aSRandall Stewart 					 * away the chunk!
644f8829a4aSRandall Stewart 					 */
645f8829a4aSRandall Stewart 
646f8829a4aSRandall Stewart 					if (control->data)
647f8829a4aSRandall Stewart 						sctp_m_freem(control->data);
648f8829a4aSRandall Stewart 					control->data = NULL;
649f8829a4aSRandall Stewart 					asoc->size_on_all_streams -= control->length;
650f8829a4aSRandall Stewart 					sctp_ucount_decr(asoc->cnt_on_all_streams);
651f8829a4aSRandall Stewart 					sctp_free_remote_addr(control->whoFrom);
652f8829a4aSRandall Stewart 					sctp_free_a_readq(stcb, control);
653f8829a4aSRandall Stewart 					return;
654f8829a4aSRandall Stewart 				} else {
655f8829a4aSRandall Stewart 					if (TAILQ_NEXT(at, next) == NULL) {
656f8829a4aSRandall Stewart 						/*
657f8829a4aSRandall Stewart 						 * We are at the end, insert
658f8829a4aSRandall Stewart 						 * it after this one
659f8829a4aSRandall Stewart 						 */
660f8829a4aSRandall Stewart #ifdef SCTP_STR_LOGGING
661f8829a4aSRandall Stewart 						sctp_log_strm_del(control, at,
662f8829a4aSRandall Stewart 						    SCTP_STR_LOG_FROM_INSERT_TL);
663f8829a4aSRandall Stewart #endif
664f8829a4aSRandall Stewart 						TAILQ_INSERT_AFTER(&strm->inqueue,
665f8829a4aSRandall Stewart 						    at, control, next);
666f8829a4aSRandall Stewart 						break;
667f8829a4aSRandall Stewart 					}
668f8829a4aSRandall Stewart 				}
669f8829a4aSRandall Stewart 			}
670f8829a4aSRandall Stewart 		}
671f8829a4aSRandall Stewart 	}
672f8829a4aSRandall Stewart }
673f8829a4aSRandall Stewart 
674f8829a4aSRandall Stewart /*
675f8829a4aSRandall Stewart  * Returns two things: You get the total size of the deliverable parts of the
676f8829a4aSRandall Stewart  * first fragmented message on the reassembly queue. And you get a 1 back if
677f8829a4aSRandall Stewart  * all of the message is ready or a 0 back if the message is still incomplete
678f8829a4aSRandall Stewart  */
679f8829a4aSRandall Stewart static int
680f8829a4aSRandall Stewart sctp_is_all_msg_on_reasm(struct sctp_association *asoc, uint32_t * t_size)
681f8829a4aSRandall Stewart {
682f8829a4aSRandall Stewart 	struct sctp_tmit_chunk *chk;
683f8829a4aSRandall Stewart 	uint32_t tsn;
684f8829a4aSRandall Stewart 
685f8829a4aSRandall Stewart 	*t_size = 0;
686f8829a4aSRandall Stewart 	chk = TAILQ_FIRST(&asoc->reasmqueue);
687f8829a4aSRandall Stewart 	if (chk == NULL) {
688f8829a4aSRandall Stewart 		/* nothing on the queue */
689f8829a4aSRandall Stewart 		return (0);
690f8829a4aSRandall Stewart 	}
691f8829a4aSRandall Stewart 	if ((chk->rec.data.rcv_flags & SCTP_DATA_FIRST_FRAG) == 0) {
692f8829a4aSRandall Stewart 		/* Not a first on the queue */
693f8829a4aSRandall Stewart 		return (0);
694f8829a4aSRandall Stewart 	}
695f8829a4aSRandall Stewart 	tsn = chk->rec.data.TSN_seq;
696f8829a4aSRandall Stewart 	while (chk) {
697f8829a4aSRandall Stewart 		if (tsn != chk->rec.data.TSN_seq) {
698f8829a4aSRandall Stewart 			return (0);
699f8829a4aSRandall Stewart 		}
700f8829a4aSRandall Stewart 		*t_size += chk->send_size;
701f8829a4aSRandall Stewart 		if (chk->rec.data.rcv_flags & SCTP_DATA_LAST_FRAG) {
702f8829a4aSRandall Stewart 			return (1);
703f8829a4aSRandall Stewart 		}
704f8829a4aSRandall Stewart 		tsn++;
705f8829a4aSRandall Stewart 		chk = TAILQ_NEXT(chk, sctp_next);
706f8829a4aSRandall Stewart 	}
707f8829a4aSRandall Stewart 	return (0);
708f8829a4aSRandall Stewart }
709f8829a4aSRandall Stewart 
710f8829a4aSRandall Stewart static void
711f8829a4aSRandall Stewart sctp_deliver_reasm_check(struct sctp_tcb *stcb, struct sctp_association *asoc)
712f8829a4aSRandall Stewart {
713f8829a4aSRandall Stewart 	struct sctp_tmit_chunk *chk;
714f8829a4aSRandall Stewart 	uint16_t nxt_todel;
715f8829a4aSRandall Stewart 	uint32_t tsize;
716f8829a4aSRandall Stewart 
717139bc87fSRandall Stewart doit_again:
718f8829a4aSRandall Stewart 	chk = TAILQ_FIRST(&asoc->reasmqueue);
719f8829a4aSRandall Stewart 	if (chk == NULL) {
720f8829a4aSRandall Stewart 		/* Huh? */
721f8829a4aSRandall Stewart 		asoc->size_on_reasm_queue = 0;
722f8829a4aSRandall Stewart 		asoc->cnt_on_reasm_queue = 0;
723f8829a4aSRandall Stewart 		return;
724f8829a4aSRandall Stewart 	}
725f8829a4aSRandall Stewart 	if (asoc->fragmented_delivery_inprogress == 0) {
726f8829a4aSRandall Stewart 		nxt_todel =
727f8829a4aSRandall Stewart 		    asoc->strmin[chk->rec.data.stream_number].last_sequence_delivered + 1;
728f8829a4aSRandall Stewart 		if ((chk->rec.data.rcv_flags & SCTP_DATA_FIRST_FRAG) &&
729f8829a4aSRandall Stewart 		    (nxt_todel == chk->rec.data.stream_seq ||
730f8829a4aSRandall Stewart 		    (chk->rec.data.rcv_flags & SCTP_DATA_UNORDERED))) {
731f8829a4aSRandall Stewart 			/*
732f8829a4aSRandall Stewart 			 * Yep the first one is here and its ok to deliver
733f8829a4aSRandall Stewart 			 * but should we?
734f8829a4aSRandall Stewart 			 */
735f8829a4aSRandall Stewart 			if ((sctp_is_all_msg_on_reasm(asoc, &tsize) ||
736f8829a4aSRandall Stewart 			    (tsize > stcb->sctp_ep->partial_delivery_point))) {
737f8829a4aSRandall Stewart 
738f8829a4aSRandall Stewart 				/*
739f8829a4aSRandall Stewart 				 * Yes, we setup to start reception, by
740f8829a4aSRandall Stewart 				 * backing down the TSN just in case we
741f8829a4aSRandall Stewart 				 * can't deliver. If we
742f8829a4aSRandall Stewart 				 */
743f8829a4aSRandall Stewart 				asoc->fragmented_delivery_inprogress = 1;
744f8829a4aSRandall Stewart 				asoc->tsn_last_delivered =
745f8829a4aSRandall Stewart 				    chk->rec.data.TSN_seq - 1;
746f8829a4aSRandall Stewart 				asoc->str_of_pdapi =
747f8829a4aSRandall Stewart 				    chk->rec.data.stream_number;
748f8829a4aSRandall Stewart 				asoc->ssn_of_pdapi = chk->rec.data.stream_seq;
749f8829a4aSRandall Stewart 				asoc->pdapi_ppid = chk->rec.data.payloadtype;
750f8829a4aSRandall Stewart 				asoc->fragment_flags = chk->rec.data.rcv_flags;
751f8829a4aSRandall Stewart 				sctp_service_reassembly(stcb, asoc);
752f8829a4aSRandall Stewart 			}
753f8829a4aSRandall Stewart 		}
754f8829a4aSRandall Stewart 	} else {
755139bc87fSRandall Stewart 		/*
756139bc87fSRandall Stewart 		 * Service re-assembly will deliver stream data queued at
757139bc87fSRandall Stewart 		 * the end of fragmented delivery.. but it wont know to go
758139bc87fSRandall Stewart 		 * back and call itself again... we do that here with the
759139bc87fSRandall Stewart 		 * got doit_again
760139bc87fSRandall Stewart 		 */
761f8829a4aSRandall Stewart 		sctp_service_reassembly(stcb, asoc);
762139bc87fSRandall Stewart 		if (asoc->fragmented_delivery_inprogress == 0) {
763139bc87fSRandall Stewart 			/*
764139bc87fSRandall Stewart 			 * finished our Fragmented delivery, could be more
765139bc87fSRandall Stewart 			 * waiting?
766139bc87fSRandall Stewart 			 */
767139bc87fSRandall Stewart 			goto doit_again;
768139bc87fSRandall Stewart 		}
769f8829a4aSRandall Stewart 	}
770f8829a4aSRandall Stewart }
771f8829a4aSRandall Stewart 
772f8829a4aSRandall Stewart /*
773f8829a4aSRandall Stewart  * Dump onto the re-assembly queue, in its proper place. After dumping on the
774f8829a4aSRandall Stewart  * queue, see if anthing can be delivered. If so pull it off (or as much as
775f8829a4aSRandall Stewart  * we can. If we run out of space then we must dump what we can and set the
776f8829a4aSRandall Stewart  * appropriate flag to say we queued what we could.
777f8829a4aSRandall Stewart  */
778f8829a4aSRandall Stewart static void
779f8829a4aSRandall Stewart sctp_queue_data_for_reasm(struct sctp_tcb *stcb, struct sctp_association *asoc,
780f8829a4aSRandall Stewart     struct sctp_tmit_chunk *chk, int *abort_flag)
781f8829a4aSRandall Stewart {
782f8829a4aSRandall Stewart 	struct mbuf *oper;
783f8829a4aSRandall Stewart 	uint32_t cum_ackp1, last_tsn, prev_tsn, post_tsn;
784f8829a4aSRandall Stewart 	u_char last_flags;
785f8829a4aSRandall Stewart 	struct sctp_tmit_chunk *at, *prev, *next;
786f8829a4aSRandall Stewart 
787f8829a4aSRandall Stewart 	prev = next = NULL;
788f8829a4aSRandall Stewart 	cum_ackp1 = asoc->tsn_last_delivered + 1;
789f8829a4aSRandall Stewart 	if (TAILQ_EMPTY(&asoc->reasmqueue)) {
790f8829a4aSRandall Stewart 		/* This is the first one on the queue */
791f8829a4aSRandall Stewart 		TAILQ_INSERT_HEAD(&asoc->reasmqueue, chk, sctp_next);
792f8829a4aSRandall Stewart 		/*
793f8829a4aSRandall Stewart 		 * we do not check for delivery of anything when only one
794f8829a4aSRandall Stewart 		 * fragment is here
795f8829a4aSRandall Stewart 		 */
796f8829a4aSRandall Stewart 		asoc->size_on_reasm_queue = chk->send_size;
797f8829a4aSRandall Stewart 		sctp_ucount_incr(asoc->cnt_on_reasm_queue);
798f8829a4aSRandall Stewart 		if (chk->rec.data.TSN_seq == cum_ackp1) {
799f8829a4aSRandall Stewart 			if (asoc->fragmented_delivery_inprogress == 0 &&
800f8829a4aSRandall Stewart 			    (chk->rec.data.rcv_flags & SCTP_DATA_FIRST_FRAG) !=
801f8829a4aSRandall Stewart 			    SCTP_DATA_FIRST_FRAG) {
802f8829a4aSRandall Stewart 				/*
803f8829a4aSRandall Stewart 				 * An empty queue, no delivery inprogress,
804f8829a4aSRandall Stewart 				 * we hit the next one and it does NOT have
805f8829a4aSRandall Stewart 				 * a FIRST fragment mark.
806f8829a4aSRandall Stewart 				 */
807f8829a4aSRandall Stewart #ifdef SCTP_DEBUG
808f8829a4aSRandall Stewart 				if (sctp_debug_on & SCTP_DEBUG_INDATA1) {
809f8829a4aSRandall Stewart 					printf("Gak, Evil plot, its not first, no fragmented delivery in progress\n");
810f8829a4aSRandall Stewart 				}
811f8829a4aSRandall Stewart #endif
812139bc87fSRandall Stewart 				oper = sctp_get_mbuf_for_msg((sizeof(struct sctp_paramhdr) + 3 * sizeof(uint32_t)),
813f8829a4aSRandall Stewart 				    0, M_DONTWAIT, 1, MT_DATA);
814f8829a4aSRandall Stewart 
815f8829a4aSRandall Stewart 				if (oper) {
816f8829a4aSRandall Stewart 					struct sctp_paramhdr *ph;
817f8829a4aSRandall Stewart 					uint32_t *ippp;
818f8829a4aSRandall Stewart 
819139bc87fSRandall Stewart 					SCTP_BUF_LEN(oper) =
820f8829a4aSRandall Stewart 					    sizeof(struct sctp_paramhdr) +
821f8829a4aSRandall Stewart 					    (sizeof(uint32_t) * 3);
822f8829a4aSRandall Stewart 					ph = mtod(oper, struct sctp_paramhdr *);
823f8829a4aSRandall Stewart 					ph->param_type =
824f8829a4aSRandall Stewart 					    htons(SCTP_CAUSE_PROTOCOL_VIOLATION);
825139bc87fSRandall Stewart 					ph->param_length = htons(SCTP_BUF_LEN(oper));
826f8829a4aSRandall Stewart 					ippp = (uint32_t *) (ph + 1);
827a5d547adSRandall Stewart 					*ippp = htonl(SCTP_FROM_SCTP_INDATA + SCTP_LOC_2);
828f8829a4aSRandall Stewart 					ippp++;
829f8829a4aSRandall Stewart 					*ippp = chk->rec.data.TSN_seq;
830f8829a4aSRandall Stewart 					ippp++;
831f8829a4aSRandall Stewart 					*ippp = ((chk->rec.data.stream_number << 16) | chk->rec.data.stream_seq);
832f8829a4aSRandall Stewart 
833f8829a4aSRandall Stewart 				}
834a5d547adSRandall Stewart 				stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_2;
835f8829a4aSRandall Stewart 				sctp_abort_an_association(stcb->sctp_ep, stcb,
836f8829a4aSRandall Stewart 				    SCTP_PEER_FAULTY, oper);
837f8829a4aSRandall Stewart 				*abort_flag = 1;
838f8829a4aSRandall Stewart 			} else if (asoc->fragmented_delivery_inprogress &&
839f8829a4aSRandall Stewart 			    (chk->rec.data.rcv_flags & SCTP_DATA_FIRST_FRAG) == SCTP_DATA_FIRST_FRAG) {
840f8829a4aSRandall Stewart 				/*
841f8829a4aSRandall Stewart 				 * We are doing a partial delivery and the
842f8829a4aSRandall Stewart 				 * NEXT chunk MUST be either the LAST or
843f8829a4aSRandall Stewart 				 * MIDDLE fragment NOT a FIRST
844f8829a4aSRandall Stewart 				 */
845f8829a4aSRandall Stewart #ifdef SCTP_DEBUG
846f8829a4aSRandall Stewart 				if (sctp_debug_on & SCTP_DEBUG_INDATA1) {
847f8829a4aSRandall Stewart 					printf("Gak, Evil plot, it IS a first and fragmented delivery in progress\n");
848f8829a4aSRandall Stewart 				}
849f8829a4aSRandall Stewart #endif
850139bc87fSRandall Stewart 				oper = sctp_get_mbuf_for_msg((sizeof(struct sctp_paramhdr) + 3 * sizeof(uint32_t)),
851f8829a4aSRandall Stewart 				    0, M_DONTWAIT, 1, MT_DATA);
852f8829a4aSRandall Stewart 				if (oper) {
853f8829a4aSRandall Stewart 					struct sctp_paramhdr *ph;
854f8829a4aSRandall Stewart 					uint32_t *ippp;
855f8829a4aSRandall Stewart 
856139bc87fSRandall Stewart 					SCTP_BUF_LEN(oper) =
857f8829a4aSRandall Stewart 					    sizeof(struct sctp_paramhdr) +
858f8829a4aSRandall Stewart 					    (3 * sizeof(uint32_t));
859f8829a4aSRandall Stewart 					ph = mtod(oper, struct sctp_paramhdr *);
860f8829a4aSRandall Stewart 					ph->param_type =
861f8829a4aSRandall Stewart 					    htons(SCTP_CAUSE_PROTOCOL_VIOLATION);
862139bc87fSRandall Stewart 					ph->param_length = htons(SCTP_BUF_LEN(oper));
863f8829a4aSRandall Stewart 					ippp = (uint32_t *) (ph + 1);
864a5d547adSRandall Stewart 					*ippp = htonl(SCTP_FROM_SCTP_INDATA + SCTP_LOC_3);
865f8829a4aSRandall Stewart 					ippp++;
866f8829a4aSRandall Stewart 					*ippp = chk->rec.data.TSN_seq;
867f8829a4aSRandall Stewart 					ippp++;
868f8829a4aSRandall Stewart 					*ippp = ((chk->rec.data.stream_number << 16) | chk->rec.data.stream_seq);
869f8829a4aSRandall Stewart 				}
870a5d547adSRandall Stewart 				stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_3;
871f8829a4aSRandall Stewart 				sctp_abort_an_association(stcb->sctp_ep, stcb,
872f8829a4aSRandall Stewart 				    SCTP_PEER_FAULTY, oper);
873f8829a4aSRandall Stewart 				*abort_flag = 1;
874f8829a4aSRandall Stewart 			} else if (asoc->fragmented_delivery_inprogress) {
875f8829a4aSRandall Stewart 				/*
876f8829a4aSRandall Stewart 				 * Here we are ok with a MIDDLE or LAST
877f8829a4aSRandall Stewart 				 * piece
878f8829a4aSRandall Stewart 				 */
879f8829a4aSRandall Stewart 				if (chk->rec.data.stream_number !=
880f8829a4aSRandall Stewart 				    asoc->str_of_pdapi) {
881f8829a4aSRandall Stewart 					/* Got to be the right STR No */
882f8829a4aSRandall Stewart #ifdef SCTP_DEBUG
883f8829a4aSRandall Stewart 					if (sctp_debug_on & SCTP_DEBUG_INDATA1) {
884f8829a4aSRandall Stewart 						printf("Gak, Evil plot, it IS not same stream number %d vs %d\n",
885f8829a4aSRandall Stewart 						    chk->rec.data.stream_number,
886f8829a4aSRandall Stewart 						    asoc->str_of_pdapi);
887f8829a4aSRandall Stewart 					}
888f8829a4aSRandall Stewart #endif
889139bc87fSRandall Stewart 					oper = sctp_get_mbuf_for_msg((sizeof(struct sctp_paramhdr) + 3 * sizeof(uint32_t)),
890f8829a4aSRandall Stewart 					    0, M_DONTWAIT, 1, MT_DATA);
891f8829a4aSRandall Stewart 					if (oper) {
892f8829a4aSRandall Stewart 						struct sctp_paramhdr *ph;
893f8829a4aSRandall Stewart 						uint32_t *ippp;
894f8829a4aSRandall Stewart 
895139bc87fSRandall Stewart 						SCTP_BUF_LEN(oper) =
896f8829a4aSRandall Stewart 						    sizeof(struct sctp_paramhdr) +
897f8829a4aSRandall Stewart 						    (sizeof(uint32_t) * 3);
898f8829a4aSRandall Stewart 						ph = mtod(oper,
899f8829a4aSRandall Stewart 						    struct sctp_paramhdr *);
900f8829a4aSRandall Stewart 						ph->param_type =
901f8829a4aSRandall Stewart 						    htons(SCTP_CAUSE_PROTOCOL_VIOLATION);
902f8829a4aSRandall Stewart 						ph->param_length =
903139bc87fSRandall Stewart 						    htons(SCTP_BUF_LEN(oper));
904f8829a4aSRandall Stewart 						ippp = (uint32_t *) (ph + 1);
905a5d547adSRandall Stewart 						*ippp = htonl(SCTP_FROM_SCTP_INDATA + SCTP_LOC_4);
906f8829a4aSRandall Stewart 						ippp++;
907f8829a4aSRandall Stewart 						*ippp = chk->rec.data.TSN_seq;
908f8829a4aSRandall Stewart 						ippp++;
909f8829a4aSRandall Stewart 						*ippp = ((chk->rec.data.stream_number << 16) | chk->rec.data.stream_seq);
910f8829a4aSRandall Stewart 					}
911a5d547adSRandall Stewart 					stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_4;
912f8829a4aSRandall Stewart 					sctp_abort_an_association(stcb->sctp_ep,
913f8829a4aSRandall Stewart 					    stcb, SCTP_PEER_FAULTY, oper);
914f8829a4aSRandall Stewart 					*abort_flag = 1;
915f8829a4aSRandall Stewart 				} else if ((asoc->fragment_flags & SCTP_DATA_UNORDERED) !=
916f8829a4aSRandall Stewart 					    SCTP_DATA_UNORDERED &&
917f8829a4aSRandall Stewart 					    chk->rec.data.stream_seq !=
918f8829a4aSRandall Stewart 				    asoc->ssn_of_pdapi) {
919f8829a4aSRandall Stewart 					/* Got to be the right STR Seq */
920f8829a4aSRandall Stewart #ifdef SCTP_DEBUG
921f8829a4aSRandall Stewart 					if (sctp_debug_on & SCTP_DEBUG_INDATA1) {
922f8829a4aSRandall Stewart 						printf("Gak, Evil plot, it IS not same stream seq %d vs %d\n",
923f8829a4aSRandall Stewart 						    chk->rec.data.stream_seq,
924f8829a4aSRandall Stewart 						    asoc->ssn_of_pdapi);
925f8829a4aSRandall Stewart 					}
926f8829a4aSRandall Stewart #endif
927139bc87fSRandall Stewart 					oper = sctp_get_mbuf_for_msg((sizeof(struct sctp_paramhdr) + 3 * sizeof(uint32_t)),
928f8829a4aSRandall Stewart 					    0, M_DONTWAIT, 1, MT_DATA);
929f8829a4aSRandall Stewart 					if (oper) {
930f8829a4aSRandall Stewart 						struct sctp_paramhdr *ph;
931f8829a4aSRandall Stewart 						uint32_t *ippp;
932f8829a4aSRandall Stewart 
933139bc87fSRandall Stewart 						SCTP_BUF_LEN(oper) =
934f8829a4aSRandall Stewart 						    sizeof(struct sctp_paramhdr) +
935f8829a4aSRandall Stewart 						    (3 * sizeof(uint32_t));
936f8829a4aSRandall Stewart 						ph = mtod(oper,
937f8829a4aSRandall Stewart 						    struct sctp_paramhdr *);
938f8829a4aSRandall Stewart 						ph->param_type =
939f8829a4aSRandall Stewart 						    htons(SCTP_CAUSE_PROTOCOL_VIOLATION);
940f8829a4aSRandall Stewart 						ph->param_length =
941139bc87fSRandall Stewart 						    htons(SCTP_BUF_LEN(oper));
942f8829a4aSRandall Stewart 						ippp = (uint32_t *) (ph + 1);
943a5d547adSRandall Stewart 						*ippp = htonl(SCTP_FROM_SCTP_INDATA + SCTP_LOC_5);
944f8829a4aSRandall Stewart 						ippp++;
945f8829a4aSRandall Stewart 						*ippp = chk->rec.data.TSN_seq;
946f8829a4aSRandall Stewart 						ippp++;
947f8829a4aSRandall Stewart 						*ippp = ((chk->rec.data.stream_number << 16) | chk->rec.data.stream_seq);
948f8829a4aSRandall Stewart 
949f8829a4aSRandall Stewart 					}
950a5d547adSRandall Stewart 					stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_5;
951f8829a4aSRandall Stewart 					sctp_abort_an_association(stcb->sctp_ep,
952f8829a4aSRandall Stewart 					    stcb, SCTP_PEER_FAULTY, oper);
953f8829a4aSRandall Stewart 					*abort_flag = 1;
954f8829a4aSRandall Stewart 				}
955f8829a4aSRandall Stewart 			}
956f8829a4aSRandall Stewart 		}
957f8829a4aSRandall Stewart 		return;
958f8829a4aSRandall Stewart 	}
959f8829a4aSRandall Stewart 	/* Find its place */
960f8829a4aSRandall Stewart 	TAILQ_FOREACH(at, &asoc->reasmqueue, sctp_next) {
961f8829a4aSRandall Stewart 		if (compare_with_wrap(at->rec.data.TSN_seq,
962f8829a4aSRandall Stewart 		    chk->rec.data.TSN_seq, MAX_TSN)) {
963f8829a4aSRandall Stewart 			/*
964f8829a4aSRandall Stewart 			 * one in queue is bigger than the new one, insert
965f8829a4aSRandall Stewart 			 * before this one
966f8829a4aSRandall Stewart 			 */
967f8829a4aSRandall Stewart 			/* A check */
968f8829a4aSRandall Stewart 			asoc->size_on_reasm_queue += chk->send_size;
969f8829a4aSRandall Stewart 			sctp_ucount_incr(asoc->cnt_on_reasm_queue);
970f8829a4aSRandall Stewart 			next = at;
971f8829a4aSRandall Stewart 			TAILQ_INSERT_BEFORE(at, chk, sctp_next);
972f8829a4aSRandall Stewart 			break;
973f8829a4aSRandall Stewart 		} else if (at->rec.data.TSN_seq == chk->rec.data.TSN_seq) {
974f8829a4aSRandall Stewart 			/* Gak, He sent me a duplicate str seq number */
975f8829a4aSRandall Stewart 			/*
976f8829a4aSRandall Stewart 			 * foo bar, I guess I will just free this new guy,
977f8829a4aSRandall Stewart 			 * should we abort too? FIX ME MAYBE? Or it COULD be
978f8829a4aSRandall Stewart 			 * that the SSN's have wrapped. Maybe I should
979f8829a4aSRandall Stewart 			 * compare to TSN somehow... sigh for now just blow
980f8829a4aSRandall Stewart 			 * away the chunk!
981f8829a4aSRandall Stewart 			 */
982f8829a4aSRandall Stewart 			if (chk->data) {
983f8829a4aSRandall Stewart 				sctp_m_freem(chk->data);
984f8829a4aSRandall Stewart 				chk->data = NULL;
985f8829a4aSRandall Stewart 			}
986f8829a4aSRandall Stewart 			sctp_free_remote_addr(chk->whoTo);
987f8829a4aSRandall Stewart 			sctp_free_a_chunk(stcb, chk);
988f8829a4aSRandall Stewart 			return;
989f8829a4aSRandall Stewart 		} else {
990f8829a4aSRandall Stewart 			last_flags = at->rec.data.rcv_flags;
991f8829a4aSRandall Stewart 			last_tsn = at->rec.data.TSN_seq;
992f8829a4aSRandall Stewart 			prev = at;
993f8829a4aSRandall Stewart 			if (TAILQ_NEXT(at, sctp_next) == NULL) {
994f8829a4aSRandall Stewart 				/*
995f8829a4aSRandall Stewart 				 * We are at the end, insert it after this
996f8829a4aSRandall Stewart 				 * one
997f8829a4aSRandall Stewart 				 */
998f8829a4aSRandall Stewart 				/* check it first */
999f8829a4aSRandall Stewart 				asoc->size_on_reasm_queue += chk->send_size;
1000f8829a4aSRandall Stewart 				sctp_ucount_incr(asoc->cnt_on_reasm_queue);
1001f8829a4aSRandall Stewart 				TAILQ_INSERT_AFTER(&asoc->reasmqueue, at, chk, sctp_next);
1002f8829a4aSRandall Stewart 				break;
1003f8829a4aSRandall Stewart 			}
1004f8829a4aSRandall Stewart 		}
1005f8829a4aSRandall Stewart 	}
1006f8829a4aSRandall Stewart 	/* Now the audits */
1007f8829a4aSRandall Stewart 	if (prev) {
1008f8829a4aSRandall Stewart 		prev_tsn = chk->rec.data.TSN_seq - 1;
1009f8829a4aSRandall Stewart 		if (prev_tsn == prev->rec.data.TSN_seq) {
1010f8829a4aSRandall Stewart 			/*
1011f8829a4aSRandall Stewart 			 * Ok the one I am dropping onto the end is the
1012f8829a4aSRandall Stewart 			 * NEXT. A bit of valdiation here.
1013f8829a4aSRandall Stewart 			 */
1014f8829a4aSRandall Stewart 			if ((prev->rec.data.rcv_flags & SCTP_DATA_FRAG_MASK) ==
1015f8829a4aSRandall Stewart 			    SCTP_DATA_FIRST_FRAG ||
1016f8829a4aSRandall Stewart 			    (prev->rec.data.rcv_flags & SCTP_DATA_FRAG_MASK) ==
1017f8829a4aSRandall Stewart 			    SCTP_DATA_MIDDLE_FRAG) {
1018f8829a4aSRandall Stewart 				/*
1019f8829a4aSRandall Stewart 				 * Insert chk MUST be a MIDDLE or LAST
1020f8829a4aSRandall Stewart 				 * fragment
1021f8829a4aSRandall Stewart 				 */
1022f8829a4aSRandall Stewart 				if ((chk->rec.data.rcv_flags & SCTP_DATA_FRAG_MASK) ==
1023f8829a4aSRandall Stewart 				    SCTP_DATA_FIRST_FRAG) {
1024f8829a4aSRandall Stewart #ifdef SCTP_DEBUG
1025f8829a4aSRandall Stewart 					if (sctp_debug_on & SCTP_DEBUG_INDATA1) {
1026f8829a4aSRandall Stewart 						printf("Prev check - It can be a midlle or last but not a first\n");
1027f8829a4aSRandall Stewart 						printf("Gak, Evil plot, it's a FIRST!\n");
1028f8829a4aSRandall Stewart 					}
1029f8829a4aSRandall Stewart #endif
1030139bc87fSRandall Stewart 					oper = sctp_get_mbuf_for_msg((sizeof(struct sctp_paramhdr) + 3 * sizeof(uint32_t)),
1031f8829a4aSRandall Stewart 					    0, M_DONTWAIT, 1, MT_DATA);
1032f8829a4aSRandall Stewart 					if (oper) {
1033f8829a4aSRandall Stewart 						struct sctp_paramhdr *ph;
1034f8829a4aSRandall Stewart 						uint32_t *ippp;
1035f8829a4aSRandall Stewart 
1036139bc87fSRandall Stewart 						SCTP_BUF_LEN(oper) =
1037f8829a4aSRandall Stewart 						    sizeof(struct sctp_paramhdr) +
1038f8829a4aSRandall Stewart 						    (3 * sizeof(uint32_t));
1039f8829a4aSRandall Stewart 						ph = mtod(oper,
1040f8829a4aSRandall Stewart 						    struct sctp_paramhdr *);
1041f8829a4aSRandall Stewart 						ph->param_type =
1042f8829a4aSRandall Stewart 						    htons(SCTP_CAUSE_PROTOCOL_VIOLATION);
1043f8829a4aSRandall Stewart 						ph->param_length =
1044139bc87fSRandall Stewart 						    htons(SCTP_BUF_LEN(oper));
1045f8829a4aSRandall Stewart 						ippp = (uint32_t *) (ph + 1);
1046a5d547adSRandall Stewart 						*ippp = htonl(SCTP_FROM_SCTP_INDATA + SCTP_LOC_6);
1047f8829a4aSRandall Stewart 						ippp++;
1048f8829a4aSRandall Stewart 						*ippp = chk->rec.data.TSN_seq;
1049f8829a4aSRandall Stewart 						ippp++;
1050f8829a4aSRandall Stewart 						*ippp = ((chk->rec.data.stream_number << 16) | chk->rec.data.stream_seq);
1051f8829a4aSRandall Stewart 
1052f8829a4aSRandall Stewart 					}
1053a5d547adSRandall Stewart 					stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_6;
1054f8829a4aSRandall Stewart 					sctp_abort_an_association(stcb->sctp_ep,
1055f8829a4aSRandall Stewart 					    stcb, SCTP_PEER_FAULTY, oper);
1056f8829a4aSRandall Stewart 					*abort_flag = 1;
1057f8829a4aSRandall Stewart 					return;
1058f8829a4aSRandall Stewart 				}
1059f8829a4aSRandall Stewart 				if (chk->rec.data.stream_number !=
1060f8829a4aSRandall Stewart 				    prev->rec.data.stream_number) {
1061f8829a4aSRandall Stewart 					/*
1062f8829a4aSRandall Stewart 					 * Huh, need the correct STR here,
1063f8829a4aSRandall Stewart 					 * they must be the same.
1064f8829a4aSRandall Stewart 					 */
1065f8829a4aSRandall Stewart #ifdef SCTP_DEBUG
1066f8829a4aSRandall Stewart 					if (sctp_debug_on & SCTP_DEBUG_INDATA1) {
1067f8829a4aSRandall Stewart 						printf("Prev check - Gak, Evil plot, ssn:%d not the same as at:%d\n",
1068f8829a4aSRandall Stewart 						    chk->rec.data.stream_number,
1069f8829a4aSRandall Stewart 						    prev->rec.data.stream_number);
1070f8829a4aSRandall Stewart 					}
1071f8829a4aSRandall Stewart #endif
1072139bc87fSRandall Stewart 					oper = sctp_get_mbuf_for_msg((sizeof(struct sctp_paramhdr) + 3 * sizeof(uint32_t)),
1073f8829a4aSRandall Stewart 					    0, M_DONTWAIT, 1, MT_DATA);
1074f8829a4aSRandall Stewart 					if (oper) {
1075f8829a4aSRandall Stewart 						struct sctp_paramhdr *ph;
1076f8829a4aSRandall Stewart 						uint32_t *ippp;
1077f8829a4aSRandall Stewart 
1078139bc87fSRandall Stewart 						SCTP_BUF_LEN(oper) =
1079f8829a4aSRandall Stewart 						    sizeof(struct sctp_paramhdr) +
1080f8829a4aSRandall Stewart 						    (3 * sizeof(uint32_t));
1081f8829a4aSRandall Stewart 						ph = mtod(oper,
1082f8829a4aSRandall Stewart 						    struct sctp_paramhdr *);
1083f8829a4aSRandall Stewart 						ph->param_type =
1084f8829a4aSRandall Stewart 						    htons(SCTP_CAUSE_PROTOCOL_VIOLATION);
1085f8829a4aSRandall Stewart 						ph->param_length =
1086139bc87fSRandall Stewart 						    htons(SCTP_BUF_LEN(oper));
1087f8829a4aSRandall Stewart 						ippp = (uint32_t *) (ph + 1);
1088a5d547adSRandall Stewart 						*ippp = htonl(SCTP_FROM_SCTP_INDATA + SCTP_LOC_7);
1089f8829a4aSRandall Stewart 						ippp++;
1090f8829a4aSRandall Stewart 						*ippp = chk->rec.data.TSN_seq;
1091f8829a4aSRandall Stewart 						ippp++;
1092f8829a4aSRandall Stewart 						*ippp = ((chk->rec.data.stream_number << 16) | chk->rec.data.stream_seq);
1093f8829a4aSRandall Stewart 					}
1094a5d547adSRandall Stewart 					stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_7;
1095f8829a4aSRandall Stewart 					sctp_abort_an_association(stcb->sctp_ep,
1096f8829a4aSRandall Stewart 					    stcb, SCTP_PEER_FAULTY, oper);
1097f8829a4aSRandall Stewart 
1098f8829a4aSRandall Stewart 					*abort_flag = 1;
1099f8829a4aSRandall Stewart 					return;
1100f8829a4aSRandall Stewart 				}
1101f8829a4aSRandall Stewart 				if ((prev->rec.data.rcv_flags & SCTP_DATA_UNORDERED) == 0 &&
1102f8829a4aSRandall Stewart 				    chk->rec.data.stream_seq !=
1103f8829a4aSRandall Stewart 				    prev->rec.data.stream_seq) {
1104f8829a4aSRandall Stewart 					/*
1105f8829a4aSRandall Stewart 					 * Huh, need the correct STR here,
1106f8829a4aSRandall Stewart 					 * they must be the same.
1107f8829a4aSRandall Stewart 					 */
1108f8829a4aSRandall Stewart #ifdef SCTP_DEBUG
1109f8829a4aSRandall Stewart 					if (sctp_debug_on & SCTP_DEBUG_INDATA1) {
1110f8829a4aSRandall Stewart 						printf("Prev check - Gak, Evil plot, sseq:%d not the same as at:%d\n",
1111f8829a4aSRandall Stewart 						    chk->rec.data.stream_seq,
1112f8829a4aSRandall Stewart 						    prev->rec.data.stream_seq);
1113f8829a4aSRandall Stewart 					}
1114f8829a4aSRandall Stewart #endif
1115139bc87fSRandall Stewart 					oper = sctp_get_mbuf_for_msg((sizeof(struct sctp_paramhdr) + 3 * sizeof(uint32_t)),
1116f8829a4aSRandall Stewart 					    0, M_DONTWAIT, 1, MT_DATA);
1117f8829a4aSRandall Stewart 					if (oper) {
1118f8829a4aSRandall Stewart 						struct sctp_paramhdr *ph;
1119f8829a4aSRandall Stewart 						uint32_t *ippp;
1120f8829a4aSRandall Stewart 
1121139bc87fSRandall Stewart 						SCTP_BUF_LEN(oper) =
1122f8829a4aSRandall Stewart 						    sizeof(struct sctp_paramhdr) +
1123f8829a4aSRandall Stewart 						    (3 * sizeof(uint32_t));
1124f8829a4aSRandall Stewart 						ph = mtod(oper,
1125f8829a4aSRandall Stewart 						    struct sctp_paramhdr *);
1126f8829a4aSRandall Stewart 						ph->param_type =
1127f8829a4aSRandall Stewart 						    htons(SCTP_CAUSE_PROTOCOL_VIOLATION);
1128f8829a4aSRandall Stewart 						ph->param_length =
1129139bc87fSRandall Stewart 						    htons(SCTP_BUF_LEN(oper));
1130f8829a4aSRandall Stewart 						ippp = (uint32_t *) (ph + 1);
1131a5d547adSRandall Stewart 						*ippp = htonl(SCTP_FROM_SCTP_INDATA + SCTP_LOC_8);
1132f8829a4aSRandall Stewart 						ippp++;
1133f8829a4aSRandall Stewart 						*ippp = chk->rec.data.TSN_seq;
1134f8829a4aSRandall Stewart 						ippp++;
1135f8829a4aSRandall Stewart 						*ippp = ((chk->rec.data.stream_number << 16) | chk->rec.data.stream_seq);
1136f8829a4aSRandall Stewart 					}
1137a5d547adSRandall Stewart 					stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_8;
1138f8829a4aSRandall Stewart 					sctp_abort_an_association(stcb->sctp_ep,
1139f8829a4aSRandall Stewart 					    stcb, SCTP_PEER_FAULTY, oper);
1140f8829a4aSRandall Stewart 
1141f8829a4aSRandall Stewart 					*abort_flag = 1;
1142f8829a4aSRandall Stewart 					return;
1143f8829a4aSRandall Stewart 				}
1144f8829a4aSRandall Stewart 			} else if ((prev->rec.data.rcv_flags & SCTP_DATA_FRAG_MASK) ==
1145f8829a4aSRandall Stewart 			    SCTP_DATA_LAST_FRAG) {
1146f8829a4aSRandall Stewart 				/* Insert chk MUST be a FIRST */
1147f8829a4aSRandall Stewart 				if ((chk->rec.data.rcv_flags & SCTP_DATA_FRAG_MASK) !=
1148f8829a4aSRandall Stewart 				    SCTP_DATA_FIRST_FRAG) {
1149f8829a4aSRandall Stewart #ifdef SCTP_DEBUG
1150f8829a4aSRandall Stewart 					if (sctp_debug_on & SCTP_DEBUG_INDATA1) {
1151f8829a4aSRandall Stewart 						printf("Prev check - Gak, evil plot, its not FIRST and it must be!\n");
1152f8829a4aSRandall Stewart 					}
1153f8829a4aSRandall Stewart #endif
1154139bc87fSRandall Stewart 					oper = sctp_get_mbuf_for_msg((sizeof(struct sctp_paramhdr) + 3 * sizeof(uint32_t)),
1155f8829a4aSRandall Stewart 					    0, M_DONTWAIT, 1, MT_DATA);
1156f8829a4aSRandall Stewart 					if (oper) {
1157f8829a4aSRandall Stewart 						struct sctp_paramhdr *ph;
1158f8829a4aSRandall Stewart 						uint32_t *ippp;
1159f8829a4aSRandall Stewart 
1160139bc87fSRandall Stewart 						SCTP_BUF_LEN(oper) =
1161f8829a4aSRandall Stewart 						    sizeof(struct sctp_paramhdr) +
1162f8829a4aSRandall Stewart 						    (3 * sizeof(uint32_t));
1163f8829a4aSRandall Stewart 						ph = mtod(oper,
1164f8829a4aSRandall Stewart 						    struct sctp_paramhdr *);
1165f8829a4aSRandall Stewart 						ph->param_type =
1166f8829a4aSRandall Stewart 						    htons(SCTP_CAUSE_PROTOCOL_VIOLATION);
1167f8829a4aSRandall Stewart 						ph->param_length =
1168139bc87fSRandall Stewart 						    htons(SCTP_BUF_LEN(oper));
1169f8829a4aSRandall Stewart 						ippp = (uint32_t *) (ph + 1);
1170a5d547adSRandall Stewart 						*ippp = htonl(SCTP_FROM_SCTP_INDATA + SCTP_LOC_9);
1171f8829a4aSRandall Stewart 						ippp++;
1172f8829a4aSRandall Stewart 						*ippp = chk->rec.data.TSN_seq;
1173f8829a4aSRandall Stewart 						ippp++;
1174f8829a4aSRandall Stewart 						*ippp = ((chk->rec.data.stream_number << 16) | chk->rec.data.stream_seq);
1175f8829a4aSRandall Stewart 
1176f8829a4aSRandall Stewart 					}
1177a5d547adSRandall Stewart 					stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_9;
1178f8829a4aSRandall Stewart 					sctp_abort_an_association(stcb->sctp_ep,
1179f8829a4aSRandall Stewart 					    stcb, SCTP_PEER_FAULTY, oper);
1180f8829a4aSRandall Stewart 
1181f8829a4aSRandall Stewart 					*abort_flag = 1;
1182f8829a4aSRandall Stewart 					return;
1183f8829a4aSRandall Stewart 				}
1184f8829a4aSRandall Stewart 			}
1185f8829a4aSRandall Stewart 		}
1186f8829a4aSRandall Stewart 	}
1187f8829a4aSRandall Stewart 	if (next) {
1188f8829a4aSRandall Stewart 		post_tsn = chk->rec.data.TSN_seq + 1;
1189f8829a4aSRandall Stewart 		if (post_tsn == next->rec.data.TSN_seq) {
1190f8829a4aSRandall Stewart 			/*
1191f8829a4aSRandall Stewart 			 * Ok the one I am inserting ahead of is my NEXT
1192f8829a4aSRandall Stewart 			 * one. A bit of valdiation here.
1193f8829a4aSRandall Stewart 			 */
1194f8829a4aSRandall Stewart 			if (next->rec.data.rcv_flags & SCTP_DATA_FIRST_FRAG) {
1195f8829a4aSRandall Stewart 				/* Insert chk MUST be a last fragment */
1196f8829a4aSRandall Stewart 				if ((chk->rec.data.rcv_flags & SCTP_DATA_FRAG_MASK)
1197f8829a4aSRandall Stewart 				    != SCTP_DATA_LAST_FRAG) {
1198f8829a4aSRandall Stewart #ifdef SCTP_DEBUG
1199f8829a4aSRandall Stewart 					if (sctp_debug_on & SCTP_DEBUG_INDATA1) {
1200f8829a4aSRandall Stewart 						printf("Next chk - Next is FIRST, we must be LAST\n");
1201f8829a4aSRandall Stewart 						printf("Gak, Evil plot, its not a last!\n");
1202f8829a4aSRandall Stewart 					}
1203f8829a4aSRandall Stewart #endif
1204139bc87fSRandall Stewart 					oper = sctp_get_mbuf_for_msg((sizeof(struct sctp_paramhdr) + 3 * sizeof(uint32_t)),
1205f8829a4aSRandall Stewart 					    0, M_DONTWAIT, 1, MT_DATA);
1206f8829a4aSRandall Stewart 					if (oper) {
1207f8829a4aSRandall Stewart 						struct sctp_paramhdr *ph;
1208f8829a4aSRandall Stewart 						uint32_t *ippp;
1209f8829a4aSRandall Stewart 
1210139bc87fSRandall Stewart 						SCTP_BUF_LEN(oper) =
1211f8829a4aSRandall Stewart 						    sizeof(struct sctp_paramhdr) +
1212f8829a4aSRandall Stewart 						    (3 * sizeof(uint32_t));
1213f8829a4aSRandall Stewart 						ph = mtod(oper,
1214f8829a4aSRandall Stewart 						    struct sctp_paramhdr *);
1215f8829a4aSRandall Stewart 						ph->param_type =
1216f8829a4aSRandall Stewart 						    htons(SCTP_CAUSE_PROTOCOL_VIOLATION);
1217f8829a4aSRandall Stewart 						ph->param_length =
1218139bc87fSRandall Stewart 						    htons(SCTP_BUF_LEN(oper));
1219f8829a4aSRandall Stewart 						ippp = (uint32_t *) (ph + 1);
1220a5d547adSRandall Stewart 						*ippp = htonl(SCTP_FROM_SCTP_INDATA + SCTP_LOC_10);
1221f8829a4aSRandall Stewart 						ippp++;
1222f8829a4aSRandall Stewart 						*ippp = chk->rec.data.TSN_seq;
1223f8829a4aSRandall Stewart 						ippp++;
1224f8829a4aSRandall Stewart 						*ippp = ((chk->rec.data.stream_number << 16) | chk->rec.data.stream_seq);
1225f8829a4aSRandall Stewart 					}
1226a5d547adSRandall Stewart 					stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_10;
1227f8829a4aSRandall Stewart 					sctp_abort_an_association(stcb->sctp_ep,
1228f8829a4aSRandall Stewart 					    stcb, SCTP_PEER_FAULTY, oper);
1229f8829a4aSRandall Stewart 
1230f8829a4aSRandall Stewart 					*abort_flag = 1;
1231f8829a4aSRandall Stewart 					return;
1232f8829a4aSRandall Stewart 				}
1233f8829a4aSRandall Stewart 			} else if ((next->rec.data.rcv_flags & SCTP_DATA_FRAG_MASK) ==
1234f8829a4aSRandall Stewart 				    SCTP_DATA_MIDDLE_FRAG ||
1235f8829a4aSRandall Stewart 				    (next->rec.data.rcv_flags & SCTP_DATA_FRAG_MASK) ==
1236f8829a4aSRandall Stewart 			    SCTP_DATA_LAST_FRAG) {
1237f8829a4aSRandall Stewart 				/*
1238f8829a4aSRandall Stewart 				 * Insert chk CAN be MIDDLE or FIRST NOT
1239f8829a4aSRandall Stewart 				 * LAST
1240f8829a4aSRandall Stewart 				 */
1241f8829a4aSRandall Stewart 				if ((chk->rec.data.rcv_flags & SCTP_DATA_FRAG_MASK) ==
1242f8829a4aSRandall Stewart 				    SCTP_DATA_LAST_FRAG) {
1243f8829a4aSRandall Stewart #ifdef SCTP_DEBUG
1244f8829a4aSRandall Stewart 					if (sctp_debug_on & SCTP_DEBUG_INDATA1) {
1245f8829a4aSRandall Stewart 						printf("Next chk - Next is a MIDDLE/LAST\n");
1246f8829a4aSRandall Stewart 						printf("Gak, Evil plot, new prev chunk is a LAST\n");
1247f8829a4aSRandall Stewart 					}
1248f8829a4aSRandall Stewart #endif
1249139bc87fSRandall Stewart 					oper = sctp_get_mbuf_for_msg((sizeof(struct sctp_paramhdr) + 3 * sizeof(uint32_t)),
1250f8829a4aSRandall Stewart 					    0, M_DONTWAIT, 1, MT_DATA);
1251f8829a4aSRandall Stewart 					if (oper) {
1252f8829a4aSRandall Stewart 						struct sctp_paramhdr *ph;
1253f8829a4aSRandall Stewart 						uint32_t *ippp;
1254f8829a4aSRandall Stewart 
1255139bc87fSRandall Stewart 						SCTP_BUF_LEN(oper) =
1256f8829a4aSRandall Stewart 						    sizeof(struct sctp_paramhdr) +
1257f8829a4aSRandall Stewart 						    (3 * sizeof(uint32_t));
1258f8829a4aSRandall Stewart 						ph = mtod(oper,
1259f8829a4aSRandall Stewart 						    struct sctp_paramhdr *);
1260f8829a4aSRandall Stewart 						ph->param_type =
1261f8829a4aSRandall Stewart 						    htons(SCTP_CAUSE_PROTOCOL_VIOLATION);
1262f8829a4aSRandall Stewart 						ph->param_length =
1263139bc87fSRandall Stewart 						    htons(SCTP_BUF_LEN(oper));
1264f8829a4aSRandall Stewart 						ippp = (uint32_t *) (ph + 1);
1265a5d547adSRandall Stewart 						*ippp = htonl(SCTP_FROM_SCTP_INDATA + SCTP_LOC_11);
1266f8829a4aSRandall Stewart 						ippp++;
1267f8829a4aSRandall Stewart 						*ippp = chk->rec.data.TSN_seq;
1268f8829a4aSRandall Stewart 						ippp++;
1269f8829a4aSRandall Stewart 						*ippp = ((chk->rec.data.stream_number << 16) | chk->rec.data.stream_seq);
1270f8829a4aSRandall Stewart 
1271f8829a4aSRandall Stewart 					}
1272a5d547adSRandall Stewart 					stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_11;
1273f8829a4aSRandall Stewart 					sctp_abort_an_association(stcb->sctp_ep,
1274f8829a4aSRandall Stewart 					    stcb, SCTP_PEER_FAULTY, oper);
1275f8829a4aSRandall Stewart 
1276f8829a4aSRandall Stewart 					*abort_flag = 1;
1277f8829a4aSRandall Stewart 					return;
1278f8829a4aSRandall Stewart 				}
1279f8829a4aSRandall Stewart 				if (chk->rec.data.stream_number !=
1280f8829a4aSRandall Stewart 				    next->rec.data.stream_number) {
1281f8829a4aSRandall Stewart 					/*
1282f8829a4aSRandall Stewart 					 * Huh, need the correct STR here,
1283f8829a4aSRandall Stewart 					 * they must be the same.
1284f8829a4aSRandall Stewart 					 */
1285f8829a4aSRandall Stewart #ifdef SCTP_DEBUG
1286f8829a4aSRandall Stewart 					if (sctp_debug_on & SCTP_DEBUG_INDATA1) {
1287f8829a4aSRandall Stewart 						printf("Next chk - Gak, Evil plot, ssn:%d not the same as at:%d\n",
1288f8829a4aSRandall Stewart 						    chk->rec.data.stream_number,
1289f8829a4aSRandall Stewart 						    next->rec.data.stream_number);
1290f8829a4aSRandall Stewart 					}
1291f8829a4aSRandall Stewart #endif
1292139bc87fSRandall Stewart 					oper = sctp_get_mbuf_for_msg((sizeof(struct sctp_paramhdr) + 3 * sizeof(uint32_t)),
1293f8829a4aSRandall Stewart 					    0, M_DONTWAIT, 1, MT_DATA);
1294f8829a4aSRandall Stewart 					if (oper) {
1295f8829a4aSRandall Stewart 						struct sctp_paramhdr *ph;
1296f8829a4aSRandall Stewart 						uint32_t *ippp;
1297f8829a4aSRandall Stewart 
1298139bc87fSRandall Stewart 						SCTP_BUF_LEN(oper) =
1299f8829a4aSRandall Stewart 						    sizeof(struct sctp_paramhdr) +
1300f8829a4aSRandall Stewart 						    (3 * sizeof(uint32_t));
1301f8829a4aSRandall Stewart 						ph = mtod(oper,
1302f8829a4aSRandall Stewart 						    struct sctp_paramhdr *);
1303f8829a4aSRandall Stewart 						ph->param_type =
1304f8829a4aSRandall Stewart 						    htons(SCTP_CAUSE_PROTOCOL_VIOLATION);
1305f8829a4aSRandall Stewart 						ph->param_length =
1306139bc87fSRandall Stewart 						    htons(SCTP_BUF_LEN(oper));
1307f8829a4aSRandall Stewart 						ippp = (uint32_t *) (ph + 1);
1308a5d547adSRandall Stewart 						*ippp = htonl(SCTP_FROM_SCTP_INDATA + SCTP_LOC_12);
1309f8829a4aSRandall Stewart 						ippp++;
1310f8829a4aSRandall Stewart 						*ippp = chk->rec.data.TSN_seq;
1311f8829a4aSRandall Stewart 						ippp++;
1312f8829a4aSRandall Stewart 						*ippp = ((chk->rec.data.stream_number << 16) | chk->rec.data.stream_seq);
1313f8829a4aSRandall Stewart 
1314f8829a4aSRandall Stewart 					}
1315a5d547adSRandall Stewart 					stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_12;
1316f8829a4aSRandall Stewart 					sctp_abort_an_association(stcb->sctp_ep,
1317f8829a4aSRandall Stewart 					    stcb, SCTP_PEER_FAULTY, oper);
1318f8829a4aSRandall Stewart 
1319f8829a4aSRandall Stewart 					*abort_flag = 1;
1320f8829a4aSRandall Stewart 					return;
1321f8829a4aSRandall Stewart 				}
1322f8829a4aSRandall Stewart 				if ((next->rec.data.rcv_flags & SCTP_DATA_UNORDERED) == 0 &&
1323f8829a4aSRandall Stewart 				    chk->rec.data.stream_seq !=
1324f8829a4aSRandall Stewart 				    next->rec.data.stream_seq) {
1325f8829a4aSRandall Stewart 					/*
1326f8829a4aSRandall Stewart 					 * Huh, need the correct STR here,
1327f8829a4aSRandall Stewart 					 * they must be the same.
1328f8829a4aSRandall Stewart 					 */
1329f8829a4aSRandall Stewart #ifdef SCTP_DEBUG
1330f8829a4aSRandall Stewart 					if (sctp_debug_on & SCTP_DEBUG_INDATA1) {
1331f8829a4aSRandall Stewart 						printf("Next chk - Gak, Evil plot, sseq:%d not the same as at:%d\n",
1332f8829a4aSRandall Stewart 						    chk->rec.data.stream_seq,
1333f8829a4aSRandall Stewart 						    next->rec.data.stream_seq);
1334f8829a4aSRandall Stewart 					}
1335f8829a4aSRandall Stewart #endif
1336139bc87fSRandall Stewart 					oper = sctp_get_mbuf_for_msg((sizeof(struct sctp_paramhdr) + 3 * sizeof(uint32_t)),
1337f8829a4aSRandall Stewart 					    0, M_DONTWAIT, 1, MT_DATA);
1338f8829a4aSRandall Stewart 					if (oper) {
1339f8829a4aSRandall Stewart 						struct sctp_paramhdr *ph;
1340f8829a4aSRandall Stewart 						uint32_t *ippp;
1341f8829a4aSRandall Stewart 
1342139bc87fSRandall Stewart 						SCTP_BUF_LEN(oper) =
1343f8829a4aSRandall Stewart 						    sizeof(struct sctp_paramhdr) +
1344f8829a4aSRandall Stewart 						    (3 * sizeof(uint32_t));
1345f8829a4aSRandall Stewart 						ph = mtod(oper,
1346f8829a4aSRandall Stewart 						    struct sctp_paramhdr *);
1347f8829a4aSRandall Stewart 						ph->param_type =
1348f8829a4aSRandall Stewart 						    htons(SCTP_CAUSE_PROTOCOL_VIOLATION);
1349f8829a4aSRandall Stewart 						ph->param_length =
1350139bc87fSRandall Stewart 						    htons(SCTP_BUF_LEN(oper));
1351f8829a4aSRandall Stewart 						ippp = (uint32_t *) (ph + 1);
1352a5d547adSRandall Stewart 						*ippp = htonl(SCTP_FROM_SCTP_INDATA + SCTP_LOC_13);
1353f8829a4aSRandall Stewart 						ippp++;
1354f8829a4aSRandall Stewart 						*ippp = chk->rec.data.TSN_seq;
1355f8829a4aSRandall Stewart 						ippp++;
1356f8829a4aSRandall Stewart 						*ippp = ((chk->rec.data.stream_number << 16) | chk->rec.data.stream_seq);
1357f8829a4aSRandall Stewart 					}
1358a5d547adSRandall Stewart 					stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_13;
1359f8829a4aSRandall Stewart 					sctp_abort_an_association(stcb->sctp_ep,
1360f8829a4aSRandall Stewart 					    stcb, SCTP_PEER_FAULTY, oper);
1361f8829a4aSRandall Stewart 
1362f8829a4aSRandall Stewart 					*abort_flag = 1;
1363f8829a4aSRandall Stewart 					return;
1364f8829a4aSRandall Stewart 
1365f8829a4aSRandall Stewart 				}
1366f8829a4aSRandall Stewart 			}
1367f8829a4aSRandall Stewart 		}
1368f8829a4aSRandall Stewart 	}
1369f8829a4aSRandall Stewart 	/* Do we need to do some delivery? check */
1370f8829a4aSRandall Stewart 	sctp_deliver_reasm_check(stcb, asoc);
1371f8829a4aSRandall Stewart }
1372f8829a4aSRandall Stewart 
1373f8829a4aSRandall Stewart /*
1374f8829a4aSRandall Stewart  * This is an unfortunate routine. It checks to make sure a evil guy is not
1375f8829a4aSRandall Stewart  * stuffing us full of bad packet fragments. A broken peer could also do this
1376f8829a4aSRandall Stewart  * but this is doubtful. It is to bad I must worry about evil crackers sigh
1377f8829a4aSRandall Stewart  * :< more cycles.
1378f8829a4aSRandall Stewart  */
1379f8829a4aSRandall Stewart static int
1380f8829a4aSRandall Stewart sctp_does_tsn_belong_to_reasm(struct sctp_association *asoc,
1381f8829a4aSRandall Stewart     uint32_t TSN_seq)
1382f8829a4aSRandall Stewart {
1383f8829a4aSRandall Stewart 	struct sctp_tmit_chunk *at;
1384f8829a4aSRandall Stewart 	uint32_t tsn_est;
1385f8829a4aSRandall Stewart 
1386f8829a4aSRandall Stewart 	TAILQ_FOREACH(at, &asoc->reasmqueue, sctp_next) {
1387f8829a4aSRandall Stewart 		if (compare_with_wrap(TSN_seq,
1388f8829a4aSRandall Stewart 		    at->rec.data.TSN_seq, MAX_TSN)) {
1389f8829a4aSRandall Stewart 			/* is it one bigger? */
1390f8829a4aSRandall Stewart 			tsn_est = at->rec.data.TSN_seq + 1;
1391f8829a4aSRandall Stewart 			if (tsn_est == TSN_seq) {
1392f8829a4aSRandall Stewart 				/* yep. It better be a last then */
1393f8829a4aSRandall Stewart 				if ((at->rec.data.rcv_flags & SCTP_DATA_FRAG_MASK) !=
1394f8829a4aSRandall Stewart 				    SCTP_DATA_LAST_FRAG) {
1395f8829a4aSRandall Stewart 					/*
1396f8829a4aSRandall Stewart 					 * Ok this guy belongs next to a guy
1397f8829a4aSRandall Stewart 					 * that is NOT last, it should be a
1398f8829a4aSRandall Stewart 					 * middle/last, not a complete
1399f8829a4aSRandall Stewart 					 * chunk.
1400f8829a4aSRandall Stewart 					 */
1401f8829a4aSRandall Stewart 					return (1);
1402f8829a4aSRandall Stewart 				} else {
1403f8829a4aSRandall Stewart 					/*
1404f8829a4aSRandall Stewart 					 * This guy is ok since its a LAST
1405f8829a4aSRandall Stewart 					 * and the new chunk is a fully
1406f8829a4aSRandall Stewart 					 * self- contained one.
1407f8829a4aSRandall Stewart 					 */
1408f8829a4aSRandall Stewart 					return (0);
1409f8829a4aSRandall Stewart 				}
1410f8829a4aSRandall Stewart 			}
1411f8829a4aSRandall Stewart 		} else if (TSN_seq == at->rec.data.TSN_seq) {
1412f8829a4aSRandall Stewart 			/* Software error since I have a dup? */
1413f8829a4aSRandall Stewart 			return (1);
1414f8829a4aSRandall Stewart 		} else {
1415f8829a4aSRandall Stewart 			/*
1416f8829a4aSRandall Stewart 			 * Ok, 'at' is larger than new chunk but does it
1417f8829a4aSRandall Stewart 			 * need to be right before it.
1418f8829a4aSRandall Stewart 			 */
1419f8829a4aSRandall Stewart 			tsn_est = TSN_seq + 1;
1420f8829a4aSRandall Stewart 			if (tsn_est == at->rec.data.TSN_seq) {
1421f8829a4aSRandall Stewart 				/* Yep, It better be a first */
1422f8829a4aSRandall Stewart 				if ((at->rec.data.rcv_flags & SCTP_DATA_FRAG_MASK) !=
1423f8829a4aSRandall Stewart 				    SCTP_DATA_FIRST_FRAG) {
1424f8829a4aSRandall Stewart 					return (1);
1425f8829a4aSRandall Stewart 				} else {
1426f8829a4aSRandall Stewart 					return (0);
1427f8829a4aSRandall Stewart 				}
1428f8829a4aSRandall Stewart 			}
1429f8829a4aSRandall Stewart 		}
1430f8829a4aSRandall Stewart 	}
1431f8829a4aSRandall Stewart 	return (0);
1432f8829a4aSRandall Stewart }
1433f8829a4aSRandall Stewart 
1434f8829a4aSRandall Stewart 
1435f8829a4aSRandall Stewart static int
1436f8829a4aSRandall Stewart sctp_process_a_data_chunk(struct sctp_tcb *stcb, struct sctp_association *asoc,
1437f8829a4aSRandall Stewart     struct mbuf **m, int offset, struct sctp_data_chunk *ch, int chk_length,
1438f8829a4aSRandall Stewart     struct sctp_nets *net, uint32_t * high_tsn, int *abort_flag,
1439f8829a4aSRandall Stewart     int *break_flag, int last_chunk)
1440f8829a4aSRandall Stewart {
1441f8829a4aSRandall Stewart 	/* Process a data chunk */
1442f8829a4aSRandall Stewart 	/* struct sctp_tmit_chunk *chk; */
1443f8829a4aSRandall Stewart 	struct sctp_tmit_chunk *chk;
1444f8829a4aSRandall Stewart 	uint32_t tsn, gap;
1445f8829a4aSRandall Stewart 	struct mbuf *dmbuf;
1446f8829a4aSRandall Stewart 	int indx, the_len;
1447139bc87fSRandall Stewart 	int need_reasm_check = 0;
1448f8829a4aSRandall Stewart 	uint16_t strmno, strmseq;
1449f8829a4aSRandall Stewart 	struct mbuf *oper;
1450f8829a4aSRandall Stewart 	struct sctp_queued_to_read *control;
1451f42a358aSRandall Stewart 	int ordered;
1452f42a358aSRandall Stewart 	uint32_t protocol_id;
1453f42a358aSRandall Stewart 	uint8_t chunk_flags;
1454f8829a4aSRandall Stewart 
1455f8829a4aSRandall Stewart 	chk = NULL;
1456f8829a4aSRandall Stewart 	tsn = ntohl(ch->dp.tsn);
1457f42a358aSRandall Stewart 	chunk_flags = ch->ch.chunk_flags;
1458f42a358aSRandall Stewart 	protocol_id = ch->dp.protocol_id;
1459f42a358aSRandall Stewart 	ordered = ((ch->ch.chunk_flags & SCTP_DATA_UNORDERED) == 0);
1460f8829a4aSRandall Stewart #ifdef SCTP_MAP_LOGGING
1461f8829a4aSRandall Stewart 	sctp_log_map(0, tsn, asoc->cumulative_tsn, SCTP_MAP_PREPARE_SLIDE);
1462f8829a4aSRandall Stewart #endif
1463f8829a4aSRandall Stewart 	if (compare_with_wrap(asoc->cumulative_tsn, tsn, MAX_TSN) ||
1464f8829a4aSRandall Stewart 	    asoc->cumulative_tsn == tsn) {
1465f8829a4aSRandall Stewart 		/* It is a duplicate */
1466f8829a4aSRandall Stewart 		SCTP_STAT_INCR(sctps_recvdupdata);
1467f8829a4aSRandall Stewart 		if (asoc->numduptsns < SCTP_MAX_DUP_TSNS) {
1468f8829a4aSRandall Stewart 			/* Record a dup for the next outbound sack */
1469f8829a4aSRandall Stewart 			asoc->dup_tsns[asoc->numduptsns] = tsn;
1470f8829a4aSRandall Stewart 			asoc->numduptsns++;
1471f8829a4aSRandall Stewart 		}
1472f8829a4aSRandall Stewart 		return (0);
1473f8829a4aSRandall Stewart 	}
1474f8829a4aSRandall Stewart 	/* Calculate the number of TSN's between the base and this TSN */
1475f8829a4aSRandall Stewart 	if (tsn >= asoc->mapping_array_base_tsn) {
1476f8829a4aSRandall Stewart 		gap = tsn - asoc->mapping_array_base_tsn;
1477f8829a4aSRandall Stewart 	} else {
1478f8829a4aSRandall Stewart 		gap = (MAX_TSN - asoc->mapping_array_base_tsn) + tsn + 1;
1479f8829a4aSRandall Stewart 	}
1480f8829a4aSRandall Stewart 	if (gap >= (SCTP_MAPPING_ARRAY << 3)) {
1481f8829a4aSRandall Stewart 		/* Can't hold the bit in the mapping at max array, toss it */
1482f8829a4aSRandall Stewart 		return (0);
1483f8829a4aSRandall Stewart 	}
1484f8829a4aSRandall Stewart 	if (gap >= (uint32_t) (asoc->mapping_array_size << 3)) {
1485f8829a4aSRandall Stewart 		if (sctp_expand_mapping_array(asoc)) {
1486f8829a4aSRandall Stewart 			/* Can't expand, drop it */
1487f8829a4aSRandall Stewart 			return (0);
1488f8829a4aSRandall Stewart 		}
1489f8829a4aSRandall Stewart 	}
1490f8829a4aSRandall Stewart 	if (compare_with_wrap(tsn, *high_tsn, MAX_TSN)) {
1491f8829a4aSRandall Stewart 		*high_tsn = tsn;
1492f8829a4aSRandall Stewart 	}
1493f8829a4aSRandall Stewart 	/* See if we have received this one already */
1494f8829a4aSRandall Stewart 	if (SCTP_IS_TSN_PRESENT(asoc->mapping_array, gap)) {
1495f8829a4aSRandall Stewart 		SCTP_STAT_INCR(sctps_recvdupdata);
1496f8829a4aSRandall Stewart 		if (asoc->numduptsns < SCTP_MAX_DUP_TSNS) {
1497f8829a4aSRandall Stewart 			/* Record a dup for the next outbound sack */
1498f8829a4aSRandall Stewart 			asoc->dup_tsns[asoc->numduptsns] = tsn;
1499f8829a4aSRandall Stewart 			asoc->numduptsns++;
1500f8829a4aSRandall Stewart 		}
150142551e99SRandall Stewart 		asoc->send_sack = 1;
1502f8829a4aSRandall Stewart 		return (0);
1503f8829a4aSRandall Stewart 	}
1504f8829a4aSRandall Stewart 	/*
1505f8829a4aSRandall Stewart 	 * Check to see about the GONE flag, duplicates would cause a sack
1506f8829a4aSRandall Stewart 	 * to be sent up above
1507f8829a4aSRandall Stewart 	 */
1508f8829a4aSRandall Stewart 	if (stcb && ((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE) ||
1509f8829a4aSRandall Stewart 	    (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_SOCKET_ALLGONE) ||
1510f8829a4aSRandall Stewart 	    (stcb->asoc.state & SCTP_STATE_CLOSED_SOCKET))
1511f8829a4aSRandall Stewart 	    ) {
1512f8829a4aSRandall Stewart 		/*
1513f8829a4aSRandall Stewart 		 * wait a minute, this guy is gone, there is no longer a
1514f8829a4aSRandall Stewart 		 * receiver. Send peer an ABORT!
1515f8829a4aSRandall Stewart 		 */
1516f8829a4aSRandall Stewart 		struct mbuf *op_err;
1517f8829a4aSRandall Stewart 
1518f8829a4aSRandall Stewart 		op_err = sctp_generate_invmanparam(SCTP_CAUSE_OUT_OF_RESC);
1519f8829a4aSRandall Stewart 		sctp_abort_an_association(stcb->sctp_ep, stcb, 0, op_err);
1520f8829a4aSRandall Stewart 		*abort_flag = 1;
1521f8829a4aSRandall Stewart 		return (0);
1522f8829a4aSRandall Stewart 	}
1523f8829a4aSRandall Stewart 	/*
1524f8829a4aSRandall Stewart 	 * Now before going further we see if there is room. If NOT then we
1525f8829a4aSRandall Stewart 	 * MAY let one through only IF this TSN is the one we are waiting
1526f8829a4aSRandall Stewart 	 * for on a partial delivery API.
1527f8829a4aSRandall Stewart 	 */
1528f8829a4aSRandall Stewart 
1529f8829a4aSRandall Stewart 	/* now do the tests */
1530f8829a4aSRandall Stewart 	if (((asoc->cnt_on_all_streams +
1531f8829a4aSRandall Stewart 	    asoc->cnt_on_reasm_queue +
1532f8829a4aSRandall Stewart 	    asoc->cnt_msg_on_sb) > sctp_max_chunks_on_queue) ||
1533f8829a4aSRandall Stewart 	    (((int)asoc->my_rwnd) <= 0)) {
1534f8829a4aSRandall Stewart 		/*
1535f8829a4aSRandall Stewart 		 * When we have NO room in the rwnd we check to make sure
1536f8829a4aSRandall Stewart 		 * the reader is doing its job...
1537f8829a4aSRandall Stewart 		 */
1538f8829a4aSRandall Stewart 		if (stcb->sctp_socket->so_rcv.sb_cc) {
1539f8829a4aSRandall Stewart 			/* some to read, wake-up */
1540f8829a4aSRandall Stewart 			sctp_sorwakeup(stcb->sctp_ep, stcb->sctp_socket);
1541f8829a4aSRandall Stewart 		}
1542f8829a4aSRandall Stewart 		/* now is it in the mapping array of what we have accepted? */
1543f8829a4aSRandall Stewart 		if (compare_with_wrap(tsn,
1544f8829a4aSRandall Stewart 		    asoc->highest_tsn_inside_map, MAX_TSN)) {
1545f8829a4aSRandall Stewart 
1546f8829a4aSRandall Stewart 			/* Nope not in the valid range dump it */
1547f8829a4aSRandall Stewart #ifdef SCTP_DEBUG
1548f8829a4aSRandall Stewart 			if (sctp_debug_on & SCTP_DEBUG_INDATA1) {
1549f8829a4aSRandall Stewart 				printf("My rwnd overrun1:tsn:%lx rwnd %lu sbspace:%ld\n",
1550f8829a4aSRandall Stewart 				    (u_long)tsn, (u_long)asoc->my_rwnd,
1551f8829a4aSRandall Stewart 				    sctp_sbspace(&stcb->asoc, &stcb->sctp_socket->so_rcv));
1552f8829a4aSRandall Stewart 
1553f8829a4aSRandall Stewart 			}
1554f8829a4aSRandall Stewart #endif
1555f8829a4aSRandall Stewart 			sctp_set_rwnd(stcb, asoc);
1556f8829a4aSRandall Stewart 			if ((asoc->cnt_on_all_streams +
1557f8829a4aSRandall Stewart 			    asoc->cnt_on_reasm_queue +
1558f8829a4aSRandall Stewart 			    asoc->cnt_msg_on_sb) > sctp_max_chunks_on_queue) {
1559f8829a4aSRandall Stewart 				SCTP_STAT_INCR(sctps_datadropchklmt);
1560f8829a4aSRandall Stewart 			} else {
1561f8829a4aSRandall Stewart 				SCTP_STAT_INCR(sctps_datadroprwnd);
1562f8829a4aSRandall Stewart 			}
1563f8829a4aSRandall Stewart 			indx = *break_flag;
1564f8829a4aSRandall Stewart 			*break_flag = 1;
1565f8829a4aSRandall Stewart 			return (0);
1566f8829a4aSRandall Stewart 		}
1567f8829a4aSRandall Stewart 	}
1568f8829a4aSRandall Stewart 	strmno = ntohs(ch->dp.stream_id);
1569f8829a4aSRandall Stewart 	if (strmno >= asoc->streamincnt) {
1570f8829a4aSRandall Stewart 		struct sctp_paramhdr *phdr;
1571f8829a4aSRandall Stewart 		struct mbuf *mb;
1572f8829a4aSRandall Stewart 
1573f8829a4aSRandall Stewart 		mb = sctp_get_mbuf_for_msg((sizeof(struct sctp_paramhdr) * 2),
1574139bc87fSRandall Stewart 		    0, M_DONTWAIT, 1, MT_DATA);
1575f8829a4aSRandall Stewart 		if (mb != NULL) {
1576f8829a4aSRandall Stewart 			/* add some space up front so prepend will work well */
1577139bc87fSRandall Stewart 			SCTP_BUF_RESV_UF(mb, sizeof(struct sctp_chunkhdr));
1578f8829a4aSRandall Stewart 			phdr = mtod(mb, struct sctp_paramhdr *);
1579f8829a4aSRandall Stewart 			/*
1580f8829a4aSRandall Stewart 			 * Error causes are just param's and this one has
1581f8829a4aSRandall Stewart 			 * two back to back phdr, one with the error type
1582f8829a4aSRandall Stewart 			 * and size, the other with the streamid and a rsvd
1583f8829a4aSRandall Stewart 			 */
1584139bc87fSRandall Stewart 			SCTP_BUF_LEN(mb) = (sizeof(struct sctp_paramhdr) * 2);
1585f8829a4aSRandall Stewart 			phdr->param_type = htons(SCTP_CAUSE_INVALID_STREAM);
1586f8829a4aSRandall Stewart 			phdr->param_length =
1587f8829a4aSRandall Stewart 			    htons(sizeof(struct sctp_paramhdr) * 2);
1588f8829a4aSRandall Stewart 			phdr++;
1589f8829a4aSRandall Stewart 			/* We insert the stream in the type field */
1590f8829a4aSRandall Stewart 			phdr->param_type = ch->dp.stream_id;
1591f8829a4aSRandall Stewart 			/* And set the length to 0 for the rsvd field */
1592f8829a4aSRandall Stewart 			phdr->param_length = 0;
1593f8829a4aSRandall Stewart 			sctp_queue_op_err(stcb, mb);
1594f8829a4aSRandall Stewart 		}
1595f8829a4aSRandall Stewart 		SCTP_STAT_INCR(sctps_badsid);
1596f8829a4aSRandall Stewart 		return (0);
1597f8829a4aSRandall Stewart 	}
1598f8829a4aSRandall Stewart 	/*
1599f8829a4aSRandall Stewart 	 * Before we continue lets validate that we are not being fooled by
1600f8829a4aSRandall Stewart 	 * an evil attacker. We can only have 4k chunks based on our TSN
1601f8829a4aSRandall Stewart 	 * spread allowed by the mapping array 512 * 8 bits, so there is no
1602f8829a4aSRandall Stewart 	 * way our stream sequence numbers could have wrapped. We of course
1603f8829a4aSRandall Stewart 	 * only validate the FIRST fragment so the bit must be set.
1604f8829a4aSRandall Stewart 	 */
1605f8829a4aSRandall Stewart 	strmseq = ntohs(ch->dp.stream_sequence);
1606f42a358aSRandall Stewart 
1607f42a358aSRandall Stewart #ifdef SCTP_ASOCLOG_OF_TSNS
1608f42a358aSRandall Stewart 	asoc->in_tsnlog[asoc->tsn_in_at].tsn = tsn;
1609f42a358aSRandall Stewart 	asoc->in_tsnlog[asoc->tsn_in_at].strm = strmno;
1610f42a358aSRandall Stewart 	asoc->in_tsnlog[asoc->tsn_in_at].seq = strmseq;
1611f1f73e57SRandall Stewart 	asoc->in_tsnlog[asoc->tsn_in_at].sz = chk_length;
1612f1f73e57SRandall Stewart 	asoc->in_tsnlog[asoc->tsn_in_at].flgs = chunk_flags;
1613f42a358aSRandall Stewart 	asoc->tsn_in_at++;
1614f42a358aSRandall Stewart 	if (asoc->tsn_in_at >= SCTP_TSN_LOG_SIZE) {
1615f42a358aSRandall Stewart 		asoc->tsn_in_at = 0;
1616f1f73e57SRandall Stewart 		asoc->tsn_in_wrapped = 1;
1617f42a358aSRandall Stewart 	}
1618f42a358aSRandall Stewart #endif
1619f42a358aSRandall Stewart 	if ((chunk_flags & SCTP_DATA_FIRST_FRAG) &&
1620f42a358aSRandall Stewart 	    (chunk_flags & SCTP_DATA_UNORDERED) == 0 &&
1621f8829a4aSRandall Stewart 	    (compare_with_wrap(asoc->strmin[strmno].last_sequence_delivered,
1622f8829a4aSRandall Stewart 	    strmseq, MAX_SEQ) ||
1623f8829a4aSRandall Stewart 	    asoc->strmin[strmno].last_sequence_delivered == strmseq)) {
1624f8829a4aSRandall Stewart 		/* The incoming sseq is behind where we last delivered? */
1625f8829a4aSRandall Stewart #ifdef SCTP_DEBUG
1626f8829a4aSRandall Stewart 		if (sctp_debug_on & SCTP_DEBUG_INDATA1) {
1627f8829a4aSRandall Stewart 			printf("EVIL/Broken-Dup S-SEQ:%d delivered:%d from peer, Abort!\n",
1628f8829a4aSRandall Stewart 			    strmseq,
1629f8829a4aSRandall Stewart 			    asoc->strmin[strmno].last_sequence_delivered);
1630f8829a4aSRandall Stewart 		}
1631f8829a4aSRandall Stewart #endif
1632f8829a4aSRandall Stewart 		/*
1633f8829a4aSRandall Stewart 		 * throw it in the stream so it gets cleaned up in
1634f8829a4aSRandall Stewart 		 * association destruction
1635f8829a4aSRandall Stewart 		 */
1636139bc87fSRandall Stewart 		oper = sctp_get_mbuf_for_msg((sizeof(struct sctp_paramhdr) + 3 * sizeof(uint32_t)),
1637f8829a4aSRandall Stewart 		    0, M_DONTWAIT, 1, MT_DATA);
1638f8829a4aSRandall Stewart 		if (oper) {
1639f8829a4aSRandall Stewart 			struct sctp_paramhdr *ph;
1640f8829a4aSRandall Stewart 			uint32_t *ippp;
1641f8829a4aSRandall Stewart 
1642139bc87fSRandall Stewart 			SCTP_BUF_LEN(oper) = sizeof(struct sctp_paramhdr) +
1643f8829a4aSRandall Stewart 			    (3 * sizeof(uint32_t));
1644f8829a4aSRandall Stewart 			ph = mtod(oper, struct sctp_paramhdr *);
1645f8829a4aSRandall Stewart 			ph->param_type = htons(SCTP_CAUSE_PROTOCOL_VIOLATION);
1646139bc87fSRandall Stewart 			ph->param_length = htons(SCTP_BUF_LEN(oper));
1647f8829a4aSRandall Stewart 			ippp = (uint32_t *) (ph + 1);
1648a5d547adSRandall Stewart 			*ippp = htonl(SCTP_FROM_SCTP_INDATA + SCTP_LOC_14);
1649f8829a4aSRandall Stewart 			ippp++;
1650f8829a4aSRandall Stewart 			*ippp = tsn;
1651f8829a4aSRandall Stewart 			ippp++;
1652f8829a4aSRandall Stewart 			*ippp = ((strmno << 16) | strmseq);
1653f8829a4aSRandall Stewart 
1654f8829a4aSRandall Stewart 		}
1655a5d547adSRandall Stewart 		stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_14;
1656f8829a4aSRandall Stewart 		sctp_abort_an_association(stcb->sctp_ep, stcb,
1657f8829a4aSRandall Stewart 		    SCTP_PEER_FAULTY, oper);
1658f8829a4aSRandall Stewart 		*abort_flag = 1;
1659f8829a4aSRandall Stewart 		return (0);
1660f8829a4aSRandall Stewart 	}
1661f42a358aSRandall Stewart 	/************************************
1662f42a358aSRandall Stewart 	 * From here down we may find ch-> invalid
1663f42a358aSRandall Stewart 	 * so its a good idea NOT to use it.
1664f42a358aSRandall Stewart 	 *************************************/
1665f42a358aSRandall Stewart 
1666f8829a4aSRandall Stewart 	the_len = (chk_length - sizeof(struct sctp_data_chunk));
1667f8829a4aSRandall Stewart 	if (last_chunk == 0) {
166844b7479bSRandall Stewart 		dmbuf = SCTP_M_COPYM(*m,
1669f8829a4aSRandall Stewart 		    (offset + sizeof(struct sctp_data_chunk)),
1670f8829a4aSRandall Stewart 		    the_len, M_DONTWAIT);
1671f8829a4aSRandall Stewart #ifdef SCTP_MBUF_LOGGING
1672f8829a4aSRandall Stewart 		{
1673f8829a4aSRandall Stewart 			struct mbuf *mat;
1674f8829a4aSRandall Stewart 
1675f8829a4aSRandall Stewart 			mat = dmbuf;
1676f8829a4aSRandall Stewart 			while (mat) {
1677139bc87fSRandall Stewart 				if (SCTP_BUF_IS_EXTENDED(mat)) {
1678f8829a4aSRandall Stewart 					sctp_log_mb(mat, SCTP_MBUF_ICOPY);
1679f8829a4aSRandall Stewart 				}
1680139bc87fSRandall Stewart 				mat = SCTP_BUF_NEXT(mat);
1681f8829a4aSRandall Stewart 			}
1682f8829a4aSRandall Stewart 		}
1683f8829a4aSRandall Stewart #endif
1684f8829a4aSRandall Stewart 	} else {
1685f8829a4aSRandall Stewart 		/* We can steal the last chunk */
1686139bc87fSRandall Stewart 		int l_len;
1687139bc87fSRandall Stewart 
1688f8829a4aSRandall Stewart 		dmbuf = *m;
1689f8829a4aSRandall Stewart 		/* lop off the top part */
1690f8829a4aSRandall Stewart 		m_adj(dmbuf, (offset + sizeof(struct sctp_data_chunk)));
1691139bc87fSRandall Stewart 		if (SCTP_BUF_NEXT(dmbuf) == NULL) {
1692139bc87fSRandall Stewart 			l_len = SCTP_BUF_LEN(dmbuf);
1693139bc87fSRandall Stewart 		} else {
1694139bc87fSRandall Stewart 			/*
1695139bc87fSRandall Stewart 			 * need to count up the size hopefully does not hit
1696139bc87fSRandall Stewart 			 * this to often :-0
1697139bc87fSRandall Stewart 			 */
1698139bc87fSRandall Stewart 			struct mbuf *lat;
1699139bc87fSRandall Stewart 
1700139bc87fSRandall Stewart 			l_len = 0;
1701139bc87fSRandall Stewart 			lat = dmbuf;
1702139bc87fSRandall Stewart 			while (lat) {
1703139bc87fSRandall Stewart 				l_len += SCTP_BUF_LEN(lat);
1704139bc87fSRandall Stewart 				lat = SCTP_BUF_NEXT(lat);
1705139bc87fSRandall Stewart 			}
1706139bc87fSRandall Stewart 		}
1707139bc87fSRandall Stewart 		if (l_len > the_len) {
1708f8829a4aSRandall Stewart 			/* Trim the end round bytes off  too */
1709139bc87fSRandall Stewart 			m_adj(dmbuf, -(l_len - the_len));
1710f8829a4aSRandall Stewart 		}
1711f8829a4aSRandall Stewart 	}
1712f8829a4aSRandall Stewart 	if (dmbuf == NULL) {
1713f8829a4aSRandall Stewart 		SCTP_STAT_INCR(sctps_nomem);
1714f8829a4aSRandall Stewart 		return (0);
1715f8829a4aSRandall Stewart 	}
1716f42a358aSRandall Stewart 	if ((chunk_flags & SCTP_DATA_NOT_FRAG) == SCTP_DATA_NOT_FRAG &&
1717f8829a4aSRandall Stewart 	    asoc->fragmented_delivery_inprogress == 0 &&
1718f8829a4aSRandall Stewart 	    TAILQ_EMPTY(&asoc->resetHead) &&
1719f42a358aSRandall Stewart 	    ((ordered == 0) ||
1720f8829a4aSRandall Stewart 	    ((asoc->strmin[strmno].last_sequence_delivered + 1) == strmseq &&
1721f8829a4aSRandall Stewart 	    TAILQ_EMPTY(&asoc->strmin[strmno].inqueue)))) {
1722f8829a4aSRandall Stewart 		/* Candidate for express delivery */
1723f8829a4aSRandall Stewart 		/*
1724f8829a4aSRandall Stewart 		 * Its not fragmented, No PD-API is up, Nothing in the
1725f8829a4aSRandall Stewart 		 * delivery queue, Its un-ordered OR ordered and the next to
1726f8829a4aSRandall Stewart 		 * deliver AND nothing else is stuck on the stream queue,
1727f8829a4aSRandall Stewart 		 * And there is room for it in the socket buffer. Lets just
1728f8829a4aSRandall Stewart 		 * stuff it up the buffer....
1729f8829a4aSRandall Stewart 		 */
1730f8829a4aSRandall Stewart 
1731f8829a4aSRandall Stewart 		/* It would be nice to avoid this copy if we could :< */
1732f8829a4aSRandall Stewart 		sctp_alloc_a_readq(stcb, control);
1733f8829a4aSRandall Stewart 		sctp_build_readq_entry_mac(control, stcb, asoc->context, net, tsn,
1734f42a358aSRandall Stewart 		    protocol_id,
1735f8829a4aSRandall Stewart 		    stcb->asoc.context,
1736f8829a4aSRandall Stewart 		    strmno, strmseq,
1737f42a358aSRandall Stewart 		    chunk_flags,
1738f8829a4aSRandall Stewart 		    dmbuf);
1739f8829a4aSRandall Stewart 		if (control == NULL) {
1740f8829a4aSRandall Stewart 			goto failed_express_del;
1741f8829a4aSRandall Stewart 		}
1742f8829a4aSRandall Stewart 		sctp_add_to_readq(stcb->sctp_ep, stcb, control, &stcb->sctp_socket->so_rcv, 1);
1743f42a358aSRandall Stewart 		if ((chunk_flags & SCTP_DATA_UNORDERED) == 0) {
1744f8829a4aSRandall Stewart 			/* for ordered, bump what we delivered */
1745f8829a4aSRandall Stewart 			asoc->strmin[strmno].last_sequence_delivered++;
1746f8829a4aSRandall Stewart 		}
1747f8829a4aSRandall Stewart 		SCTP_STAT_INCR(sctps_recvexpress);
1748f8829a4aSRandall Stewart #ifdef SCTP_STR_LOGGING
17496a91f103SRandall Stewart 		sctp_log_strm_del_alt(stcb, tsn, strmseq, strmno,
1750f8829a4aSRandall Stewart 		    SCTP_STR_LOG_FROM_EXPRS_DEL);
1751f8829a4aSRandall Stewart #endif
1752f8829a4aSRandall Stewart 		control = NULL;
1753f8829a4aSRandall Stewart 		goto finish_express_del;
1754f8829a4aSRandall Stewart 	}
1755f8829a4aSRandall Stewart failed_express_del:
1756f8829a4aSRandall Stewart 	/* If we reach here this is a new chunk */
1757f8829a4aSRandall Stewart 	chk = NULL;
1758f8829a4aSRandall Stewart 	control = NULL;
1759f8829a4aSRandall Stewart 	/* Express for fragmented delivery? */
1760f8829a4aSRandall Stewart 	if ((asoc->fragmented_delivery_inprogress) &&
1761f8829a4aSRandall Stewart 	    (stcb->asoc.control_pdapi) &&
1762f8829a4aSRandall Stewart 	    (asoc->str_of_pdapi == strmno) &&
1763f8829a4aSRandall Stewart 	    (asoc->ssn_of_pdapi == strmseq)
1764f8829a4aSRandall Stewart 	    ) {
1765f8829a4aSRandall Stewart 		control = stcb->asoc.control_pdapi;
1766f42a358aSRandall Stewart 		if ((chunk_flags & SCTP_DATA_FIRST_FRAG) == SCTP_DATA_FIRST_FRAG) {
1767f8829a4aSRandall Stewart 			/* Can't be another first? */
1768f8829a4aSRandall Stewart 			goto failed_pdapi_express_del;
1769f8829a4aSRandall Stewart 		}
1770f8829a4aSRandall Stewart 		if (tsn == (control->sinfo_tsn + 1)) {
1771f8829a4aSRandall Stewart 			/* Yep, we can add it on */
1772f8829a4aSRandall Stewart 			int end = 0;
1773f8829a4aSRandall Stewart 			uint32_t cumack;
1774f8829a4aSRandall Stewart 
1775f42a358aSRandall Stewart 			if (chunk_flags & SCTP_DATA_LAST_FRAG) {
1776f8829a4aSRandall Stewart 				end = 1;
1777f8829a4aSRandall Stewart 			}
1778f8829a4aSRandall Stewart 			cumack = asoc->cumulative_tsn;
1779f8829a4aSRandall Stewart 			if ((cumack + 1) == tsn)
1780f8829a4aSRandall Stewart 				cumack = tsn;
1781f8829a4aSRandall Stewart 
1782f8829a4aSRandall Stewart 			if (sctp_append_to_readq(stcb->sctp_ep, stcb, control, dmbuf, end,
1783f8829a4aSRandall Stewart 			    tsn,
1784f8829a4aSRandall Stewart 			    &stcb->sctp_socket->so_rcv)) {
1785f8829a4aSRandall Stewart 				printf("Append fails end:%d\n", end);
1786f8829a4aSRandall Stewart 				goto failed_pdapi_express_del;
1787f8829a4aSRandall Stewart 			}
1788f8829a4aSRandall Stewart 			SCTP_STAT_INCR(sctps_recvexpressm);
1789f8829a4aSRandall Stewart 			control->sinfo_tsn = tsn;
1790f8829a4aSRandall Stewart 			asoc->tsn_last_delivered = tsn;
1791f42a358aSRandall Stewart 			asoc->fragment_flags = chunk_flags;
1792f8829a4aSRandall Stewart 			asoc->tsn_of_pdapi_last_delivered = tsn;
1793f42a358aSRandall Stewart 			asoc->last_flags_delivered = chunk_flags;
1794f8829a4aSRandall Stewart 			asoc->last_strm_seq_delivered = strmseq;
1795f8829a4aSRandall Stewart 			asoc->last_strm_no_delivered = strmno;
1796f8829a4aSRandall Stewart 			if (end) {
1797f8829a4aSRandall Stewart 				/* clean up the flags and such */
1798f8829a4aSRandall Stewart 				asoc->fragmented_delivery_inprogress = 0;
1799f42a358aSRandall Stewart 				if ((chunk_flags & SCTP_DATA_UNORDERED) == 0) {
1800f8829a4aSRandall Stewart 					asoc->strmin[strmno].last_sequence_delivered++;
1801a5d547adSRandall Stewart 				}
1802f8829a4aSRandall Stewart 				stcb->asoc.control_pdapi = NULL;
1803139bc87fSRandall Stewart 				if (TAILQ_EMPTY(&asoc->reasmqueue) == 0) {
1804139bc87fSRandall Stewart 					/*
1805139bc87fSRandall Stewart 					 * There could be another message
1806139bc87fSRandall Stewart 					 * ready
1807139bc87fSRandall Stewart 					 */
1808139bc87fSRandall Stewart 					need_reasm_check = 1;
1809139bc87fSRandall Stewart 				}
1810f8829a4aSRandall Stewart 			}
1811f8829a4aSRandall Stewart 			control = NULL;
1812f8829a4aSRandall Stewart 			goto finish_express_del;
1813f8829a4aSRandall Stewart 		}
1814f8829a4aSRandall Stewart 	}
1815f8829a4aSRandall Stewart failed_pdapi_express_del:
1816f8829a4aSRandall Stewart 	control = NULL;
1817f42a358aSRandall Stewart 	if ((chunk_flags & SCTP_DATA_NOT_FRAG) != SCTP_DATA_NOT_FRAG) {
1818f8829a4aSRandall Stewart 		sctp_alloc_a_chunk(stcb, chk);
1819f8829a4aSRandall Stewart 		if (chk == NULL) {
1820f8829a4aSRandall Stewart 			/* No memory so we drop the chunk */
1821f8829a4aSRandall Stewart 			SCTP_STAT_INCR(sctps_nomem);
1822f8829a4aSRandall Stewart 			if (last_chunk == 0) {
1823f8829a4aSRandall Stewart 				/* we copied it, free the copy */
1824f8829a4aSRandall Stewart 				sctp_m_freem(dmbuf);
1825f8829a4aSRandall Stewart 			}
1826f8829a4aSRandall Stewart 			return (0);
1827f8829a4aSRandall Stewart 		}
1828f8829a4aSRandall Stewart 		chk->rec.data.TSN_seq = tsn;
1829f8829a4aSRandall Stewart 		chk->no_fr_allowed = 0;
1830f8829a4aSRandall Stewart 		chk->rec.data.stream_seq = strmseq;
1831f8829a4aSRandall Stewart 		chk->rec.data.stream_number = strmno;
1832f42a358aSRandall Stewart 		chk->rec.data.payloadtype = protocol_id;
1833f8829a4aSRandall Stewart 		chk->rec.data.context = stcb->asoc.context;
1834f8829a4aSRandall Stewart 		chk->rec.data.doing_fast_retransmit = 0;
1835f42a358aSRandall Stewart 		chk->rec.data.rcv_flags = chunk_flags;
1836f8829a4aSRandall Stewart 		chk->asoc = asoc;
1837f8829a4aSRandall Stewart 		chk->send_size = the_len;
1838f8829a4aSRandall Stewart 		chk->whoTo = net;
1839f8829a4aSRandall Stewart 		atomic_add_int(&net->ref_count, 1);
1840f8829a4aSRandall Stewart 		chk->data = dmbuf;
1841f8829a4aSRandall Stewart 	} else {
1842f8829a4aSRandall Stewart 		sctp_alloc_a_readq(stcb, control);
1843f8829a4aSRandall Stewart 		sctp_build_readq_entry_mac(control, stcb, asoc->context, net, tsn,
1844f42a358aSRandall Stewart 		    protocol_id,
1845f8829a4aSRandall Stewart 		    stcb->asoc.context,
1846f8829a4aSRandall Stewart 		    strmno, strmseq,
1847f42a358aSRandall Stewart 		    chunk_flags,
1848f8829a4aSRandall Stewart 		    dmbuf);
1849f8829a4aSRandall Stewart 		if (control == NULL) {
1850f8829a4aSRandall Stewart 			/* No memory so we drop the chunk */
1851f8829a4aSRandall Stewart 			SCTP_STAT_INCR(sctps_nomem);
1852f8829a4aSRandall Stewart 			if (last_chunk == 0) {
1853f8829a4aSRandall Stewart 				/* we copied it, free the copy */
1854f8829a4aSRandall Stewart 				sctp_m_freem(dmbuf);
1855f8829a4aSRandall Stewart 			}
1856f8829a4aSRandall Stewart 			return (0);
1857f8829a4aSRandall Stewart 		}
1858f8829a4aSRandall Stewart 		control->length = the_len;
1859f8829a4aSRandall Stewart 	}
1860f8829a4aSRandall Stewart 
1861f8829a4aSRandall Stewart 	/* Mark it as received */
1862f8829a4aSRandall Stewart 	/* Now queue it where it belongs */
1863f8829a4aSRandall Stewart 	if (control != NULL) {
1864f8829a4aSRandall Stewart 		/* First a sanity check */
1865f8829a4aSRandall Stewart 		if (asoc->fragmented_delivery_inprogress) {
1866f8829a4aSRandall Stewart 			/*
1867f8829a4aSRandall Stewart 			 * Ok, we have a fragmented delivery in progress if
1868f8829a4aSRandall Stewart 			 * this chunk is next to deliver OR belongs in our
1869f8829a4aSRandall Stewart 			 * view to the reassembly, the peer is evil or
1870f8829a4aSRandall Stewart 			 * broken.
1871f8829a4aSRandall Stewart 			 */
1872f8829a4aSRandall Stewart 			uint32_t estimate_tsn;
1873f8829a4aSRandall Stewart 
1874f8829a4aSRandall Stewart 			estimate_tsn = asoc->tsn_last_delivered + 1;
1875f8829a4aSRandall Stewart 			if (TAILQ_EMPTY(&asoc->reasmqueue) &&
1876f8829a4aSRandall Stewart 			    (estimate_tsn == control->sinfo_tsn)) {
1877f8829a4aSRandall Stewart 				/* Evil/Broke peer */
1878f8829a4aSRandall Stewart 				sctp_m_freem(control->data);
1879f8829a4aSRandall Stewart 				control->data = NULL;
1880f8829a4aSRandall Stewart 				sctp_free_remote_addr(control->whoFrom);
1881f8829a4aSRandall Stewart 				sctp_free_a_readq(stcb, control);
1882139bc87fSRandall Stewart 				oper = sctp_get_mbuf_for_msg((sizeof(struct sctp_paramhdr) + 3 * sizeof(uint32_t)),
1883f8829a4aSRandall Stewart 				    0, M_DONTWAIT, 1, MT_DATA);
1884f8829a4aSRandall Stewart 				if (oper) {
1885f8829a4aSRandall Stewart 					struct sctp_paramhdr *ph;
1886f8829a4aSRandall Stewart 					uint32_t *ippp;
1887f8829a4aSRandall Stewart 
1888139bc87fSRandall Stewart 					SCTP_BUF_LEN(oper) =
1889f8829a4aSRandall Stewart 					    sizeof(struct sctp_paramhdr) +
1890f8829a4aSRandall Stewart 					    (3 * sizeof(uint32_t));
1891f8829a4aSRandall Stewart 					ph = mtod(oper, struct sctp_paramhdr *);
1892f8829a4aSRandall Stewart 					ph->param_type =
1893f8829a4aSRandall Stewart 					    htons(SCTP_CAUSE_PROTOCOL_VIOLATION);
1894139bc87fSRandall Stewart 					ph->param_length = htons(SCTP_BUF_LEN(oper));
1895f8829a4aSRandall Stewart 					ippp = (uint32_t *) (ph + 1);
1896a5d547adSRandall Stewart 					*ippp = htonl(SCTP_FROM_SCTP_INDATA + SCTP_LOC_15);
1897f8829a4aSRandall Stewart 					ippp++;
1898f8829a4aSRandall Stewart 					*ippp = tsn;
1899f8829a4aSRandall Stewart 					ippp++;
1900f8829a4aSRandall Stewart 					*ippp = ((strmno << 16) | strmseq);
1901f8829a4aSRandall Stewart 				}
1902a5d547adSRandall Stewart 				stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_15;
1903f8829a4aSRandall Stewart 				sctp_abort_an_association(stcb->sctp_ep, stcb,
1904f8829a4aSRandall Stewart 				    SCTP_PEER_FAULTY, oper);
1905f8829a4aSRandall Stewart 
1906f8829a4aSRandall Stewart 				*abort_flag = 1;
1907f8829a4aSRandall Stewart 				return (0);
1908f8829a4aSRandall Stewart 			} else {
1909f8829a4aSRandall Stewart 				if (sctp_does_tsn_belong_to_reasm(asoc, control->sinfo_tsn)) {
1910f8829a4aSRandall Stewart 					sctp_m_freem(control->data);
1911f8829a4aSRandall Stewart 					control->data = NULL;
1912f8829a4aSRandall Stewart 					sctp_free_remote_addr(control->whoFrom);
1913f8829a4aSRandall Stewart 					sctp_free_a_readq(stcb, control);
1914f8829a4aSRandall Stewart 
1915139bc87fSRandall Stewart 					oper = sctp_get_mbuf_for_msg((sizeof(struct sctp_paramhdr) + 3 * sizeof(uint32_t)),
1916f8829a4aSRandall Stewart 					    0, M_DONTWAIT, 1, MT_DATA);
1917f8829a4aSRandall Stewart 					if (oper) {
1918f8829a4aSRandall Stewart 						struct sctp_paramhdr *ph;
1919f8829a4aSRandall Stewart 						uint32_t *ippp;
1920f8829a4aSRandall Stewart 
1921139bc87fSRandall Stewart 						SCTP_BUF_LEN(oper) =
1922f8829a4aSRandall Stewart 						    sizeof(struct sctp_paramhdr) +
1923f8829a4aSRandall Stewart 						    (3 * sizeof(uint32_t));
1924f8829a4aSRandall Stewart 						ph = mtod(oper,
1925f8829a4aSRandall Stewart 						    struct sctp_paramhdr *);
1926f8829a4aSRandall Stewart 						ph->param_type =
1927f8829a4aSRandall Stewart 						    htons(SCTP_CAUSE_PROTOCOL_VIOLATION);
1928f8829a4aSRandall Stewart 						ph->param_length =
1929139bc87fSRandall Stewart 						    htons(SCTP_BUF_LEN(oper));
1930f8829a4aSRandall Stewart 						ippp = (uint32_t *) (ph + 1);
1931a5d547adSRandall Stewart 						*ippp = htonl(SCTP_FROM_SCTP_INDATA + SCTP_LOC_16);
1932f8829a4aSRandall Stewart 						ippp++;
1933f8829a4aSRandall Stewart 						*ippp = tsn;
1934f8829a4aSRandall Stewart 						ippp++;
1935f8829a4aSRandall Stewart 						*ippp = ((strmno << 16) | strmseq);
1936f8829a4aSRandall Stewart 					}
1937a5d547adSRandall Stewart 					stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_16;
1938f8829a4aSRandall Stewart 					sctp_abort_an_association(stcb->sctp_ep,
1939f8829a4aSRandall Stewart 					    stcb, SCTP_PEER_FAULTY, oper);
1940f8829a4aSRandall Stewart 
1941f8829a4aSRandall Stewart 					*abort_flag = 1;
1942f8829a4aSRandall Stewart 					return (0);
1943f8829a4aSRandall Stewart 				}
1944f8829a4aSRandall Stewart 			}
1945f8829a4aSRandall Stewart 		} else {
1946f8829a4aSRandall Stewart 			/* No PDAPI running */
1947f8829a4aSRandall Stewart 			if (!TAILQ_EMPTY(&asoc->reasmqueue)) {
1948f8829a4aSRandall Stewart 				/*
1949f8829a4aSRandall Stewart 				 * Reassembly queue is NOT empty validate
1950f8829a4aSRandall Stewart 				 * that this tsn does not need to be in
1951f8829a4aSRandall Stewart 				 * reasembly queue. If it does then our peer
1952f8829a4aSRandall Stewart 				 * is broken or evil.
1953f8829a4aSRandall Stewart 				 */
1954f8829a4aSRandall Stewart 				if (sctp_does_tsn_belong_to_reasm(asoc, control->sinfo_tsn)) {
1955f8829a4aSRandall Stewart 					sctp_m_freem(control->data);
1956f8829a4aSRandall Stewart 					control->data = NULL;
1957f8829a4aSRandall Stewart 					sctp_free_remote_addr(control->whoFrom);
1958f8829a4aSRandall Stewart 					sctp_free_a_readq(stcb, control);
1959139bc87fSRandall Stewart 					oper = sctp_get_mbuf_for_msg((sizeof(struct sctp_paramhdr) + 3 * sizeof(uint32_t)),
1960f8829a4aSRandall Stewart 					    0, M_DONTWAIT, 1, MT_DATA);
1961f8829a4aSRandall Stewart 					if (oper) {
1962f8829a4aSRandall Stewart 						struct sctp_paramhdr *ph;
1963f8829a4aSRandall Stewart 						uint32_t *ippp;
1964f8829a4aSRandall Stewart 
1965139bc87fSRandall Stewart 						SCTP_BUF_LEN(oper) =
1966f8829a4aSRandall Stewart 						    sizeof(struct sctp_paramhdr) +
1967f8829a4aSRandall Stewart 						    (3 * sizeof(uint32_t));
1968f8829a4aSRandall Stewart 						ph = mtod(oper,
1969f8829a4aSRandall Stewart 						    struct sctp_paramhdr *);
1970f8829a4aSRandall Stewart 						ph->param_type =
1971f8829a4aSRandall Stewart 						    htons(SCTP_CAUSE_PROTOCOL_VIOLATION);
1972f8829a4aSRandall Stewart 						ph->param_length =
1973139bc87fSRandall Stewart 						    htons(SCTP_BUF_LEN(oper));
1974f8829a4aSRandall Stewart 						ippp = (uint32_t *) (ph + 1);
1975a5d547adSRandall Stewart 						*ippp = htonl(SCTP_FROM_SCTP_INDATA + SCTP_LOC_17);
1976f8829a4aSRandall Stewart 						ippp++;
1977f8829a4aSRandall Stewart 						*ippp = tsn;
1978f8829a4aSRandall Stewart 						ippp++;
1979f8829a4aSRandall Stewart 						*ippp = ((strmno << 16) | strmseq);
1980f8829a4aSRandall Stewart 					}
1981a5d547adSRandall Stewart 					stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_17;
1982f8829a4aSRandall Stewart 					sctp_abort_an_association(stcb->sctp_ep,
1983f8829a4aSRandall Stewart 					    stcb, SCTP_PEER_FAULTY, oper);
1984f8829a4aSRandall Stewart 
1985f8829a4aSRandall Stewart 					*abort_flag = 1;
1986f8829a4aSRandall Stewart 					return (0);
1987f8829a4aSRandall Stewart 				}
1988f8829a4aSRandall Stewart 			}
1989f8829a4aSRandall Stewart 		}
1990f8829a4aSRandall Stewart 		/* ok, if we reach here we have passed the sanity checks */
1991f42a358aSRandall Stewart 		if (chunk_flags & SCTP_DATA_UNORDERED) {
1992f8829a4aSRandall Stewart 			/* queue directly into socket buffer */
1993f8829a4aSRandall Stewart 			sctp_add_to_readq(stcb->sctp_ep, stcb,
1994f8829a4aSRandall Stewart 			    control,
1995f8829a4aSRandall Stewart 			    &stcb->sctp_socket->so_rcv, 1);
1996f8829a4aSRandall Stewart 		} else {
1997f8829a4aSRandall Stewart 			/*
1998f8829a4aSRandall Stewart 			 * Special check for when streams are resetting. We
1999f8829a4aSRandall Stewart 			 * could be more smart about this and check the
2000f8829a4aSRandall Stewart 			 * actual stream to see if it is not being reset..
2001f8829a4aSRandall Stewart 			 * that way we would not create a HOLB when amongst
2002f8829a4aSRandall Stewart 			 * streams being reset and those not being reset.
2003f8829a4aSRandall Stewart 			 *
2004f8829a4aSRandall Stewart 			 * We take complete messages that have a stream reset
2005f8829a4aSRandall Stewart 			 * intervening (aka the TSN is after where our
2006f8829a4aSRandall Stewart 			 * cum-ack needs to be) off and put them on a
2007f8829a4aSRandall Stewart 			 * pending_reply_queue. The reassembly ones we do
2008f8829a4aSRandall Stewart 			 * not have to worry about since they are all sorted
2009f8829a4aSRandall Stewart 			 * and proceessed by TSN order. It is only the
2010f8829a4aSRandall Stewart 			 * singletons I must worry about.
2011f8829a4aSRandall Stewart 			 */
2012f8829a4aSRandall Stewart 			struct sctp_stream_reset_list *liste;
2013f8829a4aSRandall Stewart 
2014f8829a4aSRandall Stewart 			if (((liste = TAILQ_FIRST(&asoc->resetHead)) != NULL) &&
2015f8829a4aSRandall Stewart 			    ((compare_with_wrap(tsn, liste->tsn, MAX_TSN)) ||
2016f8829a4aSRandall Stewart 			    (tsn == ntohl(liste->tsn)))
2017f8829a4aSRandall Stewart 			    ) {
2018f8829a4aSRandall Stewart 				/*
2019f8829a4aSRandall Stewart 				 * yep its past where we need to reset... go
2020f8829a4aSRandall Stewart 				 * ahead and queue it.
2021f8829a4aSRandall Stewart 				 */
2022f8829a4aSRandall Stewart 				if (TAILQ_EMPTY(&asoc->pending_reply_queue)) {
2023f8829a4aSRandall Stewart 					/* first one on */
2024f8829a4aSRandall Stewart 					TAILQ_INSERT_TAIL(&asoc->pending_reply_queue, control, next);
2025f8829a4aSRandall Stewart 				} else {
2026f8829a4aSRandall Stewart 					struct sctp_queued_to_read *ctlOn;
2027f8829a4aSRandall Stewart 					unsigned char inserted = 0;
2028f8829a4aSRandall Stewart 
2029f8829a4aSRandall Stewart 					ctlOn = TAILQ_FIRST(&asoc->pending_reply_queue);
2030f8829a4aSRandall Stewart 					while (ctlOn) {
2031f8829a4aSRandall Stewart 						if (compare_with_wrap(control->sinfo_tsn,
2032f8829a4aSRandall Stewart 						    ctlOn->sinfo_tsn, MAX_TSN)) {
2033f8829a4aSRandall Stewart 							ctlOn = TAILQ_NEXT(ctlOn, next);
2034f8829a4aSRandall Stewart 						} else {
2035f8829a4aSRandall Stewart 							/* found it */
2036f8829a4aSRandall Stewart 							TAILQ_INSERT_BEFORE(ctlOn, control, next);
2037f8829a4aSRandall Stewart 							inserted = 1;
2038f8829a4aSRandall Stewart 							break;
2039f8829a4aSRandall Stewart 						}
2040f8829a4aSRandall Stewart 					}
2041f8829a4aSRandall Stewart 					if (inserted == 0) {
2042f8829a4aSRandall Stewart 						/*
2043f8829a4aSRandall Stewart 						 * must be put at end, use
2044f8829a4aSRandall Stewart 						 * prevP (all setup from
2045f8829a4aSRandall Stewart 						 * loop) to setup nextP.
2046f8829a4aSRandall Stewart 						 */
2047f8829a4aSRandall Stewart 						TAILQ_INSERT_TAIL(&asoc->pending_reply_queue, control, next);
2048f8829a4aSRandall Stewart 					}
2049f8829a4aSRandall Stewart 				}
2050f8829a4aSRandall Stewart 			} else {
2051f8829a4aSRandall Stewart 				sctp_queue_data_to_stream(stcb, asoc, control, abort_flag);
2052f8829a4aSRandall Stewart 				if (*abort_flag) {
2053f8829a4aSRandall Stewart 					return (0);
2054f8829a4aSRandall Stewart 				}
2055f8829a4aSRandall Stewart 			}
2056f8829a4aSRandall Stewart 		}
2057f8829a4aSRandall Stewart 	} else {
2058f8829a4aSRandall Stewart 		/* Into the re-assembly queue */
2059f8829a4aSRandall Stewart 		sctp_queue_data_for_reasm(stcb, asoc, chk, abort_flag);
2060f8829a4aSRandall Stewart 		if (*abort_flag) {
2061a5d547adSRandall Stewart 			/*
2062a5d547adSRandall Stewart 			 * the assoc is now gone and chk was put onto the
2063a5d547adSRandall Stewart 			 * reasm queue, which has all been freed.
2064a5d547adSRandall Stewart 			 */
2065a5d547adSRandall Stewart 			*m = NULL;
2066f8829a4aSRandall Stewart 			return (0);
2067f8829a4aSRandall Stewart 		}
2068f8829a4aSRandall Stewart 	}
2069f8829a4aSRandall Stewart finish_express_del:
2070f8829a4aSRandall Stewart 	if (compare_with_wrap(tsn, asoc->highest_tsn_inside_map, MAX_TSN)) {
2071f8829a4aSRandall Stewart 		/* we have a new high score */
2072f8829a4aSRandall Stewart 		asoc->highest_tsn_inside_map = tsn;
2073f8829a4aSRandall Stewart #ifdef SCTP_MAP_LOGGING
2074f8829a4aSRandall Stewart 		sctp_log_map(0, 2, asoc->highest_tsn_inside_map, SCTP_MAP_SLIDE_RESULT);
2075f8829a4aSRandall Stewart #endif
2076f8829a4aSRandall Stewart 	}
2077f8829a4aSRandall Stewart 	if (tsn == (asoc->cumulative_tsn + 1)) {
2078f8829a4aSRandall Stewart 		/* Update cum-ack */
2079f8829a4aSRandall Stewart 		asoc->cumulative_tsn = tsn;
2080f8829a4aSRandall Stewart 	}
2081f8829a4aSRandall Stewart 	if (last_chunk) {
2082f8829a4aSRandall Stewart 		*m = NULL;
2083f8829a4aSRandall Stewart 	}
2084f42a358aSRandall Stewart 	if (ordered) {
2085f8829a4aSRandall Stewart 		SCTP_STAT_INCR_COUNTER64(sctps_inorderchunks);
2086f8829a4aSRandall Stewart 	} else {
2087f8829a4aSRandall Stewart 		SCTP_STAT_INCR_COUNTER64(sctps_inunorderchunks);
2088f8829a4aSRandall Stewart 	}
2089f8829a4aSRandall Stewart 	SCTP_STAT_INCR(sctps_recvdata);
2090f8829a4aSRandall Stewart 	/* Set it present please */
2091f8829a4aSRandall Stewart #ifdef SCTP_STR_LOGGING
20926a91f103SRandall Stewart 	sctp_log_strm_del_alt(stcb, tsn, strmseq, strmno, SCTP_STR_LOG_FROM_MARK_TSN);
2093f8829a4aSRandall Stewart #endif
2094f8829a4aSRandall Stewart #ifdef SCTP_MAP_LOGGING
2095f8829a4aSRandall Stewart 	sctp_log_map(asoc->mapping_array_base_tsn, asoc->cumulative_tsn,
2096f8829a4aSRandall Stewart 	    asoc->highest_tsn_inside_map, SCTP_MAP_PREPARE_SLIDE);
2097f8829a4aSRandall Stewart #endif
2098f8829a4aSRandall Stewart 	SCTP_SET_TSN_PRESENT(asoc->mapping_array, gap);
2099139bc87fSRandall Stewart 	if (need_reasm_check) {
2100139bc87fSRandall Stewart 		/* Another one waits ? */
2101139bc87fSRandall Stewart 		sctp_deliver_reasm_check(stcb, asoc);
2102139bc87fSRandall Stewart 	}
2103f8829a4aSRandall Stewart 	return (1);
2104f8829a4aSRandall Stewart }
2105f8829a4aSRandall Stewart 
2106f8829a4aSRandall Stewart int8_t sctp_map_lookup_tab[256] = {
2107f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 2,
2108f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 3,
2109f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 2,
2110f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 4,
2111f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 2,
2112f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 3,
2113f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 2,
2114f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 5,
2115f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 2,
2116f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 3,
2117f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 2,
2118f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 4,
2119f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 2,
2120f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 3,
2121f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 2,
2122f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 6,
2123f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 2,
2124f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 3,
2125f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 2,
2126f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 4,
2127f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 2,
2128f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 3,
2129f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 2,
2130f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 5,
2131f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 2,
2132f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 3,
2133f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 2,
2134f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 4,
2135f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 2,
2136f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 3,
2137f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 2,
2138f8829a4aSRandall Stewart 	-1, 0, -1, 1, -1, 0, -1, 7,
2139f8829a4aSRandall Stewart };
2140f8829a4aSRandall Stewart 
2141f8829a4aSRandall Stewart 
2142f8829a4aSRandall Stewart void
2143f8829a4aSRandall Stewart sctp_sack_check(struct sctp_tcb *stcb, int ok_to_sack, int was_a_gap, int *abort_flag)
2144f8829a4aSRandall Stewart {
2145f8829a4aSRandall Stewart 	/*
2146f8829a4aSRandall Stewart 	 * Now we also need to check the mapping array in a couple of ways.
2147f8829a4aSRandall Stewart 	 * 1) Did we move the cum-ack point?
2148f8829a4aSRandall Stewart 	 */
2149f8829a4aSRandall Stewart 	struct sctp_association *asoc;
2150f8829a4aSRandall Stewart 	int i, at;
215193164cf9SRandall Stewart 	int all_ones, last_all_ones = 0;
2152f8829a4aSRandall Stewart 	int slide_from, slide_end, lgap, distance;
2153f8829a4aSRandall Stewart 
2154f8829a4aSRandall Stewart #ifdef SCTP_MAP_LOGGING
2155f8829a4aSRandall Stewart 	uint32_t old_cumack, old_base, old_highest;
2156f8829a4aSRandall Stewart 	unsigned char aux_array[64];
2157f8829a4aSRandall Stewart 
2158f8829a4aSRandall Stewart #endif
2159f8829a4aSRandall Stewart 	struct sctp_stream_reset_list *liste;
2160f8829a4aSRandall Stewart 
2161f8829a4aSRandall Stewart 	asoc = &stcb->asoc;
2162f8829a4aSRandall Stewart 	at = 0;
2163f8829a4aSRandall Stewart 
2164f8829a4aSRandall Stewart #ifdef SCTP_MAP_LOGGING
2165f8829a4aSRandall Stewart 	old_cumack = asoc->cumulative_tsn;
2166f8829a4aSRandall Stewart 	old_base = asoc->mapping_array_base_tsn;
2167f8829a4aSRandall Stewart 	old_highest = asoc->highest_tsn_inside_map;
2168f8829a4aSRandall Stewart 	if (asoc->mapping_array_size < 64)
2169f8829a4aSRandall Stewart 		memcpy(aux_array, asoc->mapping_array,
2170f8829a4aSRandall Stewart 		    asoc->mapping_array_size);
2171f8829a4aSRandall Stewart 	else
2172f8829a4aSRandall Stewart 		memcpy(aux_array, asoc->mapping_array, 64);
2173f8829a4aSRandall Stewart #endif
2174f8829a4aSRandall Stewart 
2175f8829a4aSRandall Stewart 	/*
2176f8829a4aSRandall Stewart 	 * We could probably improve this a small bit by calculating the
2177f8829a4aSRandall Stewart 	 * offset of the current cum-ack as the starting point.
2178f8829a4aSRandall Stewart 	 */
2179f8829a4aSRandall Stewart 	all_ones = 1;
2180f8829a4aSRandall Stewart 	at = 0;
2181f8829a4aSRandall Stewart 	for (i = 0; i < stcb->asoc.mapping_array_size; i++) {
2182f8829a4aSRandall Stewart 		if (asoc->mapping_array[i] == 0xff) {
2183f8829a4aSRandall Stewart 			at += 8;
218493164cf9SRandall Stewart 			last_all_ones = 1;
2185f8829a4aSRandall Stewart 		} else {
2186f8829a4aSRandall Stewart 			/* there is a 0 bit */
2187f8829a4aSRandall Stewart 			all_ones = 0;
2188f8829a4aSRandall Stewart 			at += sctp_map_lookup_tab[asoc->mapping_array[i]];
218993164cf9SRandall Stewart 			last_all_ones = 0;
2190f8829a4aSRandall Stewart 			break;
2191f8829a4aSRandall Stewart 		}
2192f8829a4aSRandall Stewart 	}
219393164cf9SRandall Stewart 	asoc->cumulative_tsn = asoc->mapping_array_base_tsn + (at - last_all_ones);
2194f8829a4aSRandall Stewart 	/* at is one off, since in the table a embedded -1 is present */
2195f8829a4aSRandall Stewart 	at++;
2196f8829a4aSRandall Stewart 
2197f8829a4aSRandall Stewart 	if (compare_with_wrap(asoc->cumulative_tsn,
2198f8829a4aSRandall Stewart 	    asoc->highest_tsn_inside_map,
2199f8829a4aSRandall Stewart 	    MAX_TSN)) {
2200a5d547adSRandall Stewart #ifdef INVARIANTS
2201f8829a4aSRandall Stewart 		panic("huh, cumack greater than high-tsn in map");
2202f8829a4aSRandall Stewart #else
2203f8829a4aSRandall Stewart 		printf("huh, cumack greater than high-tsn in map - should panic?\n");
2204f8829a4aSRandall Stewart 		asoc->highest_tsn_inside_map = asoc->cumulative_tsn;
2205f8829a4aSRandall Stewart #endif
2206f8829a4aSRandall Stewart 	}
2207f8829a4aSRandall Stewart 	if (all_ones ||
2208f8829a4aSRandall Stewart 	    (asoc->cumulative_tsn == asoc->highest_tsn_inside_map && at >= 8)) {
2209f8829a4aSRandall Stewart 		/* The complete array was completed by a single FR */
2210f8829a4aSRandall Stewart 		/* higest becomes the cum-ack */
2211f8829a4aSRandall Stewart 		int clr;
2212f8829a4aSRandall Stewart 
2213f8829a4aSRandall Stewart 		asoc->cumulative_tsn = asoc->highest_tsn_inside_map;
2214f8829a4aSRandall Stewart 		/* clear the array */
2215f8829a4aSRandall Stewart 		if (all_ones)
2216f8829a4aSRandall Stewart 			clr = asoc->mapping_array_size;
2217f8829a4aSRandall Stewart 		else {
2218f8829a4aSRandall Stewart 			clr = (at >> 3) + 1;
2219f8829a4aSRandall Stewart 			/*
2220f8829a4aSRandall Stewart 			 * this should be the allones case but just in case
2221f8829a4aSRandall Stewart 			 * :>
2222f8829a4aSRandall Stewart 			 */
2223f8829a4aSRandall Stewart 			if (clr > asoc->mapping_array_size)
2224f8829a4aSRandall Stewart 				clr = asoc->mapping_array_size;
2225f8829a4aSRandall Stewart 		}
2226f8829a4aSRandall Stewart 		memset(asoc->mapping_array, 0, clr);
2227f8829a4aSRandall Stewart 		/* base becomes one ahead of the cum-ack */
2228f8829a4aSRandall Stewart 		asoc->mapping_array_base_tsn = asoc->cumulative_tsn + 1;
2229f8829a4aSRandall Stewart #ifdef SCTP_MAP_LOGGING
2230f8829a4aSRandall Stewart 		sctp_log_map(old_base, old_cumack, old_highest,
2231f8829a4aSRandall Stewart 		    SCTP_MAP_PREPARE_SLIDE);
2232f8829a4aSRandall Stewart 		sctp_log_map(asoc->mapping_array_base_tsn, asoc->cumulative_tsn,
2233f8829a4aSRandall Stewart 		    asoc->highest_tsn_inside_map, SCTP_MAP_SLIDE_CLEARED);
2234f8829a4aSRandall Stewart #endif
2235f8829a4aSRandall Stewart 	} else if (at >= 8) {
2236f8829a4aSRandall Stewart 		/* we can slide the mapping array down */
2237f8829a4aSRandall Stewart 		/* Calculate the new byte postion we can move down */
2238f8829a4aSRandall Stewart 		slide_from = at >> 3;
2239f8829a4aSRandall Stewart 		/*
2240f8829a4aSRandall Stewart 		 * now calculate the ceiling of the move using our highest
2241f8829a4aSRandall Stewart 		 * TSN value
2242f8829a4aSRandall Stewart 		 */
2243f8829a4aSRandall Stewart 		if (asoc->highest_tsn_inside_map >= asoc->mapping_array_base_tsn) {
2244f8829a4aSRandall Stewart 			lgap = asoc->highest_tsn_inside_map -
2245f8829a4aSRandall Stewart 			    asoc->mapping_array_base_tsn;
2246f8829a4aSRandall Stewart 		} else {
2247f8829a4aSRandall Stewart 			lgap = (MAX_TSN - asoc->mapping_array_base_tsn) +
2248f8829a4aSRandall Stewart 			    asoc->highest_tsn_inside_map + 1;
2249f8829a4aSRandall Stewart 		}
2250f8829a4aSRandall Stewart 		slide_end = lgap >> 3;
2251f8829a4aSRandall Stewart 		if (slide_end < slide_from) {
2252f8829a4aSRandall Stewart 			panic("impossible slide");
2253f8829a4aSRandall Stewart 		}
2254f8829a4aSRandall Stewart 		distance = (slide_end - slide_from) + 1;
2255f8829a4aSRandall Stewart #ifdef SCTP_MAP_LOGGING
2256f8829a4aSRandall Stewart 		sctp_log_map(old_base, old_cumack, old_highest,
2257f8829a4aSRandall Stewart 		    SCTP_MAP_PREPARE_SLIDE);
2258f8829a4aSRandall Stewart 		sctp_log_map((uint32_t) slide_from, (uint32_t) slide_end,
2259f8829a4aSRandall Stewart 		    (uint32_t) lgap, SCTP_MAP_SLIDE_FROM);
2260f8829a4aSRandall Stewart #endif
2261f8829a4aSRandall Stewart 		if (distance + slide_from > asoc->mapping_array_size ||
2262f8829a4aSRandall Stewart 		    distance < 0) {
2263f8829a4aSRandall Stewart 			/*
2264f8829a4aSRandall Stewart 			 * Here we do NOT slide forward the array so that
2265f8829a4aSRandall Stewart 			 * hopefully when more data comes in to fill it up
2266f8829a4aSRandall Stewart 			 * we will be able to slide it forward. Really I
2267f8829a4aSRandall Stewart 			 * don't think this should happen :-0
2268f8829a4aSRandall Stewart 			 */
2269f8829a4aSRandall Stewart 
2270f8829a4aSRandall Stewart #ifdef SCTP_MAP_LOGGING
2271f8829a4aSRandall Stewart 			sctp_log_map((uint32_t) distance, (uint32_t) slide_from,
2272f8829a4aSRandall Stewart 			    (uint32_t) asoc->mapping_array_size,
2273f8829a4aSRandall Stewart 			    SCTP_MAP_SLIDE_NONE);
2274f8829a4aSRandall Stewart #endif
2275f8829a4aSRandall Stewart 		} else {
2276f8829a4aSRandall Stewart 			int ii;
2277f8829a4aSRandall Stewart 
2278f8829a4aSRandall Stewart 			for (ii = 0; ii < distance; ii++) {
2279f8829a4aSRandall Stewart 				asoc->mapping_array[ii] =
2280f8829a4aSRandall Stewart 				    asoc->mapping_array[slide_from + ii];
2281f8829a4aSRandall Stewart 			}
2282f8829a4aSRandall Stewart 			for (ii = distance; ii <= slide_end; ii++) {
2283f8829a4aSRandall Stewart 				asoc->mapping_array[ii] = 0;
2284f8829a4aSRandall Stewart 			}
2285f8829a4aSRandall Stewart 			asoc->mapping_array_base_tsn += (slide_from << 3);
2286f8829a4aSRandall Stewart #ifdef SCTP_MAP_LOGGING
2287f8829a4aSRandall Stewart 			sctp_log_map(asoc->mapping_array_base_tsn,
2288f8829a4aSRandall Stewart 			    asoc->cumulative_tsn, asoc->highest_tsn_inside_map,
2289f8829a4aSRandall Stewart 			    SCTP_MAP_SLIDE_RESULT);
2290f8829a4aSRandall Stewart #endif
2291f8829a4aSRandall Stewart 		}
2292f8829a4aSRandall Stewart 	}
2293f8829a4aSRandall Stewart 	/* check the special flag for stream resets */
2294f8829a4aSRandall Stewart 	if (((liste = TAILQ_FIRST(&asoc->resetHead)) != NULL) &&
2295f8829a4aSRandall Stewart 	    ((compare_with_wrap(asoc->cumulative_tsn, liste->tsn, MAX_TSN)) ||
2296f8829a4aSRandall Stewart 	    (asoc->cumulative_tsn == liste->tsn))
2297f8829a4aSRandall Stewart 	    ) {
2298f8829a4aSRandall Stewart 		/*
2299f8829a4aSRandall Stewart 		 * we have finished working through the backlogged TSN's now
2300f8829a4aSRandall Stewart 		 * time to reset streams. 1: call reset function. 2: free
2301f8829a4aSRandall Stewart 		 * pending_reply space 3: distribute any chunks in
2302f8829a4aSRandall Stewart 		 * pending_reply_queue.
2303f8829a4aSRandall Stewart 		 */
2304f8829a4aSRandall Stewart 		struct sctp_queued_to_read *ctl;
2305f8829a4aSRandall Stewart 
2306f8829a4aSRandall Stewart 		sctp_reset_in_stream(stcb, liste->number_entries, liste->req.list_of_streams);
2307f8829a4aSRandall Stewart 		TAILQ_REMOVE(&asoc->resetHead, liste, next_resp);
2308f8829a4aSRandall Stewart 		SCTP_FREE(liste);
2309f8829a4aSRandall Stewart 		liste = TAILQ_FIRST(&asoc->resetHead);
2310f8829a4aSRandall Stewart 		ctl = TAILQ_FIRST(&asoc->pending_reply_queue);
2311f8829a4aSRandall Stewart 		if (ctl && (liste == NULL)) {
2312f8829a4aSRandall Stewart 			/* All can be removed */
2313f8829a4aSRandall Stewart 			while (ctl) {
2314f8829a4aSRandall Stewart 				TAILQ_REMOVE(&asoc->pending_reply_queue, ctl, next);
2315f8829a4aSRandall Stewart 				sctp_queue_data_to_stream(stcb, asoc, ctl, abort_flag);
2316f8829a4aSRandall Stewart 				if (*abort_flag) {
2317f8829a4aSRandall Stewart 					return;
2318f8829a4aSRandall Stewart 				}
2319f8829a4aSRandall Stewart 				ctl = TAILQ_FIRST(&asoc->pending_reply_queue);
2320f8829a4aSRandall Stewart 			}
2321f8829a4aSRandall Stewart 		} else if (ctl) {
2322f8829a4aSRandall Stewart 			/* more than one in queue */
2323f8829a4aSRandall Stewart 			while (!compare_with_wrap(ctl->sinfo_tsn, liste->tsn, MAX_TSN)) {
2324f8829a4aSRandall Stewart 				/*
2325f8829a4aSRandall Stewart 				 * if ctl->sinfo_tsn is <= liste->tsn we can
2326f8829a4aSRandall Stewart 				 * process it which is the NOT of
2327f8829a4aSRandall Stewart 				 * ctl->sinfo_tsn > liste->tsn
2328f8829a4aSRandall Stewart 				 */
2329f8829a4aSRandall Stewart 				TAILQ_REMOVE(&asoc->pending_reply_queue, ctl, next);
2330f8829a4aSRandall Stewart 				sctp_queue_data_to_stream(stcb, asoc, ctl, abort_flag);
2331f8829a4aSRandall Stewart 				if (*abort_flag) {
2332f8829a4aSRandall Stewart 					return;
2333f8829a4aSRandall Stewart 				}
2334f8829a4aSRandall Stewart 				ctl = TAILQ_FIRST(&asoc->pending_reply_queue);
2335f8829a4aSRandall Stewart 			}
2336f8829a4aSRandall Stewart 		}
2337f8829a4aSRandall Stewart 		/*
2338f8829a4aSRandall Stewart 		 * Now service re-assembly to pick up anything that has been
2339f8829a4aSRandall Stewart 		 * held on reassembly queue?
2340f8829a4aSRandall Stewart 		 */
2341f8829a4aSRandall Stewart 		sctp_deliver_reasm_check(stcb, asoc);
2342f8829a4aSRandall Stewart 	}
2343f8829a4aSRandall Stewart 	/*
2344f8829a4aSRandall Stewart 	 * Now we need to see if we need to queue a sack or just start the
2345f8829a4aSRandall Stewart 	 * timer (if allowed).
2346f8829a4aSRandall Stewart 	 */
2347f8829a4aSRandall Stewart 	if (ok_to_sack) {
2348f8829a4aSRandall Stewart 		if (SCTP_GET_STATE(asoc) == SCTP_STATE_SHUTDOWN_SENT) {
2349f8829a4aSRandall Stewart 			/*
2350f8829a4aSRandall Stewart 			 * Ok special case, in SHUTDOWN-SENT case. here we
2351f8829a4aSRandall Stewart 			 * maker sure SACK timer is off and instead send a
2352f8829a4aSRandall Stewart 			 * SHUTDOWN and a SACK
2353f8829a4aSRandall Stewart 			 */
2354139bc87fSRandall Stewart 			if (SCTP_OS_TIMER_PENDING(&stcb->asoc.dack_timer.timer)) {
2355f8829a4aSRandall Stewart 				sctp_timer_stop(SCTP_TIMER_TYPE_RECV,
2356a5d547adSRandall Stewart 				    stcb->sctp_ep, stcb, NULL, SCTP_FROM_SCTP_INDATA + SCTP_LOC_18);
2357f8829a4aSRandall Stewart 			}
2358f8829a4aSRandall Stewart 			sctp_send_shutdown(stcb, stcb->asoc.primary_destination);
2359f8829a4aSRandall Stewart 			sctp_send_sack(stcb);
2360f8829a4aSRandall Stewart 		} else {
2361f8829a4aSRandall Stewart 			int is_a_gap;
2362f8829a4aSRandall Stewart 
2363f8829a4aSRandall Stewart 			/* is there a gap now ? */
2364f8829a4aSRandall Stewart 			is_a_gap = compare_with_wrap(stcb->asoc.highest_tsn_inside_map,
2365f8829a4aSRandall Stewart 			    stcb->asoc.cumulative_tsn, MAX_TSN);
2366f8829a4aSRandall Stewart 
2367f8829a4aSRandall Stewart 			/*
2368f8829a4aSRandall Stewart 			 * CMT DAC algorithm: increase number of packets
2369f8829a4aSRandall Stewart 			 * received since last ack
2370f8829a4aSRandall Stewart 			 */
2371f8829a4aSRandall Stewart 			stcb->asoc.cmt_dac_pkts_rcvd++;
2372f8829a4aSRandall Stewart 
237342551e99SRandall Stewart 			if ((stcb->asoc.send_sack == 1) ||	/* We need to send a
237442551e99SRandall Stewart 								 * SACK */
2375f8829a4aSRandall Stewart 			    ((was_a_gap) && (is_a_gap == 0)) ||	/* was a gap, but no
2376f8829a4aSRandall Stewart 								 * longer is one */
2377f8829a4aSRandall Stewart 			    (stcb->asoc.numduptsns) ||	/* we have dup's */
2378f8829a4aSRandall Stewart 			    (is_a_gap) ||	/* is still a gap */
237942551e99SRandall Stewart 			    (stcb->asoc.delayed_ack == 0) ||	/* Delayed sack disabled */
238042551e99SRandall Stewart 			    (stcb->asoc.data_pkts_seen >= stcb->asoc.sack_freq)	/* hit limit of pkts */
2381f8829a4aSRandall Stewart 			    ) {
2382f8829a4aSRandall Stewart 
2383f8829a4aSRandall Stewart 				if ((sctp_cmt_on_off) && (sctp_cmt_use_dac) &&
238442551e99SRandall Stewart 				    (stcb->asoc.send_sack == 0) &&
2385f8829a4aSRandall Stewart 				    (stcb->asoc.numduptsns == 0) &&
2386f8829a4aSRandall Stewart 				    (stcb->asoc.delayed_ack) &&
2387139bc87fSRandall Stewart 				    (!SCTP_OS_TIMER_PENDING(&stcb->asoc.dack_timer.timer))) {
2388f8829a4aSRandall Stewart 
2389f8829a4aSRandall Stewart 					/*
2390f8829a4aSRandall Stewart 					 * CMT DAC algorithm: With CMT,
2391f8829a4aSRandall Stewart 					 * delay acks even in the face of
2392f8829a4aSRandall Stewart 					 *
2393f8829a4aSRandall Stewart 					 * reordering. Therefore, if acks that
2394f8829a4aSRandall Stewart 					 * do not have to be sent because of
2395f8829a4aSRandall Stewart 					 * the above reasons, will be
2396f8829a4aSRandall Stewart 					 * delayed. That is, acks that would
2397f8829a4aSRandall Stewart 					 * have been sent due to gap reports
2398f8829a4aSRandall Stewart 					 * will be delayed with DAC. Start
2399f8829a4aSRandall Stewart 					 * the delayed ack timer.
2400f8829a4aSRandall Stewart 					 */
2401f8829a4aSRandall Stewart 					sctp_timer_start(SCTP_TIMER_TYPE_RECV,
2402f8829a4aSRandall Stewart 					    stcb->sctp_ep, stcb, NULL);
2403f8829a4aSRandall Stewart 				} else {
2404f8829a4aSRandall Stewart 					/*
2405f8829a4aSRandall Stewart 					 * Ok we must build a SACK since the
2406f8829a4aSRandall Stewart 					 * timer is pending, we got our
2407f8829a4aSRandall Stewart 					 * first packet OR there are gaps or
2408f8829a4aSRandall Stewart 					 * duplicates.
2409f8829a4aSRandall Stewart 					 */
2410f42a358aSRandall Stewart 					SCTP_OS_TIMER_STOP(&stcb->asoc.dack_timer.timer);
2411f8829a4aSRandall Stewart 					sctp_send_sack(stcb);
2412f8829a4aSRandall Stewart 				}
2413f8829a4aSRandall Stewart 			} else {
241442551e99SRandall Stewart 				if (!SCTP_OS_TIMER_PENDING(&stcb->asoc.dack_timer.timer)) {
2415f8829a4aSRandall Stewart 					sctp_timer_start(SCTP_TIMER_TYPE_RECV,
2416f8829a4aSRandall Stewart 					    stcb->sctp_ep, stcb, NULL);
2417f8829a4aSRandall Stewart 				}
2418f8829a4aSRandall Stewart 			}
2419f8829a4aSRandall Stewart 		}
2420f8829a4aSRandall Stewart 	}
242142551e99SRandall Stewart }
2422f8829a4aSRandall Stewart 
2423f8829a4aSRandall Stewart void
2424f8829a4aSRandall Stewart sctp_service_queues(struct sctp_tcb *stcb, struct sctp_association *asoc)
2425f8829a4aSRandall Stewart {
2426f8829a4aSRandall Stewart 	struct sctp_tmit_chunk *chk;
2427f8829a4aSRandall Stewart 	uint32_t tsize;
2428f8829a4aSRandall Stewart 	uint16_t nxt_todel;
2429f8829a4aSRandall Stewart 
2430f8829a4aSRandall Stewart 	if (asoc->fragmented_delivery_inprogress) {
2431f8829a4aSRandall Stewart 		sctp_service_reassembly(stcb, asoc);
2432f8829a4aSRandall Stewart 	}
2433f8829a4aSRandall Stewart 	/* Can we proceed further, i.e. the PD-API is complete */
2434f8829a4aSRandall Stewart 	if (asoc->fragmented_delivery_inprogress) {
2435f8829a4aSRandall Stewart 		/* no */
2436f8829a4aSRandall Stewart 		return;
2437f8829a4aSRandall Stewart 	}
2438f8829a4aSRandall Stewart 	/*
2439f8829a4aSRandall Stewart 	 * Now is there some other chunk I can deliver from the reassembly
2440f8829a4aSRandall Stewart 	 * queue.
2441f8829a4aSRandall Stewart 	 */
2442139bc87fSRandall Stewart doit_again:
2443f8829a4aSRandall Stewart 	chk = TAILQ_FIRST(&asoc->reasmqueue);
2444f8829a4aSRandall Stewart 	if (chk == NULL) {
2445f8829a4aSRandall Stewart 		asoc->size_on_reasm_queue = 0;
2446f8829a4aSRandall Stewart 		asoc->cnt_on_reasm_queue = 0;
2447f8829a4aSRandall Stewart 		return;
2448f8829a4aSRandall Stewart 	}
2449f8829a4aSRandall Stewart 	nxt_todel = asoc->strmin[chk->rec.data.stream_number].last_sequence_delivered + 1;
2450f8829a4aSRandall Stewart 	if ((chk->rec.data.rcv_flags & SCTP_DATA_FIRST_FRAG) &&
2451f8829a4aSRandall Stewart 	    ((nxt_todel == chk->rec.data.stream_seq) ||
2452f8829a4aSRandall Stewart 	    (chk->rec.data.rcv_flags & SCTP_DATA_UNORDERED))) {
2453f8829a4aSRandall Stewart 		/*
2454f8829a4aSRandall Stewart 		 * Yep the first one is here. We setup to start reception,
2455f8829a4aSRandall Stewart 		 * by backing down the TSN just in case we can't deliver.
2456f8829a4aSRandall Stewart 		 */
2457f8829a4aSRandall Stewart 
2458f8829a4aSRandall Stewart 		/*
2459f8829a4aSRandall Stewart 		 * Before we start though either all of the message should
2460f8829a4aSRandall Stewart 		 * be here or 1/4 the socket buffer max or nothing on the
2461f8829a4aSRandall Stewart 		 * delivery queue and something can be delivered.
2462f8829a4aSRandall Stewart 		 */
2463f8829a4aSRandall Stewart 		if ((sctp_is_all_msg_on_reasm(asoc, &tsize) ||
2464f8829a4aSRandall Stewart 		    (tsize > stcb->sctp_ep->partial_delivery_point))) {
2465f8829a4aSRandall Stewart 			asoc->fragmented_delivery_inprogress = 1;
2466f8829a4aSRandall Stewart 			asoc->tsn_last_delivered = chk->rec.data.TSN_seq - 1;
2467f8829a4aSRandall Stewart 			asoc->str_of_pdapi = chk->rec.data.stream_number;
2468f8829a4aSRandall Stewart 			asoc->ssn_of_pdapi = chk->rec.data.stream_seq;
2469f8829a4aSRandall Stewart 			asoc->pdapi_ppid = chk->rec.data.payloadtype;
2470f8829a4aSRandall Stewart 			asoc->fragment_flags = chk->rec.data.rcv_flags;
2471f8829a4aSRandall Stewart 			sctp_service_reassembly(stcb, asoc);
2472139bc87fSRandall Stewart 			if (asoc->fragmented_delivery_inprogress == 0) {
2473139bc87fSRandall Stewart 				goto doit_again;
2474139bc87fSRandall Stewart 			}
2475f8829a4aSRandall Stewart 		}
2476f8829a4aSRandall Stewart 	}
2477f8829a4aSRandall Stewart }
2478f8829a4aSRandall Stewart 
2479f8829a4aSRandall Stewart int
2480f8829a4aSRandall Stewart sctp_process_data(struct mbuf **mm, int iphlen, int *offset, int length,
2481f8829a4aSRandall Stewart     struct sctphdr *sh, struct sctp_inpcb *inp, struct sctp_tcb *stcb,
2482f8829a4aSRandall Stewart     struct sctp_nets *net, uint32_t * high_tsn)
2483f8829a4aSRandall Stewart {
2484f8829a4aSRandall Stewart 	struct sctp_data_chunk *ch, chunk_buf;
2485f8829a4aSRandall Stewart 	struct sctp_association *asoc;
2486f8829a4aSRandall Stewart 	int num_chunks = 0;	/* number of control chunks processed */
2487f8829a4aSRandall Stewart 	int stop_proc = 0;
2488f8829a4aSRandall Stewart 	int chk_length, break_flag, last_chunk;
2489f8829a4aSRandall Stewart 	int abort_flag = 0, was_a_gap = 0;
2490f8829a4aSRandall Stewart 	struct mbuf *m;
2491f8829a4aSRandall Stewart 
2492f8829a4aSRandall Stewart 	/* set the rwnd */
2493f8829a4aSRandall Stewart 	sctp_set_rwnd(stcb, &stcb->asoc);
2494f8829a4aSRandall Stewart 
2495f8829a4aSRandall Stewart 	m = *mm;
2496f8829a4aSRandall Stewart 	SCTP_TCB_LOCK_ASSERT(stcb);
2497f8829a4aSRandall Stewart 	asoc = &stcb->asoc;
2498f8829a4aSRandall Stewart 	if ((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE) ||
2499f8829a4aSRandall Stewart 	    (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_SOCKET_ALLGONE) ||
2500f8829a4aSRandall Stewart 	    (stcb->asoc.state & SCTP_STATE_CLOSED_SOCKET)) {
2501f8829a4aSRandall Stewart 		/*
2502f8829a4aSRandall Stewart 		 * wait a minute, this guy is gone, there is no longer a
2503f8829a4aSRandall Stewart 		 * receiver. Send peer an ABORT!
2504f8829a4aSRandall Stewart 		 */
2505f8829a4aSRandall Stewart 		struct mbuf *op_err;
2506f8829a4aSRandall Stewart 
2507f8829a4aSRandall Stewart 		op_err = sctp_generate_invmanparam(SCTP_CAUSE_OUT_OF_RESC);
2508f8829a4aSRandall Stewart 		sctp_abort_an_association(stcb->sctp_ep, stcb, 0, op_err);
2509f8829a4aSRandall Stewart 		return (2);
2510f8829a4aSRandall Stewart 	}
2511f8829a4aSRandall Stewart 	if (compare_with_wrap(stcb->asoc.highest_tsn_inside_map,
2512f8829a4aSRandall Stewart 	    stcb->asoc.cumulative_tsn, MAX_TSN)) {
2513f8829a4aSRandall Stewart 		/* there was a gap before this data was processed */
2514f8829a4aSRandall Stewart 		was_a_gap = 1;
2515f8829a4aSRandall Stewart 	}
2516f8829a4aSRandall Stewart 	/*
2517f8829a4aSRandall Stewart 	 * setup where we got the last DATA packet from for any SACK that
2518f8829a4aSRandall Stewart 	 * may need to go out. Don't bump the net. This is done ONLY when a
2519f8829a4aSRandall Stewart 	 * chunk is assigned.
2520f8829a4aSRandall Stewart 	 */
2521f8829a4aSRandall Stewart 	asoc->last_data_chunk_from = net;
2522f8829a4aSRandall Stewart 
2523f8829a4aSRandall Stewart 	/*
2524f8829a4aSRandall Stewart 	 * Now before we proceed we must figure out if this is a wasted
2525f8829a4aSRandall Stewart 	 * cluster... i.e. it is a small packet sent in and yet the driver
2526f8829a4aSRandall Stewart 	 * underneath allocated a full cluster for it. If so we must copy it
2527f8829a4aSRandall Stewart 	 * to a smaller mbuf and free up the cluster mbuf. This will help
2528f8829a4aSRandall Stewart 	 * with cluster starvation.
2529f8829a4aSRandall Stewart 	 */
253044b7479bSRandall Stewart 	if (SCTP_BUF_LEN(m) < (long)MLEN && SCTP_BUF_NEXT(m) == NULL) {
2531f8829a4aSRandall Stewart 		/* we only handle mbufs that are singletons.. not chains */
2532139bc87fSRandall Stewart 		m = sctp_get_mbuf_for_msg(SCTP_BUF_LEN(m), 0, M_DONTWAIT, 1, MT_DATA);
2533f8829a4aSRandall Stewart 		if (m) {
2534f8829a4aSRandall Stewart 			/* ok lets see if we can copy the data up */
2535f8829a4aSRandall Stewart 			caddr_t *from, *to;
2536f8829a4aSRandall Stewart 
2537f8829a4aSRandall Stewart 			/* get the pointers and copy */
2538f8829a4aSRandall Stewart 			to = mtod(m, caddr_t *);
2539f8829a4aSRandall Stewart 			from = mtod((*mm), caddr_t *);
2540139bc87fSRandall Stewart 			memcpy(to, from, SCTP_BUF_LEN((*mm)));
2541f8829a4aSRandall Stewart 			/* copy the length and free up the old */
2542139bc87fSRandall Stewart 			SCTP_BUF_LEN(m) = SCTP_BUF_LEN((*mm));
2543f8829a4aSRandall Stewart 			sctp_m_freem(*mm);
2544f8829a4aSRandall Stewart 			/* sucess, back copy */
2545f8829a4aSRandall Stewart 			*mm = m;
2546f8829a4aSRandall Stewart 		} else {
2547f8829a4aSRandall Stewart 			/* We are in trouble in the mbuf world .. yikes */
2548f8829a4aSRandall Stewart 			m = *mm;
2549f8829a4aSRandall Stewart 		}
2550f8829a4aSRandall Stewart 	}
2551f8829a4aSRandall Stewart 	/* get pointer to the first chunk header */
2552f8829a4aSRandall Stewart 	ch = (struct sctp_data_chunk *)sctp_m_getptr(m, *offset,
2553f8829a4aSRandall Stewart 	    sizeof(struct sctp_data_chunk), (uint8_t *) & chunk_buf);
2554f8829a4aSRandall Stewart 	if (ch == NULL) {
2555f8829a4aSRandall Stewart 		return (1);
2556f8829a4aSRandall Stewart 	}
2557f8829a4aSRandall Stewart 	/*
2558f8829a4aSRandall Stewart 	 * process all DATA chunks...
2559f8829a4aSRandall Stewart 	 */
2560f8829a4aSRandall Stewart 	*high_tsn = asoc->cumulative_tsn;
2561f8829a4aSRandall Stewart 	break_flag = 0;
256242551e99SRandall Stewart 	asoc->data_pkts_seen++;
2563f8829a4aSRandall Stewart 	while (stop_proc == 0) {
2564f8829a4aSRandall Stewart 		/* validate chunk length */
2565f8829a4aSRandall Stewart 		chk_length = ntohs(ch->ch.chunk_length);
2566f8829a4aSRandall Stewart 		if (length - *offset < chk_length) {
2567f8829a4aSRandall Stewart 			/* all done, mutulated chunk */
2568f8829a4aSRandall Stewart 			stop_proc = 1;
2569f8829a4aSRandall Stewart 			break;
2570f8829a4aSRandall Stewart 		}
2571f8829a4aSRandall Stewart 		if (ch->ch.chunk_type == SCTP_DATA) {
2572f8829a4aSRandall Stewart 			if ((size_t)chk_length < sizeof(struct sctp_data_chunk) + 1) {
2573f8829a4aSRandall Stewart 				/*
2574f8829a4aSRandall Stewart 				 * Need to send an abort since we had a
2575f8829a4aSRandall Stewart 				 * invalid data chunk.
2576f8829a4aSRandall Stewart 				 */
2577f8829a4aSRandall Stewart 				struct mbuf *op_err;
2578f8829a4aSRandall Stewart 
2579139bc87fSRandall Stewart 				op_err = sctp_get_mbuf_for_msg((sizeof(struct sctp_paramhdr) + 2 * sizeof(uint32_t)),
2580f8829a4aSRandall Stewart 				    0, M_DONTWAIT, 1, MT_DATA);
2581f8829a4aSRandall Stewart 
2582f8829a4aSRandall Stewart 				if (op_err) {
2583f8829a4aSRandall Stewart 					struct sctp_paramhdr *ph;
2584f8829a4aSRandall Stewart 					uint32_t *ippp;
2585f8829a4aSRandall Stewart 
2586139bc87fSRandall Stewart 					SCTP_BUF_LEN(op_err) = sizeof(struct sctp_paramhdr) +
2587f8829a4aSRandall Stewart 					    (2 * sizeof(uint32_t));
2588f8829a4aSRandall Stewart 					ph = mtod(op_err, struct sctp_paramhdr *);
2589f8829a4aSRandall Stewart 					ph->param_type =
2590f8829a4aSRandall Stewart 					    htons(SCTP_CAUSE_PROTOCOL_VIOLATION);
2591139bc87fSRandall Stewart 					ph->param_length = htons(SCTP_BUF_LEN(op_err));
2592f8829a4aSRandall Stewart 					ippp = (uint32_t *) (ph + 1);
2593a5d547adSRandall Stewart 					*ippp = htonl(SCTP_FROM_SCTP_INDATA + SCTP_LOC_19);
2594f8829a4aSRandall Stewart 					ippp++;
2595f8829a4aSRandall Stewart 					*ippp = asoc->cumulative_tsn;
2596f8829a4aSRandall Stewart 
2597f8829a4aSRandall Stewart 				}
2598a5d547adSRandall Stewart 				stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_19;
2599f8829a4aSRandall Stewart 				sctp_abort_association(inp, stcb, m, iphlen, sh,
2600f8829a4aSRandall Stewart 				    op_err);
2601f8829a4aSRandall Stewart 				return (2);
2602f8829a4aSRandall Stewart 			}
2603f8829a4aSRandall Stewart #ifdef SCTP_AUDITING_ENABLED
2604f8829a4aSRandall Stewart 			sctp_audit_log(0xB1, 0);
2605f8829a4aSRandall Stewart #endif
2606f8829a4aSRandall Stewart 			if (SCTP_SIZE32(chk_length) == (length - *offset)) {
2607f8829a4aSRandall Stewart 				last_chunk = 1;
2608f8829a4aSRandall Stewart 			} else {
2609f8829a4aSRandall Stewart 				last_chunk = 0;
2610f8829a4aSRandall Stewart 			}
2611f8829a4aSRandall Stewart 			if (sctp_process_a_data_chunk(stcb, asoc, mm, *offset, ch,
2612f8829a4aSRandall Stewart 			    chk_length, net, high_tsn, &abort_flag, &break_flag,
2613f8829a4aSRandall Stewart 			    last_chunk)) {
2614f8829a4aSRandall Stewart 				num_chunks++;
2615f8829a4aSRandall Stewart 			}
2616f8829a4aSRandall Stewart 			if (abort_flag)
2617f8829a4aSRandall Stewart 				return (2);
2618f8829a4aSRandall Stewart 
2619f8829a4aSRandall Stewart 			if (break_flag) {
2620f8829a4aSRandall Stewart 				/*
2621f8829a4aSRandall Stewart 				 * Set because of out of rwnd space and no
2622f8829a4aSRandall Stewart 				 * drop rep space left.
2623f8829a4aSRandall Stewart 				 */
2624f8829a4aSRandall Stewart 				stop_proc = 1;
2625f8829a4aSRandall Stewart 				break;
2626f8829a4aSRandall Stewart 			}
2627f8829a4aSRandall Stewart 		} else {
2628f8829a4aSRandall Stewart 			/* not a data chunk in the data region */
2629f8829a4aSRandall Stewart 			switch (ch->ch.chunk_type) {
2630f8829a4aSRandall Stewart 			case SCTP_INITIATION:
2631f8829a4aSRandall Stewart 			case SCTP_INITIATION_ACK:
2632f8829a4aSRandall Stewart 			case SCTP_SELECTIVE_ACK:
2633f8829a4aSRandall Stewart 			case SCTP_HEARTBEAT_REQUEST:
2634f8829a4aSRandall Stewart 			case SCTP_HEARTBEAT_ACK:
2635f8829a4aSRandall Stewart 			case SCTP_ABORT_ASSOCIATION:
2636f8829a4aSRandall Stewart 			case SCTP_SHUTDOWN:
2637f8829a4aSRandall Stewart 			case SCTP_SHUTDOWN_ACK:
2638f8829a4aSRandall Stewart 			case SCTP_OPERATION_ERROR:
2639f8829a4aSRandall Stewart 			case SCTP_COOKIE_ECHO:
2640f8829a4aSRandall Stewart 			case SCTP_COOKIE_ACK:
2641f8829a4aSRandall Stewart 			case SCTP_ECN_ECHO:
2642f8829a4aSRandall Stewart 			case SCTP_ECN_CWR:
2643f8829a4aSRandall Stewart 			case SCTP_SHUTDOWN_COMPLETE:
2644f8829a4aSRandall Stewart 			case SCTP_AUTHENTICATION:
2645f8829a4aSRandall Stewart 			case SCTP_ASCONF_ACK:
2646f8829a4aSRandall Stewart 			case SCTP_PACKET_DROPPED:
2647f8829a4aSRandall Stewart 			case SCTP_STREAM_RESET:
2648f8829a4aSRandall Stewart 			case SCTP_FORWARD_CUM_TSN:
2649f8829a4aSRandall Stewart 			case SCTP_ASCONF:
2650f8829a4aSRandall Stewart 				/*
2651f8829a4aSRandall Stewart 				 * Now, what do we do with KNOWN chunks that
2652f8829a4aSRandall Stewart 				 * are NOT in the right place?
2653f8829a4aSRandall Stewart 				 *
2654f8829a4aSRandall Stewart 				 * For now, I do nothing but ignore them. We
2655f8829a4aSRandall Stewart 				 * may later want to add sysctl stuff to
2656f8829a4aSRandall Stewart 				 * switch out and do either an ABORT() or
2657f8829a4aSRandall Stewart 				 * possibly process them.
2658f8829a4aSRandall Stewart 				 */
2659f8829a4aSRandall Stewart 				if (sctp_strict_data_order) {
2660f8829a4aSRandall Stewart 					struct mbuf *op_err;
2661f8829a4aSRandall Stewart 
2662f8829a4aSRandall Stewart 					op_err = sctp_generate_invmanparam(SCTP_CAUSE_PROTOCOL_VIOLATION);
2663f8829a4aSRandall Stewart 					sctp_abort_association(inp, stcb, m, iphlen, sh, op_err);
2664f8829a4aSRandall Stewart 					return (2);
2665f8829a4aSRandall Stewart 				}
2666f8829a4aSRandall Stewart 				break;
2667f8829a4aSRandall Stewart 			default:
2668f8829a4aSRandall Stewart 				/* unknown chunk type, use bit rules */
2669f8829a4aSRandall Stewart 				if (ch->ch.chunk_type & 0x40) {
2670f8829a4aSRandall Stewart 					/* Add a error report to the queue */
2671f8829a4aSRandall Stewart 					struct mbuf *mm;
2672f8829a4aSRandall Stewart 					struct sctp_paramhdr *phd;
2673f8829a4aSRandall Stewart 
2674139bc87fSRandall Stewart 					mm = sctp_get_mbuf_for_msg(sizeof(*phd), 0, M_DONTWAIT, 1, MT_DATA);
2675f8829a4aSRandall Stewart 					if (mm) {
2676f8829a4aSRandall Stewart 						phd = mtod(mm, struct sctp_paramhdr *);
2677f8829a4aSRandall Stewart 						/*
2678f8829a4aSRandall Stewart 						 * We cheat and use param
2679f8829a4aSRandall Stewart 						 * type since we did not
2680f8829a4aSRandall Stewart 						 * bother to define a error
2681f8829a4aSRandall Stewart 						 * cause struct. They are
2682f8829a4aSRandall Stewart 						 * the same basic format
2683f8829a4aSRandall Stewart 						 * with different names.
2684f8829a4aSRandall Stewart 						 */
2685f8829a4aSRandall Stewart 						phd->param_type =
2686f8829a4aSRandall Stewart 						    htons(SCTP_CAUSE_UNRECOG_CHUNK);
2687f8829a4aSRandall Stewart 						phd->param_length =
2688f8829a4aSRandall Stewart 						    htons(chk_length + sizeof(*phd));
2689139bc87fSRandall Stewart 						SCTP_BUF_LEN(mm) = sizeof(*phd);
269044b7479bSRandall Stewart 						SCTP_BUF_NEXT(mm) = SCTP_M_COPYM(m, *offset,
2691f8829a4aSRandall Stewart 						    SCTP_SIZE32(chk_length),
2692f8829a4aSRandall Stewart 						    M_DONTWAIT);
2693139bc87fSRandall Stewart 						if (SCTP_BUF_NEXT(mm)) {
2694f8829a4aSRandall Stewart 							sctp_queue_op_err(stcb, mm);
2695f8829a4aSRandall Stewart 						} else {
2696f8829a4aSRandall Stewart 							sctp_m_freem(mm);
2697f8829a4aSRandall Stewart 						}
2698f8829a4aSRandall Stewart 					}
2699f8829a4aSRandall Stewart 				}
2700f8829a4aSRandall Stewart 				if ((ch->ch.chunk_type & 0x80) == 0) {
2701f8829a4aSRandall Stewart 					/* discard the rest of this packet */
2702f8829a4aSRandall Stewart 					stop_proc = 1;
2703f8829a4aSRandall Stewart 				}	/* else skip this bad chunk and
2704f8829a4aSRandall Stewart 					 * continue... */
2705f8829a4aSRandall Stewart 				break;
2706f8829a4aSRandall Stewart 			};	/* switch of chunk type */
2707f8829a4aSRandall Stewart 		}
2708f8829a4aSRandall Stewart 		*offset += SCTP_SIZE32(chk_length);
2709f8829a4aSRandall Stewart 		if ((*offset >= length) || stop_proc) {
2710f8829a4aSRandall Stewart 			/* no more data left in the mbuf chain */
2711f8829a4aSRandall Stewart 			stop_proc = 1;
2712f8829a4aSRandall Stewart 			continue;
2713f8829a4aSRandall Stewart 		}
2714f8829a4aSRandall Stewart 		ch = (struct sctp_data_chunk *)sctp_m_getptr(m, *offset,
2715f8829a4aSRandall Stewart 		    sizeof(struct sctp_data_chunk), (uint8_t *) & chunk_buf);
2716f8829a4aSRandall Stewart 		if (ch == NULL) {
2717f8829a4aSRandall Stewart 			*offset = length;
2718f8829a4aSRandall Stewart 			stop_proc = 1;
2719f8829a4aSRandall Stewart 			break;
2720f8829a4aSRandall Stewart 
2721f8829a4aSRandall Stewart 		}
2722f8829a4aSRandall Stewart 	}			/* while */
2723f8829a4aSRandall Stewart 	if (break_flag) {
2724f8829a4aSRandall Stewart 		/*
2725f8829a4aSRandall Stewart 		 * we need to report rwnd overrun drops.
2726f8829a4aSRandall Stewart 		 */
2727f8829a4aSRandall Stewart 		sctp_send_packet_dropped(stcb, net, *mm, iphlen, 0);
2728f8829a4aSRandall Stewart 	}
2729f8829a4aSRandall Stewart 	if (num_chunks) {
2730f8829a4aSRandall Stewart 		/*
2731f8829a4aSRandall Stewart 		 * Did we get data, if so update the time for auto-close and
2732f8829a4aSRandall Stewart 		 * give peer credit for being alive.
2733f8829a4aSRandall Stewart 		 */
2734f8829a4aSRandall Stewart 		SCTP_STAT_INCR(sctps_recvpktwithdata);
2735f8829a4aSRandall Stewart 		stcb->asoc.overall_error_count = 0;
2736f8829a4aSRandall Stewart 		SCTP_GETTIME_TIMEVAL(&stcb->asoc.time_last_rcvd);
2737f8829a4aSRandall Stewart 	}
2738f8829a4aSRandall Stewart 	/* now service all of the reassm queue if needed */
2739f8829a4aSRandall Stewart 	if (!(TAILQ_EMPTY(&asoc->reasmqueue)))
2740f8829a4aSRandall Stewart 		sctp_service_queues(stcb, asoc);
2741f8829a4aSRandall Stewart 
2742f8829a4aSRandall Stewart 	if (SCTP_GET_STATE(asoc) == SCTP_STATE_SHUTDOWN_SENT) {
274342551e99SRandall Stewart 		/* Assure that we ack right away */
274442551e99SRandall Stewart 		stcb->asoc.send_sack = 1;
2745f8829a4aSRandall Stewart 	}
2746f8829a4aSRandall Stewart 	/* Start a sack timer or QUEUE a SACK for sending */
2747f8829a4aSRandall Stewart 	if ((stcb->asoc.cumulative_tsn == stcb->asoc.highest_tsn_inside_map) &&
274842551e99SRandall Stewart 	    (stcb->asoc.mapping_array[0] != 0xff)) {
274942551e99SRandall Stewart 		if ((stcb->asoc.data_pkts_seen >= stcb->asoc.sack_freq) ||
275042551e99SRandall Stewart 		    (stcb->asoc.delayed_ack == 0) ||
275142551e99SRandall Stewart 		    (stcb->asoc.send_sack == 1)) {
2752139bc87fSRandall Stewart 			if (SCTP_OS_TIMER_PENDING(&stcb->asoc.dack_timer.timer)) {
2753139bc87fSRandall Stewart 				SCTP_OS_TIMER_STOP(&stcb->asoc.dack_timer.timer);
275442551e99SRandall Stewart 			}
2755f8829a4aSRandall Stewart 			sctp_send_sack(stcb);
2756f8829a4aSRandall Stewart 		} else {
275742551e99SRandall Stewart 			if (!SCTP_OS_TIMER_PENDING(&stcb->asoc.dack_timer.timer)) {
2758f8829a4aSRandall Stewart 				sctp_timer_start(SCTP_TIMER_TYPE_RECV,
2759f8829a4aSRandall Stewart 				    stcb->sctp_ep, stcb, NULL);
2760f8829a4aSRandall Stewart 			}
2761f8829a4aSRandall Stewart 		}
2762f8829a4aSRandall Stewart 	} else {
2763f8829a4aSRandall Stewart 		sctp_sack_check(stcb, 1, was_a_gap, &abort_flag);
2764f8829a4aSRandall Stewart 	}
2765f8829a4aSRandall Stewart 	if (abort_flag)
2766f8829a4aSRandall Stewart 		return (2);
2767f8829a4aSRandall Stewart 
2768f8829a4aSRandall Stewart 	return (0);
2769f8829a4aSRandall Stewart }
2770f8829a4aSRandall Stewart 
2771f8829a4aSRandall Stewart static void
2772f8829a4aSRandall Stewart sctp_handle_segments(struct sctp_tcb *stcb, struct sctp_association *asoc,
2773f8829a4aSRandall Stewart     struct sctp_sack_chunk *ch, uint32_t last_tsn, uint32_t * biggest_tsn_acked,
2774139bc87fSRandall Stewart     uint32_t * biggest_newly_acked_tsn, uint32_t * this_sack_lowest_newack,
2775139bc87fSRandall Stewart     int num_seg, int *ecn_seg_sums)
2776f8829a4aSRandall Stewart {
2777f8829a4aSRandall Stewart 	/************************************************/
2778f8829a4aSRandall Stewart 	/* process fragments and update sendqueue        */
2779f8829a4aSRandall Stewart 	/************************************************/
2780f8829a4aSRandall Stewart 	struct sctp_sack *sack;
2781f8829a4aSRandall Stewart 	struct sctp_gap_ack_block *frag;
2782f8829a4aSRandall Stewart 	struct sctp_tmit_chunk *tp1;
2783f8829a4aSRandall Stewart 	int i;
2784f8829a4aSRandall Stewart 	unsigned int j;
2785f8829a4aSRandall Stewart 
2786f8829a4aSRandall Stewart #ifdef SCTP_FR_LOGGING
2787f8829a4aSRandall Stewart 	int num_frs = 0;
2788f8829a4aSRandall Stewart 
2789f8829a4aSRandall Stewart #endif
2790f8829a4aSRandall Stewart 	uint16_t frag_strt, frag_end, primary_flag_set;
2791f8829a4aSRandall Stewart 	u_long last_frag_high;
2792f8829a4aSRandall Stewart 
2793f8829a4aSRandall Stewart 	/*
2794f8829a4aSRandall Stewart 	 * @@@ JRI : TODO: This flag is not used anywhere .. remove?
2795f8829a4aSRandall Stewart 	 */
2796f8829a4aSRandall Stewart 	if (asoc->primary_destination->dest_state & SCTP_ADDR_SWITCH_PRIMARY) {
2797f8829a4aSRandall Stewart 		primary_flag_set = 1;
2798f8829a4aSRandall Stewart 	} else {
2799f8829a4aSRandall Stewart 		primary_flag_set = 0;
2800f8829a4aSRandall Stewart 	}
2801f8829a4aSRandall Stewart 
2802f8829a4aSRandall Stewart 	sack = &ch->sack;
2803f8829a4aSRandall Stewart 	frag = (struct sctp_gap_ack_block *)((caddr_t)sack +
2804f8829a4aSRandall Stewart 	    sizeof(struct sctp_sack));
2805f8829a4aSRandall Stewart 	tp1 = NULL;
2806f8829a4aSRandall Stewart 	last_frag_high = 0;
2807f8829a4aSRandall Stewart 	for (i = 0; i < num_seg; i++) {
2808f8829a4aSRandall Stewart 		frag_strt = ntohs(frag->start);
2809f8829a4aSRandall Stewart 		frag_end = ntohs(frag->end);
2810f8829a4aSRandall Stewart 		/* some sanity checks on the fargment offsets */
2811f8829a4aSRandall Stewart 		if (frag_strt > frag_end) {
2812f8829a4aSRandall Stewart 			/* this one is malformed, skip */
2813f8829a4aSRandall Stewart 			frag++;
2814f8829a4aSRandall Stewart 			continue;
2815f8829a4aSRandall Stewart 		}
2816f8829a4aSRandall Stewart 		if (compare_with_wrap((frag_end + last_tsn), *biggest_tsn_acked,
2817f8829a4aSRandall Stewart 		    MAX_TSN))
2818f8829a4aSRandall Stewart 			*biggest_tsn_acked = frag_end + last_tsn;
2819f8829a4aSRandall Stewart 
2820f8829a4aSRandall Stewart 		/* mark acked dgs and find out the highestTSN being acked */
2821f8829a4aSRandall Stewart 		if (tp1 == NULL) {
2822f8829a4aSRandall Stewart 			tp1 = TAILQ_FIRST(&asoc->sent_queue);
2823f8829a4aSRandall Stewart 
2824f8829a4aSRandall Stewart 			/* save the locations of the last frags */
2825f8829a4aSRandall Stewart 			last_frag_high = frag_end + last_tsn;
2826f8829a4aSRandall Stewart 		} else {
2827f8829a4aSRandall Stewart 			/*
2828f8829a4aSRandall Stewart 			 * now lets see if we need to reset the queue due to
2829f8829a4aSRandall Stewart 			 * a out-of-order SACK fragment
2830f8829a4aSRandall Stewart 			 */
2831f8829a4aSRandall Stewart 			if (compare_with_wrap(frag_strt + last_tsn,
2832f8829a4aSRandall Stewart 			    last_frag_high, MAX_TSN)) {
2833f8829a4aSRandall Stewart 				/*
2834f8829a4aSRandall Stewart 				 * if the new frag starts after the last TSN
2835f8829a4aSRandall Stewart 				 * frag covered, we are ok and this one is
2836f8829a4aSRandall Stewart 				 * beyond the last one
2837f8829a4aSRandall Stewart 				 */
2838f8829a4aSRandall Stewart 				;
2839f8829a4aSRandall Stewart 			} else {
2840f8829a4aSRandall Stewart 				/*
2841f8829a4aSRandall Stewart 				 * ok, they have reset us, so we need to
2842f8829a4aSRandall Stewart 				 * reset the queue this will cause extra
2843f8829a4aSRandall Stewart 				 * hunting but hey, they chose the
2844f8829a4aSRandall Stewart 				 * performance hit when they failed to order
2845f8829a4aSRandall Stewart 				 * there gaps..
2846f8829a4aSRandall Stewart 				 */
2847f8829a4aSRandall Stewart 				tp1 = TAILQ_FIRST(&asoc->sent_queue);
2848f8829a4aSRandall Stewart 			}
2849f8829a4aSRandall Stewart 			last_frag_high = frag_end + last_tsn;
2850f8829a4aSRandall Stewart 		}
2851f8829a4aSRandall Stewart 		for (j = frag_strt + last_tsn; j <= frag_end + last_tsn; j++) {
2852f8829a4aSRandall Stewart 			while (tp1) {
2853f8829a4aSRandall Stewart #ifdef SCTP_FR_LOGGING
2854f8829a4aSRandall Stewart 				if (tp1->rec.data.doing_fast_retransmit)
2855f8829a4aSRandall Stewart 					num_frs++;
2856f8829a4aSRandall Stewart #endif
2857f8829a4aSRandall Stewart 
2858f8829a4aSRandall Stewart 				/*
2859f8829a4aSRandall Stewart 				 * CMT: CUCv2 algorithm. For each TSN being
2860f8829a4aSRandall Stewart 				 * processed from the sent queue, track the
2861f8829a4aSRandall Stewart 				 * next expected pseudo-cumack, or
2862f8829a4aSRandall Stewart 				 * rtx_pseudo_cumack, if required. Separate
2863f8829a4aSRandall Stewart 				 * cumack trackers for first transmissions,
2864f8829a4aSRandall Stewart 				 * and retransmissions.
2865f8829a4aSRandall Stewart 				 */
2866f8829a4aSRandall Stewart 				if ((tp1->whoTo->find_pseudo_cumack == 1) && (tp1->sent < SCTP_DATAGRAM_RESEND) &&
2867f8829a4aSRandall Stewart 				    (tp1->snd_count == 1)) {
2868f8829a4aSRandall Stewart 					tp1->whoTo->pseudo_cumack = tp1->rec.data.TSN_seq;
2869f8829a4aSRandall Stewart 					tp1->whoTo->find_pseudo_cumack = 0;
2870f8829a4aSRandall Stewart 				}
2871f8829a4aSRandall Stewart 				if ((tp1->whoTo->find_rtx_pseudo_cumack == 1) && (tp1->sent < SCTP_DATAGRAM_RESEND) &&
2872f8829a4aSRandall Stewart 				    (tp1->snd_count > 1)) {
2873f8829a4aSRandall Stewart 					tp1->whoTo->rtx_pseudo_cumack = tp1->rec.data.TSN_seq;
2874f8829a4aSRandall Stewart 					tp1->whoTo->find_rtx_pseudo_cumack = 0;
2875f8829a4aSRandall Stewart 				}
2876f8829a4aSRandall Stewart 				if (tp1->rec.data.TSN_seq == j) {
2877f8829a4aSRandall Stewart 					if (tp1->sent != SCTP_DATAGRAM_UNSENT) {
2878f8829a4aSRandall Stewart 						/*
2879f8829a4aSRandall Stewart 						 * must be held until
2880f8829a4aSRandall Stewart 						 * cum-ack passes
2881f8829a4aSRandall Stewart 						 */
2882f8829a4aSRandall Stewart 						/*
2883f8829a4aSRandall Stewart 						 * ECN Nonce: Add the nonce
2884f8829a4aSRandall Stewart 						 * value to the sender's
2885f8829a4aSRandall Stewart 						 * nonce sum
2886f8829a4aSRandall Stewart 						 */
2887c105859eSRandall Stewart 						if (tp1->sent < SCTP_DATAGRAM_RESEND) {
2888c105859eSRandall Stewart 							/*-
2889c105859eSRandall Stewart 							 * If it is less than RESEND, it is
2890c105859eSRandall Stewart 							 * now no-longer in flight.
2891c105859eSRandall Stewart 							 * Higher values may already be set
2892c105859eSRandall Stewart 							 * via previous Gap Ack Blocks...
2893c105859eSRandall Stewart 							 * i.e. ACKED or RESEND.
2894f8829a4aSRandall Stewart 							 */
2895f8829a4aSRandall Stewart 							if (compare_with_wrap(tp1->rec.data.TSN_seq,
2896f8829a4aSRandall Stewart 							    *biggest_newly_acked_tsn, MAX_TSN)) {
2897f8829a4aSRandall Stewart 								*biggest_newly_acked_tsn = tp1->rec.data.TSN_seq;
2898f8829a4aSRandall Stewart 							}
2899f8829a4aSRandall Stewart 							/*
2900f8829a4aSRandall Stewart 							 * CMT: SFR algo
2901f8829a4aSRandall Stewart 							 * (and HTNA) - set
2902f8829a4aSRandall Stewart 							 * saw_newack to 1
2903f8829a4aSRandall Stewart 							 * for dest being
2904f8829a4aSRandall Stewart 							 * newly acked.
2905f8829a4aSRandall Stewart 							 * update
2906f8829a4aSRandall Stewart 							 * this_sack_highest_
2907f8829a4aSRandall Stewart 							 * newack if
2908f8829a4aSRandall Stewart 							 * appropriate.
2909f8829a4aSRandall Stewart 							 */
2910f8829a4aSRandall Stewart 							if (tp1->rec.data.chunk_was_revoked == 0)
2911f8829a4aSRandall Stewart 								tp1->whoTo->saw_newack = 1;
2912f8829a4aSRandall Stewart 
2913f8829a4aSRandall Stewart 							if (compare_with_wrap(tp1->rec.data.TSN_seq,
2914f8829a4aSRandall Stewart 							    tp1->whoTo->this_sack_highest_newack,
2915f8829a4aSRandall Stewart 							    MAX_TSN)) {
2916f8829a4aSRandall Stewart 								tp1->whoTo->this_sack_highest_newack =
2917f8829a4aSRandall Stewart 								    tp1->rec.data.TSN_seq;
2918f8829a4aSRandall Stewart 							}
2919f8829a4aSRandall Stewart 							/*
2920f8829a4aSRandall Stewart 							 * CMT DAC algo:
2921f8829a4aSRandall Stewart 							 * also update
2922f8829a4aSRandall Stewart 							 * this_sack_lowest_n
2923f8829a4aSRandall Stewart 							 * ewack
2924f8829a4aSRandall Stewart 							 */
2925f8829a4aSRandall Stewart 							if (*this_sack_lowest_newack == 0) {
2926f8829a4aSRandall Stewart #ifdef SCTP_SACK_LOGGING
2927f8829a4aSRandall Stewart 								sctp_log_sack(*this_sack_lowest_newack,
2928d0cf96b4SMax Laier 								    last_tsn,
2929f8829a4aSRandall Stewart 								    tp1->rec.data.TSN_seq,
2930f8829a4aSRandall Stewart 								    0,
2931f8829a4aSRandall Stewart 								    0,
2932f8829a4aSRandall Stewart 								    SCTP_LOG_TSN_ACKED);
2933f8829a4aSRandall Stewart #endif
2934f8829a4aSRandall Stewart 								*this_sack_lowest_newack = tp1->rec.data.TSN_seq;
2935f8829a4aSRandall Stewart 							}
2936f8829a4aSRandall Stewart 							/*
2937f8829a4aSRandall Stewart 							 * CMT: CUCv2
2938f8829a4aSRandall Stewart 							 * algorithm. If
2939f8829a4aSRandall Stewart 							 * (rtx-)pseudo-cumac
2940f8829a4aSRandall Stewart 							 * k for corresp
2941f8829a4aSRandall Stewart 							 * dest is being
2942f8829a4aSRandall Stewart 							 * acked, then we
2943f8829a4aSRandall Stewart 							 * have a new
2944f8829a4aSRandall Stewart 							 * (rtx-)pseudo-cumac
2945f8829a4aSRandall Stewart 							 * k. Set
2946f8829a4aSRandall Stewart 							 * new_(rtx_)pseudo_c
2947f8829a4aSRandall Stewart 							 * umack to TRUE so
2948f8829a4aSRandall Stewart 							 * that the cwnd for
2949f8829a4aSRandall Stewart 							 * this dest can be
2950f8829a4aSRandall Stewart 							 * updated. Also
2951f8829a4aSRandall Stewart 							 * trigger search
2952f8829a4aSRandall Stewart 							 * for the next
2953f8829a4aSRandall Stewart 							 * expected
2954f8829a4aSRandall Stewart 							 * (rtx-)pseudo-cumac
2955f8829a4aSRandall Stewart 							 * k. Separate
2956f8829a4aSRandall Stewart 							 * pseudo_cumack
2957f8829a4aSRandall Stewart 							 * trackers for
2958f8829a4aSRandall Stewart 							 * first
2959f8829a4aSRandall Stewart 							 * transmissions and
2960f8829a4aSRandall Stewart 							 * retransmissions.
2961f8829a4aSRandall Stewart 							 */
2962f8829a4aSRandall Stewart 							if (tp1->rec.data.TSN_seq == tp1->whoTo->pseudo_cumack) {
2963f8829a4aSRandall Stewart 								if (tp1->rec.data.chunk_was_revoked == 0) {
2964f8829a4aSRandall Stewart 									tp1->whoTo->new_pseudo_cumack = 1;
2965f8829a4aSRandall Stewart 								}
2966f8829a4aSRandall Stewart 								tp1->whoTo->find_pseudo_cumack = 1;
2967f8829a4aSRandall Stewart 							}
2968f8829a4aSRandall Stewart #ifdef SCTP_CWND_LOGGING
2969f8829a4aSRandall Stewart 							sctp_log_cwnd(stcb, tp1->whoTo, tp1->rec.data.TSN_seq, SCTP_CWND_LOG_FROM_SACK);
2970f8829a4aSRandall Stewart #endif
2971f8829a4aSRandall Stewart 							if (tp1->rec.data.TSN_seq == tp1->whoTo->rtx_pseudo_cumack) {
2972f8829a4aSRandall Stewart 								if (tp1->rec.data.chunk_was_revoked == 0) {
2973f8829a4aSRandall Stewart 									tp1->whoTo->new_pseudo_cumack = 1;
2974f8829a4aSRandall Stewart 								}
2975f8829a4aSRandall Stewart 								tp1->whoTo->find_rtx_pseudo_cumack = 1;
2976f8829a4aSRandall Stewart 							}
2977f8829a4aSRandall Stewart #ifdef SCTP_SACK_LOGGING
2978f8829a4aSRandall Stewart 							sctp_log_sack(*biggest_newly_acked_tsn,
2979f8829a4aSRandall Stewart 							    last_tsn,
2980f8829a4aSRandall Stewart 							    tp1->rec.data.TSN_seq,
2981f8829a4aSRandall Stewart 							    frag_strt,
2982f8829a4aSRandall Stewart 							    frag_end,
2983f8829a4aSRandall Stewart 							    SCTP_LOG_TSN_ACKED);
2984f8829a4aSRandall Stewart #endif
2985a5d547adSRandall Stewart #ifdef SCTP_FLIGHT_LOGGING
2986c105859eSRandall Stewart 							sctp_misc_ints(SCTP_FLIGHT_LOG_DOWN_GAP,
2987a5d547adSRandall Stewart 							    tp1->whoTo->flight_size,
2988a5d547adSRandall Stewart 							    tp1->book_size,
2989c105859eSRandall Stewart 							    (uintptr_t) tp1->whoTo,
2990a5d547adSRandall Stewart 							    tp1->rec.data.TSN_seq);
2991a5d547adSRandall Stewart #endif
2992c105859eSRandall Stewart 							sctp_flight_size_decrease(tp1);
2993c105859eSRandall Stewart 							sctp_total_flight_decrease(stcb, tp1);
2994f8829a4aSRandall Stewart 
2995f8829a4aSRandall Stewart 							tp1->whoTo->net_ack += tp1->send_size;
2996f8829a4aSRandall Stewart 							if (tp1->snd_count < 2) {
2997f8829a4aSRandall Stewart 								/*
2998a5d547adSRandall Stewart 								 * True
2999a5d547adSRandall Stewart 								 * non-retran
3000a5d547adSRandall Stewart 								 * smited
3001a5d547adSRandall Stewart 								 * chunk */
3002f8829a4aSRandall Stewart 								tp1->whoTo->net_ack2 += tp1->send_size;
3003f8829a4aSRandall Stewart 
3004f8829a4aSRandall Stewart 								/*
3005a5d547adSRandall Stewart 								 * update RTO
3006a5d547adSRandall Stewart 								 * too ? */
3007f8829a4aSRandall Stewart 								if (tp1->do_rtt) {
3008f8829a4aSRandall Stewart 									tp1->whoTo->RTO =
3009f8829a4aSRandall Stewart 									    sctp_calculate_rto(stcb,
3010f8829a4aSRandall Stewart 									    asoc,
3011f8829a4aSRandall Stewart 									    tp1->whoTo,
3012f8829a4aSRandall Stewart 									    &tp1->sent_rcv_time);
3013f8829a4aSRandall Stewart 									tp1->do_rtt = 0;
3014f8829a4aSRandall Stewart 								}
3015f8829a4aSRandall Stewart 							}
3016f8829a4aSRandall Stewart 						}
3017c105859eSRandall Stewart 						if (tp1->sent <= SCTP_DATAGRAM_RESEND) {
3018c105859eSRandall Stewart 							(*ecn_seg_sums) += tp1->rec.data.ect_nonce;
3019c105859eSRandall Stewart 							(*ecn_seg_sums) &= SCTP_SACK_NONCE_SUM;
3020c105859eSRandall Stewart 							if (compare_with_wrap(tp1->rec.data.TSN_seq,
3021f8829a4aSRandall Stewart 							    asoc->this_sack_highest_gap,
3022f8829a4aSRandall Stewart 							    MAX_TSN)) {
3023f8829a4aSRandall Stewart 								asoc->this_sack_highest_gap =
3024f8829a4aSRandall Stewart 								    tp1->rec.data.TSN_seq;
3025f8829a4aSRandall Stewart 							}
3026f8829a4aSRandall Stewart 							if (tp1->sent == SCTP_DATAGRAM_RESEND) {
3027f8829a4aSRandall Stewart 								sctp_ucount_decr(asoc->sent_queue_retran_cnt);
3028f8829a4aSRandall Stewart #ifdef SCTP_AUDITING_ENABLED
3029f8829a4aSRandall Stewart 								sctp_audit_log(0xB2,
3030f8829a4aSRandall Stewart 								    (asoc->sent_queue_retran_cnt & 0x000000ff));
3031f8829a4aSRandall Stewart #endif
3032f8829a4aSRandall Stewart 							}
3033c105859eSRandall Stewart 						}
3034c105859eSRandall Stewart 						/*
3035c105859eSRandall Stewart 						 * All chunks NOT UNSENT
3036c105859eSRandall Stewart 						 * fall through here and are
3037c105859eSRandall Stewart 						 * marked
3038c105859eSRandall Stewart 						 */
3039f8829a4aSRandall Stewart 						tp1->sent = SCTP_DATAGRAM_MARKED;
304042551e99SRandall Stewart 						if (tp1->rec.data.chunk_was_revoked) {
304142551e99SRandall Stewart 							/* deflate the cwnd */
304242551e99SRandall Stewart 							tp1->whoTo->cwnd -= tp1->book_size;
304342551e99SRandall Stewart 							tp1->rec.data.chunk_was_revoked = 0;
304442551e99SRandall Stewart 						}
3045f8829a4aSRandall Stewart 					}
3046f8829a4aSRandall Stewart 					break;
3047f8829a4aSRandall Stewart 				}	/* if (tp1->TSN_seq == j) */
3048f8829a4aSRandall Stewart 				if (compare_with_wrap(tp1->rec.data.TSN_seq, j,
3049f8829a4aSRandall Stewart 				    MAX_TSN))
3050f8829a4aSRandall Stewart 					break;
3051f8829a4aSRandall Stewart 
3052f8829a4aSRandall Stewart 				tp1 = TAILQ_NEXT(tp1, sctp_next);
3053f8829a4aSRandall Stewart 			}	/* end while (tp1) */
3054f8829a4aSRandall Stewart 		}		/* end for (j = fragStart */
3055f8829a4aSRandall Stewart 		frag++;		/* next one */
3056f8829a4aSRandall Stewart 	}
3057f8829a4aSRandall Stewart #ifdef SCTP_FR_LOGGING
3058f8829a4aSRandall Stewart 	/*
3059f8829a4aSRandall Stewart 	 * if (num_frs) sctp_log_fr(*biggest_tsn_acked,
3060f8829a4aSRandall Stewart 	 * *biggest_newly_acked_tsn, last_tsn, SCTP_FR_LOG_BIGGEST_TSNS);
3061f8829a4aSRandall Stewart 	 */
3062f8829a4aSRandall Stewart #endif
3063f8829a4aSRandall Stewart }
3064f8829a4aSRandall Stewart 
3065f8829a4aSRandall Stewart static void
3066c105859eSRandall Stewart sctp_check_for_revoked(struct sctp_tcb *stcb,
3067c105859eSRandall Stewart     struct sctp_association *asoc, uint32_t cumack,
3068f8829a4aSRandall Stewart     u_long biggest_tsn_acked)
3069f8829a4aSRandall Stewart {
3070f8829a4aSRandall Stewart 	struct sctp_tmit_chunk *tp1;
3071f8829a4aSRandall Stewart 	int tot_revoked = 0;
3072f8829a4aSRandall Stewart 
3073f8829a4aSRandall Stewart 	tp1 = TAILQ_FIRST(&asoc->sent_queue);
3074f8829a4aSRandall Stewart 	while (tp1) {
3075f8829a4aSRandall Stewart 		if (compare_with_wrap(tp1->rec.data.TSN_seq, cumack,
3076f8829a4aSRandall Stewart 		    MAX_TSN)) {
3077f8829a4aSRandall Stewart 			/*
3078f8829a4aSRandall Stewart 			 * ok this guy is either ACK or MARKED. If it is
3079f8829a4aSRandall Stewart 			 * ACKED it has been previously acked but not this
3080f8829a4aSRandall Stewart 			 * time i.e. revoked.  If it is MARKED it was ACK'ed
3081f8829a4aSRandall Stewart 			 * again.
3082f8829a4aSRandall Stewart 			 */
3083f8829a4aSRandall Stewart 			if (tp1->sent == SCTP_DATAGRAM_ACKED) {
3084f8829a4aSRandall Stewart 				/* it has been revoked */
3085f8829a4aSRandall Stewart 				tp1->sent = SCTP_DATAGRAM_SENT;
3086f8829a4aSRandall Stewart 				tp1->rec.data.chunk_was_revoked = 1;
3087a5d547adSRandall Stewart 				/*
308842551e99SRandall Stewart 				 * We must add this stuff back in to assure
308942551e99SRandall Stewart 				 * timers and such get started.
3090a5d547adSRandall Stewart 				 */
3091c105859eSRandall Stewart #ifdef SCTP_FLIGHT_LOGGING
3092c105859eSRandall Stewart 				sctp_misc_ints(SCTP_FLIGHT_LOG_UP_REVOKE,
3093c105859eSRandall Stewart 				    tp1->whoTo->flight_size,
3094c105859eSRandall Stewart 				    tp1->book_size,
3095c105859eSRandall Stewart 				    (uintptr_t) tp1->whoTo,
3096c105859eSRandall Stewart 				    tp1->rec.data.TSN_seq);
3097c105859eSRandall Stewart #endif
3098c105859eSRandall Stewart 				sctp_flight_size_increase(tp1);
3099c105859eSRandall Stewart 				sctp_total_flight_increase(stcb, tp1);
310042551e99SRandall Stewart 				/*
310142551e99SRandall Stewart 				 * We inflate the cwnd to compensate for our
310242551e99SRandall Stewart 				 * artificial inflation of the flight_size.
310342551e99SRandall Stewart 				 */
310442551e99SRandall Stewart 				tp1->whoTo->cwnd += tp1->book_size;
3105f8829a4aSRandall Stewart 				tot_revoked++;
3106f8829a4aSRandall Stewart #ifdef SCTP_SACK_LOGGING
3107f8829a4aSRandall Stewart 				sctp_log_sack(asoc->last_acked_seq,
3108f8829a4aSRandall Stewart 				    cumack,
3109f8829a4aSRandall Stewart 				    tp1->rec.data.TSN_seq,
3110f8829a4aSRandall Stewart 				    0,
3111f8829a4aSRandall Stewart 				    0,
3112f8829a4aSRandall Stewart 				    SCTP_LOG_TSN_REVOKED);
3113f8829a4aSRandall Stewart #endif
3114f8829a4aSRandall Stewart 			} else if (tp1->sent == SCTP_DATAGRAM_MARKED) {
3115f8829a4aSRandall Stewart 				/* it has been re-acked in this SACK */
3116f8829a4aSRandall Stewart 				tp1->sent = SCTP_DATAGRAM_ACKED;
3117f8829a4aSRandall Stewart 			}
3118f8829a4aSRandall Stewart 		}
3119f8829a4aSRandall Stewart 		if (tp1->sent == SCTP_DATAGRAM_UNSENT)
3120f8829a4aSRandall Stewart 			break;
3121f8829a4aSRandall Stewart 		tp1 = TAILQ_NEXT(tp1, sctp_next);
3122f8829a4aSRandall Stewart 	}
3123f8829a4aSRandall Stewart 	if (tot_revoked > 0) {
3124f8829a4aSRandall Stewart 		/*
3125f8829a4aSRandall Stewart 		 * Setup the ecn nonce re-sync point. We do this since once
3126f8829a4aSRandall Stewart 		 * data is revoked we begin to retransmit things, which do
3127f8829a4aSRandall Stewart 		 * NOT have the ECN bits set. This means we are now out of
3128f8829a4aSRandall Stewart 		 * sync and must wait until we get back in sync with the
3129f8829a4aSRandall Stewart 		 * peer to check ECN bits.
3130f8829a4aSRandall Stewart 		 */
3131f8829a4aSRandall Stewart 		tp1 = TAILQ_FIRST(&asoc->send_queue);
3132f8829a4aSRandall Stewart 		if (tp1 == NULL) {
3133f8829a4aSRandall Stewart 			asoc->nonce_resync_tsn = asoc->sending_seq;
3134f8829a4aSRandall Stewart 		} else {
3135f8829a4aSRandall Stewart 			asoc->nonce_resync_tsn = tp1->rec.data.TSN_seq;
3136f8829a4aSRandall Stewart 		}
3137f8829a4aSRandall Stewart 		asoc->nonce_wait_for_ecne = 0;
3138f8829a4aSRandall Stewart 		asoc->nonce_sum_check = 0;
3139f8829a4aSRandall Stewart 	}
3140f8829a4aSRandall Stewart }
3141f8829a4aSRandall Stewart 
3142f8829a4aSRandall Stewart static void
3143f8829a4aSRandall Stewart sctp_strike_gap_ack_chunks(struct sctp_tcb *stcb, struct sctp_association *asoc,
3144f8829a4aSRandall Stewart     u_long biggest_tsn_acked, u_long biggest_tsn_newly_acked, u_long this_sack_lowest_newack, int accum_moved)
3145f8829a4aSRandall Stewart {
3146f8829a4aSRandall Stewart 	struct sctp_tmit_chunk *tp1;
3147f8829a4aSRandall Stewart 	int strike_flag = 0;
3148f8829a4aSRandall Stewart 	struct timeval now;
3149f8829a4aSRandall Stewart 	int tot_retrans = 0;
3150f8829a4aSRandall Stewart 	uint32_t sending_seq;
3151f8829a4aSRandall Stewart 	struct sctp_nets *net;
3152f8829a4aSRandall Stewart 	int num_dests_sacked = 0;
3153f8829a4aSRandall Stewart 
3154f8829a4aSRandall Stewart 	/*
3155f8829a4aSRandall Stewart 	 * select the sending_seq, this is either the next thing ready to be
3156f8829a4aSRandall Stewart 	 * sent but not transmitted, OR, the next seq we assign.
3157f8829a4aSRandall Stewart 	 */
3158f8829a4aSRandall Stewart 	tp1 = TAILQ_FIRST(&stcb->asoc.send_queue);
3159f8829a4aSRandall Stewart 	if (tp1 == NULL) {
3160f8829a4aSRandall Stewart 		sending_seq = asoc->sending_seq;
3161f8829a4aSRandall Stewart 	} else {
3162f8829a4aSRandall Stewart 		sending_seq = tp1->rec.data.TSN_seq;
3163f8829a4aSRandall Stewart 	}
3164f8829a4aSRandall Stewart 
3165f8829a4aSRandall Stewart 	/* CMT DAC algo: finding out if SACK is a mixed SACK */
3166f8829a4aSRandall Stewart 	if (sctp_cmt_on_off && sctp_cmt_use_dac) {
3167f8829a4aSRandall Stewart 		TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
3168f8829a4aSRandall Stewart 			if (net->saw_newack)
3169f8829a4aSRandall Stewart 				num_dests_sacked++;
3170f8829a4aSRandall Stewart 		}
3171f8829a4aSRandall Stewart 	}
3172f8829a4aSRandall Stewart 	if (stcb->asoc.peer_supports_prsctp) {
3173f8829a4aSRandall Stewart 		SCTP_GETTIME_TIMEVAL(&now);
3174f8829a4aSRandall Stewart 	}
3175f8829a4aSRandall Stewart 	tp1 = TAILQ_FIRST(&asoc->sent_queue);
3176f8829a4aSRandall Stewart 	while (tp1) {
3177f8829a4aSRandall Stewart 		strike_flag = 0;
3178f8829a4aSRandall Stewart 		if (tp1->no_fr_allowed) {
3179f8829a4aSRandall Stewart 			/* this one had a timeout or something */
3180f8829a4aSRandall Stewart 			tp1 = TAILQ_NEXT(tp1, sctp_next);
3181f8829a4aSRandall Stewart 			continue;
3182f8829a4aSRandall Stewart 		}
3183f8829a4aSRandall Stewart #ifdef SCTP_FR_LOGGING
3184f8829a4aSRandall Stewart 		if (tp1->sent < SCTP_DATAGRAM_RESEND)
3185f8829a4aSRandall Stewart 			sctp_log_fr(biggest_tsn_newly_acked,
3186f8829a4aSRandall Stewart 			    tp1->rec.data.TSN_seq,
3187f8829a4aSRandall Stewart 			    tp1->sent,
3188f8829a4aSRandall Stewart 			    SCTP_FR_LOG_CHECK_STRIKE);
3189f8829a4aSRandall Stewart #endif
3190f8829a4aSRandall Stewart 		if (compare_with_wrap(tp1->rec.data.TSN_seq, biggest_tsn_acked,
3191f8829a4aSRandall Stewart 		    MAX_TSN) ||
3192f8829a4aSRandall Stewart 		    tp1->sent == SCTP_DATAGRAM_UNSENT) {
3193f8829a4aSRandall Stewart 			/* done */
3194f8829a4aSRandall Stewart 			break;
3195f8829a4aSRandall Stewart 		}
3196f8829a4aSRandall Stewart 		if (stcb->asoc.peer_supports_prsctp) {
3197f8829a4aSRandall Stewart 			if ((PR_SCTP_TTL_ENABLED(tp1->flags)) && tp1->sent < SCTP_DATAGRAM_ACKED) {
3198f8829a4aSRandall Stewart 				/* Is it expired? */
31995e54f665SRandall Stewart 				if (
32005e54f665SRandall Stewart 				    (timevalcmp(&now, &tp1->rec.data.timetodrop, >))
32015e54f665SRandall Stewart 				    ) {
3202f8829a4aSRandall Stewart 					/* Yes so drop it */
3203f8829a4aSRandall Stewart 					if (tp1->data != NULL) {
3204f8829a4aSRandall Stewart 						sctp_release_pr_sctp_chunk(stcb, tp1,
3205f8829a4aSRandall Stewart 						    (SCTP_RESPONSE_TO_USER_REQ | SCTP_NOTIFY_DATAGRAM_SENT),
3206f8829a4aSRandall Stewart 						    &asoc->sent_queue);
3207f8829a4aSRandall Stewart 					}
3208f8829a4aSRandall Stewart 					tp1 = TAILQ_NEXT(tp1, sctp_next);
3209f8829a4aSRandall Stewart 					continue;
3210f8829a4aSRandall Stewart 				}
3211f8829a4aSRandall Stewart 			}
3212f8829a4aSRandall Stewart 			if ((PR_SCTP_RTX_ENABLED(tp1->flags)) && tp1->sent < SCTP_DATAGRAM_ACKED) {
3213f8829a4aSRandall Stewart 				/* Has it been retransmitted tv_sec times? */
3214f8829a4aSRandall Stewart 				if (tp1->snd_count > tp1->rec.data.timetodrop.tv_sec) {
3215f8829a4aSRandall Stewart 					/* Yes, so drop it */
3216f8829a4aSRandall Stewart 					if (tp1->data != NULL) {
3217f8829a4aSRandall Stewart 						sctp_release_pr_sctp_chunk(stcb, tp1,
3218f8829a4aSRandall Stewart 						    (SCTP_RESPONSE_TO_USER_REQ | SCTP_NOTIFY_DATAGRAM_SENT),
3219f8829a4aSRandall Stewart 						    &asoc->sent_queue);
3220f8829a4aSRandall Stewart 					}
3221f8829a4aSRandall Stewart 					tp1 = TAILQ_NEXT(tp1, sctp_next);
3222f8829a4aSRandall Stewart 					continue;
3223f8829a4aSRandall Stewart 				}
3224f8829a4aSRandall Stewart 			}
3225f8829a4aSRandall Stewart 		}
3226f8829a4aSRandall Stewart 		if (compare_with_wrap(tp1->rec.data.TSN_seq,
3227f8829a4aSRandall Stewart 		    asoc->this_sack_highest_gap, MAX_TSN)) {
3228f8829a4aSRandall Stewart 			/* we are beyond the tsn in the sack  */
3229f8829a4aSRandall Stewart 			break;
3230f8829a4aSRandall Stewart 		}
3231f8829a4aSRandall Stewart 		if (tp1->sent >= SCTP_DATAGRAM_RESEND) {
3232f8829a4aSRandall Stewart 			/* either a RESEND, ACKED, or MARKED */
3233f8829a4aSRandall Stewart 			/* skip */
3234f8829a4aSRandall Stewart 			tp1 = TAILQ_NEXT(tp1, sctp_next);
3235f8829a4aSRandall Stewart 			continue;
3236f8829a4aSRandall Stewart 		}
3237f8829a4aSRandall Stewart 		/*
3238f8829a4aSRandall Stewart 		 * CMT : SFR algo (covers part of DAC and HTNA as well)
3239f8829a4aSRandall Stewart 		 */
3240f8829a4aSRandall Stewart 		if (tp1->whoTo->saw_newack == 0) {
3241f8829a4aSRandall Stewart 			/*
3242f8829a4aSRandall Stewart 			 * No new acks were receieved for data sent to this
3243f8829a4aSRandall Stewart 			 * dest. Therefore, according to the SFR algo for
3244f8829a4aSRandall Stewart 			 * CMT, no data sent to this dest can be marked for
3245c105859eSRandall Stewart 			 * FR using this SACK.
3246f8829a4aSRandall Stewart 			 */
3247f8829a4aSRandall Stewart 			tp1 = TAILQ_NEXT(tp1, sctp_next);
3248f8829a4aSRandall Stewart 			continue;
3249f8829a4aSRandall Stewart 		} else if (compare_with_wrap(tp1->rec.data.TSN_seq,
3250f8829a4aSRandall Stewart 		    tp1->whoTo->this_sack_highest_newack, MAX_TSN)) {
3251f8829a4aSRandall Stewart 			/*
3252f8829a4aSRandall Stewart 			 * CMT: New acks were receieved for data sent to
3253f8829a4aSRandall Stewart 			 * this dest. But no new acks were seen for data
3254f8829a4aSRandall Stewart 			 * sent after tp1. Therefore, according to the SFR
3255f8829a4aSRandall Stewart 			 * algo for CMT, tp1 cannot be marked for FR using
3256f8829a4aSRandall Stewart 			 * this SACK. This step covers part of the DAC algo
3257f8829a4aSRandall Stewart 			 * and the HTNA algo as well.
3258f8829a4aSRandall Stewart 			 */
3259f8829a4aSRandall Stewart 			tp1 = TAILQ_NEXT(tp1, sctp_next);
3260f8829a4aSRandall Stewart 			continue;
3261f8829a4aSRandall Stewart 		}
3262f8829a4aSRandall Stewart 		/*
3263f8829a4aSRandall Stewart 		 * Here we check to see if we were have already done a FR
3264f8829a4aSRandall Stewart 		 * and if so we see if the biggest TSN we saw in the sack is
3265f8829a4aSRandall Stewart 		 * smaller than the recovery point. If so we don't strike
3266f8829a4aSRandall Stewart 		 * the tsn... otherwise we CAN strike the TSN.
3267f8829a4aSRandall Stewart 		 */
3268f8829a4aSRandall Stewart 		/*
326942551e99SRandall Stewart 		 * @@@ JRI: Check for CMT if (accum_moved &&
327042551e99SRandall Stewart 		 * asoc->fast_retran_loss_recovery && (sctp_cmt_on_off ==
327142551e99SRandall Stewart 		 * 0)) {
3272f8829a4aSRandall Stewart 		 */
327342551e99SRandall Stewart 		if (accum_moved && asoc->fast_retran_loss_recovery) {
3274f8829a4aSRandall Stewart 			/*
3275f8829a4aSRandall Stewart 			 * Strike the TSN if in fast-recovery and cum-ack
3276f8829a4aSRandall Stewart 			 * moved.
3277f8829a4aSRandall Stewart 			 */
3278f8829a4aSRandall Stewart #ifdef SCTP_FR_LOGGING
3279f8829a4aSRandall Stewart 			sctp_log_fr(biggest_tsn_newly_acked,
3280f8829a4aSRandall Stewart 			    tp1->rec.data.TSN_seq,
3281f8829a4aSRandall Stewart 			    tp1->sent,
3282f8829a4aSRandall Stewart 			    SCTP_FR_LOG_STRIKE_CHUNK);
3283f8829a4aSRandall Stewart #endif
32845e54f665SRandall Stewart 			if (tp1->sent < SCTP_DATAGRAM_RESEND) {
3285f8829a4aSRandall Stewart 				tp1->sent++;
32865e54f665SRandall Stewart 			}
3287f8829a4aSRandall Stewart 			if (sctp_cmt_on_off && sctp_cmt_use_dac) {
3288f8829a4aSRandall Stewart 				/*
3289f8829a4aSRandall Stewart 				 * CMT DAC algorithm: If SACK flag is set to
3290f8829a4aSRandall Stewart 				 * 0, then lowest_newack test will not pass
3291f8829a4aSRandall Stewart 				 * because it would have been set to the
3292f8829a4aSRandall Stewart 				 * cumack earlier. If not already to be
3293f8829a4aSRandall Stewart 				 * rtx'd, If not a mixed sack and if tp1 is
3294f8829a4aSRandall Stewart 				 * not between two sacked TSNs, then mark by
3295c105859eSRandall Stewart 				 * one more. NOTE that we are marking by one
3296c105859eSRandall Stewart 				 * additional time since the SACK DAC flag
3297c105859eSRandall Stewart 				 * indicates that two packets have been
3298c105859eSRandall Stewart 				 * received after this missing TSN.
32995e54f665SRandall Stewart 				 */
33005e54f665SRandall Stewart 				if ((tp1->sent < SCTP_DATAGRAM_RESEND) && (num_dests_sacked == 1) &&
3301f8829a4aSRandall Stewart 				    compare_with_wrap(this_sack_lowest_newack, tp1->rec.data.TSN_seq, MAX_TSN)) {
3302f8829a4aSRandall Stewart #ifdef SCTP_FR_LOGGING
3303f8829a4aSRandall Stewart 					sctp_log_fr(16 + num_dests_sacked,
3304f8829a4aSRandall Stewart 					    tp1->rec.data.TSN_seq,
3305f8829a4aSRandall Stewart 					    tp1->sent,
3306f8829a4aSRandall Stewart 					    SCTP_FR_LOG_STRIKE_CHUNK);
3307f8829a4aSRandall Stewart #endif
3308f8829a4aSRandall Stewart 					tp1->sent++;
3309f8829a4aSRandall Stewart 				}
3310f8829a4aSRandall Stewart 			}
3311f8829a4aSRandall Stewart 		} else if (tp1->rec.data.doing_fast_retransmit) {
3312f8829a4aSRandall Stewart 			/*
3313f8829a4aSRandall Stewart 			 * For those that have done a FR we must take
3314f8829a4aSRandall Stewart 			 * special consideration if we strike. I.e the
3315f8829a4aSRandall Stewart 			 * biggest_newly_acked must be higher than the
3316f8829a4aSRandall Stewart 			 * sending_seq at the time we did the FR.
3317f8829a4aSRandall Stewart 			 */
33185e54f665SRandall Stewart 			if (
3319f8829a4aSRandall Stewart #ifdef SCTP_FR_TO_ALTERNATE
3320f8829a4aSRandall Stewart 			/*
3321f8829a4aSRandall Stewart 			 * If FR's go to new networks, then we must only do
3322f8829a4aSRandall Stewart 			 * this for singly homed asoc's. However if the FR's
3323f8829a4aSRandall Stewart 			 * go to the same network (Armando's work) then its
3324f8829a4aSRandall Stewart 			 * ok to FR multiple times.
3325f8829a4aSRandall Stewart 			 */
33265e54f665SRandall Stewart 			    (asoc->numnets < 2)
3327f8829a4aSRandall Stewart #else
33285e54f665SRandall Stewart 			    (1)
3329f8829a4aSRandall Stewart #endif
33305e54f665SRandall Stewart 			    ) {
33315e54f665SRandall Stewart 
3332f8829a4aSRandall Stewart 				if ((compare_with_wrap(biggest_tsn_newly_acked,
3333f8829a4aSRandall Stewart 				    tp1->rec.data.fast_retran_tsn, MAX_TSN)) ||
3334f8829a4aSRandall Stewart 				    (biggest_tsn_newly_acked ==
3335f8829a4aSRandall Stewart 				    tp1->rec.data.fast_retran_tsn)) {
3336f8829a4aSRandall Stewart 					/*
3337f8829a4aSRandall Stewart 					 * Strike the TSN, since this ack is
3338f8829a4aSRandall Stewart 					 * beyond where things were when we
3339f8829a4aSRandall Stewart 					 * did a FR.
3340f8829a4aSRandall Stewart 					 */
3341f8829a4aSRandall Stewart #ifdef SCTP_FR_LOGGING
3342f8829a4aSRandall Stewart 					sctp_log_fr(biggest_tsn_newly_acked,
3343f8829a4aSRandall Stewart 					    tp1->rec.data.TSN_seq,
3344f8829a4aSRandall Stewart 					    tp1->sent,
3345f8829a4aSRandall Stewart 					    SCTP_FR_LOG_STRIKE_CHUNK);
3346f8829a4aSRandall Stewart #endif
33475e54f665SRandall Stewart 					if (tp1->sent < SCTP_DATAGRAM_RESEND) {
3348f8829a4aSRandall Stewart 						tp1->sent++;
33495e54f665SRandall Stewart 					}
3350f8829a4aSRandall Stewart 					strike_flag = 1;
3351f8829a4aSRandall Stewart 					if (sctp_cmt_on_off && sctp_cmt_use_dac) {
3352f8829a4aSRandall Stewart 						/*
3353f8829a4aSRandall Stewart 						 * CMT DAC algorithm: If
3354f8829a4aSRandall Stewart 						 * SACK flag is set to 0,
3355f8829a4aSRandall Stewart 						 * then lowest_newack test
3356f8829a4aSRandall Stewart 						 * will not pass because it
3357f8829a4aSRandall Stewart 						 * would have been set to
3358f8829a4aSRandall Stewart 						 * the cumack earlier. If
3359f8829a4aSRandall Stewart 						 * not already to be rtx'd,
3360f8829a4aSRandall Stewart 						 * If not a mixed sack and
3361f8829a4aSRandall Stewart 						 * if tp1 is not between two
3362f8829a4aSRandall Stewart 						 * sacked TSNs, then mark by
3363c105859eSRandall Stewart 						 * one more. NOTE that we
3364c105859eSRandall Stewart 						 * are marking by one
3365c105859eSRandall Stewart 						 * additional time since the
3366c105859eSRandall Stewart 						 * SACK DAC flag indicates
3367c105859eSRandall Stewart 						 * that two packets have
3368c105859eSRandall Stewart 						 * been received after this
3369c105859eSRandall Stewart 						 * missing TSN.
3370f8829a4aSRandall Stewart 						 */
33715e54f665SRandall Stewart 						if ((tp1->sent < SCTP_DATAGRAM_RESEND) &&
33725e54f665SRandall Stewart 						    (num_dests_sacked == 1) &&
33735e54f665SRandall Stewart 						    compare_with_wrap(this_sack_lowest_newack,
33745e54f665SRandall Stewart 						    tp1->rec.data.TSN_seq, MAX_TSN)) {
3375f8829a4aSRandall Stewart #ifdef SCTP_FR_LOGGING
3376f8829a4aSRandall Stewart 							sctp_log_fr(32 + num_dests_sacked,
3377f8829a4aSRandall Stewart 							    tp1->rec.data.TSN_seq,
3378f8829a4aSRandall Stewart 							    tp1->sent,
3379f8829a4aSRandall Stewart 							    SCTP_FR_LOG_STRIKE_CHUNK);
3380f8829a4aSRandall Stewart #endif
33815e54f665SRandall Stewart 							if (tp1->sent < SCTP_DATAGRAM_RESEND) {
3382f8829a4aSRandall Stewart 								tp1->sent++;
33835e54f665SRandall Stewart 
33845e54f665SRandall Stewart 							}
3385f8829a4aSRandall Stewart 						}
3386f8829a4aSRandall Stewart 					}
3387f8829a4aSRandall Stewart 				}
3388f8829a4aSRandall Stewart 			}
3389f8829a4aSRandall Stewart 			/*
339042551e99SRandall Stewart 			 * JRI: TODO: remove code for HTNA algo. CMT's SFR
339142551e99SRandall Stewart 			 * algo covers HTNA.
3392f8829a4aSRandall Stewart 			 */
3393f8829a4aSRandall Stewart 		} else if (compare_with_wrap(tp1->rec.data.TSN_seq,
3394f8829a4aSRandall Stewart 		    biggest_tsn_newly_acked, MAX_TSN)) {
3395f8829a4aSRandall Stewart 			/*
3396f8829a4aSRandall Stewart 			 * We don't strike these: This is the  HTNA
3397f8829a4aSRandall Stewart 			 * algorithm i.e. we don't strike If our TSN is
3398f8829a4aSRandall Stewart 			 * larger than the Highest TSN Newly Acked.
3399f8829a4aSRandall Stewart 			 */
3400f8829a4aSRandall Stewart 			;
3401f8829a4aSRandall Stewart 		} else {
3402f8829a4aSRandall Stewart 			/* Strike the TSN */
3403f8829a4aSRandall Stewart #ifdef SCTP_FR_LOGGING
3404f8829a4aSRandall Stewart 			sctp_log_fr(biggest_tsn_newly_acked,
3405f8829a4aSRandall Stewart 			    tp1->rec.data.TSN_seq,
3406f8829a4aSRandall Stewart 			    tp1->sent,
3407f8829a4aSRandall Stewart 			    SCTP_FR_LOG_STRIKE_CHUNK);
3408f8829a4aSRandall Stewart #endif
34095e54f665SRandall Stewart 			if (tp1->sent < SCTP_DATAGRAM_RESEND) {
3410f8829a4aSRandall Stewart 				tp1->sent++;
34115e54f665SRandall Stewart 			}
3412f8829a4aSRandall Stewart 			if (sctp_cmt_on_off && sctp_cmt_use_dac) {
3413f8829a4aSRandall Stewart 				/*
3414f8829a4aSRandall Stewart 				 * CMT DAC algorithm: If SACK flag is set to
3415f8829a4aSRandall Stewart 				 * 0, then lowest_newack test will not pass
3416f8829a4aSRandall Stewart 				 * because it would have been set to the
3417f8829a4aSRandall Stewart 				 * cumack earlier. If not already to be
3418f8829a4aSRandall Stewart 				 * rtx'd, If not a mixed sack and if tp1 is
3419f8829a4aSRandall Stewart 				 * not between two sacked TSNs, then mark by
3420c105859eSRandall Stewart 				 * one more. NOTE that we are marking by one
3421c105859eSRandall Stewart 				 * additional time since the SACK DAC flag
3422c105859eSRandall Stewart 				 * indicates that two packets have been
3423c105859eSRandall Stewart 				 * received after this missing TSN.
3424f8829a4aSRandall Stewart 				 */
34255e54f665SRandall Stewart 				if ((tp1->sent < SCTP_DATAGRAM_RESEND) && (num_dests_sacked == 1) &&
3426f8829a4aSRandall Stewart 				    compare_with_wrap(this_sack_lowest_newack, tp1->rec.data.TSN_seq, MAX_TSN)) {
3427f8829a4aSRandall Stewart #ifdef SCTP_FR_LOGGING
3428f8829a4aSRandall Stewart 					sctp_log_fr(48 + num_dests_sacked,
3429f8829a4aSRandall Stewart 					    tp1->rec.data.TSN_seq,
3430f8829a4aSRandall Stewart 					    tp1->sent,
3431f8829a4aSRandall Stewart 					    SCTP_FR_LOG_STRIKE_CHUNK);
3432f8829a4aSRandall Stewart #endif
3433f8829a4aSRandall Stewart 					tp1->sent++;
3434f8829a4aSRandall Stewart 				}
3435f8829a4aSRandall Stewart 			}
3436f8829a4aSRandall Stewart 		}
3437f8829a4aSRandall Stewart 		if (tp1->sent == SCTP_DATAGRAM_RESEND) {
3438f8829a4aSRandall Stewart 			/* Increment the count to resend */
3439f8829a4aSRandall Stewart 			struct sctp_nets *alt;
3440f8829a4aSRandall Stewart 
3441f8829a4aSRandall Stewart 			/* printf("OK, we are now ready to FR this guy\n"); */
3442f8829a4aSRandall Stewart #ifdef SCTP_FR_LOGGING
3443f8829a4aSRandall Stewart 			sctp_log_fr(tp1->rec.data.TSN_seq, tp1->snd_count,
3444f8829a4aSRandall Stewart 			    0, SCTP_FR_MARKED);
3445f8829a4aSRandall Stewart #endif
3446f8829a4aSRandall Stewart 			if (strike_flag) {
3447f8829a4aSRandall Stewart 				/* This is a subsequent FR */
3448f8829a4aSRandall Stewart 				SCTP_STAT_INCR(sctps_sendmultfastretrans);
3449f8829a4aSRandall Stewart 			}
34505e54f665SRandall Stewart 			sctp_ucount_incr(stcb->asoc.sent_queue_retran_cnt);
3451f8829a4aSRandall Stewart 			if (sctp_cmt_on_off) {
3452f8829a4aSRandall Stewart 				/*
3453f8829a4aSRandall Stewart 				 * CMT: Using RTX_SSTHRESH policy for CMT.
3454f8829a4aSRandall Stewart 				 * If CMT is being used, then pick dest with
3455f8829a4aSRandall Stewart 				 * largest ssthresh for any retransmission.
3456f8829a4aSRandall Stewart 				 */
3457f8829a4aSRandall Stewart 				tp1->no_fr_allowed = 1;
3458f8829a4aSRandall Stewart 				alt = tp1->whoTo;
3459f8829a4aSRandall Stewart 				alt = sctp_find_alternate_net(stcb, alt, 1);
3460f8829a4aSRandall Stewart 				/*
3461f8829a4aSRandall Stewart 				 * CUCv2: If a different dest is picked for
3462f8829a4aSRandall Stewart 				 * the retransmission, then new
3463f8829a4aSRandall Stewart 				 * (rtx-)pseudo_cumack needs to be tracked
3464f8829a4aSRandall Stewart 				 * for orig dest. Let CUCv2 track new (rtx-)
3465f8829a4aSRandall Stewart 				 * pseudo-cumack always.
3466f8829a4aSRandall Stewart 				 */
3467f8829a4aSRandall Stewart 				tp1->whoTo->find_pseudo_cumack = 1;
3468f8829a4aSRandall Stewart 				tp1->whoTo->find_rtx_pseudo_cumack = 1;
3469f8829a4aSRandall Stewart 
3470f8829a4aSRandall Stewart 
3471f8829a4aSRandall Stewart 			} else {/* CMT is OFF */
3472f8829a4aSRandall Stewart 
3473f8829a4aSRandall Stewart #ifdef SCTP_FR_TO_ALTERNATE
3474f8829a4aSRandall Stewart 				/* Can we find an alternate? */
3475f8829a4aSRandall Stewart 				alt = sctp_find_alternate_net(stcb, tp1->whoTo, 0);
3476f8829a4aSRandall Stewart #else
3477f8829a4aSRandall Stewart 				/*
3478f8829a4aSRandall Stewart 				 * default behavior is to NOT retransmit
3479f8829a4aSRandall Stewart 				 * FR's to an alternate. Armando Caro's
3480f8829a4aSRandall Stewart 				 * paper details why.
3481f8829a4aSRandall Stewart 				 */
3482f8829a4aSRandall Stewart 				alt = tp1->whoTo;
3483f8829a4aSRandall Stewart #endif
3484f8829a4aSRandall Stewart 			}
3485f8829a4aSRandall Stewart 
3486f8829a4aSRandall Stewart 			tp1->rec.data.doing_fast_retransmit = 1;
3487f8829a4aSRandall Stewart 			tot_retrans++;
3488f8829a4aSRandall Stewart 			/* mark the sending seq for possible subsequent FR's */
3489f8829a4aSRandall Stewart 			/*
3490f8829a4aSRandall Stewart 			 * printf("Marking TSN for FR new value %x\n",
3491f8829a4aSRandall Stewart 			 * (uint32_t)tpi->rec.data.TSN_seq);
3492f8829a4aSRandall Stewart 			 */
3493f8829a4aSRandall Stewart 			if (TAILQ_EMPTY(&asoc->send_queue)) {
3494f8829a4aSRandall Stewart 				/*
3495f8829a4aSRandall Stewart 				 * If the queue of send is empty then its
3496f8829a4aSRandall Stewart 				 * the next sequence number that will be
3497f8829a4aSRandall Stewart 				 * assigned so we subtract one from this to
3498f8829a4aSRandall Stewart 				 * get the one we last sent.
3499f8829a4aSRandall Stewart 				 */
3500f8829a4aSRandall Stewart 				tp1->rec.data.fast_retran_tsn = sending_seq;
3501f8829a4aSRandall Stewart 			} else {
3502f8829a4aSRandall Stewart 				/*
3503f8829a4aSRandall Stewart 				 * If there are chunks on the send queue
3504f8829a4aSRandall Stewart 				 * (unsent data that has made it from the
3505f8829a4aSRandall Stewart 				 * stream queues but not out the door, we
3506f8829a4aSRandall Stewart 				 * take the first one (which will have the
3507f8829a4aSRandall Stewart 				 * lowest TSN) and subtract one to get the
3508f8829a4aSRandall Stewart 				 * one we last sent.
3509f8829a4aSRandall Stewart 				 */
3510f8829a4aSRandall Stewart 				struct sctp_tmit_chunk *ttt;
3511f8829a4aSRandall Stewart 
3512f8829a4aSRandall Stewart 				ttt = TAILQ_FIRST(&asoc->send_queue);
3513f8829a4aSRandall Stewart 				tp1->rec.data.fast_retran_tsn =
3514f8829a4aSRandall Stewart 				    ttt->rec.data.TSN_seq;
3515f8829a4aSRandall Stewart 			}
3516f8829a4aSRandall Stewart 
3517f8829a4aSRandall Stewart 			if (tp1->do_rtt) {
3518f8829a4aSRandall Stewart 				/*
3519f8829a4aSRandall Stewart 				 * this guy had a RTO calculation pending on
3520f8829a4aSRandall Stewart 				 * it, cancel it
3521f8829a4aSRandall Stewart 				 */
3522f8829a4aSRandall Stewart 				tp1->do_rtt = 0;
3523f8829a4aSRandall Stewart 			}
3524f8829a4aSRandall Stewart 			/* fix counts and things */
3525a5d547adSRandall Stewart #ifdef SCTP_FLIGHT_LOGGING
3526c105859eSRandall Stewart 			sctp_misc_ints(SCTP_FLIGHT_LOG_DOWN_RSND,
3527a5d547adSRandall Stewart 			    tp1->whoTo->flight_size,
3528a5d547adSRandall Stewart 			    tp1->book_size,
3529c105859eSRandall Stewart 			    (uintptr_t) tp1->whoTo,
3530a5d547adSRandall Stewart 			    tp1->rec.data.TSN_seq);
3531a5d547adSRandall Stewart #endif
3532f8829a4aSRandall Stewart 			tp1->whoTo->net_ack++;
3533c105859eSRandall Stewart 			sctp_flight_size_decrease(tp1);
3534f8829a4aSRandall Stewart 
3535f8829a4aSRandall Stewart #ifdef SCTP_LOG_RWND
3536f8829a4aSRandall Stewart 			sctp_log_rwnd(SCTP_INCREASE_PEER_RWND,
3537f8829a4aSRandall Stewart 			    asoc->peers_rwnd, tp1->send_size, sctp_peer_chunk_oh);
3538f8829a4aSRandall Stewart #endif
3539f8829a4aSRandall Stewart 			/* add back to the rwnd */
3540f8829a4aSRandall Stewart 			asoc->peers_rwnd += (tp1->send_size + sctp_peer_chunk_oh);
3541f8829a4aSRandall Stewart 
3542f8829a4aSRandall Stewart 			/* remove from the total flight */
3543c105859eSRandall Stewart 			sctp_total_flight_decrease(stcb, tp1);
3544f8829a4aSRandall Stewart 			if (alt != tp1->whoTo) {
3545f8829a4aSRandall Stewart 				/* yes, there is an alternate. */
3546f8829a4aSRandall Stewart 				sctp_free_remote_addr(tp1->whoTo);
3547f8829a4aSRandall Stewart 				tp1->whoTo = alt;
3548f8829a4aSRandall Stewart 				atomic_add_int(&alt->ref_count, 1);
3549f8829a4aSRandall Stewart 			}
3550f8829a4aSRandall Stewart 		}
3551f8829a4aSRandall Stewart 		tp1 = TAILQ_NEXT(tp1, sctp_next);
3552f8829a4aSRandall Stewart 	}			/* while (tp1) */
3553f8829a4aSRandall Stewart 
3554f8829a4aSRandall Stewart 	if (tot_retrans > 0) {
3555f8829a4aSRandall Stewart 		/*
3556f8829a4aSRandall Stewart 		 * Setup the ecn nonce re-sync point. We do this since once
3557f8829a4aSRandall Stewart 		 * we go to FR something we introduce a Karn's rule scenario
3558f8829a4aSRandall Stewart 		 * and won't know the totals for the ECN bits.
3559f8829a4aSRandall Stewart 		 */
3560f8829a4aSRandall Stewart 		asoc->nonce_resync_tsn = sending_seq;
3561f8829a4aSRandall Stewart 		asoc->nonce_wait_for_ecne = 0;
3562f8829a4aSRandall Stewart 		asoc->nonce_sum_check = 0;
3563f8829a4aSRandall Stewart 	}
3564f8829a4aSRandall Stewart }
3565f8829a4aSRandall Stewart 
3566f8829a4aSRandall Stewart struct sctp_tmit_chunk *
3567f8829a4aSRandall Stewart sctp_try_advance_peer_ack_point(struct sctp_tcb *stcb,
3568f8829a4aSRandall Stewart     struct sctp_association *asoc)
3569f8829a4aSRandall Stewart {
3570f8829a4aSRandall Stewart 	struct sctp_tmit_chunk *tp1, *tp2, *a_adv = NULL;
3571f8829a4aSRandall Stewart 	struct timeval now;
3572f8829a4aSRandall Stewart 	int now_filled = 0;
3573f8829a4aSRandall Stewart 
3574f8829a4aSRandall Stewart 	if (asoc->peer_supports_prsctp == 0) {
3575f8829a4aSRandall Stewart 		return (NULL);
3576f8829a4aSRandall Stewart 	}
3577f8829a4aSRandall Stewart 	tp1 = TAILQ_FIRST(&asoc->sent_queue);
3578f8829a4aSRandall Stewart 	while (tp1) {
3579f8829a4aSRandall Stewart 		if (tp1->sent != SCTP_FORWARD_TSN_SKIP &&
3580f8829a4aSRandall Stewart 		    tp1->sent != SCTP_DATAGRAM_RESEND) {
3581f8829a4aSRandall Stewart 			/* no chance to advance, out of here */
3582f8829a4aSRandall Stewart 			break;
3583f8829a4aSRandall Stewart 		}
3584f8829a4aSRandall Stewart 		if (!PR_SCTP_ENABLED(tp1->flags)) {
3585f8829a4aSRandall Stewart 			/*
3586f8829a4aSRandall Stewart 			 * We can't fwd-tsn past any that are reliable aka
3587f8829a4aSRandall Stewart 			 * retransmitted until the asoc fails.
3588f8829a4aSRandall Stewart 			 */
3589f8829a4aSRandall Stewart 			break;
3590f8829a4aSRandall Stewart 		}
3591f8829a4aSRandall Stewart 		if (!now_filled) {
3592f8829a4aSRandall Stewart 			SCTP_GETTIME_TIMEVAL(&now);
3593f8829a4aSRandall Stewart 			now_filled = 1;
3594f8829a4aSRandall Stewart 		}
3595f8829a4aSRandall Stewart 		tp2 = TAILQ_NEXT(tp1, sctp_next);
3596f8829a4aSRandall Stewart 		/*
3597f8829a4aSRandall Stewart 		 * now we got a chunk which is marked for another
3598f8829a4aSRandall Stewart 		 * retransmission to a PR-stream but has run out its chances
3599f8829a4aSRandall Stewart 		 * already maybe OR has been marked to skip now. Can we skip
3600f8829a4aSRandall Stewart 		 * it if its a resend?
3601f8829a4aSRandall Stewart 		 */
3602f8829a4aSRandall Stewart 		if (tp1->sent == SCTP_DATAGRAM_RESEND &&
3603f8829a4aSRandall Stewart 		    (PR_SCTP_TTL_ENABLED(tp1->flags))) {
3604f8829a4aSRandall Stewart 			/*
3605f8829a4aSRandall Stewart 			 * Now is this one marked for resend and its time is
3606f8829a4aSRandall Stewart 			 * now up?
3607f8829a4aSRandall Stewart 			 */
3608f8829a4aSRandall Stewart 			if (timevalcmp(&now, &tp1->rec.data.timetodrop, >)) {
3609f8829a4aSRandall Stewart 				/* Yes so drop it */
3610f8829a4aSRandall Stewart 				if (tp1->data) {
3611f8829a4aSRandall Stewart 					sctp_release_pr_sctp_chunk(stcb, tp1,
3612f8829a4aSRandall Stewart 					    (SCTP_RESPONSE_TO_USER_REQ | SCTP_NOTIFY_DATAGRAM_SENT),
3613f8829a4aSRandall Stewart 					    &asoc->sent_queue);
3614f8829a4aSRandall Stewart 				}
3615f8829a4aSRandall Stewart 			} else {
3616f8829a4aSRandall Stewart 				/*
3617f8829a4aSRandall Stewart 				 * No, we are done when hit one for resend
3618f8829a4aSRandall Stewart 				 * whos time as not expired.
3619f8829a4aSRandall Stewart 				 */
3620f8829a4aSRandall Stewart 				break;
3621f8829a4aSRandall Stewart 			}
3622f8829a4aSRandall Stewart 		}
3623f8829a4aSRandall Stewart 		/*
3624f8829a4aSRandall Stewart 		 * Ok now if this chunk is marked to drop it we can clean up
3625f8829a4aSRandall Stewart 		 * the chunk, advance our peer ack point and we can check
3626f8829a4aSRandall Stewart 		 * the next chunk.
3627f8829a4aSRandall Stewart 		 */
3628f8829a4aSRandall Stewart 		if (tp1->sent == SCTP_FORWARD_TSN_SKIP) {
3629f8829a4aSRandall Stewart 			/* advance PeerAckPoint goes forward */
3630f8829a4aSRandall Stewart 			asoc->advanced_peer_ack_point = tp1->rec.data.TSN_seq;
3631f8829a4aSRandall Stewart 			a_adv = tp1;
3632f8829a4aSRandall Stewart 			/*
3633f8829a4aSRandall Stewart 			 * we don't want to de-queue it here. Just wait for
3634f8829a4aSRandall Stewart 			 * the next peer SACK to come with a new cumTSN and
3635f8829a4aSRandall Stewart 			 * then the chunk will be droped in the normal
3636f8829a4aSRandall Stewart 			 * fashion.
3637f8829a4aSRandall Stewart 			 */
3638f8829a4aSRandall Stewart 			if (tp1->data) {
3639f8829a4aSRandall Stewart 				sctp_free_bufspace(stcb, asoc, tp1, 1);
3640f8829a4aSRandall Stewart 				/*
3641f8829a4aSRandall Stewart 				 * Maybe there should be another
3642f8829a4aSRandall Stewart 				 * notification type
3643f8829a4aSRandall Stewart 				 */
3644f8829a4aSRandall Stewart 				sctp_ulp_notify(SCTP_NOTIFY_DG_FAIL, stcb,
3645f8829a4aSRandall Stewart 				    (SCTP_RESPONSE_TO_USER_REQ | SCTP_NOTIFY_DATAGRAM_SENT),
3646f8829a4aSRandall Stewart 				    tp1);
3647f8829a4aSRandall Stewart 				sctp_m_freem(tp1->data);
3648f8829a4aSRandall Stewart 				tp1->data = NULL;
3649f8829a4aSRandall Stewart 				if (stcb->sctp_socket) {
3650f8829a4aSRandall Stewart 					sctp_sowwakeup(stcb->sctp_ep,
3651f8829a4aSRandall Stewart 					    stcb->sctp_socket);
3652f8829a4aSRandall Stewart #ifdef SCTP_WAKE_LOGGING
3653f8829a4aSRandall Stewart 					sctp_wakeup_log(stcb, tp1->rec.data.TSN_seq, 1, SCTP_WAKESND_FROM_FWDTSN);
3654f8829a4aSRandall Stewart #endif
3655f8829a4aSRandall Stewart 				}
3656f8829a4aSRandall Stewart 			}
3657f8829a4aSRandall Stewart 		} else {
3658f8829a4aSRandall Stewart 			/*
3659f8829a4aSRandall Stewart 			 * If it is still in RESEND we can advance no
3660f8829a4aSRandall Stewart 			 * further
3661f8829a4aSRandall Stewart 			 */
3662f8829a4aSRandall Stewart 			break;
3663f8829a4aSRandall Stewart 		}
3664f8829a4aSRandall Stewart 		/*
3665f8829a4aSRandall Stewart 		 * If we hit here we just dumped tp1, move to next tsn on
3666f8829a4aSRandall Stewart 		 * sent queue.
3667f8829a4aSRandall Stewart 		 */
3668f8829a4aSRandall Stewart 		tp1 = tp2;
3669f8829a4aSRandall Stewart 	}
3670f8829a4aSRandall Stewart 	return (a_adv);
3671f8829a4aSRandall Stewart }
3672f8829a4aSRandall Stewart 
3673f8829a4aSRandall Stewart #ifdef SCTP_HIGH_SPEED
3674f8829a4aSRandall Stewart struct sctp_hs_raise_drop {
3675f8829a4aSRandall Stewart 	int32_t cwnd;
3676f8829a4aSRandall Stewart 	int32_t increase;
3677f8829a4aSRandall Stewart 	int32_t drop_percent;
3678f8829a4aSRandall Stewart };
3679f8829a4aSRandall Stewart 
3680f8829a4aSRandall Stewart #define SCTP_HS_TABLE_SIZE 73
3681f8829a4aSRandall Stewart 
3682f8829a4aSRandall Stewart struct sctp_hs_raise_drop sctp_cwnd_adjust[SCTP_HS_TABLE_SIZE] = {
3683f8829a4aSRandall Stewart 	{38, 1, 50},		/* 0   */
3684f8829a4aSRandall Stewart 	{118, 2, 44},		/* 1   */
3685f8829a4aSRandall Stewart 	{221, 3, 41},		/* 2   */
3686f8829a4aSRandall Stewart 	{347, 4, 38},		/* 3   */
3687f8829a4aSRandall Stewart 	{495, 5, 37},		/* 4   */
3688f8829a4aSRandall Stewart 	{663, 6, 35},		/* 5   */
3689f8829a4aSRandall Stewart 	{851, 7, 34},		/* 6   */
3690f8829a4aSRandall Stewart 	{1058, 8, 33},		/* 7   */
3691f8829a4aSRandall Stewart 	{1284, 9, 32},		/* 8   */
3692f8829a4aSRandall Stewart 	{1529, 10, 31},		/* 9   */
3693f8829a4aSRandall Stewart 	{1793, 11, 30},		/* 10  */
3694f8829a4aSRandall Stewart 	{2076, 12, 29},		/* 11  */
3695f8829a4aSRandall Stewart 	{2378, 13, 28},		/* 12  */
3696f8829a4aSRandall Stewart 	{2699, 14, 28},		/* 13  */
3697f8829a4aSRandall Stewart 	{3039, 15, 27},		/* 14  */
3698f8829a4aSRandall Stewart 	{3399, 16, 27},		/* 15  */
3699f8829a4aSRandall Stewart 	{3778, 17, 26},		/* 16  */
3700f8829a4aSRandall Stewart 	{4177, 18, 26},		/* 17  */
3701f8829a4aSRandall Stewart 	{4596, 19, 25},		/* 18  */
3702f8829a4aSRandall Stewart 	{5036, 20, 25},		/* 19  */
3703f8829a4aSRandall Stewart 	{5497, 21, 24},		/* 20  */
3704f8829a4aSRandall Stewart 	{5979, 22, 24},		/* 21  */
3705f8829a4aSRandall Stewart 	{6483, 23, 23},		/* 22  */
3706f8829a4aSRandall Stewart 	{7009, 24, 23},		/* 23  */
3707f8829a4aSRandall Stewart 	{7558, 25, 22},		/* 24  */
3708f8829a4aSRandall Stewart 	{8130, 26, 22},		/* 25  */
3709f8829a4aSRandall Stewart 	{8726, 27, 22},		/* 26  */
3710f8829a4aSRandall Stewart 	{9346, 28, 21},		/* 27  */
3711f8829a4aSRandall Stewart 	{9991, 29, 21},		/* 28  */
3712f8829a4aSRandall Stewart 	{10661, 30, 21},	/* 29  */
3713f8829a4aSRandall Stewart 	{11358, 31, 20},	/* 30  */
3714f8829a4aSRandall Stewart 	{12082, 32, 20},	/* 31  */
3715f8829a4aSRandall Stewart 	{12834, 33, 20},	/* 32  */
3716f8829a4aSRandall Stewart 	{13614, 34, 19},	/* 33  */
3717f8829a4aSRandall Stewart 	{14424, 35, 19},	/* 34  */
3718f8829a4aSRandall Stewart 	{15265, 36, 19},	/* 35  */
3719f8829a4aSRandall Stewart 	{16137, 37, 19},	/* 36  */
3720f8829a4aSRandall Stewart 	{17042, 38, 18},	/* 37  */
3721f8829a4aSRandall Stewart 	{17981, 39, 18},	/* 38  */
3722f8829a4aSRandall Stewart 	{18955, 40, 18},	/* 39  */
3723f8829a4aSRandall Stewart 	{19965, 41, 17},	/* 40  */
3724f8829a4aSRandall Stewart 	{21013, 42, 17},	/* 41  */
3725f8829a4aSRandall Stewart 	{22101, 43, 17},	/* 42  */
3726f8829a4aSRandall Stewart 	{23230, 44, 17},	/* 43  */
3727f8829a4aSRandall Stewart 	{24402, 45, 16},	/* 44  */
3728f8829a4aSRandall Stewart 	{25618, 46, 16},	/* 45  */
3729f8829a4aSRandall Stewart 	{26881, 47, 16},	/* 46  */
3730f8829a4aSRandall Stewart 	{28193, 48, 16},	/* 47  */
3731f8829a4aSRandall Stewart 	{29557, 49, 15},	/* 48  */
3732f8829a4aSRandall Stewart 	{30975, 50, 15},	/* 49  */
3733f8829a4aSRandall Stewart 	{32450, 51, 15},	/* 50  */
3734f8829a4aSRandall Stewart 	{33986, 52, 15},	/* 51  */
3735f8829a4aSRandall Stewart 	{35586, 53, 14},	/* 52  */
3736f8829a4aSRandall Stewart 	{37253, 54, 14},	/* 53  */
3737f8829a4aSRandall Stewart 	{38992, 55, 14},	/* 54  */
3738f8829a4aSRandall Stewart 	{40808, 56, 14},	/* 55  */
3739f8829a4aSRandall Stewart 	{42707, 57, 13},	/* 56  */
3740f8829a4aSRandall Stewart 	{44694, 58, 13},	/* 57  */
3741f8829a4aSRandall Stewart 	{46776, 59, 13},	/* 58  */
3742f8829a4aSRandall Stewart 	{48961, 60, 13},	/* 59  */
3743f8829a4aSRandall Stewart 	{51258, 61, 13},	/* 60  */
3744f8829a4aSRandall Stewart 	{53677, 62, 12},	/* 61  */
3745f8829a4aSRandall Stewart 	{56230, 63, 12},	/* 62  */
3746f8829a4aSRandall Stewart 	{58932, 64, 12},	/* 63  */
3747f8829a4aSRandall Stewart 	{61799, 65, 12},	/* 64  */
3748f8829a4aSRandall Stewart 	{64851, 66, 11},	/* 65  */
3749f8829a4aSRandall Stewart 	{68113, 67, 11},	/* 66  */
3750f8829a4aSRandall Stewart 	{71617, 68, 11},	/* 67  */
3751f8829a4aSRandall Stewart 	{75401, 69, 10},	/* 68  */
3752f8829a4aSRandall Stewart 	{79517, 70, 10},	/* 69  */
3753f8829a4aSRandall Stewart 	{84035, 71, 10},	/* 70  */
3754f8829a4aSRandall Stewart 	{89053, 72, 10},	/* 71  */
3755f8829a4aSRandall Stewart 	{94717, 73, 9}		/* 72  */
3756f8829a4aSRandall Stewart };
3757f8829a4aSRandall Stewart 
3758f8829a4aSRandall Stewart static void
375950cec919SRandall Stewart sctp_hs_cwnd_increase(struct sctp_tcb *stcb, struct sctp_nets *net)
3760f8829a4aSRandall Stewart {
3761f8829a4aSRandall Stewart 	int cur_val, i, indx, incr;
3762f8829a4aSRandall Stewart 
3763f8829a4aSRandall Stewart 	cur_val = net->cwnd >> 10;
3764f8829a4aSRandall Stewart 	indx = SCTP_HS_TABLE_SIZE - 1;
3765f8829a4aSRandall Stewart 
3766f8829a4aSRandall Stewart 	if (cur_val < sctp_cwnd_adjust[0].cwnd) {
3767f8829a4aSRandall Stewart 		/* normal mode */
3768f8829a4aSRandall Stewart 		if (net->net_ack > net->mtu) {
3769f8829a4aSRandall Stewart 			net->cwnd += net->mtu;
3770f8829a4aSRandall Stewart #ifdef SCTP_CWND_MONITOR
3771f8829a4aSRandall Stewart 			sctp_log_cwnd(stcb, net, net->mtu, SCTP_CWND_LOG_FROM_SS);
3772f8829a4aSRandall Stewart #endif
3773f8829a4aSRandall Stewart 		} else {
3774f8829a4aSRandall Stewart 			net->cwnd += net->net_ack;
3775f8829a4aSRandall Stewart #ifdef SCTP_CWND_MONITOR
3776f8829a4aSRandall Stewart 			sctp_log_cwnd(stcb, net, net->net_ack, SCTP_CWND_LOG_FROM_SS);
3777f8829a4aSRandall Stewart #endif
3778f8829a4aSRandall Stewart 		}
3779f8829a4aSRandall Stewart 	} else {
3780f8829a4aSRandall Stewart 		for (i = net->last_hs_used; i < SCTP_HS_TABLE_SIZE; i++) {
3781f8829a4aSRandall Stewart 			if (cur_val < sctp_cwnd_adjust[i].cwnd) {
3782f8829a4aSRandall Stewart 				indx = i;
3783f8829a4aSRandall Stewart 				break;
3784f8829a4aSRandall Stewart 			}
3785f8829a4aSRandall Stewart 		}
3786f8829a4aSRandall Stewart 		net->last_hs_used = indx;
3787f8829a4aSRandall Stewart 		incr = ((sctp_cwnd_adjust[indx].increase) << 10);
3788f8829a4aSRandall Stewart 		net->cwnd += incr;
3789f8829a4aSRandall Stewart #ifdef SCTP_CWND_MONITOR
3790f8829a4aSRandall Stewart 		sctp_log_cwnd(stcb, net, incr, SCTP_CWND_LOG_FROM_SS);
3791f8829a4aSRandall Stewart #endif
3792f8829a4aSRandall Stewart 	}
3793f8829a4aSRandall Stewart }
3794f8829a4aSRandall Stewart 
3795f8829a4aSRandall Stewart static void
379650cec919SRandall Stewart sctp_hs_cwnd_decrease(struct sctp_tcb *stcb, struct sctp_nets *net)
3797f8829a4aSRandall Stewart {
3798f8829a4aSRandall Stewart 	int cur_val, i, indx;
3799f8829a4aSRandall Stewart 
3800f8829a4aSRandall Stewart #ifdef SCTP_CWND_MONITOR
3801f8829a4aSRandall Stewart 	int old_cwnd = net->cwnd;
3802f8829a4aSRandall Stewart 
3803f8829a4aSRandall Stewart #endif
3804f8829a4aSRandall Stewart 
3805f8829a4aSRandall Stewart 	cur_val = net->cwnd >> 10;
3806f8829a4aSRandall Stewart 	indx = net->last_hs_used;
3807f8829a4aSRandall Stewart 	if (cur_val < sctp_cwnd_adjust[0].cwnd) {
3808f8829a4aSRandall Stewart 		/* normal mode */
3809f8829a4aSRandall Stewart 		net->ssthresh = net->cwnd / 2;
3810f8829a4aSRandall Stewart 		if (net->ssthresh < (net->mtu * 2)) {
3811f8829a4aSRandall Stewart 			net->ssthresh = 2 * net->mtu;
3812f8829a4aSRandall Stewart 		}
3813f8829a4aSRandall Stewart 		net->cwnd = net->ssthresh;
3814f8829a4aSRandall Stewart 	} else {
3815f8829a4aSRandall Stewart 		/* drop by the proper amount */
3816f8829a4aSRandall Stewart 		net->ssthresh = net->cwnd - (int)((net->cwnd / 100) *
3817f8829a4aSRandall Stewart 		    sctp_cwnd_adjust[net->last_hs_used].drop_percent);
3818f8829a4aSRandall Stewart 		net->cwnd = net->ssthresh;
3819f8829a4aSRandall Stewart 		/* now where are we */
3820f8829a4aSRandall Stewart 		indx = net->last_hs_used;
3821f8829a4aSRandall Stewart 		cur_val = net->cwnd >> 10;
3822f8829a4aSRandall Stewart 		/* reset where we are in the table */
3823f8829a4aSRandall Stewart 		if (cur_val < sctp_cwnd_adjust[0].cwnd) {
3824f8829a4aSRandall Stewart 			/* feel out of hs */
3825f8829a4aSRandall Stewart 			net->last_hs_used = 0;
3826f8829a4aSRandall Stewart 		} else {
3827f8829a4aSRandall Stewart 			for (i = indx; i >= 1; i--) {
3828f8829a4aSRandall Stewart 				if (cur_val > sctp_cwnd_adjust[i - 1].cwnd) {
3829f8829a4aSRandall Stewart 					break;
3830f8829a4aSRandall Stewart 				}
3831f8829a4aSRandall Stewart 			}
3832f8829a4aSRandall Stewart 			net->last_hs_used = indx;
3833f8829a4aSRandall Stewart 		}
3834f8829a4aSRandall Stewart 	}
3835f8829a4aSRandall Stewart #ifdef SCTP_CWND_MONITOR
3836f8829a4aSRandall Stewart 	sctp_log_cwnd(stcb, net, (net->cwnd - old_cwnd), SCTP_CWND_LOG_FROM_FR);
3837f8829a4aSRandall Stewart #endif
3838f8829a4aSRandall Stewart 
3839f8829a4aSRandall Stewart }
3840f8829a4aSRandall Stewart 
3841f8829a4aSRandall Stewart #endif
3842f8829a4aSRandall Stewart 
3843f8829a4aSRandall Stewart 
3844f8829a4aSRandall Stewart static __inline void
3845f8829a4aSRandall Stewart sctp_cwnd_update(struct sctp_tcb *stcb,
3846f8829a4aSRandall Stewart     struct sctp_association *asoc,
3847f8829a4aSRandall Stewart     int accum_moved, int reneged_all, int will_exit)
3848f8829a4aSRandall Stewart {
3849f8829a4aSRandall Stewart 	struct sctp_nets *net;
3850f8829a4aSRandall Stewart 
3851f8829a4aSRandall Stewart 	/******************************/
3852f8829a4aSRandall Stewart 	/* update cwnd and Early FR   */
3853f8829a4aSRandall Stewart 	/******************************/
3854f8829a4aSRandall Stewart 	TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
385542551e99SRandall Stewart 
385642551e99SRandall Stewart #ifdef JANA_CMT_FAST_RECOVERY
3857f8829a4aSRandall Stewart 		/*
3858f8829a4aSRandall Stewart 		 * CMT fast recovery code. Need to debug.
3859f8829a4aSRandall Stewart 		 */
3860f8829a4aSRandall Stewart 		if (net->fast_retran_loss_recovery && net->new_pseudo_cumack) {
3861f8829a4aSRandall Stewart 			if (compare_with_wrap(asoc->last_acked_seq,
3862f8829a4aSRandall Stewart 			    net->fast_recovery_tsn, MAX_TSN) ||
3863f8829a4aSRandall Stewart 			    (asoc->last_acked_seq == net->fast_recovery_tsn) ||
3864f8829a4aSRandall Stewart 			    compare_with_wrap(net->pseudo_cumack, net->fast_recovery_tsn, MAX_TSN) ||
3865f8829a4aSRandall Stewart 			    (net->pseudo_cumack == net->fast_recovery_tsn)) {
3866f8829a4aSRandall Stewart 				net->will_exit_fast_recovery = 1;
3867f8829a4aSRandall Stewart 			}
3868f8829a4aSRandall Stewart 		}
3869f8829a4aSRandall Stewart #endif
3870f8829a4aSRandall Stewart 		if (sctp_early_fr) {
3871f8829a4aSRandall Stewart 			/*
3872f8829a4aSRandall Stewart 			 * So, first of all do we need to have a Early FR
3873f8829a4aSRandall Stewart 			 * timer running?
3874f8829a4aSRandall Stewart 			 */
3875f8829a4aSRandall Stewart 			if (((TAILQ_FIRST(&asoc->sent_queue)) &&
3876f8829a4aSRandall Stewart 			    (net->ref_count > 1) &&
3877f8829a4aSRandall Stewart 			    (net->flight_size < net->cwnd)) ||
3878f8829a4aSRandall Stewart 			    (reneged_all)) {
3879f8829a4aSRandall Stewart 				/*
3880f8829a4aSRandall Stewart 				 * yes, so in this case stop it if its
3881f8829a4aSRandall Stewart 				 * running, and then restart it. Reneging
3882f8829a4aSRandall Stewart 				 * all is a special case where we want to
3883f8829a4aSRandall Stewart 				 * run the Early FR timer and then force the
3884f8829a4aSRandall Stewart 				 * last few unacked to be sent, causing us
3885f8829a4aSRandall Stewart 				 * to illicit a sack with gaps to force out
3886f8829a4aSRandall Stewart 				 * the others.
3887f8829a4aSRandall Stewart 				 */
3888139bc87fSRandall Stewart 				if (SCTP_OS_TIMER_PENDING(&net->fr_timer.timer)) {
3889f8829a4aSRandall Stewart 					SCTP_STAT_INCR(sctps_earlyfrstpidsck2);
3890a5d547adSRandall Stewart 					sctp_timer_stop(SCTP_TIMER_TYPE_EARLYFR, stcb->sctp_ep, stcb, net,
3891a5d547adSRandall Stewart 					    SCTP_FROM_SCTP_INDATA + SCTP_LOC_20);
3892f8829a4aSRandall Stewart 				}
3893f8829a4aSRandall Stewart 				SCTP_STAT_INCR(sctps_earlyfrstrid);
3894f8829a4aSRandall Stewart 				sctp_timer_start(SCTP_TIMER_TYPE_EARLYFR, stcb->sctp_ep, stcb, net);
3895f8829a4aSRandall Stewart 			} else {
3896f8829a4aSRandall Stewart 				/* No, stop it if its running */
3897139bc87fSRandall Stewart 				if (SCTP_OS_TIMER_PENDING(&net->fr_timer.timer)) {
3898f8829a4aSRandall Stewart 					SCTP_STAT_INCR(sctps_earlyfrstpidsck3);
3899a5d547adSRandall Stewart 					sctp_timer_stop(SCTP_TIMER_TYPE_EARLYFR, stcb->sctp_ep, stcb, net,
3900a5d547adSRandall Stewart 					    SCTP_FROM_SCTP_INDATA + SCTP_LOC_21);
3901f8829a4aSRandall Stewart 				}
3902f8829a4aSRandall Stewart 			}
3903f8829a4aSRandall Stewart 		}
3904f8829a4aSRandall Stewart 		/* if nothing was acked on this destination skip it */
3905f8829a4aSRandall Stewart 		if (net->net_ack == 0) {
3906f8829a4aSRandall Stewart #ifdef SCTP_CWND_LOGGING
3907f8829a4aSRandall Stewart 			sctp_log_cwnd(stcb, net, 0, SCTP_CWND_LOG_FROM_SACK);
3908f8829a4aSRandall Stewart #endif
3909f8829a4aSRandall Stewart 			continue;
3910f8829a4aSRandall Stewart 		}
3911f8829a4aSRandall Stewart 		if (net->net_ack2 > 0) {
3912f8829a4aSRandall Stewart 			/*
3913f8829a4aSRandall Stewart 			 * Karn's rule applies to clearing error count, this
3914f8829a4aSRandall Stewart 			 * is optional.
3915f8829a4aSRandall Stewart 			 */
3916f8829a4aSRandall Stewart 			net->error_count = 0;
3917f8829a4aSRandall Stewart 			if ((net->dest_state & SCTP_ADDR_NOT_REACHABLE) ==
3918f8829a4aSRandall Stewart 			    SCTP_ADDR_NOT_REACHABLE) {
3919f8829a4aSRandall Stewart 				/* addr came good */
3920f8829a4aSRandall Stewart 				net->dest_state &= ~SCTP_ADDR_NOT_REACHABLE;
3921f8829a4aSRandall Stewart 				net->dest_state |= SCTP_ADDR_REACHABLE;
3922f8829a4aSRandall Stewart 				sctp_ulp_notify(SCTP_NOTIFY_INTERFACE_UP, stcb,
3923f8829a4aSRandall Stewart 				    SCTP_RECEIVED_SACK, (void *)net);
3924f8829a4aSRandall Stewart 				/* now was it the primary? if so restore */
3925f8829a4aSRandall Stewart 				if (net->dest_state & SCTP_ADDR_WAS_PRIMARY) {
3926f8829a4aSRandall Stewart 					sctp_set_primary_addr(stcb, (struct sockaddr *)NULL, net);
3927f8829a4aSRandall Stewart 				}
3928f8829a4aSRandall Stewart 			}
3929f8829a4aSRandall Stewart 		}
393042551e99SRandall Stewart #ifdef JANA_CMT_FAST_RECOVERY
3931f8829a4aSRandall Stewart 		/*
393242551e99SRandall Stewart 		 * CMT fast recovery code
3933f8829a4aSRandall Stewart 		 */
3934f8829a4aSRandall Stewart 		/*
393542551e99SRandall Stewart 		 * if (sctp_cmt_on_off == 1 &&
393642551e99SRandall Stewart 		 * net->fast_retran_loss_recovery &&
393742551e99SRandall Stewart 		 * net->will_exit_fast_recovery == 0) { // @@@ Do something
393842551e99SRandall Stewart 		 * }	   else if (sctp_cmt_on_off == 0 &&
393942551e99SRandall Stewart 		 * asoc->fast_retran_loss_recovery && will_exit == 0) {
394042551e99SRandall Stewart 		 */
394142551e99SRandall Stewart #endif
394242551e99SRandall Stewart 
3943c105859eSRandall Stewart 		if (asoc->fast_retran_loss_recovery && will_exit == 0 && sctp_cmt_on_off == 0) {
394442551e99SRandall Stewart 			/*
394542551e99SRandall Stewart 			 * If we are in loss recovery we skip any cwnd
394642551e99SRandall Stewart 			 * update
3947f8829a4aSRandall Stewart 			 */
3948f8829a4aSRandall Stewart 			goto skip_cwnd_update;
3949f8829a4aSRandall Stewart 		}
3950f8829a4aSRandall Stewart 		/*
3951f8829a4aSRandall Stewart 		 * CMT: CUC algorithm. Update cwnd if pseudo-cumack has
3952f8829a4aSRandall Stewart 		 * moved.
3953f8829a4aSRandall Stewart 		 */
3954f8829a4aSRandall Stewart 		if (accum_moved || (sctp_cmt_on_off && net->new_pseudo_cumack)) {
3955f8829a4aSRandall Stewart 			/* If the cumulative ack moved we can proceed */
3956f8829a4aSRandall Stewart 			if (net->cwnd <= net->ssthresh) {
3957f8829a4aSRandall Stewart 				/* We are in slow start */
3958f8829a4aSRandall Stewart 				if (net->flight_size + net->net_ack >=
3959f8829a4aSRandall Stewart 				    net->cwnd) {
3960f8829a4aSRandall Stewart #ifdef SCTP_HIGH_SPEED
396150cec919SRandall Stewart 					sctp_hs_cwnd_increase(stcb, net);
3962f8829a4aSRandall Stewart #else
3963f8829a4aSRandall Stewart 					if (net->net_ack > (net->mtu * sctp_L2_abc_variable)) {
3964f8829a4aSRandall Stewart 						net->cwnd += (net->mtu * sctp_L2_abc_variable);
3965f8829a4aSRandall Stewart #ifdef SCTP_CWND_MONITOR
3966f8829a4aSRandall Stewart 						sctp_log_cwnd(stcb, net, net->mtu,
3967f8829a4aSRandall Stewart 						    SCTP_CWND_LOG_FROM_SS);
3968f8829a4aSRandall Stewart #endif
3969f8829a4aSRandall Stewart 
3970f8829a4aSRandall Stewart 					} else {
3971f8829a4aSRandall Stewart 						net->cwnd += net->net_ack;
3972f8829a4aSRandall Stewart #ifdef SCTP_CWND_MONITOR
3973f8829a4aSRandall Stewart 						sctp_log_cwnd(stcb, net, net->net_ack,
3974f8829a4aSRandall Stewart 						    SCTP_CWND_LOG_FROM_SS);
3975f8829a4aSRandall Stewart #endif
3976f8829a4aSRandall Stewart 
3977f8829a4aSRandall Stewart 					}
3978f8829a4aSRandall Stewart #endif
3979f8829a4aSRandall Stewart 				} else {
3980f8829a4aSRandall Stewart 					unsigned int dif;
3981f8829a4aSRandall Stewart 
3982f8829a4aSRandall Stewart 					dif = net->cwnd - (net->flight_size +
3983f8829a4aSRandall Stewart 					    net->net_ack);
3984f8829a4aSRandall Stewart #ifdef SCTP_CWND_LOGGING
3985f8829a4aSRandall Stewart 					sctp_log_cwnd(stcb, net, net->net_ack,
3986f8829a4aSRandall Stewart 					    SCTP_CWND_LOG_NOADV_SS);
3987f8829a4aSRandall Stewart #endif
3988f8829a4aSRandall Stewart 				}
3989f8829a4aSRandall Stewart 			} else {
3990f8829a4aSRandall Stewart 				/* We are in congestion avoidance */
3991f8829a4aSRandall Stewart 				if (net->flight_size + net->net_ack >=
3992f8829a4aSRandall Stewart 				    net->cwnd) {
3993f8829a4aSRandall Stewart 					/*
3994f8829a4aSRandall Stewart 					 * add to pba only if we had a
3995f8829a4aSRandall Stewart 					 * cwnd's worth (or so) in flight OR
3996f8829a4aSRandall Stewart 					 * the burst limit was applied.
3997f8829a4aSRandall Stewart 					 */
3998f8829a4aSRandall Stewart 					net->partial_bytes_acked +=
3999f8829a4aSRandall Stewart 					    net->net_ack;
4000f8829a4aSRandall Stewart 
4001f8829a4aSRandall Stewart 					/*
4002f8829a4aSRandall Stewart 					 * Do we need to increase (if pba is
4003f8829a4aSRandall Stewart 					 * > cwnd)?
4004f8829a4aSRandall Stewart 					 */
4005f8829a4aSRandall Stewart 					if (net->partial_bytes_acked >=
4006f8829a4aSRandall Stewart 					    net->cwnd) {
4007f8829a4aSRandall Stewart 						if (net->cwnd <
4008f8829a4aSRandall Stewart 						    net->partial_bytes_acked) {
4009f8829a4aSRandall Stewart 							net->partial_bytes_acked -=
4010f8829a4aSRandall Stewart 							    net->cwnd;
4011f8829a4aSRandall Stewart 						} else {
4012f8829a4aSRandall Stewart 							net->partial_bytes_acked =
4013f8829a4aSRandall Stewart 							    0;
4014f8829a4aSRandall Stewart 						}
4015f8829a4aSRandall Stewart 						net->cwnd += net->mtu;
4016f8829a4aSRandall Stewart #ifdef SCTP_CWND_MONITOR
4017f8829a4aSRandall Stewart 						sctp_log_cwnd(stcb, net, net->mtu,
4018f8829a4aSRandall Stewart 						    SCTP_CWND_LOG_FROM_CA);
4019f8829a4aSRandall Stewart #endif
4020f8829a4aSRandall Stewart 					}
4021f8829a4aSRandall Stewart #ifdef SCTP_CWND_LOGGING
4022f8829a4aSRandall Stewart 					else {
4023f8829a4aSRandall Stewart 						sctp_log_cwnd(stcb, net, net->net_ack,
4024f8829a4aSRandall Stewart 						    SCTP_CWND_LOG_NOADV_CA);
4025f8829a4aSRandall Stewart 					}
4026f8829a4aSRandall Stewart #endif
4027f8829a4aSRandall Stewart 				} else {
4028f8829a4aSRandall Stewart 					unsigned int dif;
4029f8829a4aSRandall Stewart 
4030f8829a4aSRandall Stewart #ifdef SCTP_CWND_LOGGING
4031f8829a4aSRandall Stewart 					sctp_log_cwnd(stcb, net, net->net_ack,
4032f8829a4aSRandall Stewart 					    SCTP_CWND_LOG_NOADV_CA);
4033f8829a4aSRandall Stewart #endif
4034f8829a4aSRandall Stewart 					dif = net->cwnd - (net->flight_size +
4035f8829a4aSRandall Stewart 					    net->net_ack);
4036f8829a4aSRandall Stewart 				}
4037f8829a4aSRandall Stewart 			}
4038f8829a4aSRandall Stewart 		} else {
4039f8829a4aSRandall Stewart #ifdef SCTP_CWND_LOGGING
4040f8829a4aSRandall Stewart 			sctp_log_cwnd(stcb, net, net->mtu,
4041f8829a4aSRandall Stewart 			    SCTP_CWND_LOG_NO_CUMACK);
4042f8829a4aSRandall Stewart #endif
4043f8829a4aSRandall Stewart 		}
4044f8829a4aSRandall Stewart skip_cwnd_update:
4045f8829a4aSRandall Stewart 		/*
4046f8829a4aSRandall Stewart 		 * NOW, according to Karn's rule do we need to restore the
4047f8829a4aSRandall Stewart 		 * RTO timer back? Check our net_ack2. If not set then we
4048f8829a4aSRandall Stewart 		 * have a ambiguity.. i.e. all data ack'd was sent to more
4049f8829a4aSRandall Stewart 		 * than one place.
4050f8829a4aSRandall Stewart 		 */
4051f8829a4aSRandall Stewart 		if (net->net_ack2) {
4052f8829a4aSRandall Stewart 			/* restore any doubled timers */
4053f8829a4aSRandall Stewart 			net->RTO = ((net->lastsa >> 2) + net->lastsv) >> 1;
4054f8829a4aSRandall Stewart 			if (net->RTO < stcb->asoc.minrto) {
4055f8829a4aSRandall Stewart 				net->RTO = stcb->asoc.minrto;
4056f8829a4aSRandall Stewart 			}
4057f8829a4aSRandall Stewart 			if (net->RTO > stcb->asoc.maxrto) {
4058f8829a4aSRandall Stewart 				net->RTO = stcb->asoc.maxrto;
4059f8829a4aSRandall Stewart 			}
4060f8829a4aSRandall Stewart 		}
4061f8829a4aSRandall Stewart 	}
4062f8829a4aSRandall Stewart }
4063f8829a4aSRandall Stewart 
4064bff64a4dSRandall Stewart static void
4065c105859eSRandall Stewart sctp_fs_audit(struct sctp_association *asoc)
4066bff64a4dSRandall Stewart {
4067bff64a4dSRandall Stewart 	struct sctp_tmit_chunk *chk;
4068bff64a4dSRandall Stewart 	int inflight = 0, resend = 0, inbetween = 0, acked = 0, above = 0;
4069bff64a4dSRandall Stewart 
4070bff64a4dSRandall Stewart 	TAILQ_FOREACH(chk, &asoc->sent_queue, sctp_next) {
4071bff64a4dSRandall Stewart 		if (chk->sent < SCTP_DATAGRAM_RESEND) {
4072bff64a4dSRandall Stewart 			inflight++;
4073bff64a4dSRandall Stewart 		} else if (chk->sent == SCTP_DATAGRAM_RESEND) {
4074bff64a4dSRandall Stewart 			resend++;
4075bff64a4dSRandall Stewart 		} else if (chk->sent < SCTP_DATAGRAM_ACKED) {
4076bff64a4dSRandall Stewart 			inbetween++;
4077bff64a4dSRandall Stewart 		} else if (chk->sent > SCTP_DATAGRAM_ACKED) {
4078bff64a4dSRandall Stewart 			above++;
4079bff64a4dSRandall Stewart 		} else {
4080bff64a4dSRandall Stewart 			acked++;
4081bff64a4dSRandall Stewart 		}
4082bff64a4dSRandall Stewart 	}
4083f1f73e57SRandall Stewart 
4084c105859eSRandall Stewart 	if ((inflight > 0) || (inbetween > 0)) {
4085f1f73e57SRandall Stewart #ifdef INVARIANTS
4086c105859eSRandall Stewart 		panic("Flight size-express incorrect? \n");
4087f1f73e57SRandall Stewart #else
4088f1f73e57SRandall Stewart 		printf("Flight size-express incorrect inflight:%d inbetween:%d\n",
4089f1f73e57SRandall Stewart 		    inflight, inbetween);
4090f1f73e57SRandall Stewart #endif
4091bff64a4dSRandall Stewart 	}
4092c105859eSRandall Stewart }
4093c105859eSRandall Stewart 
4094c105859eSRandall Stewart 
4095c105859eSRandall Stewart static void
4096c105859eSRandall Stewart sctp_window_probe_recovery(struct sctp_tcb *stcb,
4097c105859eSRandall Stewart     struct sctp_association *asoc,
4098c105859eSRandall Stewart     struct sctp_nets *net,
4099c105859eSRandall Stewart     struct sctp_tmit_chunk *tp1)
4100c105859eSRandall Stewart {
4101c105859eSRandall Stewart 	struct sctp_tmit_chunk *chk;
4102c105859eSRandall Stewart 
4103c105859eSRandall Stewart 	/* First setup this one and get it moved back */
4104c105859eSRandall Stewart 	tp1->sent = SCTP_DATAGRAM_UNSENT;
4105c105859eSRandall Stewart 	tp1->window_probe = 0;
4106c105859eSRandall Stewart #ifdef SCTP_FLIGHT_LOGGING
4107c105859eSRandall Stewart 	sctp_misc_ints(SCTP_FLIGHT_LOG_DOWN_WP,
4108c105859eSRandall Stewart 	    tp1->whoTo->flight_size,
4109c105859eSRandall Stewart 	    tp1->book_size,
4110c105859eSRandall Stewart 	    (uintptr_t) tp1->whoTo,
4111c105859eSRandall Stewart 	    tp1->rec.data.TSN_seq);
4112c105859eSRandall Stewart #endif
4113c105859eSRandall Stewart 	sctp_flight_size_decrease(tp1);
4114c105859eSRandall Stewart 	sctp_total_flight_decrease(stcb, tp1);
4115c105859eSRandall Stewart 	TAILQ_REMOVE(&asoc->sent_queue, tp1, sctp_next);
4116c105859eSRandall Stewart 	TAILQ_INSERT_HEAD(&asoc->send_queue, tp1, sctp_next);
4117c105859eSRandall Stewart 	asoc->sent_queue_cnt--;
4118c105859eSRandall Stewart 	asoc->send_queue_cnt++;
4119c105859eSRandall Stewart 	/*
4120c105859eSRandall Stewart 	 * Now all guys marked for RESEND on the sent_queue must be moved
4121c105859eSRandall Stewart 	 * back too.
4122c105859eSRandall Stewart 	 */
4123c105859eSRandall Stewart 	TAILQ_FOREACH(chk, &asoc->sent_queue, sctp_next) {
4124c105859eSRandall Stewart 		if (chk->sent == SCTP_DATAGRAM_RESEND) {
4125c105859eSRandall Stewart 			/* Another chunk to move */
4126c105859eSRandall Stewart 			chk->sent = SCTP_DATAGRAM_UNSENT;
4127c105859eSRandall Stewart 			chk->window_probe = 0;
4128c105859eSRandall Stewart 			/* It should not be in flight */
4129c105859eSRandall Stewart 			TAILQ_REMOVE(&asoc->sent_queue, chk, sctp_next);
4130c105859eSRandall Stewart 			TAILQ_INSERT_AFTER(&asoc->send_queue, tp1, chk, sctp_next);
4131c105859eSRandall Stewart 			asoc->sent_queue_cnt--;
4132c105859eSRandall Stewart 			asoc->send_queue_cnt++;
4133c105859eSRandall Stewart 			sctp_ucount_decr(asoc->sent_queue_retran_cnt);
4134c105859eSRandall Stewart 		}
4135c105859eSRandall Stewart 	}
4136c105859eSRandall Stewart }
4137c105859eSRandall Stewart 
4138f8829a4aSRandall Stewart 
4139f8829a4aSRandall Stewart void
4140f8829a4aSRandall Stewart sctp_express_handle_sack(struct sctp_tcb *stcb, uint32_t cumack,
4141f8829a4aSRandall Stewart     uint32_t rwnd, int nonce_sum_flag, int *abort_now)
4142f8829a4aSRandall Stewart {
4143f8829a4aSRandall Stewart 	struct sctp_nets *net;
4144f8829a4aSRandall Stewart 	struct sctp_association *asoc;
4145f8829a4aSRandall Stewart 	struct sctp_tmit_chunk *tp1, *tp2;
41465e54f665SRandall Stewart 	uint32_t old_rwnd;
41475e54f665SRandall Stewart 	int win_probe_recovery = 0;
4148c105859eSRandall Stewart 	int win_probe_recovered = 0;
4149bff64a4dSRandall Stewart 	int j, done_once;;
4150f8829a4aSRandall Stewart 
4151f8829a4aSRandall Stewart 	SCTP_TCB_LOCK_ASSERT(stcb);
4152f8829a4aSRandall Stewart 	asoc = &stcb->asoc;
41535e54f665SRandall Stewart 	if (compare_with_wrap(asoc->last_acked_seq, cumack, MAX_TSN)) {
41545e54f665SRandall Stewart 		/* old ack */
41555e54f665SRandall Stewart 		return;
41565e54f665SRandall Stewart 	}
4157f8829a4aSRandall Stewart 	/* First setup for CC stuff */
4158f8829a4aSRandall Stewart 	TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
4159f8829a4aSRandall Stewart 		net->prev_cwnd = net->cwnd;
4160f8829a4aSRandall Stewart 		net->net_ack = 0;
4161f8829a4aSRandall Stewart 		net->net_ack2 = 0;
4162132dea7dSRandall Stewart 
4163132dea7dSRandall Stewart 		/*
4164132dea7dSRandall Stewart 		 * CMT: Reset CUC and Fast recovery algo variables before
4165132dea7dSRandall Stewart 		 * SACK processing
4166132dea7dSRandall Stewart 		 */
4167132dea7dSRandall Stewart 		net->new_pseudo_cumack = 0;
4168132dea7dSRandall Stewart 		net->will_exit_fast_recovery = 0;
4169f8829a4aSRandall Stewart 	}
4170139bc87fSRandall Stewart 	if (sctp_strict_sacks) {
4171139bc87fSRandall Stewart 		uint32_t send_s;
4172139bc87fSRandall Stewart 
4173c105859eSRandall Stewart 		if (!TAILQ_EMPTY(&asoc->sent_queue)) {
4174c105859eSRandall Stewart 			tp1 = TAILQ_LAST(&asoc->sent_queue,
4175c105859eSRandall Stewart 			    sctpchunk_listhead);
4176c105859eSRandall Stewart 			send_s = tp1->rec.data.TSN_seq + 1;
4177139bc87fSRandall Stewart 		} else {
4178c105859eSRandall Stewart 			send_s = asoc->sending_seq;
4179139bc87fSRandall Stewart 		}
4180139bc87fSRandall Stewart 		if ((cumack == send_s) ||
4181139bc87fSRandall Stewart 		    compare_with_wrap(cumack, send_s, MAX_TSN)) {
4182c105859eSRandall Stewart #ifndef INVARIANTS
4183139bc87fSRandall Stewart 			struct mbuf *oper;
4184139bc87fSRandall Stewart 
4185c105859eSRandall Stewart #endif
4186c105859eSRandall Stewart #ifdef INVARIANTS
4187c105859eSRandall Stewart 			panic("Impossible sack 1");
4188c105859eSRandall Stewart #else
4189139bc87fSRandall Stewart 			*abort_now = 1;
4190139bc87fSRandall Stewart 			/* XXX */
4191139bc87fSRandall Stewart 			oper = sctp_get_mbuf_for_msg((sizeof(struct sctp_paramhdr) + sizeof(uint32_t)),
4192139bc87fSRandall Stewart 			    0, M_DONTWAIT, 1, MT_DATA);
4193139bc87fSRandall Stewart 			if (oper) {
4194139bc87fSRandall Stewart 				struct sctp_paramhdr *ph;
4195139bc87fSRandall Stewart 				uint32_t *ippp;
4196139bc87fSRandall Stewart 
4197139bc87fSRandall Stewart 				SCTP_BUF_LEN(oper) = sizeof(struct sctp_paramhdr) +
4198139bc87fSRandall Stewart 				    sizeof(uint32_t);
4199139bc87fSRandall Stewart 				ph = mtod(oper, struct sctp_paramhdr *);
4200139bc87fSRandall Stewart 				ph->param_type = htons(SCTP_CAUSE_PROTOCOL_VIOLATION);
4201139bc87fSRandall Stewart 				ph->param_length = htons(SCTP_BUF_LEN(oper));
4202139bc87fSRandall Stewart 				ippp = (uint32_t *) (ph + 1);
4203139bc87fSRandall Stewart 				*ippp = htonl(SCTP_FROM_SCTP_INDATA + SCTP_LOC_25);
4204139bc87fSRandall Stewart 			}
4205139bc87fSRandall Stewart 			stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_25;
4206139bc87fSRandall Stewart 			sctp_abort_an_association(stcb->sctp_ep, stcb, SCTP_PEER_FAULTY, oper);
4207139bc87fSRandall Stewart 			return;
4208139bc87fSRandall Stewart #endif
4209139bc87fSRandall Stewart 		}
4210139bc87fSRandall Stewart 	}
42115e54f665SRandall Stewart 	old_rwnd = asoc->peers_rwnd;
4212f8829a4aSRandall Stewart 	asoc->this_sack_highest_gap = cumack;
4213f8829a4aSRandall Stewart 	stcb->asoc.overall_error_count = 0;
42145e54f665SRandall Stewart 	if (compare_with_wrap(cumack, asoc->last_acked_seq, MAX_TSN)) {
4215f8829a4aSRandall Stewart 		/* process the new consecutive TSN first */
4216f8829a4aSRandall Stewart 		tp1 = TAILQ_FIRST(&asoc->sent_queue);
4217f8829a4aSRandall Stewart 		while (tp1) {
4218f8829a4aSRandall Stewart 			tp2 = TAILQ_NEXT(tp1, sctp_next);
4219f8829a4aSRandall Stewart 			if (compare_with_wrap(cumack, tp1->rec.data.TSN_seq,
4220f8829a4aSRandall Stewart 			    MAX_TSN) ||
4221f8829a4aSRandall Stewart 			    cumack == tp1->rec.data.TSN_seq) {
4222f8829a4aSRandall Stewart 				if (tp1->sent != SCTP_DATAGRAM_UNSENT) {
4223f8829a4aSRandall Stewart 					/*
42245e54f665SRandall Stewart 					 * ECN Nonce: Add the nonce to the
42255e54f665SRandall Stewart 					 * sender's nonce sum
4226f8829a4aSRandall Stewart 					 */
4227f8829a4aSRandall Stewart 					asoc->nonce_sum_expect_base += tp1->rec.data.ect_nonce;
4228f8829a4aSRandall Stewart 					if (tp1->sent < SCTP_DATAGRAM_ACKED) {
4229f8829a4aSRandall Stewart 						/*
42305e54f665SRandall Stewart 						 * If it is less than ACKED,
42315e54f665SRandall Stewart 						 * it is now no-longer in
42325e54f665SRandall Stewart 						 * flight. Higher values may
42335e54f665SRandall Stewart 						 * occur during marking
4234f8829a4aSRandall Stewart 						 */
4235c105859eSRandall Stewart 						if (tp1->sent < SCTP_DATAGRAM_RESEND) {
4236a5d547adSRandall Stewart #ifdef SCTP_FLIGHT_LOGGING
4237c105859eSRandall Stewart 							sctp_misc_ints(SCTP_FLIGHT_LOG_DOWN_CA,
4238a5d547adSRandall Stewart 							    tp1->whoTo->flight_size,
4239a5d547adSRandall Stewart 							    tp1->book_size,
4240c105859eSRandall Stewart 							    (uintptr_t) tp1->whoTo,
4241a5d547adSRandall Stewart 							    tp1->rec.data.TSN_seq);
4242a5d547adSRandall Stewart #endif
4243a5d547adSRandall Stewart 
4244c105859eSRandall Stewart 							sctp_flight_size_decrease(tp1);
4245c105859eSRandall Stewart 							sctp_total_flight_decrease(stcb, tp1);
4246f8829a4aSRandall Stewart 						}
4247f8829a4aSRandall Stewart 						tp1->whoTo->net_ack += tp1->send_size;
4248f8829a4aSRandall Stewart 						if (tp1->snd_count < 2) {
4249f8829a4aSRandall Stewart 							/*
42505e54f665SRandall Stewart 							 * True
42515e54f665SRandall Stewart 							 * non-retransmited
4252f8829a4aSRandall Stewart 							 * chunk
4253f8829a4aSRandall Stewart 							 */
4254f8829a4aSRandall Stewart 							tp1->whoTo->net_ack2 +=
4255f8829a4aSRandall Stewart 							    tp1->send_size;
4256f8829a4aSRandall Stewart 
4257f8829a4aSRandall Stewart 							/* update RTO too? */
425862c1ff9cSRandall Stewart 							if (tp1->do_rtt) {
4259f8829a4aSRandall Stewart 								tp1->whoTo->RTO =
4260f8829a4aSRandall Stewart 								    sctp_calculate_rto(stcb,
4261f8829a4aSRandall Stewart 								    asoc, tp1->whoTo,
4262f8829a4aSRandall Stewart 								    &tp1->sent_rcv_time);
4263f8829a4aSRandall Stewart 								tp1->do_rtt = 0;
4264f8829a4aSRandall Stewart 							}
4265f8829a4aSRandall Stewart 						}
4266132dea7dSRandall Stewart 						/*
42675e54f665SRandall Stewart 						 * CMT: CUCv2 algorithm.
42685e54f665SRandall Stewart 						 * From the cumack'd TSNs,
42695e54f665SRandall Stewart 						 * for each TSN being acked
42705e54f665SRandall Stewart 						 * for the first time, set
42715e54f665SRandall Stewart 						 * the following variables
42725e54f665SRandall Stewart 						 * for the corresp
42735e54f665SRandall Stewart 						 * destination.
42745e54f665SRandall Stewart 						 * new_pseudo_cumack will
42755e54f665SRandall Stewart 						 * trigger a cwnd update.
42765e54f665SRandall Stewart 						 * find_(rtx_)pseudo_cumack
42775e54f665SRandall Stewart 						 * will trigger search for
42785e54f665SRandall Stewart 						 * the next expected
42795e54f665SRandall Stewart 						 * (rtx-)pseudo-cumack.
4280132dea7dSRandall Stewart 						 */
4281132dea7dSRandall Stewart 						tp1->whoTo->new_pseudo_cumack = 1;
4282132dea7dSRandall Stewart 						tp1->whoTo->find_pseudo_cumack = 1;
4283132dea7dSRandall Stewart 						tp1->whoTo->find_rtx_pseudo_cumack = 1;
4284132dea7dSRandall Stewart 
4285f8829a4aSRandall Stewart #ifdef SCTP_CWND_LOGGING
4286f8829a4aSRandall Stewart 						sctp_log_cwnd(stcb, tp1->whoTo, tp1->rec.data.TSN_seq, SCTP_CWND_LOG_FROM_SACK);
4287f8829a4aSRandall Stewart #endif
4288f8829a4aSRandall Stewart 					}
4289f8829a4aSRandall Stewart 					if (tp1->sent == SCTP_DATAGRAM_RESEND) {
4290f8829a4aSRandall Stewart 						sctp_ucount_decr(asoc->sent_queue_retran_cnt);
4291f8829a4aSRandall Stewart 					}
429242551e99SRandall Stewart 					if (tp1->rec.data.chunk_was_revoked) {
429342551e99SRandall Stewart 						/* deflate the cwnd */
429442551e99SRandall Stewart 						tp1->whoTo->cwnd -= tp1->book_size;
429542551e99SRandall Stewart 						tp1->rec.data.chunk_was_revoked = 0;
429642551e99SRandall Stewart 					}
4297f8829a4aSRandall Stewart 					tp1->sent = SCTP_DATAGRAM_ACKED;
4298f8829a4aSRandall Stewart 				}
4299f8829a4aSRandall Stewart 			} else {
4300f8829a4aSRandall Stewart 				break;
4301f8829a4aSRandall Stewart 			}
4302f8829a4aSRandall Stewart 			TAILQ_REMOVE(&asoc->sent_queue, tp1, sctp_next);
4303f8829a4aSRandall Stewart 			if (tp1->data) {
4304f8829a4aSRandall Stewart 				sctp_free_bufspace(stcb, asoc, tp1, 1);
4305f8829a4aSRandall Stewart 				sctp_m_freem(tp1->data);
4306f8829a4aSRandall Stewart 			}
4307f8829a4aSRandall Stewart #ifdef SCTP_SACK_LOGGING
4308f8829a4aSRandall Stewart 			sctp_log_sack(asoc->last_acked_seq,
4309f8829a4aSRandall Stewart 			    cumack,
4310f8829a4aSRandall Stewart 			    tp1->rec.data.TSN_seq,
4311f8829a4aSRandall Stewart 			    0,
4312f8829a4aSRandall Stewart 			    0,
4313f8829a4aSRandall Stewart 			    SCTP_LOG_FREE_SENT);
4314f8829a4aSRandall Stewart #endif
4315f8829a4aSRandall Stewart 			tp1->data = NULL;
4316f8829a4aSRandall Stewart 			asoc->sent_queue_cnt--;
4317f8829a4aSRandall Stewart 			sctp_free_remote_addr(tp1->whoTo);
4318f8829a4aSRandall Stewart 			sctp_free_a_chunk(stcb, tp1);
4319f8829a4aSRandall Stewart 			tp1 = tp2;
4320f8829a4aSRandall Stewart 		}
43215e54f665SRandall Stewart 	}
4322f8829a4aSRandall Stewart 	if (stcb->sctp_socket) {
4323f8829a4aSRandall Stewart 		SOCKBUF_LOCK(&stcb->sctp_socket->so_snd);
4324f8829a4aSRandall Stewart #ifdef SCTP_WAKE_LOGGING
4325f8829a4aSRandall Stewart 		sctp_wakeup_log(stcb, cumack, 1, SCTP_WAKESND_FROM_SACK);
4326f8829a4aSRandall Stewart #endif
4327f8829a4aSRandall Stewart 		sctp_sowwakeup_locked(stcb->sctp_ep, stcb->sctp_socket);
4328f8829a4aSRandall Stewart #ifdef SCTP_WAKE_LOGGING
4329f8829a4aSRandall Stewart 	} else {
4330f8829a4aSRandall Stewart 		sctp_wakeup_log(stcb, cumack, 1, SCTP_NOWAKE_FROM_SACK);
4331f8829a4aSRandall Stewart #endif
4332f8829a4aSRandall Stewart 	}
4333f8829a4aSRandall Stewart 
43345e54f665SRandall Stewart 
4335f8829a4aSRandall Stewart 	if (asoc->last_acked_seq != cumack)
4336f8829a4aSRandall Stewart 		sctp_cwnd_update(stcb, asoc, 1, 0, 0);
43375e54f665SRandall Stewart 
4338f8829a4aSRandall Stewart 	asoc->last_acked_seq = cumack;
43395e54f665SRandall Stewart 
4340f8829a4aSRandall Stewart 	if (TAILQ_EMPTY(&asoc->sent_queue)) {
4341f8829a4aSRandall Stewart 		/* nothing left in-flight */
4342f8829a4aSRandall Stewart 		TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
4343f8829a4aSRandall Stewart 			net->flight_size = 0;
4344f8829a4aSRandall Stewart 			net->partial_bytes_acked = 0;
4345f8829a4aSRandall Stewart 		}
4346f8829a4aSRandall Stewart 		asoc->total_flight = 0;
4347f8829a4aSRandall Stewart 		asoc->total_flight_count = 0;
4348f8829a4aSRandall Stewart 	}
4349f8829a4aSRandall Stewart 	/* Fix up the a-p-a-p for future PR-SCTP sends */
4350f8829a4aSRandall Stewart 	if (compare_with_wrap(cumack, asoc->advanced_peer_ack_point, MAX_TSN)) {
4351f8829a4aSRandall Stewart 		asoc->advanced_peer_ack_point = cumack;
4352f8829a4aSRandall Stewart 	}
4353f8829a4aSRandall Stewart 	/* ECN Nonce updates */
4354f8829a4aSRandall Stewart 	if (asoc->ecn_nonce_allowed) {
4355f8829a4aSRandall Stewart 		if (asoc->nonce_sum_check) {
4356f8829a4aSRandall Stewart 			if (nonce_sum_flag != ((asoc->nonce_sum_expect_base) & SCTP_SACK_NONCE_SUM)) {
4357f8829a4aSRandall Stewart 				if (asoc->nonce_wait_for_ecne == 0) {
4358f8829a4aSRandall Stewart 					struct sctp_tmit_chunk *lchk;
4359f8829a4aSRandall Stewart 
4360f8829a4aSRandall Stewart 					lchk = TAILQ_FIRST(&asoc->send_queue);
4361f8829a4aSRandall Stewart 					asoc->nonce_wait_for_ecne = 1;
4362f8829a4aSRandall Stewart 					if (lchk) {
4363f8829a4aSRandall Stewart 						asoc->nonce_wait_tsn = lchk->rec.data.TSN_seq;
4364f8829a4aSRandall Stewart 					} else {
4365f8829a4aSRandall Stewart 						asoc->nonce_wait_tsn = asoc->sending_seq;
4366f8829a4aSRandall Stewart 					}
4367f8829a4aSRandall Stewart 				} else {
4368f8829a4aSRandall Stewart 					if (compare_with_wrap(asoc->last_acked_seq, asoc->nonce_wait_tsn, MAX_TSN) ||
4369f8829a4aSRandall Stewart 					    (asoc->last_acked_seq == asoc->nonce_wait_tsn)) {
4370f8829a4aSRandall Stewart 						/*
4371f8829a4aSRandall Stewart 						 * Misbehaving peer. We need
4372f8829a4aSRandall Stewart 						 * to react to this guy
4373f8829a4aSRandall Stewart 						 */
4374f8829a4aSRandall Stewart 						asoc->ecn_allowed = 0;
4375f8829a4aSRandall Stewart 						asoc->ecn_nonce_allowed = 0;
4376f8829a4aSRandall Stewart 					}
4377f8829a4aSRandall Stewart 				}
4378f8829a4aSRandall Stewart 			}
4379f8829a4aSRandall Stewart 		} else {
4380f8829a4aSRandall Stewart 			/* See if Resynchronization Possible */
4381f8829a4aSRandall Stewart 			if (compare_with_wrap(asoc->last_acked_seq, asoc->nonce_resync_tsn, MAX_TSN)) {
4382f8829a4aSRandall Stewart 				asoc->nonce_sum_check = 1;
4383f8829a4aSRandall Stewart 				/*
4384f8829a4aSRandall Stewart 				 * now we must calculate what the base is.
4385f8829a4aSRandall Stewart 				 * We do this based on two things, we know
4386f8829a4aSRandall Stewart 				 * the total's for all the segments
4387f8829a4aSRandall Stewart 				 * gap-acked in the SACK (none), We also
4388f8829a4aSRandall Stewart 				 * know the SACK's nonce sum, its in
4389f8829a4aSRandall Stewart 				 * nonce_sum_flag. So we can build a truth
4390f8829a4aSRandall Stewart 				 * table to back-calculate the new value of
4391f8829a4aSRandall Stewart 				 * asoc->nonce_sum_expect_base:
4392f8829a4aSRandall Stewart 				 *
4393f8829a4aSRandall Stewart 				 * SACK-flag-Value         Seg-Sums Base 0 0 0
4394f8829a4aSRandall Stewart 				 * 1                    0 1 0 1 1 1
4395f8829a4aSRandall Stewart 				 * 1 0
4396f8829a4aSRandall Stewart 				 */
4397f8829a4aSRandall Stewart 				asoc->nonce_sum_expect_base = (0 ^ nonce_sum_flag) & SCTP_SACK_NONCE_SUM;
4398f8829a4aSRandall Stewart 			}
4399f8829a4aSRandall Stewart 		}
4400f8829a4aSRandall Stewart 	}
4401f8829a4aSRandall Stewart 	/* RWND update */
4402f8829a4aSRandall Stewart 	asoc->peers_rwnd = sctp_sbspace_sub(rwnd,
4403f8829a4aSRandall Stewart 	    (uint32_t) (asoc->total_flight + (asoc->sent_queue_cnt * sctp_peer_chunk_oh)));
4404f8829a4aSRandall Stewart 	if (asoc->peers_rwnd < stcb->sctp_ep->sctp_ep.sctp_sws_sender) {
4405f8829a4aSRandall Stewart 		/* SWS sender side engages */
4406f8829a4aSRandall Stewart 		asoc->peers_rwnd = 0;
4407f8829a4aSRandall Stewart 	}
44085e54f665SRandall Stewart 	if (asoc->peers_rwnd > old_rwnd) {
44095e54f665SRandall Stewart 		win_probe_recovery = 1;
44105e54f665SRandall Stewart 	}
4411f8829a4aSRandall Stewart 	/* Now assure a timer where data is queued at */
4412bff64a4dSRandall Stewart 	done_once = 0;
4413a5d547adSRandall Stewart again:
4414a5d547adSRandall Stewart 	j = 0;
4415f8829a4aSRandall Stewart 	TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
44165e54f665SRandall Stewart 		if (win_probe_recovery && (net->window_probe)) {
44175e54f665SRandall Stewart 			net->window_probe = 0;
4418c105859eSRandall Stewart 			win_probe_recovered = 1;
44195e54f665SRandall Stewart 			/*
44205e54f665SRandall Stewart 			 * Find first chunk that was used with window probe
44215e54f665SRandall Stewart 			 * and clear the sent
44225e54f665SRandall Stewart 			 */
44235e54f665SRandall Stewart 			TAILQ_FOREACH(tp1, &asoc->sent_queue, sctp_next) {
44245e54f665SRandall Stewart 				if (tp1->window_probe) {
44255e54f665SRandall Stewart 					/* move back to data send queue */
4426c105859eSRandall Stewart 					sctp_window_probe_recovery(stcb, asoc, net, tp1);
44275e54f665SRandall Stewart 					break;
44285e54f665SRandall Stewart 				}
44295e54f665SRandall Stewart 			}
44305e54f665SRandall Stewart 		}
4431f8829a4aSRandall Stewart 		if (net->flight_size) {
4432f8829a4aSRandall Stewart 			int to_ticks;
4433f8829a4aSRandall Stewart 
4434f8829a4aSRandall Stewart 			if (net->RTO == 0) {
4435f8829a4aSRandall Stewart 				to_ticks = MSEC_TO_TICKS(stcb->asoc.initial_rto);
4436f8829a4aSRandall Stewart 			} else {
4437f8829a4aSRandall Stewart 				to_ticks = MSEC_TO_TICKS(net->RTO);
4438f8829a4aSRandall Stewart 			}
4439a5d547adSRandall Stewart 			j++;
4440139bc87fSRandall Stewart 			SCTP_OS_TIMER_START(&net->rxt_timer.timer, to_ticks,
4441f8829a4aSRandall Stewart 			    sctp_timeout_handler, &net->rxt_timer);
4442f8829a4aSRandall Stewart 		} else {
4443139bc87fSRandall Stewart 			if (SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer)) {
4444f8829a4aSRandall Stewart 				sctp_timer_stop(SCTP_TIMER_TYPE_SEND, stcb->sctp_ep,
4445a5d547adSRandall Stewart 				    stcb, net,
4446a5d547adSRandall Stewart 				    SCTP_FROM_SCTP_INDATA + SCTP_LOC_22);
4447f8829a4aSRandall Stewart 			}
4448f8829a4aSRandall Stewart 			if (sctp_early_fr) {
4449139bc87fSRandall Stewart 				if (SCTP_OS_TIMER_PENDING(&net->fr_timer.timer)) {
4450f8829a4aSRandall Stewart 					SCTP_STAT_INCR(sctps_earlyfrstpidsck4);
4451a5d547adSRandall Stewart 					sctp_timer_stop(SCTP_TIMER_TYPE_EARLYFR, stcb->sctp_ep, stcb, net,
4452a5d547adSRandall Stewart 					    SCTP_FROM_SCTP_INDATA + SCTP_LOC_23);
4453f8829a4aSRandall Stewart 				}
4454f8829a4aSRandall Stewart 			}
4455f8829a4aSRandall Stewart 		}
4456f8829a4aSRandall Stewart 	}
4457bff64a4dSRandall Stewart 	if ((j == 0) &&
4458bff64a4dSRandall Stewart 	    (!TAILQ_EMPTY(&asoc->sent_queue)) &&
4459bff64a4dSRandall Stewart 	    (asoc->sent_queue_retran_cnt == 0) &&
4460c105859eSRandall Stewart 	    (win_probe_recovered == 0) &&
4461bff64a4dSRandall Stewart 	    (done_once == 0)) {
4462a5d547adSRandall Stewart 		/* huh, this should not happen */
4463c105859eSRandall Stewart 		sctp_fs_audit(asoc);
4464a5d547adSRandall Stewart 		TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
4465a5d547adSRandall Stewart 			net->flight_size = 0;
4466a5d547adSRandall Stewart 		}
4467a5d547adSRandall Stewart 		asoc->total_flight = 0;
4468a5d547adSRandall Stewart 		asoc->total_flight_count = 0;
4469a5d547adSRandall Stewart 		asoc->sent_queue_retran_cnt = 0;
4470a5d547adSRandall Stewart 		TAILQ_FOREACH(tp1, &asoc->sent_queue, sctp_next) {
4471a5d547adSRandall Stewart 			if (tp1->sent < SCTP_DATAGRAM_RESEND) {
4472c105859eSRandall Stewart 				sctp_flight_size_increase(tp1);
4473c105859eSRandall Stewart 				sctp_total_flight_increase(stcb, tp1);
4474a5d547adSRandall Stewart 			} else if (tp1->sent == SCTP_DATAGRAM_RESEND) {
4475a5d547adSRandall Stewart 				asoc->sent_queue_retran_cnt++;
4476a5d547adSRandall Stewart 			}
4477a5d547adSRandall Stewart 		}
4478bff64a4dSRandall Stewart 		done_once = 1;
4479a5d547adSRandall Stewart 		goto again;
4480a5d547adSRandall Stewart 	}
4481f8829a4aSRandall Stewart 	/**********************************/
4482f8829a4aSRandall Stewart 	/* Now what about shutdown issues */
4483f8829a4aSRandall Stewart 	/**********************************/
4484f8829a4aSRandall Stewart 	if (TAILQ_EMPTY(&asoc->send_queue) && TAILQ_EMPTY(&asoc->sent_queue)) {
4485f8829a4aSRandall Stewart 		/* nothing left on sendqueue.. consider done */
4486f8829a4aSRandall Stewart 		/* clean up */
4487f8829a4aSRandall Stewart 		if ((asoc->stream_queue_cnt == 1) &&
4488f8829a4aSRandall Stewart 		    ((asoc->state & SCTP_STATE_SHUTDOWN_PENDING) ||
4489f8829a4aSRandall Stewart 		    (asoc->state & SCTP_STATE_SHUTDOWN_RECEIVED)) &&
4490f8829a4aSRandall Stewart 		    (asoc->locked_on_sending)
4491f8829a4aSRandall Stewart 		    ) {
4492f8829a4aSRandall Stewart 			struct sctp_stream_queue_pending *sp;
4493f8829a4aSRandall Stewart 
4494f8829a4aSRandall Stewart 			/*
4495f8829a4aSRandall Stewart 			 * I may be in a state where we got all across.. but
4496f8829a4aSRandall Stewart 			 * cannot write more due to a shutdown... we abort
4497f8829a4aSRandall Stewart 			 * since the user did not indicate EOR in this case.
4498f8829a4aSRandall Stewart 			 * The sp will be cleaned during free of the asoc.
4499f8829a4aSRandall Stewart 			 */
4500f8829a4aSRandall Stewart 			sp = TAILQ_LAST(&((asoc->locked_on_sending)->outqueue),
4501f8829a4aSRandall Stewart 			    sctp_streamhead);
4502f8829a4aSRandall Stewart 			if ((sp) && (sp->length == 0) && (sp->msg_is_complete == 0)) {
4503f8829a4aSRandall Stewart 				asoc->state |= SCTP_STATE_PARTIAL_MSG_LEFT;
4504f8829a4aSRandall Stewart 				asoc->locked_on_sending = NULL;
4505f8829a4aSRandall Stewart 				asoc->stream_queue_cnt--;
4506f8829a4aSRandall Stewart 			}
4507f8829a4aSRandall Stewart 		}
4508f8829a4aSRandall Stewart 		if ((asoc->state & SCTP_STATE_SHUTDOWN_PENDING) &&
4509f8829a4aSRandall Stewart 		    (asoc->stream_queue_cnt == 0)) {
4510f8829a4aSRandall Stewart 			if (asoc->state & SCTP_STATE_PARTIAL_MSG_LEFT) {
4511f8829a4aSRandall Stewart 				/* Need to abort here */
4512f8829a4aSRandall Stewart 				struct mbuf *oper;
4513f8829a4aSRandall Stewart 
4514f8829a4aSRandall Stewart 		abort_out_now:
4515f8829a4aSRandall Stewart 				*abort_now = 1;
4516f8829a4aSRandall Stewart 				/* XXX */
4517f8829a4aSRandall Stewart 				oper = sctp_get_mbuf_for_msg((sizeof(struct sctp_paramhdr) + sizeof(uint32_t)),
4518f8829a4aSRandall Stewart 				    0, M_DONTWAIT, 1, MT_DATA);
4519f8829a4aSRandall Stewart 				if (oper) {
4520f8829a4aSRandall Stewart 					struct sctp_paramhdr *ph;
4521f8829a4aSRandall Stewart 					uint32_t *ippp;
4522f8829a4aSRandall Stewart 
4523139bc87fSRandall Stewart 					SCTP_BUF_LEN(oper) = sizeof(struct sctp_paramhdr) +
4524f8829a4aSRandall Stewart 					    sizeof(uint32_t);
4525f8829a4aSRandall Stewart 					ph = mtod(oper, struct sctp_paramhdr *);
4526f8829a4aSRandall Stewart 					ph->param_type = htons(SCTP_CAUSE_USER_INITIATED_ABT);
4527139bc87fSRandall Stewart 					ph->param_length = htons(SCTP_BUF_LEN(oper));
4528f8829a4aSRandall Stewart 					ippp = (uint32_t *) (ph + 1);
4529a5d547adSRandall Stewart 					*ippp = htonl(SCTP_FROM_SCTP_INDATA + SCTP_LOC_24);
4530f8829a4aSRandall Stewart 				}
4531a5d547adSRandall Stewart 				stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_24;
4532f8829a4aSRandall Stewart 				sctp_abort_an_association(stcb->sctp_ep, stcb, SCTP_RESPONSE_TO_USER_REQ, oper);
4533f8829a4aSRandall Stewart 			} else {
4534f42a358aSRandall Stewart 				if ((SCTP_GET_STATE(asoc) == SCTP_STATE_OPEN) ||
4535f42a358aSRandall Stewart 				    (SCTP_GET_STATE(asoc) == SCTP_STATE_SHUTDOWN_RECEIVED)) {
4536f8829a4aSRandall Stewart 					SCTP_STAT_DECR_GAUGE32(sctps_currestab);
4537f42a358aSRandall Stewart 				}
4538f42a358aSRandall Stewart 				asoc->state = SCTP_STATE_SHUTDOWN_SENT;
4539f8829a4aSRandall Stewart 				sctp_stop_timers_for_shutdown(stcb);
4540f8829a4aSRandall Stewart 				sctp_send_shutdown(stcb,
4541f8829a4aSRandall Stewart 				    stcb->asoc.primary_destination);
4542f8829a4aSRandall Stewart 				sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWN,
4543f8829a4aSRandall Stewart 				    stcb->sctp_ep, stcb, asoc->primary_destination);
4544f8829a4aSRandall Stewart 				sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNGUARD,
4545f8829a4aSRandall Stewart 				    stcb->sctp_ep, stcb, asoc->primary_destination);
4546f8829a4aSRandall Stewart 			}
4547f8829a4aSRandall Stewart 		} else if ((SCTP_GET_STATE(asoc) == SCTP_STATE_SHUTDOWN_RECEIVED) &&
4548f8829a4aSRandall Stewart 		    (asoc->stream_queue_cnt == 0)) {
4549f8829a4aSRandall Stewart 			if (asoc->state & SCTP_STATE_PARTIAL_MSG_LEFT) {
4550f8829a4aSRandall Stewart 				goto abort_out_now;
4551f8829a4aSRandall Stewart 			}
4552f8829a4aSRandall Stewart 			SCTP_STAT_DECR_GAUGE32(sctps_currestab);
4553f42a358aSRandall Stewart 			asoc->state = SCTP_STATE_SHUTDOWN_ACK_SENT;
4554f8829a4aSRandall Stewart 			sctp_send_shutdown_ack(stcb,
4555f8829a4aSRandall Stewart 			    stcb->asoc.primary_destination);
4556f8829a4aSRandall Stewart 
4557f8829a4aSRandall Stewart 			sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNACK,
4558f8829a4aSRandall Stewart 			    stcb->sctp_ep, stcb, asoc->primary_destination);
4559f8829a4aSRandall Stewart 		}
4560f8829a4aSRandall Stewart 	}
4561f8829a4aSRandall Stewart #ifdef SCTP_SACK_RWND_LOGGING
4562f8829a4aSRandall Stewart 	sctp_misc_ints(SCTP_SACK_RWND_UPDATE,
4563f8829a4aSRandall Stewart 	    rwnd,
4564f8829a4aSRandall Stewart 	    stcb->asoc.peers_rwnd,
4565f8829a4aSRandall Stewart 	    stcb->asoc.total_flight,
4566f8829a4aSRandall Stewart 	    stcb->asoc.total_output_queue_size);
4567f8829a4aSRandall Stewart 
4568f8829a4aSRandall Stewart #endif
4569f8829a4aSRandall Stewart }
4570f8829a4aSRandall Stewart 
4571f8829a4aSRandall Stewart 
4572f8829a4aSRandall Stewart 
4573f8829a4aSRandall Stewart void
4574f8829a4aSRandall Stewart sctp_handle_sack(struct sctp_sack_chunk *ch, struct sctp_tcb *stcb,
4575f8829a4aSRandall Stewart     struct sctp_nets *net_from, int *abort_now)
4576f8829a4aSRandall Stewart {
4577f8829a4aSRandall Stewart 	struct sctp_association *asoc;
4578f8829a4aSRandall Stewart 	struct sctp_sack *sack;
4579f8829a4aSRandall Stewart 	struct sctp_tmit_chunk *tp1, *tp2;
4580f8829a4aSRandall Stewart 	uint32_t cum_ack, last_tsn, biggest_tsn_acked, biggest_tsn_newly_acked,
4581f8829a4aSRandall Stewart 	         this_sack_lowest_newack;
4582bff64a4dSRandall Stewart 	uint32_t sav_cum_ack;
4583f8829a4aSRandall Stewart 	uint16_t num_seg, num_dup;
4584f8829a4aSRandall Stewart 	uint16_t wake_him = 0;
4585f8829a4aSRandall Stewart 	unsigned int sack_length;
4586c105859eSRandall Stewart 	uint32_t send_s = 0;
4587f8829a4aSRandall Stewart 	long j;
4588f8829a4aSRandall Stewart 	int accum_moved = 0;
4589f8829a4aSRandall Stewart 	int will_exit_fast_recovery = 0;
45905e54f665SRandall Stewart 	uint32_t a_rwnd, old_rwnd;
45915e54f665SRandall Stewart 	int win_probe_recovery = 0;
4592c105859eSRandall Stewart 	int win_probe_recovered = 0;
4593f8829a4aSRandall Stewart 	struct sctp_nets *net = NULL;
4594f8829a4aSRandall Stewart 	int nonce_sum_flag, ecn_seg_sums = 0;
4595bff64a4dSRandall Stewart 	int done_once;
4596f8829a4aSRandall Stewart 	uint8_t reneged_all = 0;
4597f8829a4aSRandall Stewart 	uint8_t cmt_dac_flag;
4598f8829a4aSRandall Stewart 
4599f8829a4aSRandall Stewart 	/*
4600f8829a4aSRandall Stewart 	 * we take any chance we can to service our queues since we cannot
4601f8829a4aSRandall Stewart 	 * get awoken when the socket is read from :<
4602f8829a4aSRandall Stewart 	 */
4603f8829a4aSRandall Stewart 	/*
4604f8829a4aSRandall Stewart 	 * Now perform the actual SACK handling: 1) Verify that it is not an
4605f8829a4aSRandall Stewart 	 * old sack, if so discard. 2) If there is nothing left in the send
4606f8829a4aSRandall Stewart 	 * queue (cum-ack is equal to last acked) then you have a duplicate
4607f8829a4aSRandall Stewart 	 * too, update any rwnd change and verify no timers are running.
4608f8829a4aSRandall Stewart 	 * then return. 3) Process any new consequtive data i.e. cum-ack
4609f8829a4aSRandall Stewart 	 * moved process these first and note that it moved. 4) Process any
4610f8829a4aSRandall Stewart 	 * sack blocks. 5) Drop any acked from the queue. 6) Check for any
4611f8829a4aSRandall Stewart 	 * revoked blocks and mark. 7) Update the cwnd. 8) Nothing left,
4612f8829a4aSRandall Stewart 	 * sync up flightsizes and things, stop all timers and also check
4613f8829a4aSRandall Stewart 	 * for shutdown_pending state. If so then go ahead and send off the
4614f8829a4aSRandall Stewart 	 * shutdown. If in shutdown recv, send off the shutdown-ack and
4615f8829a4aSRandall Stewart 	 * start that timer, Ret. 9) Strike any non-acked things and do FR
4616f8829a4aSRandall Stewart 	 * procedure if needed being sure to set the FR flag. 10) Do pr-sctp
4617f8829a4aSRandall Stewart 	 * procedures. 11) Apply any FR penalties. 12) Assure we will SACK
4618f8829a4aSRandall Stewart 	 * if in shutdown_recv state.
4619f8829a4aSRandall Stewart 	 */
4620f8829a4aSRandall Stewart 	SCTP_TCB_LOCK_ASSERT(stcb);
4621f8829a4aSRandall Stewart 	sack = &ch->sack;
4622f8829a4aSRandall Stewart 	/* CMT DAC algo */
4623f8829a4aSRandall Stewart 	this_sack_lowest_newack = 0;
4624f8829a4aSRandall Stewart 	j = 0;
4625f8829a4aSRandall Stewart 	sack_length = ntohs(ch->ch.chunk_length);
4626f8829a4aSRandall Stewart 	if (sack_length < sizeof(struct sctp_sack_chunk)) {
4627f8829a4aSRandall Stewart #ifdef SCTP_DEBUG
4628f8829a4aSRandall Stewart 		if (sctp_debug_on & SCTP_DEBUG_INDATA1) {
4629f8829a4aSRandall Stewart 			printf("Bad size on sack chunk .. to small\n");
4630f8829a4aSRandall Stewart 		}
4631f8829a4aSRandall Stewart #endif
4632f8829a4aSRandall Stewart 		return;
4633f8829a4aSRandall Stewart 	}
4634f8829a4aSRandall Stewart 	/* ECN Nonce */
4635f8829a4aSRandall Stewart 	SCTP_STAT_INCR(sctps_slowpath_sack);
4636f8829a4aSRandall Stewart 	nonce_sum_flag = ch->ch.chunk_flags & SCTP_SACK_NONCE_SUM;
4637f8829a4aSRandall Stewart 	cum_ack = last_tsn = ntohl(sack->cum_tsn_ack);
4638f8829a4aSRandall Stewart 	num_seg = ntohs(sack->num_gap_ack_blks);
4639f8829a4aSRandall Stewart 	a_rwnd = (uint32_t) ntohl(sack->a_rwnd);
4640f8829a4aSRandall Stewart 
4641f8829a4aSRandall Stewart 	/* CMT DAC algo */
4642f8829a4aSRandall Stewart 	cmt_dac_flag = ch->ch.chunk_flags & SCTP_SACK_CMT_DAC;
4643f8829a4aSRandall Stewart 	num_dup = ntohs(sack->num_dup_tsns);
4644f8829a4aSRandall Stewart 
46455e54f665SRandall Stewart 	old_rwnd = stcb->asoc.peers_rwnd;
4646f8829a4aSRandall Stewart 	stcb->asoc.overall_error_count = 0;
4647f8829a4aSRandall Stewart 	asoc = &stcb->asoc;
4648f8829a4aSRandall Stewart #ifdef SCTP_SACK_LOGGING
4649f8829a4aSRandall Stewart 	sctp_log_sack(asoc->last_acked_seq,
4650f8829a4aSRandall Stewart 	    cum_ack,
4651f8829a4aSRandall Stewart 	    0,
4652f8829a4aSRandall Stewart 	    num_seg,
4653f8829a4aSRandall Stewart 	    num_dup,
4654f8829a4aSRandall Stewart 	    SCTP_LOG_NEW_SACK);
4655f8829a4aSRandall Stewart #endif
4656f8829a4aSRandall Stewart #if defined(SCTP_FR_LOGGING) || defined(SCTP_EARLYFR_LOGGING)
4657f8829a4aSRandall Stewart 	if (num_dup) {
4658f8829a4aSRandall Stewart 		int off_to_dup, iii;
4659f8829a4aSRandall Stewart 		uint32_t *dupdata;
4660f8829a4aSRandall Stewart 
4661f8829a4aSRandall Stewart 		off_to_dup = (num_seg * sizeof(struct sctp_gap_ack_block)) + sizeof(struct sctp_sack_chunk);
4662f8829a4aSRandall Stewart 		if ((off_to_dup + (num_dup * sizeof(uint32_t))) <= sack_length) {
4663f8829a4aSRandall Stewart 			dupdata = (uint32_t *) ((caddr_t)ch + off_to_dup);
4664f8829a4aSRandall Stewart 			for (iii = 0; iii < num_dup; iii++) {
4665f8829a4aSRandall Stewart 				sctp_log_fr(*dupdata, 0, 0, SCTP_FR_DUPED);
4666f8829a4aSRandall Stewart 				dupdata++;
4667f8829a4aSRandall Stewart 
4668f8829a4aSRandall Stewart 			}
4669f8829a4aSRandall Stewart 		} else {
4670f8829a4aSRandall Stewart 			printf("Size invalid offset to dups:%d number dups:%d sack_len:%d num gaps:%d\n",
4671f8829a4aSRandall Stewart 			    off_to_dup, num_dup, sack_length, num_seg);
4672f8829a4aSRandall Stewart 		}
4673f8829a4aSRandall Stewart 	}
4674f8829a4aSRandall Stewart #endif
4675f8829a4aSRandall Stewart 	if (sctp_strict_sacks) {
4676c105859eSRandall Stewart 		/* reality check */
4677c105859eSRandall Stewart 		if (!TAILQ_EMPTY(&asoc->sent_queue)) {
4678c105859eSRandall Stewart 			tp1 = TAILQ_LAST(&asoc->sent_queue,
4679c105859eSRandall Stewart 			    sctpchunk_listhead);
4680c105859eSRandall Stewart 			send_s = tp1->rec.data.TSN_seq + 1;
4681c105859eSRandall Stewart 		} else {
4682c105859eSRandall Stewart 			send_s = asoc->sending_seq;
4683c105859eSRandall Stewart 		}
4684f8829a4aSRandall Stewart 		if (cum_ack == send_s ||
4685f8829a4aSRandall Stewart 		    compare_with_wrap(cum_ack, send_s, MAX_TSN)) {
4686c105859eSRandall Stewart #ifndef INVARIANTS
4687c105859eSRandall Stewart 			struct mbuf *oper;
4688c105859eSRandall Stewart 
4689c105859eSRandall Stewart #endif
4690c105859eSRandall Stewart #ifdef INVARIANTS
4691139bc87fSRandall Stewart 	hopeless_peer:
4692139bc87fSRandall Stewart 			panic("Impossible sack 1");
4693139bc87fSRandall Stewart #else
4694c105859eSRandall Stewart 
4695f8829a4aSRandall Stewart 
4696f8829a4aSRandall Stewart 			/*
4697f8829a4aSRandall Stewart 			 * no way, we have not even sent this TSN out yet.
4698f8829a4aSRandall Stewart 			 * Peer is hopelessly messed up with us.
4699f8829a4aSRandall Stewart 			 */
4700f8829a4aSRandall Stewart 	hopeless_peer:
4701f8829a4aSRandall Stewart 			*abort_now = 1;
4702f8829a4aSRandall Stewart 			/* XXX */
4703f8829a4aSRandall Stewart 			oper = sctp_get_mbuf_for_msg((sizeof(struct sctp_paramhdr) + sizeof(uint32_t)),
4704f8829a4aSRandall Stewart 			    0, M_DONTWAIT, 1, MT_DATA);
4705f8829a4aSRandall Stewart 			if (oper) {
4706f8829a4aSRandall Stewart 				struct sctp_paramhdr *ph;
4707f8829a4aSRandall Stewart 				uint32_t *ippp;
4708f8829a4aSRandall Stewart 
4709139bc87fSRandall Stewart 				SCTP_BUF_LEN(oper) = sizeof(struct sctp_paramhdr) +
4710f8829a4aSRandall Stewart 				    sizeof(uint32_t);
4711f8829a4aSRandall Stewart 				ph = mtod(oper, struct sctp_paramhdr *);
4712f8829a4aSRandall Stewart 				ph->param_type = htons(SCTP_CAUSE_PROTOCOL_VIOLATION);
4713139bc87fSRandall Stewart 				ph->param_length = htons(SCTP_BUF_LEN(oper));
4714f8829a4aSRandall Stewart 				ippp = (uint32_t *) (ph + 1);
4715a5d547adSRandall Stewart 				*ippp = htonl(SCTP_FROM_SCTP_INDATA + SCTP_LOC_25);
4716f8829a4aSRandall Stewart 			}
4717a5d547adSRandall Stewart 			stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_25;
4718f8829a4aSRandall Stewart 			sctp_abort_an_association(stcb->sctp_ep, stcb, SCTP_PEER_FAULTY, oper);
4719f8829a4aSRandall Stewart 			return;
4720139bc87fSRandall Stewart #endif
4721f8829a4aSRandall Stewart 		}
4722f8829a4aSRandall Stewart 	}
4723f8829a4aSRandall Stewart 	/**********************/
4724f8829a4aSRandall Stewart 	/* 1) check the range */
4725f8829a4aSRandall Stewart 	/**********************/
4726f8829a4aSRandall Stewart 	if (compare_with_wrap(asoc->last_acked_seq, last_tsn, MAX_TSN)) {
4727f8829a4aSRandall Stewart 		/* acking something behind */
4728f8829a4aSRandall Stewart 		return;
4729f8829a4aSRandall Stewart 	}
4730bff64a4dSRandall Stewart 	sav_cum_ack = asoc->last_acked_seq;
4731bff64a4dSRandall Stewart 
4732f8829a4aSRandall Stewart 	/* update the Rwnd of the peer */
4733f8829a4aSRandall Stewart 	if (TAILQ_EMPTY(&asoc->sent_queue) &&
4734f8829a4aSRandall Stewart 	    TAILQ_EMPTY(&asoc->send_queue) &&
4735f8829a4aSRandall Stewart 	    (asoc->stream_queue_cnt == 0)
4736f8829a4aSRandall Stewart 	    ) {
4737f8829a4aSRandall Stewart 		/* nothing left on send/sent and strmq */
4738f8829a4aSRandall Stewart #ifdef SCTP_LOG_RWND
4739f8829a4aSRandall Stewart 		sctp_log_rwnd_set(SCTP_SET_PEER_RWND_VIA_SACK,
4740f8829a4aSRandall Stewart 		    asoc->peers_rwnd, 0, 0, a_rwnd);
4741f8829a4aSRandall Stewart #endif
4742f8829a4aSRandall Stewart 		asoc->peers_rwnd = a_rwnd;
4743f8829a4aSRandall Stewart 		if (asoc->sent_queue_retran_cnt) {
4744f8829a4aSRandall Stewart 			asoc->sent_queue_retran_cnt = 0;
4745f8829a4aSRandall Stewart 		}
4746f8829a4aSRandall Stewart 		if (asoc->peers_rwnd < stcb->sctp_ep->sctp_ep.sctp_sws_sender) {
4747f8829a4aSRandall Stewart 			/* SWS sender side engages */
4748f8829a4aSRandall Stewart 			asoc->peers_rwnd = 0;
4749f8829a4aSRandall Stewart 		}
4750f8829a4aSRandall Stewart 		/* stop any timers */
4751f8829a4aSRandall Stewart 		TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
4752f8829a4aSRandall Stewart 			sctp_timer_stop(SCTP_TIMER_TYPE_SEND, stcb->sctp_ep,
4753a5d547adSRandall Stewart 			    stcb, net, SCTP_FROM_SCTP_INDATA + SCTP_LOC_26);
4754f8829a4aSRandall Stewart 			if (sctp_early_fr) {
4755139bc87fSRandall Stewart 				if (SCTP_OS_TIMER_PENDING(&net->fr_timer.timer)) {
4756f8829a4aSRandall Stewart 					SCTP_STAT_INCR(sctps_earlyfrstpidsck1);
4757a5d547adSRandall Stewart 					sctp_timer_stop(SCTP_TIMER_TYPE_EARLYFR, stcb->sctp_ep, stcb, net,
4758a5d547adSRandall Stewart 					    SCTP_FROM_SCTP_INDATA + SCTP_LOC_26);
4759f8829a4aSRandall Stewart 				}
4760f8829a4aSRandall Stewart 			}
4761f8829a4aSRandall Stewart 			net->partial_bytes_acked = 0;
4762f8829a4aSRandall Stewart 			net->flight_size = 0;
4763f8829a4aSRandall Stewart 		}
4764f8829a4aSRandall Stewart 		asoc->total_flight = 0;
4765f8829a4aSRandall Stewart 		asoc->total_flight_count = 0;
4766f8829a4aSRandall Stewart 		return;
4767f8829a4aSRandall Stewart 	}
4768f8829a4aSRandall Stewart 	/*
4769f8829a4aSRandall Stewart 	 * We init netAckSz and netAckSz2 to 0. These are used to track 2
4770f8829a4aSRandall Stewart 	 * things. The total byte count acked is tracked in netAckSz AND
4771f8829a4aSRandall Stewart 	 * netAck2 is used to track the total bytes acked that are un-
4772f8829a4aSRandall Stewart 	 * amibguious and were never retransmitted. We track these on a per
4773f8829a4aSRandall Stewart 	 * destination address basis.
4774f8829a4aSRandall Stewart 	 */
4775f8829a4aSRandall Stewart 	TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
4776f8829a4aSRandall Stewart 		net->prev_cwnd = net->cwnd;
4777f8829a4aSRandall Stewart 		net->net_ack = 0;
4778f8829a4aSRandall Stewart 		net->net_ack2 = 0;
4779f8829a4aSRandall Stewart 
4780f8829a4aSRandall Stewart 		/*
478142551e99SRandall Stewart 		 * CMT: Reset CUC and Fast recovery algo variables before
478242551e99SRandall Stewart 		 * SACK processing
4783f8829a4aSRandall Stewart 		 */
4784f8829a4aSRandall Stewart 		net->new_pseudo_cumack = 0;
4785f8829a4aSRandall Stewart 		net->will_exit_fast_recovery = 0;
4786f8829a4aSRandall Stewart 	}
4787f8829a4aSRandall Stewart 	/* process the new consecutive TSN first */
4788f8829a4aSRandall Stewart 	tp1 = TAILQ_FIRST(&asoc->sent_queue);
4789f8829a4aSRandall Stewart 	while (tp1) {
4790f8829a4aSRandall Stewart 		if (compare_with_wrap(last_tsn, tp1->rec.data.TSN_seq,
4791f8829a4aSRandall Stewart 		    MAX_TSN) ||
4792f8829a4aSRandall Stewart 		    last_tsn == tp1->rec.data.TSN_seq) {
4793f8829a4aSRandall Stewart 			if (tp1->sent != SCTP_DATAGRAM_UNSENT) {
4794f8829a4aSRandall Stewart 				/*
4795f8829a4aSRandall Stewart 				 * ECN Nonce: Add the nonce to the sender's
4796f8829a4aSRandall Stewart 				 * nonce sum
4797f8829a4aSRandall Stewart 				 */
4798f8829a4aSRandall Stewart 				asoc->nonce_sum_expect_base += tp1->rec.data.ect_nonce;
4799f8829a4aSRandall Stewart 				accum_moved = 1;
4800f8829a4aSRandall Stewart 				if (tp1->sent < SCTP_DATAGRAM_ACKED) {
4801f8829a4aSRandall Stewart 					/*
4802f8829a4aSRandall Stewart 					 * If it is less than ACKED, it is
4803f8829a4aSRandall Stewart 					 * now no-longer in flight. Higher
4804f8829a4aSRandall Stewart 					 * values may occur during marking
4805f8829a4aSRandall Stewart 					 */
4806f8829a4aSRandall Stewart 					if ((tp1->whoTo->dest_state &
4807f8829a4aSRandall Stewart 					    SCTP_ADDR_UNCONFIRMED) &&
4808f8829a4aSRandall Stewart 					    (tp1->snd_count < 2)) {
4809f8829a4aSRandall Stewart 						/*
4810f8829a4aSRandall Stewart 						 * If there was no retran
4811f8829a4aSRandall Stewart 						 * and the address is
4812f8829a4aSRandall Stewart 						 * un-confirmed and we sent
4813f8829a4aSRandall Stewart 						 * there and are now
4814f8829a4aSRandall Stewart 						 * sacked.. its confirmed,
4815f8829a4aSRandall Stewart 						 * mark it so.
4816f8829a4aSRandall Stewart 						 */
4817f8829a4aSRandall Stewart 						tp1->whoTo->dest_state &=
4818f8829a4aSRandall Stewart 						    ~SCTP_ADDR_UNCONFIRMED;
4819f8829a4aSRandall Stewart 					}
4820c105859eSRandall Stewart 					if (tp1->sent < SCTP_DATAGRAM_RESEND) {
4821a5d547adSRandall Stewart #ifdef SCTP_FLIGHT_LOGGING
4822c105859eSRandall Stewart 						sctp_misc_ints(SCTP_FLIGHT_LOG_DOWN_CA,
4823a5d547adSRandall Stewart 						    tp1->whoTo->flight_size,
4824a5d547adSRandall Stewart 						    tp1->book_size,
4825c105859eSRandall Stewart 						    (uintptr_t) tp1->whoTo,
4826a5d547adSRandall Stewart 						    tp1->rec.data.TSN_seq);
4827a5d547adSRandall Stewart #endif
4828c105859eSRandall Stewart 						sctp_flight_size_decrease(tp1);
4829c105859eSRandall Stewart 						sctp_total_flight_decrease(stcb, tp1);
4830f8829a4aSRandall Stewart 					}
4831f8829a4aSRandall Stewart 					tp1->whoTo->net_ack += tp1->send_size;
4832f8829a4aSRandall Stewart 
4833f8829a4aSRandall Stewart 					/* CMT SFR and DAC algos */
4834f8829a4aSRandall Stewart 					this_sack_lowest_newack = tp1->rec.data.TSN_seq;
4835f8829a4aSRandall Stewart 					tp1->whoTo->saw_newack = 1;
4836f8829a4aSRandall Stewart 
4837f8829a4aSRandall Stewart 					if (tp1->snd_count < 2) {
4838f8829a4aSRandall Stewart 						/*
4839f8829a4aSRandall Stewart 						 * True non-retransmited
4840f8829a4aSRandall Stewart 						 * chunk
4841f8829a4aSRandall Stewart 						 */
4842f8829a4aSRandall Stewart 						tp1->whoTo->net_ack2 +=
4843f8829a4aSRandall Stewart 						    tp1->send_size;
4844f8829a4aSRandall Stewart 
4845f8829a4aSRandall Stewart 						/* update RTO too? */
4846f8829a4aSRandall Stewart 						if (tp1->do_rtt) {
4847f8829a4aSRandall Stewart 							tp1->whoTo->RTO =
4848f8829a4aSRandall Stewart 							    sctp_calculate_rto(stcb,
4849f8829a4aSRandall Stewart 							    asoc, tp1->whoTo,
4850f8829a4aSRandall Stewart 							    &tp1->sent_rcv_time);
4851f8829a4aSRandall Stewart 							tp1->do_rtt = 0;
4852f8829a4aSRandall Stewart 						}
4853f8829a4aSRandall Stewart 					}
4854f8829a4aSRandall Stewart 					/*
4855f8829a4aSRandall Stewart 					 * CMT: CUCv2 algorithm. From the
4856f8829a4aSRandall Stewart 					 * cumack'd TSNs, for each TSN being
4857f8829a4aSRandall Stewart 					 * acked for the first time, set the
4858f8829a4aSRandall Stewart 					 * following variables for the
4859f8829a4aSRandall Stewart 					 * corresp destination.
4860f8829a4aSRandall Stewart 					 * new_pseudo_cumack will trigger a
4861f8829a4aSRandall Stewart 					 * cwnd update.
4862f8829a4aSRandall Stewart 					 * find_(rtx_)pseudo_cumack will
4863f8829a4aSRandall Stewart 					 * trigger search for the next
4864f8829a4aSRandall Stewart 					 * expected (rtx-)pseudo-cumack.
4865f8829a4aSRandall Stewart 					 */
4866f8829a4aSRandall Stewart 					tp1->whoTo->new_pseudo_cumack = 1;
4867f8829a4aSRandall Stewart 					tp1->whoTo->find_pseudo_cumack = 1;
4868f8829a4aSRandall Stewart 					tp1->whoTo->find_rtx_pseudo_cumack = 1;
4869f8829a4aSRandall Stewart 
4870f8829a4aSRandall Stewart 
4871f8829a4aSRandall Stewart #ifdef SCTP_SACK_LOGGING
4872f8829a4aSRandall Stewart 					sctp_log_sack(asoc->last_acked_seq,
4873f8829a4aSRandall Stewart 					    cum_ack,
4874f8829a4aSRandall Stewart 					    tp1->rec.data.TSN_seq,
4875f8829a4aSRandall Stewart 					    0,
4876f8829a4aSRandall Stewart 					    0,
4877f8829a4aSRandall Stewart 					    SCTP_LOG_TSN_ACKED);
4878f8829a4aSRandall Stewart #endif
4879f8829a4aSRandall Stewart #ifdef SCTP_CWND_LOGGING
4880f8829a4aSRandall Stewart 					sctp_log_cwnd(stcb, tp1->whoTo, tp1->rec.data.TSN_seq, SCTP_CWND_LOG_FROM_SACK);
4881f8829a4aSRandall Stewart #endif
4882f8829a4aSRandall Stewart 				}
4883f8829a4aSRandall Stewart 				if (tp1->sent == SCTP_DATAGRAM_RESEND) {
4884f8829a4aSRandall Stewart 					sctp_ucount_decr(asoc->sent_queue_retran_cnt);
4885f8829a4aSRandall Stewart #ifdef SCTP_AUDITING_ENABLED
4886f8829a4aSRandall Stewart 					sctp_audit_log(0xB3,
4887f8829a4aSRandall Stewart 					    (asoc->sent_queue_retran_cnt & 0x000000ff));
4888f8829a4aSRandall Stewart #endif
4889f8829a4aSRandall Stewart 				}
489042551e99SRandall Stewart 				if (tp1->rec.data.chunk_was_revoked) {
489142551e99SRandall Stewart 					/* deflate the cwnd */
489242551e99SRandall Stewart 					tp1->whoTo->cwnd -= tp1->book_size;
489342551e99SRandall Stewart 					tp1->rec.data.chunk_was_revoked = 0;
489442551e99SRandall Stewart 				}
4895f8829a4aSRandall Stewart 				tp1->sent = SCTP_DATAGRAM_ACKED;
4896f8829a4aSRandall Stewart 			}
4897f8829a4aSRandall Stewart 		} else {
4898f8829a4aSRandall Stewart 			break;
4899f8829a4aSRandall Stewart 		}
4900f8829a4aSRandall Stewart 		tp1 = TAILQ_NEXT(tp1, sctp_next);
4901f8829a4aSRandall Stewart 	}
4902f8829a4aSRandall Stewart 	biggest_tsn_newly_acked = biggest_tsn_acked = last_tsn;
4903f8829a4aSRandall Stewart 	/* always set this up to cum-ack */
4904f8829a4aSRandall Stewart 	asoc->this_sack_highest_gap = last_tsn;
4905f8829a4aSRandall Stewart 
4906f8829a4aSRandall Stewart 	if (((num_seg * (sizeof(struct sctp_gap_ack_block))) + sizeof(struct sctp_sack_chunk)) > sack_length) {
4907f8829a4aSRandall Stewart 
4908f8829a4aSRandall Stewart 		/* skip corrupt segments */
4909f8829a4aSRandall Stewart 		goto skip_segments;
4910f8829a4aSRandall Stewart 	}
4911f8829a4aSRandall Stewart 	if (num_seg > 0) {
4912f8829a4aSRandall Stewart 
4913f8829a4aSRandall Stewart 		/*
4914f8829a4aSRandall Stewart 		 * CMT: SFR algo (and HTNA) - this_sack_highest_newack has
4915f8829a4aSRandall Stewart 		 * to be greater than the cumack. Also reset saw_newack to 0
4916f8829a4aSRandall Stewart 		 * for all dests.
4917f8829a4aSRandall Stewart 		 */
4918f8829a4aSRandall Stewart 		TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
4919f8829a4aSRandall Stewart 			net->saw_newack = 0;
4920f8829a4aSRandall Stewart 			net->this_sack_highest_newack = last_tsn;
4921f8829a4aSRandall Stewart 		}
4922f8829a4aSRandall Stewart 
4923f8829a4aSRandall Stewart 		/*
4924f8829a4aSRandall Stewart 		 * thisSackHighestGap will increase while handling NEW
4925f8829a4aSRandall Stewart 		 * segments this_sack_highest_newack will increase while
4926f8829a4aSRandall Stewart 		 * handling NEWLY ACKED chunks. this_sack_lowest_newack is
4927f8829a4aSRandall Stewart 		 * used for CMT DAC algo. saw_newack will also change.
4928f8829a4aSRandall Stewart 		 */
4929f8829a4aSRandall Stewart 		sctp_handle_segments(stcb, asoc, ch, last_tsn,
4930f8829a4aSRandall Stewart 		    &biggest_tsn_acked, &biggest_tsn_newly_acked, &this_sack_lowest_newack,
4931f8829a4aSRandall Stewart 		    num_seg, &ecn_seg_sums);
4932f8829a4aSRandall Stewart 
4933f8829a4aSRandall Stewart 		if (sctp_strict_sacks) {
4934f8829a4aSRandall Stewart 			/*
4935f8829a4aSRandall Stewart 			 * validate the biggest_tsn_acked in the gap acks if
4936f8829a4aSRandall Stewart 			 * strict adherence is wanted.
4937f8829a4aSRandall Stewart 			 */
4938f8829a4aSRandall Stewart 			if ((biggest_tsn_acked == send_s) ||
4939f8829a4aSRandall Stewart 			    (compare_with_wrap(biggest_tsn_acked, send_s, MAX_TSN))) {
4940f8829a4aSRandall Stewart 				/*
4941f8829a4aSRandall Stewart 				 * peer is either confused or we are under
4942f8829a4aSRandall Stewart 				 * attack. We must abort.
4943f8829a4aSRandall Stewart 				 */
4944f8829a4aSRandall Stewart 				goto hopeless_peer;
4945f8829a4aSRandall Stewart 			}
4946f8829a4aSRandall Stewart 		}
4947f8829a4aSRandall Stewart 	}
4948f8829a4aSRandall Stewart skip_segments:
4949f8829a4aSRandall Stewart 	/*******************************************/
4950f8829a4aSRandall Stewart 	/* cancel ALL T3-send timer if accum moved */
4951f8829a4aSRandall Stewart 	/*******************************************/
4952f8829a4aSRandall Stewart 	if (sctp_cmt_on_off) {
4953f8829a4aSRandall Stewart 		TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
4954f8829a4aSRandall Stewart 			if (net->new_pseudo_cumack)
4955f8829a4aSRandall Stewart 				sctp_timer_stop(SCTP_TIMER_TYPE_SEND, stcb->sctp_ep,
4956a5d547adSRandall Stewart 				    stcb, net,
4957a5d547adSRandall Stewart 				    SCTP_FROM_SCTP_INDATA + SCTP_LOC_27);
4958f8829a4aSRandall Stewart 
4959f8829a4aSRandall Stewart 		}
4960f8829a4aSRandall Stewart 	} else {
4961f8829a4aSRandall Stewart 		if (accum_moved) {
4962f8829a4aSRandall Stewart 			TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
4963f8829a4aSRandall Stewart 				sctp_timer_stop(SCTP_TIMER_TYPE_SEND, stcb->sctp_ep,
4964a5d547adSRandall Stewart 				    stcb, net, SCTP_FROM_SCTP_INDATA + SCTP_LOC_28);
4965f8829a4aSRandall Stewart 			}
4966f8829a4aSRandall Stewart 		}
4967f8829a4aSRandall Stewart 	}
4968f8829a4aSRandall Stewart 	/********************************************/
4969f8829a4aSRandall Stewart 	/* drop the acked chunks from the sendqueue */
4970f8829a4aSRandall Stewart 	/********************************************/
4971f8829a4aSRandall Stewart 	asoc->last_acked_seq = cum_ack;
4972f8829a4aSRandall Stewart 
4973f8829a4aSRandall Stewart 	tp1 = TAILQ_FIRST(&asoc->sent_queue);
4974f8829a4aSRandall Stewart 	if (tp1 == NULL)
4975f8829a4aSRandall Stewart 		goto done_with_it;
4976f8829a4aSRandall Stewart 	do {
4977f8829a4aSRandall Stewart 		if (compare_with_wrap(tp1->rec.data.TSN_seq, cum_ack,
4978f8829a4aSRandall Stewart 		    MAX_TSN)) {
4979f8829a4aSRandall Stewart 			break;
4980f8829a4aSRandall Stewart 		}
4981f8829a4aSRandall Stewart 		if (tp1->sent == SCTP_DATAGRAM_UNSENT) {
4982f8829a4aSRandall Stewart 			/* no more sent on list */
4983f8829a4aSRandall Stewart 			break;
4984f8829a4aSRandall Stewart 		}
4985f8829a4aSRandall Stewart 		tp2 = TAILQ_NEXT(tp1, sctp_next);
4986f8829a4aSRandall Stewart 		TAILQ_REMOVE(&asoc->sent_queue, tp1, sctp_next);
4987f8829a4aSRandall Stewart 		/*
4988f8829a4aSRandall Stewart 		 * Friendlier printf in lieu of panic now that I think its
4989f8829a4aSRandall Stewart 		 * fixed
4990f8829a4aSRandall Stewart 		 */
4991f8829a4aSRandall Stewart 
4992f8829a4aSRandall Stewart 		if (tp1->pr_sctp_on) {
4993f8829a4aSRandall Stewart 			if (asoc->pr_sctp_cnt != 0)
4994f8829a4aSRandall Stewart 				asoc->pr_sctp_cnt--;
4995f8829a4aSRandall Stewart 		}
4996f8829a4aSRandall Stewart 		if ((TAILQ_FIRST(&asoc->sent_queue) == NULL) &&
4997f8829a4aSRandall Stewart 		    (asoc->total_flight > 0)) {
4998f1f73e57SRandall Stewart #ifdef INVARIANTS
4999c105859eSRandall Stewart 			panic("Warning flight size is postive and should be 0");
5000f1f73e57SRandall Stewart #else
5001f1f73e57SRandall Stewart 
5002f8829a4aSRandall Stewart 			printf("Warning flight size incorrect should be 0 is %d\n",
5003f8829a4aSRandall Stewart 			    asoc->total_flight);
5004f1f73e57SRandall Stewart #endif
5005f8829a4aSRandall Stewart 			asoc->total_flight = 0;
5006f8829a4aSRandall Stewart 		}
5007f8829a4aSRandall Stewart 		if (tp1->data) {
5008f8829a4aSRandall Stewart 			sctp_free_bufspace(stcb, asoc, tp1, 1);
5009f8829a4aSRandall Stewart 			sctp_m_freem(tp1->data);
5010f8829a4aSRandall Stewart 			if (PR_SCTP_BUF_ENABLED(tp1->flags)) {
5011f8829a4aSRandall Stewart 				asoc->sent_queue_cnt_removeable--;
5012f8829a4aSRandall Stewart 			}
5013f8829a4aSRandall Stewart 		}
5014f8829a4aSRandall Stewart #ifdef SCTP_SACK_LOGGING
5015f8829a4aSRandall Stewart 		sctp_log_sack(asoc->last_acked_seq,
5016f8829a4aSRandall Stewart 		    cum_ack,
5017f8829a4aSRandall Stewart 		    tp1->rec.data.TSN_seq,
5018f8829a4aSRandall Stewart 		    0,
5019f8829a4aSRandall Stewart 		    0,
5020f8829a4aSRandall Stewart 		    SCTP_LOG_FREE_SENT);
5021f8829a4aSRandall Stewart #endif
5022f8829a4aSRandall Stewart 		tp1->data = NULL;
5023f8829a4aSRandall Stewart 		asoc->sent_queue_cnt--;
5024f8829a4aSRandall Stewart 		sctp_free_remote_addr(tp1->whoTo);
5025f8829a4aSRandall Stewart 
5026f8829a4aSRandall Stewart 		sctp_free_a_chunk(stcb, tp1);
5027f8829a4aSRandall Stewart 		wake_him++;
5028f8829a4aSRandall Stewart 		tp1 = tp2;
5029f8829a4aSRandall Stewart 	} while (tp1 != NULL);
5030f8829a4aSRandall Stewart 
5031f8829a4aSRandall Stewart done_with_it:
5032f8829a4aSRandall Stewart 	if ((wake_him) && (stcb->sctp_socket)) {
5033f8829a4aSRandall Stewart 		SOCKBUF_LOCK(&stcb->sctp_socket->so_snd);
5034f8829a4aSRandall Stewart #ifdef SCTP_WAKE_LOGGING
5035f8829a4aSRandall Stewart 		sctp_wakeup_log(stcb, cum_ack, wake_him, SCTP_WAKESND_FROM_SACK);
5036f8829a4aSRandall Stewart #endif
5037f8829a4aSRandall Stewart 		sctp_sowwakeup_locked(stcb->sctp_ep, stcb->sctp_socket);
5038f8829a4aSRandall Stewart #ifdef SCTP_WAKE_LOGGING
5039f8829a4aSRandall Stewart 	} else {
5040f8829a4aSRandall Stewart 		sctp_wakeup_log(stcb, cum_ack, wake_him, SCTP_NOWAKE_FROM_SACK);
5041f8829a4aSRandall Stewart #endif
5042f8829a4aSRandall Stewart 	}
5043f8829a4aSRandall Stewart 
504442551e99SRandall Stewart 	if (asoc->fast_retran_loss_recovery && accum_moved) {
5045f8829a4aSRandall Stewart 		if (compare_with_wrap(asoc->last_acked_seq,
5046f8829a4aSRandall Stewart 		    asoc->fast_recovery_tsn, MAX_TSN) ||
5047f8829a4aSRandall Stewart 		    asoc->last_acked_seq == asoc->fast_recovery_tsn) {
5048f8829a4aSRandall Stewart 			/* Setup so we will exit RFC2582 fast recovery */
5049f8829a4aSRandall Stewart 			will_exit_fast_recovery = 1;
5050f8829a4aSRandall Stewart 		}
5051f8829a4aSRandall Stewart 	}
5052f8829a4aSRandall Stewart 	/*
5053f8829a4aSRandall Stewart 	 * Check for revoked fragments:
5054f8829a4aSRandall Stewart 	 *
5055f8829a4aSRandall Stewart 	 * if Previous sack - Had no frags then we can't have any revoked if
5056f8829a4aSRandall Stewart 	 * Previous sack - Had frag's then - If we now have frags aka
5057f8829a4aSRandall Stewart 	 * num_seg > 0 call sctp_check_for_revoked() to tell if peer revoked
5058f8829a4aSRandall Stewart 	 * some of them. else - The peer revoked all ACKED fragments, since
5059f8829a4aSRandall Stewart 	 * we had some before and now we have NONE.
5060f8829a4aSRandall Stewart 	 */
5061f8829a4aSRandall Stewart 
5062f42a358aSRandall Stewart 	if (num_seg)
5063c105859eSRandall Stewart 		sctp_check_for_revoked(stcb, asoc, cum_ack, biggest_tsn_acked);
5064f8829a4aSRandall Stewart 	else if (asoc->saw_sack_with_frags) {
5065f8829a4aSRandall Stewart 		int cnt_revoked = 0;
5066f8829a4aSRandall Stewart 
5067f8829a4aSRandall Stewart 		tp1 = TAILQ_FIRST(&asoc->sent_queue);
5068f8829a4aSRandall Stewart 		if (tp1 != NULL) {
5069f8829a4aSRandall Stewart 			/* Peer revoked all dg's marked or acked */
5070f8829a4aSRandall Stewart 			TAILQ_FOREACH(tp1, &asoc->sent_queue, sctp_next) {
5071f8829a4aSRandall Stewart 				if ((tp1->sent > SCTP_DATAGRAM_RESEND) &&
5072f8829a4aSRandall Stewart 				    (tp1->sent < SCTP_FORWARD_TSN_SKIP)) {
5073f8829a4aSRandall Stewart 					tp1->sent = SCTP_DATAGRAM_SENT;
5074c105859eSRandall Stewart #ifdef SCTP_FLIGHT_LOGGING
5075c105859eSRandall Stewart 					sctp_misc_ints(SCTP_FLIGHT_LOG_UP_REVOKE,
5076c105859eSRandall Stewart 					    tp1->whoTo->flight_size,
5077c105859eSRandall Stewart 					    tp1->book_size,
5078c105859eSRandall Stewart 					    (uintptr_t) tp1->whoTo,
5079c105859eSRandall Stewart 					    tp1->rec.data.TSN_seq);
5080c105859eSRandall Stewart #endif
5081c105859eSRandall Stewart 					sctp_flight_size_increase(tp1);
5082c105859eSRandall Stewart 					sctp_total_flight_increase(stcb, tp1);
5083a5d547adSRandall Stewart 					tp1->rec.data.chunk_was_revoked = 1;
508442551e99SRandall Stewart 					/*
508542551e99SRandall Stewart 					 * To ensure that this increase in
508642551e99SRandall Stewart 					 * flightsize, which is artificial,
508742551e99SRandall Stewart 					 * does not throttle the sender, we
508842551e99SRandall Stewart 					 * also increase the cwnd
508942551e99SRandall Stewart 					 * artificially.
509042551e99SRandall Stewart 					 */
509142551e99SRandall Stewart 					tp1->whoTo->cwnd += tp1->book_size;
5092f8829a4aSRandall Stewart 					cnt_revoked++;
5093f8829a4aSRandall Stewart 				}
5094f8829a4aSRandall Stewart 			}
5095f8829a4aSRandall Stewart 			if (cnt_revoked) {
5096f8829a4aSRandall Stewart 				reneged_all = 1;
5097f8829a4aSRandall Stewart 			}
5098f8829a4aSRandall Stewart 		}
5099f8829a4aSRandall Stewart 		asoc->saw_sack_with_frags = 0;
5100f8829a4aSRandall Stewart 	}
5101f8829a4aSRandall Stewart 	if (num_seg)
5102f8829a4aSRandall Stewart 		asoc->saw_sack_with_frags = 1;
5103f8829a4aSRandall Stewart 	else
5104f8829a4aSRandall Stewart 		asoc->saw_sack_with_frags = 0;
5105f8829a4aSRandall Stewart 
5106f8829a4aSRandall Stewart 
5107f8829a4aSRandall Stewart 	sctp_cwnd_update(stcb, asoc, accum_moved, reneged_all, will_exit_fast_recovery);
5108f8829a4aSRandall Stewart 
5109f8829a4aSRandall Stewart 	if (TAILQ_EMPTY(&asoc->sent_queue)) {
5110f8829a4aSRandall Stewart 		/* nothing left in-flight */
5111f8829a4aSRandall Stewart 		TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
5112f8829a4aSRandall Stewart 			/* stop all timers */
5113f8829a4aSRandall Stewart 			if (sctp_early_fr) {
5114139bc87fSRandall Stewart 				if (SCTP_OS_TIMER_PENDING(&net->fr_timer.timer)) {
5115f8829a4aSRandall Stewart 					SCTP_STAT_INCR(sctps_earlyfrstpidsck4);
5116a5d547adSRandall Stewart 					sctp_timer_stop(SCTP_TIMER_TYPE_EARLYFR, stcb->sctp_ep, stcb, net,
5117a5d547adSRandall Stewart 					    SCTP_FROM_SCTP_INDATA + SCTP_LOC_29);
5118f8829a4aSRandall Stewart 				}
5119f8829a4aSRandall Stewart 			}
5120f8829a4aSRandall Stewart 			sctp_timer_stop(SCTP_TIMER_TYPE_SEND, stcb->sctp_ep,
5121a5d547adSRandall Stewart 			    stcb, net, SCTP_FROM_SCTP_INDATA + SCTP_LOC_30);
5122f8829a4aSRandall Stewart 			net->flight_size = 0;
5123f8829a4aSRandall Stewart 			net->partial_bytes_acked = 0;
5124f8829a4aSRandall Stewart 		}
5125f8829a4aSRandall Stewart 		asoc->total_flight = 0;
5126f8829a4aSRandall Stewart 		asoc->total_flight_count = 0;
5127f8829a4aSRandall Stewart 	}
5128f8829a4aSRandall Stewart 	/**********************************/
5129f8829a4aSRandall Stewart 	/* Now what about shutdown issues */
5130f8829a4aSRandall Stewart 	/**********************************/
5131f8829a4aSRandall Stewart 	if (TAILQ_EMPTY(&asoc->send_queue) && TAILQ_EMPTY(&asoc->sent_queue)) {
5132f8829a4aSRandall Stewart 		/* nothing left on sendqueue.. consider done */
5133f8829a4aSRandall Stewart #ifdef SCTP_LOG_RWND
5134f8829a4aSRandall Stewart 		sctp_log_rwnd_set(SCTP_SET_PEER_RWND_VIA_SACK,
5135f8829a4aSRandall Stewart 		    asoc->peers_rwnd, 0, 0, a_rwnd);
5136f8829a4aSRandall Stewart #endif
5137f8829a4aSRandall Stewart 		asoc->peers_rwnd = a_rwnd;
5138f8829a4aSRandall Stewart 		if (asoc->peers_rwnd < stcb->sctp_ep->sctp_ep.sctp_sws_sender) {
5139f8829a4aSRandall Stewart 			/* SWS sender side engages */
5140f8829a4aSRandall Stewart 			asoc->peers_rwnd = 0;
5141f8829a4aSRandall Stewart 		}
5142f8829a4aSRandall Stewart 		/* clean up */
5143f8829a4aSRandall Stewart 		if ((asoc->stream_queue_cnt == 1) &&
5144f8829a4aSRandall Stewart 		    ((asoc->state & SCTP_STATE_SHUTDOWN_PENDING) ||
5145f8829a4aSRandall Stewart 		    (asoc->state & SCTP_STATE_SHUTDOWN_RECEIVED)) &&
5146f8829a4aSRandall Stewart 		    (asoc->locked_on_sending)
5147f8829a4aSRandall Stewart 		    ) {
5148f8829a4aSRandall Stewart 			struct sctp_stream_queue_pending *sp;
5149f8829a4aSRandall Stewart 
5150f8829a4aSRandall Stewart 			/*
5151f8829a4aSRandall Stewart 			 * I may be in a state where we got all across.. but
5152f8829a4aSRandall Stewart 			 * cannot write more due to a shutdown... we abort
5153f8829a4aSRandall Stewart 			 * since the user did not indicate EOR in this case.
5154f8829a4aSRandall Stewart 			 */
5155f8829a4aSRandall Stewart 			sp = TAILQ_LAST(&((asoc->locked_on_sending)->outqueue),
5156f8829a4aSRandall Stewart 			    sctp_streamhead);
5157f8829a4aSRandall Stewart 			if ((sp) && (sp->length == 0) && (sp->msg_is_complete == 0)) {
5158f8829a4aSRandall Stewart 				asoc->state |= SCTP_STATE_PARTIAL_MSG_LEFT;
5159f8829a4aSRandall Stewart 				asoc->locked_on_sending = NULL;
5160f8829a4aSRandall Stewart 				asoc->stream_queue_cnt--;
5161f8829a4aSRandall Stewart 			}
5162f8829a4aSRandall Stewart 		}
5163f8829a4aSRandall Stewart 		if ((asoc->state & SCTP_STATE_SHUTDOWN_PENDING) &&
5164f8829a4aSRandall Stewart 		    (asoc->stream_queue_cnt == 0)) {
5165f8829a4aSRandall Stewart 			if (asoc->state & SCTP_STATE_PARTIAL_MSG_LEFT) {
5166f8829a4aSRandall Stewart 				/* Need to abort here */
5167f8829a4aSRandall Stewart 				struct mbuf *oper;
5168f8829a4aSRandall Stewart 
5169f8829a4aSRandall Stewart 		abort_out_now:
5170f8829a4aSRandall Stewart 				*abort_now = 1;
5171f8829a4aSRandall Stewart 				/* XXX */
5172f8829a4aSRandall Stewart 				oper = sctp_get_mbuf_for_msg((sizeof(struct sctp_paramhdr) + sizeof(uint32_t)),
5173f8829a4aSRandall Stewart 				    0, M_DONTWAIT, 1, MT_DATA);
5174f8829a4aSRandall Stewart 				if (oper) {
5175f8829a4aSRandall Stewart 					struct sctp_paramhdr *ph;
5176f8829a4aSRandall Stewart 					uint32_t *ippp;
5177f8829a4aSRandall Stewart 
5178139bc87fSRandall Stewart 					SCTP_BUF_LEN(oper) = sizeof(struct sctp_paramhdr) +
5179f8829a4aSRandall Stewart 					    sizeof(uint32_t);
5180f8829a4aSRandall Stewart 					ph = mtod(oper, struct sctp_paramhdr *);
5181f8829a4aSRandall Stewart 					ph->param_type = htons(SCTP_CAUSE_USER_INITIATED_ABT);
5182139bc87fSRandall Stewart 					ph->param_length = htons(SCTP_BUF_LEN(oper));
5183f8829a4aSRandall Stewart 					ippp = (uint32_t *) (ph + 1);
5184a5d547adSRandall Stewart 					*ippp = htonl(SCTP_FROM_SCTP_INDATA + SCTP_LOC_31);
5185f8829a4aSRandall Stewart 				}
5186a5d547adSRandall Stewart 				stcb->sctp_ep->last_abort_code = SCTP_FROM_SCTP_INDATA + SCTP_LOC_31;
5187f8829a4aSRandall Stewart 				sctp_abort_an_association(stcb->sctp_ep, stcb, SCTP_RESPONSE_TO_USER_REQ, oper);
5188f8829a4aSRandall Stewart 				return;
5189f8829a4aSRandall Stewart 			} else {
5190f42a358aSRandall Stewart 				if ((SCTP_GET_STATE(asoc) == SCTP_STATE_OPEN) ||
5191f42a358aSRandall Stewart 				    (SCTP_GET_STATE(asoc) == SCTP_STATE_SHUTDOWN_RECEIVED)) {
5192f8829a4aSRandall Stewart 					SCTP_STAT_DECR_GAUGE32(sctps_currestab);
5193f42a358aSRandall Stewart 				}
5194f42a358aSRandall Stewart 				asoc->state = SCTP_STATE_SHUTDOWN_SENT;
5195f8829a4aSRandall Stewart 				sctp_stop_timers_for_shutdown(stcb);
5196f8829a4aSRandall Stewart 				sctp_send_shutdown(stcb,
5197f8829a4aSRandall Stewart 				    stcb->asoc.primary_destination);
5198f8829a4aSRandall Stewart 				sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWN,
5199f8829a4aSRandall Stewart 				    stcb->sctp_ep, stcb, asoc->primary_destination);
5200f8829a4aSRandall Stewart 				sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNGUARD,
5201f8829a4aSRandall Stewart 				    stcb->sctp_ep, stcb, asoc->primary_destination);
5202f8829a4aSRandall Stewart 			}
5203f8829a4aSRandall Stewart 			return;
5204f8829a4aSRandall Stewart 		} else if ((SCTP_GET_STATE(asoc) == SCTP_STATE_SHUTDOWN_RECEIVED) &&
5205f8829a4aSRandall Stewart 		    (asoc->stream_queue_cnt == 0)) {
5206f8829a4aSRandall Stewart 			if (asoc->state & SCTP_STATE_PARTIAL_MSG_LEFT) {
5207f8829a4aSRandall Stewart 				goto abort_out_now;
5208f8829a4aSRandall Stewart 			}
5209f8829a4aSRandall Stewart 			SCTP_STAT_DECR_GAUGE32(sctps_currestab);
5210f42a358aSRandall Stewart 			asoc->state = SCTP_STATE_SHUTDOWN_ACK_SENT;
5211f8829a4aSRandall Stewart 			sctp_send_shutdown_ack(stcb,
5212f8829a4aSRandall Stewart 			    stcb->asoc.primary_destination);
5213f8829a4aSRandall Stewart 
5214f8829a4aSRandall Stewart 			sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNACK,
5215f8829a4aSRandall Stewart 			    stcb->sctp_ep, stcb, asoc->primary_destination);
5216f8829a4aSRandall Stewart 			return;
5217f8829a4aSRandall Stewart 		}
5218f8829a4aSRandall Stewart 	}
5219f8829a4aSRandall Stewart 	/*
5220f8829a4aSRandall Stewart 	 * Now here we are going to recycle net_ack for a different use...
5221f8829a4aSRandall Stewart 	 * HEADS UP.
5222f8829a4aSRandall Stewart 	 */
5223f8829a4aSRandall Stewart 	TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
5224f8829a4aSRandall Stewart 		net->net_ack = 0;
5225f8829a4aSRandall Stewart 	}
5226f8829a4aSRandall Stewart 
5227f8829a4aSRandall Stewart 	/*
5228f8829a4aSRandall Stewart 	 * CMT DAC algorithm: If SACK DAC flag was 0, then no extra marking
5229f8829a4aSRandall Stewart 	 * to be done. Setting this_sack_lowest_newack to the cum_ack will
5230f8829a4aSRandall Stewart 	 * automatically ensure that.
5231f8829a4aSRandall Stewart 	 */
5232f8829a4aSRandall Stewart 	if (sctp_cmt_on_off && sctp_cmt_use_dac && (cmt_dac_flag == 0)) {
5233f8829a4aSRandall Stewart 		this_sack_lowest_newack = cum_ack;
5234f8829a4aSRandall Stewart 	}
5235f8829a4aSRandall Stewart 	if (num_seg > 0) {
5236f8829a4aSRandall Stewart 		sctp_strike_gap_ack_chunks(stcb, asoc, biggest_tsn_acked,
5237f8829a4aSRandall Stewart 		    biggest_tsn_newly_acked, this_sack_lowest_newack, accum_moved);
5238f8829a4aSRandall Stewart 	}
5239f8829a4aSRandall Stewart 	/*********************************************/
5240f8829a4aSRandall Stewart 	/* Here we perform PR-SCTP procedures        */
5241f8829a4aSRandall Stewart 	/* (section 4.2)                             */
5242f8829a4aSRandall Stewart 	/*********************************************/
5243f8829a4aSRandall Stewart 	/* C1. update advancedPeerAckPoint */
5244f8829a4aSRandall Stewart 	if (compare_with_wrap(cum_ack, asoc->advanced_peer_ack_point, MAX_TSN)) {
5245f8829a4aSRandall Stewart 		asoc->advanced_peer_ack_point = cum_ack;
5246f8829a4aSRandall Stewart 	}
5247f8829a4aSRandall Stewart 	/* C2. try to further move advancedPeerAckPoint ahead */
5248f8829a4aSRandall Stewart 
5249f8829a4aSRandall Stewart 	if ((asoc->peer_supports_prsctp) && (asoc->pr_sctp_cnt > 0)) {
5250f8829a4aSRandall Stewart 		struct sctp_tmit_chunk *lchk;
5251f8829a4aSRandall Stewart 
5252f8829a4aSRandall Stewart 		lchk = sctp_try_advance_peer_ack_point(stcb, asoc);
5253f8829a4aSRandall Stewart 		/* C3. See if we need to send a Fwd-TSN */
5254f8829a4aSRandall Stewart 		if (compare_with_wrap(asoc->advanced_peer_ack_point, cum_ack,
5255f8829a4aSRandall Stewart 		    MAX_TSN)) {
5256f8829a4aSRandall Stewart 			/*
5257f8829a4aSRandall Stewart 			 * ISSUE with ECN, see FWD-TSN processing for notes
5258f8829a4aSRandall Stewart 			 * on issues that will occur when the ECN NONCE
5259f8829a4aSRandall Stewart 			 * stuff is put into SCTP for cross checking.
5260f8829a4aSRandall Stewart 			 */
5261f8829a4aSRandall Stewart 			send_forward_tsn(stcb, asoc);
5262f8829a4aSRandall Stewart 
5263f8829a4aSRandall Stewart 			/*
5264f8829a4aSRandall Stewart 			 * ECN Nonce: Disable Nonce Sum check when FWD TSN
5265f8829a4aSRandall Stewart 			 * is sent and store resync tsn
5266f8829a4aSRandall Stewart 			 */
5267f8829a4aSRandall Stewart 			asoc->nonce_sum_check = 0;
5268f8829a4aSRandall Stewart 			asoc->nonce_resync_tsn = asoc->advanced_peer_ack_point;
5269f8829a4aSRandall Stewart 			if (lchk) {
5270f8829a4aSRandall Stewart 				/* Assure a timer is up */
5271f8829a4aSRandall Stewart 				sctp_timer_start(SCTP_TIMER_TYPE_SEND,
5272f8829a4aSRandall Stewart 				    stcb->sctp_ep, stcb, lchk->whoTo);
5273f8829a4aSRandall Stewart 			}
5274f8829a4aSRandall Stewart 		}
5275f8829a4aSRandall Stewart 	}
5276f8829a4aSRandall Stewart 	/*
5277f8829a4aSRandall Stewart 	 * CMT fast recovery code. Need to debug. ((sctp_cmt_on_off == 1) &&
5278c105859eSRandall Stewart 	 * (net->fast_retran_loss_recovery == 0)))
5279f8829a4aSRandall Stewart 	 */
5280f8829a4aSRandall Stewart 	TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
5281c105859eSRandall Stewart 		if ((asoc->fast_retran_loss_recovery == 0) || (sctp_cmt_on_off == 1)) {
5282f8829a4aSRandall Stewart 			/* out of a RFC2582 Fast recovery window? */
5283f8829a4aSRandall Stewart 			if (net->net_ack > 0) {
5284f8829a4aSRandall Stewart 				/*
5285f8829a4aSRandall Stewart 				 * per section 7.2.3, are there any
5286f8829a4aSRandall Stewart 				 * destinations that had a fast retransmit
5287f8829a4aSRandall Stewart 				 * to them. If so what we need to do is
5288f8829a4aSRandall Stewart 				 * adjust ssthresh and cwnd.
5289f8829a4aSRandall Stewart 				 */
5290f8829a4aSRandall Stewart 				struct sctp_tmit_chunk *lchk;
5291f8829a4aSRandall Stewart 
5292f8829a4aSRandall Stewart #ifdef  SCTP_HIGH_SPEED
529350cec919SRandall Stewart 				sctp_hs_cwnd_decrease(stcb, net);
5294f8829a4aSRandall Stewart #else
5295f8829a4aSRandall Stewart #ifdef SCTP_CWND_MONITOR
5296f8829a4aSRandall Stewart 				int old_cwnd = net->cwnd;
5297f8829a4aSRandall Stewart 
5298f8829a4aSRandall Stewart #endif
5299f8829a4aSRandall Stewart 				net->ssthresh = net->cwnd / 2;
5300f8829a4aSRandall Stewart 				if (net->ssthresh < (net->mtu * 2)) {
5301f8829a4aSRandall Stewart 					net->ssthresh = 2 * net->mtu;
5302f8829a4aSRandall Stewart 				}
5303f8829a4aSRandall Stewart 				net->cwnd = net->ssthresh;
5304f8829a4aSRandall Stewart #ifdef SCTP_CWND_MONITOR
5305f8829a4aSRandall Stewart 				sctp_log_cwnd(stcb, net, (net->cwnd - old_cwnd),
5306f8829a4aSRandall Stewart 				    SCTP_CWND_LOG_FROM_FR);
5307f8829a4aSRandall Stewart #endif
5308f8829a4aSRandall Stewart #endif
5309f8829a4aSRandall Stewart 
5310f8829a4aSRandall Stewart 				lchk = TAILQ_FIRST(&asoc->send_queue);
5311f8829a4aSRandall Stewart 
5312f8829a4aSRandall Stewart 				net->partial_bytes_acked = 0;
5313f8829a4aSRandall Stewart 				/* Turn on fast recovery window */
5314f8829a4aSRandall Stewart 				asoc->fast_retran_loss_recovery = 1;
5315f8829a4aSRandall Stewart 				if (lchk == NULL) {
5316f8829a4aSRandall Stewart 					/* Mark end of the window */
5317f8829a4aSRandall Stewart 					asoc->fast_recovery_tsn = asoc->sending_seq - 1;
5318f8829a4aSRandall Stewart 				} else {
5319f8829a4aSRandall Stewart 					asoc->fast_recovery_tsn = lchk->rec.data.TSN_seq - 1;
5320f8829a4aSRandall Stewart 				}
5321f8829a4aSRandall Stewart 
5322f8829a4aSRandall Stewart 				/*
5323f8829a4aSRandall Stewart 				 * CMT fast recovery -- per destination
5324f8829a4aSRandall Stewart 				 * recovery variable.
5325f8829a4aSRandall Stewart 				 */
5326f8829a4aSRandall Stewart 				net->fast_retran_loss_recovery = 1;
5327f8829a4aSRandall Stewart 
5328f8829a4aSRandall Stewart 				if (lchk == NULL) {
5329f8829a4aSRandall Stewart 					/* Mark end of the window */
5330f8829a4aSRandall Stewart 					net->fast_recovery_tsn = asoc->sending_seq - 1;
5331f8829a4aSRandall Stewart 				} else {
5332f8829a4aSRandall Stewart 					net->fast_recovery_tsn = lchk->rec.data.TSN_seq - 1;
5333f8829a4aSRandall Stewart 				}
5334f8829a4aSRandall Stewart 
5335f8829a4aSRandall Stewart 
5336f8829a4aSRandall Stewart 
5337f8829a4aSRandall Stewart 				/*
5338f8829a4aSRandall Stewart 				 * Disable Nonce Sum Checking and store the
5339f8829a4aSRandall Stewart 				 * resync tsn
5340f8829a4aSRandall Stewart 				 */
5341f8829a4aSRandall Stewart 				asoc->nonce_sum_check = 0;
5342f8829a4aSRandall Stewart 				asoc->nonce_resync_tsn = asoc->fast_recovery_tsn + 1;
5343f8829a4aSRandall Stewart 
5344f8829a4aSRandall Stewart 				sctp_timer_stop(SCTP_TIMER_TYPE_SEND,
5345a5d547adSRandall Stewart 				    stcb->sctp_ep, stcb, net, SCTP_FROM_SCTP_INDATA + SCTP_LOC_32);
5346f8829a4aSRandall Stewart 				sctp_timer_start(SCTP_TIMER_TYPE_SEND,
5347f8829a4aSRandall Stewart 				    stcb->sctp_ep, stcb, net);
5348f8829a4aSRandall Stewart 			}
5349f8829a4aSRandall Stewart 		} else if (net->net_ack > 0) {
5350f8829a4aSRandall Stewart 			/*
5351f8829a4aSRandall Stewart 			 * Mark a peg that we WOULD have done a cwnd
5352f8829a4aSRandall Stewart 			 * reduction but RFC2582 prevented this action.
5353f8829a4aSRandall Stewart 			 */
5354f8829a4aSRandall Stewart 			SCTP_STAT_INCR(sctps_fastretransinrtt);
5355f8829a4aSRandall Stewart 		}
5356f8829a4aSRandall Stewart 	}
5357f8829a4aSRandall Stewart 
5358f8829a4aSRandall Stewart 
5359f8829a4aSRandall Stewart 	/******************************************************************
5360f8829a4aSRandall Stewart 	 *  Here we do the stuff with ECN Nonce checking.
5361f8829a4aSRandall Stewart 	 *  We basically check to see if the nonce sum flag was incorrect
5362f8829a4aSRandall Stewart 	 *  or if resynchronization needs to be done. Also if we catch a
5363f8829a4aSRandall Stewart 	 *  misbehaving receiver we give him the kick.
5364f8829a4aSRandall Stewart 	 ******************************************************************/
5365f8829a4aSRandall Stewart 
5366f8829a4aSRandall Stewart 	if (asoc->ecn_nonce_allowed) {
5367f8829a4aSRandall Stewart 		if (asoc->nonce_sum_check) {
5368f8829a4aSRandall Stewart 			if (nonce_sum_flag != ((asoc->nonce_sum_expect_base + ecn_seg_sums) & SCTP_SACK_NONCE_SUM)) {
5369f8829a4aSRandall Stewart 				if (asoc->nonce_wait_for_ecne == 0) {
5370f8829a4aSRandall Stewart 					struct sctp_tmit_chunk *lchk;
5371f8829a4aSRandall Stewart 
5372f8829a4aSRandall Stewart 					lchk = TAILQ_FIRST(&asoc->send_queue);
5373f8829a4aSRandall Stewart 					asoc->nonce_wait_for_ecne = 1;
5374f8829a4aSRandall Stewart 					if (lchk) {
5375f8829a4aSRandall Stewart 						asoc->nonce_wait_tsn = lchk->rec.data.TSN_seq;
5376f8829a4aSRandall Stewart 					} else {
5377f8829a4aSRandall Stewart 						asoc->nonce_wait_tsn = asoc->sending_seq;
5378f8829a4aSRandall Stewart 					}
5379f8829a4aSRandall Stewart 				} else {
5380f8829a4aSRandall Stewart 					if (compare_with_wrap(asoc->last_acked_seq, asoc->nonce_wait_tsn, MAX_TSN) ||
5381f8829a4aSRandall Stewart 					    (asoc->last_acked_seq == asoc->nonce_wait_tsn)) {
5382f8829a4aSRandall Stewart 						/*
5383f8829a4aSRandall Stewart 						 * Misbehaving peer. We need
5384f8829a4aSRandall Stewart 						 * to react to this guy
5385f8829a4aSRandall Stewart 						 */
5386f8829a4aSRandall Stewart 						asoc->ecn_allowed = 0;
5387f8829a4aSRandall Stewart 						asoc->ecn_nonce_allowed = 0;
5388f8829a4aSRandall Stewart 					}
5389f8829a4aSRandall Stewart 				}
5390f8829a4aSRandall Stewart 			}
5391f8829a4aSRandall Stewart 		} else {
5392f8829a4aSRandall Stewart 			/* See if Resynchronization Possible */
5393f8829a4aSRandall Stewart 			if (compare_with_wrap(asoc->last_acked_seq, asoc->nonce_resync_tsn, MAX_TSN)) {
5394f8829a4aSRandall Stewart 				asoc->nonce_sum_check = 1;
5395f8829a4aSRandall Stewart 				/*
5396f8829a4aSRandall Stewart 				 * now we must calculate what the base is.
5397f8829a4aSRandall Stewart 				 * We do this based on two things, we know
5398f8829a4aSRandall Stewart 				 * the total's for all the segments
5399f8829a4aSRandall Stewart 				 * gap-acked in the SACK, its stored in
5400f8829a4aSRandall Stewart 				 * ecn_seg_sums. We also know the SACK's
5401f8829a4aSRandall Stewart 				 * nonce sum, its in nonce_sum_flag. So we
5402f8829a4aSRandall Stewart 				 * can build a truth table to back-calculate
5403f8829a4aSRandall Stewart 				 * the new value of
5404f8829a4aSRandall Stewart 				 * asoc->nonce_sum_expect_base:
5405f8829a4aSRandall Stewart 				 *
5406f8829a4aSRandall Stewart 				 * SACK-flag-Value         Seg-Sums Base 0 0 0
5407f8829a4aSRandall Stewart 				 * 1                    0 1 0 1 1 1
5408f8829a4aSRandall Stewart 				 * 1 0
5409f8829a4aSRandall Stewart 				 */
5410f8829a4aSRandall Stewart 				asoc->nonce_sum_expect_base = (ecn_seg_sums ^ nonce_sum_flag) & SCTP_SACK_NONCE_SUM;
5411f8829a4aSRandall Stewart 			}
5412f8829a4aSRandall Stewart 		}
5413f8829a4aSRandall Stewart 	}
5414f8829a4aSRandall Stewart 	/* Now are we exiting loss recovery ? */
5415f8829a4aSRandall Stewart 	if (will_exit_fast_recovery) {
5416f8829a4aSRandall Stewart 		/* Ok, we must exit fast recovery */
5417f8829a4aSRandall Stewart 		asoc->fast_retran_loss_recovery = 0;
5418f8829a4aSRandall Stewart 	}
5419f8829a4aSRandall Stewart 	if ((asoc->sat_t3_loss_recovery) &&
5420f8829a4aSRandall Stewart 	    ((compare_with_wrap(asoc->last_acked_seq, asoc->sat_t3_recovery_tsn,
5421f8829a4aSRandall Stewart 	    MAX_TSN) ||
5422f8829a4aSRandall Stewart 	    (asoc->last_acked_seq == asoc->sat_t3_recovery_tsn)))) {
5423f8829a4aSRandall Stewart 		/* end satellite t3 loss recovery */
5424f8829a4aSRandall Stewart 		asoc->sat_t3_loss_recovery = 0;
5425f8829a4aSRandall Stewart 	}
542642551e99SRandall Stewart 	/*
542742551e99SRandall Stewart 	 * CMT Fast recovery
542842551e99SRandall Stewart 	 */
5429f8829a4aSRandall Stewart 	TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
5430f8829a4aSRandall Stewart 		if (net->will_exit_fast_recovery) {
5431f8829a4aSRandall Stewart 			/* Ok, we must exit fast recovery */
5432f8829a4aSRandall Stewart 			net->fast_retran_loss_recovery = 0;
5433f8829a4aSRandall Stewart 		}
5434f8829a4aSRandall Stewart 	}
5435f8829a4aSRandall Stewart 
5436f8829a4aSRandall Stewart 	/* Adjust and set the new rwnd value */
5437f8829a4aSRandall Stewart #ifdef SCTP_LOG_RWND
5438f8829a4aSRandall Stewart 	sctp_log_rwnd_set(SCTP_SET_PEER_RWND_VIA_SACK,
5439f8829a4aSRandall Stewart 	    asoc->peers_rwnd, asoc->total_flight, (asoc->sent_queue_cnt * sctp_peer_chunk_oh), a_rwnd);
5440f8829a4aSRandall Stewart #endif
5441f8829a4aSRandall Stewart 
5442f8829a4aSRandall Stewart 	asoc->peers_rwnd = sctp_sbspace_sub(a_rwnd,
5443f8829a4aSRandall Stewart 	    (uint32_t) (asoc->total_flight + (asoc->sent_queue_cnt * sctp_peer_chunk_oh)));
5444f8829a4aSRandall Stewart 	if (asoc->peers_rwnd < stcb->sctp_ep->sctp_ep.sctp_sws_sender) {
5445f8829a4aSRandall Stewart 		/* SWS sender side engages */
5446f8829a4aSRandall Stewart 		asoc->peers_rwnd = 0;
5447f8829a4aSRandall Stewart 	}
54485e54f665SRandall Stewart 	if (asoc->peers_rwnd > old_rwnd) {
54495e54f665SRandall Stewart 		win_probe_recovery = 1;
54505e54f665SRandall Stewart 	}
5451f8829a4aSRandall Stewart 	/*
5452f8829a4aSRandall Stewart 	 * Now we must setup so we have a timer up for anyone with
5453f8829a4aSRandall Stewart 	 * outstanding data.
5454f8829a4aSRandall Stewart 	 */
5455bff64a4dSRandall Stewart 	done_once = 0;
5456a5d547adSRandall Stewart again:
5457a5d547adSRandall Stewart 	j = 0;
5458f8829a4aSRandall Stewart 	TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
54595e54f665SRandall Stewart 		if (win_probe_recovery && (net->window_probe)) {
54605e54f665SRandall Stewart 			net->window_probe = 0;
5461c105859eSRandall Stewart 			win_probe_recovered = 1;
54625e54f665SRandall Stewart 			/*-
54635e54f665SRandall Stewart 			 * Find first chunk that was used with
54645e54f665SRandall Stewart 			 * window probe and clear the event. Put
54655e54f665SRandall Stewart 			 * it back into the send queue as if has
54665e54f665SRandall Stewart 			 * not been sent.
54675e54f665SRandall Stewart 			 */
54685e54f665SRandall Stewart 			TAILQ_FOREACH(tp1, &asoc->sent_queue, sctp_next) {
54695e54f665SRandall Stewart 				if (tp1->window_probe) {
5470c105859eSRandall Stewart 					sctp_window_probe_recovery(stcb, asoc, net, tp1);
54715e54f665SRandall Stewart 					break;
54725e54f665SRandall Stewart 				}
54735e54f665SRandall Stewart 			}
54745e54f665SRandall Stewart 		}
5475f8829a4aSRandall Stewart 		if (net->flight_size) {
5476a5d547adSRandall Stewart 			j++;
5477f8829a4aSRandall Stewart 			sctp_timer_start(SCTP_TIMER_TYPE_SEND,
5478f8829a4aSRandall Stewart 			    stcb->sctp_ep, stcb, net);
5479c105859eSRandall Stewart 		} else {
5480c105859eSRandall Stewart 			if (SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer)) {
5481c105859eSRandall Stewart 				sctp_timer_stop(SCTP_TIMER_TYPE_SEND, stcb->sctp_ep,
5482c105859eSRandall Stewart 				    stcb, net,
5483c105859eSRandall Stewart 				    SCTP_FROM_SCTP_INDATA + SCTP_LOC_22);
5484c105859eSRandall Stewart 			}
5485c105859eSRandall Stewart 			if (sctp_early_fr) {
5486c105859eSRandall Stewart 				if (SCTP_OS_TIMER_PENDING(&net->fr_timer.timer)) {
5487c105859eSRandall Stewart 					SCTP_STAT_INCR(sctps_earlyfrstpidsck4);
5488c105859eSRandall Stewart 					sctp_timer_stop(SCTP_TIMER_TYPE_EARLYFR, stcb->sctp_ep, stcb, net,
5489c105859eSRandall Stewart 					    SCTP_FROM_SCTP_INDATA + SCTP_LOC_23);
5490c105859eSRandall Stewart 				}
5491c105859eSRandall Stewart 			}
5492f8829a4aSRandall Stewart 		}
5493f8829a4aSRandall Stewart 	}
5494bff64a4dSRandall Stewart 	if ((j == 0) &&
5495bff64a4dSRandall Stewart 	    (!TAILQ_EMPTY(&asoc->sent_queue)) &&
5496bff64a4dSRandall Stewart 	    (asoc->sent_queue_retran_cnt == 0) &&
5497c105859eSRandall Stewart 	    (win_probe_recovered == 0) &&
5498bff64a4dSRandall Stewart 	    (done_once == 0)) {
5499a5d547adSRandall Stewart 		/* huh, this should not happen */
5500c105859eSRandall Stewart 		sctp_fs_audit(asoc);
5501a5d547adSRandall Stewart 		TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
5502a5d547adSRandall Stewart 			net->flight_size = 0;
5503a5d547adSRandall Stewart 		}
5504a5d547adSRandall Stewart 		asoc->total_flight = 0;
5505a5d547adSRandall Stewart 		asoc->total_flight_count = 0;
5506a5d547adSRandall Stewart 		asoc->sent_queue_retran_cnt = 0;
5507a5d547adSRandall Stewart 		TAILQ_FOREACH(tp1, &asoc->sent_queue, sctp_next) {
5508a5d547adSRandall Stewart 			if (tp1->sent < SCTP_DATAGRAM_RESEND) {
5509c105859eSRandall Stewart 				sctp_flight_size_increase(tp1);
5510c105859eSRandall Stewart 				sctp_total_flight_increase(stcb, tp1);
5511a5d547adSRandall Stewart 			} else if (tp1->sent == SCTP_DATAGRAM_RESEND) {
5512a5d547adSRandall Stewart 				asoc->sent_queue_retran_cnt++;
5513a5d547adSRandall Stewart 			}
5514a5d547adSRandall Stewart 		}
5515bff64a4dSRandall Stewart 		done_once = 1;
5516a5d547adSRandall Stewart 		goto again;
5517a5d547adSRandall Stewart 	}
5518f8829a4aSRandall Stewart #ifdef SCTP_SACK_RWND_LOGGING
5519f8829a4aSRandall Stewart 	sctp_misc_ints(SCTP_SACK_RWND_UPDATE,
5520f8829a4aSRandall Stewart 	    a_rwnd,
5521f8829a4aSRandall Stewart 	    stcb->asoc.peers_rwnd,
5522f8829a4aSRandall Stewart 	    stcb->asoc.total_flight,
5523f8829a4aSRandall Stewart 	    stcb->asoc.total_output_queue_size);
5524f8829a4aSRandall Stewart 
5525f8829a4aSRandall Stewart #endif
5526f8829a4aSRandall Stewart 
5527f8829a4aSRandall Stewart }
5528f8829a4aSRandall Stewart 
5529f8829a4aSRandall Stewart void
5530f8829a4aSRandall Stewart sctp_update_acked(struct sctp_tcb *stcb, struct sctp_shutdown_chunk *cp,
5531f8829a4aSRandall Stewart     struct sctp_nets *netp, int *abort_flag)
5532f8829a4aSRandall Stewart {
5533f8829a4aSRandall Stewart 	/* Copy cum-ack */
5534f8829a4aSRandall Stewart 	uint32_t cum_ack, a_rwnd;
5535f8829a4aSRandall Stewart 
5536f8829a4aSRandall Stewart 	cum_ack = ntohl(cp->cumulative_tsn_ack);
5537f8829a4aSRandall Stewart 	/* Arrange so a_rwnd does NOT change */
5538f8829a4aSRandall Stewart 	a_rwnd = stcb->asoc.peers_rwnd + stcb->asoc.total_flight;
5539f8829a4aSRandall Stewart 
5540f8829a4aSRandall Stewart 	/* Now call the express sack handling */
5541f8829a4aSRandall Stewart 	sctp_express_handle_sack(stcb, cum_ack, a_rwnd, 0, abort_flag);
5542f8829a4aSRandall Stewart }
5543f8829a4aSRandall Stewart 
5544f8829a4aSRandall Stewart static void
5545f8829a4aSRandall Stewart sctp_kick_prsctp_reorder_queue(struct sctp_tcb *stcb,
5546f8829a4aSRandall Stewart     struct sctp_stream_in *strmin)
5547f8829a4aSRandall Stewart {
5548f8829a4aSRandall Stewart 	struct sctp_queued_to_read *ctl, *nctl;
5549f8829a4aSRandall Stewart 	struct sctp_association *asoc;
5550f8829a4aSRandall Stewart 	int tt;
5551f8829a4aSRandall Stewart 
5552f8829a4aSRandall Stewart 	asoc = &stcb->asoc;
5553f8829a4aSRandall Stewart 	tt = strmin->last_sequence_delivered;
5554f8829a4aSRandall Stewart 	/*
5555f8829a4aSRandall Stewart 	 * First deliver anything prior to and including the stream no that
5556f8829a4aSRandall Stewart 	 * came in
5557f8829a4aSRandall Stewart 	 */
5558f8829a4aSRandall Stewart 	ctl = TAILQ_FIRST(&strmin->inqueue);
5559f8829a4aSRandall Stewart 	while (ctl) {
5560f8829a4aSRandall Stewart 		nctl = TAILQ_NEXT(ctl, next);
5561f8829a4aSRandall Stewart 		if (compare_with_wrap(tt, ctl->sinfo_ssn, MAX_SEQ) ||
5562f8829a4aSRandall Stewart 		    (tt == ctl->sinfo_ssn)) {
5563f8829a4aSRandall Stewart 			/* this is deliverable now */
5564f8829a4aSRandall Stewart 			TAILQ_REMOVE(&strmin->inqueue, ctl, next);
5565f8829a4aSRandall Stewart 			/* subtract pending on streams */
5566f8829a4aSRandall Stewart 			asoc->size_on_all_streams -= ctl->length;
5567f8829a4aSRandall Stewart 			sctp_ucount_decr(asoc->cnt_on_all_streams);
5568f8829a4aSRandall Stewart 			/* deliver it to at least the delivery-q */
5569f8829a4aSRandall Stewart 			if (stcb->sctp_socket) {
5570f8829a4aSRandall Stewart 				sctp_add_to_readq(stcb->sctp_ep, stcb,
5571f8829a4aSRandall Stewart 				    ctl,
5572f8829a4aSRandall Stewart 				    &stcb->sctp_socket->so_rcv, 1);
5573f8829a4aSRandall Stewart 			}
5574f8829a4aSRandall Stewart 		} else {
5575f8829a4aSRandall Stewart 			/* no more delivery now. */
5576f8829a4aSRandall Stewart 			break;
5577f8829a4aSRandall Stewart 		}
5578f8829a4aSRandall Stewart 		ctl = nctl;
5579f8829a4aSRandall Stewart 	}
5580f8829a4aSRandall Stewart 	/*
5581f8829a4aSRandall Stewart 	 * now we must deliver things in queue the normal way  if any are
5582f8829a4aSRandall Stewart 	 * now ready.
5583f8829a4aSRandall Stewart 	 */
5584f8829a4aSRandall Stewart 	tt = strmin->last_sequence_delivered + 1;
5585f8829a4aSRandall Stewart 	ctl = TAILQ_FIRST(&strmin->inqueue);
5586f8829a4aSRandall Stewart 	while (ctl) {
5587f8829a4aSRandall Stewart 		nctl = TAILQ_NEXT(ctl, next);
5588f8829a4aSRandall Stewart 		if (tt == ctl->sinfo_ssn) {
5589f8829a4aSRandall Stewart 			/* this is deliverable now */
5590f8829a4aSRandall Stewart 			TAILQ_REMOVE(&strmin->inqueue, ctl, next);
5591f8829a4aSRandall Stewart 			/* subtract pending on streams */
5592f8829a4aSRandall Stewart 			asoc->size_on_all_streams -= ctl->length;
5593f8829a4aSRandall Stewart 			sctp_ucount_decr(asoc->cnt_on_all_streams);
5594f8829a4aSRandall Stewart 			/* deliver it to at least the delivery-q */
5595f8829a4aSRandall Stewart 			strmin->last_sequence_delivered = ctl->sinfo_ssn;
5596f8829a4aSRandall Stewart 			if (stcb->sctp_socket) {
5597f8829a4aSRandall Stewart 				sctp_add_to_readq(stcb->sctp_ep, stcb,
5598f8829a4aSRandall Stewart 				    ctl,
5599f8829a4aSRandall Stewart 				    &stcb->sctp_socket->so_rcv, 1);
5600f8829a4aSRandall Stewart 			}
5601f8829a4aSRandall Stewart 			tt = strmin->last_sequence_delivered + 1;
5602f8829a4aSRandall Stewart 		} else {
5603f8829a4aSRandall Stewart 			break;
5604f8829a4aSRandall Stewart 		}
5605f8829a4aSRandall Stewart 		ctl = nctl;
5606f8829a4aSRandall Stewart 	}
5607f8829a4aSRandall Stewart }
5608f8829a4aSRandall Stewart 
5609f8829a4aSRandall Stewart void
5610f8829a4aSRandall Stewart sctp_handle_forward_tsn(struct sctp_tcb *stcb,
5611f8829a4aSRandall Stewart     struct sctp_forward_tsn_chunk *fwd, int *abort_flag)
5612f8829a4aSRandall Stewart {
5613f8829a4aSRandall Stewart 	/*
5614f8829a4aSRandall Stewart 	 * ISSUES that MUST be fixed for ECN! When we are the sender of the
5615f8829a4aSRandall Stewart 	 * forward TSN, when the SACK comes back that acknowledges the
5616f8829a4aSRandall Stewart 	 * FWD-TSN we must reset the NONCE sum to match correctly. This will
5617f8829a4aSRandall Stewart 	 * get quite tricky since we may have sent more data interveneing
5618f8829a4aSRandall Stewart 	 * and must carefully account for what the SACK says on the nonce
5619f8829a4aSRandall Stewart 	 * and any gaps that are reported. This work will NOT be done here,
5620f8829a4aSRandall Stewart 	 * but I note it here since it is really related to PR-SCTP and
5621f8829a4aSRandall Stewart 	 * FWD-TSN's
5622f8829a4aSRandall Stewart 	 */
5623f8829a4aSRandall Stewart 
5624f8829a4aSRandall Stewart 	/* The pr-sctp fwd tsn */
5625f8829a4aSRandall Stewart 	/*
5626f8829a4aSRandall Stewart 	 * here we will perform all the data receiver side steps for
5627f8829a4aSRandall Stewart 	 * processing FwdTSN, as required in by pr-sctp draft:
5628f8829a4aSRandall Stewart 	 *
5629f8829a4aSRandall Stewart 	 * Assume we get FwdTSN(x):
5630f8829a4aSRandall Stewart 	 *
5631f8829a4aSRandall Stewart 	 * 1) update local cumTSN to x 2) try to further advance cumTSN to x +
5632f8829a4aSRandall Stewart 	 * others we have 3) examine and update re-ordering queue on
5633f8829a4aSRandall Stewart 	 * pr-in-streams 4) clean up re-assembly queue 5) Send a sack to
5634f8829a4aSRandall Stewart 	 * report where we are.
5635f8829a4aSRandall Stewart 	 */
5636f8829a4aSRandall Stewart 	struct sctp_strseq *stseq;
5637f8829a4aSRandall Stewart 	struct sctp_association *asoc;
5638f8829a4aSRandall Stewart 	uint32_t new_cum_tsn, gap, back_out_htsn;
5639f8829a4aSRandall Stewart 	unsigned int i, cnt_gone, fwd_sz, cumack_set_flag, m_size;
5640f8829a4aSRandall Stewart 	struct sctp_stream_in *strm;
5641f8829a4aSRandall Stewart 	struct sctp_tmit_chunk *chk, *at;
5642f8829a4aSRandall Stewart 
5643f8829a4aSRandall Stewart 	cumack_set_flag = 0;
5644f8829a4aSRandall Stewart 	asoc = &stcb->asoc;
5645f8829a4aSRandall Stewart 	cnt_gone = 0;
5646f8829a4aSRandall Stewart 	if ((fwd_sz = ntohs(fwd->ch.chunk_length)) < sizeof(struct sctp_forward_tsn_chunk)) {
5647f8829a4aSRandall Stewart #ifdef SCTP_DEBUG
5648f8829a4aSRandall Stewart 		if (sctp_debug_on & SCTP_DEBUG_INDATA1) {
5649f8829a4aSRandall Stewart 			printf("Bad size too small/big fwd-tsn\n");
5650f8829a4aSRandall Stewart 		}
5651f8829a4aSRandall Stewart #endif
5652f8829a4aSRandall Stewart 		return;
5653f8829a4aSRandall Stewart 	}
5654f8829a4aSRandall Stewart 	m_size = (stcb->asoc.mapping_array_size << 3);
5655f8829a4aSRandall Stewart 	/*************************************************************/
5656f8829a4aSRandall Stewart 	/* 1. Here we update local cumTSN and shift the bitmap array */
5657f8829a4aSRandall Stewart 	/*************************************************************/
5658f8829a4aSRandall Stewart 	new_cum_tsn = ntohl(fwd->new_cumulative_tsn);
5659f8829a4aSRandall Stewart 
5660f8829a4aSRandall Stewart 	if (compare_with_wrap(asoc->cumulative_tsn, new_cum_tsn, MAX_TSN) ||
5661f8829a4aSRandall Stewart 	    asoc->cumulative_tsn == new_cum_tsn) {
5662f8829a4aSRandall Stewart 		/* Already got there ... */
5663f8829a4aSRandall Stewart 		return;
5664f8829a4aSRandall Stewart 	}
5665f8829a4aSRandall Stewart 	back_out_htsn = asoc->highest_tsn_inside_map;
5666f8829a4aSRandall Stewart 	if (compare_with_wrap(new_cum_tsn, asoc->highest_tsn_inside_map,
5667f8829a4aSRandall Stewart 	    MAX_TSN)) {
5668f8829a4aSRandall Stewart 		asoc->highest_tsn_inside_map = new_cum_tsn;
5669f8829a4aSRandall Stewart #ifdef SCTP_MAP_LOGGING
5670f8829a4aSRandall Stewart 		sctp_log_map(0, 0, asoc->highest_tsn_inside_map, SCTP_MAP_SLIDE_RESULT);
5671f8829a4aSRandall Stewart #endif
5672f8829a4aSRandall Stewart 	}
5673f8829a4aSRandall Stewart 	/*
5674f8829a4aSRandall Stewart 	 * now we know the new TSN is more advanced, let's find the actual
5675f8829a4aSRandall Stewart 	 * gap
5676f8829a4aSRandall Stewart 	 */
5677f8829a4aSRandall Stewart 	if ((compare_with_wrap(new_cum_tsn, asoc->mapping_array_base_tsn,
5678f8829a4aSRandall Stewart 	    MAX_TSN)) ||
5679f8829a4aSRandall Stewart 	    (new_cum_tsn == asoc->mapping_array_base_tsn)) {
5680f8829a4aSRandall Stewart 		gap = new_cum_tsn - asoc->mapping_array_base_tsn;
5681f8829a4aSRandall Stewart 	} else {
5682f8829a4aSRandall Stewart 		/* try to prevent underflow here */
5683f8829a4aSRandall Stewart 		gap = new_cum_tsn + (MAX_TSN - asoc->mapping_array_base_tsn) + 1;
5684f8829a4aSRandall Stewart 	}
5685f8829a4aSRandall Stewart 
5686f8829a4aSRandall Stewart 	if (gap > m_size || gap < 0) {
5687f8829a4aSRandall Stewart 		asoc->highest_tsn_inside_map = back_out_htsn;
5688f8829a4aSRandall Stewart 		if ((long)gap > sctp_sbspace(&stcb->asoc, &stcb->sctp_socket->so_rcv)) {
5689f8829a4aSRandall Stewart 			/*
5690f8829a4aSRandall Stewart 			 * out of range (of single byte chunks in the rwnd I
5691f8829a4aSRandall Stewart 			 * give out) too questionable. better to drop it
5692f8829a4aSRandall Stewart 			 * silently
5693f8829a4aSRandall Stewart 			 */
5694f8829a4aSRandall Stewart 			return;
5695f8829a4aSRandall Stewart 		}
5696f8829a4aSRandall Stewart 		if (asoc->highest_tsn_inside_map >
5697f8829a4aSRandall Stewart 		    asoc->mapping_array_base_tsn) {
5698f8829a4aSRandall Stewart 			gap = asoc->highest_tsn_inside_map -
5699f8829a4aSRandall Stewart 			    asoc->mapping_array_base_tsn;
5700f8829a4aSRandall Stewart 		} else {
5701f8829a4aSRandall Stewart 			gap = asoc->highest_tsn_inside_map +
5702f8829a4aSRandall Stewart 			    (MAX_TSN - asoc->mapping_array_base_tsn) + 1;
5703f8829a4aSRandall Stewart 		}
5704f8829a4aSRandall Stewart 		cumack_set_flag = 1;
5705f8829a4aSRandall Stewart 	}
5706f8829a4aSRandall Stewart 	for (i = 0; i <= gap; i++) {
5707f8829a4aSRandall Stewart 		SCTP_SET_TSN_PRESENT(asoc->mapping_array, i);
5708f8829a4aSRandall Stewart 	}
5709f8829a4aSRandall Stewart 	/*
5710f8829a4aSRandall Stewart 	 * Now after marking all, slide thing forward but no sack please.
5711f8829a4aSRandall Stewart 	 */
5712f8829a4aSRandall Stewart 	sctp_sack_check(stcb, 0, 0, abort_flag);
5713f8829a4aSRandall Stewart 	if (*abort_flag)
5714f8829a4aSRandall Stewart 		return;
5715f8829a4aSRandall Stewart 
5716f8829a4aSRandall Stewart 	if (cumack_set_flag) {
5717f8829a4aSRandall Stewart 		/*
5718f8829a4aSRandall Stewart 		 * fwd-tsn went outside my gap array - not a common
5719f8829a4aSRandall Stewart 		 * occurance. Do the same thing we do when a cookie-echo
5720f8829a4aSRandall Stewart 		 * arrives.
5721f8829a4aSRandall Stewart 		 */
5722f8829a4aSRandall Stewart 		asoc->highest_tsn_inside_map = new_cum_tsn - 1;
5723f8829a4aSRandall Stewart 		asoc->mapping_array_base_tsn = new_cum_tsn;
5724f8829a4aSRandall Stewart 		asoc->cumulative_tsn = asoc->highest_tsn_inside_map;
5725f8829a4aSRandall Stewart #ifdef SCTP_MAP_LOGGING
5726f8829a4aSRandall Stewart 		sctp_log_map(0, 3, asoc->highest_tsn_inside_map, SCTP_MAP_SLIDE_RESULT);
5727f8829a4aSRandall Stewart #endif
5728f8829a4aSRandall Stewart 		asoc->last_echo_tsn = asoc->highest_tsn_inside_map;
5729f8829a4aSRandall Stewart 	}
5730f8829a4aSRandall Stewart 	/*************************************************************/
5731f8829a4aSRandall Stewart 	/* 2. Clear up re-assembly queue                             */
5732f8829a4aSRandall Stewart 	/*************************************************************/
5733f8829a4aSRandall Stewart 
5734f8829a4aSRandall Stewart 	/*
5735f8829a4aSRandall Stewart 	 * First service it if pd-api is up, just in case we can progress it
5736f8829a4aSRandall Stewart 	 * forward
5737f8829a4aSRandall Stewart 	 */
5738f8829a4aSRandall Stewart 	if (asoc->fragmented_delivery_inprogress) {
5739f8829a4aSRandall Stewart 		sctp_service_reassembly(stcb, asoc);
5740f8829a4aSRandall Stewart 	}
5741f8829a4aSRandall Stewart 	if (!TAILQ_EMPTY(&asoc->reasmqueue)) {
5742f8829a4aSRandall Stewart 		/* For each one on here see if we need to toss it */
5743f8829a4aSRandall Stewart 		/*
5744f8829a4aSRandall Stewart 		 * For now large messages held on the reasmqueue that are
5745f8829a4aSRandall Stewart 		 * complete will be tossed too. We could in theory do more
5746f8829a4aSRandall Stewart 		 * work to spin through and stop after dumping one msg aka
5747f8829a4aSRandall Stewart 		 * seeing the start of a new msg at the head, and call the
5748f8829a4aSRandall Stewart 		 * delivery function... to see if it can be delivered... But
5749f8829a4aSRandall Stewart 		 * for now we just dump everything on the queue.
5750f8829a4aSRandall Stewart 		 */
5751f8829a4aSRandall Stewart 		chk = TAILQ_FIRST(&asoc->reasmqueue);
5752f8829a4aSRandall Stewart 		while (chk) {
5753f8829a4aSRandall Stewart 			at = TAILQ_NEXT(chk, sctp_next);
5754f8829a4aSRandall Stewart 			if (compare_with_wrap(asoc->cumulative_tsn,
5755f8829a4aSRandall Stewart 			    chk->rec.data.TSN_seq, MAX_TSN) ||
5756f8829a4aSRandall Stewart 			    asoc->cumulative_tsn == chk->rec.data.TSN_seq) {
5757f8829a4aSRandall Stewart 				/* It needs to be tossed */
5758f8829a4aSRandall Stewart 				TAILQ_REMOVE(&asoc->reasmqueue, chk, sctp_next);
5759f8829a4aSRandall Stewart 				if (compare_with_wrap(chk->rec.data.TSN_seq,
5760f8829a4aSRandall Stewart 				    asoc->tsn_last_delivered, MAX_TSN)) {
5761f8829a4aSRandall Stewart 					asoc->tsn_last_delivered =
5762f8829a4aSRandall Stewart 					    chk->rec.data.TSN_seq;
5763f8829a4aSRandall Stewart 					asoc->str_of_pdapi =
5764f8829a4aSRandall Stewart 					    chk->rec.data.stream_number;
5765f8829a4aSRandall Stewart 					asoc->ssn_of_pdapi =
5766f8829a4aSRandall Stewart 					    chk->rec.data.stream_seq;
5767f8829a4aSRandall Stewart 					asoc->fragment_flags =
5768f8829a4aSRandall Stewart 					    chk->rec.data.rcv_flags;
5769f8829a4aSRandall Stewart 				}
5770f8829a4aSRandall Stewart 				asoc->size_on_reasm_queue -= chk->send_size;
5771f8829a4aSRandall Stewart 				sctp_ucount_decr(asoc->cnt_on_reasm_queue);
5772f8829a4aSRandall Stewart 				cnt_gone++;
5773f8829a4aSRandall Stewart 
5774f8829a4aSRandall Stewart 				/* Clear up any stream problem */
5775f8829a4aSRandall Stewart 				if ((chk->rec.data.rcv_flags & SCTP_DATA_UNORDERED) !=
5776f8829a4aSRandall Stewart 				    SCTP_DATA_UNORDERED &&
5777f8829a4aSRandall Stewart 				    (compare_with_wrap(chk->rec.data.stream_seq,
5778f8829a4aSRandall Stewart 				    asoc->strmin[chk->rec.data.stream_number].last_sequence_delivered,
5779f8829a4aSRandall Stewart 				    MAX_SEQ))) {
5780f8829a4aSRandall Stewart 					/*
5781f8829a4aSRandall Stewart 					 * We must dump forward this streams
5782f8829a4aSRandall Stewart 					 * sequence number if the chunk is
5783f8829a4aSRandall Stewart 					 * not unordered that is being
5784f8829a4aSRandall Stewart 					 * skipped. There is a chance that
5785f8829a4aSRandall Stewart 					 * if the peer does not include the
5786f8829a4aSRandall Stewart 					 * last fragment in its FWD-TSN we
5787f8829a4aSRandall Stewart 					 * WILL have a problem here since
5788f8829a4aSRandall Stewart 					 * you would have a partial chunk in
5789f8829a4aSRandall Stewart 					 * queue that may not be
5790f8829a4aSRandall Stewart 					 * deliverable. Also if a Partial
5791f8829a4aSRandall Stewart 					 * delivery API as started the user
5792f8829a4aSRandall Stewart 					 * may get a partial chunk. The next
5793f8829a4aSRandall Stewart 					 * read returning a new chunk...
5794f8829a4aSRandall Stewart 					 * really ugly but I see no way
5795f8829a4aSRandall Stewart 					 * around it! Maybe a notify??
5796f8829a4aSRandall Stewart 					 */
5797f8829a4aSRandall Stewart 					asoc->strmin[chk->rec.data.stream_number].last_sequence_delivered =
5798f8829a4aSRandall Stewart 					    chk->rec.data.stream_seq;
5799f8829a4aSRandall Stewart 				}
5800f8829a4aSRandall Stewart 				if (chk->data) {
5801f8829a4aSRandall Stewart 					sctp_m_freem(chk->data);
5802f8829a4aSRandall Stewart 					chk->data = NULL;
5803f8829a4aSRandall Stewart 				}
5804f8829a4aSRandall Stewart 				sctp_free_remote_addr(chk->whoTo);
5805f8829a4aSRandall Stewart 				sctp_free_a_chunk(stcb, chk);
5806f8829a4aSRandall Stewart 			} else {
5807f8829a4aSRandall Stewart 				/*
5808f8829a4aSRandall Stewart 				 * Ok we have gone beyond the end of the
5809f8829a4aSRandall Stewart 				 * fwd-tsn's mark. Some checks...
5810f8829a4aSRandall Stewart 				 */
5811f8829a4aSRandall Stewart 				if ((asoc->fragmented_delivery_inprogress) &&
5812f8829a4aSRandall Stewart 				    (chk->rec.data.rcv_flags & SCTP_DATA_FIRST_FRAG)) {
5813f8829a4aSRandall Stewart 					/*
5814f8829a4aSRandall Stewart 					 * Special case PD-API is up and
5815f8829a4aSRandall Stewart 					 * what we fwd-tsn' over includes
5816f8829a4aSRandall Stewart 					 * one that had the LAST_FRAG. We no
5817f8829a4aSRandall Stewart 					 * longer need to do the PD-API.
5818f8829a4aSRandall Stewart 					 */
5819f8829a4aSRandall Stewart 					asoc->fragmented_delivery_inprogress = 0;
5820f8829a4aSRandall Stewart 					sctp_ulp_notify(SCTP_NOTIFY_PARTIAL_DELVIERY_INDICATION,
5821f8829a4aSRandall Stewart 					    stcb, SCTP_PARTIAL_DELIVERY_ABORTED, (void *)NULL);
5822f8829a4aSRandall Stewart 
5823f8829a4aSRandall Stewart 				}
5824f8829a4aSRandall Stewart 				break;
5825f8829a4aSRandall Stewart 			}
5826f8829a4aSRandall Stewart 			chk = at;
5827f8829a4aSRandall Stewart 		}
5828f8829a4aSRandall Stewart 	}
5829f8829a4aSRandall Stewart 	if (asoc->fragmented_delivery_inprogress) {
5830f8829a4aSRandall Stewart 		/*
5831f8829a4aSRandall Stewart 		 * Ok we removed cnt_gone chunks in the PD-API queue that
5832f8829a4aSRandall Stewart 		 * were being delivered. So now we must turn off the flag.
5833f8829a4aSRandall Stewart 		 */
5834f8829a4aSRandall Stewart 		sctp_ulp_notify(SCTP_NOTIFY_PARTIAL_DELVIERY_INDICATION,
5835f8829a4aSRandall Stewart 		    stcb, SCTP_PARTIAL_DELIVERY_ABORTED, (void *)NULL);
5836f8829a4aSRandall Stewart 		asoc->fragmented_delivery_inprogress = 0;
5837f8829a4aSRandall Stewart 	}
5838f8829a4aSRandall Stewart 	/*************************************************************/
5839f8829a4aSRandall Stewart 	/* 3. Update the PR-stream re-ordering queues                */
5840f8829a4aSRandall Stewart 	/*************************************************************/
5841f8829a4aSRandall Stewart 	stseq = (struct sctp_strseq *)((caddr_t)fwd + sizeof(*fwd));
5842f8829a4aSRandall Stewart 	fwd_sz -= sizeof(*fwd);
5843f8829a4aSRandall Stewart 	{
5844f8829a4aSRandall Stewart 		/* New method. */
5845f8829a4aSRandall Stewart 		int num_str, i;
5846f8829a4aSRandall Stewart 
5847f8829a4aSRandall Stewart 		num_str = fwd_sz / sizeof(struct sctp_strseq);
5848f8829a4aSRandall Stewart 		for (i = 0; i < num_str; i++) {
5849f8829a4aSRandall Stewart 			uint16_t st;
5850f8829a4aSRandall Stewart 			unsigned char *xx;
5851f8829a4aSRandall Stewart 
5852f8829a4aSRandall Stewart 			/* Convert */
5853f8829a4aSRandall Stewart 			xx = (unsigned char *)&stseq[i];
5854f8829a4aSRandall Stewart 			st = ntohs(stseq[i].stream);
5855f8829a4aSRandall Stewart 			stseq[i].stream = st;
5856f8829a4aSRandall Stewart 			st = ntohs(stseq[i].sequence);
5857f8829a4aSRandall Stewart 			stseq[i].sequence = st;
5858f8829a4aSRandall Stewart 			/* now process */
5859f8829a4aSRandall Stewart 			if (stseq[i].stream > asoc->streamincnt) {
5860f8829a4aSRandall Stewart 				/*
5861f8829a4aSRandall Stewart 				 * It is arguable if we should continue.
5862f8829a4aSRandall Stewart 				 * Since the peer sent bogus stream info we
5863f8829a4aSRandall Stewart 				 * may be in deep trouble.. a return may be
5864f8829a4aSRandall Stewart 				 * a better choice?
5865f8829a4aSRandall Stewart 				 */
5866f8829a4aSRandall Stewart 				continue;
5867f8829a4aSRandall Stewart 			}
5868f8829a4aSRandall Stewart 			strm = &asoc->strmin[stseq[i].stream];
5869f8829a4aSRandall Stewart 			if (compare_with_wrap(stseq[i].sequence,
5870f8829a4aSRandall Stewart 			    strm->last_sequence_delivered, MAX_SEQ)) {
5871f8829a4aSRandall Stewart 				/* Update the sequence number */
5872f8829a4aSRandall Stewart 				strm->last_sequence_delivered =
5873f8829a4aSRandall Stewart 				    stseq[i].sequence;
5874f8829a4aSRandall Stewart 			}
5875f8829a4aSRandall Stewart 			/* now kick the stream the new way */
5876f8829a4aSRandall Stewart 			sctp_kick_prsctp_reorder_queue(stcb, strm);
5877f8829a4aSRandall Stewart 		}
5878f8829a4aSRandall Stewart 	}
5879139bc87fSRandall Stewart 	if (TAILQ_FIRST(&asoc->reasmqueue)) {
5880139bc87fSRandall Stewart 		/* now lets kick out and check for more fragmented delivery */
5881139bc87fSRandall Stewart 		sctp_deliver_reasm_check(stcb, &stcb->asoc);
5882139bc87fSRandall Stewart 	}
5883f8829a4aSRandall Stewart }
5884