xref: /openbmc/linux/net/dccp/ccids/ccid3.c (revision 179ebc9f)
17c657876SArnaldo Carvalho de Melo /*
27c657876SArnaldo Carvalho de Melo  *  net/dccp/ccids/ccid3.c
37c657876SArnaldo Carvalho de Melo  *
47c657876SArnaldo Carvalho de Melo  *  Copyright (c) 2005 The University of Waikato, Hamilton, New Zealand.
5e6bccd35SIan McDonald  *  Copyright (c) 2005-6 Ian McDonald <ian.mcdonald@jandi.co.nz>
67c657876SArnaldo Carvalho de Melo  *
77c657876SArnaldo Carvalho de Melo  *  An implementation of the DCCP protocol
87c657876SArnaldo Carvalho de Melo  *
97c657876SArnaldo Carvalho de Melo  *  This code has been developed by the University of Waikato WAND
107c657876SArnaldo Carvalho de Melo  *  research group. For further information please see http://www.wand.net.nz/
117c657876SArnaldo Carvalho de Melo  *
127c657876SArnaldo Carvalho de Melo  *  This code also uses code from Lulea University, rereleased as GPL by its
137c657876SArnaldo Carvalho de Melo  *  authors:
147c657876SArnaldo Carvalho de Melo  *  Copyright (c) 2003 Nils-Erik Mattsson, Joacim Haggmark, Magnus Erixzon
157c657876SArnaldo Carvalho de Melo  *
167c657876SArnaldo Carvalho de Melo  *  Changes to meet Linux coding standards, to make it meet latest ccid3 draft
177c657876SArnaldo Carvalho de Melo  *  and to make it work as a loadable module in the DCCP stack written by
187c657876SArnaldo Carvalho de Melo  *  Arnaldo Carvalho de Melo <acme@conectiva.com.br>.
197c657876SArnaldo Carvalho de Melo  *
207c657876SArnaldo Carvalho de Melo  *  Copyright (c) 2005 Arnaldo Carvalho de Melo <acme@conectiva.com.br>
217c657876SArnaldo Carvalho de Melo  *
227c657876SArnaldo Carvalho de Melo  *  This program is free software; you can redistribute it and/or modify
237c657876SArnaldo Carvalho de Melo  *  it under the terms of the GNU General Public License as published by
247c657876SArnaldo Carvalho de Melo  *  the Free Software Foundation; either version 2 of the License, or
257c657876SArnaldo Carvalho de Melo  *  (at your option) any later version.
267c657876SArnaldo Carvalho de Melo  *
277c657876SArnaldo Carvalho de Melo  *  This program is distributed in the hope that it will be useful,
287c657876SArnaldo Carvalho de Melo  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
297c657876SArnaldo Carvalho de Melo  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
307c657876SArnaldo Carvalho de Melo  *  GNU General Public License for more details.
317c657876SArnaldo Carvalho de Melo  *
327c657876SArnaldo Carvalho de Melo  *  You should have received a copy of the GNU General Public License
337c657876SArnaldo Carvalho de Melo  *  along with this program; if not, write to the Free Software
347c657876SArnaldo Carvalho de Melo  *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
357c657876SArnaldo Carvalho de Melo  */
367c657876SArnaldo Carvalho de Melo 
377c657876SArnaldo Carvalho de Melo #include "../ccid.h"
387c657876SArnaldo Carvalho de Melo #include "../dccp.h"
394524b259SArnaldo Carvalho de Melo #include "lib/packet_history.h"
40ae6706f0SArnaldo Carvalho de Melo #include "lib/loss_interval.h"
4136729c1aSArnaldo Carvalho de Melo #include "lib/tfrc.h"
427c657876SArnaldo Carvalho de Melo #include "ccid3.h"
437c657876SArnaldo Carvalho de Melo 
446b5e633aSArnaldo Carvalho de Melo /*
450ba7a3baSArnaldo Carvalho de Melo  * Reason for maths here is to avoid 32 bit overflow when a is big.
460ba7a3baSArnaldo Carvalho de Melo  * With this we get close to the limit.
476b5e633aSArnaldo Carvalho de Melo  */
48c25a18baSArnaldo Carvalho de Melo static u32 usecs_div(const u32 a, const u32 b)
496b5e633aSArnaldo Carvalho de Melo {
500ba7a3baSArnaldo Carvalho de Melo 	const u32 div = a < (UINT_MAX / (USEC_PER_SEC /    10)) ?    10 :
510ba7a3baSArnaldo Carvalho de Melo 			a < (UINT_MAX / (USEC_PER_SEC /    50)) ?    50 :
520ba7a3baSArnaldo Carvalho de Melo 			a < (UINT_MAX / (USEC_PER_SEC /   100)) ?   100 :
530ba7a3baSArnaldo Carvalho de Melo 			a < (UINT_MAX / (USEC_PER_SEC /   500)) ?   500 :
540ba7a3baSArnaldo Carvalho de Melo 			a < (UINT_MAX / (USEC_PER_SEC /  1000)) ?  1000 :
550ba7a3baSArnaldo Carvalho de Melo 			a < (UINT_MAX / (USEC_PER_SEC /  5000)) ?  5000 :
560ba7a3baSArnaldo Carvalho de Melo 			a < (UINT_MAX / (USEC_PER_SEC / 10000)) ? 10000 :
570ba7a3baSArnaldo Carvalho de Melo 			a < (UINT_MAX / (USEC_PER_SEC / 50000)) ? 50000 :
580ba7a3baSArnaldo Carvalho de Melo 								 100000;
590ba7a3baSArnaldo Carvalho de Melo 	const u32 tmp = a * (USEC_PER_SEC / div);
600ba7a3baSArnaldo Carvalho de Melo 	return (b >= 2 * div) ? tmp / (b / div) : tmp;
616b5e633aSArnaldo Carvalho de Melo }
626b5e633aSArnaldo Carvalho de Melo 
637c657876SArnaldo Carvalho de Melo 
6456724aa4SGerrit Renker 
6556724aa4SGerrit Renker #ifdef CONFIG_IP_DCCP_CCID3_DEBUG
6656724aa4SGerrit Renker static int ccid3_debug;
6756724aa4SGerrit Renker #define ccid3_pr_debug(format, a...)	DCCP_PR_DEBUG(ccid3_debug, format, ##a)
687c657876SArnaldo Carvalho de Melo #else
697c657876SArnaldo Carvalho de Melo #define ccid3_pr_debug(format, a...)
707c657876SArnaldo Carvalho de Melo #endif
717c657876SArnaldo Carvalho de Melo 
72a1d3a355SArnaldo Carvalho de Melo static struct dccp_tx_hist *ccid3_tx_hist;
73a1d3a355SArnaldo Carvalho de Melo static struct dccp_rx_hist *ccid3_rx_hist;
74ae6706f0SArnaldo Carvalho de Melo static struct dccp_li_hist *ccid3_li_hist;
757c657876SArnaldo Carvalho de Melo 
7656724aa4SGerrit Renker #ifdef CONFIG_IP_DCCP_CCID3_DEBUG
777c657876SArnaldo Carvalho de Melo static const char *ccid3_tx_state_name(enum ccid3_hc_tx_states state)
787c657876SArnaldo Carvalho de Melo {
797c657876SArnaldo Carvalho de Melo 	static char *ccid3_state_names[] = {
807c657876SArnaldo Carvalho de Melo 	[TFRC_SSTATE_NO_SENT]  = "NO_SENT",
817c657876SArnaldo Carvalho de Melo 	[TFRC_SSTATE_NO_FBACK] = "NO_FBACK",
827c657876SArnaldo Carvalho de Melo 	[TFRC_SSTATE_FBACK]    = "FBACK",
837c657876SArnaldo Carvalho de Melo 	[TFRC_SSTATE_TERM]     = "TERM",
847c657876SArnaldo Carvalho de Melo 	};
857c657876SArnaldo Carvalho de Melo 
867c657876SArnaldo Carvalho de Melo 	return ccid3_state_names[state];
877c657876SArnaldo Carvalho de Melo }
887c657876SArnaldo Carvalho de Melo #endif
897c657876SArnaldo Carvalho de Melo 
90c25a18baSArnaldo Carvalho de Melo static void ccid3_hc_tx_set_state(struct sock *sk,
911f2333aeSArnaldo Carvalho de Melo 				  enum ccid3_hc_tx_states state)
927c657876SArnaldo Carvalho de Melo {
9359725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
947c657876SArnaldo Carvalho de Melo 	enum ccid3_hc_tx_states oldstate = hctx->ccid3hctx_state;
957c657876SArnaldo Carvalho de Melo 
967c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s(%p) %-8.8s -> %s\n",
971f2333aeSArnaldo Carvalho de Melo 		       dccp_role(sk), sk, ccid3_tx_state_name(oldstate),
981f2333aeSArnaldo Carvalho de Melo 		       ccid3_tx_state_name(state));
997c657876SArnaldo Carvalho de Melo 	WARN_ON(state == oldstate);
1007c657876SArnaldo Carvalho de Melo 	hctx->ccid3hctx_state = state;
1017c657876SArnaldo Carvalho de Melo }
1027c657876SArnaldo Carvalho de Melo 
10317893bc1SGerrit Renker /*
10417893bc1SGerrit Renker  * Recalculate scheduled nominal send time t_nom, inter-packet interval
10517893bc1SGerrit Renker  * t_ipi, and delta value. Should be called after each change to X.
10617893bc1SGerrit Renker  */
10717893bc1SGerrit Renker static inline void ccid3_update_send_time(struct ccid3_hc_tx_sock *hctx)
1087c657876SArnaldo Carvalho de Melo {
10917893bc1SGerrit Renker 	timeval_sub_usecs(&hctx->ccid3hctx_t_nom, hctx->ccid3hctx_t_ipi);
11017893bc1SGerrit Renker 
11117893bc1SGerrit Renker 	/* Calculate new t_ipi (inter packet interval) by t_ipi = s / X_inst */
112f5c2d636SGerrit Renker 	hctx->ccid3hctx_t_ipi = usecs_div(hctx->ccid3hctx_s, hctx->ccid3hctx_x);
11317893bc1SGerrit Renker 
11417893bc1SGerrit Renker 	/* Update nominal send time with regard to the new t_ipi */
11517893bc1SGerrit Renker 	timeval_add_usecs(&hctx->ccid3hctx_t_nom, hctx->ccid3hctx_t_ipi);
1167c657876SArnaldo Carvalho de Melo 
1177c657876SArnaldo Carvalho de Melo 	/* Calculate new delta by delta = min(t_ipi / 2, t_gran / 2) */
1181f2333aeSArnaldo Carvalho de Melo 	hctx->ccid3hctx_delta = min_t(u32, hctx->ccid3hctx_t_ipi / 2,
1191f2333aeSArnaldo Carvalho de Melo 					   TFRC_OPSYS_HALF_TIME_GRAN);
1207c657876SArnaldo Carvalho de Melo }
1217c657876SArnaldo Carvalho de Melo /*
1227c657876SArnaldo Carvalho de Melo  * Update X by
1237c657876SArnaldo Carvalho de Melo  *    If (p > 0)
1245c3fbb6aSGerrit Renker  *       X_calc = calcX(s, R, p);
1257c657876SArnaldo Carvalho de Melo  *       X = max(min(X_calc, 2 * X_recv), s / t_mbi);
1267c657876SArnaldo Carvalho de Melo  *    Else
1277c657876SArnaldo Carvalho de Melo  *       If (now - tld >= R)
1287c657876SArnaldo Carvalho de Melo  *          X = max(min(2 * X, 2 * X_recv), s / R);
1297c657876SArnaldo Carvalho de Melo  *          tld = now;
1305c3fbb6aSGerrit Renker  *
1315c3fbb6aSGerrit Renker  * If X has changed, we also update the scheduled send time t_now,
1325c3fbb6aSGerrit Renker  * the inter-packet interval t_ipi, and the delta value.
1337c657876SArnaldo Carvalho de Melo  */
134a79ef76fSGerrit Renker static void ccid3_hc_tx_update_x(struct sock *sk, struct timeval *now)
135a79ef76fSGerrit Renker 
1367c657876SArnaldo Carvalho de Melo {
13759725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
13817893bc1SGerrit Renker 	const __u32 old_x = hctx->ccid3hctx_x;
1397c657876SArnaldo Carvalho de Melo 
14044158306SGerrit Renker 	if (hctx->ccid3hctx_p > 0) {
141a79ef76fSGerrit Renker 		hctx->ccid3hctx_x = max_t(u32, min(hctx->ccid3hctx_x_calc,
142a79ef76fSGerrit Renker 						   hctx->ccid3hctx_x_recv * 2),
143a79ef76fSGerrit Renker 					       hctx->ccid3hctx_s / TFRC_T_MBI);
144b6ee3d4aSArnaldo Carvalho de Melo 
145a79ef76fSGerrit Renker 	} else if (timeval_delta(now, &hctx->ccid3hctx_t_ld) >=
146b6ee3d4aSArnaldo Carvalho de Melo 							  hctx->ccid3hctx_rtt) {
147a79ef76fSGerrit Renker 		hctx->ccid3hctx_x = max(min(hctx->ccid3hctx_x_recv,
1486b5e633aSArnaldo Carvalho de Melo 					    hctx->ccid3hctx_x      ) * 2,
1496b5e633aSArnaldo Carvalho de Melo 					usecs_div(hctx->ccid3hctx_s,
1506b5e633aSArnaldo Carvalho de Melo 					       	  hctx->ccid3hctx_rtt)   );
151a79ef76fSGerrit Renker 		hctx->ccid3hctx_t_ld = *now;
152ff586298SGerrit Renker 	}
153a79ef76fSGerrit Renker 
15417893bc1SGerrit Renker 	if (hctx->ccid3hctx_x != old_x)
15517893bc1SGerrit Renker 		ccid3_update_send_time(hctx);
1567c657876SArnaldo Carvalho de Melo }
1577c657876SArnaldo Carvalho de Melo 
15878ad713dSGerrit Renker /*
15978ad713dSGerrit Renker  * 	Track the mean packet size `s' (cf. RFC 4342, 5.3 and  RFC 3448, 4.1)
16078ad713dSGerrit Renker  * 	@len: DCCP packet payload size in bytes
16178ad713dSGerrit Renker  */
16278ad713dSGerrit Renker static inline void ccid3_hc_tx_update_s(struct ccid3_hc_tx_sock *hctx, int len)
16378ad713dSGerrit Renker {
16478ad713dSGerrit Renker 	if (unlikely(len == 0))
16578ad713dSGerrit Renker 		ccid3_pr_debug("Packet payload length is 0 - not updating\n");
16678ad713dSGerrit Renker 	else
16778ad713dSGerrit Renker 		hctx->ccid3hctx_s = hctx->ccid3hctx_s == 0 ? len :
16878ad713dSGerrit Renker 				    (9 * hctx->ccid3hctx_s + len) / 10;
16978ad713dSGerrit Renker 	/*
17078ad713dSGerrit Renker 	 * Note: We could do a potential optimisation here - when `s' changes,
17178ad713dSGerrit Renker 	 *	 recalculate sending rate and consequently t_ipi, t_delta, and
17278ad713dSGerrit Renker 	 *	 t_now. This is however non-standard, and the benefits are not
17378ad713dSGerrit Renker 	 *	 clear, so it is currently left out.
17478ad713dSGerrit Renker 	 */
17578ad713dSGerrit Renker }
17678ad713dSGerrit Renker 
1777c657876SArnaldo Carvalho de Melo static void ccid3_hc_tx_no_feedback_timer(unsigned long data)
1787c657876SArnaldo Carvalho de Melo {
1797c657876SArnaldo Carvalho de Melo 	struct sock *sk = (struct sock *)data;
18059725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
1812a1fda6fSGerrit Renker 	unsigned long t_nfb = USEC_PER_SEC / 5;
1827c657876SArnaldo Carvalho de Melo 
1837c657876SArnaldo Carvalho de Melo 	bh_lock_sock(sk);
1847c657876SArnaldo Carvalho de Melo 	if (sock_owned_by_user(sk)) {
1857c657876SArnaldo Carvalho de Melo 		/* Try again later. */
1867c657876SArnaldo Carvalho de Melo 		/* XXX: set some sensible MIB */
18748e03eeeSGerrit Renker 		goto restart_timer;
1887c657876SArnaldo Carvalho de Melo 	}
1897c657876SArnaldo Carvalho de Melo 
1907c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p, state=%s\n", dccp_role(sk), sk,
1917c657876SArnaldo Carvalho de Melo 		       ccid3_tx_state_name(hctx->ccid3hctx_state));
1927c657876SArnaldo Carvalho de Melo 
1937c657876SArnaldo Carvalho de Melo 	switch (hctx->ccid3hctx_state) {
1947c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_FBACK:
195a79ef76fSGerrit Renker 		/* RFC 3448, 4.4: Halve send rate directly */
196179ebc9fSGerrit Renker 		hctx->ccid3hctx_x = max_t(u32, hctx->ccid3hctx_x / 2,
197a79ef76fSGerrit Renker 					       hctx->ccid3hctx_s / TFRC_T_MBI);
1987c657876SArnaldo Carvalho de Melo 
1991f2333aeSArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p, state=%s, updated tx rate to %d "
2001f2333aeSArnaldo Carvalho de Melo 			       "bytes/s\n",
2011f2333aeSArnaldo Carvalho de Melo 			       dccp_role(sk), sk,
2021f2333aeSArnaldo Carvalho de Melo 			       ccid3_tx_state_name(hctx->ccid3hctx_state),
2037c657876SArnaldo Carvalho de Melo 			       hctx->ccid3hctx_x);
20448e03eeeSGerrit Renker 		/* The value of R is still undefined and so we can not recompute
20548e03eeeSGerrit Renker 		 * the timout value. Keep initial value as per [RFC 4342, 5]. */
2062a1fda6fSGerrit Renker 		t_nfb = TFRC_INITIAL_TIMEOUT;
20717893bc1SGerrit Renker 		ccid3_update_send_time(hctx);
2087c657876SArnaldo Carvalho de Melo 		break;
2097c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_FBACK:
2101f2333aeSArnaldo Carvalho de Melo 		/*
2111f2333aeSArnaldo Carvalho de Melo 		 * Check if IDLE since last timeout and recv rate is less than
2121f2333aeSArnaldo Carvalho de Melo 		 * 4 packets per RTT
2131f2333aeSArnaldo Carvalho de Melo 		 */
2141f2333aeSArnaldo Carvalho de Melo 		if (!hctx->ccid3hctx_idle ||
2156b5e633aSArnaldo Carvalho de Melo 		    (hctx->ccid3hctx_x_recv >=
2166b5e633aSArnaldo Carvalho de Melo 		     4 * usecs_div(hctx->ccid3hctx_s, hctx->ccid3hctx_rtt))) {
217a79ef76fSGerrit Renker 			struct timeval now;
218a79ef76fSGerrit Renker 
2191f2333aeSArnaldo Carvalho de Melo 			ccid3_pr_debug("%s, sk=%p, state=%s, not idle\n",
2201f2333aeSArnaldo Carvalho de Melo 				       dccp_role(sk), sk,
2217c657876SArnaldo Carvalho de Melo 				       ccid3_tx_state_name(hctx->ccid3hctx_state));
2227c657876SArnaldo Carvalho de Melo 
223ff586298SGerrit Renker 			/*
224ff586298SGerrit Renker 			 *  Modify the cached value of X_recv [RFC 3448, 4.4]
225ff586298SGerrit Renker 			 *
226ff586298SGerrit Renker 			 *  If (p == 0 || X_calc > 2 * X_recv)
2277c657876SArnaldo Carvalho de Melo 			 *    X_recv = max(X_recv / 2, s / (2 * t_mbi));
2287c657876SArnaldo Carvalho de Melo 			 *  Else
2297c657876SArnaldo Carvalho de Melo 			 *    X_recv = X_calc / 4;
2307c657876SArnaldo Carvalho de Melo 			 */
23144158306SGerrit Renker 			BUG_ON(hctx->ccid3hctx_p && !hctx->ccid3hctx_x_calc);
2327c657876SArnaldo Carvalho de Melo 
23344158306SGerrit Renker 			if (hctx->ccid3hctx_p  == 0 ||
234ff586298SGerrit Renker 			    hctx->ccid3hctx_x_calc > 2 * hctx->ccid3hctx_x_recv)  {
2357c657876SArnaldo Carvalho de Melo 				hctx->ccid3hctx_x_recv = max_t(u32, hctx->ccid3hctx_x_recv / 2,
236a79ef76fSGerrit Renker 								    hctx->ccid3hctx_s / (2 * TFRC_T_MBI));
237ff586298SGerrit Renker 				if (hctx->ccid3hctx_p == 0)
238ff586298SGerrit Renker 					dccp_timestamp(sk, &now);
239ff586298SGerrit Renker 			} else
2407c657876SArnaldo Carvalho de Melo 				hctx->ccid3hctx_x_recv = hctx->ccid3hctx_x_calc / 4;
2417c657876SArnaldo Carvalho de Melo 
242ff586298SGerrit Renker 			/* Now recalculate X [RFC 3448, 4.3, step (4)] */
243a79ef76fSGerrit Renker 			ccid3_hc_tx_update_x(sk, &now);
2447c657876SArnaldo Carvalho de Melo 		}
2456b5e633aSArnaldo Carvalho de Melo 		/*
2466b5e633aSArnaldo Carvalho de Melo 		 * Schedule no feedback timer to expire in
2478a508ac2SGerrit Renker 		 * max(t_RTO, 2 * s/X)  =  max(t_RTO, 2 * t_ipi)
2488a508ac2SGerrit Renker 		 * See comments in packet_recv() regarding the value of t_RTO.
2496b5e633aSArnaldo Carvalho de Melo 		 */
2508a508ac2SGerrit Renker 		t_nfb = max(hctx->ccid3hctx_t_rto, 2 * hctx->ccid3hctx_t_ipi);
2517c657876SArnaldo Carvalho de Melo 		break;
25259348b19SGerrit Renker 	case TFRC_SSTATE_NO_SENT:
25359348b19SGerrit Renker 		DCCP_BUG("Illegal %s state NO_SENT, sk=%p", dccp_role(sk), sk);
25459348b19SGerrit Renker 		/* fall through */
25559348b19SGerrit Renker 	case TFRC_SSTATE_TERM:
2567c657876SArnaldo Carvalho de Melo 		goto out;
2577c657876SArnaldo Carvalho de Melo 	}
2587c657876SArnaldo Carvalho de Melo 
2597c657876SArnaldo Carvalho de Melo 	hctx->ccid3hctx_idle = 1;
26048e03eeeSGerrit Renker 
26148e03eeeSGerrit Renker restart_timer:
26248e03eeeSGerrit Renker 	sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
2632a1fda6fSGerrit Renker 		           jiffies + usecs_to_jiffies(t_nfb));
2647c657876SArnaldo Carvalho de Melo out:
2657c657876SArnaldo Carvalho de Melo 	bh_unlock_sock(sk);
2667c657876SArnaldo Carvalho de Melo 	sock_put(sk);
2677c657876SArnaldo Carvalho de Melo }
2687c657876SArnaldo Carvalho de Melo 
2697da7f456SGerrit Renker /*
2707da7f456SGerrit Renker  * returns
2717da7f456SGerrit Renker  *   > 0: delay (in msecs) that should pass before actually sending
2727da7f456SGerrit Renker  *   = 0: can send immediately
2737da7f456SGerrit Renker  *   < 0: error condition; do not send packet
2747da7f456SGerrit Renker  */
2756b57c93dSGerrit Renker static int ccid3_hc_tx_send_packet(struct sock *sk, struct sk_buff *skb)
2767c657876SArnaldo Carvalho de Melo {
2777c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
27859725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
2798c60f3faSArnaldo Carvalho de Melo 	struct dccp_tx_hist_entry *new_packet;
2807c657876SArnaldo Carvalho de Melo 	struct timeval now;
28127258ee5SArnaldo Carvalho de Melo 	long delay;
2827c657876SArnaldo Carvalho de Melo 
28359348b19SGerrit Renker 	BUG_ON(hctx == NULL);
2841f2333aeSArnaldo Carvalho de Melo 
2857c657876SArnaldo Carvalho de Melo 	/*
286da335bafSGerrit Renker 	 * This function is called only for Data and DataAck packets. Sending
287da335bafSGerrit Renker 	 * zero-sized Data(Ack)s is theoretically possible, but for congestion
288da335bafSGerrit Renker 	 * control this case is pathological - ignore it.
2897c657876SArnaldo Carvalho de Melo 	 */
2906b57c93dSGerrit Renker 	if (unlikely(skb->len == 0))
291da335bafSGerrit Renker 		return -EBADMSG;
2927c657876SArnaldo Carvalho de Melo 
2937c657876SArnaldo Carvalho de Melo 	/* See if last packet allocated was not sent */
2948c60f3faSArnaldo Carvalho de Melo 	new_packet = dccp_tx_hist_head(&hctx->ccid3hctx_hist);
2958c60f3faSArnaldo Carvalho de Melo 	if (new_packet == NULL || new_packet->dccphtx_sent) {
2961f2333aeSArnaldo Carvalho de Melo 		new_packet = dccp_tx_hist_entry_new(ccid3_tx_hist,
29754e6ecb2SChristoph Lameter 						    GFP_ATOMIC);
2987c657876SArnaldo Carvalho de Melo 
29959d203f9SArnaldo Carvalho de Melo 		if (unlikely(new_packet == NULL)) {
30059348b19SGerrit Renker 			DCCP_WARN("%s, sk=%p, not enough mem to add to history,"
30159348b19SGerrit Renker 				  "send refused\n", dccp_role(sk), sk);
3027da7f456SGerrit Renker 			return -ENOBUFS;
3037c657876SArnaldo Carvalho de Melo 		}
3047c657876SArnaldo Carvalho de Melo 
3058c60f3faSArnaldo Carvalho de Melo 		dccp_tx_hist_add_entry(&hctx->ccid3hctx_hist, new_packet);
3067c657876SArnaldo Carvalho de Melo 	}
3077c657876SArnaldo Carvalho de Melo 
308b0e56780SArnaldo Carvalho de Melo 	dccp_timestamp(sk, &now);
3097c657876SArnaldo Carvalho de Melo 
3107c657876SArnaldo Carvalho de Melo 	switch (hctx->ccid3hctx_state) {
3117c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_SENT:
3121f2333aeSArnaldo Carvalho de Melo 		sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
3131f2333aeSArnaldo Carvalho de Melo 			       jiffies + usecs_to_jiffies(TFRC_INITIAL_TIMEOUT));
3147c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_last_win_count	 = 0;
3157c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_t_last_win_count = now;
3167c657876SArnaldo Carvalho de Melo 		ccid3_hc_tx_set_state(sk, TFRC_SSTATE_NO_FBACK);
3177c657876SArnaldo Carvalho de Melo 
31878ad713dSGerrit Renker 		/* Set initial sending rate to 1 packet per second */
3196b57c93dSGerrit Renker 		ccid3_hc_tx_update_s(hctx, skb->len);
32078ad713dSGerrit Renker 		hctx->ccid3hctx_x     = hctx->ccid3hctx_s;
32178ad713dSGerrit Renker 
32290feeb95SGerrit Renker 		/* First timeout, according to [RFC 3448, 4.2], is 1 second */
32390feeb95SGerrit Renker 		hctx->ccid3hctx_t_ipi = USEC_PER_SEC;
32490feeb95SGerrit Renker 		/* Initial delta: minimum of 0.5 sec and t_gran/2 */
32590feeb95SGerrit Renker 		hctx->ccid3hctx_delta = TFRC_OPSYS_HALF_TIME_GRAN;
32690feeb95SGerrit Renker 
32790feeb95SGerrit Renker 		/* Set t_0 for initial packet */
3287c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_t_nom = now;
3297c657876SArnaldo Carvalho de Melo 		break;
3307c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_FBACK:
3317c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_FBACK:
33291cf5a17SGerrit Renker 		delay = timeval_delta(&hctx->ccid3hctx_t_nom, &now);
33391cf5a17SGerrit Renker 		/*
33491cf5a17SGerrit Renker 		 * 	Scheduling of packet transmissions [RFC 3448, 4.6]
33591cf5a17SGerrit Renker 		 *
33691cf5a17SGerrit Renker 		 * if (t_now > t_nom - delta)
33791cf5a17SGerrit Renker 		 *       // send the packet now
33891cf5a17SGerrit Renker 		 * else
33991cf5a17SGerrit Renker 		 *       // send the packet in (t_nom - t_now) milliseconds.
34091cf5a17SGerrit Renker 		 */
34176d12777SGerrit Renker 		if (delay - (long)hctx->ccid3hctx_delta >= 0)
3427da7f456SGerrit Renker 			return delay / 1000L;
3437c657876SArnaldo Carvalho de Melo 		break;
34459348b19SGerrit Renker 	case TFRC_SSTATE_TERM:
34559348b19SGerrit Renker 		DCCP_BUG("Illegal %s state TERM, sk=%p", dccp_role(sk), sk);
3467da7f456SGerrit Renker 		return -EINVAL;
3477c657876SArnaldo Carvalho de Melo 	}
3487c657876SArnaldo Carvalho de Melo 
3497da7f456SGerrit Renker 	/* prepare to send now (add options etc.) */
350507d37cfSArnaldo Carvalho de Melo 	dp->dccps_hc_tx_insert_options = 1;
3517da7f456SGerrit Renker 	new_packet->dccphtx_ccval = DCCP_SKB_CB(skb)->dccpd_ccval =
3528c60f3faSArnaldo Carvalho de Melo 				    hctx->ccid3hctx_last_win_count;
3537da7f456SGerrit Renker 	timeval_add_usecs(&hctx->ccid3hctx_t_nom, hctx->ccid3hctx_t_ipi);
3547da7f456SGerrit Renker 
3557da7f456SGerrit Renker 	return 0;
3567c657876SArnaldo Carvalho de Melo }
3577c657876SArnaldo Carvalho de Melo 
3586b57c93dSGerrit Renker static void ccid3_hc_tx_packet_sent(struct sock *sk, int more, unsigned int len)
3597c657876SArnaldo Carvalho de Melo {
36059725dc2SArnaldo Carvalho de Melo 	const struct dccp_sock *dp = dccp_sk(sk);
36159725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
3627c657876SArnaldo Carvalho de Melo 	struct timeval now;
3636b57c93dSGerrit Renker 	unsigned long quarter_rtt;
3646b57c93dSGerrit Renker 	struct dccp_tx_hist_entry *packet;
3657c657876SArnaldo Carvalho de Melo 
36659348b19SGerrit Renker 	BUG_ON(hctx == NULL);
3677c657876SArnaldo Carvalho de Melo 
368b0e56780SArnaldo Carvalho de Melo 	dccp_timestamp(sk, &now);
3697c657876SArnaldo Carvalho de Melo 
37078ad713dSGerrit Renker 	ccid3_hc_tx_update_s(hctx, len);
37178ad713dSGerrit Renker 
3728c60f3faSArnaldo Carvalho de Melo 	packet = dccp_tx_hist_head(&hctx->ccid3hctx_hist);
37359d203f9SArnaldo Carvalho de Melo 	if (unlikely(packet == NULL)) {
37459348b19SGerrit Renker 		DCCP_WARN("packet doesn't exist in history!\n");
3757c657876SArnaldo Carvalho de Melo 		return;
3767c657876SArnaldo Carvalho de Melo 	}
37759d203f9SArnaldo Carvalho de Melo 	if (unlikely(packet->dccphtx_sent)) {
37859348b19SGerrit Renker 		DCCP_WARN("no unsent packet in history!\n");
3797c657876SArnaldo Carvalho de Melo 		return;
3807c657876SArnaldo Carvalho de Melo 	}
3818c60f3faSArnaldo Carvalho de Melo 	packet->dccphtx_tstamp = now;
3828c60f3faSArnaldo Carvalho de Melo 	packet->dccphtx_seqno  = dp->dccps_gss;
3837c657876SArnaldo Carvalho de Melo 	/*
3841f2333aeSArnaldo Carvalho de Melo 	 * Check if win_count have changed
3850e64e94eSGerrit Renker 	 * Algorithm in "8.1. Window Counter Value" in RFC 4342.
3867c657876SArnaldo Carvalho de Melo 	 */
3876b5e633aSArnaldo Carvalho de Melo 	quarter_rtt = timeval_delta(&now, &hctx->ccid3hctx_t_last_win_count);
3886b5e633aSArnaldo Carvalho de Melo 	if (likely(hctx->ccid3hctx_rtt > 8))
3896b5e633aSArnaldo Carvalho de Melo 		quarter_rtt /= hctx->ccid3hctx_rtt / 4;
3906b5e633aSArnaldo Carvalho de Melo 
3917c657876SArnaldo Carvalho de Melo 	if (quarter_rtt > 0) {
3927c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_t_last_win_count = now;
3937c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_last_win_count	 = (hctx->ccid3hctx_last_win_count +
3947c657876SArnaldo Carvalho de Melo 						    min_t(unsigned long, quarter_rtt, 5)) % 16;
3951f2333aeSArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p, window changed from "
3961f2333aeSArnaldo Carvalho de Melo 			       "%u to %u!\n",
3977c657876SArnaldo Carvalho de Melo 			       dccp_role(sk), sk,
398c1734376SArnaldo Carvalho de Melo 			       packet->dccphtx_ccval,
3997c657876SArnaldo Carvalho de Melo 			       hctx->ccid3hctx_last_win_count);
4007c657876SArnaldo Carvalho de Melo 	}
4011f2333aeSArnaldo Carvalho de Melo 
4027c657876SArnaldo Carvalho de Melo 	hctx->ccid3hctx_idle = 0;
403c1734376SArnaldo Carvalho de Melo 	packet->dccphtx_rtt  = hctx->ccid3hctx_rtt;
4048c60f3faSArnaldo Carvalho de Melo 	packet->dccphtx_sent = 1;
4057c657876SArnaldo Carvalho de Melo }
4067c657876SArnaldo Carvalho de Melo 
4077c657876SArnaldo Carvalho de Melo static void ccid3_hc_tx_packet_recv(struct sock *sk, struct sk_buff *skb)
4087c657876SArnaldo Carvalho de Melo {
40959725dc2SArnaldo Carvalho de Melo 	const struct dccp_sock *dp = dccp_sk(sk);
41059725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
4117c657876SArnaldo Carvalho de Melo 	struct ccid3_options_received *opt_recv;
4128c60f3faSArnaldo Carvalho de Melo 	struct dccp_tx_hist_entry *packet;
413b0e56780SArnaldo Carvalho de Melo 	struct timeval now;
4142a1fda6fSGerrit Renker 	unsigned long t_nfb;
4157c657876SArnaldo Carvalho de Melo 	u32 pinv;
4165c3fbb6aSGerrit Renker 	long r_sample, t_elapsed;
4171f2333aeSArnaldo Carvalho de Melo 
41859348b19SGerrit Renker 	BUG_ON(hctx == NULL);
4197c657876SArnaldo Carvalho de Melo 
4207c657876SArnaldo Carvalho de Melo 	/* we are only interested in ACKs */
4217c657876SArnaldo Carvalho de Melo 	if (!(DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_ACK ||
4227c657876SArnaldo Carvalho de Melo 	      DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_DATAACK))
4237c657876SArnaldo Carvalho de Melo 		return;
4247c657876SArnaldo Carvalho de Melo 
4257c657876SArnaldo Carvalho de Melo 	opt_recv = &hctx->ccid3hctx_options_received;
4267c657876SArnaldo Carvalho de Melo 
4277c657876SArnaldo Carvalho de Melo 	switch (hctx->ccid3hctx_state) {
4287c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_FBACK:
4297c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_FBACK:
4305c3fbb6aSGerrit Renker 		/* get packet from history to look up t_recvdata */
4318c60f3faSArnaldo Carvalho de Melo 		packet = dccp_tx_hist_find_entry(&hctx->ccid3hctx_hist,
4328c60f3faSArnaldo Carvalho de Melo 						 DCCP_SKB_CB(skb)->dccpd_ack_seq);
43359d203f9SArnaldo Carvalho de Melo 		if (unlikely(packet == NULL)) {
4345c3fbb6aSGerrit Renker 			DCCP_WARN("%s(%p), seqno %llu(%s) doesn't exist "
43559348b19SGerrit Renker 				  "in history!\n",  dccp_role(sk), sk,
43659d203f9SArnaldo Carvalho de Melo 			    (unsigned long long)DCCP_SKB_CB(skb)->dccpd_ack_seq,
4377c657876SArnaldo Carvalho de Melo 				  dccp_packet_name(DCCP_SKB_CB(skb)->dccpd_type));
4387c657876SArnaldo Carvalho de Melo 			return;
4397c657876SArnaldo Carvalho de Melo 		}
4407c657876SArnaldo Carvalho de Melo 
4415c3fbb6aSGerrit Renker 		/* Update receive rate */
4425c3fbb6aSGerrit Renker 		hctx->ccid3hctx_x_recv = opt_recv->ccid3or_receive_rate;
4435c3fbb6aSGerrit Renker 
4445c3fbb6aSGerrit Renker 		/* Update loss event rate */
4455c3fbb6aSGerrit Renker 		pinv = opt_recv->ccid3or_loss_event_rate;
44645393a66SGerrit Renker 		if (pinv == ~0U || pinv == 0)	       /* see RFC 4342, 8.5   */
4475c3fbb6aSGerrit Renker 			hctx->ccid3hctx_p = 0;
44845393a66SGerrit Renker 		else				       /* can not exceed 100% */
4495c3fbb6aSGerrit Renker  			hctx->ccid3hctx_p = 1000000 / pinv;
4505c3fbb6aSGerrit Renker 
451b0e56780SArnaldo Carvalho de Melo 		dccp_timestamp(sk, &now);
4525c3fbb6aSGerrit Renker 
4535c3fbb6aSGerrit Renker 		/*
4545c3fbb6aSGerrit Renker 		 * Calculate new round trip sample as per [RFC 3448, 4.3] by
4555c3fbb6aSGerrit Renker 		 * 	R_sample  =  (now - t_recvdata) - t_elapsed
4565c3fbb6aSGerrit Renker 		 */
457b0e56780SArnaldo Carvalho de Melo 		r_sample  = timeval_delta(&now, &packet->dccphtx_tstamp);
4585c3fbb6aSGerrit Renker 		t_elapsed = dp->dccps_options_received.dccpor_elapsed_time * 10;
4595c3fbb6aSGerrit Renker 
4605c3fbb6aSGerrit Renker 		if (unlikely(r_sample <= 0)) {
4615c3fbb6aSGerrit Renker 			DCCP_WARN("WARNING: R_sample (%ld) <= 0!\n", r_sample);
4625c3fbb6aSGerrit Renker 			r_sample = 0;
4635c3fbb6aSGerrit Renker 		} else if (unlikely(r_sample <= t_elapsed))
4645c3fbb6aSGerrit Renker 			DCCP_WARN("WARNING: r_sample=%ldus <= t_elapsed=%ldus\n",
46559348b19SGerrit Renker 				  r_sample, t_elapsed);
4661a28599aSArnaldo Carvalho de Melo 		else
4671a28599aSArnaldo Carvalho de Melo 			r_sample -= t_elapsed;
4687c657876SArnaldo Carvalho de Melo 
4697c657876SArnaldo Carvalho de Melo 		/* Update RTT estimate by
4707c657876SArnaldo Carvalho de Melo 		 * If (No feedback recv)
4717c657876SArnaldo Carvalho de Melo 		 *    R = R_sample;
4727c657876SArnaldo Carvalho de Melo 		 * Else
4737c657876SArnaldo Carvalho de Melo 		 *    R = q * R + (1 - q) * R_sample;
4747c657876SArnaldo Carvalho de Melo 		 *
4757c657876SArnaldo Carvalho de Melo 		 * q is a constant, RFC 3448 recomments 0.9
4767c657876SArnaldo Carvalho de Melo 		 */
4777c657876SArnaldo Carvalho de Melo 		if (hctx->ccid3hctx_state == TFRC_SSTATE_NO_FBACK) {
478a79ef76fSGerrit Renker 			/* Use Larger Initial Windows [RFC 4342, sec. 5]
479a79ef76fSGerrit Renker 			 * We deviate in that we use `s' instead of `MSS'. */
480179ebc9fSGerrit Renker 			u16 w_init = min(    4 * hctx->ccid3hctx_s,
481a79ef76fSGerrit Renker 					 max(2 * hctx->ccid3hctx_s, 4380));
4827c657876SArnaldo Carvalho de Melo 			hctx->ccid3hctx_rtt  = r_sample;
483a79ef76fSGerrit Renker 			hctx->ccid3hctx_x    = usecs_div(w_init, r_sample);
484a79ef76fSGerrit Renker 			hctx->ccid3hctx_t_ld = now;
485a79ef76fSGerrit Renker 
486a79ef76fSGerrit Renker 			ccid3_update_send_time(hctx);
4875c3fbb6aSGerrit Renker 
4885c3fbb6aSGerrit Renker 			ccid3_pr_debug("%s(%p), s=%u, w_init=%u, "
4895c3fbb6aSGerrit Renker 				       "R_sample=%ldus, X=%u\n", dccp_role(sk),
4905c3fbb6aSGerrit Renker 				       sk, hctx->ccid3hctx_s, w_init, r_sample,
4915c3fbb6aSGerrit Renker 				       hctx->ccid3hctx_x);
4925c3fbb6aSGerrit Renker 
493a79ef76fSGerrit Renker 			ccid3_hc_tx_set_state(sk, TFRC_SSTATE_FBACK);
494a79ef76fSGerrit Renker 		} else {
4955c3fbb6aSGerrit Renker 			hctx->ccid3hctx_rtt = (9 * hctx->ccid3hctx_rtt +
4965c3fbb6aSGerrit Renker 					           (u32)r_sample        ) / 10;
4975c3fbb6aSGerrit Renker 
498ff586298SGerrit Renker 			/* Update sending rate (step 4 of [RFC 3448, 4.3]) */
499ff586298SGerrit Renker 			if (hctx->ccid3hctx_p > 0)
500ff586298SGerrit Renker 				hctx->ccid3hctx_x_calc =
501ff586298SGerrit Renker 					tfrc_calc_x(hctx->ccid3hctx_s,
502ff586298SGerrit Renker 						    hctx->ccid3hctx_rtt,
503ff586298SGerrit Renker 						    hctx->ccid3hctx_p);
504a79ef76fSGerrit Renker 			ccid3_hc_tx_update_x(sk, &now);
5057c657876SArnaldo Carvalho de Melo 
5065c3fbb6aSGerrit Renker 			ccid3_pr_debug("%s(%p), RTT=%uus (sample=%ldus), s=%u, "
5075c3fbb6aSGerrit Renker 				       "p=%u, X_calc=%u, X=%u\n", dccp_role(sk),
5085c3fbb6aSGerrit Renker 				       sk, hctx->ccid3hctx_rtt, r_sample,
5095c3fbb6aSGerrit Renker 				       hctx->ccid3hctx_s, hctx->ccid3hctx_p,
5105c3fbb6aSGerrit Renker 				       hctx->ccid3hctx_x_calc,
5115c3fbb6aSGerrit Renker 				       hctx->ccid3hctx_x);
5127c657876SArnaldo Carvalho de Melo 		}
5137c657876SArnaldo Carvalho de Melo 
5147c657876SArnaldo Carvalho de Melo 		/* unschedule no feedback timer */
5157c657876SArnaldo Carvalho de Melo 		sk_stop_timer(sk, &hctx->ccid3hctx_no_feedback_timer);
5167c657876SArnaldo Carvalho de Melo 
5177c657876SArnaldo Carvalho de Melo 		/* remove all packets older than the one acked from history */
5188c60f3faSArnaldo Carvalho de Melo 		dccp_tx_hist_purge_older(ccid3_tx_hist,
5198c60f3faSArnaldo Carvalho de Melo 					 &hctx->ccid3hctx_hist, packet);
520c530cfb1SArnaldo Carvalho de Melo 		/*
521c530cfb1SArnaldo Carvalho de Melo 		 * As we have calculated new ipi, delta, t_nom it is possible that
5225d0dbc4aSGerrit Renker 		 * we now can send a packet, so wake up dccp_wait_for_ccid
523c530cfb1SArnaldo Carvalho de Melo 		 */
524c530cfb1SArnaldo Carvalho de Melo 		sk->sk_write_space(sk);
5258c60f3faSArnaldo Carvalho de Melo 
5268a508ac2SGerrit Renker 		/*
5278a508ac2SGerrit Renker 		 * Update timeout interval for the nofeedback timer.
5288a508ac2SGerrit Renker 		 * We use a configuration option to increase the lower bound.
5298a508ac2SGerrit Renker 		 * This can help avoid triggering the nofeedback timer too often
5308a508ac2SGerrit Renker 		 * ('spinning') on LANs with small RTTs.
5318a508ac2SGerrit Renker 		 */
5325d0dbc4aSGerrit Renker 		hctx->ccid3hctx_t_rto = max_t(u32, 4 * hctx->ccid3hctx_rtt,
5338a508ac2SGerrit Renker 						   CONFIG_IP_DCCP_CCID3_RTO *
5348a508ac2SGerrit Renker 						   (USEC_PER_SEC/1000)	     );
5351f2333aeSArnaldo Carvalho de Melo 		/*
5361f2333aeSArnaldo Carvalho de Melo 		 * Schedule no feedback timer to expire in
5378a508ac2SGerrit Renker 		 * max(t_RTO, 2 * s/X)  =  max(t_RTO, 2 * t_ipi)
5381f2333aeSArnaldo Carvalho de Melo 		 */
5398a508ac2SGerrit Renker 		t_nfb = max(hctx->ccid3hctx_t_rto, 2 * hctx->ccid3hctx_t_ipi);
5407c657876SArnaldo Carvalho de Melo 
5411f2333aeSArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p, Scheduled no feedback timer to "
5421f2333aeSArnaldo Carvalho de Melo 			       "expire in %lu jiffies (%luus)\n",
5431f2333aeSArnaldo Carvalho de Melo 			       dccp_role(sk), sk,
5442a1fda6fSGerrit Renker 			       usecs_to_jiffies(t_nfb), t_nfb);
5457c657876SArnaldo Carvalho de Melo 
5467c657876SArnaldo Carvalho de Melo 		sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
5472a1fda6fSGerrit Renker 				   jiffies + usecs_to_jiffies(t_nfb));
5487c657876SArnaldo Carvalho de Melo 
5497c657876SArnaldo Carvalho de Melo 		/* set idle flag */
5507c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_idle = 1;
5517c657876SArnaldo Carvalho de Melo 		break;
5525e19e3fcSGerrit Renker 	case TFRC_SSTATE_NO_SENT:
55326af3072SGerrit Renker 		if (dccp_sk(sk)->dccps_role == DCCP_ROLE_CLIENT)
55426af3072SGerrit Renker 			DCCP_WARN("Illegal ACK received - no packet sent\n");
5555e19e3fcSGerrit Renker 		/* fall through */
5565e19e3fcSGerrit Renker 	case TFRC_SSTATE_TERM:		/* ignore feedback when closing */
5577c657876SArnaldo Carvalho de Melo 		break;
5587c657876SArnaldo Carvalho de Melo 	}
5597c657876SArnaldo Carvalho de Melo }
5607c657876SArnaldo Carvalho de Melo 
5612d0817d1SArnaldo Carvalho de Melo static int ccid3_hc_tx_insert_options(struct sock *sk, struct sk_buff *skb)
5627c657876SArnaldo Carvalho de Melo {
56359d203f9SArnaldo Carvalho de Melo 	const struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
5647c657876SArnaldo Carvalho de Melo 
56559d203f9SArnaldo Carvalho de Melo 	BUG_ON(hctx == NULL);
56659d203f9SArnaldo Carvalho de Melo 
5672d0817d1SArnaldo Carvalho de Melo 	if (sk->sk_state == DCCP_OPEN || sk->sk_state == DCCP_PARTOPEN)
5687c657876SArnaldo Carvalho de Melo 		DCCP_SKB_CB(skb)->dccpd_ccval = hctx->ccid3hctx_last_win_count;
5692d0817d1SArnaldo Carvalho de Melo 	return 0;
5707c657876SArnaldo Carvalho de Melo }
5717c657876SArnaldo Carvalho de Melo 
5727c657876SArnaldo Carvalho de Melo static int ccid3_hc_tx_parse_options(struct sock *sk, unsigned char option,
5731f2333aeSArnaldo Carvalho de Melo 				     unsigned char len, u16 idx,
5741f2333aeSArnaldo Carvalho de Melo 				     unsigned char *value)
5757c657876SArnaldo Carvalho de Melo {
5767c657876SArnaldo Carvalho de Melo 	int rc = 0;
57759725dc2SArnaldo Carvalho de Melo 	const struct dccp_sock *dp = dccp_sk(sk);
57859725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
5797c657876SArnaldo Carvalho de Melo 	struct ccid3_options_received *opt_recv;
5807c657876SArnaldo Carvalho de Melo 
58159d203f9SArnaldo Carvalho de Melo 	BUG_ON(hctx == NULL);
5827c657876SArnaldo Carvalho de Melo 
5837c657876SArnaldo Carvalho de Melo 	opt_recv = &hctx->ccid3hctx_options_received;
5847c657876SArnaldo Carvalho de Melo 
5857c657876SArnaldo Carvalho de Melo 	if (opt_recv->ccid3or_seqno != dp->dccps_gsr) {
5867c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_seqno		     = dp->dccps_gsr;
5877c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_event_rate    = ~0;
5887c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_intervals_idx = 0;
5897c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_intervals_len = 0;
5907c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_receive_rate	     = 0;
5917c657876SArnaldo Carvalho de Melo 	}
5927c657876SArnaldo Carvalho de Melo 
5937c657876SArnaldo Carvalho de Melo 	switch (option) {
5947c657876SArnaldo Carvalho de Melo 	case TFRC_OPT_LOSS_EVENT_RATE:
59559d203f9SArnaldo Carvalho de Melo 		if (unlikely(len != 4)) {
59659348b19SGerrit Renker 			DCCP_WARN("%s, sk=%p, invalid len %d "
59759348b19SGerrit Renker 				  "for TFRC_OPT_LOSS_EVENT_RATE\n",
59859348b19SGerrit Renker 				  dccp_role(sk), sk, len);
5997c657876SArnaldo Carvalho de Melo 			rc = -EINVAL;
6007c657876SArnaldo Carvalho de Melo 		} else {
60160fe62e7SAndrea Bittau 			opt_recv->ccid3or_loss_event_rate = ntohl(*(__be32 *)value);
6027c657876SArnaldo Carvalho de Melo 			ccid3_pr_debug("%s, sk=%p, LOSS_EVENT_RATE=%u\n",
6037c657876SArnaldo Carvalho de Melo 				       dccp_role(sk), sk,
6047c657876SArnaldo Carvalho de Melo 				       opt_recv->ccid3or_loss_event_rate);
6057c657876SArnaldo Carvalho de Melo 		}
6067c657876SArnaldo Carvalho de Melo 		break;
6077c657876SArnaldo Carvalho de Melo 	case TFRC_OPT_LOSS_INTERVALS:
6087c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_intervals_idx = idx;
6097c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_intervals_len = len;
6107c657876SArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p, LOSS_INTERVALS=(%u, %u)\n",
6117c657876SArnaldo Carvalho de Melo 			       dccp_role(sk), sk,
6127c657876SArnaldo Carvalho de Melo 			       opt_recv->ccid3or_loss_intervals_idx,
6137c657876SArnaldo Carvalho de Melo 			       opt_recv->ccid3or_loss_intervals_len);
6147c657876SArnaldo Carvalho de Melo 		break;
6157c657876SArnaldo Carvalho de Melo 	case TFRC_OPT_RECEIVE_RATE:
61659d203f9SArnaldo Carvalho de Melo 		if (unlikely(len != 4)) {
61759348b19SGerrit Renker 			DCCP_WARN("%s, sk=%p, invalid len %d "
61859348b19SGerrit Renker 				  "for TFRC_OPT_RECEIVE_RATE\n",
61959348b19SGerrit Renker 				  dccp_role(sk), sk, len);
6207c657876SArnaldo Carvalho de Melo 			rc = -EINVAL;
6217c657876SArnaldo Carvalho de Melo 		} else {
62260fe62e7SAndrea Bittau 			opt_recv->ccid3or_receive_rate = ntohl(*(__be32 *)value);
6237c657876SArnaldo Carvalho de Melo 			ccid3_pr_debug("%s, sk=%p, RECEIVE_RATE=%u\n",
6247c657876SArnaldo Carvalho de Melo 				       dccp_role(sk), sk,
6257c657876SArnaldo Carvalho de Melo 				       opt_recv->ccid3or_receive_rate);
6267c657876SArnaldo Carvalho de Melo 		}
6277c657876SArnaldo Carvalho de Melo 		break;
6287c657876SArnaldo Carvalho de Melo 	}
6297c657876SArnaldo Carvalho de Melo 
6307c657876SArnaldo Carvalho de Melo 	return rc;
6317c657876SArnaldo Carvalho de Melo }
6327c657876SArnaldo Carvalho de Melo 
63391f0ebf7SArnaldo Carvalho de Melo static int ccid3_hc_tx_init(struct ccid *ccid, struct sock *sk)
6347c657876SArnaldo Carvalho de Melo {
63591f0ebf7SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid_priv(ccid);
6367c657876SArnaldo Carvalho de Melo 
63778ad713dSGerrit Renker 	hctx->ccid3hctx_s     = 0;
6387c657876SArnaldo Carvalho de Melo 	hctx->ccid3hctx_state = TFRC_SSTATE_NO_SENT;
6397c657876SArnaldo Carvalho de Melo 	INIT_LIST_HEAD(&hctx->ccid3hctx_hist);
640aa5d7df3SArnaldo Carvalho de Melo 
641aa5d7df3SArnaldo Carvalho de Melo 	hctx->ccid3hctx_no_feedback_timer.function = ccid3_hc_tx_no_feedback_timer;
642aa5d7df3SArnaldo Carvalho de Melo 	hctx->ccid3hctx_no_feedback_timer.data     = (unsigned long)sk;
6437c657876SArnaldo Carvalho de Melo 	init_timer(&hctx->ccid3hctx_no_feedback_timer);
6447c657876SArnaldo Carvalho de Melo 
6457c657876SArnaldo Carvalho de Melo 	return 0;
6467c657876SArnaldo Carvalho de Melo }
6477c657876SArnaldo Carvalho de Melo 
6487c657876SArnaldo Carvalho de Melo static void ccid3_hc_tx_exit(struct sock *sk)
6497c657876SArnaldo Carvalho de Melo {
65059725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
6517c657876SArnaldo Carvalho de Melo 
6527c657876SArnaldo Carvalho de Melo 	BUG_ON(hctx == NULL);
6537c657876SArnaldo Carvalho de Melo 
6547c657876SArnaldo Carvalho de Melo 	ccid3_hc_tx_set_state(sk, TFRC_SSTATE_TERM);
6557c657876SArnaldo Carvalho de Melo 	sk_stop_timer(sk, &hctx->ccid3hctx_no_feedback_timer);
6567c657876SArnaldo Carvalho de Melo 
6577c657876SArnaldo Carvalho de Melo 	/* Empty packet history */
6588c60f3faSArnaldo Carvalho de Melo 	dccp_tx_hist_purge(ccid3_tx_hist, &hctx->ccid3hctx_hist);
6597c657876SArnaldo Carvalho de Melo }
6607c657876SArnaldo Carvalho de Melo 
6617c657876SArnaldo Carvalho de Melo /*
6627c657876SArnaldo Carvalho de Melo  * RX Half Connection methods
6637c657876SArnaldo Carvalho de Melo  */
6647c657876SArnaldo Carvalho de Melo 
66556724aa4SGerrit Renker #ifdef CONFIG_IP_DCCP_CCID3_DEBUG
6667c657876SArnaldo Carvalho de Melo static const char *ccid3_rx_state_name(enum ccid3_hc_rx_states state)
6677c657876SArnaldo Carvalho de Melo {
6687c657876SArnaldo Carvalho de Melo 	static char *ccid3_rx_state_names[] = {
6697c657876SArnaldo Carvalho de Melo 	[TFRC_RSTATE_NO_DATA] = "NO_DATA",
6707c657876SArnaldo Carvalho de Melo 	[TFRC_RSTATE_DATA]    = "DATA",
6717c657876SArnaldo Carvalho de Melo 	[TFRC_RSTATE_TERM]    = "TERM",
6727c657876SArnaldo Carvalho de Melo 	};
6737c657876SArnaldo Carvalho de Melo 
6747c657876SArnaldo Carvalho de Melo 	return ccid3_rx_state_names[state];
6757c657876SArnaldo Carvalho de Melo }
6767c657876SArnaldo Carvalho de Melo #endif
6777c657876SArnaldo Carvalho de Melo 
678c25a18baSArnaldo Carvalho de Melo static void ccid3_hc_rx_set_state(struct sock *sk,
6791f2333aeSArnaldo Carvalho de Melo 				  enum ccid3_hc_rx_states state)
6807c657876SArnaldo Carvalho de Melo {
68159725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
6827c657876SArnaldo Carvalho de Melo 	enum ccid3_hc_rx_states oldstate = hcrx->ccid3hcrx_state;
6837c657876SArnaldo Carvalho de Melo 
6847c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s(%p) %-8.8s -> %s\n",
6851f2333aeSArnaldo Carvalho de Melo 		       dccp_role(sk), sk, ccid3_rx_state_name(oldstate),
6861f2333aeSArnaldo Carvalho de Melo 		       ccid3_rx_state_name(state));
6877c657876SArnaldo Carvalho de Melo 	WARN_ON(state == oldstate);
6887c657876SArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_state = state;
6897c657876SArnaldo Carvalho de Melo }
6907c657876SArnaldo Carvalho de Melo 
69178ad713dSGerrit Renker static inline void ccid3_hc_rx_update_s(struct ccid3_hc_rx_sock *hcrx, int len)
69278ad713dSGerrit Renker {
69378ad713dSGerrit Renker 	if (unlikely(len == 0))	/* don't update on empty packets (e.g. ACKs) */
69478ad713dSGerrit Renker 		ccid3_pr_debug("Packet payload length is 0 - not updating\n");
69578ad713dSGerrit Renker 	else
69678ad713dSGerrit Renker 		hcrx->ccid3hcrx_s = hcrx->ccid3hcrx_s == 0 ? len :
69778ad713dSGerrit Renker 				    (9 * hcrx->ccid3hcrx_s + len) / 10;
69878ad713dSGerrit Renker }
69978ad713dSGerrit Renker 
7007c657876SArnaldo Carvalho de Melo static void ccid3_hc_rx_send_feedback(struct sock *sk)
7017c657876SArnaldo Carvalho de Melo {
70259725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
7037c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
7048c60f3faSArnaldo Carvalho de Melo 	struct dccp_rx_hist_entry *packet;
705b6ee3d4aSArnaldo Carvalho de Melo 	struct timeval now;
7067c657876SArnaldo Carvalho de Melo 
7077c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
7087c657876SArnaldo Carvalho de Melo 
709b0e56780SArnaldo Carvalho de Melo 	dccp_timestamp(sk, &now);
710b6ee3d4aSArnaldo Carvalho de Melo 
7117c657876SArnaldo Carvalho de Melo 	switch (hcrx->ccid3hcrx_state) {
7127c657876SArnaldo Carvalho de Melo 	case TFRC_RSTATE_NO_DATA:
7137c657876SArnaldo Carvalho de Melo 		hcrx->ccid3hcrx_x_recv = 0;
7147c657876SArnaldo Carvalho de Melo 		break;
7157c657876SArnaldo Carvalho de Melo 	case TFRC_RSTATE_DATA: {
716b6ee3d4aSArnaldo Carvalho de Melo 		const u32 delta = timeval_delta(&now,
717b6ee3d4aSArnaldo Carvalho de Melo 					&hcrx->ccid3hcrx_tstamp_last_feedback);
71827ae543eSArnaldo Carvalho de Melo 		hcrx->ccid3hcrx_x_recv = usecs_div(hcrx->ccid3hcrx_bytes_recv,
71927ae543eSArnaldo Carvalho de Melo 						   delta);
7207c657876SArnaldo Carvalho de Melo 	}
7217c657876SArnaldo Carvalho de Melo 		break;
72259348b19SGerrit Renker 	case TFRC_RSTATE_TERM:
72359348b19SGerrit Renker 		DCCP_BUG("Illegal %s state TERM, sk=%p", dccp_role(sk), sk);
7247c657876SArnaldo Carvalho de Melo 		return;
7257c657876SArnaldo Carvalho de Melo 	}
7267c657876SArnaldo Carvalho de Melo 
7278c60f3faSArnaldo Carvalho de Melo 	packet = dccp_rx_hist_find_data_packet(&hcrx->ccid3hcrx_hist);
72859d203f9SArnaldo Carvalho de Melo 	if (unlikely(packet == NULL)) {
72959348b19SGerrit Renker 		DCCP_WARN("%s, sk=%p, no data packet in history!\n",
73059348b19SGerrit Renker 			  dccp_role(sk), sk);
7317c657876SArnaldo Carvalho de Melo 		return;
7327c657876SArnaldo Carvalho de Melo 	}
7337c657876SArnaldo Carvalho de Melo 
734b6ee3d4aSArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_tstamp_last_feedback = now;
73566a377c5SIan McDonald 	hcrx->ccid3hcrx_ccval_last_counter   = packet->dccphrx_ccval;
7367c657876SArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_bytes_recv	     = 0;
7377c657876SArnaldo Carvalho de Melo 
7387c657876SArnaldo Carvalho de Melo 	/* Convert to multiples of 10us */
739b6ee3d4aSArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_elapsed_time =
740b6ee3d4aSArnaldo Carvalho de Melo 			timeval_delta(&now, &packet->dccphrx_tstamp) / 10;
74145393a66SGerrit Renker 
7427c657876SArnaldo Carvalho de Melo 	if (hcrx->ccid3hcrx_p == 0)
74345393a66SGerrit Renker 		hcrx->ccid3hcrx_pinv = ~0U;	/* see RFC 4342, 8.5 */
74445393a66SGerrit Renker 	else if (hcrx->ccid3hcrx_p > 1000000) {
74545393a66SGerrit Renker 		DCCP_WARN("p (%u) > 100%%\n", hcrx->ccid3hcrx_p);
74645393a66SGerrit Renker 		hcrx->ccid3hcrx_pinv = 1;	/* use 100% in this case */
74745393a66SGerrit Renker 	} else
7487c657876SArnaldo Carvalho de Melo 		hcrx->ccid3hcrx_pinv = 1000000 / hcrx->ccid3hcrx_p;
74945393a66SGerrit Renker 
750507d37cfSArnaldo Carvalho de Melo 	dp->dccps_hc_rx_insert_options = 1;
7517c657876SArnaldo Carvalho de Melo 	dccp_send_ack(sk);
7527c657876SArnaldo Carvalho de Melo }
7537c657876SArnaldo Carvalho de Melo 
7542d0817d1SArnaldo Carvalho de Melo static int ccid3_hc_rx_insert_options(struct sock *sk, struct sk_buff *skb)
7557c657876SArnaldo Carvalho de Melo {
75659d203f9SArnaldo Carvalho de Melo 	const struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
75760fe62e7SAndrea Bittau 	__be32 x_recv, pinv;
7587c657876SArnaldo Carvalho de Melo 
75959d203f9SArnaldo Carvalho de Melo 	BUG_ON(hcrx == NULL);
76059d203f9SArnaldo Carvalho de Melo 
76159d203f9SArnaldo Carvalho de Melo 	if (!(sk->sk_state == DCCP_OPEN || sk->sk_state == DCCP_PARTOPEN))
7622d0817d1SArnaldo Carvalho de Melo 		return 0;
7637c657876SArnaldo Carvalho de Melo 
76466a377c5SIan McDonald 	DCCP_SKB_CB(skb)->dccpd_ccval = hcrx->ccid3hcrx_ccval_last_counter;
7654fded33bSArnaldo Carvalho de Melo 
7664fded33bSArnaldo Carvalho de Melo 	if (dccp_packet_without_ack(skb))
7672d0817d1SArnaldo Carvalho de Melo 		return 0;
7684fded33bSArnaldo Carvalho de Melo 
7694fded33bSArnaldo Carvalho de Melo 	x_recv = htonl(hcrx->ccid3hcrx_x_recv);
7704fded33bSArnaldo Carvalho de Melo 	pinv   = htonl(hcrx->ccid3hcrx_pinv);
7712d0817d1SArnaldo Carvalho de Melo 
7722d0817d1SArnaldo Carvalho de Melo 	if ((hcrx->ccid3hcrx_elapsed_time != 0 &&
7732d0817d1SArnaldo Carvalho de Melo 	     dccp_insert_option_elapsed_time(sk, skb,
7742d0817d1SArnaldo Carvalho de Melo 					     hcrx->ccid3hcrx_elapsed_time)) ||
7752d0817d1SArnaldo Carvalho de Melo 	    dccp_insert_option_timestamp(sk, skb) ||
7764fded33bSArnaldo Carvalho de Melo 	    dccp_insert_option(sk, skb, TFRC_OPT_LOSS_EVENT_RATE,
7772d0817d1SArnaldo Carvalho de Melo 		    	       &pinv, sizeof(pinv)) ||
7784fded33bSArnaldo Carvalho de Melo 	    dccp_insert_option(sk, skb, TFRC_OPT_RECEIVE_RATE,
7792d0817d1SArnaldo Carvalho de Melo 		    	       &x_recv, sizeof(x_recv)))
7802d0817d1SArnaldo Carvalho de Melo 		return -1;
7812d0817d1SArnaldo Carvalho de Melo 
7822d0817d1SArnaldo Carvalho de Melo 	return 0;
7837c657876SArnaldo Carvalho de Melo }
7847c657876SArnaldo Carvalho de Melo 
7857c657876SArnaldo Carvalho de Melo /* calculate first loss interval
7867c657876SArnaldo Carvalho de Melo  *
7877c657876SArnaldo Carvalho de Melo  * returns estimated loss interval in usecs */
7887c657876SArnaldo Carvalho de Melo 
7897c657876SArnaldo Carvalho de Melo static u32 ccid3_hc_rx_calc_first_li(struct sock *sk)
7907c657876SArnaldo Carvalho de Melo {
79159725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
7928c60f3faSArnaldo Carvalho de Melo 	struct dccp_rx_hist_entry *entry, *next, *tail = NULL;
7937c657876SArnaldo Carvalho de Melo 	u32 rtt, delta, x_recv, fval, p, tmp2;
794b6ee3d4aSArnaldo Carvalho de Melo 	struct timeval tstamp = { 0, };
7957c657876SArnaldo Carvalho de Melo 	int interval = 0;
7967c657876SArnaldo Carvalho de Melo 	int win_count = 0;
7977c657876SArnaldo Carvalho de Melo 	int step = 0;
7987c657876SArnaldo Carvalho de Melo 	u64 tmp1;
7997c657876SArnaldo Carvalho de Melo 
8008c60f3faSArnaldo Carvalho de Melo 	list_for_each_entry_safe(entry, next, &hcrx->ccid3hcrx_hist,
8018c60f3faSArnaldo Carvalho de Melo 				 dccphrx_node) {
8028c60f3faSArnaldo Carvalho de Melo 		if (dccp_rx_hist_entry_data_packet(entry)) {
8037c657876SArnaldo Carvalho de Melo 			tail = entry;
8047c657876SArnaldo Carvalho de Melo 
8057c657876SArnaldo Carvalho de Melo 			switch (step) {
8067c657876SArnaldo Carvalho de Melo 			case 0:
8078c60f3faSArnaldo Carvalho de Melo 				tstamp	  = entry->dccphrx_tstamp;
808c1734376SArnaldo Carvalho de Melo 				win_count = entry->dccphrx_ccval;
8097c657876SArnaldo Carvalho de Melo 				step = 1;
8107c657876SArnaldo Carvalho de Melo 				break;
8117c657876SArnaldo Carvalho de Melo 			case 1:
812c1734376SArnaldo Carvalho de Melo 				interval = win_count - entry->dccphrx_ccval;
8137c657876SArnaldo Carvalho de Melo 				if (interval < 0)
8147c657876SArnaldo Carvalho de Melo 					interval += TFRC_WIN_COUNT_LIMIT;
8157c657876SArnaldo Carvalho de Melo 				if (interval > 4)
8167c657876SArnaldo Carvalho de Melo 					goto found;
8177c657876SArnaldo Carvalho de Melo 				break;
8187c657876SArnaldo Carvalho de Melo 			}
8197c657876SArnaldo Carvalho de Melo 		}
8207c657876SArnaldo Carvalho de Melo 	}
8217c657876SArnaldo Carvalho de Melo 
82259d203f9SArnaldo Carvalho de Melo 	if (unlikely(step == 0)) {
82359348b19SGerrit Renker 		DCCP_WARN("%s, sk=%p, packet history has no data packets!\n",
82459348b19SGerrit Renker 			  dccp_role(sk), sk);
8257c657876SArnaldo Carvalho de Melo 		return ~0;
8267c657876SArnaldo Carvalho de Melo 	}
8277c657876SArnaldo Carvalho de Melo 
82859d203f9SArnaldo Carvalho de Melo 	if (unlikely(interval == 0)) {
82959348b19SGerrit Renker 		DCCP_WARN("%s, sk=%p, Could not find a win_count interval > 0."
83059348b19SGerrit Renker 			  "Defaulting to 1\n", dccp_role(sk), sk);
8317c657876SArnaldo Carvalho de Melo 		interval = 1;
8327c657876SArnaldo Carvalho de Melo 	}
8337c657876SArnaldo Carvalho de Melo found:
83466a377c5SIan McDonald 	if (!tail) {
83559348b19SGerrit Renker 		DCCP_CRIT("tail is null\n");
83666a377c5SIan McDonald 		return ~0;
83766a377c5SIan McDonald 	}
838b6ee3d4aSArnaldo Carvalho de Melo 	rtt = timeval_delta(&tstamp, &tail->dccphrx_tstamp) * 4 / interval;
8397c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p, approximated RTT to %uus\n",
8407c657876SArnaldo Carvalho de Melo 		       dccp_role(sk), sk, rtt);
84159348b19SGerrit Renker 
84259348b19SGerrit Renker 	if (rtt == 0) {
84359348b19SGerrit Renker 		DCCP_WARN("RTT==0, setting to 1\n");
8447c657876SArnaldo Carvalho de Melo  		rtt = 1;
84559348b19SGerrit Renker 	}
8467c657876SArnaldo Carvalho de Melo 
847b0e56780SArnaldo Carvalho de Melo 	dccp_timestamp(sk, &tstamp);
848b0e56780SArnaldo Carvalho de Melo 	delta = timeval_delta(&tstamp, &hcrx->ccid3hcrx_tstamp_last_feedback);
849b0e56780SArnaldo Carvalho de Melo 	x_recv = usecs_div(hcrx->ccid3hcrx_bytes_recv, delta);
8507c657876SArnaldo Carvalho de Melo 
85166a377c5SIan McDonald 	if (x_recv == 0)
85266a377c5SIan McDonald 		x_recv = hcrx->ccid3hcrx_x_recv;
85366a377c5SIan McDonald 
8547c657876SArnaldo Carvalho de Melo 	tmp1 = (u64)x_recv * (u64)rtt;
8557c657876SArnaldo Carvalho de Melo 	do_div(tmp1,10000000);
8567c657876SArnaldo Carvalho de Melo 	tmp2 = (u32)tmp1;
85766a377c5SIan McDonald 
85866a377c5SIan McDonald 	if (!tmp2) {
85959348b19SGerrit Renker 		DCCP_CRIT("tmp2 = 0, x_recv = %u, rtt =%u\n", x_recv, rtt);
86066a377c5SIan McDonald 		return ~0;
86166a377c5SIan McDonald 	}
86266a377c5SIan McDonald 
8637c657876SArnaldo Carvalho de Melo 	fval = (hcrx->ccid3hcrx_s * 100000) / tmp2;
8647c657876SArnaldo Carvalho de Melo 	/* do not alter order above or you will get overflow on 32 bit */
86536729c1aSArnaldo Carvalho de Melo 	p = tfrc_calc_x_reverse_lookup(fval);
8661f2333aeSArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p, receive rate=%u bytes/s, implied "
8671f2333aeSArnaldo Carvalho de Melo 		       "loss rate=%u\n", dccp_role(sk), sk, x_recv, p);
8687c657876SArnaldo Carvalho de Melo 
8697c657876SArnaldo Carvalho de Melo 	if (p == 0)
8707c657876SArnaldo Carvalho de Melo 		return ~0;
8717c657876SArnaldo Carvalho de Melo 	else
8727c657876SArnaldo Carvalho de Melo 		return 1000000 / p;
8737c657876SArnaldo Carvalho de Melo }
8747c657876SArnaldo Carvalho de Melo 
8757c657876SArnaldo Carvalho de Melo static void ccid3_hc_rx_update_li(struct sock *sk, u64 seq_loss, u8 win_loss)
8767c657876SArnaldo Carvalho de Melo {
87759725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
878fc747e82SIan McDonald 	struct dccp_li_hist_entry *head;
87966a377c5SIan McDonald 	u64 seq_temp;
8807c657876SArnaldo Carvalho de Melo 
88166a377c5SIan McDonald 	if (list_empty(&hcrx->ccid3hcrx_li_hist)) {
88266a377c5SIan McDonald 		if (!dccp_li_hist_interval_new(ccid3_li_hist,
88366a377c5SIan McDonald 		   &hcrx->ccid3hcrx_li_hist, seq_loss, win_loss))
884ae6706f0SArnaldo Carvalho de Melo 			return;
88566a377c5SIan McDonald 
886fc747e82SIan McDonald 		head = list_entry(hcrx->ccid3hcrx_li_hist.next,
887fc747e82SIan McDonald 		   struct dccp_li_hist_entry, dccplih_node);
888fc747e82SIan McDonald 		head->dccplih_interval = ccid3_hc_rx_calc_first_li(sk);
88966a377c5SIan McDonald 	} else {
89066a377c5SIan McDonald 		struct dccp_li_hist_entry *entry;
89166a377c5SIan McDonald 		struct list_head *tail;
89266a377c5SIan McDonald 
893fc747e82SIan McDonald 		head = list_entry(hcrx->ccid3hcrx_li_hist.next,
894fc747e82SIan McDonald 		   struct dccp_li_hist_entry, dccplih_node);
89566a377c5SIan McDonald 		/* FIXME win count check removed as was wrong */
89666a377c5SIan McDonald 		/* should make this check with receive history */
89766a377c5SIan McDonald 		/* and compare there as per section 10.2 of RFC4342 */
89866a377c5SIan McDonald 
89966a377c5SIan McDonald 		/* new loss event detected */
90066a377c5SIan McDonald 		/* calculate last interval length */
90166a377c5SIan McDonald 		seq_temp = dccp_delta_seqno(head->dccplih_seqno, seq_loss);
90254e6ecb2SChristoph Lameter 		entry = dccp_li_hist_entry_new(ccid3_li_hist, GFP_ATOMIC);
90366a377c5SIan McDonald 
90466a377c5SIan McDonald 		if (entry == NULL) {
90559348b19SGerrit Renker 			DCCP_BUG("out of memory - can not allocate entry");
90666a377c5SIan McDonald 			return;
9077c657876SArnaldo Carvalho de Melo 		}
9087c657876SArnaldo Carvalho de Melo 
90966a377c5SIan McDonald 		list_add(&entry->dccplih_node, &hcrx->ccid3hcrx_li_hist);
91066a377c5SIan McDonald 
91166a377c5SIan McDonald 		tail = hcrx->ccid3hcrx_li_hist.prev;
91266a377c5SIan McDonald 		list_del(tail);
91366a377c5SIan McDonald 		kmem_cache_free(ccid3_li_hist->dccplih_slab, tail);
91466a377c5SIan McDonald 
91566a377c5SIan McDonald 		/* Create the newest interval */
91666a377c5SIan McDonald 		entry->dccplih_seqno = seq_loss;
91766a377c5SIan McDonald 		entry->dccplih_interval = seq_temp;
91866a377c5SIan McDonald 		entry->dccplih_win_count = win_loss;
91966a377c5SIan McDonald 	}
92066a377c5SIan McDonald }
92166a377c5SIan McDonald 
92266a377c5SIan McDonald static int ccid3_hc_rx_detect_loss(struct sock *sk,
92366a377c5SIan McDonald                                     struct dccp_rx_hist_entry *packet)
9247c657876SArnaldo Carvalho de Melo {
92559725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
92666a377c5SIan McDonald 	struct dccp_rx_hist_entry *rx_hist = dccp_rx_hist_head(&hcrx->ccid3hcrx_hist);
92766a377c5SIan McDonald 	u64 seqno = packet->dccphrx_seqno;
92866a377c5SIan McDonald 	u64 tmp_seqno;
92966a377c5SIan McDonald 	int loss = 0;
93066a377c5SIan McDonald 	u8 ccval;
9317c657876SArnaldo Carvalho de Melo 
93266a377c5SIan McDonald 
93366a377c5SIan McDonald 	tmp_seqno = hcrx->ccid3hcrx_seqno_nonloss;
93466a377c5SIan McDonald 
93566a377c5SIan McDonald 	if (!rx_hist ||
93666a377c5SIan McDonald 	   follows48(packet->dccphrx_seqno, hcrx->ccid3hcrx_seqno_nonloss)) {
93766a377c5SIan McDonald 		hcrx->ccid3hcrx_seqno_nonloss = seqno;
93866a377c5SIan McDonald 		hcrx->ccid3hcrx_ccval_nonloss = packet->dccphrx_ccval;
93966a377c5SIan McDonald 		goto detect_out;
94066a377c5SIan McDonald 	}
94166a377c5SIan McDonald 
94266a377c5SIan McDonald 
94366a377c5SIan McDonald 	while (dccp_delta_seqno(hcrx->ccid3hcrx_seqno_nonloss, seqno)
94466a377c5SIan McDonald 	   > TFRC_RECV_NUM_LATE_LOSS) {
94566a377c5SIan McDonald 		loss = 1;
94666a377c5SIan McDonald 		ccid3_hc_rx_update_li(sk, hcrx->ccid3hcrx_seqno_nonloss,
94766a377c5SIan McDonald 		   hcrx->ccid3hcrx_ccval_nonloss);
94866a377c5SIan McDonald 		tmp_seqno = hcrx->ccid3hcrx_seqno_nonloss;
94966a377c5SIan McDonald 		dccp_inc_seqno(&tmp_seqno);
95066a377c5SIan McDonald 		hcrx->ccid3hcrx_seqno_nonloss = tmp_seqno;
95166a377c5SIan McDonald 		dccp_inc_seqno(&tmp_seqno);
95266a377c5SIan McDonald 		while (dccp_rx_hist_find_entry(&hcrx->ccid3hcrx_hist,
95366a377c5SIan McDonald 		   tmp_seqno, &ccval)) {
95466a377c5SIan McDonald 		   	hcrx->ccid3hcrx_seqno_nonloss = tmp_seqno;
95566a377c5SIan McDonald 			hcrx->ccid3hcrx_ccval_nonloss = ccval;
95666a377c5SIan McDonald 			dccp_inc_seqno(&tmp_seqno);
95766a377c5SIan McDonald 		}
95866a377c5SIan McDonald 	}
95966a377c5SIan McDonald 
96066a377c5SIan McDonald 	/* FIXME - this code could be simplified with above while */
96166a377c5SIan McDonald 	/* but works at moment */
96266a377c5SIan McDonald 	if (follows48(packet->dccphrx_seqno, hcrx->ccid3hcrx_seqno_nonloss)) {
96366a377c5SIan McDonald 		hcrx->ccid3hcrx_seqno_nonloss = seqno;
96466a377c5SIan McDonald 		hcrx->ccid3hcrx_ccval_nonloss = packet->dccphrx_ccval;
96566a377c5SIan McDonald 	}
96666a377c5SIan McDonald 
96766a377c5SIan McDonald detect_out:
96866a377c5SIan McDonald 	dccp_rx_hist_add_packet(ccid3_rx_hist, &hcrx->ccid3hcrx_hist,
96966a377c5SIan McDonald 		   &hcrx->ccid3hcrx_li_hist, packet,
97066a377c5SIan McDonald 		   hcrx->ccid3hcrx_seqno_nonloss);
97166a377c5SIan McDonald 	return loss;
9727c657876SArnaldo Carvalho de Melo }
9737c657876SArnaldo Carvalho de Melo 
9747c657876SArnaldo Carvalho de Melo static void ccid3_hc_rx_packet_recv(struct sock *sk, struct sk_buff *skb)
9757c657876SArnaldo Carvalho de Melo {
97659725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
9774fded33bSArnaldo Carvalho de Melo 	const struct dccp_options_received *opt_recv;
9788c60f3faSArnaldo Carvalho de Melo 	struct dccp_rx_hist_entry *packet;
9797c657876SArnaldo Carvalho de Melo 	struct timeval now;
98066a377c5SIan McDonald 	u32 p_prev, rtt_prev, r_sample, t_elapsed;
98178ad713dSGerrit Renker 	int loss, payload_size;
9821f2333aeSArnaldo Carvalho de Melo 
98359348b19SGerrit Renker 	BUG_ON(hcrx == NULL);
9847c657876SArnaldo Carvalho de Melo 
98559725dc2SArnaldo Carvalho de Melo 	opt_recv = &dccp_sk(sk)->dccps_options_received;
9864fded33bSArnaldo Carvalho de Melo 
9877c657876SArnaldo Carvalho de Melo 	switch (DCCP_SKB_CB(skb)->dccpd_type) {
9887c657876SArnaldo Carvalho de Melo 	case DCCP_PKT_ACK:
9897c657876SArnaldo Carvalho de Melo 		if (hcrx->ccid3hcrx_state == TFRC_RSTATE_NO_DATA)
9907c657876SArnaldo Carvalho de Melo 			return;
9917c657876SArnaldo Carvalho de Melo 	case DCCP_PKT_DATAACK:
9924fded33bSArnaldo Carvalho de Melo 		if (opt_recv->dccpor_timestamp_echo == 0)
9937c657876SArnaldo Carvalho de Melo 			break;
99466a377c5SIan McDonald 		rtt_prev = hcrx->ccid3hcrx_rtt;
995b0e56780SArnaldo Carvalho de Melo 		dccp_timestamp(sk, &now);
996b3a3077dSArnaldo Carvalho de Melo 		timeval_sub_usecs(&now, opt_recv->dccpor_timestamp_echo * 10);
997b3a3077dSArnaldo Carvalho de Melo 		r_sample = timeval_usecs(&now);
998b3a3077dSArnaldo Carvalho de Melo 		t_elapsed = opt_recv->dccpor_elapsed_time * 10;
999b3a3077dSArnaldo Carvalho de Melo 
1000b3a3077dSArnaldo Carvalho de Melo 		if (unlikely(r_sample <= t_elapsed))
100159348b19SGerrit Renker 			DCCP_WARN("r_sample=%uus, t_elapsed=%uus\n",
100259348b19SGerrit Renker 				  r_sample, t_elapsed);
1003b3a3077dSArnaldo Carvalho de Melo 		else
1004b3a3077dSArnaldo Carvalho de Melo 			r_sample -= t_elapsed;
1005b3a3077dSArnaldo Carvalho de Melo 
1006b3a3077dSArnaldo Carvalho de Melo 		if (hcrx->ccid3hcrx_state == TFRC_RSTATE_NO_DATA)
1007b3a3077dSArnaldo Carvalho de Melo 			hcrx->ccid3hcrx_rtt = r_sample;
1008b3a3077dSArnaldo Carvalho de Melo 		else
1009b3a3077dSArnaldo Carvalho de Melo 			hcrx->ccid3hcrx_rtt = (hcrx->ccid3hcrx_rtt * 9) / 10 +
1010b3a3077dSArnaldo Carvalho de Melo 					      r_sample / 10;
1011b3a3077dSArnaldo Carvalho de Melo 
101266a377c5SIan McDonald 		if (rtt_prev != hcrx->ccid3hcrx_rtt)
101366a377c5SIan McDonald 			ccid3_pr_debug("%s, New RTT=%uus, elapsed time=%u\n",
10144fded33bSArnaldo Carvalho de Melo 				       dccp_role(sk), hcrx->ccid3hcrx_rtt,
10154fded33bSArnaldo Carvalho de Melo 				       opt_recv->dccpor_elapsed_time);
10167c657876SArnaldo Carvalho de Melo 		break;
10177c657876SArnaldo Carvalho de Melo 	case DCCP_PKT_DATA:
10187c657876SArnaldo Carvalho de Melo 		break;
101959d203f9SArnaldo Carvalho de Melo 	default: /* We're not interested in other packet types, move along */
10207c657876SArnaldo Carvalho de Melo 		return;
10217c657876SArnaldo Carvalho de Melo 	}
10227c657876SArnaldo Carvalho de Melo 
1023b0e56780SArnaldo Carvalho de Melo 	packet = dccp_rx_hist_entry_new(ccid3_rx_hist, sk, opt_recv->dccpor_ndp,
102454e6ecb2SChristoph Lameter 					skb, GFP_ATOMIC);
102559d203f9SArnaldo Carvalho de Melo 	if (unlikely(packet == NULL)) {
102659348b19SGerrit Renker 		DCCP_WARN("%s, sk=%p, Not enough mem to add rx packet "
102759348b19SGerrit Renker 			  "to history, consider it lost!\n", dccp_role(sk), sk);
10287c657876SArnaldo Carvalho de Melo 		return;
10297c657876SArnaldo Carvalho de Melo 	}
10307c657876SArnaldo Carvalho de Melo 
103166a377c5SIan McDonald 	loss = ccid3_hc_rx_detect_loss(sk, packet);
10327c657876SArnaldo Carvalho de Melo 
10337c657876SArnaldo Carvalho de Melo 	if (DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_ACK)
10347c657876SArnaldo Carvalho de Melo 		return;
10357c657876SArnaldo Carvalho de Melo 
103678ad713dSGerrit Renker 	payload_size = skb->len - dccp_hdr(skb)->dccph_doff * 4;
103778ad713dSGerrit Renker 	ccid3_hc_rx_update_s(hcrx, payload_size);
103878ad713dSGerrit Renker 
10397c657876SArnaldo Carvalho de Melo 	switch (hcrx->ccid3hcrx_state) {
10407c657876SArnaldo Carvalho de Melo 	case TFRC_RSTATE_NO_DATA:
10411f2333aeSArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p(%s), skb=%p, sending initial "
10421f2333aeSArnaldo Carvalho de Melo 			       "feedback\n",
10431f2333aeSArnaldo Carvalho de Melo 			       dccp_role(sk), sk,
10441f2333aeSArnaldo Carvalho de Melo 			       dccp_state_name(sk->sk_state), skb);
10457c657876SArnaldo Carvalho de Melo 		ccid3_hc_rx_send_feedback(sk);
10467c657876SArnaldo Carvalho de Melo 		ccid3_hc_rx_set_state(sk, TFRC_RSTATE_DATA);
10477c657876SArnaldo Carvalho de Melo 		return;
10487c657876SArnaldo Carvalho de Melo 	case TFRC_RSTATE_DATA:
104978ad713dSGerrit Renker 		hcrx->ccid3hcrx_bytes_recv += payload_size;
105066a377c5SIan McDonald 		if (loss)
1051b6ee3d4aSArnaldo Carvalho de Melo 			break;
1052b6ee3d4aSArnaldo Carvalho de Melo 
1053b0e56780SArnaldo Carvalho de Melo 		dccp_timestamp(sk, &now);
1054b6ee3d4aSArnaldo Carvalho de Melo 		if (timeval_delta(&now, &hcrx->ccid3hcrx_tstamp_last_ack) >=
10554fded33bSArnaldo Carvalho de Melo 		    hcrx->ccid3hcrx_rtt) {
1056b6ee3d4aSArnaldo Carvalho de Melo 			hcrx->ccid3hcrx_tstamp_last_ack = now;
10577c657876SArnaldo Carvalho de Melo 			ccid3_hc_rx_send_feedback(sk);
10587c657876SArnaldo Carvalho de Melo 		}
10597c657876SArnaldo Carvalho de Melo 		return;
106059348b19SGerrit Renker 	case TFRC_RSTATE_TERM:
106159348b19SGerrit Renker 		DCCP_BUG("Illegal %s state TERM, sk=%p", dccp_role(sk), sk);
10627c657876SArnaldo Carvalho de Melo 		return;
10637c657876SArnaldo Carvalho de Melo 	}
10647c657876SArnaldo Carvalho de Melo 
10657c657876SArnaldo Carvalho de Melo 	/* Dealing with packet loss */
10664fded33bSArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p(%s), data loss! Reacting...\n",
10674fded33bSArnaldo Carvalho de Melo 		       dccp_role(sk), sk, dccp_state_name(sk->sk_state));
10687c657876SArnaldo Carvalho de Melo 
10697c657876SArnaldo Carvalho de Melo 	p_prev = hcrx->ccid3hcrx_p;
10707c657876SArnaldo Carvalho de Melo 
10717c657876SArnaldo Carvalho de Melo 	/* Calculate loss event rate */
1072c0996660SIan McDonald 	if (!list_empty(&hcrx->ccid3hcrx_li_hist)) {
1073c0996660SIan McDonald 		u32 i_mean = dccp_li_hist_calc_i_mean(&hcrx->ccid3hcrx_li_hist);
1074c0996660SIan McDonald 
10757c657876SArnaldo Carvalho de Melo 		/* Scaling up by 1000000 as fixed decimal */
1076c0996660SIan McDonald 		if (i_mean != 0)
1077c0996660SIan McDonald 			hcrx->ccid3hcrx_p = 1000000 / i_mean;
107859348b19SGerrit Renker 	} else
107959348b19SGerrit Renker 		DCCP_BUG("empty loss history");
10807c657876SArnaldo Carvalho de Melo 
10817c657876SArnaldo Carvalho de Melo 	if (hcrx->ccid3hcrx_p > p_prev) {
10827c657876SArnaldo Carvalho de Melo 		ccid3_hc_rx_send_feedback(sk);
10837c657876SArnaldo Carvalho de Melo 		return;
10847c657876SArnaldo Carvalho de Melo 	}
10857c657876SArnaldo Carvalho de Melo }
10867c657876SArnaldo Carvalho de Melo 
108791f0ebf7SArnaldo Carvalho de Melo static int ccid3_hc_rx_init(struct ccid *ccid, struct sock *sk)
10887c657876SArnaldo Carvalho de Melo {
108991f0ebf7SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid_priv(ccid);
10907c657876SArnaldo Carvalho de Melo 
10917c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
10927c657876SArnaldo Carvalho de Melo 
10937c657876SArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_state = TFRC_RSTATE_NO_DATA;
10947c657876SArnaldo Carvalho de Melo 	INIT_LIST_HEAD(&hcrx->ccid3hcrx_hist);
1095ae6706f0SArnaldo Carvalho de Melo 	INIT_LIST_HEAD(&hcrx->ccid3hcrx_li_hist);
1096b0e56780SArnaldo Carvalho de Melo 	dccp_timestamp(sk, &hcrx->ccid3hcrx_tstamp_last_ack);
1097954ee31fSArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_tstamp_last_feedback = hcrx->ccid3hcrx_tstamp_last_ack;
109878ad713dSGerrit Renker 	hcrx->ccid3hcrx_s   = 0;
1099954ee31fSArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_rtt = 5000; /* XXX 5ms for now... */
11007c657876SArnaldo Carvalho de Melo 	return 0;
11017c657876SArnaldo Carvalho de Melo }
11027c657876SArnaldo Carvalho de Melo 
11037c657876SArnaldo Carvalho de Melo static void ccid3_hc_rx_exit(struct sock *sk)
11047c657876SArnaldo Carvalho de Melo {
110559725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
11067c657876SArnaldo Carvalho de Melo 
110759d203f9SArnaldo Carvalho de Melo 	BUG_ON(hcrx == NULL);
11087c657876SArnaldo Carvalho de Melo 
11097c657876SArnaldo Carvalho de Melo 	ccid3_hc_rx_set_state(sk, TFRC_RSTATE_TERM);
11107c657876SArnaldo Carvalho de Melo 
11117c657876SArnaldo Carvalho de Melo 	/* Empty packet history */
11128c60f3faSArnaldo Carvalho de Melo 	dccp_rx_hist_purge(ccid3_rx_hist, &hcrx->ccid3hcrx_hist);
11137c657876SArnaldo Carvalho de Melo 
11147c657876SArnaldo Carvalho de Melo 	/* Empty loss interval history */
1115ae6706f0SArnaldo Carvalho de Melo 	dccp_li_hist_purge(ccid3_li_hist, &hcrx->ccid3hcrx_li_hist);
11167c657876SArnaldo Carvalho de Melo }
11177c657876SArnaldo Carvalho de Melo 
11182babe1f6SArnaldo Carvalho de Melo static void ccid3_hc_rx_get_info(struct sock *sk, struct tcp_info *info)
11192babe1f6SArnaldo Carvalho de Melo {
112059725dc2SArnaldo Carvalho de Melo 	const struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
11212babe1f6SArnaldo Carvalho de Melo 
112259c2353dSArnaldo Carvalho de Melo 	/* Listen socks doesn't have a private CCID block */
112359c2353dSArnaldo Carvalho de Melo 	if (sk->sk_state == DCCP_LISTEN)
112459c2353dSArnaldo Carvalho de Melo 		return;
112559c2353dSArnaldo Carvalho de Melo 
112659d203f9SArnaldo Carvalho de Melo 	BUG_ON(hcrx == NULL);
11272babe1f6SArnaldo Carvalho de Melo 
11282babe1f6SArnaldo Carvalho de Melo 	info->tcpi_ca_state	= hcrx->ccid3hcrx_state;
11292babe1f6SArnaldo Carvalho de Melo 	info->tcpi_options	|= TCPI_OPT_TIMESTAMPS;
11302babe1f6SArnaldo Carvalho de Melo 	info->tcpi_rcv_rtt	= hcrx->ccid3hcrx_rtt;
11312babe1f6SArnaldo Carvalho de Melo }
11322babe1f6SArnaldo Carvalho de Melo 
11332babe1f6SArnaldo Carvalho de Melo static void ccid3_hc_tx_get_info(struct sock *sk, struct tcp_info *info)
11342babe1f6SArnaldo Carvalho de Melo {
113559725dc2SArnaldo Carvalho de Melo 	const struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
11362babe1f6SArnaldo Carvalho de Melo 
113759c2353dSArnaldo Carvalho de Melo 	/* Listen socks doesn't have a private CCID block */
113859c2353dSArnaldo Carvalho de Melo 	if (sk->sk_state == DCCP_LISTEN)
113959c2353dSArnaldo Carvalho de Melo 		return;
114059c2353dSArnaldo Carvalho de Melo 
114159d203f9SArnaldo Carvalho de Melo 	BUG_ON(hctx == NULL);
11422babe1f6SArnaldo Carvalho de Melo 
11432babe1f6SArnaldo Carvalho de Melo 	info->tcpi_rto = hctx->ccid3hctx_t_rto;
11442babe1f6SArnaldo Carvalho de Melo 	info->tcpi_rtt = hctx->ccid3hctx_rtt;
11452babe1f6SArnaldo Carvalho de Melo }
11462babe1f6SArnaldo Carvalho de Melo 
114788f964dbSArnaldo Carvalho de Melo static int ccid3_hc_rx_getsockopt(struct sock *sk, const int optname, int len,
114888f964dbSArnaldo Carvalho de Melo 				  u32 __user *optval, int __user *optlen)
114988f964dbSArnaldo Carvalho de Melo {
115088f964dbSArnaldo Carvalho de Melo 	const struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
115188f964dbSArnaldo Carvalho de Melo 	const void *val;
115288f964dbSArnaldo Carvalho de Melo 
115388f964dbSArnaldo Carvalho de Melo 	/* Listen socks doesn't have a private CCID block */
115488f964dbSArnaldo Carvalho de Melo 	if (sk->sk_state == DCCP_LISTEN)
115588f964dbSArnaldo Carvalho de Melo 		return -EINVAL;
115688f964dbSArnaldo Carvalho de Melo 
115788f964dbSArnaldo Carvalho de Melo 	switch (optname) {
115888f964dbSArnaldo Carvalho de Melo 	case DCCP_SOCKOPT_CCID_RX_INFO:
115988f964dbSArnaldo Carvalho de Melo 		if (len < sizeof(hcrx->ccid3hcrx_tfrc))
116088f964dbSArnaldo Carvalho de Melo 			return -EINVAL;
116188f964dbSArnaldo Carvalho de Melo 		len = sizeof(hcrx->ccid3hcrx_tfrc);
116288f964dbSArnaldo Carvalho de Melo 		val = &hcrx->ccid3hcrx_tfrc;
116388f964dbSArnaldo Carvalho de Melo 		break;
116488f964dbSArnaldo Carvalho de Melo 	default:
116588f964dbSArnaldo Carvalho de Melo 		return -ENOPROTOOPT;
116688f964dbSArnaldo Carvalho de Melo 	}
116788f964dbSArnaldo Carvalho de Melo 
116888f964dbSArnaldo Carvalho de Melo 	if (put_user(len, optlen) || copy_to_user(optval, val, len))
116988f964dbSArnaldo Carvalho de Melo 		return -EFAULT;
117088f964dbSArnaldo Carvalho de Melo 
117188f964dbSArnaldo Carvalho de Melo 	return 0;
117288f964dbSArnaldo Carvalho de Melo }
117388f964dbSArnaldo Carvalho de Melo 
117488f964dbSArnaldo Carvalho de Melo static int ccid3_hc_tx_getsockopt(struct sock *sk, const int optname, int len,
117588f964dbSArnaldo Carvalho de Melo 				  u32 __user *optval, int __user *optlen)
117688f964dbSArnaldo Carvalho de Melo {
117788f964dbSArnaldo Carvalho de Melo 	const struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
117888f964dbSArnaldo Carvalho de Melo 	const void *val;
117988f964dbSArnaldo Carvalho de Melo 
118088f964dbSArnaldo Carvalho de Melo 	/* Listen socks doesn't have a private CCID block */
118188f964dbSArnaldo Carvalho de Melo 	if (sk->sk_state == DCCP_LISTEN)
118288f964dbSArnaldo Carvalho de Melo 		return -EINVAL;
118388f964dbSArnaldo Carvalho de Melo 
118488f964dbSArnaldo Carvalho de Melo 	switch (optname) {
118588f964dbSArnaldo Carvalho de Melo 	case DCCP_SOCKOPT_CCID_TX_INFO:
118688f964dbSArnaldo Carvalho de Melo 		if (len < sizeof(hctx->ccid3hctx_tfrc))
118788f964dbSArnaldo Carvalho de Melo 			return -EINVAL;
118888f964dbSArnaldo Carvalho de Melo 		len = sizeof(hctx->ccid3hctx_tfrc);
118988f964dbSArnaldo Carvalho de Melo 		val = &hctx->ccid3hctx_tfrc;
119088f964dbSArnaldo Carvalho de Melo 		break;
119188f964dbSArnaldo Carvalho de Melo 	default:
119288f964dbSArnaldo Carvalho de Melo 		return -ENOPROTOOPT;
119388f964dbSArnaldo Carvalho de Melo 	}
119488f964dbSArnaldo Carvalho de Melo 
119588f964dbSArnaldo Carvalho de Melo 	if (put_user(len, optlen) || copy_to_user(optval, val, len))
119688f964dbSArnaldo Carvalho de Melo 		return -EFAULT;
119788f964dbSArnaldo Carvalho de Melo 
119888f964dbSArnaldo Carvalho de Melo 	return 0;
119988f964dbSArnaldo Carvalho de Melo }
120088f964dbSArnaldo Carvalho de Melo 
120191f0ebf7SArnaldo Carvalho de Melo static struct ccid_operations ccid3 = {
12023dd9a7c3SIan McDonald 	.ccid_id		   = DCCPC_CCID3,
12037c657876SArnaldo Carvalho de Melo 	.ccid_name		   = "ccid3",
12047c657876SArnaldo Carvalho de Melo 	.ccid_owner		   = THIS_MODULE,
120591f0ebf7SArnaldo Carvalho de Melo 	.ccid_hc_tx_obj_size	   = sizeof(struct ccid3_hc_tx_sock),
12067c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_init	   = ccid3_hc_tx_init,
12077c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_exit	   = ccid3_hc_tx_exit,
12087c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_send_packet	   = ccid3_hc_tx_send_packet,
12097c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_packet_sent	   = ccid3_hc_tx_packet_sent,
12107c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_packet_recv	   = ccid3_hc_tx_packet_recv,
12117c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_insert_options = ccid3_hc_tx_insert_options,
12127c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_parse_options  = ccid3_hc_tx_parse_options,
121391f0ebf7SArnaldo Carvalho de Melo 	.ccid_hc_rx_obj_size	   = sizeof(struct ccid3_hc_rx_sock),
12147c657876SArnaldo Carvalho de Melo 	.ccid_hc_rx_init	   = ccid3_hc_rx_init,
12157c657876SArnaldo Carvalho de Melo 	.ccid_hc_rx_exit	   = ccid3_hc_rx_exit,
12167c657876SArnaldo Carvalho de Melo 	.ccid_hc_rx_insert_options = ccid3_hc_rx_insert_options,
12177c657876SArnaldo Carvalho de Melo 	.ccid_hc_rx_packet_recv	   = ccid3_hc_rx_packet_recv,
12182babe1f6SArnaldo Carvalho de Melo 	.ccid_hc_rx_get_info	   = ccid3_hc_rx_get_info,
12192babe1f6SArnaldo Carvalho de Melo 	.ccid_hc_tx_get_info	   = ccid3_hc_tx_get_info,
122088f964dbSArnaldo Carvalho de Melo 	.ccid_hc_rx_getsockopt	   = ccid3_hc_rx_getsockopt,
122188f964dbSArnaldo Carvalho de Melo 	.ccid_hc_tx_getsockopt	   = ccid3_hc_tx_getsockopt,
12227c657876SArnaldo Carvalho de Melo };
12237c657876SArnaldo Carvalho de Melo 
122456724aa4SGerrit Renker #ifdef CONFIG_IP_DCCP_CCID3_DEBUG
12257c657876SArnaldo Carvalho de Melo module_param(ccid3_debug, int, 0444);
12267c657876SArnaldo Carvalho de Melo MODULE_PARM_DESC(ccid3_debug, "Enable debug messages");
122756724aa4SGerrit Renker #endif
12287c657876SArnaldo Carvalho de Melo 
12297c657876SArnaldo Carvalho de Melo static __init int ccid3_module_init(void)
12307c657876SArnaldo Carvalho de Melo {
12318c60f3faSArnaldo Carvalho de Melo 	int rc = -ENOBUFS;
12327c657876SArnaldo Carvalho de Melo 
12338c60f3faSArnaldo Carvalho de Melo 	ccid3_rx_hist = dccp_rx_hist_new("ccid3");
12348c60f3faSArnaldo Carvalho de Melo 	if (ccid3_rx_hist == NULL)
12357c657876SArnaldo Carvalho de Melo 		goto out;
12367c657876SArnaldo Carvalho de Melo 
12378c60f3faSArnaldo Carvalho de Melo 	ccid3_tx_hist = dccp_tx_hist_new("ccid3");
12388c60f3faSArnaldo Carvalho de Melo 	if (ccid3_tx_hist == NULL)
12398c60f3faSArnaldo Carvalho de Melo 		goto out_free_rx;
12407c657876SArnaldo Carvalho de Melo 
1241ae6706f0SArnaldo Carvalho de Melo 	ccid3_li_hist = dccp_li_hist_new("ccid3");
1242ae6706f0SArnaldo Carvalho de Melo 	if (ccid3_li_hist == NULL)
12438c60f3faSArnaldo Carvalho de Melo 		goto out_free_tx;
12447c657876SArnaldo Carvalho de Melo 
12457c657876SArnaldo Carvalho de Melo 	rc = ccid_register(&ccid3);
12467c657876SArnaldo Carvalho de Melo 	if (rc != 0)
12477c657876SArnaldo Carvalho de Melo 		goto out_free_loss_interval_history;
12487c657876SArnaldo Carvalho de Melo out:
12497c657876SArnaldo Carvalho de Melo 	return rc;
12508c60f3faSArnaldo Carvalho de Melo 
12517c657876SArnaldo Carvalho de Melo out_free_loss_interval_history:
1252ae6706f0SArnaldo Carvalho de Melo 	dccp_li_hist_delete(ccid3_li_hist);
1253ae6706f0SArnaldo Carvalho de Melo 	ccid3_li_hist = NULL;
12548c60f3faSArnaldo Carvalho de Melo out_free_tx:
12558c60f3faSArnaldo Carvalho de Melo 	dccp_tx_hist_delete(ccid3_tx_hist);
12568c60f3faSArnaldo Carvalho de Melo 	ccid3_tx_hist = NULL;
12578c60f3faSArnaldo Carvalho de Melo out_free_rx:
12588c60f3faSArnaldo Carvalho de Melo 	dccp_rx_hist_delete(ccid3_rx_hist);
12598c60f3faSArnaldo Carvalho de Melo 	ccid3_rx_hist = NULL;
12607c657876SArnaldo Carvalho de Melo 	goto out;
12617c657876SArnaldo Carvalho de Melo }
12627c657876SArnaldo Carvalho de Melo module_init(ccid3_module_init);
12637c657876SArnaldo Carvalho de Melo 
12647c657876SArnaldo Carvalho de Melo static __exit void ccid3_module_exit(void)
12657c657876SArnaldo Carvalho de Melo {
12667c657876SArnaldo Carvalho de Melo 	ccid_unregister(&ccid3);
12677c657876SArnaldo Carvalho de Melo 
12688c60f3faSArnaldo Carvalho de Melo 	if (ccid3_tx_hist != NULL) {
12698c60f3faSArnaldo Carvalho de Melo 		dccp_tx_hist_delete(ccid3_tx_hist);
12708c60f3faSArnaldo Carvalho de Melo 		ccid3_tx_hist = NULL;
12717c657876SArnaldo Carvalho de Melo 	}
12728c60f3faSArnaldo Carvalho de Melo 	if (ccid3_rx_hist != NULL) {
12738c60f3faSArnaldo Carvalho de Melo 		dccp_rx_hist_delete(ccid3_rx_hist);
12748c60f3faSArnaldo Carvalho de Melo 		ccid3_rx_hist = NULL;
12757c657876SArnaldo Carvalho de Melo 	}
1276ae6706f0SArnaldo Carvalho de Melo 	if (ccid3_li_hist != NULL) {
1277ae6706f0SArnaldo Carvalho de Melo 		dccp_li_hist_delete(ccid3_li_hist);
1278ae6706f0SArnaldo Carvalho de Melo 		ccid3_li_hist = NULL;
12797c657876SArnaldo Carvalho de Melo 	}
12807c657876SArnaldo Carvalho de Melo }
12817c657876SArnaldo Carvalho de Melo module_exit(ccid3_module_exit);
12827c657876SArnaldo Carvalho de Melo 
1283e6bccd35SIan McDonald MODULE_AUTHOR("Ian McDonald <ian.mcdonald@jandi.co.nz>, "
12841f2333aeSArnaldo Carvalho de Melo 	      "Arnaldo Carvalho de Melo <acme@ghostprotocols.net>");
12857c657876SArnaldo Carvalho de Melo MODULE_DESCRIPTION("DCCP TFRC CCID3 CCID");
12867c657876SArnaldo Carvalho de Melo MODULE_LICENSE("GPL");
12877c657876SArnaldo Carvalho de Melo MODULE_ALIAS("net-dccp-ccid-3");
1288