xref: /openbmc/linux/net/dccp/ccids/ccid3.c (revision a21f9f96)
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 #include "../ccid.h"
377c657876SArnaldo Carvalho de Melo #include "../dccp.h"
384524b259SArnaldo Carvalho de Melo #include "lib/packet_history.h"
39ae6706f0SArnaldo Carvalho de Melo #include "lib/loss_interval.h"
4036729c1aSArnaldo Carvalho de Melo #include "lib/tfrc.h"
417c657876SArnaldo Carvalho de Melo #include "ccid3.h"
427c657876SArnaldo Carvalho de Melo 
4356724aa4SGerrit Renker #ifdef CONFIG_IP_DCCP_CCID3_DEBUG
4456724aa4SGerrit Renker static int ccid3_debug;
4556724aa4SGerrit Renker #define ccid3_pr_debug(format, a...)	DCCP_PR_DEBUG(ccid3_debug, format, ##a)
467c657876SArnaldo Carvalho de Melo #else
477c657876SArnaldo Carvalho de Melo #define ccid3_pr_debug(format, a...)
487c657876SArnaldo Carvalho de Melo #endif
497c657876SArnaldo Carvalho de Melo 
50a1d3a355SArnaldo Carvalho de Melo static struct dccp_tx_hist *ccid3_tx_hist;
51a1d3a355SArnaldo Carvalho de Melo static struct dccp_rx_hist *ccid3_rx_hist;
52ae6706f0SArnaldo Carvalho de Melo static struct dccp_li_hist *ccid3_li_hist;
537c657876SArnaldo Carvalho de Melo 
549bf17475SGerrit Renker /*
559bf17475SGerrit Renker  *	Transmitter Half-Connection Routines
569bf17475SGerrit Renker  */
5756724aa4SGerrit Renker #ifdef CONFIG_IP_DCCP_CCID3_DEBUG
587c657876SArnaldo Carvalho de Melo static const char *ccid3_tx_state_name(enum ccid3_hc_tx_states state)
597c657876SArnaldo Carvalho de Melo {
607c657876SArnaldo Carvalho de Melo 	static char *ccid3_state_names[] = {
617c657876SArnaldo Carvalho de Melo 	[TFRC_SSTATE_NO_SENT]  = "NO_SENT",
627c657876SArnaldo Carvalho de Melo 	[TFRC_SSTATE_NO_FBACK] = "NO_FBACK",
637c657876SArnaldo Carvalho de Melo 	[TFRC_SSTATE_FBACK]    = "FBACK",
647c657876SArnaldo Carvalho de Melo 	[TFRC_SSTATE_TERM]     = "TERM",
657c657876SArnaldo Carvalho de Melo 	};
667c657876SArnaldo Carvalho de Melo 
677c657876SArnaldo Carvalho de Melo 	return ccid3_state_names[state];
687c657876SArnaldo Carvalho de Melo }
697c657876SArnaldo Carvalho de Melo #endif
707c657876SArnaldo Carvalho de Melo 
71c25a18baSArnaldo Carvalho de Melo static void ccid3_hc_tx_set_state(struct sock *sk,
721f2333aeSArnaldo Carvalho de Melo 				  enum ccid3_hc_tx_states state)
737c657876SArnaldo Carvalho de Melo {
7459725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
757c657876SArnaldo Carvalho de Melo 	enum ccid3_hc_tx_states oldstate = hctx->ccid3hctx_state;
767c657876SArnaldo Carvalho de Melo 
777c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s(%p) %-8.8s -> %s\n",
781f2333aeSArnaldo Carvalho de Melo 		       dccp_role(sk), sk, ccid3_tx_state_name(oldstate),
791f2333aeSArnaldo Carvalho de Melo 		       ccid3_tx_state_name(state));
807c657876SArnaldo Carvalho de Melo 	WARN_ON(state == oldstate);
817c657876SArnaldo Carvalho de Melo 	hctx->ccid3hctx_state = state;
827c657876SArnaldo Carvalho de Melo }
837c657876SArnaldo Carvalho de Melo 
8417893bc1SGerrit Renker /*
85a21f9f96SGerrit Renker  * Compute the initial sending rate X_init according to RFC 3390:
86a21f9f96SGerrit Renker  *	w_init   =    min(4 * MSS, max(2 * MSS, 4380 bytes))
87a21f9f96SGerrit Renker  *	X_init   =    w_init / RTT
88a21f9f96SGerrit Renker  * For consistency with other parts of the code, X_init is scaled by 2^6.
89a21f9f96SGerrit Renker  */
90a21f9f96SGerrit Renker static inline u64 rfc3390_initial_rate(struct sock *sk)
91a21f9f96SGerrit Renker {
92a21f9f96SGerrit Renker 	const struct dccp_sock *dp = dccp_sk(sk);
93a21f9f96SGerrit Renker 	const __u32 w_init = min(4 * dp->dccps_mss_cache,
94a21f9f96SGerrit Renker 				 max(2 * dp->dccps_mss_cache, 4380U));
95a21f9f96SGerrit Renker 
96a21f9f96SGerrit Renker 	return scaled_div(w_init << 6, ccid3_hc_tx_sk(sk)->ccid3hctx_rtt);
97a21f9f96SGerrit Renker }
98a21f9f96SGerrit Renker 
99a21f9f96SGerrit Renker /*
1001266adeeSGerrit Renker  * Recalculate t_ipi and delta (should be called whenever X changes)
10117893bc1SGerrit Renker  */
1021266adeeSGerrit Renker static inline void ccid3_update_send_interval(struct ccid3_hc_tx_sock *hctx)
1037c657876SArnaldo Carvalho de Melo {
1041a21e49aSGerrit Renker 	/* Calculate new t_ipi = s / X_inst (X_inst is in 64 * bytes/second) */
1051a21e49aSGerrit Renker 	hctx->ccid3hctx_t_ipi = scaled_div(hctx->ccid3hctx_s,
1061a21e49aSGerrit Renker 					   hctx->ccid3hctx_x >> 6);
10717893bc1SGerrit Renker 
1087c657876SArnaldo Carvalho de Melo 	/* Calculate new delta by delta = min(t_ipi / 2, t_gran / 2) */
1091f2333aeSArnaldo Carvalho de Melo 	hctx->ccid3hctx_delta = min_t(u32, hctx->ccid3hctx_t_ipi / 2,
1101f2333aeSArnaldo Carvalho de Melo 					   TFRC_OPSYS_HALF_TIME_GRAN);
1118699be7dSIan McDonald 
1121761f7d7SGerrit Renker 	ccid3_pr_debug("t_ipi=%u, delta=%u, s=%u, X=%u\n",
1138699be7dSIan McDonald 		       hctx->ccid3hctx_t_ipi, hctx->ccid3hctx_delta,
1141761f7d7SGerrit Renker 		       hctx->ccid3hctx_s, (unsigned)(hctx->ccid3hctx_x >> 6));
1158699be7dSIan McDonald 
1167c657876SArnaldo Carvalho de Melo }
1177c657876SArnaldo Carvalho de Melo /*
1187c657876SArnaldo Carvalho de Melo  * Update X by
1197c657876SArnaldo Carvalho de Melo  *    If (p > 0)
1205c3fbb6aSGerrit Renker  *       X_calc = calcX(s, R, p);
1217c657876SArnaldo Carvalho de Melo  *       X = max(min(X_calc, 2 * X_recv), s / t_mbi);
1227c657876SArnaldo Carvalho de Melo  *    Else
1237c657876SArnaldo Carvalho de Melo  *       If (now - tld >= R)
1247c657876SArnaldo Carvalho de Melo  *          X = max(min(2 * X, 2 * X_recv), s / R);
1257c657876SArnaldo Carvalho de Melo  *          tld = now;
1265c3fbb6aSGerrit Renker  *
1271a21e49aSGerrit Renker  * Note: X and X_recv are both stored in units of 64 * bytes/second, to support
1281a21e49aSGerrit Renker  *       fine-grained resolution of sending rates. This requires scaling by 2^6
1291a21e49aSGerrit Renker  *       throughout the code. Only X_calc is unscaled (in bytes/second).
1301a21e49aSGerrit Renker  *
1317c657876SArnaldo Carvalho de Melo  */
132a79ef76fSGerrit Renker static void ccid3_hc_tx_update_x(struct sock *sk, struct timeval *now)
133a79ef76fSGerrit Renker 
1347c657876SArnaldo Carvalho de Melo {
13559725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
1361a21e49aSGerrit Renker 	const  __u64 old_x = hctx->ccid3hctx_x;
1377c657876SArnaldo Carvalho de Melo 
13844158306SGerrit Renker 	if (hctx->ccid3hctx_p > 0) {
1391a21e49aSGerrit Renker 
1409e8efc82SGerrit Renker 		hctx->ccid3hctx_x = min(((__u64)hctx->ccid3hctx_x_calc) << 6,
1411a21e49aSGerrit Renker 					hctx->ccid3hctx_x_recv * 2);
1429e8efc82SGerrit Renker 		hctx->ccid3hctx_x = max(hctx->ccid3hctx_x,
1439e8efc82SGerrit Renker 					(((__u64)hctx->ccid3hctx_s) << 6) /
1449e8efc82SGerrit Renker 								TFRC_T_MBI);
145b6ee3d4aSArnaldo Carvalho de Melo 
1460f9e5b57SGerrit Renker 	} else if (timeval_delta(now, &hctx->ccid3hctx_t_ld) -
1470f9e5b57SGerrit Renker 			(suseconds_t)hctx->ccid3hctx_rtt >= 0) {
1481a21e49aSGerrit Renker 
1499e8efc82SGerrit Renker 		hctx->ccid3hctx_x =
1509e8efc82SGerrit Renker 			max(2 * min(hctx->ccid3hctx_x, hctx->ccid3hctx_x_recv),
1519e8efc82SGerrit Renker 			    scaled_div(((__u64)hctx->ccid3hctx_s) << 6,
1526b5e633aSArnaldo Carvalho de Melo 				       hctx->ccid3hctx_rtt));
153a79ef76fSGerrit Renker 		hctx->ccid3hctx_t_ld = *now;
154ff586298SGerrit Renker 	}
155a79ef76fSGerrit Renker 
1568699be7dSIan McDonald 	if (hctx->ccid3hctx_x != old_x) {
1571761f7d7SGerrit Renker 		ccid3_pr_debug("X_prev=%u, X_now=%u, X_calc=%u, "
1581761f7d7SGerrit Renker 			       "X_recv=%u\n", (unsigned)(old_x >> 6),
1591761f7d7SGerrit Renker 			       (unsigned)(hctx->ccid3hctx_x >> 6),
1601761f7d7SGerrit Renker 			       hctx->ccid3hctx_x_calc,
1611761f7d7SGerrit Renker 			       (unsigned)(hctx->ccid3hctx_x_recv >> 6));
1628699be7dSIan McDonald 
1631266adeeSGerrit Renker 		ccid3_update_send_interval(hctx);
1647c657876SArnaldo Carvalho de Melo 	}
1658699be7dSIan McDonald }
1667c657876SArnaldo Carvalho de Melo 
16778ad713dSGerrit Renker /*
16878ad713dSGerrit Renker  *	Track the mean packet size `s' (cf. RFC 4342, 5.3 and  RFC 3448, 4.1)
16978ad713dSGerrit Renker  *	@len: DCCP packet payload size in bytes
17078ad713dSGerrit Renker  */
17178ad713dSGerrit Renker static inline void ccid3_hc_tx_update_s(struct ccid3_hc_tx_sock *hctx, int len)
17278ad713dSGerrit Renker {
1731266adeeSGerrit Renker 	const u16 old_s = hctx->ccid3hctx_s;
1741266adeeSGerrit Renker 
1751266adeeSGerrit Renker 	hctx->ccid3hctx_s = old_s == 0 ? len : (9 * old_s + len) / 10;
1761266adeeSGerrit Renker 
1771266adeeSGerrit Renker 	if (hctx->ccid3hctx_s != old_s)
1781266adeeSGerrit Renker 		ccid3_update_send_interval(hctx);
17978ad713dSGerrit Renker }
18078ad713dSGerrit Renker 
1819f8681dbSGerrit Renker /*
1829f8681dbSGerrit Renker  *	Update Window Counter using the algorithm from [RFC 4342, 8.1].
1839f8681dbSGerrit Renker  *	The algorithm is not applicable if RTT < 4 microseconds.
1849f8681dbSGerrit Renker  */
1859f8681dbSGerrit Renker static inline void ccid3_hc_tx_update_win_count(struct ccid3_hc_tx_sock *hctx,
1869f8681dbSGerrit Renker 						struct timeval *now)
1879f8681dbSGerrit Renker {
1889f8681dbSGerrit Renker 	suseconds_t delta;
1899f8681dbSGerrit Renker 	u32 quarter_rtts;
1909f8681dbSGerrit Renker 
1919f8681dbSGerrit Renker 	if (unlikely(hctx->ccid3hctx_rtt < 4))	/* avoid divide-by-zero */
1929f8681dbSGerrit Renker 		return;
1939f8681dbSGerrit Renker 
1949f8681dbSGerrit Renker 	delta = timeval_delta(now, &hctx->ccid3hctx_t_last_win_count);
1959f8681dbSGerrit Renker 	DCCP_BUG_ON(delta < 0);
1969f8681dbSGerrit Renker 
1979f8681dbSGerrit Renker 	quarter_rtts = (u32)delta / (hctx->ccid3hctx_rtt / 4);
1989f8681dbSGerrit Renker 
1999f8681dbSGerrit Renker 	if (quarter_rtts > 0) {
2009f8681dbSGerrit Renker 		hctx->ccid3hctx_t_last_win_count = *now;
2019f8681dbSGerrit Renker 		hctx->ccid3hctx_last_win_count	+= min_t(u32, quarter_rtts, 5);
2029f8681dbSGerrit Renker 		hctx->ccid3hctx_last_win_count	&= 0xF;		/* mod 16 */
2039f8681dbSGerrit Renker 
2049f8681dbSGerrit Renker 		ccid3_pr_debug("now at %#X\n", hctx->ccid3hctx_last_win_count);
2059f8681dbSGerrit Renker 	}
2069f8681dbSGerrit Renker }
2079f8681dbSGerrit Renker 
2087c657876SArnaldo Carvalho de Melo static void ccid3_hc_tx_no_feedback_timer(unsigned long data)
2097c657876SArnaldo Carvalho de Melo {
2107c657876SArnaldo Carvalho de Melo 	struct sock *sk = (struct sock *)data;
21159725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
2122a1fda6fSGerrit Renker 	unsigned long t_nfb = USEC_PER_SEC / 5;
2137c657876SArnaldo Carvalho de Melo 
2147c657876SArnaldo Carvalho de Melo 	bh_lock_sock(sk);
2157c657876SArnaldo Carvalho de Melo 	if (sock_owned_by_user(sk)) {
2167c657876SArnaldo Carvalho de Melo 		/* Try again later. */
2177c657876SArnaldo Carvalho de Melo 		/* XXX: set some sensible MIB */
21848e03eeeSGerrit Renker 		goto restart_timer;
2197c657876SArnaldo Carvalho de Melo 	}
2207c657876SArnaldo Carvalho de Melo 
221a9672411SGerrit Renker 	ccid3_pr_debug("%s(%p, state=%s) - entry \n", dccp_role(sk), sk,
2227c657876SArnaldo Carvalho de Melo 		       ccid3_tx_state_name(hctx->ccid3hctx_state));
2237c657876SArnaldo Carvalho de Melo 
2247c657876SArnaldo Carvalho de Melo 	switch (hctx->ccid3hctx_state) {
2257c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_FBACK:
226a79ef76fSGerrit Renker 		/* RFC 3448, 4.4: Halve send rate directly */
2279e8efc82SGerrit Renker 		hctx->ccid3hctx_x = max(hctx->ccid3hctx_x / 2,
2289e8efc82SGerrit Renker 					(((__u64)hctx->ccid3hctx_s) << 6) /
2299e8efc82SGerrit Renker 								    TFRC_T_MBI);
2307c657876SArnaldo Carvalho de Melo 
231a9672411SGerrit Renker 		ccid3_pr_debug("%s(%p, state=%s), updated tx rate to %u "
232a9672411SGerrit Renker 			       "bytes/s\n", dccp_role(sk), sk,
2331f2333aeSArnaldo Carvalho de Melo 			       ccid3_tx_state_name(hctx->ccid3hctx_state),
2341a21e49aSGerrit Renker 			       (unsigned)(hctx->ccid3hctx_x >> 6));
23548e03eeeSGerrit Renker 		/* The value of R is still undefined and so we can not recompute
23648e03eeeSGerrit Renker 		 * the timout value. Keep initial value as per [RFC 4342, 5]. */
2372a1fda6fSGerrit Renker 		t_nfb = TFRC_INITIAL_TIMEOUT;
2381266adeeSGerrit Renker 		ccid3_update_send_interval(hctx);
2397c657876SArnaldo Carvalho de Melo 		break;
2407c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_FBACK:
2411f2333aeSArnaldo Carvalho de Melo 		/*
2421f2333aeSArnaldo Carvalho de Melo 		 * Check if IDLE since last timeout and recv rate is less than
2431a21e49aSGerrit Renker 		 * 4 packets (in units of 64*bytes/sec) per RTT
2441f2333aeSArnaldo Carvalho de Melo 		 */
2451f2333aeSArnaldo Carvalho de Melo 		if (!hctx->ccid3hctx_idle ||
2461a21e49aSGerrit Renker 		    (hctx->ccid3hctx_x_recv >= 4 *
2478109b02bSArnaldo Carvalho de Melo 		     scaled_div(((__u64)hctx->ccid3hctx_s) << 6,
2488109b02bSArnaldo Carvalho de Melo 				hctx->ccid3hctx_rtt))) {
249a79ef76fSGerrit Renker 			struct timeval now;
250a79ef76fSGerrit Renker 
251a9672411SGerrit Renker 			ccid3_pr_debug("%s(%p, state=%s), not idle\n",
2521f2333aeSArnaldo Carvalho de Melo 				       dccp_role(sk), sk,
2537c657876SArnaldo Carvalho de Melo 				   ccid3_tx_state_name(hctx->ccid3hctx_state));
2547c657876SArnaldo Carvalho de Melo 
255ff586298SGerrit Renker 			/*
256ff586298SGerrit Renker 			 *  Modify the cached value of X_recv [RFC 3448, 4.4]
257ff586298SGerrit Renker 			 *
258ff586298SGerrit Renker 			 *  If (p == 0 || X_calc > 2 * X_recv)
2597c657876SArnaldo Carvalho de Melo 			 *    X_recv = max(X_recv / 2, s / (2 * t_mbi));
2607c657876SArnaldo Carvalho de Melo 			 *  Else
2617c657876SArnaldo Carvalho de Melo 			 *    X_recv = X_calc / 4;
2621a21e49aSGerrit Renker 			 *
2631a21e49aSGerrit Renker 			 *  Note that X_recv is scaled by 2^6 while X_calc is not
2647c657876SArnaldo Carvalho de Melo 			 */
26544158306SGerrit Renker 			BUG_ON(hctx->ccid3hctx_p && !hctx->ccid3hctx_x_calc);
2667c657876SArnaldo Carvalho de Melo 
26744158306SGerrit Renker 			if (hctx->ccid3hctx_p  == 0 ||
2688109b02bSArnaldo Carvalho de Melo 			    (hctx->ccid3hctx_x_calc >
2698109b02bSArnaldo Carvalho de Melo 			     (hctx->ccid3hctx_x_recv >> 5))) {
2701a21e49aSGerrit Renker 
2711a21e49aSGerrit Renker 				hctx->ccid3hctx_x_recv =
2729e8efc82SGerrit Renker 					max(hctx->ccid3hctx_x_recv / 2,
2739e8efc82SGerrit Renker 					    (((__u64)hctx->ccid3hctx_s) << 6) /
2741a21e49aSGerrit Renker 							  (2 * TFRC_T_MBI));
2751a21e49aSGerrit Renker 
276ff586298SGerrit Renker 				if (hctx->ccid3hctx_p == 0)
277ff586298SGerrit Renker 					dccp_timestamp(sk, &now);
2789e8efc82SGerrit Renker 			} else {
2799e8efc82SGerrit Renker 				hctx->ccid3hctx_x_recv = hctx->ccid3hctx_x_calc;
2809e8efc82SGerrit Renker 				hctx->ccid3hctx_x_recv <<= 4;
2819e8efc82SGerrit Renker 			}
282ff586298SGerrit Renker 			/* Now recalculate X [RFC 3448, 4.3, step (4)] */
283a79ef76fSGerrit Renker 			ccid3_hc_tx_update_x(sk, &now);
2847c657876SArnaldo Carvalho de Melo 		}
2856b5e633aSArnaldo Carvalho de Melo 		/*
2866b5e633aSArnaldo Carvalho de Melo 		 * Schedule no feedback timer to expire in
2878a508ac2SGerrit Renker 		 * max(t_RTO, 2 * s/X)  =  max(t_RTO, 2 * t_ipi)
2888a508ac2SGerrit Renker 		 * See comments in packet_recv() regarding the value of t_RTO.
2896b5e633aSArnaldo Carvalho de Melo 		 */
2908a508ac2SGerrit Renker 		t_nfb = max(hctx->ccid3hctx_t_rto, 2 * hctx->ccid3hctx_t_ipi);
2917c657876SArnaldo Carvalho de Melo 		break;
29259348b19SGerrit Renker 	case TFRC_SSTATE_NO_SENT:
293a9672411SGerrit Renker 		DCCP_BUG("%s(%p) - Illegal state NO_SENT", dccp_role(sk), sk);
29459348b19SGerrit Renker 		/* fall through */
29559348b19SGerrit Renker 	case TFRC_SSTATE_TERM:
2967c657876SArnaldo Carvalho de Melo 		goto out;
2977c657876SArnaldo Carvalho de Melo 	}
2987c657876SArnaldo Carvalho de Melo 
2997c657876SArnaldo Carvalho de Melo 	hctx->ccid3hctx_idle = 1;
30048e03eeeSGerrit Renker 
30148e03eeeSGerrit Renker restart_timer:
30248e03eeeSGerrit Renker 	sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
3032a1fda6fSGerrit Renker 			   jiffies + usecs_to_jiffies(t_nfb));
3047c657876SArnaldo Carvalho de Melo out:
3057c657876SArnaldo Carvalho de Melo 	bh_unlock_sock(sk);
3067c657876SArnaldo Carvalho de Melo 	sock_put(sk);
3077c657876SArnaldo Carvalho de Melo }
3087c657876SArnaldo Carvalho de Melo 
3097da7f456SGerrit Renker /*
3107da7f456SGerrit Renker  * returns
3117da7f456SGerrit Renker  *   > 0: delay (in msecs) that should pass before actually sending
3127da7f456SGerrit Renker  *   = 0: can send immediately
3137da7f456SGerrit Renker  *   < 0: error condition; do not send packet
3147da7f456SGerrit Renker  */
3156b57c93dSGerrit Renker static int ccid3_hc_tx_send_packet(struct sock *sk, struct sk_buff *skb)
3167c657876SArnaldo Carvalho de Melo {
3177c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
31859725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
3197c657876SArnaldo Carvalho de Melo 	struct timeval now;
3200f9e5b57SGerrit Renker 	suseconds_t delay;
3217c657876SArnaldo Carvalho de Melo 
32259348b19SGerrit Renker 	BUG_ON(hctx == NULL);
3231f2333aeSArnaldo Carvalho de Melo 
3247c657876SArnaldo Carvalho de Melo 	/*
325da335bafSGerrit Renker 	 * This function is called only for Data and DataAck packets. Sending
326da335bafSGerrit Renker 	 * zero-sized Data(Ack)s is theoretically possible, but for congestion
327da335bafSGerrit Renker 	 * control this case is pathological - ignore it.
3287c657876SArnaldo Carvalho de Melo 	 */
3296b57c93dSGerrit Renker 	if (unlikely(skb->len == 0))
330da335bafSGerrit Renker 		return -EBADMSG;
3317c657876SArnaldo Carvalho de Melo 
332b0e56780SArnaldo Carvalho de Melo 	dccp_timestamp(sk, &now);
3337c657876SArnaldo Carvalho de Melo 
3347c657876SArnaldo Carvalho de Melo 	switch (hctx->ccid3hctx_state) {
3357c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_SENT:
3361f2333aeSArnaldo Carvalho de Melo 		sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
3378109b02bSArnaldo Carvalho de Melo 			       (jiffies +
3388109b02bSArnaldo Carvalho de Melo 				usecs_to_jiffies(TFRC_INITIAL_TIMEOUT)));
3397c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_last_win_count	 = 0;
3407c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_t_last_win_count = now;
3417c657876SArnaldo Carvalho de Melo 		ccid3_hc_tx_set_state(sk, TFRC_SSTATE_NO_FBACK);
3427c657876SArnaldo Carvalho de Melo 
3431a21e49aSGerrit Renker 		/* Set initial sending rate X/s to 1pps (X is scaled by 2^6) */
3441266adeeSGerrit Renker 		hctx->ccid3hctx_x = hctx->ccid3hctx_s = skb->len;
3459e8efc82SGerrit Renker 		hctx->ccid3hctx_x <<= 6;
34678ad713dSGerrit Renker 
34790feeb95SGerrit Renker 		/* First timeout, according to [RFC 3448, 4.2], is 1 second */
34890feeb95SGerrit Renker 		hctx->ccid3hctx_t_ipi = USEC_PER_SEC;
34990feeb95SGerrit Renker 		/* Initial delta: minimum of 0.5 sec and t_gran/2 */
35090feeb95SGerrit Renker 		hctx->ccid3hctx_delta = TFRC_OPSYS_HALF_TIME_GRAN;
35190feeb95SGerrit Renker 
35290feeb95SGerrit Renker 		/* Set t_0 for initial packet */
3537c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_t_nom = now;
3547c657876SArnaldo Carvalho de Melo 		break;
3557c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_FBACK:
3567c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_FBACK:
35791cf5a17SGerrit Renker 		delay = timeval_delta(&hctx->ccid3hctx_t_nom, &now);
3588699be7dSIan McDonald 		ccid3_pr_debug("delay=%ld\n", (long)delay);
35991cf5a17SGerrit Renker 		/*
36091cf5a17SGerrit Renker 		 *	Scheduling of packet transmissions [RFC 3448, 4.6]
36191cf5a17SGerrit Renker 		 *
36291cf5a17SGerrit Renker 		 * if (t_now > t_nom - delta)
36391cf5a17SGerrit Renker 		 *       // send the packet now
36491cf5a17SGerrit Renker 		 * else
36591cf5a17SGerrit Renker 		 *       // send the packet in (t_nom - t_now) milliseconds.
36691cf5a17SGerrit Renker 		 */
3670f9e5b57SGerrit Renker 		if (delay - (suseconds_t)hctx->ccid3hctx_delta >= 0)
3687da7f456SGerrit Renker 			return delay / 1000L;
3699f8681dbSGerrit Renker 
3709f8681dbSGerrit Renker 		ccid3_hc_tx_update_win_count(hctx, &now);
3717c657876SArnaldo Carvalho de Melo 		break;
37259348b19SGerrit Renker 	case TFRC_SSTATE_TERM:
373a9672411SGerrit Renker 		DCCP_BUG("%s(%p) - Illegal state TERM", dccp_role(sk), sk);
3747da7f456SGerrit Renker 		return -EINVAL;
3757c657876SArnaldo Carvalho de Melo 	}
3767c657876SArnaldo Carvalho de Melo 
3777da7f456SGerrit Renker 	/* prepare to send now (add options etc.) */
378507d37cfSArnaldo Carvalho de Melo 	dp->dccps_hc_tx_insert_options = 1;
379e312d100SGerrit Renker 	DCCP_SKB_CB(skb)->dccpd_ccval = hctx->ccid3hctx_last_win_count;
380e312d100SGerrit Renker 
381e312d100SGerrit Renker 	/* set the nominal send time for the next following packet */
3827da7f456SGerrit Renker 	timeval_add_usecs(&hctx->ccid3hctx_t_nom, hctx->ccid3hctx_t_ipi);
3837da7f456SGerrit Renker 
3847da7f456SGerrit Renker 	return 0;
3857c657876SArnaldo Carvalho de Melo }
3867c657876SArnaldo Carvalho de Melo 
3878109b02bSArnaldo Carvalho de Melo static void ccid3_hc_tx_packet_sent(struct sock *sk, int more,
3888109b02bSArnaldo Carvalho de Melo 				    unsigned int len)
3897c657876SArnaldo Carvalho de Melo {
39059725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
3917c657876SArnaldo Carvalho de Melo 	struct timeval now;
3926b57c93dSGerrit Renker 	struct dccp_tx_hist_entry *packet;
3937c657876SArnaldo Carvalho de Melo 
39459348b19SGerrit Renker 	BUG_ON(hctx == NULL);
3957c657876SArnaldo Carvalho de Melo 
39678ad713dSGerrit Renker 	ccid3_hc_tx_update_s(hctx, len);
39778ad713dSGerrit Renker 
398c5a1ae9aSGerrit Renker 	packet = dccp_tx_hist_entry_new(ccid3_tx_hist, GFP_ATOMIC);
39959d203f9SArnaldo Carvalho de Melo 	if (unlikely(packet == NULL)) {
400c5a1ae9aSGerrit Renker 		DCCP_CRIT("packet history - out of memory!");
4017c657876SArnaldo Carvalho de Melo 		return;
4027c657876SArnaldo Carvalho de Melo 	}
403c5a1ae9aSGerrit Renker 	dccp_tx_hist_add_entry(&hctx->ccid3hctx_hist, packet);
404c5a1ae9aSGerrit Renker 
405c5a1ae9aSGerrit Renker 	dccp_timestamp(sk, &now);
4068c60f3faSArnaldo Carvalho de Melo 	packet->dccphtx_tstamp = now;
407c5a1ae9aSGerrit Renker 	packet->dccphtx_seqno  = dccp_sk(sk)->dccps_gss;
408c1734376SArnaldo Carvalho de Melo 	packet->dccphtx_rtt    = hctx->ccid3hctx_rtt;
4098c60f3faSArnaldo Carvalho de Melo 	packet->dccphtx_sent   = 1;
410c5a1ae9aSGerrit Renker 	hctx->ccid3hctx_idle   = 0;
4117c657876SArnaldo Carvalho de Melo }
4127c657876SArnaldo Carvalho de Melo 
4137c657876SArnaldo Carvalho de Melo static void ccid3_hc_tx_packet_recv(struct sock *sk, struct sk_buff *skb)
4147c657876SArnaldo Carvalho de Melo {
41559725dc2SArnaldo Carvalho de Melo 	const struct dccp_sock *dp = dccp_sk(sk);
41659725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
4177c657876SArnaldo Carvalho de Melo 	struct ccid3_options_received *opt_recv;
4188c60f3faSArnaldo Carvalho de Melo 	struct dccp_tx_hist_entry *packet;
419b0e56780SArnaldo Carvalho de Melo 	struct timeval now;
4202a1fda6fSGerrit Renker 	unsigned long t_nfb;
4217c657876SArnaldo Carvalho de Melo 	u32 pinv;
4221fba78b6SArnaldo Carvalho de Melo 	suseconds_t r_sample, t_elapsed;
4231f2333aeSArnaldo Carvalho de Melo 
42459348b19SGerrit Renker 	BUG_ON(hctx == NULL);
4257c657876SArnaldo Carvalho de Melo 
4267c657876SArnaldo Carvalho de Melo 	/* we are only interested in ACKs */
4277c657876SArnaldo Carvalho de Melo 	if (!(DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_ACK ||
4287c657876SArnaldo Carvalho de Melo 	      DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_DATAACK))
4297c657876SArnaldo Carvalho de Melo 		return;
4307c657876SArnaldo Carvalho de Melo 
4317c657876SArnaldo Carvalho de Melo 	opt_recv = &hctx->ccid3hctx_options_received;
4327c657876SArnaldo Carvalho de Melo 
4337c657876SArnaldo Carvalho de Melo 	switch (hctx->ccid3hctx_state) {
4347c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_FBACK:
4357c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_FBACK:
4365c3fbb6aSGerrit Renker 		/* get packet from history to look up t_recvdata */
4378c60f3faSArnaldo Carvalho de Melo 		packet = dccp_tx_hist_find_entry(&hctx->ccid3hctx_hist,
4388c60f3faSArnaldo Carvalho de Melo 					      DCCP_SKB_CB(skb)->dccpd_ack_seq);
43959d203f9SArnaldo Carvalho de Melo 		if (unlikely(packet == NULL)) {
4405c3fbb6aSGerrit Renker 			DCCP_WARN("%s(%p), seqno %llu(%s) doesn't exist "
44159348b19SGerrit Renker 				  "in history!\n",  dccp_role(sk), sk,
44259d203f9SArnaldo Carvalho de Melo 			    (unsigned long long)DCCP_SKB_CB(skb)->dccpd_ack_seq,
4437c657876SArnaldo Carvalho de Melo 				dccp_packet_name(DCCP_SKB_CB(skb)->dccpd_type));
4447c657876SArnaldo Carvalho de Melo 			return;
4457c657876SArnaldo Carvalho de Melo 		}
4467c657876SArnaldo Carvalho de Melo 
4471a21e49aSGerrit Renker 		/* Update receive rate in units of 64 * bytes/second */
4489e8efc82SGerrit Renker 		hctx->ccid3hctx_x_recv = opt_recv->ccid3or_receive_rate;
4499e8efc82SGerrit Renker 		hctx->ccid3hctx_x_recv <<= 6;
4505c3fbb6aSGerrit Renker 
4515c3fbb6aSGerrit Renker 		/* Update loss event rate */
4525c3fbb6aSGerrit Renker 		pinv = opt_recv->ccid3or_loss_event_rate;
45345393a66SGerrit Renker 		if (pinv == ~0U || pinv == 0)	       /* see RFC 4342, 8.5   */
4545c3fbb6aSGerrit Renker 			hctx->ccid3hctx_p = 0;
45545393a66SGerrit Renker 		else				       /* can not exceed 100% */
4565c3fbb6aSGerrit Renker 			hctx->ccid3hctx_p = 1000000 / pinv;
4575c3fbb6aSGerrit Renker 
458b0e56780SArnaldo Carvalho de Melo 		dccp_timestamp(sk, &now);
4595c3fbb6aSGerrit Renker 
4605c3fbb6aSGerrit Renker 		/*
4615c3fbb6aSGerrit Renker 		 * Calculate new round trip sample as per [RFC 3448, 4.3] by
4625c3fbb6aSGerrit Renker 		 *	R_sample  =  (now - t_recvdata) - t_elapsed
4635c3fbb6aSGerrit Renker 		 */
464b0e56780SArnaldo Carvalho de Melo 		r_sample  = timeval_delta(&now, &packet->dccphtx_tstamp);
4655c3fbb6aSGerrit Renker 		t_elapsed = dp->dccps_options_received.dccpor_elapsed_time * 10;
4665c3fbb6aSGerrit Renker 
4670f9e5b57SGerrit Renker 		DCCP_BUG_ON(r_sample < 0);
4680f9e5b57SGerrit Renker 		if (unlikely(r_sample <= t_elapsed))
4691fba78b6SArnaldo Carvalho de Melo 			DCCP_WARN("WARNING: r_sample=%dus <= t_elapsed=%dus\n",
4701fba78b6SArnaldo Carvalho de Melo 				  (int)r_sample, (int)t_elapsed);
4711a28599aSArnaldo Carvalho de Melo 		else
4721a28599aSArnaldo Carvalho de Melo 			r_sample -= t_elapsed;
473de553c18SGerrit Renker 		CCID3_RTT_SANITY_CHECK(r_sample);
4747c657876SArnaldo Carvalho de Melo 
4757c657876SArnaldo Carvalho de Melo 		/* Update RTT estimate by
4767c657876SArnaldo Carvalho de Melo 		 * If (No feedback recv)
4777c657876SArnaldo Carvalho de Melo 		 *    R = R_sample;
4787c657876SArnaldo Carvalho de Melo 		 * Else
4797c657876SArnaldo Carvalho de Melo 		 *    R = q * R + (1 - q) * R_sample;
4807c657876SArnaldo Carvalho de Melo 		 *
4817c657876SArnaldo Carvalho de Melo 		 * q is a constant, RFC 3448 recomments 0.9
4827c657876SArnaldo Carvalho de Melo 		 */
4837c657876SArnaldo Carvalho de Melo 		if (hctx->ccid3hctx_state == TFRC_SSTATE_NO_FBACK) {
4841a21e49aSGerrit Renker 			/*
4851a21e49aSGerrit Renker 			 * Larger Initial Windows [RFC 4342, sec. 5]
4861a21e49aSGerrit Renker 			 */
4877c657876SArnaldo Carvalho de Melo 			hctx->ccid3hctx_rtt  = r_sample;
488a21f9f96SGerrit Renker 			hctx->ccid3hctx_x    = rfc3390_initial_rate(sk);
489a79ef76fSGerrit Renker 			hctx->ccid3hctx_t_ld = now;
490a79ef76fSGerrit Renker 
4911266adeeSGerrit Renker 			ccid3_update_send_interval(hctx);
4925c3fbb6aSGerrit Renker 
493a21f9f96SGerrit Renker 			ccid3_pr_debug("%s(%p), s=%u, MSS=%u, "
4941fba78b6SArnaldo Carvalho de Melo 				       "R_sample=%dus, X=%u\n", dccp_role(sk),
4950f08461eSAndrew Morton 				       sk, hctx->ccid3hctx_s,
496a21f9f96SGerrit Renker 				       dp->dccps_mss_cache, (int)r_sample,
4971a21e49aSGerrit Renker 				       (unsigned)(hctx->ccid3hctx_x >> 6));
4985c3fbb6aSGerrit Renker 
499a79ef76fSGerrit Renker 			ccid3_hc_tx_set_state(sk, TFRC_SSTATE_FBACK);
500a79ef76fSGerrit Renker 		} else {
5015c3fbb6aSGerrit Renker 			hctx->ccid3hctx_rtt = (9 * hctx->ccid3hctx_rtt +
5025c3fbb6aSGerrit Renker 						   (u32)r_sample) / 10;
5035c3fbb6aSGerrit Renker 
504ff586298SGerrit Renker 			/* Update sending rate (step 4 of [RFC 3448, 4.3]) */
505ff586298SGerrit Renker 			if (hctx->ccid3hctx_p > 0)
506ff586298SGerrit Renker 				hctx->ccid3hctx_x_calc =
507ff586298SGerrit Renker 					tfrc_calc_x(hctx->ccid3hctx_s,
508ff586298SGerrit Renker 						    hctx->ccid3hctx_rtt,
509ff586298SGerrit Renker 						    hctx->ccid3hctx_p);
510a79ef76fSGerrit Renker 			ccid3_hc_tx_update_x(sk, &now);
5117c657876SArnaldo Carvalho de Melo 
5121fba78b6SArnaldo Carvalho de Melo 			ccid3_pr_debug("%s(%p), RTT=%uus (sample=%dus), s=%u, "
5138109b02bSArnaldo Carvalho de Melo 				       "p=%u, X_calc=%u, X_recv=%u, X=%u\n",
5148109b02bSArnaldo Carvalho de Melo 				       dccp_role(sk),
5151fba78b6SArnaldo Carvalho de Melo 				       sk, hctx->ccid3hctx_rtt, (int)r_sample,
5165c3fbb6aSGerrit Renker 				       hctx->ccid3hctx_s, hctx->ccid3hctx_p,
5175c3fbb6aSGerrit Renker 				       hctx->ccid3hctx_x_calc,
5189e8efc82SGerrit Renker 				       (unsigned)(hctx->ccid3hctx_x_recv >> 6),
5191a21e49aSGerrit Renker 				       (unsigned)(hctx->ccid3hctx_x >> 6));
5207c657876SArnaldo Carvalho de Melo 		}
5217c657876SArnaldo Carvalho de Melo 
5227c657876SArnaldo Carvalho de Melo 		/* unschedule no feedback timer */
5237c657876SArnaldo Carvalho de Melo 		sk_stop_timer(sk, &hctx->ccid3hctx_no_feedback_timer);
5247c657876SArnaldo Carvalho de Melo 
5257c657876SArnaldo Carvalho de Melo 		/* remove all packets older than the one acked from history */
5268c60f3faSArnaldo Carvalho de Melo 		dccp_tx_hist_purge_older(ccid3_tx_hist,
5278c60f3faSArnaldo Carvalho de Melo 					 &hctx->ccid3hctx_hist, packet);
528c530cfb1SArnaldo Carvalho de Melo 		/*
5298109b02bSArnaldo Carvalho de Melo 		 * As we have calculated new ipi, delta, t_nom it is possible
5308109b02bSArnaldo Carvalho de Melo 		 * that we now can send a packet, so wake up dccp_wait_for_ccid
531c530cfb1SArnaldo Carvalho de Melo 		 */
532c530cfb1SArnaldo Carvalho de Melo 		sk->sk_write_space(sk);
5338c60f3faSArnaldo Carvalho de Melo 
5348a508ac2SGerrit Renker 		/*
5358a508ac2SGerrit Renker 		 * Update timeout interval for the nofeedback timer.
5368a508ac2SGerrit Renker 		 * We use a configuration option to increase the lower bound.
5378109b02bSArnaldo Carvalho de Melo 		 * This can help avoid triggering the nofeedback timer too
5388109b02bSArnaldo Carvalho de Melo 		 * often ('spinning') on LANs with small RTTs.
5398a508ac2SGerrit Renker 		 */
5405d0dbc4aSGerrit Renker 		hctx->ccid3hctx_t_rto = max_t(u32, 4 * hctx->ccid3hctx_rtt,
5418a508ac2SGerrit Renker 						   CONFIG_IP_DCCP_CCID3_RTO *
5428a508ac2SGerrit Renker 						   (USEC_PER_SEC/1000));
5431f2333aeSArnaldo Carvalho de Melo 		/*
5441f2333aeSArnaldo Carvalho de Melo 		 * Schedule no feedback timer to expire in
5458a508ac2SGerrit Renker 		 * max(t_RTO, 2 * s/X)  =  max(t_RTO, 2 * t_ipi)
5461f2333aeSArnaldo Carvalho de Melo 		 */
5478a508ac2SGerrit Renker 		t_nfb = max(hctx->ccid3hctx_t_rto, 2 * hctx->ccid3hctx_t_ipi);
5487c657876SArnaldo Carvalho de Melo 
549a9672411SGerrit Renker 		ccid3_pr_debug("%s(%p), Scheduled no feedback timer to "
5508109b02bSArnaldo Carvalho de Melo 			       "expire in %lu jiffies (%luus)\n",
5518109b02bSArnaldo Carvalho de Melo 			       dccp_role(sk),
552a9672411SGerrit Renker 			       sk, usecs_to_jiffies(t_nfb), t_nfb);
5537c657876SArnaldo Carvalho de Melo 
5547c657876SArnaldo Carvalho de Melo 		sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
5552a1fda6fSGerrit Renker 				   jiffies + usecs_to_jiffies(t_nfb));
5567c657876SArnaldo Carvalho de Melo 
5577c657876SArnaldo Carvalho de Melo 		/* set idle flag */
5587c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_idle = 1;
5597c657876SArnaldo Carvalho de Melo 		break;
560151a9931SGerrit Renker 	case TFRC_SSTATE_NO_SENT:	/* fall through */
5615e19e3fcSGerrit Renker 	case TFRC_SSTATE_TERM:		/* ignore feedback when closing */
5627c657876SArnaldo Carvalho de Melo 		break;
5637c657876SArnaldo Carvalho de Melo 	}
5647c657876SArnaldo Carvalho de Melo }
5657c657876SArnaldo Carvalho de Melo 
5667c657876SArnaldo Carvalho de Melo static int ccid3_hc_tx_parse_options(struct sock *sk, unsigned char option,
5671f2333aeSArnaldo Carvalho de Melo 				     unsigned char len, u16 idx,
5681f2333aeSArnaldo Carvalho de Melo 				     unsigned char *value)
5697c657876SArnaldo Carvalho de Melo {
5707c657876SArnaldo Carvalho de Melo 	int rc = 0;
57159725dc2SArnaldo Carvalho de Melo 	const struct dccp_sock *dp = dccp_sk(sk);
57259725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
5737c657876SArnaldo Carvalho de Melo 	struct ccid3_options_received *opt_recv;
5747c657876SArnaldo Carvalho de Melo 
57559d203f9SArnaldo Carvalho de Melo 	BUG_ON(hctx == NULL);
5767c657876SArnaldo Carvalho de Melo 
5777c657876SArnaldo Carvalho de Melo 	opt_recv = &hctx->ccid3hctx_options_received;
5787c657876SArnaldo Carvalho de Melo 
5797c657876SArnaldo Carvalho de Melo 	if (opt_recv->ccid3or_seqno != dp->dccps_gsr) {
5807c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_seqno		     = dp->dccps_gsr;
5817c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_event_rate    = ~0;
5827c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_intervals_idx = 0;
5837c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_intervals_len = 0;
5847c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_receive_rate	     = 0;
5857c657876SArnaldo Carvalho de Melo 	}
5867c657876SArnaldo Carvalho de Melo 
5877c657876SArnaldo Carvalho de Melo 	switch (option) {
5887c657876SArnaldo Carvalho de Melo 	case TFRC_OPT_LOSS_EVENT_RATE:
58959d203f9SArnaldo Carvalho de Melo 		if (unlikely(len != 4)) {
590a9672411SGerrit Renker 			DCCP_WARN("%s(%p), invalid len %d "
59159348b19SGerrit Renker 				  "for TFRC_OPT_LOSS_EVENT_RATE\n",
59259348b19SGerrit Renker 				  dccp_role(sk), sk, len);
5937c657876SArnaldo Carvalho de Melo 			rc = -EINVAL;
5947c657876SArnaldo Carvalho de Melo 		} else {
5958109b02bSArnaldo Carvalho de Melo 			opt_recv->ccid3or_loss_event_rate =
5968109b02bSArnaldo Carvalho de Melo 						ntohl(*(__be32 *)value);
597a9672411SGerrit Renker 			ccid3_pr_debug("%s(%p), LOSS_EVENT_RATE=%u\n",
5987c657876SArnaldo Carvalho de Melo 				       dccp_role(sk), sk,
5997c657876SArnaldo Carvalho de Melo 				       opt_recv->ccid3or_loss_event_rate);
6007c657876SArnaldo Carvalho de Melo 		}
6017c657876SArnaldo Carvalho de Melo 		break;
6027c657876SArnaldo Carvalho de Melo 	case TFRC_OPT_LOSS_INTERVALS:
6037c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_intervals_idx = idx;
6047c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_intervals_len = len;
605a9672411SGerrit Renker 		ccid3_pr_debug("%s(%p), LOSS_INTERVALS=(%u, %u)\n",
6067c657876SArnaldo Carvalho de Melo 			       dccp_role(sk), sk,
6077c657876SArnaldo Carvalho de Melo 			       opt_recv->ccid3or_loss_intervals_idx,
6087c657876SArnaldo Carvalho de Melo 			       opt_recv->ccid3or_loss_intervals_len);
6097c657876SArnaldo Carvalho de Melo 		break;
6107c657876SArnaldo Carvalho de Melo 	case TFRC_OPT_RECEIVE_RATE:
61159d203f9SArnaldo Carvalho de Melo 		if (unlikely(len != 4)) {
612a9672411SGerrit Renker 			DCCP_WARN("%s(%p), invalid len %d "
61359348b19SGerrit Renker 				  "for TFRC_OPT_RECEIVE_RATE\n",
61459348b19SGerrit Renker 				  dccp_role(sk), sk, len);
6157c657876SArnaldo Carvalho de Melo 			rc = -EINVAL;
6167c657876SArnaldo Carvalho de Melo 		} else {
6178109b02bSArnaldo Carvalho de Melo 			opt_recv->ccid3or_receive_rate =
6188109b02bSArnaldo Carvalho de Melo 						ntohl(*(__be32 *)value);
619a9672411SGerrit Renker 			ccid3_pr_debug("%s(%p), RECEIVE_RATE=%u\n",
6207c657876SArnaldo Carvalho de Melo 				       dccp_role(sk), sk,
6217c657876SArnaldo Carvalho de Melo 				       opt_recv->ccid3or_receive_rate);
6227c657876SArnaldo Carvalho de Melo 		}
6237c657876SArnaldo Carvalho de Melo 		break;
6247c657876SArnaldo Carvalho de Melo 	}
6257c657876SArnaldo Carvalho de Melo 
6267c657876SArnaldo Carvalho de Melo 	return rc;
6277c657876SArnaldo Carvalho de Melo }
6287c657876SArnaldo Carvalho de Melo 
62991f0ebf7SArnaldo Carvalho de Melo static int ccid3_hc_tx_init(struct ccid *ccid, struct sock *sk)
6307c657876SArnaldo Carvalho de Melo {
63191f0ebf7SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid_priv(ccid);
6327c657876SArnaldo Carvalho de Melo 
63378ad713dSGerrit Renker 	hctx->ccid3hctx_s     = 0;
634fe0499aeSGerrit Renker 	hctx->ccid3hctx_rtt   = 0;
6357c657876SArnaldo Carvalho de Melo 	hctx->ccid3hctx_state = TFRC_SSTATE_NO_SENT;
6367c657876SArnaldo Carvalho de Melo 	INIT_LIST_HEAD(&hctx->ccid3hctx_hist);
637aa5d7df3SArnaldo Carvalho de Melo 
6388109b02bSArnaldo Carvalho de Melo 	hctx->ccid3hctx_no_feedback_timer.function =
6398109b02bSArnaldo Carvalho de Melo 				ccid3_hc_tx_no_feedback_timer;
640aa5d7df3SArnaldo Carvalho de Melo 	hctx->ccid3hctx_no_feedback_timer.data     = (unsigned long)sk;
6417c657876SArnaldo Carvalho de Melo 	init_timer(&hctx->ccid3hctx_no_feedback_timer);
6427c657876SArnaldo Carvalho de Melo 
6437c657876SArnaldo Carvalho de Melo 	return 0;
6447c657876SArnaldo Carvalho de Melo }
6457c657876SArnaldo Carvalho de Melo 
6467c657876SArnaldo Carvalho de Melo static void ccid3_hc_tx_exit(struct sock *sk)
6477c657876SArnaldo Carvalho de Melo {
64859725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
6497c657876SArnaldo Carvalho de Melo 
6507c657876SArnaldo Carvalho de Melo 	BUG_ON(hctx == NULL);
6517c657876SArnaldo Carvalho de Melo 
6527c657876SArnaldo Carvalho de Melo 	ccid3_hc_tx_set_state(sk, TFRC_SSTATE_TERM);
6537c657876SArnaldo Carvalho de Melo 	sk_stop_timer(sk, &hctx->ccid3hctx_no_feedback_timer);
6547c657876SArnaldo Carvalho de Melo 
6557c657876SArnaldo Carvalho de Melo 	/* Empty packet history */
6568c60f3faSArnaldo Carvalho de Melo 	dccp_tx_hist_purge(ccid3_tx_hist, &hctx->ccid3hctx_hist);
6577c657876SArnaldo Carvalho de Melo }
6587c657876SArnaldo Carvalho de Melo 
6599bf17475SGerrit Renker static void ccid3_hc_tx_get_info(struct sock *sk, struct tcp_info *info)
6609bf17475SGerrit Renker {
6619bf17475SGerrit Renker 	const struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
6627c657876SArnaldo Carvalho de Melo 
6639bf17475SGerrit Renker 	/* Listen socks doesn't have a private CCID block */
6649bf17475SGerrit Renker 	if (sk->sk_state == DCCP_LISTEN)
6659bf17475SGerrit Renker 		return;
6669bf17475SGerrit Renker 
6679bf17475SGerrit Renker 	BUG_ON(hctx == NULL);
6689bf17475SGerrit Renker 
6699bf17475SGerrit Renker 	info->tcpi_rto = hctx->ccid3hctx_t_rto;
6709bf17475SGerrit Renker 	info->tcpi_rtt = hctx->ccid3hctx_rtt;
6719bf17475SGerrit Renker }
6729bf17475SGerrit Renker 
6739bf17475SGerrit Renker static int ccid3_hc_tx_getsockopt(struct sock *sk, const int optname, int len,
6749bf17475SGerrit Renker 				  u32 __user *optval, int __user *optlen)
6759bf17475SGerrit Renker {
6769bf17475SGerrit Renker 	const struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
6779bf17475SGerrit Renker 	const void *val;
6789bf17475SGerrit Renker 
6799bf17475SGerrit Renker 	/* Listen socks doesn't have a private CCID block */
6809bf17475SGerrit Renker 	if (sk->sk_state == DCCP_LISTEN)
6819bf17475SGerrit Renker 		return -EINVAL;
6829bf17475SGerrit Renker 
6839bf17475SGerrit Renker 	switch (optname) {
6849bf17475SGerrit Renker 	case DCCP_SOCKOPT_CCID_TX_INFO:
6859bf17475SGerrit Renker 		if (len < sizeof(hctx->ccid3hctx_tfrc))
6869bf17475SGerrit Renker 			return -EINVAL;
6879bf17475SGerrit Renker 		len = sizeof(hctx->ccid3hctx_tfrc);
6889bf17475SGerrit Renker 		val = &hctx->ccid3hctx_tfrc;
6899bf17475SGerrit Renker 		break;
6909bf17475SGerrit Renker 	default:
6919bf17475SGerrit Renker 		return -ENOPROTOOPT;
6929bf17475SGerrit Renker 	}
6939bf17475SGerrit Renker 
6949bf17475SGerrit Renker 	if (put_user(len, optlen) || copy_to_user(optval, val, len))
6959bf17475SGerrit Renker 		return -EFAULT;
6969bf17475SGerrit Renker 
6979bf17475SGerrit Renker 	return 0;
6989bf17475SGerrit Renker }
6999bf17475SGerrit Renker 
7009bf17475SGerrit Renker /*
7019bf17475SGerrit Renker  *	Receiver Half-Connection Routines
7029bf17475SGerrit Renker  */
70356724aa4SGerrit Renker #ifdef CONFIG_IP_DCCP_CCID3_DEBUG
7047c657876SArnaldo Carvalho de Melo static const char *ccid3_rx_state_name(enum ccid3_hc_rx_states state)
7057c657876SArnaldo Carvalho de Melo {
7067c657876SArnaldo Carvalho de Melo 	static char *ccid3_rx_state_names[] = {
7077c657876SArnaldo Carvalho de Melo 	[TFRC_RSTATE_NO_DATA] = "NO_DATA",
7087c657876SArnaldo Carvalho de Melo 	[TFRC_RSTATE_DATA]    = "DATA",
7097c657876SArnaldo Carvalho de Melo 	[TFRC_RSTATE_TERM]    = "TERM",
7107c657876SArnaldo Carvalho de Melo 	};
7117c657876SArnaldo Carvalho de Melo 
7127c657876SArnaldo Carvalho de Melo 	return ccid3_rx_state_names[state];
7137c657876SArnaldo Carvalho de Melo }
7147c657876SArnaldo Carvalho de Melo #endif
7157c657876SArnaldo Carvalho de Melo 
716c25a18baSArnaldo Carvalho de Melo static void ccid3_hc_rx_set_state(struct sock *sk,
7171f2333aeSArnaldo Carvalho de Melo 				  enum ccid3_hc_rx_states state)
7187c657876SArnaldo Carvalho de Melo {
71959725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
7207c657876SArnaldo Carvalho de Melo 	enum ccid3_hc_rx_states oldstate = hcrx->ccid3hcrx_state;
7217c657876SArnaldo Carvalho de Melo 
7227c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s(%p) %-8.8s -> %s\n",
7231f2333aeSArnaldo Carvalho de Melo 		       dccp_role(sk), sk, ccid3_rx_state_name(oldstate),
7241f2333aeSArnaldo Carvalho de Melo 		       ccid3_rx_state_name(state));
7257c657876SArnaldo Carvalho de Melo 	WARN_ON(state == oldstate);
7267c657876SArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_state = state;
7277c657876SArnaldo Carvalho de Melo }
7287c657876SArnaldo Carvalho de Melo 
72978ad713dSGerrit Renker static inline void ccid3_hc_rx_update_s(struct ccid3_hc_rx_sock *hcrx, int len)
73078ad713dSGerrit Renker {
73178ad713dSGerrit Renker 	if (unlikely(len == 0))	/* don't update on empty packets (e.g. ACKs) */
73278ad713dSGerrit Renker 		ccid3_pr_debug("Packet payload length is 0 - not updating\n");
73378ad713dSGerrit Renker 	else
73478ad713dSGerrit Renker 		hcrx->ccid3hcrx_s = hcrx->ccid3hcrx_s == 0 ? len :
73578ad713dSGerrit Renker 				    (9 * hcrx->ccid3hcrx_s + len) / 10;
73678ad713dSGerrit Renker }
73778ad713dSGerrit Renker 
7387c657876SArnaldo Carvalho de Melo static void ccid3_hc_rx_send_feedback(struct sock *sk)
7397c657876SArnaldo Carvalho de Melo {
74059725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
7417c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
7428c60f3faSArnaldo Carvalho de Melo 	struct dccp_rx_hist_entry *packet;
743b6ee3d4aSArnaldo Carvalho de Melo 	struct timeval now;
7440f9e5b57SGerrit Renker 	suseconds_t delta;
7457c657876SArnaldo Carvalho de Melo 
746a9672411SGerrit Renker 	ccid3_pr_debug("%s(%p) - entry \n", dccp_role(sk), sk);
7477c657876SArnaldo Carvalho de Melo 
748b0e56780SArnaldo Carvalho de Melo 	dccp_timestamp(sk, &now);
749b6ee3d4aSArnaldo Carvalho de Melo 
7507c657876SArnaldo Carvalho de Melo 	switch (hcrx->ccid3hcrx_state) {
7517c657876SArnaldo Carvalho de Melo 	case TFRC_RSTATE_NO_DATA:
7527c657876SArnaldo Carvalho de Melo 		hcrx->ccid3hcrx_x_recv = 0;
7537c657876SArnaldo Carvalho de Melo 		break;
7540f9e5b57SGerrit Renker 	case TFRC_RSTATE_DATA:
7550f9e5b57SGerrit Renker 		delta = timeval_delta(&now,
756b6ee3d4aSArnaldo Carvalho de Melo 				      &hcrx->ccid3hcrx_tstamp_last_feedback);
7570f9e5b57SGerrit Renker 		DCCP_BUG_ON(delta < 0);
758b9039a2aSGerrit Renker 		hcrx->ccid3hcrx_x_recv =
759b9039a2aSGerrit Renker 			scaled_div32(hcrx->ccid3hcrx_bytes_recv, delta);
7607c657876SArnaldo Carvalho de Melo 		break;
76159348b19SGerrit Renker 	case TFRC_RSTATE_TERM:
762a9672411SGerrit Renker 		DCCP_BUG("%s(%p) - Illegal state TERM", dccp_role(sk), sk);
7637c657876SArnaldo Carvalho de Melo 		return;
7647c657876SArnaldo Carvalho de Melo 	}
7657c657876SArnaldo Carvalho de Melo 
7668c60f3faSArnaldo Carvalho de Melo 	packet = dccp_rx_hist_find_data_packet(&hcrx->ccid3hcrx_hist);
76759d203f9SArnaldo Carvalho de Melo 	if (unlikely(packet == NULL)) {
768a9672411SGerrit Renker 		DCCP_WARN("%s(%p), no data packet in history!\n",
76959348b19SGerrit Renker 			  dccp_role(sk), sk);
7707c657876SArnaldo Carvalho de Melo 		return;
7717c657876SArnaldo Carvalho de Melo 	}
7727c657876SArnaldo Carvalho de Melo 
773b6ee3d4aSArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_tstamp_last_feedback = now;
77466a377c5SIan McDonald 	hcrx->ccid3hcrx_ccval_last_counter   = packet->dccphrx_ccval;
7757c657876SArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_bytes_recv	     = 0;
7767c657876SArnaldo Carvalho de Melo 
7770f9e5b57SGerrit Renker 	/* Elapsed time information [RFC 4340, 13.2] in units of 10 * usecs */
7780f9e5b57SGerrit Renker 	delta = timeval_delta(&now, &packet->dccphrx_tstamp);
7790f9e5b57SGerrit Renker 	DCCP_BUG_ON(delta < 0);
7800f9e5b57SGerrit Renker 	hcrx->ccid3hcrx_elapsed_time = delta / 10;
78145393a66SGerrit Renker 
7827c657876SArnaldo Carvalho de Melo 	if (hcrx->ccid3hcrx_p == 0)
78345393a66SGerrit Renker 		hcrx->ccid3hcrx_pinv = ~0U;	/* see RFC 4342, 8.5 */
78445393a66SGerrit Renker 	else if (hcrx->ccid3hcrx_p > 1000000) {
78545393a66SGerrit Renker 		DCCP_WARN("p (%u) > 100%%\n", hcrx->ccid3hcrx_p);
78645393a66SGerrit Renker 		hcrx->ccid3hcrx_pinv = 1;	/* use 100% in this case */
78745393a66SGerrit Renker 	} else
7887c657876SArnaldo Carvalho de Melo 		hcrx->ccid3hcrx_pinv = 1000000 / hcrx->ccid3hcrx_p;
78945393a66SGerrit Renker 
790507d37cfSArnaldo Carvalho de Melo 	dp->dccps_hc_rx_insert_options = 1;
7917c657876SArnaldo Carvalho de Melo 	dccp_send_ack(sk);
7927c657876SArnaldo Carvalho de Melo }
7937c657876SArnaldo Carvalho de Melo 
7942d0817d1SArnaldo Carvalho de Melo static int ccid3_hc_rx_insert_options(struct sock *sk, struct sk_buff *skb)
7957c657876SArnaldo Carvalho de Melo {
79659d203f9SArnaldo Carvalho de Melo 	const struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
79760fe62e7SAndrea Bittau 	__be32 x_recv, pinv;
7987c657876SArnaldo Carvalho de Melo 
79959d203f9SArnaldo Carvalho de Melo 	BUG_ON(hcrx == NULL);
80059d203f9SArnaldo Carvalho de Melo 
80159d203f9SArnaldo Carvalho de Melo 	if (!(sk->sk_state == DCCP_OPEN || sk->sk_state == DCCP_PARTOPEN))
8022d0817d1SArnaldo Carvalho de Melo 		return 0;
8037c657876SArnaldo Carvalho de Melo 
80466a377c5SIan McDonald 	DCCP_SKB_CB(skb)->dccpd_ccval = hcrx->ccid3hcrx_ccval_last_counter;
8054fded33bSArnaldo Carvalho de Melo 
8064fded33bSArnaldo Carvalho de Melo 	if (dccp_packet_without_ack(skb))
8072d0817d1SArnaldo Carvalho de Melo 		return 0;
8084fded33bSArnaldo Carvalho de Melo 
8094fded33bSArnaldo Carvalho de Melo 	x_recv = htonl(hcrx->ccid3hcrx_x_recv);
8104fded33bSArnaldo Carvalho de Melo 	pinv   = htonl(hcrx->ccid3hcrx_pinv);
8112d0817d1SArnaldo Carvalho de Melo 
8122d0817d1SArnaldo Carvalho de Melo 	if ((hcrx->ccid3hcrx_elapsed_time != 0 &&
8132d0817d1SArnaldo Carvalho de Melo 	     dccp_insert_option_elapsed_time(sk, skb,
8142d0817d1SArnaldo Carvalho de Melo 					     hcrx->ccid3hcrx_elapsed_time)) ||
8152d0817d1SArnaldo Carvalho de Melo 	    dccp_insert_option_timestamp(sk, skb) ||
8164fded33bSArnaldo Carvalho de Melo 	    dccp_insert_option(sk, skb, TFRC_OPT_LOSS_EVENT_RATE,
8172d0817d1SArnaldo Carvalho de Melo 			       &pinv, sizeof(pinv)) ||
8184fded33bSArnaldo Carvalho de Melo 	    dccp_insert_option(sk, skb, TFRC_OPT_RECEIVE_RATE,
8192d0817d1SArnaldo Carvalho de Melo 			       &x_recv, sizeof(x_recv)))
8202d0817d1SArnaldo Carvalho de Melo 		return -1;
8212d0817d1SArnaldo Carvalho de Melo 
8222d0817d1SArnaldo Carvalho de Melo 	return 0;
8237c657876SArnaldo Carvalho de Melo }
8247c657876SArnaldo Carvalho de Melo 
8257c657876SArnaldo Carvalho de Melo /* calculate first loss interval
8267c657876SArnaldo Carvalho de Melo  *
8277c657876SArnaldo Carvalho de Melo  * returns estimated loss interval in usecs */
8287c657876SArnaldo Carvalho de Melo 
8297c657876SArnaldo Carvalho de Melo static u32 ccid3_hc_rx_calc_first_li(struct sock *sk)
8307c657876SArnaldo Carvalho de Melo {
83159725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
8328c60f3faSArnaldo Carvalho de Melo 	struct dccp_rx_hist_entry *entry, *next, *tail = NULL;
8330f9e5b57SGerrit Renker 	u32 x_recv, p;
8340f9e5b57SGerrit Renker 	suseconds_t rtt, delta;
835b6ee3d4aSArnaldo Carvalho de Melo 	struct timeval tstamp = { 0, };
8367c657876SArnaldo Carvalho de Melo 	int interval = 0;
8377c657876SArnaldo Carvalho de Melo 	int win_count = 0;
8387c657876SArnaldo Carvalho de Melo 	int step = 0;
839bfe24a6cSGerrit Renker 	u64 fval;
8407c657876SArnaldo Carvalho de Melo 
8418c60f3faSArnaldo Carvalho de Melo 	list_for_each_entry_safe(entry, next, &hcrx->ccid3hcrx_hist,
8428c60f3faSArnaldo Carvalho de Melo 				 dccphrx_node) {
8438c60f3faSArnaldo Carvalho de Melo 		if (dccp_rx_hist_entry_data_packet(entry)) {
8447c657876SArnaldo Carvalho de Melo 			tail = entry;
8457c657876SArnaldo Carvalho de Melo 
8467c657876SArnaldo Carvalho de Melo 			switch (step) {
8477c657876SArnaldo Carvalho de Melo 			case 0:
8488c60f3faSArnaldo Carvalho de Melo 				tstamp	  = entry->dccphrx_tstamp;
849c1734376SArnaldo Carvalho de Melo 				win_count = entry->dccphrx_ccval;
8507c657876SArnaldo Carvalho de Melo 				step = 1;
8517c657876SArnaldo Carvalho de Melo 				break;
8527c657876SArnaldo Carvalho de Melo 			case 1:
853c1734376SArnaldo Carvalho de Melo 				interval = win_count - entry->dccphrx_ccval;
8547c657876SArnaldo Carvalho de Melo 				if (interval < 0)
8557c657876SArnaldo Carvalho de Melo 					interval += TFRC_WIN_COUNT_LIMIT;
8567c657876SArnaldo Carvalho de Melo 				if (interval > 4)
8577c657876SArnaldo Carvalho de Melo 					goto found;
8587c657876SArnaldo Carvalho de Melo 				break;
8597c657876SArnaldo Carvalho de Melo 			}
8607c657876SArnaldo Carvalho de Melo 		}
8617c657876SArnaldo Carvalho de Melo 	}
8627c657876SArnaldo Carvalho de Melo 
86359d203f9SArnaldo Carvalho de Melo 	if (unlikely(step == 0)) {
864a9672411SGerrit Renker 		DCCP_WARN("%s(%p), packet history has no data packets!\n",
86559348b19SGerrit Renker 			  dccp_role(sk), sk);
8667c657876SArnaldo Carvalho de Melo 		return ~0;
8677c657876SArnaldo Carvalho de Melo 	}
8687c657876SArnaldo Carvalho de Melo 
86959d203f9SArnaldo Carvalho de Melo 	if (unlikely(interval == 0)) {
870a9672411SGerrit Renker 		DCCP_WARN("%s(%p), Could not find a win_count interval > 0."
87159348b19SGerrit Renker 			  "Defaulting to 1\n", dccp_role(sk), sk);
8727c657876SArnaldo Carvalho de Melo 		interval = 1;
8737c657876SArnaldo Carvalho de Melo 	}
8747c657876SArnaldo Carvalho de Melo found:
87566a377c5SIan McDonald 	if (!tail) {
87659348b19SGerrit Renker 		DCCP_CRIT("tail is null\n");
87766a377c5SIan McDonald 		return ~0;
87866a377c5SIan McDonald 	}
8790f9e5b57SGerrit Renker 
8800f9e5b57SGerrit Renker 	delta = timeval_delta(&tstamp, &tail->dccphrx_tstamp);
8810f9e5b57SGerrit Renker 	DCCP_BUG_ON(delta < 0);
8820f9e5b57SGerrit Renker 
8830f9e5b57SGerrit Renker 	rtt = delta * 4 / interval;
8841fba78b6SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s(%p), approximated RTT to %dus\n",
8851fba78b6SArnaldo Carvalho de Melo 		       dccp_role(sk), sk, (int)rtt);
88659348b19SGerrit Renker 
887bfe24a6cSGerrit Renker 	/*
888bfe24a6cSGerrit Renker 	 * Determine the length of the first loss interval via inverse lookup.
889bfe24a6cSGerrit Renker 	 * Assume that X_recv can be computed by the throughput equation
890bfe24a6cSGerrit Renker 	 *		    s
891bfe24a6cSGerrit Renker 	 *	X_recv = --------
892bfe24a6cSGerrit Renker 	 *		 R * fval
893bfe24a6cSGerrit Renker 	 * Find some p such that f(p) = fval; return 1/p [RFC 3448, 6.3.1].
894bfe24a6cSGerrit Renker 	 */
895bfe24a6cSGerrit Renker 	if (rtt == 0) {			/* would result in divide-by-zero */
896832e3ca6SIan McDonald 		DCCP_WARN("RTT==0\n");
897832e3ca6SIan McDonald 		return ~0;
89859348b19SGerrit Renker 	}
8997c657876SArnaldo Carvalho de Melo 
900b0e56780SArnaldo Carvalho de Melo 	dccp_timestamp(sk, &tstamp);
901b0e56780SArnaldo Carvalho de Melo 	delta = timeval_delta(&tstamp, &hcrx->ccid3hcrx_tstamp_last_feedback);
9020f9e5b57SGerrit Renker 	DCCP_BUG_ON(delta <= 0);
9037c657876SArnaldo Carvalho de Melo 
9040f9e5b57SGerrit Renker 	x_recv = scaled_div32(hcrx->ccid3hcrx_bytes_recv, delta);
905bfe24a6cSGerrit Renker 	if (x_recv == 0) {		/* would also trigger divide-by-zero */
906bfe24a6cSGerrit Renker 		DCCP_WARN("X_recv==0\n");
907bfe24a6cSGerrit Renker 		if ((x_recv = hcrx->ccid3hcrx_x_recv) == 0) {
908bfe24a6cSGerrit Renker 			DCCP_BUG("stored value of X_recv is zero");
909832e3ca6SIan McDonald 			return ~0;
910bfe24a6cSGerrit Renker 		}
91166a377c5SIan McDonald 	}
91266a377c5SIan McDonald 
913bfe24a6cSGerrit Renker 	fval = scaled_div(hcrx->ccid3hcrx_s, rtt);
914bfe24a6cSGerrit Renker 	fval = scaled_div32(fval, x_recv);
91536729c1aSArnaldo Carvalho de Melo 	p = tfrc_calc_x_reverse_lookup(fval);
916bfe24a6cSGerrit Renker 
917a9672411SGerrit Renker 	ccid3_pr_debug("%s(%p), receive rate=%u bytes/s, implied "
9181f2333aeSArnaldo Carvalho de Melo 		       "loss rate=%u\n", dccp_role(sk), sk, x_recv, p);
9197c657876SArnaldo Carvalho de Melo 
9207c657876SArnaldo Carvalho de Melo 	if (p == 0)
9217c657876SArnaldo Carvalho de Melo 		return ~0;
9227c657876SArnaldo Carvalho de Melo 	else
9237c657876SArnaldo Carvalho de Melo 		return 1000000 / p;
9247c657876SArnaldo Carvalho de Melo }
9257c657876SArnaldo Carvalho de Melo 
9267c657876SArnaldo Carvalho de Melo static void ccid3_hc_rx_update_li(struct sock *sk, u64 seq_loss, u8 win_loss)
9277c657876SArnaldo Carvalho de Melo {
92859725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
929fc747e82SIan McDonald 	struct dccp_li_hist_entry *head;
93066a377c5SIan McDonald 	u64 seq_temp;
9317c657876SArnaldo Carvalho de Melo 
93266a377c5SIan McDonald 	if (list_empty(&hcrx->ccid3hcrx_li_hist)) {
93366a377c5SIan McDonald 		if (!dccp_li_hist_interval_new(ccid3_li_hist,
93466a377c5SIan McDonald 		   &hcrx->ccid3hcrx_li_hist, seq_loss, win_loss))
935ae6706f0SArnaldo Carvalho de Melo 			return;
93666a377c5SIan McDonald 
937fc747e82SIan McDonald 		head = list_entry(hcrx->ccid3hcrx_li_hist.next,
938fc747e82SIan McDonald 		   struct dccp_li_hist_entry, dccplih_node);
939fc747e82SIan McDonald 		head->dccplih_interval = ccid3_hc_rx_calc_first_li(sk);
94066a377c5SIan McDonald 	} else {
94166a377c5SIan McDonald 		struct dccp_li_hist_entry *entry;
94266a377c5SIan McDonald 		struct list_head *tail;
94366a377c5SIan McDonald 
944fc747e82SIan McDonald 		head = list_entry(hcrx->ccid3hcrx_li_hist.next,
945fc747e82SIan McDonald 		   struct dccp_li_hist_entry, dccplih_node);
94666a377c5SIan McDonald 		/* FIXME win count check removed as was wrong */
94766a377c5SIan McDonald 		/* should make this check with receive history */
94866a377c5SIan McDonald 		/* and compare there as per section 10.2 of RFC4342 */
94966a377c5SIan McDonald 
95066a377c5SIan McDonald 		/* new loss event detected */
95166a377c5SIan McDonald 		/* calculate last interval length */
95266a377c5SIan McDonald 		seq_temp = dccp_delta_seqno(head->dccplih_seqno, seq_loss);
95354e6ecb2SChristoph Lameter 		entry = dccp_li_hist_entry_new(ccid3_li_hist, GFP_ATOMIC);
95466a377c5SIan McDonald 
95566a377c5SIan McDonald 		if (entry == NULL) {
95659348b19SGerrit Renker 			DCCP_BUG("out of memory - can not allocate entry");
95766a377c5SIan McDonald 			return;
9587c657876SArnaldo Carvalho de Melo 		}
9597c657876SArnaldo Carvalho de Melo 
96066a377c5SIan McDonald 		list_add(&entry->dccplih_node, &hcrx->ccid3hcrx_li_hist);
96166a377c5SIan McDonald 
96266a377c5SIan McDonald 		tail = hcrx->ccid3hcrx_li_hist.prev;
96366a377c5SIan McDonald 		list_del(tail);
96466a377c5SIan McDonald 		kmem_cache_free(ccid3_li_hist->dccplih_slab, tail);
96566a377c5SIan McDonald 
96666a377c5SIan McDonald 		/* Create the newest interval */
96766a377c5SIan McDonald 		entry->dccplih_seqno = seq_loss;
96866a377c5SIan McDonald 		entry->dccplih_interval = seq_temp;
96966a377c5SIan McDonald 		entry->dccplih_win_count = win_loss;
97066a377c5SIan McDonald 	}
97166a377c5SIan McDonald }
97266a377c5SIan McDonald 
97366a377c5SIan McDonald static int ccid3_hc_rx_detect_loss(struct sock *sk,
97466a377c5SIan McDonald 				    struct dccp_rx_hist_entry *packet)
9757c657876SArnaldo Carvalho de Melo {
97659725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
9778109b02bSArnaldo Carvalho de Melo 	struct dccp_rx_hist_entry *rx_hist =
9788109b02bSArnaldo Carvalho de Melo 				dccp_rx_hist_head(&hcrx->ccid3hcrx_hist);
97966a377c5SIan McDonald 	u64 seqno = packet->dccphrx_seqno;
98066a377c5SIan McDonald 	u64 tmp_seqno;
98166a377c5SIan McDonald 	int loss = 0;
98266a377c5SIan McDonald 	u8 ccval;
9837c657876SArnaldo Carvalho de Melo 
98466a377c5SIan McDonald 
98566a377c5SIan McDonald 	tmp_seqno = hcrx->ccid3hcrx_seqno_nonloss;
98666a377c5SIan McDonald 
98766a377c5SIan McDonald 	if (!rx_hist ||
98866a377c5SIan McDonald 	   follows48(packet->dccphrx_seqno, hcrx->ccid3hcrx_seqno_nonloss)) {
98966a377c5SIan McDonald 		hcrx->ccid3hcrx_seqno_nonloss = seqno;
99066a377c5SIan McDonald 		hcrx->ccid3hcrx_ccval_nonloss = packet->dccphrx_ccval;
99166a377c5SIan McDonald 		goto detect_out;
99266a377c5SIan McDonald 	}
99366a377c5SIan McDonald 
99466a377c5SIan McDonald 
99566a377c5SIan McDonald 	while (dccp_delta_seqno(hcrx->ccid3hcrx_seqno_nonloss, seqno)
99666a377c5SIan McDonald 	   > TFRC_RECV_NUM_LATE_LOSS) {
99766a377c5SIan McDonald 		loss = 1;
99866a377c5SIan McDonald 		ccid3_hc_rx_update_li(sk, hcrx->ccid3hcrx_seqno_nonloss,
99966a377c5SIan McDonald 		   hcrx->ccid3hcrx_ccval_nonloss);
100066a377c5SIan McDonald 		tmp_seqno = hcrx->ccid3hcrx_seqno_nonloss;
100166a377c5SIan McDonald 		dccp_inc_seqno(&tmp_seqno);
100266a377c5SIan McDonald 		hcrx->ccid3hcrx_seqno_nonloss = tmp_seqno;
100366a377c5SIan McDonald 		dccp_inc_seqno(&tmp_seqno);
100466a377c5SIan McDonald 		while (dccp_rx_hist_find_entry(&hcrx->ccid3hcrx_hist,
100566a377c5SIan McDonald 		   tmp_seqno, &ccval)) {
100666a377c5SIan McDonald 			hcrx->ccid3hcrx_seqno_nonloss = tmp_seqno;
100766a377c5SIan McDonald 			hcrx->ccid3hcrx_ccval_nonloss = ccval;
100866a377c5SIan McDonald 			dccp_inc_seqno(&tmp_seqno);
100966a377c5SIan McDonald 		}
101066a377c5SIan McDonald 	}
101166a377c5SIan McDonald 
101266a377c5SIan McDonald 	/* FIXME - this code could be simplified with above while */
101366a377c5SIan McDonald 	/* but works at moment */
101466a377c5SIan McDonald 	if (follows48(packet->dccphrx_seqno, hcrx->ccid3hcrx_seqno_nonloss)) {
101566a377c5SIan McDonald 		hcrx->ccid3hcrx_seqno_nonloss = seqno;
101666a377c5SIan McDonald 		hcrx->ccid3hcrx_ccval_nonloss = packet->dccphrx_ccval;
101766a377c5SIan McDonald 	}
101866a377c5SIan McDonald 
101966a377c5SIan McDonald detect_out:
102066a377c5SIan McDonald 	dccp_rx_hist_add_packet(ccid3_rx_hist, &hcrx->ccid3hcrx_hist,
102166a377c5SIan McDonald 		   &hcrx->ccid3hcrx_li_hist, packet,
102266a377c5SIan McDonald 		   hcrx->ccid3hcrx_seqno_nonloss);
102366a377c5SIan McDonald 	return loss;
10247c657876SArnaldo Carvalho de Melo }
10257c657876SArnaldo Carvalho de Melo 
10267c657876SArnaldo Carvalho de Melo static void ccid3_hc_rx_packet_recv(struct sock *sk, struct sk_buff *skb)
10277c657876SArnaldo Carvalho de Melo {
102859725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
10294fded33bSArnaldo Carvalho de Melo 	const struct dccp_options_received *opt_recv;
10308c60f3faSArnaldo Carvalho de Melo 	struct dccp_rx_hist_entry *packet;
10317c657876SArnaldo Carvalho de Melo 	struct timeval now;
10320f9e5b57SGerrit Renker 	u32 p_prev, rtt_prev;
10330f9e5b57SGerrit Renker 	suseconds_t r_sample, t_elapsed;
103478ad713dSGerrit Renker 	int loss, payload_size;
10351f2333aeSArnaldo Carvalho de Melo 
103659348b19SGerrit Renker 	BUG_ON(hcrx == NULL);
10377c657876SArnaldo Carvalho de Melo 
103859725dc2SArnaldo Carvalho de Melo 	opt_recv = &dccp_sk(sk)->dccps_options_received;
10394fded33bSArnaldo Carvalho de Melo 
10407c657876SArnaldo Carvalho de Melo 	switch (DCCP_SKB_CB(skb)->dccpd_type) {
10417c657876SArnaldo Carvalho de Melo 	case DCCP_PKT_ACK:
10427c657876SArnaldo Carvalho de Melo 		if (hcrx->ccid3hcrx_state == TFRC_RSTATE_NO_DATA)
10437c657876SArnaldo Carvalho de Melo 			return;
10447c657876SArnaldo Carvalho de Melo 	case DCCP_PKT_DATAACK:
10454fded33bSArnaldo Carvalho de Melo 		if (opt_recv->dccpor_timestamp_echo == 0)
10467c657876SArnaldo Carvalho de Melo 			break;
104766a377c5SIan McDonald 		rtt_prev = hcrx->ccid3hcrx_rtt;
1048b0e56780SArnaldo Carvalho de Melo 		dccp_timestamp(sk, &now);
1049b3a3077dSArnaldo Carvalho de Melo 		timeval_sub_usecs(&now, opt_recv->dccpor_timestamp_echo * 10);
1050b3a3077dSArnaldo Carvalho de Melo 		r_sample = timeval_usecs(&now);
1051b3a3077dSArnaldo Carvalho de Melo 		t_elapsed = opt_recv->dccpor_elapsed_time * 10;
1052b3a3077dSArnaldo Carvalho de Melo 
10530f9e5b57SGerrit Renker 		DCCP_BUG_ON(r_sample < 0);
1054b3a3077dSArnaldo Carvalho de Melo 		if (unlikely(r_sample <= t_elapsed))
10550f9e5b57SGerrit Renker 			DCCP_WARN("r_sample=%ldus, t_elapsed=%ldus\n",
10560f08461eSAndrew Morton 				  (long)r_sample, (long)t_elapsed);
1057b3a3077dSArnaldo Carvalho de Melo 		else
1058b3a3077dSArnaldo Carvalho de Melo 			r_sample -= t_elapsed;
1059de553c18SGerrit Renker 		CCID3_RTT_SANITY_CHECK(r_sample);
1060b3a3077dSArnaldo Carvalho de Melo 
1061b3a3077dSArnaldo Carvalho de Melo 		if (hcrx->ccid3hcrx_state == TFRC_RSTATE_NO_DATA)
1062b3a3077dSArnaldo Carvalho de Melo 			hcrx->ccid3hcrx_rtt = r_sample;
1063b3a3077dSArnaldo Carvalho de Melo 		else
1064b3a3077dSArnaldo Carvalho de Melo 			hcrx->ccid3hcrx_rtt = (hcrx->ccid3hcrx_rtt * 9) / 10 +
1065b3a3077dSArnaldo Carvalho de Melo 					      r_sample / 10;
1066b3a3077dSArnaldo Carvalho de Melo 
106766a377c5SIan McDonald 		if (rtt_prev != hcrx->ccid3hcrx_rtt)
1068a9672411SGerrit Renker 			ccid3_pr_debug("%s(%p), New RTT=%uus, elapsed time=%u\n",
1069a9672411SGerrit Renker 				       dccp_role(sk), sk, hcrx->ccid3hcrx_rtt,
10704fded33bSArnaldo Carvalho de Melo 				       opt_recv->dccpor_elapsed_time);
10717c657876SArnaldo Carvalho de Melo 		break;
10727c657876SArnaldo Carvalho de Melo 	case DCCP_PKT_DATA:
10737c657876SArnaldo Carvalho de Melo 		break;
107459d203f9SArnaldo Carvalho de Melo 	default: /* We're not interested in other packet types, move along */
10757c657876SArnaldo Carvalho de Melo 		return;
10767c657876SArnaldo Carvalho de Melo 	}
10777c657876SArnaldo Carvalho de Melo 
1078b0e56780SArnaldo Carvalho de Melo 	packet = dccp_rx_hist_entry_new(ccid3_rx_hist, sk, opt_recv->dccpor_ndp,
107954e6ecb2SChristoph Lameter 					skb, GFP_ATOMIC);
108059d203f9SArnaldo Carvalho de Melo 	if (unlikely(packet == NULL)) {
1081a9672411SGerrit Renker 		DCCP_WARN("%s(%p), Not enough mem to add rx packet "
108259348b19SGerrit Renker 			  "to history, consider it lost!\n", dccp_role(sk), sk);
10837c657876SArnaldo Carvalho de Melo 		return;
10847c657876SArnaldo Carvalho de Melo 	}
10857c657876SArnaldo Carvalho de Melo 
108666a377c5SIan McDonald 	loss = ccid3_hc_rx_detect_loss(sk, packet);
10877c657876SArnaldo Carvalho de Melo 
10887c657876SArnaldo Carvalho de Melo 	if (DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_ACK)
10897c657876SArnaldo Carvalho de Melo 		return;
10907c657876SArnaldo Carvalho de Melo 
109178ad713dSGerrit Renker 	payload_size = skb->len - dccp_hdr(skb)->dccph_doff * 4;
109278ad713dSGerrit Renker 	ccid3_hc_rx_update_s(hcrx, payload_size);
109378ad713dSGerrit Renker 
10947c657876SArnaldo Carvalho de Melo 	switch (hcrx->ccid3hcrx_state) {
10957c657876SArnaldo Carvalho de Melo 	case TFRC_RSTATE_NO_DATA:
1096a9672411SGerrit Renker 		ccid3_pr_debug("%s(%p, state=%s), skb=%p, sending initial "
1097a9672411SGerrit Renker 			       "feedback\n", dccp_role(sk), sk,
10981f2333aeSArnaldo Carvalho de Melo 			       dccp_state_name(sk->sk_state), skb);
10997c657876SArnaldo Carvalho de Melo 		ccid3_hc_rx_send_feedback(sk);
11007c657876SArnaldo Carvalho de Melo 		ccid3_hc_rx_set_state(sk, TFRC_RSTATE_DATA);
11017c657876SArnaldo Carvalho de Melo 		return;
11027c657876SArnaldo Carvalho de Melo 	case TFRC_RSTATE_DATA:
110378ad713dSGerrit Renker 		hcrx->ccid3hcrx_bytes_recv += payload_size;
110466a377c5SIan McDonald 		if (loss)
1105b6ee3d4aSArnaldo Carvalho de Melo 			break;
1106b6ee3d4aSArnaldo Carvalho de Melo 
1107b0e56780SArnaldo Carvalho de Melo 		dccp_timestamp(sk, &now);
11088109b02bSArnaldo Carvalho de Melo 		if ((timeval_delta(&now, &hcrx->ccid3hcrx_tstamp_last_ack) -
11098109b02bSArnaldo Carvalho de Melo 		     (suseconds_t)hcrx->ccid3hcrx_rtt) >= 0) {
1110b6ee3d4aSArnaldo Carvalho de Melo 			hcrx->ccid3hcrx_tstamp_last_ack = now;
11117c657876SArnaldo Carvalho de Melo 			ccid3_hc_rx_send_feedback(sk);
11127c657876SArnaldo Carvalho de Melo 		}
11137c657876SArnaldo Carvalho de Melo 		return;
111459348b19SGerrit Renker 	case TFRC_RSTATE_TERM:
1115a9672411SGerrit Renker 		DCCP_BUG("%s(%p) - Illegal state TERM", dccp_role(sk), sk);
11167c657876SArnaldo Carvalho de Melo 		return;
11177c657876SArnaldo Carvalho de Melo 	}
11187c657876SArnaldo Carvalho de Melo 
11197c657876SArnaldo Carvalho de Melo 	/* Dealing with packet loss */
1120a9672411SGerrit Renker 	ccid3_pr_debug("%s(%p, state=%s), data loss! Reacting...\n",
11214fded33bSArnaldo Carvalho de Melo 		       dccp_role(sk), sk, dccp_state_name(sk->sk_state));
11227c657876SArnaldo Carvalho de Melo 
11237c657876SArnaldo Carvalho de Melo 	p_prev = hcrx->ccid3hcrx_p;
11247c657876SArnaldo Carvalho de Melo 
11257c657876SArnaldo Carvalho de Melo 	/* Calculate loss event rate */
1126c0996660SIan McDonald 	if (!list_empty(&hcrx->ccid3hcrx_li_hist)) {
1127c0996660SIan McDonald 		u32 i_mean = dccp_li_hist_calc_i_mean(&hcrx->ccid3hcrx_li_hist);
1128c0996660SIan McDonald 
11297c657876SArnaldo Carvalho de Melo 		/* Scaling up by 1000000 as fixed decimal */
1130c0996660SIan McDonald 		if (i_mean != 0)
1131c0996660SIan McDonald 			hcrx->ccid3hcrx_p = 1000000 / i_mean;
113259348b19SGerrit Renker 	} else
113359348b19SGerrit Renker 		DCCP_BUG("empty loss history");
11347c657876SArnaldo Carvalho de Melo 
11357c657876SArnaldo Carvalho de Melo 	if (hcrx->ccid3hcrx_p > p_prev) {
11367c657876SArnaldo Carvalho de Melo 		ccid3_hc_rx_send_feedback(sk);
11377c657876SArnaldo Carvalho de Melo 		return;
11387c657876SArnaldo Carvalho de Melo 	}
11397c657876SArnaldo Carvalho de Melo }
11407c657876SArnaldo Carvalho de Melo 
114191f0ebf7SArnaldo Carvalho de Melo static int ccid3_hc_rx_init(struct ccid *ccid, struct sock *sk)
11427c657876SArnaldo Carvalho de Melo {
114391f0ebf7SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid_priv(ccid);
11447c657876SArnaldo Carvalho de Melo 
1145a9672411SGerrit Renker 	ccid3_pr_debug("entry\n");
11467c657876SArnaldo Carvalho de Melo 
11477c657876SArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_state = TFRC_RSTATE_NO_DATA;
11487c657876SArnaldo Carvalho de Melo 	INIT_LIST_HEAD(&hcrx->ccid3hcrx_hist);
1149ae6706f0SArnaldo Carvalho de Melo 	INIT_LIST_HEAD(&hcrx->ccid3hcrx_li_hist);
1150b0e56780SArnaldo Carvalho de Melo 	dccp_timestamp(sk, &hcrx->ccid3hcrx_tstamp_last_ack);
1151954ee31fSArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_tstamp_last_feedback = hcrx->ccid3hcrx_tstamp_last_ack;
115278ad713dSGerrit Renker 	hcrx->ccid3hcrx_s   = 0;
1153fe0499aeSGerrit Renker 	hcrx->ccid3hcrx_rtt = 0;
11547c657876SArnaldo Carvalho de Melo 	return 0;
11557c657876SArnaldo Carvalho de Melo }
11567c657876SArnaldo Carvalho de Melo 
11577c657876SArnaldo Carvalho de Melo static void ccid3_hc_rx_exit(struct sock *sk)
11587c657876SArnaldo Carvalho de Melo {
115959725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
11607c657876SArnaldo Carvalho de Melo 
116159d203f9SArnaldo Carvalho de Melo 	BUG_ON(hcrx == NULL);
11627c657876SArnaldo Carvalho de Melo 
11637c657876SArnaldo Carvalho de Melo 	ccid3_hc_rx_set_state(sk, TFRC_RSTATE_TERM);
11647c657876SArnaldo Carvalho de Melo 
11657c657876SArnaldo Carvalho de Melo 	/* Empty packet history */
11668c60f3faSArnaldo Carvalho de Melo 	dccp_rx_hist_purge(ccid3_rx_hist, &hcrx->ccid3hcrx_hist);
11677c657876SArnaldo Carvalho de Melo 
11687c657876SArnaldo Carvalho de Melo 	/* Empty loss interval history */
1169ae6706f0SArnaldo Carvalho de Melo 	dccp_li_hist_purge(ccid3_li_hist, &hcrx->ccid3hcrx_li_hist);
11707c657876SArnaldo Carvalho de Melo }
11717c657876SArnaldo Carvalho de Melo 
11722babe1f6SArnaldo Carvalho de Melo static void ccid3_hc_rx_get_info(struct sock *sk, struct tcp_info *info)
11732babe1f6SArnaldo Carvalho de Melo {
117459725dc2SArnaldo Carvalho de Melo 	const struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
11752babe1f6SArnaldo Carvalho de Melo 
117659c2353dSArnaldo Carvalho de Melo 	/* Listen socks doesn't have a private CCID block */
117759c2353dSArnaldo Carvalho de Melo 	if (sk->sk_state == DCCP_LISTEN)
117859c2353dSArnaldo Carvalho de Melo 		return;
117959c2353dSArnaldo Carvalho de Melo 
118059d203f9SArnaldo Carvalho de Melo 	BUG_ON(hcrx == NULL);
11812babe1f6SArnaldo Carvalho de Melo 
11822babe1f6SArnaldo Carvalho de Melo 	info->tcpi_ca_state = hcrx->ccid3hcrx_state;
11832babe1f6SArnaldo Carvalho de Melo 	info->tcpi_options  |= TCPI_OPT_TIMESTAMPS;
11842babe1f6SArnaldo Carvalho de Melo 	info->tcpi_rcv_rtt  = hcrx->ccid3hcrx_rtt;
11852babe1f6SArnaldo Carvalho de Melo }
11862babe1f6SArnaldo Carvalho de Melo 
118788f964dbSArnaldo Carvalho de Melo static int ccid3_hc_rx_getsockopt(struct sock *sk, const int optname, int len,
118888f964dbSArnaldo Carvalho de Melo 				  u32 __user *optval, int __user *optlen)
118988f964dbSArnaldo Carvalho de Melo {
119088f964dbSArnaldo Carvalho de Melo 	const struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
119188f964dbSArnaldo Carvalho de Melo 	const void *val;
119288f964dbSArnaldo Carvalho de Melo 
119388f964dbSArnaldo Carvalho de Melo 	/* Listen socks doesn't have a private CCID block */
119488f964dbSArnaldo Carvalho de Melo 	if (sk->sk_state == DCCP_LISTEN)
119588f964dbSArnaldo Carvalho de Melo 		return -EINVAL;
119688f964dbSArnaldo Carvalho de Melo 
119788f964dbSArnaldo Carvalho de Melo 	switch (optname) {
119888f964dbSArnaldo Carvalho de Melo 	case DCCP_SOCKOPT_CCID_RX_INFO:
119988f964dbSArnaldo Carvalho de Melo 		if (len < sizeof(hcrx->ccid3hcrx_tfrc))
120088f964dbSArnaldo Carvalho de Melo 			return -EINVAL;
120188f964dbSArnaldo Carvalho de Melo 		len = sizeof(hcrx->ccid3hcrx_tfrc);
120288f964dbSArnaldo Carvalho de Melo 		val = &hcrx->ccid3hcrx_tfrc;
120388f964dbSArnaldo Carvalho de Melo 		break;
120488f964dbSArnaldo Carvalho de Melo 	default:
120588f964dbSArnaldo Carvalho de Melo 		return -ENOPROTOOPT;
120688f964dbSArnaldo Carvalho de Melo 	}
120788f964dbSArnaldo Carvalho de Melo 
120888f964dbSArnaldo Carvalho de Melo 	if (put_user(len, optlen) || copy_to_user(optval, val, len))
120988f964dbSArnaldo Carvalho de Melo 		return -EFAULT;
121088f964dbSArnaldo Carvalho de Melo 
121188f964dbSArnaldo Carvalho de Melo 	return 0;
121288f964dbSArnaldo Carvalho de Melo }
121388f964dbSArnaldo Carvalho de Melo 
121491f0ebf7SArnaldo Carvalho de Melo static struct ccid_operations ccid3 = {
12153dd9a7c3SIan McDonald 	.ccid_id		   = DCCPC_CCID3,
12167c657876SArnaldo Carvalho de Melo 	.ccid_name		   = "ccid3",
12177c657876SArnaldo Carvalho de Melo 	.ccid_owner		   = THIS_MODULE,
121891f0ebf7SArnaldo Carvalho de Melo 	.ccid_hc_tx_obj_size	   = sizeof(struct ccid3_hc_tx_sock),
12197c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_init	   = ccid3_hc_tx_init,
12207c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_exit	   = ccid3_hc_tx_exit,
12217c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_send_packet	   = ccid3_hc_tx_send_packet,
12227c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_packet_sent	   = ccid3_hc_tx_packet_sent,
12237c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_packet_recv	   = ccid3_hc_tx_packet_recv,
12247c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_parse_options  = ccid3_hc_tx_parse_options,
122591f0ebf7SArnaldo Carvalho de Melo 	.ccid_hc_rx_obj_size	   = sizeof(struct ccid3_hc_rx_sock),
12267c657876SArnaldo Carvalho de Melo 	.ccid_hc_rx_init	   = ccid3_hc_rx_init,
12277c657876SArnaldo Carvalho de Melo 	.ccid_hc_rx_exit	   = ccid3_hc_rx_exit,
12287c657876SArnaldo Carvalho de Melo 	.ccid_hc_rx_insert_options = ccid3_hc_rx_insert_options,
12297c657876SArnaldo Carvalho de Melo 	.ccid_hc_rx_packet_recv	   = ccid3_hc_rx_packet_recv,
12302babe1f6SArnaldo Carvalho de Melo 	.ccid_hc_rx_get_info	   = ccid3_hc_rx_get_info,
12312babe1f6SArnaldo Carvalho de Melo 	.ccid_hc_tx_get_info	   = ccid3_hc_tx_get_info,
123288f964dbSArnaldo Carvalho de Melo 	.ccid_hc_rx_getsockopt	   = ccid3_hc_rx_getsockopt,
123388f964dbSArnaldo Carvalho de Melo 	.ccid_hc_tx_getsockopt	   = ccid3_hc_tx_getsockopt,
12347c657876SArnaldo Carvalho de Melo };
12357c657876SArnaldo Carvalho de Melo 
123656724aa4SGerrit Renker #ifdef CONFIG_IP_DCCP_CCID3_DEBUG
12377c657876SArnaldo Carvalho de Melo module_param(ccid3_debug, int, 0444);
12387c657876SArnaldo Carvalho de Melo MODULE_PARM_DESC(ccid3_debug, "Enable debug messages");
123956724aa4SGerrit Renker #endif
12407c657876SArnaldo Carvalho de Melo 
12417c657876SArnaldo Carvalho de Melo static __init int ccid3_module_init(void)
12427c657876SArnaldo Carvalho de Melo {
12438c60f3faSArnaldo Carvalho de Melo 	int rc = -ENOBUFS;
12447c657876SArnaldo Carvalho de Melo 
12458c60f3faSArnaldo Carvalho de Melo 	ccid3_rx_hist = dccp_rx_hist_new("ccid3");
12468c60f3faSArnaldo Carvalho de Melo 	if (ccid3_rx_hist == NULL)
12477c657876SArnaldo Carvalho de Melo 		goto out;
12487c657876SArnaldo Carvalho de Melo 
12498c60f3faSArnaldo Carvalho de Melo 	ccid3_tx_hist = dccp_tx_hist_new("ccid3");
12508c60f3faSArnaldo Carvalho de Melo 	if (ccid3_tx_hist == NULL)
12518c60f3faSArnaldo Carvalho de Melo 		goto out_free_rx;
12527c657876SArnaldo Carvalho de Melo 
1253ae6706f0SArnaldo Carvalho de Melo 	ccid3_li_hist = dccp_li_hist_new("ccid3");
1254ae6706f0SArnaldo Carvalho de Melo 	if (ccid3_li_hist == NULL)
12558c60f3faSArnaldo Carvalho de Melo 		goto out_free_tx;
12567c657876SArnaldo Carvalho de Melo 
12577c657876SArnaldo Carvalho de Melo 	rc = ccid_register(&ccid3);
12587c657876SArnaldo Carvalho de Melo 	if (rc != 0)
12597c657876SArnaldo Carvalho de Melo 		goto out_free_loss_interval_history;
12607c657876SArnaldo Carvalho de Melo out:
12617c657876SArnaldo Carvalho de Melo 	return rc;
12628c60f3faSArnaldo Carvalho de Melo 
12637c657876SArnaldo Carvalho de Melo out_free_loss_interval_history:
1264ae6706f0SArnaldo Carvalho de Melo 	dccp_li_hist_delete(ccid3_li_hist);
1265ae6706f0SArnaldo Carvalho de Melo 	ccid3_li_hist = NULL;
12668c60f3faSArnaldo Carvalho de Melo out_free_tx:
12678c60f3faSArnaldo Carvalho de Melo 	dccp_tx_hist_delete(ccid3_tx_hist);
12688c60f3faSArnaldo Carvalho de Melo 	ccid3_tx_hist = NULL;
12698c60f3faSArnaldo Carvalho de Melo out_free_rx:
12708c60f3faSArnaldo Carvalho de Melo 	dccp_rx_hist_delete(ccid3_rx_hist);
12718c60f3faSArnaldo Carvalho de Melo 	ccid3_rx_hist = NULL;
12727c657876SArnaldo Carvalho de Melo 	goto out;
12737c657876SArnaldo Carvalho de Melo }
12747c657876SArnaldo Carvalho de Melo module_init(ccid3_module_init);
12757c657876SArnaldo Carvalho de Melo 
12767c657876SArnaldo Carvalho de Melo static __exit void ccid3_module_exit(void)
12777c657876SArnaldo Carvalho de Melo {
12787c657876SArnaldo Carvalho de Melo 	ccid_unregister(&ccid3);
12797c657876SArnaldo Carvalho de Melo 
12808c60f3faSArnaldo Carvalho de Melo 	if (ccid3_tx_hist != NULL) {
12818c60f3faSArnaldo Carvalho de Melo 		dccp_tx_hist_delete(ccid3_tx_hist);
12828c60f3faSArnaldo Carvalho de Melo 		ccid3_tx_hist = NULL;
12837c657876SArnaldo Carvalho de Melo 	}
12848c60f3faSArnaldo Carvalho de Melo 	if (ccid3_rx_hist != NULL) {
12858c60f3faSArnaldo Carvalho de Melo 		dccp_rx_hist_delete(ccid3_rx_hist);
12868c60f3faSArnaldo Carvalho de Melo 		ccid3_rx_hist = NULL;
12877c657876SArnaldo Carvalho de Melo 	}
1288ae6706f0SArnaldo Carvalho de Melo 	if (ccid3_li_hist != NULL) {
1289ae6706f0SArnaldo Carvalho de Melo 		dccp_li_hist_delete(ccid3_li_hist);
1290ae6706f0SArnaldo Carvalho de Melo 		ccid3_li_hist = NULL;
12917c657876SArnaldo Carvalho de Melo 	}
12927c657876SArnaldo Carvalho de Melo }
12937c657876SArnaldo Carvalho de Melo module_exit(ccid3_module_exit);
12947c657876SArnaldo Carvalho de Melo 
1295e6bccd35SIan McDonald MODULE_AUTHOR("Ian McDonald <ian.mcdonald@jandi.co.nz>, "
12961f2333aeSArnaldo Carvalho de Melo 	      "Arnaldo Carvalho de Melo <acme@ghostprotocols.net>");
12977c657876SArnaldo Carvalho de Melo MODULE_DESCRIPTION("DCCP TFRC CCID3 CCID");
12987c657876SArnaldo Carvalho de Melo MODULE_LICENSE("GPL");
12997c657876SArnaldo Carvalho de Melo MODULE_ALIAS("net-dccp-ccid-3");
1300