xref: /openbmc/linux/net/dccp/ccids/ccid2.c (revision 9ac8d3fb)
1 /*
2  *  net/dccp/ccids/ccid2.c
3  *
4  *  Copyright (c) 2005, 2006 Andrea Bittau <a.bittau@cs.ucl.ac.uk>
5  *
6  *  Changes to meet Linux coding standards, and DCCP infrastructure fixes.
7  *
8  *  Copyright (c) 2006 Arnaldo Carvalho de Melo <acme@conectiva.com.br>
9  *
10  *  This program is free software; you can redistribute it and/or modify
11  *  it under the terms of the GNU General Public License as published by
12  *  the Free Software Foundation; either version 2 of the License, or
13  *  (at your option) any later version.
14  *
15  *  This program is distributed in the hope that it will be useful,
16  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
17  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
18  *  GNU General Public License for more details.
19  *
20  *  You should have received a copy of the GNU General Public License
21  *  along with this program; if not, write to the Free Software
22  *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
23  */
24 
25 /*
26  * This implementation should follow RFC 4341
27  */
28 
29 #include "../ccid.h"
30 #include "../dccp.h"
31 #include "ccid2.h"
32 
33 
34 #ifdef CONFIG_IP_DCCP_CCID2_DEBUG
35 static int ccid2_debug;
36 #define ccid2_pr_debug(format, a...)	DCCP_PR_DEBUG(ccid2_debug, format, ##a)
37 
38 static void ccid2_hc_tx_check_sanity(const struct ccid2_hc_tx_sock *hctx)
39 {
40 	int len = 0;
41 	int pipe = 0;
42 	struct ccid2_seq *seqp = hctx->ccid2hctx_seqh;
43 
44 	/* there is data in the chain */
45 	if (seqp != hctx->ccid2hctx_seqt) {
46 		seqp = seqp->ccid2s_prev;
47 		len++;
48 		if (!seqp->ccid2s_acked)
49 			pipe++;
50 
51 		while (seqp != hctx->ccid2hctx_seqt) {
52 			struct ccid2_seq *prev = seqp->ccid2s_prev;
53 
54 			len++;
55 			if (!prev->ccid2s_acked)
56 				pipe++;
57 
58 			/* packets are sent sequentially */
59 			BUG_ON(dccp_delta_seqno(seqp->ccid2s_seq,
60 						prev->ccid2s_seq ) >= 0);
61 			BUG_ON(time_before(seqp->ccid2s_sent,
62 					   prev->ccid2s_sent));
63 
64 			seqp = prev;
65 		}
66 	}
67 
68 	BUG_ON(pipe != hctx->ccid2hctx_pipe);
69 	ccid2_pr_debug("len of chain=%d\n", len);
70 
71 	do {
72 		seqp = seqp->ccid2s_prev;
73 		len++;
74 	} while (seqp != hctx->ccid2hctx_seqh);
75 
76 	ccid2_pr_debug("total len=%d\n", len);
77 	BUG_ON(len != hctx->ccid2hctx_seqbufc * CCID2_SEQBUF_LEN);
78 }
79 #else
80 #define ccid2_pr_debug(format, a...)
81 #define ccid2_hc_tx_check_sanity(hctx)
82 #endif
83 
84 static int ccid2_hc_tx_alloc_seq(struct ccid2_hc_tx_sock *hctx)
85 {
86 	struct ccid2_seq *seqp;
87 	int i;
88 
89 	/* check if we have space to preserve the pointer to the buffer */
90 	if (hctx->ccid2hctx_seqbufc >= (sizeof(hctx->ccid2hctx_seqbuf) /
91 					sizeof(struct ccid2_seq*)))
92 		return -ENOMEM;
93 
94 	/* allocate buffer and initialize linked list */
95 	seqp = kmalloc(CCID2_SEQBUF_LEN * sizeof(struct ccid2_seq), gfp_any());
96 	if (seqp == NULL)
97 		return -ENOMEM;
98 
99 	for (i = 0; i < (CCID2_SEQBUF_LEN - 1); i++) {
100 		seqp[i].ccid2s_next = &seqp[i + 1];
101 		seqp[i + 1].ccid2s_prev = &seqp[i];
102 	}
103 	seqp[CCID2_SEQBUF_LEN - 1].ccid2s_next = seqp;
104 	seqp->ccid2s_prev = &seqp[CCID2_SEQBUF_LEN - 1];
105 
106 	/* This is the first allocation.  Initiate the head and tail.  */
107 	if (hctx->ccid2hctx_seqbufc == 0)
108 		hctx->ccid2hctx_seqh = hctx->ccid2hctx_seqt = seqp;
109 	else {
110 		/* link the existing list with the one we just created */
111 		hctx->ccid2hctx_seqh->ccid2s_next = seqp;
112 		seqp->ccid2s_prev = hctx->ccid2hctx_seqh;
113 
114 		hctx->ccid2hctx_seqt->ccid2s_prev = &seqp[CCID2_SEQBUF_LEN - 1];
115 		seqp[CCID2_SEQBUF_LEN - 1].ccid2s_next = hctx->ccid2hctx_seqt;
116 	}
117 
118 	/* store the original pointer to the buffer so we can free it */
119 	hctx->ccid2hctx_seqbuf[hctx->ccid2hctx_seqbufc] = seqp;
120 	hctx->ccid2hctx_seqbufc++;
121 
122 	return 0;
123 }
124 
125 static int ccid2_hc_tx_send_packet(struct sock *sk, struct sk_buff *skb)
126 {
127 	struct ccid2_hc_tx_sock *hctx = ccid2_hc_tx_sk(sk);
128 
129 	if (hctx->ccid2hctx_pipe < hctx->ccid2hctx_cwnd)
130 		return 0;
131 
132 	return 1; /* XXX CCID should dequeue when ready instead of polling */
133 }
134 
135 static void ccid2_change_l_ack_ratio(struct sock *sk, u32 val)
136 {
137 	struct dccp_sock *dp = dccp_sk(sk);
138 	u32 max_ratio = DIV_ROUND_UP(ccid2_hc_tx_sk(sk)->ccid2hctx_cwnd, 2);
139 
140 	/*
141 	 * Ensure that Ack Ratio does not exceed ceil(cwnd/2), which is (2) from
142 	 * RFC 4341, 6.1.2. We ignore the statement that Ack Ratio 2 is always
143 	 * acceptable since this causes starvation/deadlock whenever cwnd < 2.
144 	 * The same problem arises when Ack Ratio is 0 (ie. Ack Ratio disabled).
145 	 */
146 	if (val == 0 || val > max_ratio) {
147 		DCCP_WARN("Limiting Ack Ratio (%u) to %u\n", val, max_ratio);
148 		val = max_ratio;
149 	}
150 	if (val > 0xFFFF)		/* RFC 4340, 11.3 */
151 		val = 0xFFFF;
152 
153 	if (val == dp->dccps_l_ack_ratio)
154 		return;
155 
156 	ccid2_pr_debug("changing local ack ratio to %u\n", val);
157 	dp->dccps_l_ack_ratio = val;
158 }
159 
160 static void ccid2_change_srtt(struct ccid2_hc_tx_sock *hctx, long val)
161 {
162 	ccid2_pr_debug("change SRTT to %ld\n", val);
163 	hctx->ccid2hctx_srtt = val;
164 }
165 
166 static void ccid2_start_rto_timer(struct sock *sk);
167 
168 static void ccid2_hc_tx_rto_expire(unsigned long data)
169 {
170 	struct sock *sk = (struct sock *)data;
171 	struct ccid2_hc_tx_sock *hctx = ccid2_hc_tx_sk(sk);
172 	long s;
173 
174 	bh_lock_sock(sk);
175 	if (sock_owned_by_user(sk)) {
176 		sk_reset_timer(sk, &hctx->ccid2hctx_rtotimer,
177 			       jiffies + HZ / 5);
178 		goto out;
179 	}
180 
181 	ccid2_pr_debug("RTO_EXPIRE\n");
182 
183 	ccid2_hc_tx_check_sanity(hctx);
184 
185 	/* back-off timer */
186 	hctx->ccid2hctx_rto <<= 1;
187 
188 	s = hctx->ccid2hctx_rto / HZ;
189 	if (s > 60)
190 		hctx->ccid2hctx_rto = 60 * HZ;
191 
192 	ccid2_start_rto_timer(sk);
193 
194 	/* adjust pipe, cwnd etc */
195 	hctx->ccid2hctx_ssthresh = hctx->ccid2hctx_cwnd / 2;
196 	if (hctx->ccid2hctx_ssthresh < 2)
197 		hctx->ccid2hctx_ssthresh = 2;
198 	hctx->ccid2hctx_cwnd	 = 1;
199 	hctx->ccid2hctx_pipe	 = 0;
200 
201 	/* clear state about stuff we sent */
202 	hctx->ccid2hctx_seqt = hctx->ccid2hctx_seqh;
203 	hctx->ccid2hctx_packets_acked = 0;
204 
205 	/* clear ack ratio state. */
206 	hctx->ccid2hctx_rpseq	 = 0;
207 	hctx->ccid2hctx_rpdupack = -1;
208 	ccid2_change_l_ack_ratio(sk, 1);
209 	ccid2_hc_tx_check_sanity(hctx);
210 out:
211 	bh_unlock_sock(sk);
212 	sock_put(sk);
213 }
214 
215 static void ccid2_start_rto_timer(struct sock *sk)
216 {
217 	struct ccid2_hc_tx_sock *hctx = ccid2_hc_tx_sk(sk);
218 
219 	ccid2_pr_debug("setting RTO timeout=%ld\n", hctx->ccid2hctx_rto);
220 
221 	BUG_ON(timer_pending(&hctx->ccid2hctx_rtotimer));
222 	sk_reset_timer(sk, &hctx->ccid2hctx_rtotimer,
223 		       jiffies + hctx->ccid2hctx_rto);
224 }
225 
226 static void ccid2_hc_tx_packet_sent(struct sock *sk, int more, unsigned int len)
227 {
228 	struct dccp_sock *dp = dccp_sk(sk);
229 	struct ccid2_hc_tx_sock *hctx = ccid2_hc_tx_sk(sk);
230 	struct ccid2_seq *next;
231 
232 	hctx->ccid2hctx_pipe++;
233 
234 	hctx->ccid2hctx_seqh->ccid2s_seq   = dp->dccps_gss;
235 	hctx->ccid2hctx_seqh->ccid2s_acked = 0;
236 	hctx->ccid2hctx_seqh->ccid2s_sent  = jiffies;
237 
238 	next = hctx->ccid2hctx_seqh->ccid2s_next;
239 	/* check if we need to alloc more space */
240 	if (next == hctx->ccid2hctx_seqt) {
241 		if (ccid2_hc_tx_alloc_seq(hctx)) {
242 			DCCP_CRIT("packet history - out of memory!");
243 			/* FIXME: find a more graceful way to bail out */
244 			return;
245 		}
246 		next = hctx->ccid2hctx_seqh->ccid2s_next;
247 		BUG_ON(next == hctx->ccid2hctx_seqt);
248 	}
249 	hctx->ccid2hctx_seqh = next;
250 
251 	ccid2_pr_debug("cwnd=%d pipe=%d\n", hctx->ccid2hctx_cwnd,
252 		       hctx->ccid2hctx_pipe);
253 
254 	/*
255 	 * FIXME: The code below is broken and the variables have been removed
256 	 * from the socket struct. The `ackloss' variable was always set to 0,
257 	 * and with arsent there are several problems:
258 	 *  (i) it doesn't just count the number of Acks, but all sent packets;
259 	 *  (ii) it is expressed in # of packets, not # of windows, so the
260 	 *  comparison below uses the wrong formula: Appendix A of RFC 4341
261 	 *  comes up with the number K = cwnd / (R^2 - R) of consecutive windows
262 	 *  of data with no lost or marked Ack packets. If arsent were the # of
263 	 *  consecutive Acks received without loss, then Ack Ratio needs to be
264 	 *  decreased by 1 when
265 	 *	      arsent >=  K * cwnd / R  =  cwnd^2 / (R^3 - R^2)
266 	 *  where cwnd / R is the number of Acks received per window of data
267 	 *  (cf. RFC 4341, App. A). The problems are that
268 	 *  - arsent counts other packets as well;
269 	 *  - the comparison uses a formula different from RFC 4341;
270 	 *  - computing a cubic/quadratic equation each time is too complicated.
271 	 *  Hence a different algorithm is needed.
272 	 */
273 #if 0
274 	/* Ack Ratio.  Need to maintain a concept of how many windows we sent */
275 	hctx->ccid2hctx_arsent++;
276 	/* We had an ack loss in this window... */
277 	if (hctx->ccid2hctx_ackloss) {
278 		if (hctx->ccid2hctx_arsent >= hctx->ccid2hctx_cwnd) {
279 			hctx->ccid2hctx_arsent	= 0;
280 			hctx->ccid2hctx_ackloss	= 0;
281 		}
282 	} else {
283 		/* No acks lost up to now... */
284 		/* decrease ack ratio if enough packets were sent */
285 		if (dp->dccps_l_ack_ratio > 1) {
286 			/* XXX don't calculate denominator each time */
287 			int denom = dp->dccps_l_ack_ratio * dp->dccps_l_ack_ratio -
288 				    dp->dccps_l_ack_ratio;
289 
290 			denom = hctx->ccid2hctx_cwnd * hctx->ccid2hctx_cwnd / denom;
291 
292 			if (hctx->ccid2hctx_arsent >= denom) {
293 				ccid2_change_l_ack_ratio(sk, dp->dccps_l_ack_ratio - 1);
294 				hctx->ccid2hctx_arsent = 0;
295 			}
296 		} else {
297 			/* we can't increase ack ratio further [1] */
298 			hctx->ccid2hctx_arsent = 0; /* or maybe set it to cwnd*/
299 		}
300 	}
301 #endif
302 
303 	/* setup RTO timer */
304 	if (!timer_pending(&hctx->ccid2hctx_rtotimer))
305 		ccid2_start_rto_timer(sk);
306 
307 #ifdef CONFIG_IP_DCCP_CCID2_DEBUG
308 	do {
309 		struct ccid2_seq *seqp = hctx->ccid2hctx_seqt;
310 
311 		while (seqp != hctx->ccid2hctx_seqh) {
312 			ccid2_pr_debug("out seq=%llu acked=%d time=%lu\n",
313 				       (unsigned long long)seqp->ccid2s_seq,
314 				       seqp->ccid2s_acked, seqp->ccid2s_sent);
315 			seqp = seqp->ccid2s_next;
316 		}
317 	} while (0);
318 	ccid2_pr_debug("=========\n");
319 	ccid2_hc_tx_check_sanity(hctx);
320 #endif
321 }
322 
323 /* XXX Lame code duplication!
324  * returns -1 if none was found.
325  * else returns the next offset to use in the function call.
326  */
327 static int ccid2_ackvector(struct sock *sk, struct sk_buff *skb, int offset,
328 			   unsigned char **vec, unsigned char *veclen)
329 {
330 	const struct dccp_hdr *dh = dccp_hdr(skb);
331 	unsigned char *options = (unsigned char *)dh + dccp_hdr_len(skb);
332 	unsigned char *opt_ptr;
333 	const unsigned char *opt_end = (unsigned char *)dh +
334 					(dh->dccph_doff * 4);
335 	unsigned char opt, len;
336 	unsigned char *value;
337 
338 	BUG_ON(offset < 0);
339 	options += offset;
340 	opt_ptr = options;
341 	if (opt_ptr >= opt_end)
342 		return -1;
343 
344 	while (opt_ptr != opt_end) {
345 		opt   = *opt_ptr++;
346 		len   = 0;
347 		value = NULL;
348 
349 		/* Check if this isn't a single byte option */
350 		if (opt > DCCPO_MAX_RESERVED) {
351 			if (opt_ptr == opt_end)
352 				goto out_invalid_option;
353 
354 			len = *opt_ptr++;
355 			if (len < 3)
356 				goto out_invalid_option;
357 			/*
358 			 * Remove the type and len fields, leaving
359 			 * just the value size
360 			 */
361 			len     -= 2;
362 			value   = opt_ptr;
363 			opt_ptr += len;
364 
365 			if (opt_ptr > opt_end)
366 				goto out_invalid_option;
367 		}
368 
369 		switch (opt) {
370 		case DCCPO_ACK_VECTOR_0:
371 		case DCCPO_ACK_VECTOR_1:
372 			*vec	= value;
373 			*veclen = len;
374 			return offset + (opt_ptr - options);
375 		}
376 	}
377 
378 	return -1;
379 
380 out_invalid_option:
381 	DCCP_BUG("Invalid option - this should not happen (previous parsing)!");
382 	return -1;
383 }
384 
385 static void ccid2_hc_tx_kill_rto_timer(struct sock *sk)
386 {
387 	struct ccid2_hc_tx_sock *hctx = ccid2_hc_tx_sk(sk);
388 
389 	sk_stop_timer(sk, &hctx->ccid2hctx_rtotimer);
390 	ccid2_pr_debug("deleted RTO timer\n");
391 }
392 
393 static inline void ccid2_new_ack(struct sock *sk,
394 				 struct ccid2_seq *seqp,
395 				 unsigned int *maxincr)
396 {
397 	struct ccid2_hc_tx_sock *hctx = ccid2_hc_tx_sk(sk);
398 
399 	if (hctx->ccid2hctx_cwnd < hctx->ccid2hctx_ssthresh) {
400 		if (*maxincr > 0 && ++hctx->ccid2hctx_packets_acked == 2) {
401 			hctx->ccid2hctx_cwnd += 1;
402 			*maxincr	     -= 1;
403 			hctx->ccid2hctx_packets_acked = 0;
404 		}
405 	} else if (++hctx->ccid2hctx_packets_acked >= hctx->ccid2hctx_cwnd) {
406 			hctx->ccid2hctx_cwnd += 1;
407 			hctx->ccid2hctx_packets_acked = 0;
408 	}
409 
410 	/* update RTO */
411 	if (hctx->ccid2hctx_srtt == -1 ||
412 	    time_after(jiffies, hctx->ccid2hctx_lastrtt + hctx->ccid2hctx_srtt)) {
413 		unsigned long r = (long)jiffies - (long)seqp->ccid2s_sent;
414 		int s;
415 
416 		/* first measurement */
417 		if (hctx->ccid2hctx_srtt == -1) {
418 			ccid2_pr_debug("R: %lu Time=%lu seq=%llu\n",
419 				       r, jiffies,
420 				       (unsigned long long)seqp->ccid2s_seq);
421 			ccid2_change_srtt(hctx, r);
422 			hctx->ccid2hctx_rttvar = r >> 1;
423 		} else {
424 			/* RTTVAR */
425 			long tmp = hctx->ccid2hctx_srtt - r;
426 			long srtt;
427 
428 			if (tmp < 0)
429 				tmp *= -1;
430 
431 			tmp >>= 2;
432 			hctx->ccid2hctx_rttvar *= 3;
433 			hctx->ccid2hctx_rttvar >>= 2;
434 			hctx->ccid2hctx_rttvar += tmp;
435 
436 			/* SRTT */
437 			srtt = hctx->ccid2hctx_srtt;
438 			srtt *= 7;
439 			srtt >>= 3;
440 			tmp = r >> 3;
441 			srtt += tmp;
442 			ccid2_change_srtt(hctx, srtt);
443 		}
444 		s = hctx->ccid2hctx_rttvar << 2;
445 		/* clock granularity is 1 when based on jiffies */
446 		if (!s)
447 			s = 1;
448 		hctx->ccid2hctx_rto = hctx->ccid2hctx_srtt + s;
449 
450 		/* must be at least a second */
451 		s = hctx->ccid2hctx_rto / HZ;
452 		/* DCCP doesn't require this [but I like it cuz my code sux] */
453 #if 1
454 		if (s < 1)
455 			hctx->ccid2hctx_rto = HZ;
456 #endif
457 		/* max 60 seconds */
458 		if (s > 60)
459 			hctx->ccid2hctx_rto = HZ * 60;
460 
461 		hctx->ccid2hctx_lastrtt = jiffies;
462 
463 		ccid2_pr_debug("srtt: %ld rttvar: %ld rto: %ld (HZ=%d) R=%lu\n",
464 			       hctx->ccid2hctx_srtt, hctx->ccid2hctx_rttvar,
465 			       hctx->ccid2hctx_rto, HZ, r);
466 	}
467 
468 	/* we got a new ack, so re-start RTO timer */
469 	ccid2_hc_tx_kill_rto_timer(sk);
470 	ccid2_start_rto_timer(sk);
471 }
472 
473 static void ccid2_hc_tx_dec_pipe(struct sock *sk)
474 {
475 	struct ccid2_hc_tx_sock *hctx = ccid2_hc_tx_sk(sk);
476 
477 	if (hctx->ccid2hctx_pipe == 0)
478 		DCCP_BUG("pipe == 0");
479 	else
480 		hctx->ccid2hctx_pipe--;
481 
482 	if (hctx->ccid2hctx_pipe == 0)
483 		ccid2_hc_tx_kill_rto_timer(sk);
484 }
485 
486 static void ccid2_congestion_event(struct sock *sk, struct ccid2_seq *seqp)
487 {
488 	struct ccid2_hc_tx_sock *hctx = ccid2_hc_tx_sk(sk);
489 
490 	if (time_before(seqp->ccid2s_sent, hctx->ccid2hctx_last_cong)) {
491 		ccid2_pr_debug("Multiple losses in an RTT---treating as one\n");
492 		return;
493 	}
494 
495 	hctx->ccid2hctx_last_cong = jiffies;
496 
497 	hctx->ccid2hctx_cwnd     = hctx->ccid2hctx_cwnd / 2 ? : 1U;
498 	hctx->ccid2hctx_ssthresh = max(hctx->ccid2hctx_cwnd, 2U);
499 
500 	/* Avoid spurious timeouts resulting from Ack Ratio > cwnd */
501 	if (dccp_sk(sk)->dccps_l_ack_ratio > hctx->ccid2hctx_cwnd)
502 		ccid2_change_l_ack_ratio(sk, hctx->ccid2hctx_cwnd);
503 }
504 
505 static void ccid2_hc_tx_packet_recv(struct sock *sk, struct sk_buff *skb)
506 {
507 	struct dccp_sock *dp = dccp_sk(sk);
508 	struct ccid2_hc_tx_sock *hctx = ccid2_hc_tx_sk(sk);
509 	u64 ackno, seqno;
510 	struct ccid2_seq *seqp;
511 	unsigned char *vector;
512 	unsigned char veclen;
513 	int offset = 0;
514 	int done = 0;
515 	unsigned int maxincr = 0;
516 
517 	ccid2_hc_tx_check_sanity(hctx);
518 	/* check reverse path congestion */
519 	seqno = DCCP_SKB_CB(skb)->dccpd_seq;
520 
521 	/* XXX this whole "algorithm" is broken.  Need to fix it to keep track
522 	 * of the seqnos of the dupacks so that rpseq and rpdupack are correct
523 	 * -sorbo.
524 	 */
525 	/* need to bootstrap */
526 	if (hctx->ccid2hctx_rpdupack == -1) {
527 		hctx->ccid2hctx_rpdupack = 0;
528 		hctx->ccid2hctx_rpseq = seqno;
529 	} else {
530 		/* check if packet is consecutive */
531 		if (dccp_delta_seqno(hctx->ccid2hctx_rpseq, seqno) == 1)
532 			hctx->ccid2hctx_rpseq = seqno;
533 		/* it's a later packet */
534 		else if (after48(seqno, hctx->ccid2hctx_rpseq)) {
535 			hctx->ccid2hctx_rpdupack++;
536 
537 			/* check if we got enough dupacks */
538 			if (hctx->ccid2hctx_rpdupack >= NUMDUPACK) {
539 				hctx->ccid2hctx_rpdupack = -1; /* XXX lame */
540 				hctx->ccid2hctx_rpseq = 0;
541 
542 				ccid2_change_l_ack_ratio(sk, 2 * dp->dccps_l_ack_ratio);
543 			}
544 		}
545 	}
546 
547 	/* check forward path congestion */
548 	/* still didn't send out new data packets */
549 	if (hctx->ccid2hctx_seqh == hctx->ccid2hctx_seqt)
550 		return;
551 
552 	switch (DCCP_SKB_CB(skb)->dccpd_type) {
553 	case DCCP_PKT_ACK:
554 	case DCCP_PKT_DATAACK:
555 		break;
556 	default:
557 		return;
558 	}
559 
560 	ackno = DCCP_SKB_CB(skb)->dccpd_ack_seq;
561 	if (after48(ackno, hctx->ccid2hctx_high_ack))
562 		hctx->ccid2hctx_high_ack = ackno;
563 
564 	seqp = hctx->ccid2hctx_seqt;
565 	while (before48(seqp->ccid2s_seq, ackno)) {
566 		seqp = seqp->ccid2s_next;
567 		if (seqp == hctx->ccid2hctx_seqh) {
568 			seqp = hctx->ccid2hctx_seqh->ccid2s_prev;
569 			break;
570 		}
571 	}
572 
573 	/*
574 	 * In slow-start, cwnd can increase up to a maximum of Ack Ratio/2
575 	 * packets per acknowledgement. Rounding up avoids that cwnd is not
576 	 * advanced when Ack Ratio is 1 and gives a slight edge otherwise.
577 	 */
578 	if (hctx->ccid2hctx_cwnd < hctx->ccid2hctx_ssthresh)
579 		maxincr = DIV_ROUND_UP(dp->dccps_l_ack_ratio, 2);
580 
581 	/* go through all ack vectors */
582 	while ((offset = ccid2_ackvector(sk, skb, offset,
583 					 &vector, &veclen)) != -1) {
584 		/* go through this ack vector */
585 		while (veclen--) {
586 			const u8 rl = *vector & DCCP_ACKVEC_LEN_MASK;
587 			u64 ackno_end_rl = SUB48(ackno, rl);
588 
589 			ccid2_pr_debug("ackvec start:%llu end:%llu\n",
590 				       (unsigned long long)ackno,
591 				       (unsigned long long)ackno_end_rl);
592 			/* if the seqno we are analyzing is larger than the
593 			 * current ackno, then move towards the tail of our
594 			 * seqnos.
595 			 */
596 			while (after48(seqp->ccid2s_seq, ackno)) {
597 				if (seqp == hctx->ccid2hctx_seqt) {
598 					done = 1;
599 					break;
600 				}
601 				seqp = seqp->ccid2s_prev;
602 			}
603 			if (done)
604 				break;
605 
606 			/* check all seqnos in the range of the vector
607 			 * run length
608 			 */
609 			while (between48(seqp->ccid2s_seq,ackno_end_rl,ackno)) {
610 				const u8 state = *vector &
611 						 DCCP_ACKVEC_STATE_MASK;
612 
613 				/* new packet received or marked */
614 				if (state != DCCP_ACKVEC_STATE_NOT_RECEIVED &&
615 				    !seqp->ccid2s_acked) {
616 					if (state ==
617 					    DCCP_ACKVEC_STATE_ECN_MARKED) {
618 						ccid2_congestion_event(sk,
619 								       seqp);
620 					} else
621 						ccid2_new_ack(sk, seqp,
622 							      &maxincr);
623 
624 					seqp->ccid2s_acked = 1;
625 					ccid2_pr_debug("Got ack for %llu\n",
626 						       (unsigned long long)seqp->ccid2s_seq);
627 					ccid2_hc_tx_dec_pipe(sk);
628 				}
629 				if (seqp == hctx->ccid2hctx_seqt) {
630 					done = 1;
631 					break;
632 				}
633 				seqp = seqp->ccid2s_prev;
634 			}
635 			if (done)
636 				break;
637 
638 			ackno = SUB48(ackno_end_rl, 1);
639 			vector++;
640 		}
641 		if (done)
642 			break;
643 	}
644 
645 	/* The state about what is acked should be correct now
646 	 * Check for NUMDUPACK
647 	 */
648 	seqp = hctx->ccid2hctx_seqt;
649 	while (before48(seqp->ccid2s_seq, hctx->ccid2hctx_high_ack)) {
650 		seqp = seqp->ccid2s_next;
651 		if (seqp == hctx->ccid2hctx_seqh) {
652 			seqp = hctx->ccid2hctx_seqh->ccid2s_prev;
653 			break;
654 		}
655 	}
656 	done = 0;
657 	while (1) {
658 		if (seqp->ccid2s_acked) {
659 			done++;
660 			if (done == NUMDUPACK)
661 				break;
662 		}
663 		if (seqp == hctx->ccid2hctx_seqt)
664 			break;
665 		seqp = seqp->ccid2s_prev;
666 	}
667 
668 	/* If there are at least 3 acknowledgements, anything unacknowledged
669 	 * below the last sequence number is considered lost
670 	 */
671 	if (done == NUMDUPACK) {
672 		struct ccid2_seq *last_acked = seqp;
673 
674 		/* check for lost packets */
675 		while (1) {
676 			if (!seqp->ccid2s_acked) {
677 				ccid2_pr_debug("Packet lost: %llu\n",
678 					       (unsigned long long)seqp->ccid2s_seq);
679 				/* XXX need to traverse from tail -> head in
680 				 * order to detect multiple congestion events in
681 				 * one ack vector.
682 				 */
683 				ccid2_congestion_event(sk, seqp);
684 				ccid2_hc_tx_dec_pipe(sk);
685 			}
686 			if (seqp == hctx->ccid2hctx_seqt)
687 				break;
688 			seqp = seqp->ccid2s_prev;
689 		}
690 
691 		hctx->ccid2hctx_seqt = last_acked;
692 	}
693 
694 	/* trim acked packets in tail */
695 	while (hctx->ccid2hctx_seqt != hctx->ccid2hctx_seqh) {
696 		if (!hctx->ccid2hctx_seqt->ccid2s_acked)
697 			break;
698 
699 		hctx->ccid2hctx_seqt = hctx->ccid2hctx_seqt->ccid2s_next;
700 	}
701 
702 	ccid2_hc_tx_check_sanity(hctx);
703 }
704 
705 static int ccid2_hc_tx_init(struct ccid *ccid, struct sock *sk)
706 {
707 	struct ccid2_hc_tx_sock *hctx = ccid_priv(ccid);
708 	struct dccp_sock *dp = dccp_sk(sk);
709 	u32 max_ratio;
710 
711 	/* RFC 4341, 5: initialise ssthresh to arbitrarily high (max) value */
712 	hctx->ccid2hctx_ssthresh  = ~0U;
713 
714 	/*
715 	 * RFC 4341, 5: "The cwnd parameter is initialized to at most four
716 	 * packets for new connections, following the rules from [RFC3390]".
717 	 * We need to convert the bytes of RFC3390 into the packets of RFC 4341.
718 	 */
719 	hctx->ccid2hctx_cwnd = clamp(4380U / dp->dccps_mss_cache, 2U, 4U);
720 
721 	/* Make sure that Ack Ratio is enabled and within bounds. */
722 	max_ratio = DIV_ROUND_UP(hctx->ccid2hctx_cwnd, 2);
723 	if (dp->dccps_l_ack_ratio == 0 || dp->dccps_l_ack_ratio > max_ratio)
724 		dp->dccps_l_ack_ratio = max_ratio;
725 
726 	/* XXX init ~ to window size... */
727 	if (ccid2_hc_tx_alloc_seq(hctx))
728 		return -ENOMEM;
729 
730 	hctx->ccid2hctx_rto	 = 3 * HZ;
731 	ccid2_change_srtt(hctx, -1);
732 	hctx->ccid2hctx_rttvar	 = -1;
733 	hctx->ccid2hctx_rpdupack = -1;
734 	hctx->ccid2hctx_last_cong = jiffies;
735 	setup_timer(&hctx->ccid2hctx_rtotimer, ccid2_hc_tx_rto_expire,
736 			(unsigned long)sk);
737 
738 	ccid2_hc_tx_check_sanity(hctx);
739 	return 0;
740 }
741 
742 static void ccid2_hc_tx_exit(struct sock *sk)
743 {
744 	struct ccid2_hc_tx_sock *hctx = ccid2_hc_tx_sk(sk);
745 	int i;
746 
747 	ccid2_hc_tx_kill_rto_timer(sk);
748 
749 	for (i = 0; i < hctx->ccid2hctx_seqbufc; i++)
750 		kfree(hctx->ccid2hctx_seqbuf[i]);
751 	hctx->ccid2hctx_seqbufc = 0;
752 }
753 
754 static void ccid2_hc_rx_packet_recv(struct sock *sk, struct sk_buff *skb)
755 {
756 	const struct dccp_sock *dp = dccp_sk(sk);
757 	struct ccid2_hc_rx_sock *hcrx = ccid2_hc_rx_sk(sk);
758 
759 	switch (DCCP_SKB_CB(skb)->dccpd_type) {
760 	case DCCP_PKT_DATA:
761 	case DCCP_PKT_DATAACK:
762 		hcrx->ccid2hcrx_data++;
763 		if (hcrx->ccid2hcrx_data >= dp->dccps_r_ack_ratio) {
764 			dccp_send_ack(sk);
765 			hcrx->ccid2hcrx_data = 0;
766 		}
767 		break;
768 	}
769 }
770 
771 static struct ccid_operations ccid2 = {
772 	.ccid_id		= DCCPC_CCID2,
773 	.ccid_name		= "TCP-like",
774 	.ccid_owner		= THIS_MODULE,
775 	.ccid_hc_tx_obj_size	= sizeof(struct ccid2_hc_tx_sock),
776 	.ccid_hc_tx_init	= ccid2_hc_tx_init,
777 	.ccid_hc_tx_exit	= ccid2_hc_tx_exit,
778 	.ccid_hc_tx_send_packet	= ccid2_hc_tx_send_packet,
779 	.ccid_hc_tx_packet_sent	= ccid2_hc_tx_packet_sent,
780 	.ccid_hc_tx_packet_recv	= ccid2_hc_tx_packet_recv,
781 	.ccid_hc_rx_obj_size	= sizeof(struct ccid2_hc_rx_sock),
782 	.ccid_hc_rx_packet_recv	= ccid2_hc_rx_packet_recv,
783 };
784 
785 #ifdef CONFIG_IP_DCCP_CCID2_DEBUG
786 module_param(ccid2_debug, bool, 0644);
787 MODULE_PARM_DESC(ccid2_debug, "Enable debug messages");
788 #endif
789 
790 static __init int ccid2_module_init(void)
791 {
792 	return ccid_register(&ccid2);
793 }
794 module_init(ccid2_module_init);
795 
796 static __exit void ccid2_module_exit(void)
797 {
798 	ccid_unregister(&ccid2);
799 }
800 module_exit(ccid2_module_exit);
801 
802 MODULE_AUTHOR("Andrea Bittau <a.bittau@cs.ucl.ac.uk>");
803 MODULE_DESCRIPTION("DCCP TCP-Like (CCID2) CCID");
804 MODULE_LICENSE("GPL");
805 MODULE_ALIAS("net-dccp-ccid-2");
806