xref: /openbmc/linux/net/dccp/ccids/ccid3.c (revision c5a1ae9a)
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 
4456724aa4SGerrit Renker #ifdef CONFIG_IP_DCCP_CCID3_DEBUG
4556724aa4SGerrit Renker static int ccid3_debug;
4656724aa4SGerrit Renker #define ccid3_pr_debug(format, a...)	DCCP_PR_DEBUG(ccid3_debug, format, ##a)
477c657876SArnaldo Carvalho de Melo #else
487c657876SArnaldo Carvalho de Melo #define ccid3_pr_debug(format, a...)
497c657876SArnaldo Carvalho de Melo #endif
507c657876SArnaldo Carvalho de Melo 
51a1d3a355SArnaldo Carvalho de Melo static struct dccp_tx_hist *ccid3_tx_hist;
52a1d3a355SArnaldo Carvalho de Melo static struct dccp_rx_hist *ccid3_rx_hist;
53ae6706f0SArnaldo Carvalho de Melo static struct dccp_li_hist *ccid3_li_hist;
547c657876SArnaldo Carvalho de Melo 
5556724aa4SGerrit Renker #ifdef CONFIG_IP_DCCP_CCID3_DEBUG
567c657876SArnaldo Carvalho de Melo static const char *ccid3_tx_state_name(enum ccid3_hc_tx_states state)
577c657876SArnaldo Carvalho de Melo {
587c657876SArnaldo Carvalho de Melo 	static char *ccid3_state_names[] = {
597c657876SArnaldo Carvalho de Melo 	[TFRC_SSTATE_NO_SENT]  = "NO_SENT",
607c657876SArnaldo Carvalho de Melo 	[TFRC_SSTATE_NO_FBACK] = "NO_FBACK",
617c657876SArnaldo Carvalho de Melo 	[TFRC_SSTATE_FBACK]    = "FBACK",
627c657876SArnaldo Carvalho de Melo 	[TFRC_SSTATE_TERM]     = "TERM",
637c657876SArnaldo Carvalho de Melo 	};
647c657876SArnaldo Carvalho de Melo 
657c657876SArnaldo Carvalho de Melo 	return ccid3_state_names[state];
667c657876SArnaldo Carvalho de Melo }
677c657876SArnaldo Carvalho de Melo #endif
687c657876SArnaldo Carvalho de Melo 
69c25a18baSArnaldo Carvalho de Melo static void ccid3_hc_tx_set_state(struct sock *sk,
701f2333aeSArnaldo Carvalho de Melo 				  enum ccid3_hc_tx_states state)
717c657876SArnaldo Carvalho de Melo {
7259725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
737c657876SArnaldo Carvalho de Melo 	enum ccid3_hc_tx_states oldstate = hctx->ccid3hctx_state;
747c657876SArnaldo Carvalho de Melo 
757c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s(%p) %-8.8s -> %s\n",
761f2333aeSArnaldo Carvalho de Melo 		       dccp_role(sk), sk, ccid3_tx_state_name(oldstate),
771f2333aeSArnaldo Carvalho de Melo 		       ccid3_tx_state_name(state));
787c657876SArnaldo Carvalho de Melo 	WARN_ON(state == oldstate);
797c657876SArnaldo Carvalho de Melo 	hctx->ccid3hctx_state = state;
807c657876SArnaldo Carvalho de Melo }
817c657876SArnaldo Carvalho de Melo 
8217893bc1SGerrit Renker /*
8317893bc1SGerrit Renker  * Recalculate scheduled nominal send time t_nom, inter-packet interval
8417893bc1SGerrit Renker  * t_ipi, and delta value. Should be called after each change to X.
8517893bc1SGerrit Renker  */
8617893bc1SGerrit Renker static inline void ccid3_update_send_time(struct ccid3_hc_tx_sock *hctx)
877c657876SArnaldo Carvalho de Melo {
8817893bc1SGerrit Renker 	timeval_sub_usecs(&hctx->ccid3hctx_t_nom, hctx->ccid3hctx_t_ipi);
8917893bc1SGerrit Renker 
901a21e49aSGerrit Renker 	/* Calculate new t_ipi = s / X_inst (X_inst is in 64 * bytes/second) */
911a21e49aSGerrit Renker 	hctx->ccid3hctx_t_ipi = scaled_div(hctx->ccid3hctx_s,
921a21e49aSGerrit Renker 					   hctx->ccid3hctx_x >> 6);
9317893bc1SGerrit Renker 
9417893bc1SGerrit Renker 	/* Update nominal send time with regard to the new t_ipi */
9517893bc1SGerrit Renker 	timeval_add_usecs(&hctx->ccid3hctx_t_nom, hctx->ccid3hctx_t_ipi);
967c657876SArnaldo Carvalho de Melo 
977c657876SArnaldo Carvalho de Melo 	/* Calculate new delta by delta = min(t_ipi / 2, t_gran / 2) */
981f2333aeSArnaldo Carvalho de Melo 	hctx->ccid3hctx_delta = min_t(u32, hctx->ccid3hctx_t_ipi / 2,
991f2333aeSArnaldo Carvalho de Melo 					   TFRC_OPSYS_HALF_TIME_GRAN);
1007c657876SArnaldo Carvalho de Melo }
1017c657876SArnaldo Carvalho de Melo /*
1027c657876SArnaldo Carvalho de Melo  * Update X by
1037c657876SArnaldo Carvalho de Melo  *    If (p > 0)
1045c3fbb6aSGerrit Renker  *       X_calc = calcX(s, R, p);
1057c657876SArnaldo Carvalho de Melo  *       X = max(min(X_calc, 2 * X_recv), s / t_mbi);
1067c657876SArnaldo Carvalho de Melo  *    Else
1077c657876SArnaldo Carvalho de Melo  *       If (now - tld >= R)
1087c657876SArnaldo Carvalho de Melo  *          X = max(min(2 * X, 2 * X_recv), s / R);
1097c657876SArnaldo Carvalho de Melo  *          tld = now;
1105c3fbb6aSGerrit Renker  *
1111a21e49aSGerrit Renker  * Note: X and X_recv are both stored in units of 64 * bytes/second, to support
1121a21e49aSGerrit Renker  *       fine-grained resolution of sending rates. This requires scaling by 2^6
1131a21e49aSGerrit Renker  *       throughout the code. Only X_calc is unscaled (in bytes/second).
1141a21e49aSGerrit Renker  *
1155c3fbb6aSGerrit Renker  * If X has changed, we also update the scheduled send time t_now,
1165c3fbb6aSGerrit Renker  * the inter-packet interval t_ipi, and the delta value.
1177c657876SArnaldo Carvalho de Melo  */
118a79ef76fSGerrit Renker static void ccid3_hc_tx_update_x(struct sock *sk, struct timeval *now)
119a79ef76fSGerrit Renker 
1207c657876SArnaldo Carvalho de Melo {
12159725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
1221a21e49aSGerrit Renker 	const  __u64 old_x = hctx->ccid3hctx_x;
1237c657876SArnaldo Carvalho de Melo 
12444158306SGerrit Renker 	if (hctx->ccid3hctx_p > 0) {
1251a21e49aSGerrit Renker 
1261a21e49aSGerrit Renker 		hctx->ccid3hctx_x = min_t(u64, hctx->ccid3hctx_x_calc << 6,
1271a21e49aSGerrit Renker 					       hctx->ccid3hctx_x_recv * 2  );
1281a21e49aSGerrit Renker 		hctx->ccid3hctx_x = max_t(u64, hctx->ccid3hctx_x,
1291a21e49aSGerrit Renker 					  (hctx->ccid3hctx_s << 6)/TFRC_T_MBI);
130b6ee3d4aSArnaldo Carvalho de Melo 
1310f9e5b57SGerrit Renker 	} else if (timeval_delta(now, &hctx->ccid3hctx_t_ld) -
1320f9e5b57SGerrit Renker 			(suseconds_t)hctx->ccid3hctx_rtt >= 0 ) {
1331a21e49aSGerrit Renker 
1341a21e49aSGerrit Renker 		hctx->ccid3hctx_x = max(2 * min(hctx->ccid3hctx_x,
1351a21e49aSGerrit Renker 						hctx->ccid3hctx_x_recv),
1361a21e49aSGerrit Renker 					scaled_div(hctx->ccid3hctx_s << 6,
1376b5e633aSArnaldo Carvalho de Melo 						   hctx->ccid3hctx_rtt    ));
138a79ef76fSGerrit Renker 		hctx->ccid3hctx_t_ld = *now;
139ff586298SGerrit Renker 	}
140a79ef76fSGerrit Renker 
14117893bc1SGerrit Renker 	if (hctx->ccid3hctx_x != old_x)
14217893bc1SGerrit Renker 		ccid3_update_send_time(hctx);
1437c657876SArnaldo Carvalho de Melo }
1447c657876SArnaldo Carvalho de Melo 
14578ad713dSGerrit Renker /*
14678ad713dSGerrit Renker  * 	Track the mean packet size `s' (cf. RFC 4342, 5.3 and  RFC 3448, 4.1)
14778ad713dSGerrit Renker  * 	@len: DCCP packet payload size in bytes
14878ad713dSGerrit Renker  */
14978ad713dSGerrit Renker static inline void ccid3_hc_tx_update_s(struct ccid3_hc_tx_sock *hctx, int len)
15078ad713dSGerrit Renker {
15178ad713dSGerrit Renker 	if (unlikely(len == 0))
15278ad713dSGerrit Renker 		ccid3_pr_debug("Packet payload length is 0 - not updating\n");
15378ad713dSGerrit Renker 	else
15478ad713dSGerrit Renker 		hctx->ccid3hctx_s = hctx->ccid3hctx_s == 0 ? len :
15578ad713dSGerrit Renker 				    (9 * hctx->ccid3hctx_s + len) / 10;
15678ad713dSGerrit Renker 	/*
15778ad713dSGerrit Renker 	 * Note: We could do a potential optimisation here - when `s' changes,
15878ad713dSGerrit Renker 	 *	 recalculate sending rate and consequently t_ipi, t_delta, and
15978ad713dSGerrit Renker 	 *	 t_now. This is however non-standard, and the benefits are not
16078ad713dSGerrit Renker 	 *	 clear, so it is currently left out.
16178ad713dSGerrit Renker 	 */
16278ad713dSGerrit Renker }
16378ad713dSGerrit Renker 
1649f8681dbSGerrit Renker /*
1659f8681dbSGerrit Renker  * 	Update Window Counter using the algorithm from [RFC 4342, 8.1].
1669f8681dbSGerrit Renker  * 	The algorithm is not applicable if RTT < 4 microseconds.
1679f8681dbSGerrit Renker  */
1689f8681dbSGerrit Renker static inline void ccid3_hc_tx_update_win_count(struct ccid3_hc_tx_sock *hctx,
1699f8681dbSGerrit Renker 						struct timeval *now)
1709f8681dbSGerrit Renker {
1719f8681dbSGerrit Renker 	suseconds_t delta;
1729f8681dbSGerrit Renker 	u32 quarter_rtts;
1739f8681dbSGerrit Renker 
1749f8681dbSGerrit Renker 	if (unlikely(hctx->ccid3hctx_rtt < 4))	/* avoid divide-by-zero */
1759f8681dbSGerrit Renker 		return;
1769f8681dbSGerrit Renker 
1779f8681dbSGerrit Renker 	delta = timeval_delta(now, &hctx->ccid3hctx_t_last_win_count);
1789f8681dbSGerrit Renker 	DCCP_BUG_ON(delta < 0);
1799f8681dbSGerrit Renker 
1809f8681dbSGerrit Renker 	quarter_rtts = (u32)delta / (hctx->ccid3hctx_rtt / 4);
1819f8681dbSGerrit Renker 
1829f8681dbSGerrit Renker 	if (quarter_rtts > 0) {
1839f8681dbSGerrit Renker 		hctx->ccid3hctx_t_last_win_count = *now;
1849f8681dbSGerrit Renker 		hctx->ccid3hctx_last_win_count	+= min_t(u32, quarter_rtts, 5);
1859f8681dbSGerrit Renker 		hctx->ccid3hctx_last_win_count	&= 0xF;		/* mod 16 */
1869f8681dbSGerrit Renker 
1879f8681dbSGerrit Renker 		ccid3_pr_debug("now at %#X\n", hctx->ccid3hctx_last_win_count);
1889f8681dbSGerrit Renker 	}
1899f8681dbSGerrit Renker }
1909f8681dbSGerrit Renker 
1917c657876SArnaldo Carvalho de Melo static void ccid3_hc_tx_no_feedback_timer(unsigned long data)
1927c657876SArnaldo Carvalho de Melo {
1937c657876SArnaldo Carvalho de Melo 	struct sock *sk = (struct sock *)data;
19459725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
1952a1fda6fSGerrit Renker 	unsigned long t_nfb = USEC_PER_SEC / 5;
1967c657876SArnaldo Carvalho de Melo 
1977c657876SArnaldo Carvalho de Melo 	bh_lock_sock(sk);
1987c657876SArnaldo Carvalho de Melo 	if (sock_owned_by_user(sk)) {
1997c657876SArnaldo Carvalho de Melo 		/* Try again later. */
2007c657876SArnaldo Carvalho de Melo 		/* XXX: set some sensible MIB */
20148e03eeeSGerrit Renker 		goto restart_timer;
2027c657876SArnaldo Carvalho de Melo 	}
2037c657876SArnaldo Carvalho de Melo 
2047c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p, state=%s\n", dccp_role(sk), sk,
2057c657876SArnaldo Carvalho de Melo 		       ccid3_tx_state_name(hctx->ccid3hctx_state));
2067c657876SArnaldo Carvalho de Melo 
2077c657876SArnaldo Carvalho de Melo 	switch (hctx->ccid3hctx_state) {
2087c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_FBACK:
209a79ef76fSGerrit Renker 		/* RFC 3448, 4.4: Halve send rate directly */
210179ebc9fSGerrit Renker 		hctx->ccid3hctx_x = max_t(u32, hctx->ccid3hctx_x / 2,
2111a21e49aSGerrit Renker 					  (hctx->ccid3hctx_s << 6)/TFRC_T_MBI);
2127c657876SArnaldo Carvalho de Melo 
2131a21e49aSGerrit Renker 		ccid3_pr_debug("%s, sk=%p, state=%s, updated tx rate to %u "
2141f2333aeSArnaldo Carvalho de Melo 			       "bytes/s\n",
2151f2333aeSArnaldo Carvalho de Melo 			       dccp_role(sk), sk,
2161f2333aeSArnaldo Carvalho de Melo 			       ccid3_tx_state_name(hctx->ccid3hctx_state),
2171a21e49aSGerrit Renker 			       (unsigned)(hctx->ccid3hctx_x >> 6));
21848e03eeeSGerrit Renker 		/* The value of R is still undefined and so we can not recompute
21948e03eeeSGerrit Renker 		 * the timout value. Keep initial value as per [RFC 4342, 5]. */
2202a1fda6fSGerrit Renker 		t_nfb = TFRC_INITIAL_TIMEOUT;
22117893bc1SGerrit Renker 		ccid3_update_send_time(hctx);
2227c657876SArnaldo Carvalho de Melo 		break;
2237c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_FBACK:
2241f2333aeSArnaldo Carvalho de Melo 		/*
2251f2333aeSArnaldo Carvalho de Melo 		 * Check if IDLE since last timeout and recv rate is less than
2261a21e49aSGerrit Renker 		 * 4 packets (in units of 64*bytes/sec) per RTT
2271f2333aeSArnaldo Carvalho de Melo 		 */
2281f2333aeSArnaldo Carvalho de Melo 		if (!hctx->ccid3hctx_idle ||
2291a21e49aSGerrit Renker 		    (hctx->ccid3hctx_x_recv >= 4 *
2301a21e49aSGerrit Renker 		     scaled_div(hctx->ccid3hctx_s << 6, hctx->ccid3hctx_rtt))) {
231a79ef76fSGerrit Renker 			struct timeval now;
232a79ef76fSGerrit Renker 
2331f2333aeSArnaldo Carvalho de Melo 			ccid3_pr_debug("%s, sk=%p, state=%s, not idle\n",
2341f2333aeSArnaldo Carvalho de Melo 				       dccp_role(sk), sk,
2357c657876SArnaldo Carvalho de Melo 				       ccid3_tx_state_name(hctx->ccid3hctx_state));
2367c657876SArnaldo Carvalho de Melo 
237ff586298SGerrit Renker 			/*
238ff586298SGerrit Renker 			 *  Modify the cached value of X_recv [RFC 3448, 4.4]
239ff586298SGerrit Renker 			 *
240ff586298SGerrit Renker 			 *  If (p == 0 || X_calc > 2 * X_recv)
2417c657876SArnaldo Carvalho de Melo 			 *    X_recv = max(X_recv / 2, s / (2 * t_mbi));
2427c657876SArnaldo Carvalho de Melo 			 *  Else
2437c657876SArnaldo Carvalho de Melo 			 *    X_recv = X_calc / 4;
2441a21e49aSGerrit Renker 			 *
2451a21e49aSGerrit Renker 			 *  Note that X_recv is scaled by 2^6 while X_calc is not
2467c657876SArnaldo Carvalho de Melo 			 */
24744158306SGerrit Renker 			BUG_ON(hctx->ccid3hctx_p && !hctx->ccid3hctx_x_calc);
2487c657876SArnaldo Carvalho de Melo 
24944158306SGerrit Renker 			if (hctx->ccid3hctx_p  == 0 ||
2501a21e49aSGerrit Renker 			    hctx->ccid3hctx_x_calc > (hctx->ccid3hctx_x_recv >> 5))  {
2511a21e49aSGerrit Renker 
2521a21e49aSGerrit Renker 				hctx->ccid3hctx_x_recv =
2531a21e49aSGerrit Renker 					max_t(u64, hctx->ccid3hctx_x_recv / 2,
2541a21e49aSGerrit Renker 					      	  (hctx->ccid3hctx_s << 6) /
2551a21e49aSGerrit Renker 					      			(2*TFRC_T_MBI));
2561a21e49aSGerrit Renker 
257ff586298SGerrit Renker 				if (hctx->ccid3hctx_p == 0)
258ff586298SGerrit Renker 					dccp_timestamp(sk, &now);
259ff586298SGerrit Renker 			} else
2601a21e49aSGerrit Renker 				hctx->ccid3hctx_x_recv = hctx->ccid3hctx_x_calc << 4;
2617c657876SArnaldo Carvalho de Melo 
262ff586298SGerrit Renker 			/* Now recalculate X [RFC 3448, 4.3, step (4)] */
263a79ef76fSGerrit Renker 			ccid3_hc_tx_update_x(sk, &now);
2647c657876SArnaldo Carvalho de Melo 		}
2656b5e633aSArnaldo Carvalho de Melo 		/*
2666b5e633aSArnaldo Carvalho de Melo 		 * Schedule no feedback timer to expire in
2678a508ac2SGerrit Renker 		 * max(t_RTO, 2 * s/X)  =  max(t_RTO, 2 * t_ipi)
2688a508ac2SGerrit Renker 		 * See comments in packet_recv() regarding the value of t_RTO.
2696b5e633aSArnaldo Carvalho de Melo 		 */
2708a508ac2SGerrit Renker 		t_nfb = max(hctx->ccid3hctx_t_rto, 2 * hctx->ccid3hctx_t_ipi);
2717c657876SArnaldo Carvalho de Melo 		break;
27259348b19SGerrit Renker 	case TFRC_SSTATE_NO_SENT:
27359348b19SGerrit Renker 		DCCP_BUG("Illegal %s state NO_SENT, sk=%p", dccp_role(sk), sk);
27459348b19SGerrit Renker 		/* fall through */
27559348b19SGerrit Renker 	case TFRC_SSTATE_TERM:
2767c657876SArnaldo Carvalho de Melo 		goto out;
2777c657876SArnaldo Carvalho de Melo 	}
2787c657876SArnaldo Carvalho de Melo 
2797c657876SArnaldo Carvalho de Melo 	hctx->ccid3hctx_idle = 1;
28048e03eeeSGerrit Renker 
28148e03eeeSGerrit Renker restart_timer:
28248e03eeeSGerrit Renker 	sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
2832a1fda6fSGerrit Renker 		           jiffies + usecs_to_jiffies(t_nfb));
2847c657876SArnaldo Carvalho de Melo out:
2857c657876SArnaldo Carvalho de Melo 	bh_unlock_sock(sk);
2867c657876SArnaldo Carvalho de Melo 	sock_put(sk);
2877c657876SArnaldo Carvalho de Melo }
2887c657876SArnaldo Carvalho de Melo 
2897da7f456SGerrit Renker /*
2907da7f456SGerrit Renker  * returns
2917da7f456SGerrit Renker  *   > 0: delay (in msecs) that should pass before actually sending
2927da7f456SGerrit Renker  *   = 0: can send immediately
2937da7f456SGerrit Renker  *   < 0: error condition; do not send packet
2947da7f456SGerrit Renker  */
2956b57c93dSGerrit Renker static int ccid3_hc_tx_send_packet(struct sock *sk, struct sk_buff *skb)
2967c657876SArnaldo Carvalho de Melo {
2977c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
29859725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
2997c657876SArnaldo Carvalho de Melo 	struct timeval now;
3000f9e5b57SGerrit Renker 	suseconds_t delay;
3017c657876SArnaldo Carvalho de Melo 
30259348b19SGerrit Renker 	BUG_ON(hctx == NULL);
3031f2333aeSArnaldo Carvalho de Melo 
3047c657876SArnaldo Carvalho de Melo 	/*
305da335bafSGerrit Renker 	 * This function is called only for Data and DataAck packets. Sending
306da335bafSGerrit Renker 	 * zero-sized Data(Ack)s is theoretically possible, but for congestion
307da335bafSGerrit Renker 	 * control this case is pathological - ignore it.
3087c657876SArnaldo Carvalho de Melo 	 */
3096b57c93dSGerrit Renker 	if (unlikely(skb->len == 0))
310da335bafSGerrit Renker 		return -EBADMSG;
3117c657876SArnaldo Carvalho de Melo 
312b0e56780SArnaldo Carvalho de Melo 	dccp_timestamp(sk, &now);
3137c657876SArnaldo Carvalho de Melo 
3147c657876SArnaldo Carvalho de Melo 	switch (hctx->ccid3hctx_state) {
3157c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_SENT:
3161f2333aeSArnaldo Carvalho de Melo 		sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
3171f2333aeSArnaldo Carvalho de Melo 			       jiffies + usecs_to_jiffies(TFRC_INITIAL_TIMEOUT));
3187c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_last_win_count	 = 0;
3197c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_t_last_win_count = now;
3207c657876SArnaldo Carvalho de Melo 		ccid3_hc_tx_set_state(sk, TFRC_SSTATE_NO_FBACK);
3217c657876SArnaldo Carvalho de Melo 
3221a21e49aSGerrit Renker 		/* Set initial sending rate X/s to 1pps (X is scaled by 2^6) */
3236b57c93dSGerrit Renker 		ccid3_hc_tx_update_s(hctx, skb->len);
3241a21e49aSGerrit Renker 		hctx->ccid3hctx_x = hctx->ccid3hctx_s << 6;
32578ad713dSGerrit Renker 
32690feeb95SGerrit Renker 		/* First timeout, according to [RFC 3448, 4.2], is 1 second */
32790feeb95SGerrit Renker 		hctx->ccid3hctx_t_ipi = USEC_PER_SEC;
32890feeb95SGerrit Renker 		/* Initial delta: minimum of 0.5 sec and t_gran/2 */
32990feeb95SGerrit Renker 		hctx->ccid3hctx_delta = TFRC_OPSYS_HALF_TIME_GRAN;
33090feeb95SGerrit Renker 
33190feeb95SGerrit Renker 		/* Set t_0 for initial packet */
3327c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_t_nom = now;
3337c657876SArnaldo Carvalho de Melo 		break;
3347c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_FBACK:
3357c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_FBACK:
33691cf5a17SGerrit Renker 		delay = timeval_delta(&hctx->ccid3hctx_t_nom, &now);
33791cf5a17SGerrit Renker 		/*
33891cf5a17SGerrit Renker 		 * 	Scheduling of packet transmissions [RFC 3448, 4.6]
33991cf5a17SGerrit Renker 		 *
34091cf5a17SGerrit Renker 		 * if (t_now > t_nom - delta)
34191cf5a17SGerrit Renker 		 *       // send the packet now
34291cf5a17SGerrit Renker 		 * else
34391cf5a17SGerrit Renker 		 *       // send the packet in (t_nom - t_now) milliseconds.
34491cf5a17SGerrit Renker 		 */
3450f9e5b57SGerrit Renker 		if (delay - (suseconds_t)hctx->ccid3hctx_delta >= 0)
3467da7f456SGerrit Renker 			return delay / 1000L;
3479f8681dbSGerrit Renker 
3489f8681dbSGerrit Renker 		ccid3_hc_tx_update_win_count(hctx, &now);
3497c657876SArnaldo Carvalho de Melo 		break;
35059348b19SGerrit Renker 	case TFRC_SSTATE_TERM:
35159348b19SGerrit Renker 		DCCP_BUG("Illegal %s state TERM, sk=%p", dccp_role(sk), sk);
3527da7f456SGerrit Renker 		return -EINVAL;
3537c657876SArnaldo Carvalho de Melo 	}
3547c657876SArnaldo Carvalho de Melo 
3557da7f456SGerrit Renker 	/* prepare to send now (add options etc.) */
356507d37cfSArnaldo Carvalho de Melo 	dp->dccps_hc_tx_insert_options = 1;
357e312d100SGerrit Renker 	DCCP_SKB_CB(skb)->dccpd_ccval = hctx->ccid3hctx_last_win_count;
358e312d100SGerrit Renker 
359e312d100SGerrit Renker 	/* set the nominal send time for the next following packet */
3607da7f456SGerrit Renker 	timeval_add_usecs(&hctx->ccid3hctx_t_nom, hctx->ccid3hctx_t_ipi);
3617da7f456SGerrit Renker 
3627da7f456SGerrit Renker 	return 0;
3637c657876SArnaldo Carvalho de Melo }
3647c657876SArnaldo Carvalho de Melo 
3656b57c93dSGerrit Renker static void ccid3_hc_tx_packet_sent(struct sock *sk, int more, unsigned int len)
3667c657876SArnaldo Carvalho de Melo {
36759725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
3687c657876SArnaldo Carvalho de Melo 	struct timeval now;
3696b57c93dSGerrit Renker 	struct dccp_tx_hist_entry *packet;
3707c657876SArnaldo Carvalho de Melo 
37159348b19SGerrit Renker 	BUG_ON(hctx == NULL);
3727c657876SArnaldo Carvalho de Melo 
37378ad713dSGerrit Renker 	ccid3_hc_tx_update_s(hctx, len);
37478ad713dSGerrit Renker 
375c5a1ae9aSGerrit Renker 	packet = dccp_tx_hist_entry_new(ccid3_tx_hist, GFP_ATOMIC);
37659d203f9SArnaldo Carvalho de Melo 	if (unlikely(packet == NULL)) {
377c5a1ae9aSGerrit Renker 		DCCP_CRIT("packet history - out of memory!");
3787c657876SArnaldo Carvalho de Melo 		return;
3797c657876SArnaldo Carvalho de Melo 	}
380c5a1ae9aSGerrit Renker 	dccp_tx_hist_add_entry(&hctx->ccid3hctx_hist, packet);
381c5a1ae9aSGerrit Renker 
382c5a1ae9aSGerrit Renker 	dccp_timestamp(sk, &now);
3838c60f3faSArnaldo Carvalho de Melo 	packet->dccphtx_tstamp = now;
384c5a1ae9aSGerrit Renker 	packet->dccphtx_seqno  = dccp_sk(sk)->dccps_gss;
385c1734376SArnaldo Carvalho de Melo 	packet->dccphtx_rtt    = hctx->ccid3hctx_rtt;
3868c60f3faSArnaldo Carvalho de Melo 	packet->dccphtx_sent   = 1;
387c5a1ae9aSGerrit Renker 	hctx->ccid3hctx_idle   = 0;
3887c657876SArnaldo Carvalho de Melo }
3897c657876SArnaldo Carvalho de Melo 
3907c657876SArnaldo Carvalho de Melo static void ccid3_hc_tx_packet_recv(struct sock *sk, struct sk_buff *skb)
3917c657876SArnaldo Carvalho de Melo {
39259725dc2SArnaldo Carvalho de Melo 	const struct dccp_sock *dp = dccp_sk(sk);
39359725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
3947c657876SArnaldo Carvalho de Melo 	struct ccid3_options_received *opt_recv;
3958c60f3faSArnaldo Carvalho de Melo 	struct dccp_tx_hist_entry *packet;
396b0e56780SArnaldo Carvalho de Melo 	struct timeval now;
3972a1fda6fSGerrit Renker 	unsigned long t_nfb;
3987c657876SArnaldo Carvalho de Melo 	u32 pinv;
3995c3fbb6aSGerrit Renker 	long r_sample, t_elapsed;
4001f2333aeSArnaldo Carvalho de Melo 
40159348b19SGerrit Renker 	BUG_ON(hctx == NULL);
4027c657876SArnaldo Carvalho de Melo 
4037c657876SArnaldo Carvalho de Melo 	/* we are only interested in ACKs */
4047c657876SArnaldo Carvalho de Melo 	if (!(DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_ACK ||
4057c657876SArnaldo Carvalho de Melo 	      DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_DATAACK))
4067c657876SArnaldo Carvalho de Melo 		return;
4077c657876SArnaldo Carvalho de Melo 
4087c657876SArnaldo Carvalho de Melo 	opt_recv = &hctx->ccid3hctx_options_received;
4097c657876SArnaldo Carvalho de Melo 
4107c657876SArnaldo Carvalho de Melo 	switch (hctx->ccid3hctx_state) {
4117c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_FBACK:
4127c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_FBACK:
4135c3fbb6aSGerrit Renker 		/* get packet from history to look up t_recvdata */
4148c60f3faSArnaldo Carvalho de Melo 		packet = dccp_tx_hist_find_entry(&hctx->ccid3hctx_hist,
4158c60f3faSArnaldo Carvalho de Melo 						 DCCP_SKB_CB(skb)->dccpd_ack_seq);
41659d203f9SArnaldo Carvalho de Melo 		if (unlikely(packet == NULL)) {
4175c3fbb6aSGerrit Renker 			DCCP_WARN("%s(%p), seqno %llu(%s) doesn't exist "
41859348b19SGerrit Renker 				  "in history!\n",  dccp_role(sk), sk,
41959d203f9SArnaldo Carvalho de Melo 			    (unsigned long long)DCCP_SKB_CB(skb)->dccpd_ack_seq,
4207c657876SArnaldo Carvalho de Melo 				  dccp_packet_name(DCCP_SKB_CB(skb)->dccpd_type));
4217c657876SArnaldo Carvalho de Melo 			return;
4227c657876SArnaldo Carvalho de Melo 		}
4237c657876SArnaldo Carvalho de Melo 
4241a21e49aSGerrit Renker 		/* Update receive rate in units of 64 * bytes/second */
4251a21e49aSGerrit Renker 		hctx->ccid3hctx_x_recv = opt_recv->ccid3or_receive_rate << 6;
4265c3fbb6aSGerrit Renker 
4275c3fbb6aSGerrit Renker 		/* Update loss event rate */
4285c3fbb6aSGerrit Renker 		pinv = opt_recv->ccid3or_loss_event_rate;
42945393a66SGerrit Renker 		if (pinv == ~0U || pinv == 0)	       /* see RFC 4342, 8.5   */
4305c3fbb6aSGerrit Renker 			hctx->ccid3hctx_p = 0;
43145393a66SGerrit Renker 		else				       /* can not exceed 100% */
4325c3fbb6aSGerrit Renker  			hctx->ccid3hctx_p = 1000000 / pinv;
4335c3fbb6aSGerrit Renker 
434b0e56780SArnaldo Carvalho de Melo 		dccp_timestamp(sk, &now);
4355c3fbb6aSGerrit Renker 
4365c3fbb6aSGerrit Renker 		/*
4375c3fbb6aSGerrit Renker 		 * Calculate new round trip sample as per [RFC 3448, 4.3] by
4385c3fbb6aSGerrit Renker 		 * 	R_sample  =  (now - t_recvdata) - t_elapsed
4395c3fbb6aSGerrit Renker 		 */
440b0e56780SArnaldo Carvalho de Melo 		r_sample  = timeval_delta(&now, &packet->dccphtx_tstamp);
4415c3fbb6aSGerrit Renker 		t_elapsed = dp->dccps_options_received.dccpor_elapsed_time * 10;
4425c3fbb6aSGerrit Renker 
4430f9e5b57SGerrit Renker 		DCCP_BUG_ON(r_sample < 0);
4440f9e5b57SGerrit Renker 		if (unlikely(r_sample <= t_elapsed))
4455c3fbb6aSGerrit Renker 			DCCP_WARN("WARNING: r_sample=%ldus <= t_elapsed=%ldus\n",
44659348b19SGerrit Renker 				  r_sample, t_elapsed);
4471a28599aSArnaldo Carvalho de Melo 		else
4481a28599aSArnaldo Carvalho de Melo 			r_sample -= t_elapsed;
449de553c18SGerrit Renker 		CCID3_RTT_SANITY_CHECK(r_sample);
4507c657876SArnaldo Carvalho de Melo 
4517c657876SArnaldo Carvalho de Melo 		/* Update RTT estimate by
4527c657876SArnaldo Carvalho de Melo 		 * If (No feedback recv)
4537c657876SArnaldo Carvalho de Melo 		 *    R = R_sample;
4547c657876SArnaldo Carvalho de Melo 		 * Else
4557c657876SArnaldo Carvalho de Melo 		 *    R = q * R + (1 - q) * R_sample;
4567c657876SArnaldo Carvalho de Melo 		 *
4577c657876SArnaldo Carvalho de Melo 		 * q is a constant, RFC 3448 recomments 0.9
4587c657876SArnaldo Carvalho de Melo 		 */
4597c657876SArnaldo Carvalho de Melo 		if (hctx->ccid3hctx_state == TFRC_SSTATE_NO_FBACK) {
4601a21e49aSGerrit Renker 			/*
4611a21e49aSGerrit Renker 			 * Larger Initial Windows [RFC 4342, sec. 5]
4621a21e49aSGerrit Renker 			 * We deviate in that we use `s' instead of `MSS'.
4631a21e49aSGerrit Renker 			 */
464179ebc9fSGerrit Renker 			u16 w_init = min(    4 * hctx->ccid3hctx_s,
465a79ef76fSGerrit Renker 					 max(2 * hctx->ccid3hctx_s, 4380));
4667c657876SArnaldo Carvalho de Melo 			hctx->ccid3hctx_rtt  = r_sample;
4671a21e49aSGerrit Renker 			hctx->ccid3hctx_x    = scaled_div(w_init<< 6, r_sample);
468a79ef76fSGerrit Renker 			hctx->ccid3hctx_t_ld = now;
469a79ef76fSGerrit Renker 
470a79ef76fSGerrit Renker 			ccid3_update_send_time(hctx);
4715c3fbb6aSGerrit Renker 
4725c3fbb6aSGerrit Renker 			ccid3_pr_debug("%s(%p), s=%u, w_init=%u, "
4735c3fbb6aSGerrit Renker 				       "R_sample=%ldus, X=%u\n", dccp_role(sk),
4745c3fbb6aSGerrit Renker 				       sk, hctx->ccid3hctx_s, w_init, r_sample,
4751a21e49aSGerrit Renker 				       (unsigned)(hctx->ccid3hctx_x >> 6));
4765c3fbb6aSGerrit Renker 
477a79ef76fSGerrit Renker 			ccid3_hc_tx_set_state(sk, TFRC_SSTATE_FBACK);
478a79ef76fSGerrit Renker 		} else {
4795c3fbb6aSGerrit Renker 			hctx->ccid3hctx_rtt = (9 * hctx->ccid3hctx_rtt +
4805c3fbb6aSGerrit Renker 					           (u32)r_sample        ) / 10;
4815c3fbb6aSGerrit Renker 
482ff586298SGerrit Renker 			/* Update sending rate (step 4 of [RFC 3448, 4.3]) */
483ff586298SGerrit Renker 			if (hctx->ccid3hctx_p > 0)
484ff586298SGerrit Renker 				hctx->ccid3hctx_x_calc =
485ff586298SGerrit Renker 					tfrc_calc_x(hctx->ccid3hctx_s,
486ff586298SGerrit Renker 						    hctx->ccid3hctx_rtt,
487ff586298SGerrit Renker 						    hctx->ccid3hctx_p);
488a79ef76fSGerrit Renker 			ccid3_hc_tx_update_x(sk, &now);
4897c657876SArnaldo Carvalho de Melo 
4905c3fbb6aSGerrit Renker 			ccid3_pr_debug("%s(%p), RTT=%uus (sample=%ldus), s=%u, "
4915c3fbb6aSGerrit Renker 				       "p=%u, X_calc=%u, X=%u\n", dccp_role(sk),
4925c3fbb6aSGerrit Renker 				       sk, hctx->ccid3hctx_rtt, r_sample,
4935c3fbb6aSGerrit Renker 				       hctx->ccid3hctx_s, hctx->ccid3hctx_p,
4945c3fbb6aSGerrit Renker 				       hctx->ccid3hctx_x_calc,
4951a21e49aSGerrit Renker 				       (unsigned)(hctx->ccid3hctx_x >> 6));
4967c657876SArnaldo Carvalho de Melo 		}
4977c657876SArnaldo Carvalho de Melo 
4987c657876SArnaldo Carvalho de Melo 		/* unschedule no feedback timer */
4997c657876SArnaldo Carvalho de Melo 		sk_stop_timer(sk, &hctx->ccid3hctx_no_feedback_timer);
5007c657876SArnaldo Carvalho de Melo 
5017c657876SArnaldo Carvalho de Melo 		/* remove all packets older than the one acked from history */
5028c60f3faSArnaldo Carvalho de Melo 		dccp_tx_hist_purge_older(ccid3_tx_hist,
5038c60f3faSArnaldo Carvalho de Melo 					 &hctx->ccid3hctx_hist, packet);
504c530cfb1SArnaldo Carvalho de Melo 		/*
505c530cfb1SArnaldo Carvalho de Melo 		 * As we have calculated new ipi, delta, t_nom it is possible that
5065d0dbc4aSGerrit Renker 		 * we now can send a packet, so wake up dccp_wait_for_ccid
507c530cfb1SArnaldo Carvalho de Melo 		 */
508c530cfb1SArnaldo Carvalho de Melo 		sk->sk_write_space(sk);
5098c60f3faSArnaldo Carvalho de Melo 
5108a508ac2SGerrit Renker 		/*
5118a508ac2SGerrit Renker 		 * Update timeout interval for the nofeedback timer.
5128a508ac2SGerrit Renker 		 * We use a configuration option to increase the lower bound.
5138a508ac2SGerrit Renker 		 * This can help avoid triggering the nofeedback timer too often
5148a508ac2SGerrit Renker 		 * ('spinning') on LANs with small RTTs.
5158a508ac2SGerrit Renker 		 */
5165d0dbc4aSGerrit Renker 		hctx->ccid3hctx_t_rto = max_t(u32, 4 * hctx->ccid3hctx_rtt,
5178a508ac2SGerrit Renker 						   CONFIG_IP_DCCP_CCID3_RTO *
5188a508ac2SGerrit Renker 						   (USEC_PER_SEC/1000)	     );
5191f2333aeSArnaldo Carvalho de Melo 		/*
5201f2333aeSArnaldo Carvalho de Melo 		 * Schedule no feedback timer to expire in
5218a508ac2SGerrit Renker 		 * max(t_RTO, 2 * s/X)  =  max(t_RTO, 2 * t_ipi)
5221f2333aeSArnaldo Carvalho de Melo 		 */
5238a508ac2SGerrit Renker 		t_nfb = max(hctx->ccid3hctx_t_rto, 2 * hctx->ccid3hctx_t_ipi);
5247c657876SArnaldo Carvalho de Melo 
5251f2333aeSArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p, Scheduled no feedback timer to "
5261f2333aeSArnaldo Carvalho de Melo 			       "expire in %lu jiffies (%luus)\n",
5271f2333aeSArnaldo Carvalho de Melo 			       dccp_role(sk), sk,
5282a1fda6fSGerrit Renker 			       usecs_to_jiffies(t_nfb), t_nfb);
5297c657876SArnaldo Carvalho de Melo 
5307c657876SArnaldo Carvalho de Melo 		sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
5312a1fda6fSGerrit Renker 				   jiffies + usecs_to_jiffies(t_nfb));
5327c657876SArnaldo Carvalho de Melo 
5337c657876SArnaldo Carvalho de Melo 		/* set idle flag */
5347c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_idle = 1;
5357c657876SArnaldo Carvalho de Melo 		break;
5365e19e3fcSGerrit Renker 	case TFRC_SSTATE_NO_SENT:
537bf58a381SGerrit Renker 		/* XXX when implementing bidirectional rx/tx check this again */
53826af3072SGerrit Renker 		DCCP_WARN("Illegal ACK received - no packet sent\n");
5395e19e3fcSGerrit Renker 		/* fall through */
5405e19e3fcSGerrit Renker 	case TFRC_SSTATE_TERM:		/* ignore feedback when closing */
5417c657876SArnaldo Carvalho de Melo 		break;
5427c657876SArnaldo Carvalho de Melo 	}
5437c657876SArnaldo Carvalho de Melo }
5447c657876SArnaldo Carvalho de Melo 
5457c657876SArnaldo Carvalho de Melo static int ccid3_hc_tx_parse_options(struct sock *sk, unsigned char option,
5461f2333aeSArnaldo Carvalho de Melo 				     unsigned char len, u16 idx,
5471f2333aeSArnaldo Carvalho de Melo 				     unsigned char *value)
5487c657876SArnaldo Carvalho de Melo {
5497c657876SArnaldo Carvalho de Melo 	int rc = 0;
55059725dc2SArnaldo Carvalho de Melo 	const struct dccp_sock *dp = dccp_sk(sk);
55159725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
5527c657876SArnaldo Carvalho de Melo 	struct ccid3_options_received *opt_recv;
5537c657876SArnaldo Carvalho de Melo 
55459d203f9SArnaldo Carvalho de Melo 	BUG_ON(hctx == NULL);
5557c657876SArnaldo Carvalho de Melo 
5567c657876SArnaldo Carvalho de Melo 	opt_recv = &hctx->ccid3hctx_options_received;
5577c657876SArnaldo Carvalho de Melo 
5587c657876SArnaldo Carvalho de Melo 	if (opt_recv->ccid3or_seqno != dp->dccps_gsr) {
5597c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_seqno		     = dp->dccps_gsr;
5607c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_event_rate    = ~0;
5617c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_intervals_idx = 0;
5627c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_intervals_len = 0;
5637c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_receive_rate	     = 0;
5647c657876SArnaldo Carvalho de Melo 	}
5657c657876SArnaldo Carvalho de Melo 
5667c657876SArnaldo Carvalho de Melo 	switch (option) {
5677c657876SArnaldo Carvalho de Melo 	case TFRC_OPT_LOSS_EVENT_RATE:
56859d203f9SArnaldo Carvalho de Melo 		if (unlikely(len != 4)) {
56959348b19SGerrit Renker 			DCCP_WARN("%s, sk=%p, invalid len %d "
57059348b19SGerrit Renker 				  "for TFRC_OPT_LOSS_EVENT_RATE\n",
57159348b19SGerrit Renker 				  dccp_role(sk), sk, len);
5727c657876SArnaldo Carvalho de Melo 			rc = -EINVAL;
5737c657876SArnaldo Carvalho de Melo 		} else {
57460fe62e7SAndrea Bittau 			opt_recv->ccid3or_loss_event_rate = ntohl(*(__be32 *)value);
5757c657876SArnaldo Carvalho de Melo 			ccid3_pr_debug("%s, sk=%p, LOSS_EVENT_RATE=%u\n",
5767c657876SArnaldo Carvalho de Melo 				       dccp_role(sk), sk,
5777c657876SArnaldo Carvalho de Melo 				       opt_recv->ccid3or_loss_event_rate);
5787c657876SArnaldo Carvalho de Melo 		}
5797c657876SArnaldo Carvalho de Melo 		break;
5807c657876SArnaldo Carvalho de Melo 	case TFRC_OPT_LOSS_INTERVALS:
5817c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_intervals_idx = idx;
5827c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_intervals_len = len;
5837c657876SArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p, LOSS_INTERVALS=(%u, %u)\n",
5847c657876SArnaldo Carvalho de Melo 			       dccp_role(sk), sk,
5857c657876SArnaldo Carvalho de Melo 			       opt_recv->ccid3or_loss_intervals_idx,
5867c657876SArnaldo Carvalho de Melo 			       opt_recv->ccid3or_loss_intervals_len);
5877c657876SArnaldo Carvalho de Melo 		break;
5887c657876SArnaldo Carvalho de Melo 	case TFRC_OPT_RECEIVE_RATE:
58959d203f9SArnaldo Carvalho de Melo 		if (unlikely(len != 4)) {
59059348b19SGerrit Renker 			DCCP_WARN("%s, sk=%p, invalid len %d "
59159348b19SGerrit Renker 				  "for TFRC_OPT_RECEIVE_RATE\n",
59259348b19SGerrit Renker 				  dccp_role(sk), sk, len);
5937c657876SArnaldo Carvalho de Melo 			rc = -EINVAL;
5947c657876SArnaldo Carvalho de Melo 		} else {
59560fe62e7SAndrea Bittau 			opt_recv->ccid3or_receive_rate = ntohl(*(__be32 *)value);
5967c657876SArnaldo Carvalho de Melo 			ccid3_pr_debug("%s, sk=%p, RECEIVE_RATE=%u\n",
5977c657876SArnaldo Carvalho de Melo 				       dccp_role(sk), sk,
5987c657876SArnaldo Carvalho de Melo 				       opt_recv->ccid3or_receive_rate);
5997c657876SArnaldo Carvalho de Melo 		}
6007c657876SArnaldo Carvalho de Melo 		break;
6017c657876SArnaldo Carvalho de Melo 	}
6027c657876SArnaldo Carvalho de Melo 
6037c657876SArnaldo Carvalho de Melo 	return rc;
6047c657876SArnaldo Carvalho de Melo }
6057c657876SArnaldo Carvalho de Melo 
60691f0ebf7SArnaldo Carvalho de Melo static int ccid3_hc_tx_init(struct ccid *ccid, struct sock *sk)
6077c657876SArnaldo Carvalho de Melo {
60891f0ebf7SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid_priv(ccid);
6097c657876SArnaldo Carvalho de Melo 
61078ad713dSGerrit Renker 	hctx->ccid3hctx_s     = 0;
611fe0499aeSGerrit Renker 	hctx->ccid3hctx_rtt   = 0;
6127c657876SArnaldo Carvalho de Melo 	hctx->ccid3hctx_state = TFRC_SSTATE_NO_SENT;
6137c657876SArnaldo Carvalho de Melo 	INIT_LIST_HEAD(&hctx->ccid3hctx_hist);
614aa5d7df3SArnaldo Carvalho de Melo 
615aa5d7df3SArnaldo Carvalho de Melo 	hctx->ccid3hctx_no_feedback_timer.function = ccid3_hc_tx_no_feedback_timer;
616aa5d7df3SArnaldo Carvalho de Melo 	hctx->ccid3hctx_no_feedback_timer.data     = (unsigned long)sk;
6177c657876SArnaldo Carvalho de Melo 	init_timer(&hctx->ccid3hctx_no_feedback_timer);
6187c657876SArnaldo Carvalho de Melo 
6197c657876SArnaldo Carvalho de Melo 	return 0;
6207c657876SArnaldo Carvalho de Melo }
6217c657876SArnaldo Carvalho de Melo 
6227c657876SArnaldo Carvalho de Melo static void ccid3_hc_tx_exit(struct sock *sk)
6237c657876SArnaldo Carvalho de Melo {
62459725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
6257c657876SArnaldo Carvalho de Melo 
6267c657876SArnaldo Carvalho de Melo 	BUG_ON(hctx == NULL);
6277c657876SArnaldo Carvalho de Melo 
6287c657876SArnaldo Carvalho de Melo 	ccid3_hc_tx_set_state(sk, TFRC_SSTATE_TERM);
6297c657876SArnaldo Carvalho de Melo 	sk_stop_timer(sk, &hctx->ccid3hctx_no_feedback_timer);
6307c657876SArnaldo Carvalho de Melo 
6317c657876SArnaldo Carvalho de Melo 	/* Empty packet history */
6328c60f3faSArnaldo Carvalho de Melo 	dccp_tx_hist_purge(ccid3_tx_hist, &hctx->ccid3hctx_hist);
6337c657876SArnaldo Carvalho de Melo }
6347c657876SArnaldo Carvalho de Melo 
6357c657876SArnaldo Carvalho de Melo /*
6367c657876SArnaldo Carvalho de Melo  * RX Half Connection methods
6377c657876SArnaldo Carvalho de Melo  */
6387c657876SArnaldo Carvalho de Melo 
63956724aa4SGerrit Renker #ifdef CONFIG_IP_DCCP_CCID3_DEBUG
6407c657876SArnaldo Carvalho de Melo static const char *ccid3_rx_state_name(enum ccid3_hc_rx_states state)
6417c657876SArnaldo Carvalho de Melo {
6427c657876SArnaldo Carvalho de Melo 	static char *ccid3_rx_state_names[] = {
6437c657876SArnaldo Carvalho de Melo 	[TFRC_RSTATE_NO_DATA] = "NO_DATA",
6447c657876SArnaldo Carvalho de Melo 	[TFRC_RSTATE_DATA]    = "DATA",
6457c657876SArnaldo Carvalho de Melo 	[TFRC_RSTATE_TERM]    = "TERM",
6467c657876SArnaldo Carvalho de Melo 	};
6477c657876SArnaldo Carvalho de Melo 
6487c657876SArnaldo Carvalho de Melo 	return ccid3_rx_state_names[state];
6497c657876SArnaldo Carvalho de Melo }
6507c657876SArnaldo Carvalho de Melo #endif
6517c657876SArnaldo Carvalho de Melo 
652c25a18baSArnaldo Carvalho de Melo static void ccid3_hc_rx_set_state(struct sock *sk,
6531f2333aeSArnaldo Carvalho de Melo 				  enum ccid3_hc_rx_states state)
6547c657876SArnaldo Carvalho de Melo {
65559725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
6567c657876SArnaldo Carvalho de Melo 	enum ccid3_hc_rx_states oldstate = hcrx->ccid3hcrx_state;
6577c657876SArnaldo Carvalho de Melo 
6587c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s(%p) %-8.8s -> %s\n",
6591f2333aeSArnaldo Carvalho de Melo 		       dccp_role(sk), sk, ccid3_rx_state_name(oldstate),
6601f2333aeSArnaldo Carvalho de Melo 		       ccid3_rx_state_name(state));
6617c657876SArnaldo Carvalho de Melo 	WARN_ON(state == oldstate);
6627c657876SArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_state = state;
6637c657876SArnaldo Carvalho de Melo }
6647c657876SArnaldo Carvalho de Melo 
66578ad713dSGerrit Renker static inline void ccid3_hc_rx_update_s(struct ccid3_hc_rx_sock *hcrx, int len)
66678ad713dSGerrit Renker {
66778ad713dSGerrit Renker 	if (unlikely(len == 0))	/* don't update on empty packets (e.g. ACKs) */
66878ad713dSGerrit Renker 		ccid3_pr_debug("Packet payload length is 0 - not updating\n");
66978ad713dSGerrit Renker 	else
67078ad713dSGerrit Renker 		hcrx->ccid3hcrx_s = hcrx->ccid3hcrx_s == 0 ? len :
67178ad713dSGerrit Renker 				    (9 * hcrx->ccid3hcrx_s + len) / 10;
67278ad713dSGerrit Renker }
67378ad713dSGerrit Renker 
6747c657876SArnaldo Carvalho de Melo static void ccid3_hc_rx_send_feedback(struct sock *sk)
6757c657876SArnaldo Carvalho de Melo {
67659725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
6777c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
6788c60f3faSArnaldo Carvalho de Melo 	struct dccp_rx_hist_entry *packet;
679b6ee3d4aSArnaldo Carvalho de Melo 	struct timeval now;
6800f9e5b57SGerrit Renker 	suseconds_t delta;
6817c657876SArnaldo Carvalho de Melo 
6827c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
6837c657876SArnaldo Carvalho de Melo 
684b0e56780SArnaldo Carvalho de Melo 	dccp_timestamp(sk, &now);
685b6ee3d4aSArnaldo Carvalho de Melo 
6867c657876SArnaldo Carvalho de Melo 	switch (hcrx->ccid3hcrx_state) {
6877c657876SArnaldo Carvalho de Melo 	case TFRC_RSTATE_NO_DATA:
6887c657876SArnaldo Carvalho de Melo 		hcrx->ccid3hcrx_x_recv = 0;
6897c657876SArnaldo Carvalho de Melo 		break;
6900f9e5b57SGerrit Renker 	case TFRC_RSTATE_DATA:
6910f9e5b57SGerrit Renker 		delta = timeval_delta(&now,
692b6ee3d4aSArnaldo Carvalho de Melo 				      &hcrx->ccid3hcrx_tstamp_last_feedback);
6930f9e5b57SGerrit Renker 		DCCP_BUG_ON(delta < 0);
694b9039a2aSGerrit Renker 		hcrx->ccid3hcrx_x_recv =
695b9039a2aSGerrit Renker 			scaled_div32(hcrx->ccid3hcrx_bytes_recv, delta);
6967c657876SArnaldo Carvalho de Melo 		break;
69759348b19SGerrit Renker 	case TFRC_RSTATE_TERM:
69859348b19SGerrit Renker 		DCCP_BUG("Illegal %s state TERM, sk=%p", dccp_role(sk), sk);
6997c657876SArnaldo Carvalho de Melo 		return;
7007c657876SArnaldo Carvalho de Melo 	}
7017c657876SArnaldo Carvalho de Melo 
7028c60f3faSArnaldo Carvalho de Melo 	packet = dccp_rx_hist_find_data_packet(&hcrx->ccid3hcrx_hist);
70359d203f9SArnaldo Carvalho de Melo 	if (unlikely(packet == NULL)) {
70459348b19SGerrit Renker 		DCCP_WARN("%s, sk=%p, no data packet in history!\n",
70559348b19SGerrit Renker 			  dccp_role(sk), sk);
7067c657876SArnaldo Carvalho de Melo 		return;
7077c657876SArnaldo Carvalho de Melo 	}
7087c657876SArnaldo Carvalho de Melo 
709b6ee3d4aSArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_tstamp_last_feedback = now;
71066a377c5SIan McDonald 	hcrx->ccid3hcrx_ccval_last_counter   = packet->dccphrx_ccval;
7117c657876SArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_bytes_recv	     = 0;
7127c657876SArnaldo Carvalho de Melo 
7130f9e5b57SGerrit Renker 	/* Elapsed time information [RFC 4340, 13.2] in units of 10 * usecs */
7140f9e5b57SGerrit Renker 	delta = timeval_delta(&now, &packet->dccphrx_tstamp);
7150f9e5b57SGerrit Renker 	DCCP_BUG_ON(delta < 0);
7160f9e5b57SGerrit Renker 	hcrx->ccid3hcrx_elapsed_time = delta / 10;
71745393a66SGerrit Renker 
7187c657876SArnaldo Carvalho de Melo 	if (hcrx->ccid3hcrx_p == 0)
71945393a66SGerrit Renker 		hcrx->ccid3hcrx_pinv = ~0U;	/* see RFC 4342, 8.5 */
72045393a66SGerrit Renker 	else if (hcrx->ccid3hcrx_p > 1000000) {
72145393a66SGerrit Renker 		DCCP_WARN("p (%u) > 100%%\n", hcrx->ccid3hcrx_p);
72245393a66SGerrit Renker 		hcrx->ccid3hcrx_pinv = 1;	/* use 100% in this case */
72345393a66SGerrit Renker 	} else
7247c657876SArnaldo Carvalho de Melo 		hcrx->ccid3hcrx_pinv = 1000000 / hcrx->ccid3hcrx_p;
72545393a66SGerrit Renker 
726507d37cfSArnaldo Carvalho de Melo 	dp->dccps_hc_rx_insert_options = 1;
7277c657876SArnaldo Carvalho de Melo 	dccp_send_ack(sk);
7287c657876SArnaldo Carvalho de Melo }
7297c657876SArnaldo Carvalho de Melo 
7302d0817d1SArnaldo Carvalho de Melo static int ccid3_hc_rx_insert_options(struct sock *sk, struct sk_buff *skb)
7317c657876SArnaldo Carvalho de Melo {
73259d203f9SArnaldo Carvalho de Melo 	const struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
73360fe62e7SAndrea Bittau 	__be32 x_recv, pinv;
7347c657876SArnaldo Carvalho de Melo 
73559d203f9SArnaldo Carvalho de Melo 	BUG_ON(hcrx == NULL);
73659d203f9SArnaldo Carvalho de Melo 
73759d203f9SArnaldo Carvalho de Melo 	if (!(sk->sk_state == DCCP_OPEN || sk->sk_state == DCCP_PARTOPEN))
7382d0817d1SArnaldo Carvalho de Melo 		return 0;
7397c657876SArnaldo Carvalho de Melo 
74066a377c5SIan McDonald 	DCCP_SKB_CB(skb)->dccpd_ccval = hcrx->ccid3hcrx_ccval_last_counter;
7414fded33bSArnaldo Carvalho de Melo 
7424fded33bSArnaldo Carvalho de Melo 	if (dccp_packet_without_ack(skb))
7432d0817d1SArnaldo Carvalho de Melo 		return 0;
7444fded33bSArnaldo Carvalho de Melo 
7454fded33bSArnaldo Carvalho de Melo 	x_recv = htonl(hcrx->ccid3hcrx_x_recv);
7464fded33bSArnaldo Carvalho de Melo 	pinv   = htonl(hcrx->ccid3hcrx_pinv);
7472d0817d1SArnaldo Carvalho de Melo 
7482d0817d1SArnaldo Carvalho de Melo 	if ((hcrx->ccid3hcrx_elapsed_time != 0 &&
7492d0817d1SArnaldo Carvalho de Melo 	     dccp_insert_option_elapsed_time(sk, skb,
7502d0817d1SArnaldo Carvalho de Melo 					     hcrx->ccid3hcrx_elapsed_time)) ||
7512d0817d1SArnaldo Carvalho de Melo 	    dccp_insert_option_timestamp(sk, skb) ||
7524fded33bSArnaldo Carvalho de Melo 	    dccp_insert_option(sk, skb, TFRC_OPT_LOSS_EVENT_RATE,
7532d0817d1SArnaldo Carvalho de Melo 		    	       &pinv, sizeof(pinv)) ||
7544fded33bSArnaldo Carvalho de Melo 	    dccp_insert_option(sk, skb, TFRC_OPT_RECEIVE_RATE,
7552d0817d1SArnaldo Carvalho de Melo 		    	       &x_recv, sizeof(x_recv)))
7562d0817d1SArnaldo Carvalho de Melo 		return -1;
7572d0817d1SArnaldo Carvalho de Melo 
7582d0817d1SArnaldo Carvalho de Melo 	return 0;
7597c657876SArnaldo Carvalho de Melo }
7607c657876SArnaldo Carvalho de Melo 
7617c657876SArnaldo Carvalho de Melo /* calculate first loss interval
7627c657876SArnaldo Carvalho de Melo  *
7637c657876SArnaldo Carvalho de Melo  * returns estimated loss interval in usecs */
7647c657876SArnaldo Carvalho de Melo 
7657c657876SArnaldo Carvalho de Melo static u32 ccid3_hc_rx_calc_first_li(struct sock *sk)
7667c657876SArnaldo Carvalho de Melo {
76759725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
7688c60f3faSArnaldo Carvalho de Melo 	struct dccp_rx_hist_entry *entry, *next, *tail = NULL;
7690f9e5b57SGerrit Renker 	u32 x_recv, p;
7700f9e5b57SGerrit Renker 	suseconds_t rtt, delta;
771b6ee3d4aSArnaldo Carvalho de Melo 	struct timeval tstamp = { 0, };
7727c657876SArnaldo Carvalho de Melo 	int interval = 0;
7737c657876SArnaldo Carvalho de Melo 	int win_count = 0;
7747c657876SArnaldo Carvalho de Melo 	int step = 0;
775bfe24a6cSGerrit Renker 	u64 fval;
7767c657876SArnaldo Carvalho de Melo 
7778c60f3faSArnaldo Carvalho de Melo 	list_for_each_entry_safe(entry, next, &hcrx->ccid3hcrx_hist,
7788c60f3faSArnaldo Carvalho de Melo 				 dccphrx_node) {
7798c60f3faSArnaldo Carvalho de Melo 		if (dccp_rx_hist_entry_data_packet(entry)) {
7807c657876SArnaldo Carvalho de Melo 			tail = entry;
7817c657876SArnaldo Carvalho de Melo 
7827c657876SArnaldo Carvalho de Melo 			switch (step) {
7837c657876SArnaldo Carvalho de Melo 			case 0:
7848c60f3faSArnaldo Carvalho de Melo 				tstamp	  = entry->dccphrx_tstamp;
785c1734376SArnaldo Carvalho de Melo 				win_count = entry->dccphrx_ccval;
7867c657876SArnaldo Carvalho de Melo 				step = 1;
7877c657876SArnaldo Carvalho de Melo 				break;
7887c657876SArnaldo Carvalho de Melo 			case 1:
789c1734376SArnaldo Carvalho de Melo 				interval = win_count - entry->dccphrx_ccval;
7907c657876SArnaldo Carvalho de Melo 				if (interval < 0)
7917c657876SArnaldo Carvalho de Melo 					interval += TFRC_WIN_COUNT_LIMIT;
7927c657876SArnaldo Carvalho de Melo 				if (interval > 4)
7937c657876SArnaldo Carvalho de Melo 					goto found;
7947c657876SArnaldo Carvalho de Melo 				break;
7957c657876SArnaldo Carvalho de Melo 			}
7967c657876SArnaldo Carvalho de Melo 		}
7977c657876SArnaldo Carvalho de Melo 	}
7987c657876SArnaldo Carvalho de Melo 
79959d203f9SArnaldo Carvalho de Melo 	if (unlikely(step == 0)) {
80059348b19SGerrit Renker 		DCCP_WARN("%s, sk=%p, packet history has no data packets!\n",
80159348b19SGerrit Renker 			  dccp_role(sk), sk);
8027c657876SArnaldo Carvalho de Melo 		return ~0;
8037c657876SArnaldo Carvalho de Melo 	}
8047c657876SArnaldo Carvalho de Melo 
80559d203f9SArnaldo Carvalho de Melo 	if (unlikely(interval == 0)) {
80659348b19SGerrit Renker 		DCCP_WARN("%s, sk=%p, Could not find a win_count interval > 0."
80759348b19SGerrit Renker 			  "Defaulting to 1\n", dccp_role(sk), sk);
8087c657876SArnaldo Carvalho de Melo 		interval = 1;
8097c657876SArnaldo Carvalho de Melo 	}
8107c657876SArnaldo Carvalho de Melo found:
81166a377c5SIan McDonald 	if (!tail) {
81259348b19SGerrit Renker 		DCCP_CRIT("tail is null\n");
81366a377c5SIan McDonald 		return ~0;
81466a377c5SIan McDonald 	}
8150f9e5b57SGerrit Renker 
8160f9e5b57SGerrit Renker 	delta = timeval_delta(&tstamp, &tail->dccphrx_tstamp);
8170f9e5b57SGerrit Renker 	DCCP_BUG_ON(delta < 0);
8180f9e5b57SGerrit Renker 
8190f9e5b57SGerrit Renker 	rtt = delta * 4 / interval;
8200f9e5b57SGerrit Renker 	ccid3_pr_debug("%s, sk=%p, approximated RTT to %ldus\n",
8217c657876SArnaldo Carvalho de Melo 		       dccp_role(sk), sk, rtt);
82259348b19SGerrit Renker 
823bfe24a6cSGerrit Renker 	/*
824bfe24a6cSGerrit Renker 	 * Determine the length of the first loss interval via inverse lookup.
825bfe24a6cSGerrit Renker 	 * Assume that X_recv can be computed by the throughput equation
826bfe24a6cSGerrit Renker 	 *      	    s
827bfe24a6cSGerrit Renker 	 * 	X_recv = --------
828bfe24a6cSGerrit Renker 	 * 		 R * fval
829bfe24a6cSGerrit Renker 	 * Find some p such that f(p) = fval; return 1/p [RFC 3448, 6.3.1].
830bfe24a6cSGerrit Renker 	 */
831bfe24a6cSGerrit Renker 	if (rtt == 0) {			/* would result in divide-by-zero */
832bfe24a6cSGerrit Renker 		DCCP_WARN("RTT==0, returning 1/p = 1\n");
833bfe24a6cSGerrit Renker 		return 1000000;
83459348b19SGerrit Renker 	}
8357c657876SArnaldo Carvalho de Melo 
836b0e56780SArnaldo Carvalho de Melo 	dccp_timestamp(sk, &tstamp);
837b0e56780SArnaldo Carvalho de Melo 	delta = timeval_delta(&tstamp, &hcrx->ccid3hcrx_tstamp_last_feedback);
8380f9e5b57SGerrit Renker 	DCCP_BUG_ON(delta <= 0);
8397c657876SArnaldo Carvalho de Melo 
8400f9e5b57SGerrit Renker 	x_recv = scaled_div32(hcrx->ccid3hcrx_bytes_recv, delta);
841bfe24a6cSGerrit Renker 	if (x_recv == 0) {		/* would also trigger divide-by-zero */
842bfe24a6cSGerrit Renker 		DCCP_WARN("X_recv==0\n");
843bfe24a6cSGerrit Renker 		if ((x_recv = hcrx->ccid3hcrx_x_recv) == 0) {
844bfe24a6cSGerrit Renker 			DCCP_BUG("stored value of X_recv is zero");
845bfe24a6cSGerrit Renker 			return 1000000;
846bfe24a6cSGerrit Renker 		}
84766a377c5SIan McDonald 	}
84866a377c5SIan McDonald 
849bfe24a6cSGerrit Renker 	fval = scaled_div(hcrx->ccid3hcrx_s, rtt);
850bfe24a6cSGerrit Renker 	fval = scaled_div32(fval, x_recv);
85136729c1aSArnaldo Carvalho de Melo 	p = tfrc_calc_x_reverse_lookup(fval);
852bfe24a6cSGerrit Renker 
8531f2333aeSArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p, receive rate=%u bytes/s, implied "
8541f2333aeSArnaldo Carvalho de Melo 		       "loss rate=%u\n", dccp_role(sk), sk, x_recv, p);
8557c657876SArnaldo Carvalho de Melo 
8567c657876SArnaldo Carvalho de Melo 	if (p == 0)
8577c657876SArnaldo Carvalho de Melo 		return ~0;
8587c657876SArnaldo Carvalho de Melo 	else
8597c657876SArnaldo Carvalho de Melo 		return 1000000 / p;
8607c657876SArnaldo Carvalho de Melo }
8617c657876SArnaldo Carvalho de Melo 
8627c657876SArnaldo Carvalho de Melo static void ccid3_hc_rx_update_li(struct sock *sk, u64 seq_loss, u8 win_loss)
8637c657876SArnaldo Carvalho de Melo {
86459725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
865fc747e82SIan McDonald 	struct dccp_li_hist_entry *head;
86666a377c5SIan McDonald 	u64 seq_temp;
8677c657876SArnaldo Carvalho de Melo 
86866a377c5SIan McDonald 	if (list_empty(&hcrx->ccid3hcrx_li_hist)) {
86966a377c5SIan McDonald 		if (!dccp_li_hist_interval_new(ccid3_li_hist,
87066a377c5SIan McDonald 		   &hcrx->ccid3hcrx_li_hist, seq_loss, win_loss))
871ae6706f0SArnaldo Carvalho de Melo 			return;
87266a377c5SIan McDonald 
873fc747e82SIan McDonald 		head = list_entry(hcrx->ccid3hcrx_li_hist.next,
874fc747e82SIan McDonald 		   struct dccp_li_hist_entry, dccplih_node);
875fc747e82SIan McDonald 		head->dccplih_interval = ccid3_hc_rx_calc_first_li(sk);
87666a377c5SIan McDonald 	} else {
87766a377c5SIan McDonald 		struct dccp_li_hist_entry *entry;
87866a377c5SIan McDonald 		struct list_head *tail;
87966a377c5SIan McDonald 
880fc747e82SIan McDonald 		head = list_entry(hcrx->ccid3hcrx_li_hist.next,
881fc747e82SIan McDonald 		   struct dccp_li_hist_entry, dccplih_node);
88266a377c5SIan McDonald 		/* FIXME win count check removed as was wrong */
88366a377c5SIan McDonald 		/* should make this check with receive history */
88466a377c5SIan McDonald 		/* and compare there as per section 10.2 of RFC4342 */
88566a377c5SIan McDonald 
88666a377c5SIan McDonald 		/* new loss event detected */
88766a377c5SIan McDonald 		/* calculate last interval length */
88866a377c5SIan McDonald 		seq_temp = dccp_delta_seqno(head->dccplih_seqno, seq_loss);
88954e6ecb2SChristoph Lameter 		entry = dccp_li_hist_entry_new(ccid3_li_hist, GFP_ATOMIC);
89066a377c5SIan McDonald 
89166a377c5SIan McDonald 		if (entry == NULL) {
89259348b19SGerrit Renker 			DCCP_BUG("out of memory - can not allocate entry");
89366a377c5SIan McDonald 			return;
8947c657876SArnaldo Carvalho de Melo 		}
8957c657876SArnaldo Carvalho de Melo 
89666a377c5SIan McDonald 		list_add(&entry->dccplih_node, &hcrx->ccid3hcrx_li_hist);
89766a377c5SIan McDonald 
89866a377c5SIan McDonald 		tail = hcrx->ccid3hcrx_li_hist.prev;
89966a377c5SIan McDonald 		list_del(tail);
90066a377c5SIan McDonald 		kmem_cache_free(ccid3_li_hist->dccplih_slab, tail);
90166a377c5SIan McDonald 
90266a377c5SIan McDonald 		/* Create the newest interval */
90366a377c5SIan McDonald 		entry->dccplih_seqno = seq_loss;
90466a377c5SIan McDonald 		entry->dccplih_interval = seq_temp;
90566a377c5SIan McDonald 		entry->dccplih_win_count = win_loss;
90666a377c5SIan McDonald 	}
90766a377c5SIan McDonald }
90866a377c5SIan McDonald 
90966a377c5SIan McDonald static int ccid3_hc_rx_detect_loss(struct sock *sk,
91066a377c5SIan McDonald                                     struct dccp_rx_hist_entry *packet)
9117c657876SArnaldo Carvalho de Melo {
91259725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
91366a377c5SIan McDonald 	struct dccp_rx_hist_entry *rx_hist = dccp_rx_hist_head(&hcrx->ccid3hcrx_hist);
91466a377c5SIan McDonald 	u64 seqno = packet->dccphrx_seqno;
91566a377c5SIan McDonald 	u64 tmp_seqno;
91666a377c5SIan McDonald 	int loss = 0;
91766a377c5SIan McDonald 	u8 ccval;
9187c657876SArnaldo Carvalho de Melo 
91966a377c5SIan McDonald 
92066a377c5SIan McDonald 	tmp_seqno = hcrx->ccid3hcrx_seqno_nonloss;
92166a377c5SIan McDonald 
92266a377c5SIan McDonald 	if (!rx_hist ||
92366a377c5SIan McDonald 	   follows48(packet->dccphrx_seqno, hcrx->ccid3hcrx_seqno_nonloss)) {
92466a377c5SIan McDonald 		hcrx->ccid3hcrx_seqno_nonloss = seqno;
92566a377c5SIan McDonald 		hcrx->ccid3hcrx_ccval_nonloss = packet->dccphrx_ccval;
92666a377c5SIan McDonald 		goto detect_out;
92766a377c5SIan McDonald 	}
92866a377c5SIan McDonald 
92966a377c5SIan McDonald 
93066a377c5SIan McDonald 	while (dccp_delta_seqno(hcrx->ccid3hcrx_seqno_nonloss, seqno)
93166a377c5SIan McDonald 	   > TFRC_RECV_NUM_LATE_LOSS) {
93266a377c5SIan McDonald 		loss = 1;
93366a377c5SIan McDonald 		ccid3_hc_rx_update_li(sk, hcrx->ccid3hcrx_seqno_nonloss,
93466a377c5SIan McDonald 		   hcrx->ccid3hcrx_ccval_nonloss);
93566a377c5SIan McDonald 		tmp_seqno = hcrx->ccid3hcrx_seqno_nonloss;
93666a377c5SIan McDonald 		dccp_inc_seqno(&tmp_seqno);
93766a377c5SIan McDonald 		hcrx->ccid3hcrx_seqno_nonloss = tmp_seqno;
93866a377c5SIan McDonald 		dccp_inc_seqno(&tmp_seqno);
93966a377c5SIan McDonald 		while (dccp_rx_hist_find_entry(&hcrx->ccid3hcrx_hist,
94066a377c5SIan McDonald 		   tmp_seqno, &ccval)) {
94166a377c5SIan McDonald 		   	hcrx->ccid3hcrx_seqno_nonloss = tmp_seqno;
94266a377c5SIan McDonald 			hcrx->ccid3hcrx_ccval_nonloss = ccval;
94366a377c5SIan McDonald 			dccp_inc_seqno(&tmp_seqno);
94466a377c5SIan McDonald 		}
94566a377c5SIan McDonald 	}
94666a377c5SIan McDonald 
94766a377c5SIan McDonald 	/* FIXME - this code could be simplified with above while */
94866a377c5SIan McDonald 	/* but works at moment */
94966a377c5SIan McDonald 	if (follows48(packet->dccphrx_seqno, hcrx->ccid3hcrx_seqno_nonloss)) {
95066a377c5SIan McDonald 		hcrx->ccid3hcrx_seqno_nonloss = seqno;
95166a377c5SIan McDonald 		hcrx->ccid3hcrx_ccval_nonloss = packet->dccphrx_ccval;
95266a377c5SIan McDonald 	}
95366a377c5SIan McDonald 
95466a377c5SIan McDonald detect_out:
95566a377c5SIan McDonald 	dccp_rx_hist_add_packet(ccid3_rx_hist, &hcrx->ccid3hcrx_hist,
95666a377c5SIan McDonald 		   &hcrx->ccid3hcrx_li_hist, packet,
95766a377c5SIan McDonald 		   hcrx->ccid3hcrx_seqno_nonloss);
95866a377c5SIan McDonald 	return loss;
9597c657876SArnaldo Carvalho de Melo }
9607c657876SArnaldo Carvalho de Melo 
9617c657876SArnaldo Carvalho de Melo static void ccid3_hc_rx_packet_recv(struct sock *sk, struct sk_buff *skb)
9627c657876SArnaldo Carvalho de Melo {
96359725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
9644fded33bSArnaldo Carvalho de Melo 	const struct dccp_options_received *opt_recv;
9658c60f3faSArnaldo Carvalho de Melo 	struct dccp_rx_hist_entry *packet;
9667c657876SArnaldo Carvalho de Melo 	struct timeval now;
9670f9e5b57SGerrit Renker 	u32 p_prev, rtt_prev;
9680f9e5b57SGerrit Renker 	suseconds_t r_sample, t_elapsed;
96978ad713dSGerrit Renker 	int loss, payload_size;
9701f2333aeSArnaldo Carvalho de Melo 
97159348b19SGerrit Renker 	BUG_ON(hcrx == NULL);
9727c657876SArnaldo Carvalho de Melo 
97359725dc2SArnaldo Carvalho de Melo 	opt_recv = &dccp_sk(sk)->dccps_options_received;
9744fded33bSArnaldo Carvalho de Melo 
9757c657876SArnaldo Carvalho de Melo 	switch (DCCP_SKB_CB(skb)->dccpd_type) {
9767c657876SArnaldo Carvalho de Melo 	case DCCP_PKT_ACK:
9777c657876SArnaldo Carvalho de Melo 		if (hcrx->ccid3hcrx_state == TFRC_RSTATE_NO_DATA)
9787c657876SArnaldo Carvalho de Melo 			return;
9797c657876SArnaldo Carvalho de Melo 	case DCCP_PKT_DATAACK:
9804fded33bSArnaldo Carvalho de Melo 		if (opt_recv->dccpor_timestamp_echo == 0)
9817c657876SArnaldo Carvalho de Melo 			break;
98266a377c5SIan McDonald 		rtt_prev = hcrx->ccid3hcrx_rtt;
983b0e56780SArnaldo Carvalho de Melo 		dccp_timestamp(sk, &now);
984b3a3077dSArnaldo Carvalho de Melo 		timeval_sub_usecs(&now, opt_recv->dccpor_timestamp_echo * 10);
985b3a3077dSArnaldo Carvalho de Melo 		r_sample = timeval_usecs(&now);
986b3a3077dSArnaldo Carvalho de Melo 		t_elapsed = opt_recv->dccpor_elapsed_time * 10;
987b3a3077dSArnaldo Carvalho de Melo 
9880f9e5b57SGerrit Renker 		DCCP_BUG_ON(r_sample < 0);
989b3a3077dSArnaldo Carvalho de Melo 		if (unlikely(r_sample <= t_elapsed))
9900f9e5b57SGerrit Renker 			DCCP_WARN("r_sample=%ldus, t_elapsed=%ldus\n",
99159348b19SGerrit Renker 				  r_sample, t_elapsed);
992b3a3077dSArnaldo Carvalho de Melo 		else
993b3a3077dSArnaldo Carvalho de Melo 			r_sample -= t_elapsed;
994de553c18SGerrit Renker 		CCID3_RTT_SANITY_CHECK(r_sample);
995b3a3077dSArnaldo Carvalho de Melo 
996b3a3077dSArnaldo Carvalho de Melo 		if (hcrx->ccid3hcrx_state == TFRC_RSTATE_NO_DATA)
997b3a3077dSArnaldo Carvalho de Melo 			hcrx->ccid3hcrx_rtt = r_sample;
998b3a3077dSArnaldo Carvalho de Melo 		else
999b3a3077dSArnaldo Carvalho de Melo 			hcrx->ccid3hcrx_rtt = (hcrx->ccid3hcrx_rtt * 9) / 10 +
1000b3a3077dSArnaldo Carvalho de Melo 					      r_sample / 10;
1001b3a3077dSArnaldo Carvalho de Melo 
100266a377c5SIan McDonald 		if (rtt_prev != hcrx->ccid3hcrx_rtt)
100366a377c5SIan McDonald 			ccid3_pr_debug("%s, New RTT=%uus, elapsed time=%u\n",
10044fded33bSArnaldo Carvalho de Melo 				       dccp_role(sk), hcrx->ccid3hcrx_rtt,
10054fded33bSArnaldo Carvalho de Melo 				       opt_recv->dccpor_elapsed_time);
10067c657876SArnaldo Carvalho de Melo 		break;
10077c657876SArnaldo Carvalho de Melo 	case DCCP_PKT_DATA:
10087c657876SArnaldo Carvalho de Melo 		break;
100959d203f9SArnaldo Carvalho de Melo 	default: /* We're not interested in other packet types, move along */
10107c657876SArnaldo Carvalho de Melo 		return;
10117c657876SArnaldo Carvalho de Melo 	}
10127c657876SArnaldo Carvalho de Melo 
1013b0e56780SArnaldo Carvalho de Melo 	packet = dccp_rx_hist_entry_new(ccid3_rx_hist, sk, opt_recv->dccpor_ndp,
101454e6ecb2SChristoph Lameter 					skb, GFP_ATOMIC);
101559d203f9SArnaldo Carvalho de Melo 	if (unlikely(packet == NULL)) {
101659348b19SGerrit Renker 		DCCP_WARN("%s, sk=%p, Not enough mem to add rx packet "
101759348b19SGerrit Renker 			  "to history, consider it lost!\n", dccp_role(sk), sk);
10187c657876SArnaldo Carvalho de Melo 		return;
10197c657876SArnaldo Carvalho de Melo 	}
10207c657876SArnaldo Carvalho de Melo 
102166a377c5SIan McDonald 	loss = ccid3_hc_rx_detect_loss(sk, packet);
10227c657876SArnaldo Carvalho de Melo 
10237c657876SArnaldo Carvalho de Melo 	if (DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_ACK)
10247c657876SArnaldo Carvalho de Melo 		return;
10257c657876SArnaldo Carvalho de Melo 
102678ad713dSGerrit Renker 	payload_size = skb->len - dccp_hdr(skb)->dccph_doff * 4;
102778ad713dSGerrit Renker 	ccid3_hc_rx_update_s(hcrx, payload_size);
102878ad713dSGerrit Renker 
10297c657876SArnaldo Carvalho de Melo 	switch (hcrx->ccid3hcrx_state) {
10307c657876SArnaldo Carvalho de Melo 	case TFRC_RSTATE_NO_DATA:
10311f2333aeSArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p(%s), skb=%p, sending initial "
10321f2333aeSArnaldo Carvalho de Melo 			       "feedback\n",
10331f2333aeSArnaldo Carvalho de Melo 			       dccp_role(sk), sk,
10341f2333aeSArnaldo Carvalho de Melo 			       dccp_state_name(sk->sk_state), skb);
10357c657876SArnaldo Carvalho de Melo 		ccid3_hc_rx_send_feedback(sk);
10367c657876SArnaldo Carvalho de Melo 		ccid3_hc_rx_set_state(sk, TFRC_RSTATE_DATA);
10377c657876SArnaldo Carvalho de Melo 		return;
10387c657876SArnaldo Carvalho de Melo 	case TFRC_RSTATE_DATA:
103978ad713dSGerrit Renker 		hcrx->ccid3hcrx_bytes_recv += payload_size;
104066a377c5SIan McDonald 		if (loss)
1041b6ee3d4aSArnaldo Carvalho de Melo 			break;
1042b6ee3d4aSArnaldo Carvalho de Melo 
1043b0e56780SArnaldo Carvalho de Melo 		dccp_timestamp(sk, &now);
10440f9e5b57SGerrit Renker 		if (timeval_delta(&now, &hcrx->ccid3hcrx_tstamp_last_ack) -
10450f9e5b57SGerrit Renker 					(suseconds_t)hcrx->ccid3hcrx_rtt >= 0) {
1046b6ee3d4aSArnaldo Carvalho de Melo 			hcrx->ccid3hcrx_tstamp_last_ack = now;
10477c657876SArnaldo Carvalho de Melo 			ccid3_hc_rx_send_feedback(sk);
10487c657876SArnaldo Carvalho de Melo 		}
10497c657876SArnaldo Carvalho de Melo 		return;
105059348b19SGerrit Renker 	case TFRC_RSTATE_TERM:
105159348b19SGerrit Renker 		DCCP_BUG("Illegal %s state TERM, sk=%p", dccp_role(sk), sk);
10527c657876SArnaldo Carvalho de Melo 		return;
10537c657876SArnaldo Carvalho de Melo 	}
10547c657876SArnaldo Carvalho de Melo 
10557c657876SArnaldo Carvalho de Melo 	/* Dealing with packet loss */
10564fded33bSArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p(%s), data loss! Reacting...\n",
10574fded33bSArnaldo Carvalho de Melo 		       dccp_role(sk), sk, dccp_state_name(sk->sk_state));
10587c657876SArnaldo Carvalho de Melo 
10597c657876SArnaldo Carvalho de Melo 	p_prev = hcrx->ccid3hcrx_p;
10607c657876SArnaldo Carvalho de Melo 
10617c657876SArnaldo Carvalho de Melo 	/* Calculate loss event rate */
1062c0996660SIan McDonald 	if (!list_empty(&hcrx->ccid3hcrx_li_hist)) {
1063c0996660SIan McDonald 		u32 i_mean = dccp_li_hist_calc_i_mean(&hcrx->ccid3hcrx_li_hist);
1064c0996660SIan McDonald 
10657c657876SArnaldo Carvalho de Melo 		/* Scaling up by 1000000 as fixed decimal */
1066c0996660SIan McDonald 		if (i_mean != 0)
1067c0996660SIan McDonald 			hcrx->ccid3hcrx_p = 1000000 / i_mean;
106859348b19SGerrit Renker 	} else
106959348b19SGerrit Renker 		DCCP_BUG("empty loss history");
10707c657876SArnaldo Carvalho de Melo 
10717c657876SArnaldo Carvalho de Melo 	if (hcrx->ccid3hcrx_p > p_prev) {
10727c657876SArnaldo Carvalho de Melo 		ccid3_hc_rx_send_feedback(sk);
10737c657876SArnaldo Carvalho de Melo 		return;
10747c657876SArnaldo Carvalho de Melo 	}
10757c657876SArnaldo Carvalho de Melo }
10767c657876SArnaldo Carvalho de Melo 
107791f0ebf7SArnaldo Carvalho de Melo static int ccid3_hc_rx_init(struct ccid *ccid, struct sock *sk)
10787c657876SArnaldo Carvalho de Melo {
107991f0ebf7SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid_priv(ccid);
10807c657876SArnaldo Carvalho de Melo 
10817c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
10827c657876SArnaldo Carvalho de Melo 
10837c657876SArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_state = TFRC_RSTATE_NO_DATA;
10847c657876SArnaldo Carvalho de Melo 	INIT_LIST_HEAD(&hcrx->ccid3hcrx_hist);
1085ae6706f0SArnaldo Carvalho de Melo 	INIT_LIST_HEAD(&hcrx->ccid3hcrx_li_hist);
1086b0e56780SArnaldo Carvalho de Melo 	dccp_timestamp(sk, &hcrx->ccid3hcrx_tstamp_last_ack);
1087954ee31fSArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_tstamp_last_feedback = hcrx->ccid3hcrx_tstamp_last_ack;
108878ad713dSGerrit Renker 	hcrx->ccid3hcrx_s   = 0;
1089fe0499aeSGerrit Renker 	hcrx->ccid3hcrx_rtt = 0;
10907c657876SArnaldo Carvalho de Melo 	return 0;
10917c657876SArnaldo Carvalho de Melo }
10927c657876SArnaldo Carvalho de Melo 
10937c657876SArnaldo Carvalho de Melo static void ccid3_hc_rx_exit(struct sock *sk)
10947c657876SArnaldo Carvalho de Melo {
109559725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
10967c657876SArnaldo Carvalho de Melo 
109759d203f9SArnaldo Carvalho de Melo 	BUG_ON(hcrx == NULL);
10987c657876SArnaldo Carvalho de Melo 
10997c657876SArnaldo Carvalho de Melo 	ccid3_hc_rx_set_state(sk, TFRC_RSTATE_TERM);
11007c657876SArnaldo Carvalho de Melo 
11017c657876SArnaldo Carvalho de Melo 	/* Empty packet history */
11028c60f3faSArnaldo Carvalho de Melo 	dccp_rx_hist_purge(ccid3_rx_hist, &hcrx->ccid3hcrx_hist);
11037c657876SArnaldo Carvalho de Melo 
11047c657876SArnaldo Carvalho de Melo 	/* Empty loss interval history */
1105ae6706f0SArnaldo Carvalho de Melo 	dccp_li_hist_purge(ccid3_li_hist, &hcrx->ccid3hcrx_li_hist);
11067c657876SArnaldo Carvalho de Melo }
11077c657876SArnaldo Carvalho de Melo 
11082babe1f6SArnaldo Carvalho de Melo static void ccid3_hc_rx_get_info(struct sock *sk, struct tcp_info *info)
11092babe1f6SArnaldo Carvalho de Melo {
111059725dc2SArnaldo Carvalho de Melo 	const struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
11112babe1f6SArnaldo Carvalho de Melo 
111259c2353dSArnaldo Carvalho de Melo 	/* Listen socks doesn't have a private CCID block */
111359c2353dSArnaldo Carvalho de Melo 	if (sk->sk_state == DCCP_LISTEN)
111459c2353dSArnaldo Carvalho de Melo 		return;
111559c2353dSArnaldo Carvalho de Melo 
111659d203f9SArnaldo Carvalho de Melo 	BUG_ON(hcrx == NULL);
11172babe1f6SArnaldo Carvalho de Melo 
11182babe1f6SArnaldo Carvalho de Melo 	info->tcpi_ca_state	= hcrx->ccid3hcrx_state;
11192babe1f6SArnaldo Carvalho de Melo 	info->tcpi_options	|= TCPI_OPT_TIMESTAMPS;
11202babe1f6SArnaldo Carvalho de Melo 	info->tcpi_rcv_rtt	= hcrx->ccid3hcrx_rtt;
11212babe1f6SArnaldo Carvalho de Melo }
11222babe1f6SArnaldo Carvalho de Melo 
11232babe1f6SArnaldo Carvalho de Melo static void ccid3_hc_tx_get_info(struct sock *sk, struct tcp_info *info)
11242babe1f6SArnaldo Carvalho de Melo {
112559725dc2SArnaldo Carvalho de Melo 	const struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
11262babe1f6SArnaldo Carvalho de Melo 
112759c2353dSArnaldo Carvalho de Melo 	/* Listen socks doesn't have a private CCID block */
112859c2353dSArnaldo Carvalho de Melo 	if (sk->sk_state == DCCP_LISTEN)
112959c2353dSArnaldo Carvalho de Melo 		return;
113059c2353dSArnaldo Carvalho de Melo 
113159d203f9SArnaldo Carvalho de Melo 	BUG_ON(hctx == NULL);
11322babe1f6SArnaldo Carvalho de Melo 
11332babe1f6SArnaldo Carvalho de Melo 	info->tcpi_rto = hctx->ccid3hctx_t_rto;
11342babe1f6SArnaldo Carvalho de Melo 	info->tcpi_rtt = hctx->ccid3hctx_rtt;
11352babe1f6SArnaldo Carvalho de Melo }
11362babe1f6SArnaldo Carvalho de Melo 
113788f964dbSArnaldo Carvalho de Melo static int ccid3_hc_rx_getsockopt(struct sock *sk, const int optname, int len,
113888f964dbSArnaldo Carvalho de Melo 				  u32 __user *optval, int __user *optlen)
113988f964dbSArnaldo Carvalho de Melo {
114088f964dbSArnaldo Carvalho de Melo 	const struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
114188f964dbSArnaldo Carvalho de Melo 	const void *val;
114288f964dbSArnaldo Carvalho de Melo 
114388f964dbSArnaldo Carvalho de Melo 	/* Listen socks doesn't have a private CCID block */
114488f964dbSArnaldo Carvalho de Melo 	if (sk->sk_state == DCCP_LISTEN)
114588f964dbSArnaldo Carvalho de Melo 		return -EINVAL;
114688f964dbSArnaldo Carvalho de Melo 
114788f964dbSArnaldo Carvalho de Melo 	switch (optname) {
114888f964dbSArnaldo Carvalho de Melo 	case DCCP_SOCKOPT_CCID_RX_INFO:
114988f964dbSArnaldo Carvalho de Melo 		if (len < sizeof(hcrx->ccid3hcrx_tfrc))
115088f964dbSArnaldo Carvalho de Melo 			return -EINVAL;
115188f964dbSArnaldo Carvalho de Melo 		len = sizeof(hcrx->ccid3hcrx_tfrc);
115288f964dbSArnaldo Carvalho de Melo 		val = &hcrx->ccid3hcrx_tfrc;
115388f964dbSArnaldo Carvalho de Melo 		break;
115488f964dbSArnaldo Carvalho de Melo 	default:
115588f964dbSArnaldo Carvalho de Melo 		return -ENOPROTOOPT;
115688f964dbSArnaldo Carvalho de Melo 	}
115788f964dbSArnaldo Carvalho de Melo 
115888f964dbSArnaldo Carvalho de Melo 	if (put_user(len, optlen) || copy_to_user(optval, val, len))
115988f964dbSArnaldo Carvalho de Melo 		return -EFAULT;
116088f964dbSArnaldo Carvalho de Melo 
116188f964dbSArnaldo Carvalho de Melo 	return 0;
116288f964dbSArnaldo Carvalho de Melo }
116388f964dbSArnaldo Carvalho de Melo 
116488f964dbSArnaldo Carvalho de Melo static int ccid3_hc_tx_getsockopt(struct sock *sk, const int optname, int len,
116588f964dbSArnaldo Carvalho de Melo 				  u32 __user *optval, int __user *optlen)
116688f964dbSArnaldo Carvalho de Melo {
116788f964dbSArnaldo Carvalho de Melo 	const struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
116888f964dbSArnaldo Carvalho de Melo 	const void *val;
116988f964dbSArnaldo Carvalho de Melo 
117088f964dbSArnaldo Carvalho de Melo 	/* Listen socks doesn't have a private CCID block */
117188f964dbSArnaldo Carvalho de Melo 	if (sk->sk_state == DCCP_LISTEN)
117288f964dbSArnaldo Carvalho de Melo 		return -EINVAL;
117388f964dbSArnaldo Carvalho de Melo 
117488f964dbSArnaldo Carvalho de Melo 	switch (optname) {
117588f964dbSArnaldo Carvalho de Melo 	case DCCP_SOCKOPT_CCID_TX_INFO:
117688f964dbSArnaldo Carvalho de Melo 		if (len < sizeof(hctx->ccid3hctx_tfrc))
117788f964dbSArnaldo Carvalho de Melo 			return -EINVAL;
117888f964dbSArnaldo Carvalho de Melo 		len = sizeof(hctx->ccid3hctx_tfrc);
117988f964dbSArnaldo Carvalho de Melo 		val = &hctx->ccid3hctx_tfrc;
118088f964dbSArnaldo Carvalho de Melo 		break;
118188f964dbSArnaldo Carvalho de Melo 	default:
118288f964dbSArnaldo Carvalho de Melo 		return -ENOPROTOOPT;
118388f964dbSArnaldo Carvalho de Melo 	}
118488f964dbSArnaldo Carvalho de Melo 
118588f964dbSArnaldo Carvalho de Melo 	if (put_user(len, optlen) || copy_to_user(optval, val, len))
118688f964dbSArnaldo Carvalho de Melo 		return -EFAULT;
118788f964dbSArnaldo Carvalho de Melo 
118888f964dbSArnaldo Carvalho de Melo 	return 0;
118988f964dbSArnaldo Carvalho de Melo }
119088f964dbSArnaldo Carvalho de Melo 
119191f0ebf7SArnaldo Carvalho de Melo static struct ccid_operations ccid3 = {
11923dd9a7c3SIan McDonald 	.ccid_id		   = DCCPC_CCID3,
11937c657876SArnaldo Carvalho de Melo 	.ccid_name		   = "ccid3",
11947c657876SArnaldo Carvalho de Melo 	.ccid_owner		   = THIS_MODULE,
119591f0ebf7SArnaldo Carvalho de Melo 	.ccid_hc_tx_obj_size	   = sizeof(struct ccid3_hc_tx_sock),
11967c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_init	   = ccid3_hc_tx_init,
11977c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_exit	   = ccid3_hc_tx_exit,
11987c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_send_packet	   = ccid3_hc_tx_send_packet,
11997c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_packet_sent	   = ccid3_hc_tx_packet_sent,
12007c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_packet_recv	   = ccid3_hc_tx_packet_recv,
12017c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_parse_options  = ccid3_hc_tx_parse_options,
120291f0ebf7SArnaldo Carvalho de Melo 	.ccid_hc_rx_obj_size	   = sizeof(struct ccid3_hc_rx_sock),
12037c657876SArnaldo Carvalho de Melo 	.ccid_hc_rx_init	   = ccid3_hc_rx_init,
12047c657876SArnaldo Carvalho de Melo 	.ccid_hc_rx_exit	   = ccid3_hc_rx_exit,
12057c657876SArnaldo Carvalho de Melo 	.ccid_hc_rx_insert_options = ccid3_hc_rx_insert_options,
12067c657876SArnaldo Carvalho de Melo 	.ccid_hc_rx_packet_recv	   = ccid3_hc_rx_packet_recv,
12072babe1f6SArnaldo Carvalho de Melo 	.ccid_hc_rx_get_info	   = ccid3_hc_rx_get_info,
12082babe1f6SArnaldo Carvalho de Melo 	.ccid_hc_tx_get_info	   = ccid3_hc_tx_get_info,
120988f964dbSArnaldo Carvalho de Melo 	.ccid_hc_rx_getsockopt	   = ccid3_hc_rx_getsockopt,
121088f964dbSArnaldo Carvalho de Melo 	.ccid_hc_tx_getsockopt	   = ccid3_hc_tx_getsockopt,
12117c657876SArnaldo Carvalho de Melo };
12127c657876SArnaldo Carvalho de Melo 
121356724aa4SGerrit Renker #ifdef CONFIG_IP_DCCP_CCID3_DEBUG
12147c657876SArnaldo Carvalho de Melo module_param(ccid3_debug, int, 0444);
12157c657876SArnaldo Carvalho de Melo MODULE_PARM_DESC(ccid3_debug, "Enable debug messages");
121656724aa4SGerrit Renker #endif
12177c657876SArnaldo Carvalho de Melo 
12187c657876SArnaldo Carvalho de Melo static __init int ccid3_module_init(void)
12197c657876SArnaldo Carvalho de Melo {
12208c60f3faSArnaldo Carvalho de Melo 	int rc = -ENOBUFS;
12217c657876SArnaldo Carvalho de Melo 
12228c60f3faSArnaldo Carvalho de Melo 	ccid3_rx_hist = dccp_rx_hist_new("ccid3");
12238c60f3faSArnaldo Carvalho de Melo 	if (ccid3_rx_hist == NULL)
12247c657876SArnaldo Carvalho de Melo 		goto out;
12257c657876SArnaldo Carvalho de Melo 
12268c60f3faSArnaldo Carvalho de Melo 	ccid3_tx_hist = dccp_tx_hist_new("ccid3");
12278c60f3faSArnaldo Carvalho de Melo 	if (ccid3_tx_hist == NULL)
12288c60f3faSArnaldo Carvalho de Melo 		goto out_free_rx;
12297c657876SArnaldo Carvalho de Melo 
1230ae6706f0SArnaldo Carvalho de Melo 	ccid3_li_hist = dccp_li_hist_new("ccid3");
1231ae6706f0SArnaldo Carvalho de Melo 	if (ccid3_li_hist == NULL)
12328c60f3faSArnaldo Carvalho de Melo 		goto out_free_tx;
12337c657876SArnaldo Carvalho de Melo 
12347c657876SArnaldo Carvalho de Melo 	rc = ccid_register(&ccid3);
12357c657876SArnaldo Carvalho de Melo 	if (rc != 0)
12367c657876SArnaldo Carvalho de Melo 		goto out_free_loss_interval_history;
12377c657876SArnaldo Carvalho de Melo out:
12387c657876SArnaldo Carvalho de Melo 	return rc;
12398c60f3faSArnaldo Carvalho de Melo 
12407c657876SArnaldo Carvalho de Melo out_free_loss_interval_history:
1241ae6706f0SArnaldo Carvalho de Melo 	dccp_li_hist_delete(ccid3_li_hist);
1242ae6706f0SArnaldo Carvalho de Melo 	ccid3_li_hist = NULL;
12438c60f3faSArnaldo Carvalho de Melo out_free_tx:
12448c60f3faSArnaldo Carvalho de Melo 	dccp_tx_hist_delete(ccid3_tx_hist);
12458c60f3faSArnaldo Carvalho de Melo 	ccid3_tx_hist = NULL;
12468c60f3faSArnaldo Carvalho de Melo out_free_rx:
12478c60f3faSArnaldo Carvalho de Melo 	dccp_rx_hist_delete(ccid3_rx_hist);
12488c60f3faSArnaldo Carvalho de Melo 	ccid3_rx_hist = NULL;
12497c657876SArnaldo Carvalho de Melo 	goto out;
12507c657876SArnaldo Carvalho de Melo }
12517c657876SArnaldo Carvalho de Melo module_init(ccid3_module_init);
12527c657876SArnaldo Carvalho de Melo 
12537c657876SArnaldo Carvalho de Melo static __exit void ccid3_module_exit(void)
12547c657876SArnaldo Carvalho de Melo {
12557c657876SArnaldo Carvalho de Melo 	ccid_unregister(&ccid3);
12567c657876SArnaldo Carvalho de Melo 
12578c60f3faSArnaldo Carvalho de Melo 	if (ccid3_tx_hist != NULL) {
12588c60f3faSArnaldo Carvalho de Melo 		dccp_tx_hist_delete(ccid3_tx_hist);
12598c60f3faSArnaldo Carvalho de Melo 		ccid3_tx_hist = NULL;
12607c657876SArnaldo Carvalho de Melo 	}
12618c60f3faSArnaldo Carvalho de Melo 	if (ccid3_rx_hist != NULL) {
12628c60f3faSArnaldo Carvalho de Melo 		dccp_rx_hist_delete(ccid3_rx_hist);
12638c60f3faSArnaldo Carvalho de Melo 		ccid3_rx_hist = NULL;
12647c657876SArnaldo Carvalho de Melo 	}
1265ae6706f0SArnaldo Carvalho de Melo 	if (ccid3_li_hist != NULL) {
1266ae6706f0SArnaldo Carvalho de Melo 		dccp_li_hist_delete(ccid3_li_hist);
1267ae6706f0SArnaldo Carvalho de Melo 		ccid3_li_hist = NULL;
12687c657876SArnaldo Carvalho de Melo 	}
12697c657876SArnaldo Carvalho de Melo }
12707c657876SArnaldo Carvalho de Melo module_exit(ccid3_module_exit);
12717c657876SArnaldo Carvalho de Melo 
1272e6bccd35SIan McDonald MODULE_AUTHOR("Ian McDonald <ian.mcdonald@jandi.co.nz>, "
12731f2333aeSArnaldo Carvalho de Melo 	      "Arnaldo Carvalho de Melo <acme@ghostprotocols.net>");
12747c657876SArnaldo Carvalho de Melo MODULE_DESCRIPTION("DCCP TFRC CCID3 CCID");
12757c657876SArnaldo Carvalho de Melo MODULE_LICENSE("GPL");
12767c657876SArnaldo Carvalho de Melo MODULE_ALIAS("net-dccp-ccid-3");
1277