| /* | 
 |  *  Copyright (c) 2005, 2006 Andrea Bittau <a.bittau@cs.ucl.ac.uk> | 
 |  * | 
 |  *  Changes to meet Linux coding standards, and DCCP infrastructure fixes. | 
 |  * | 
 |  *  Copyright (c) 2006 Arnaldo Carvalho de Melo <acme@conectiva.com.br> | 
 |  * | 
 |  *  This program is free software; you can redistribute it and/or modify | 
 |  *  it under the terms of the GNU General Public License as published by | 
 |  *  the Free Software Foundation; either version 2 of the License, or | 
 |  *  (at your option) any later version. | 
 |  * | 
 |  *  This program is distributed in the hope that it will be useful, | 
 |  *  but WITHOUT ANY WARRANTY; without even the implied warranty of | 
 |  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
 |  *  GNU General Public License for more details. | 
 |  * | 
 |  *  You should have received a copy of the GNU General Public License | 
 |  *  along with this program; if not, write to the Free Software | 
 |  *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | 
 |  */ | 
 |  | 
 | /* | 
 |  * This implementation should follow RFC 4341 | 
 |  */ | 
 | #include "../feat.h" | 
 | #include "../ccid.h" | 
 | #include "../dccp.h" | 
 | #include "ccid2.h" | 
 |  | 
 |  | 
 | #ifdef CONFIG_IP_DCCP_CCID2_DEBUG | 
 | static int ccid2_debug; | 
 | #define ccid2_pr_debug(format, a...)	DCCP_PR_DEBUG(ccid2_debug, format, ##a) | 
 |  | 
 | static void ccid2_hc_tx_check_sanity(const struct ccid2_hc_tx_sock *hctx) | 
 | { | 
 | 	int len = 0; | 
 | 	int pipe = 0; | 
 | 	struct ccid2_seq *seqp = hctx->ccid2hctx_seqh; | 
 |  | 
 | 	/* there is data in the chain */ | 
 | 	if (seqp != hctx->ccid2hctx_seqt) { | 
 | 		seqp = seqp->ccid2s_prev; | 
 | 		len++; | 
 | 		if (!seqp->ccid2s_acked) | 
 | 			pipe++; | 
 |  | 
 | 		while (seqp != hctx->ccid2hctx_seqt) { | 
 | 			struct ccid2_seq *prev = seqp->ccid2s_prev; | 
 |  | 
 | 			len++; | 
 | 			if (!prev->ccid2s_acked) | 
 | 				pipe++; | 
 |  | 
 | 			/* packets are sent sequentially */ | 
 | 			BUG_ON(dccp_delta_seqno(seqp->ccid2s_seq, | 
 | 						prev->ccid2s_seq ) >= 0); | 
 | 			BUG_ON(time_before(seqp->ccid2s_sent, | 
 | 					   prev->ccid2s_sent)); | 
 |  | 
 | 			seqp = prev; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	BUG_ON(pipe != hctx->ccid2hctx_pipe); | 
 | 	ccid2_pr_debug("len of chain=%d\n", len); | 
 |  | 
 | 	do { | 
 | 		seqp = seqp->ccid2s_prev; | 
 | 		len++; | 
 | 	} while (seqp != hctx->ccid2hctx_seqh); | 
 |  | 
 | 	ccid2_pr_debug("total len=%d\n", len); | 
 | 	BUG_ON(len != hctx->ccid2hctx_seqbufc * CCID2_SEQBUF_LEN); | 
 | } | 
 | #else | 
 | #define ccid2_pr_debug(format, a...) | 
 | #define ccid2_hc_tx_check_sanity(hctx) | 
 | #endif | 
 |  | 
 | static int ccid2_hc_tx_alloc_seq(struct ccid2_hc_tx_sock *hctx) | 
 | { | 
 | 	struct ccid2_seq *seqp; | 
 | 	int i; | 
 |  | 
 | 	/* check if we have space to preserve the pointer to the buffer */ | 
 | 	if (hctx->ccid2hctx_seqbufc >= (sizeof(hctx->ccid2hctx_seqbuf) / | 
 | 					sizeof(struct ccid2_seq*))) | 
 | 		return -ENOMEM; | 
 |  | 
 | 	/* allocate buffer and initialize linked list */ | 
 | 	seqp = kmalloc(CCID2_SEQBUF_LEN * sizeof(struct ccid2_seq), gfp_any()); | 
 | 	if (seqp == NULL) | 
 | 		return -ENOMEM; | 
 |  | 
 | 	for (i = 0; i < (CCID2_SEQBUF_LEN - 1); i++) { | 
 | 		seqp[i].ccid2s_next = &seqp[i + 1]; | 
 | 		seqp[i + 1].ccid2s_prev = &seqp[i]; | 
 | 	} | 
 | 	seqp[CCID2_SEQBUF_LEN - 1].ccid2s_next = seqp; | 
 | 	seqp->ccid2s_prev = &seqp[CCID2_SEQBUF_LEN - 1]; | 
 |  | 
 | 	/* This is the first allocation.  Initiate the head and tail.  */ | 
 | 	if (hctx->ccid2hctx_seqbufc == 0) | 
 | 		hctx->ccid2hctx_seqh = hctx->ccid2hctx_seqt = seqp; | 
 | 	else { | 
 | 		/* link the existing list with the one we just created */ | 
 | 		hctx->ccid2hctx_seqh->ccid2s_next = seqp; | 
 | 		seqp->ccid2s_prev = hctx->ccid2hctx_seqh; | 
 |  | 
 | 		hctx->ccid2hctx_seqt->ccid2s_prev = &seqp[CCID2_SEQBUF_LEN - 1]; | 
 | 		seqp[CCID2_SEQBUF_LEN - 1].ccid2s_next = hctx->ccid2hctx_seqt; | 
 | 	} | 
 |  | 
 | 	/* store the original pointer to the buffer so we can free it */ | 
 | 	hctx->ccid2hctx_seqbuf[hctx->ccid2hctx_seqbufc] = seqp; | 
 | 	hctx->ccid2hctx_seqbufc++; | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int ccid2_hc_tx_send_packet(struct sock *sk, struct sk_buff *skb) | 
 | { | 
 | 	struct ccid2_hc_tx_sock *hctx = ccid2_hc_tx_sk(sk); | 
 |  | 
 | 	if (hctx->ccid2hctx_pipe < hctx->ccid2hctx_cwnd) | 
 | 		return 0; | 
 |  | 
 | 	return 1; /* XXX CCID should dequeue when ready instead of polling */ | 
 | } | 
 |  | 
 | static void ccid2_change_l_ack_ratio(struct sock *sk, u32 val) | 
 | { | 
 | 	struct dccp_sock *dp = dccp_sk(sk); | 
 | 	u32 max_ratio = DIV_ROUND_UP(ccid2_hc_tx_sk(sk)->ccid2hctx_cwnd, 2); | 
 |  | 
 | 	/* | 
 | 	 * Ensure that Ack Ratio does not exceed ceil(cwnd/2), which is (2) from | 
 | 	 * RFC 4341, 6.1.2. We ignore the statement that Ack Ratio 2 is always | 
 | 	 * acceptable since this causes starvation/deadlock whenever cwnd < 2. | 
 | 	 * The same problem arises when Ack Ratio is 0 (ie. Ack Ratio disabled). | 
 | 	 */ | 
 | 	if (val == 0 || val > max_ratio) { | 
 | 		DCCP_WARN("Limiting Ack Ratio (%u) to %u\n", val, max_ratio); | 
 | 		val = max_ratio; | 
 | 	} | 
 | 	if (val > DCCPF_ACK_RATIO_MAX) | 
 | 		val = DCCPF_ACK_RATIO_MAX; | 
 |  | 
 | 	if (val == dp->dccps_l_ack_ratio) | 
 | 		return; | 
 |  | 
 | 	ccid2_pr_debug("changing local ack ratio to %u\n", val); | 
 | 	dp->dccps_l_ack_ratio = val; | 
 | } | 
 |  | 
 | static void ccid2_change_srtt(struct ccid2_hc_tx_sock *hctx, long val) | 
 | { | 
 | 	ccid2_pr_debug("change SRTT to %ld\n", val); | 
 | 	hctx->ccid2hctx_srtt = val; | 
 | } | 
 |  | 
 | static void ccid2_start_rto_timer(struct sock *sk); | 
 |  | 
 | static void ccid2_hc_tx_rto_expire(unsigned long data) | 
 | { | 
 | 	struct sock *sk = (struct sock *)data; | 
 | 	struct ccid2_hc_tx_sock *hctx = ccid2_hc_tx_sk(sk); | 
 | 	long s; | 
 |  | 
 | 	bh_lock_sock(sk); | 
 | 	if (sock_owned_by_user(sk)) { | 
 | 		sk_reset_timer(sk, &hctx->ccid2hctx_rtotimer, | 
 | 			       jiffies + HZ / 5); | 
 | 		goto out; | 
 | 	} | 
 |  | 
 | 	ccid2_pr_debug("RTO_EXPIRE\n"); | 
 |  | 
 | 	ccid2_hc_tx_check_sanity(hctx); | 
 |  | 
 | 	/* back-off timer */ | 
 | 	hctx->ccid2hctx_rto <<= 1; | 
 |  | 
 | 	s = hctx->ccid2hctx_rto / HZ; | 
 | 	if (s > 60) | 
 | 		hctx->ccid2hctx_rto = 60 * HZ; | 
 |  | 
 | 	ccid2_start_rto_timer(sk); | 
 |  | 
 | 	/* adjust pipe, cwnd etc */ | 
 | 	hctx->ccid2hctx_ssthresh = hctx->ccid2hctx_cwnd / 2; | 
 | 	if (hctx->ccid2hctx_ssthresh < 2) | 
 | 		hctx->ccid2hctx_ssthresh = 2; | 
 | 	hctx->ccid2hctx_cwnd	 = 1; | 
 | 	hctx->ccid2hctx_pipe	 = 0; | 
 |  | 
 | 	/* clear state about stuff we sent */ | 
 | 	hctx->ccid2hctx_seqt = hctx->ccid2hctx_seqh; | 
 | 	hctx->ccid2hctx_packets_acked = 0; | 
 |  | 
 | 	/* clear ack ratio state. */ | 
 | 	hctx->ccid2hctx_rpseq	 = 0; | 
 | 	hctx->ccid2hctx_rpdupack = -1; | 
 | 	ccid2_change_l_ack_ratio(sk, 1); | 
 | 	ccid2_hc_tx_check_sanity(hctx); | 
 | out: | 
 | 	bh_unlock_sock(sk); | 
 | 	sock_put(sk); | 
 | } | 
 |  | 
 | static void ccid2_start_rto_timer(struct sock *sk) | 
 | { | 
 | 	struct ccid2_hc_tx_sock *hctx = ccid2_hc_tx_sk(sk); | 
 |  | 
 | 	ccid2_pr_debug("setting RTO timeout=%ld\n", hctx->ccid2hctx_rto); | 
 |  | 
 | 	BUG_ON(timer_pending(&hctx->ccid2hctx_rtotimer)); | 
 | 	sk_reset_timer(sk, &hctx->ccid2hctx_rtotimer, | 
 | 		       jiffies + hctx->ccid2hctx_rto); | 
 | } | 
 |  | 
 | static void ccid2_hc_tx_packet_sent(struct sock *sk, int more, unsigned int len) | 
 | { | 
 | 	struct dccp_sock *dp = dccp_sk(sk); | 
 | 	struct ccid2_hc_tx_sock *hctx = ccid2_hc_tx_sk(sk); | 
 | 	struct ccid2_seq *next; | 
 |  | 
 | 	hctx->ccid2hctx_pipe++; | 
 |  | 
 | 	hctx->ccid2hctx_seqh->ccid2s_seq   = dp->dccps_gss; | 
 | 	hctx->ccid2hctx_seqh->ccid2s_acked = 0; | 
 | 	hctx->ccid2hctx_seqh->ccid2s_sent  = jiffies; | 
 |  | 
 | 	next = hctx->ccid2hctx_seqh->ccid2s_next; | 
 | 	/* check if we need to alloc more space */ | 
 | 	if (next == hctx->ccid2hctx_seqt) { | 
 | 		if (ccid2_hc_tx_alloc_seq(hctx)) { | 
 | 			DCCP_CRIT("packet history - out of memory!"); | 
 | 			/* FIXME: find a more graceful way to bail out */ | 
 | 			return; | 
 | 		} | 
 | 		next = hctx->ccid2hctx_seqh->ccid2s_next; | 
 | 		BUG_ON(next == hctx->ccid2hctx_seqt); | 
 | 	} | 
 | 	hctx->ccid2hctx_seqh = next; | 
 |  | 
 | 	ccid2_pr_debug("cwnd=%d pipe=%d\n", hctx->ccid2hctx_cwnd, | 
 | 		       hctx->ccid2hctx_pipe); | 
 |  | 
 | 	/* | 
 | 	 * FIXME: The code below is broken and the variables have been removed | 
 | 	 * from the socket struct. The `ackloss' variable was always set to 0, | 
 | 	 * and with arsent there are several problems: | 
 | 	 *  (i) it doesn't just count the number of Acks, but all sent packets; | 
 | 	 *  (ii) it is expressed in # of packets, not # of windows, so the | 
 | 	 *  comparison below uses the wrong formula: Appendix A of RFC 4341 | 
 | 	 *  comes up with the number K = cwnd / (R^2 - R) of consecutive windows | 
 | 	 *  of data with no lost or marked Ack packets. If arsent were the # of | 
 | 	 *  consecutive Acks received without loss, then Ack Ratio needs to be | 
 | 	 *  decreased by 1 when | 
 | 	 *	      arsent >=  K * cwnd / R  =  cwnd^2 / (R^3 - R^2) | 
 | 	 *  where cwnd / R is the number of Acks received per window of data | 
 | 	 *  (cf. RFC 4341, App. A). The problems are that | 
 | 	 *  - arsent counts other packets as well; | 
 | 	 *  - the comparison uses a formula different from RFC 4341; | 
 | 	 *  - computing a cubic/quadratic equation each time is too complicated. | 
 | 	 *  Hence a different algorithm is needed. | 
 | 	 */ | 
 | #if 0 | 
 | 	/* Ack Ratio.  Need to maintain a concept of how many windows we sent */ | 
 | 	hctx->ccid2hctx_arsent++; | 
 | 	/* We had an ack loss in this window... */ | 
 | 	if (hctx->ccid2hctx_ackloss) { | 
 | 		if (hctx->ccid2hctx_arsent >= hctx->ccid2hctx_cwnd) { | 
 | 			hctx->ccid2hctx_arsent	= 0; | 
 | 			hctx->ccid2hctx_ackloss	= 0; | 
 | 		} | 
 | 	} else { | 
 | 		/* No acks lost up to now... */ | 
 | 		/* decrease ack ratio if enough packets were sent */ | 
 | 		if (dp->dccps_l_ack_ratio > 1) { | 
 | 			/* XXX don't calculate denominator each time */ | 
 | 			int denom = dp->dccps_l_ack_ratio * dp->dccps_l_ack_ratio - | 
 | 				    dp->dccps_l_ack_ratio; | 
 |  | 
 | 			denom = hctx->ccid2hctx_cwnd * hctx->ccid2hctx_cwnd / denom; | 
 |  | 
 | 			if (hctx->ccid2hctx_arsent >= denom) { | 
 | 				ccid2_change_l_ack_ratio(sk, dp->dccps_l_ack_ratio - 1); | 
 | 				hctx->ccid2hctx_arsent = 0; | 
 | 			} | 
 | 		} else { | 
 | 			/* we can't increase ack ratio further [1] */ | 
 | 			hctx->ccid2hctx_arsent = 0; /* or maybe set it to cwnd*/ | 
 | 		} | 
 | 	} | 
 | #endif | 
 |  | 
 | 	/* setup RTO timer */ | 
 | 	if (!timer_pending(&hctx->ccid2hctx_rtotimer)) | 
 | 		ccid2_start_rto_timer(sk); | 
 |  | 
 | #ifdef CONFIG_IP_DCCP_CCID2_DEBUG | 
 | 	do { | 
 | 		struct ccid2_seq *seqp = hctx->ccid2hctx_seqt; | 
 |  | 
 | 		while (seqp != hctx->ccid2hctx_seqh) { | 
 | 			ccid2_pr_debug("out seq=%llu acked=%d time=%lu\n", | 
 | 				       (unsigned long long)seqp->ccid2s_seq, | 
 | 				       seqp->ccid2s_acked, seqp->ccid2s_sent); | 
 | 			seqp = seqp->ccid2s_next; | 
 | 		} | 
 | 	} while (0); | 
 | 	ccid2_pr_debug("=========\n"); | 
 | 	ccid2_hc_tx_check_sanity(hctx); | 
 | #endif | 
 | } | 
 |  | 
 | /* XXX Lame code duplication! | 
 |  * returns -1 if none was found. | 
 |  * else returns the next offset to use in the function call. | 
 |  */ | 
 | static int ccid2_ackvector(struct sock *sk, struct sk_buff *skb, int offset, | 
 | 			   unsigned char **vec, unsigned char *veclen) | 
 | { | 
 | 	const struct dccp_hdr *dh = dccp_hdr(skb); | 
 | 	unsigned char *options = (unsigned char *)dh + dccp_hdr_len(skb); | 
 | 	unsigned char *opt_ptr; | 
 | 	const unsigned char *opt_end = (unsigned char *)dh + | 
 | 					(dh->dccph_doff * 4); | 
 | 	unsigned char opt, len; | 
 | 	unsigned char *value; | 
 |  | 
 | 	BUG_ON(offset < 0); | 
 | 	options += offset; | 
 | 	opt_ptr = options; | 
 | 	if (opt_ptr >= opt_end) | 
 | 		return -1; | 
 |  | 
 | 	while (opt_ptr != opt_end) { | 
 | 		opt   = *opt_ptr++; | 
 | 		len   = 0; | 
 | 		value = NULL; | 
 |  | 
 | 		/* Check if this isn't a single byte option */ | 
 | 		if (opt > DCCPO_MAX_RESERVED) { | 
 | 			if (opt_ptr == opt_end) | 
 | 				goto out_invalid_option; | 
 |  | 
 | 			len = *opt_ptr++; | 
 | 			if (len < 3) | 
 | 				goto out_invalid_option; | 
 | 			/* | 
 | 			 * Remove the type and len fields, leaving | 
 | 			 * just the value size | 
 | 			 */ | 
 | 			len     -= 2; | 
 | 			value   = opt_ptr; | 
 | 			opt_ptr += len; | 
 |  | 
 | 			if (opt_ptr > opt_end) | 
 | 				goto out_invalid_option; | 
 | 		} | 
 |  | 
 | 		switch (opt) { | 
 | 		case DCCPO_ACK_VECTOR_0: | 
 | 		case DCCPO_ACK_VECTOR_1: | 
 | 			*vec	= value; | 
 | 			*veclen = len; | 
 | 			return offset + (opt_ptr - options); | 
 | 		} | 
 | 	} | 
 |  | 
 | 	return -1; | 
 |  | 
 | out_invalid_option: | 
 | 	DCCP_BUG("Invalid option - this should not happen (previous parsing)!"); | 
 | 	return -1; | 
 | } | 
 |  | 
 | static void ccid2_hc_tx_kill_rto_timer(struct sock *sk) | 
 | { | 
 | 	struct ccid2_hc_tx_sock *hctx = ccid2_hc_tx_sk(sk); | 
 |  | 
 | 	sk_stop_timer(sk, &hctx->ccid2hctx_rtotimer); | 
 | 	ccid2_pr_debug("deleted RTO timer\n"); | 
 | } | 
 |  | 
 | static inline void ccid2_new_ack(struct sock *sk, | 
 | 				 struct ccid2_seq *seqp, | 
 | 				 unsigned int *maxincr) | 
 | { | 
 | 	struct ccid2_hc_tx_sock *hctx = ccid2_hc_tx_sk(sk); | 
 |  | 
 | 	if (hctx->ccid2hctx_cwnd < hctx->ccid2hctx_ssthresh) { | 
 | 		if (*maxincr > 0 && ++hctx->ccid2hctx_packets_acked == 2) { | 
 | 			hctx->ccid2hctx_cwnd += 1; | 
 | 			*maxincr	     -= 1; | 
 | 			hctx->ccid2hctx_packets_acked = 0; | 
 | 		} | 
 | 	} else if (++hctx->ccid2hctx_packets_acked >= hctx->ccid2hctx_cwnd) { | 
 | 			hctx->ccid2hctx_cwnd += 1; | 
 | 			hctx->ccid2hctx_packets_acked = 0; | 
 | 	} | 
 |  | 
 | 	/* update RTO */ | 
 | 	if (hctx->ccid2hctx_srtt == -1 || | 
 | 	    time_after(jiffies, hctx->ccid2hctx_lastrtt + hctx->ccid2hctx_srtt)) { | 
 | 		unsigned long r = (long)jiffies - (long)seqp->ccid2s_sent; | 
 | 		int s; | 
 |  | 
 | 		/* first measurement */ | 
 | 		if (hctx->ccid2hctx_srtt == -1) { | 
 | 			ccid2_pr_debug("R: %lu Time=%lu seq=%llu\n", | 
 | 				       r, jiffies, | 
 | 				       (unsigned long long)seqp->ccid2s_seq); | 
 | 			ccid2_change_srtt(hctx, r); | 
 | 			hctx->ccid2hctx_rttvar = r >> 1; | 
 | 		} else { | 
 | 			/* RTTVAR */ | 
 | 			long tmp = hctx->ccid2hctx_srtt - r; | 
 | 			long srtt; | 
 |  | 
 | 			if (tmp < 0) | 
 | 				tmp *= -1; | 
 |  | 
 | 			tmp >>= 2; | 
 | 			hctx->ccid2hctx_rttvar *= 3; | 
 | 			hctx->ccid2hctx_rttvar >>= 2; | 
 | 			hctx->ccid2hctx_rttvar += tmp; | 
 |  | 
 | 			/* SRTT */ | 
 | 			srtt = hctx->ccid2hctx_srtt; | 
 | 			srtt *= 7; | 
 | 			srtt >>= 3; | 
 | 			tmp = r >> 3; | 
 | 			srtt += tmp; | 
 | 			ccid2_change_srtt(hctx, srtt); | 
 | 		} | 
 | 		s = hctx->ccid2hctx_rttvar << 2; | 
 | 		/* clock granularity is 1 when based on jiffies */ | 
 | 		if (!s) | 
 | 			s = 1; | 
 | 		hctx->ccid2hctx_rto = hctx->ccid2hctx_srtt + s; | 
 |  | 
 | 		/* must be at least a second */ | 
 | 		s = hctx->ccid2hctx_rto / HZ; | 
 | 		/* DCCP doesn't require this [but I like it cuz my code sux] */ | 
 | #if 1 | 
 | 		if (s < 1) | 
 | 			hctx->ccid2hctx_rto = HZ; | 
 | #endif | 
 | 		/* max 60 seconds */ | 
 | 		if (s > 60) | 
 | 			hctx->ccid2hctx_rto = HZ * 60; | 
 |  | 
 | 		hctx->ccid2hctx_lastrtt = jiffies; | 
 |  | 
 | 		ccid2_pr_debug("srtt: %ld rttvar: %ld rto: %ld (HZ=%d) R=%lu\n", | 
 | 			       hctx->ccid2hctx_srtt, hctx->ccid2hctx_rttvar, | 
 | 			       hctx->ccid2hctx_rto, HZ, r); | 
 | 	} | 
 |  | 
 | 	/* we got a new ack, so re-start RTO timer */ | 
 | 	ccid2_hc_tx_kill_rto_timer(sk); | 
 | 	ccid2_start_rto_timer(sk); | 
 | } | 
 |  | 
 | static void ccid2_hc_tx_dec_pipe(struct sock *sk) | 
 | { | 
 | 	struct ccid2_hc_tx_sock *hctx = ccid2_hc_tx_sk(sk); | 
 |  | 
 | 	if (hctx->ccid2hctx_pipe == 0) | 
 | 		DCCP_BUG("pipe == 0"); | 
 | 	else | 
 | 		hctx->ccid2hctx_pipe--; | 
 |  | 
 | 	if (hctx->ccid2hctx_pipe == 0) | 
 | 		ccid2_hc_tx_kill_rto_timer(sk); | 
 | } | 
 |  | 
 | static void ccid2_congestion_event(struct sock *sk, struct ccid2_seq *seqp) | 
 | { | 
 | 	struct ccid2_hc_tx_sock *hctx = ccid2_hc_tx_sk(sk); | 
 |  | 
 | 	if (time_before(seqp->ccid2s_sent, hctx->ccid2hctx_last_cong)) { | 
 | 		ccid2_pr_debug("Multiple losses in an RTT---treating as one\n"); | 
 | 		return; | 
 | 	} | 
 |  | 
 | 	hctx->ccid2hctx_last_cong = jiffies; | 
 |  | 
 | 	hctx->ccid2hctx_cwnd     = hctx->ccid2hctx_cwnd / 2 ? : 1U; | 
 | 	hctx->ccid2hctx_ssthresh = max(hctx->ccid2hctx_cwnd, 2U); | 
 |  | 
 | 	/* Avoid spurious timeouts resulting from Ack Ratio > cwnd */ | 
 | 	if (dccp_sk(sk)->dccps_l_ack_ratio > hctx->ccid2hctx_cwnd) | 
 | 		ccid2_change_l_ack_ratio(sk, hctx->ccid2hctx_cwnd); | 
 | } | 
 |  | 
 | static void ccid2_hc_tx_packet_recv(struct sock *sk, struct sk_buff *skb) | 
 | { | 
 | 	struct dccp_sock *dp = dccp_sk(sk); | 
 | 	struct ccid2_hc_tx_sock *hctx = ccid2_hc_tx_sk(sk); | 
 | 	u64 ackno, seqno; | 
 | 	struct ccid2_seq *seqp; | 
 | 	unsigned char *vector; | 
 | 	unsigned char veclen; | 
 | 	int offset = 0; | 
 | 	int done = 0; | 
 | 	unsigned int maxincr = 0; | 
 |  | 
 | 	ccid2_hc_tx_check_sanity(hctx); | 
 | 	/* check reverse path congestion */ | 
 | 	seqno = DCCP_SKB_CB(skb)->dccpd_seq; | 
 |  | 
 | 	/* XXX this whole "algorithm" is broken.  Need to fix it to keep track | 
 | 	 * of the seqnos of the dupacks so that rpseq and rpdupack are correct | 
 | 	 * -sorbo. | 
 | 	 */ | 
 | 	/* need to bootstrap */ | 
 | 	if (hctx->ccid2hctx_rpdupack == -1) { | 
 | 		hctx->ccid2hctx_rpdupack = 0; | 
 | 		hctx->ccid2hctx_rpseq = seqno; | 
 | 	} else { | 
 | 		/* check if packet is consecutive */ | 
 | 		if (dccp_delta_seqno(hctx->ccid2hctx_rpseq, seqno) == 1) | 
 | 			hctx->ccid2hctx_rpseq = seqno; | 
 | 		/* it's a later packet */ | 
 | 		else if (after48(seqno, hctx->ccid2hctx_rpseq)) { | 
 | 			hctx->ccid2hctx_rpdupack++; | 
 |  | 
 | 			/* check if we got enough dupacks */ | 
 | 			if (hctx->ccid2hctx_rpdupack >= NUMDUPACK) { | 
 | 				hctx->ccid2hctx_rpdupack = -1; /* XXX lame */ | 
 | 				hctx->ccid2hctx_rpseq = 0; | 
 |  | 
 | 				ccid2_change_l_ack_ratio(sk, 2 * dp->dccps_l_ack_ratio); | 
 | 			} | 
 | 		} | 
 | 	} | 
 |  | 
 | 	/* check forward path congestion */ | 
 | 	/* still didn't send out new data packets */ | 
 | 	if (hctx->ccid2hctx_seqh == hctx->ccid2hctx_seqt) | 
 | 		return; | 
 |  | 
 | 	switch (DCCP_SKB_CB(skb)->dccpd_type) { | 
 | 	case DCCP_PKT_ACK: | 
 | 	case DCCP_PKT_DATAACK: | 
 | 		break; | 
 | 	default: | 
 | 		return; | 
 | 	} | 
 |  | 
 | 	ackno = DCCP_SKB_CB(skb)->dccpd_ack_seq; | 
 | 	if (after48(ackno, hctx->ccid2hctx_high_ack)) | 
 | 		hctx->ccid2hctx_high_ack = ackno; | 
 |  | 
 | 	seqp = hctx->ccid2hctx_seqt; | 
 | 	while (before48(seqp->ccid2s_seq, ackno)) { | 
 | 		seqp = seqp->ccid2s_next; | 
 | 		if (seqp == hctx->ccid2hctx_seqh) { | 
 | 			seqp = hctx->ccid2hctx_seqh->ccid2s_prev; | 
 | 			break; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	/* | 
 | 	 * In slow-start, cwnd can increase up to a maximum of Ack Ratio/2 | 
 | 	 * packets per acknowledgement. Rounding up avoids that cwnd is not | 
 | 	 * advanced when Ack Ratio is 1 and gives a slight edge otherwise. | 
 | 	 */ | 
 | 	if (hctx->ccid2hctx_cwnd < hctx->ccid2hctx_ssthresh) | 
 | 		maxincr = DIV_ROUND_UP(dp->dccps_l_ack_ratio, 2); | 
 |  | 
 | 	/* go through all ack vectors */ | 
 | 	while ((offset = ccid2_ackvector(sk, skb, offset, | 
 | 					 &vector, &veclen)) != -1) { | 
 | 		/* go through this ack vector */ | 
 | 		while (veclen--) { | 
 | 			const u8 rl = *vector & DCCP_ACKVEC_LEN_MASK; | 
 | 			u64 ackno_end_rl = SUB48(ackno, rl); | 
 |  | 
 | 			ccid2_pr_debug("ackvec start:%llu end:%llu\n", | 
 | 				       (unsigned long long)ackno, | 
 | 				       (unsigned long long)ackno_end_rl); | 
 | 			/* if the seqno we are analyzing is larger than the | 
 | 			 * current ackno, then move towards the tail of our | 
 | 			 * seqnos. | 
 | 			 */ | 
 | 			while (after48(seqp->ccid2s_seq, ackno)) { | 
 | 				if (seqp == hctx->ccid2hctx_seqt) { | 
 | 					done = 1; | 
 | 					break; | 
 | 				} | 
 | 				seqp = seqp->ccid2s_prev; | 
 | 			} | 
 | 			if (done) | 
 | 				break; | 
 |  | 
 | 			/* check all seqnos in the range of the vector | 
 | 			 * run length | 
 | 			 */ | 
 | 			while (between48(seqp->ccid2s_seq,ackno_end_rl,ackno)) { | 
 | 				const u8 state = *vector & | 
 | 						 DCCP_ACKVEC_STATE_MASK; | 
 |  | 
 | 				/* new packet received or marked */ | 
 | 				if (state != DCCP_ACKVEC_STATE_NOT_RECEIVED && | 
 | 				    !seqp->ccid2s_acked) { | 
 | 					if (state == | 
 | 					    DCCP_ACKVEC_STATE_ECN_MARKED) { | 
 | 						ccid2_congestion_event(sk, | 
 | 								       seqp); | 
 | 					} else | 
 | 						ccid2_new_ack(sk, seqp, | 
 | 							      &maxincr); | 
 |  | 
 | 					seqp->ccid2s_acked = 1; | 
 | 					ccid2_pr_debug("Got ack for %llu\n", | 
 | 						       (unsigned long long)seqp->ccid2s_seq); | 
 | 					ccid2_hc_tx_dec_pipe(sk); | 
 | 				} | 
 | 				if (seqp == hctx->ccid2hctx_seqt) { | 
 | 					done = 1; | 
 | 					break; | 
 | 				} | 
 | 				seqp = seqp->ccid2s_prev; | 
 | 			} | 
 | 			if (done) | 
 | 				break; | 
 |  | 
 | 			ackno = SUB48(ackno_end_rl, 1); | 
 | 			vector++; | 
 | 		} | 
 | 		if (done) | 
 | 			break; | 
 | 	} | 
 |  | 
 | 	/* The state about what is acked should be correct now | 
 | 	 * Check for NUMDUPACK | 
 | 	 */ | 
 | 	seqp = hctx->ccid2hctx_seqt; | 
 | 	while (before48(seqp->ccid2s_seq, hctx->ccid2hctx_high_ack)) { | 
 | 		seqp = seqp->ccid2s_next; | 
 | 		if (seqp == hctx->ccid2hctx_seqh) { | 
 | 			seqp = hctx->ccid2hctx_seqh->ccid2s_prev; | 
 | 			break; | 
 | 		} | 
 | 	} | 
 | 	done = 0; | 
 | 	while (1) { | 
 | 		if (seqp->ccid2s_acked) { | 
 | 			done++; | 
 | 			if (done == NUMDUPACK) | 
 | 				break; | 
 | 		} | 
 | 		if (seqp == hctx->ccid2hctx_seqt) | 
 | 			break; | 
 | 		seqp = seqp->ccid2s_prev; | 
 | 	} | 
 |  | 
 | 	/* If there are at least 3 acknowledgements, anything unacknowledged | 
 | 	 * below the last sequence number is considered lost | 
 | 	 */ | 
 | 	if (done == NUMDUPACK) { | 
 | 		struct ccid2_seq *last_acked = seqp; | 
 |  | 
 | 		/* check for lost packets */ | 
 | 		while (1) { | 
 | 			if (!seqp->ccid2s_acked) { | 
 | 				ccid2_pr_debug("Packet lost: %llu\n", | 
 | 					       (unsigned long long)seqp->ccid2s_seq); | 
 | 				/* XXX need to traverse from tail -> head in | 
 | 				 * order to detect multiple congestion events in | 
 | 				 * one ack vector. | 
 | 				 */ | 
 | 				ccid2_congestion_event(sk, seqp); | 
 | 				ccid2_hc_tx_dec_pipe(sk); | 
 | 			} | 
 | 			if (seqp == hctx->ccid2hctx_seqt) | 
 | 				break; | 
 | 			seqp = seqp->ccid2s_prev; | 
 | 		} | 
 |  | 
 | 		hctx->ccid2hctx_seqt = last_acked; | 
 | 	} | 
 |  | 
 | 	/* trim acked packets in tail */ | 
 | 	while (hctx->ccid2hctx_seqt != hctx->ccid2hctx_seqh) { | 
 | 		if (!hctx->ccid2hctx_seqt->ccid2s_acked) | 
 | 			break; | 
 |  | 
 | 		hctx->ccid2hctx_seqt = hctx->ccid2hctx_seqt->ccid2s_next; | 
 | 	} | 
 |  | 
 | 	ccid2_hc_tx_check_sanity(hctx); | 
 | } | 
 |  | 
 | static int ccid2_hc_tx_init(struct ccid *ccid, struct sock *sk) | 
 | { | 
 | 	struct ccid2_hc_tx_sock *hctx = ccid_priv(ccid); | 
 | 	struct dccp_sock *dp = dccp_sk(sk); | 
 | 	u32 max_ratio; | 
 |  | 
 | 	/* RFC 4341, 5: initialise ssthresh to arbitrarily high (max) value */ | 
 | 	hctx->ccid2hctx_ssthresh  = ~0U; | 
 |  | 
 | 	/* | 
 | 	 * RFC 4341, 5: "The cwnd parameter is initialized to at most four | 
 | 	 * packets for new connections, following the rules from [RFC3390]". | 
 | 	 * We need to convert the bytes of RFC3390 into the packets of RFC 4341. | 
 | 	 */ | 
 | 	hctx->ccid2hctx_cwnd = clamp(4380U / dp->dccps_mss_cache, 2U, 4U); | 
 |  | 
 | 	/* Make sure that Ack Ratio is enabled and within bounds. */ | 
 | 	max_ratio = DIV_ROUND_UP(hctx->ccid2hctx_cwnd, 2); | 
 | 	if (dp->dccps_l_ack_ratio == 0 || dp->dccps_l_ack_ratio > max_ratio) | 
 | 		dp->dccps_l_ack_ratio = max_ratio; | 
 |  | 
 | 	/* XXX init ~ to window size... */ | 
 | 	if (ccid2_hc_tx_alloc_seq(hctx)) | 
 | 		return -ENOMEM; | 
 |  | 
 | 	hctx->ccid2hctx_rto	 = 3 * HZ; | 
 | 	ccid2_change_srtt(hctx, -1); | 
 | 	hctx->ccid2hctx_rttvar	 = -1; | 
 | 	hctx->ccid2hctx_rpdupack = -1; | 
 | 	hctx->ccid2hctx_last_cong = jiffies; | 
 | 	setup_timer(&hctx->ccid2hctx_rtotimer, ccid2_hc_tx_rto_expire, | 
 | 			(unsigned long)sk); | 
 |  | 
 | 	ccid2_hc_tx_check_sanity(hctx); | 
 | 	return 0; | 
 | } | 
 |  | 
 | static void ccid2_hc_tx_exit(struct sock *sk) | 
 | { | 
 | 	struct ccid2_hc_tx_sock *hctx = ccid2_hc_tx_sk(sk); | 
 | 	int i; | 
 |  | 
 | 	ccid2_hc_tx_kill_rto_timer(sk); | 
 |  | 
 | 	for (i = 0; i < hctx->ccid2hctx_seqbufc; i++) | 
 | 		kfree(hctx->ccid2hctx_seqbuf[i]); | 
 | 	hctx->ccid2hctx_seqbufc = 0; | 
 | } | 
 |  | 
 | static void ccid2_hc_rx_packet_recv(struct sock *sk, struct sk_buff *skb) | 
 | { | 
 | 	const struct dccp_sock *dp = dccp_sk(sk); | 
 | 	struct ccid2_hc_rx_sock *hcrx = ccid2_hc_rx_sk(sk); | 
 |  | 
 | 	switch (DCCP_SKB_CB(skb)->dccpd_type) { | 
 | 	case DCCP_PKT_DATA: | 
 | 	case DCCP_PKT_DATAACK: | 
 | 		hcrx->ccid2hcrx_data++; | 
 | 		if (hcrx->ccid2hcrx_data >= dp->dccps_r_ack_ratio) { | 
 | 			dccp_send_ack(sk); | 
 | 			hcrx->ccid2hcrx_data = 0; | 
 | 		} | 
 | 		break; | 
 | 	} | 
 | } | 
 |  | 
 | struct ccid_operations ccid2_ops = { | 
 | 	.ccid_id		= DCCPC_CCID2, | 
 | 	.ccid_name		= "TCP-like", | 
 | 	.ccid_hc_tx_obj_size	= sizeof(struct ccid2_hc_tx_sock), | 
 | 	.ccid_hc_tx_init	= ccid2_hc_tx_init, | 
 | 	.ccid_hc_tx_exit	= ccid2_hc_tx_exit, | 
 | 	.ccid_hc_tx_send_packet	= ccid2_hc_tx_send_packet, | 
 | 	.ccid_hc_tx_packet_sent	= ccid2_hc_tx_packet_sent, | 
 | 	.ccid_hc_tx_packet_recv	= ccid2_hc_tx_packet_recv, | 
 | 	.ccid_hc_rx_obj_size	= sizeof(struct ccid2_hc_rx_sock), | 
 | 	.ccid_hc_rx_packet_recv	= ccid2_hc_rx_packet_recv, | 
 | }; | 
 |  | 
 | #ifdef CONFIG_IP_DCCP_CCID2_DEBUG | 
 | module_param(ccid2_debug, bool, 0644); | 
 | MODULE_PARM_DESC(ccid2_debug, "Enable CCID-2 debug messages"); | 
 | #endif |