xref: /openbmc/linux/net/dccp/ccids/ccid3.c (revision b0e56780)
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.
51bc09869SIan McDonald  *  Copyright (c) 2005 Ian McDonald <iam4@cs.waikato.ac.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 
378c60f3faSArnaldo Carvalho de Melo #include <linux/config.h>
387c657876SArnaldo Carvalho de Melo #include "../ccid.h"
397c657876SArnaldo Carvalho de Melo #include "../dccp.h"
404524b259SArnaldo Carvalho de Melo #include "lib/packet_history.h"
41ae6706f0SArnaldo Carvalho de Melo #include "lib/loss_interval.h"
4236729c1aSArnaldo Carvalho de Melo #include "lib/tfrc.h"
437c657876SArnaldo Carvalho de Melo #include "ccid3.h"
447c657876SArnaldo Carvalho de Melo 
456b5e633aSArnaldo Carvalho de Melo /*
460ba7a3baSArnaldo Carvalho de Melo  * Reason for maths here is to avoid 32 bit overflow when a is big.
470ba7a3baSArnaldo Carvalho de Melo  * With this we get close to the limit.
486b5e633aSArnaldo Carvalho de Melo  */
496b5e633aSArnaldo Carvalho de Melo static inline u32 usecs_div(const u32 a, const u32 b)
506b5e633aSArnaldo Carvalho de Melo {
510ba7a3baSArnaldo Carvalho de Melo 	const u32 div = a < (UINT_MAX / (USEC_PER_SEC /    10)) ?    10 :
520ba7a3baSArnaldo Carvalho de Melo 			a < (UINT_MAX / (USEC_PER_SEC /    50)) ?    50 :
530ba7a3baSArnaldo Carvalho de Melo 			a < (UINT_MAX / (USEC_PER_SEC /   100)) ?   100 :
540ba7a3baSArnaldo Carvalho de Melo 			a < (UINT_MAX / (USEC_PER_SEC /   500)) ?   500 :
550ba7a3baSArnaldo Carvalho de Melo 			a < (UINT_MAX / (USEC_PER_SEC /  1000)) ?  1000 :
560ba7a3baSArnaldo Carvalho de Melo 			a < (UINT_MAX / (USEC_PER_SEC /  5000)) ?  5000 :
570ba7a3baSArnaldo Carvalho de Melo 			a < (UINT_MAX / (USEC_PER_SEC / 10000)) ? 10000 :
580ba7a3baSArnaldo Carvalho de Melo 			a < (UINT_MAX / (USEC_PER_SEC / 50000)) ? 50000 :
590ba7a3baSArnaldo Carvalho de Melo 								 100000;
600ba7a3baSArnaldo Carvalho de Melo 	const u32 tmp = a * (USEC_PER_SEC / div);
610ba7a3baSArnaldo Carvalho de Melo 	return (b >= 2 * div) ? tmp / (b / div) : tmp;
626b5e633aSArnaldo Carvalho de Melo }
636b5e633aSArnaldo Carvalho de Melo 
64cfc3c525SArnaldo Carvalho de Melo static int ccid3_debug;
657c657876SArnaldo Carvalho de Melo 
66cfc3c525SArnaldo Carvalho de Melo #ifdef CCID3_DEBUG
677c657876SArnaldo Carvalho de Melo #define ccid3_pr_debug(format, a...) \
687c657876SArnaldo Carvalho de Melo 	do { if (ccid3_debug) \
697c657876SArnaldo Carvalho de Melo 		printk(KERN_DEBUG "%s: " format, __FUNCTION__, ##a); \
707c657876SArnaldo Carvalho de Melo 	} while (0)
717c657876SArnaldo Carvalho de Melo #else
727c657876SArnaldo Carvalho de Melo #define ccid3_pr_debug(format, a...)
737c657876SArnaldo Carvalho de Melo #endif
747c657876SArnaldo Carvalho de Melo 
75a1d3a355SArnaldo Carvalho de Melo static struct dccp_tx_hist *ccid3_tx_hist;
76a1d3a355SArnaldo Carvalho de Melo static struct dccp_rx_hist *ccid3_rx_hist;
77ae6706f0SArnaldo Carvalho de Melo static struct dccp_li_hist *ccid3_li_hist;
787c657876SArnaldo Carvalho de Melo 
797c657876SArnaldo Carvalho de Melo static int ccid3_init(struct sock *sk)
807c657876SArnaldo Carvalho de Melo {
817c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
827c657876SArnaldo Carvalho de Melo 	return 0;
837c657876SArnaldo Carvalho de Melo }
847c657876SArnaldo Carvalho de Melo 
857c657876SArnaldo Carvalho de Melo static void ccid3_exit(struct sock *sk)
867c657876SArnaldo Carvalho de Melo {
877c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
887c657876SArnaldo Carvalho de Melo }
897c657876SArnaldo Carvalho de Melo 
907c657876SArnaldo Carvalho de Melo /* TFRC sender states */
917c657876SArnaldo Carvalho de Melo enum ccid3_hc_tx_states {
927c657876SArnaldo Carvalho de Melo        	TFRC_SSTATE_NO_SENT = 1,
937c657876SArnaldo Carvalho de Melo 	TFRC_SSTATE_NO_FBACK,
947c657876SArnaldo Carvalho de Melo 	TFRC_SSTATE_FBACK,
957c657876SArnaldo Carvalho de Melo 	TFRC_SSTATE_TERM,
967c657876SArnaldo Carvalho de Melo };
977c657876SArnaldo Carvalho de Melo 
987c657876SArnaldo Carvalho de Melo #ifdef CCID3_DEBUG
997c657876SArnaldo Carvalho de Melo static const char *ccid3_tx_state_name(enum ccid3_hc_tx_states state)
1007c657876SArnaldo Carvalho de Melo {
1017c657876SArnaldo Carvalho de Melo 	static char *ccid3_state_names[] = {
1027c657876SArnaldo Carvalho de Melo 	[TFRC_SSTATE_NO_SENT]  = "NO_SENT",
1037c657876SArnaldo Carvalho de Melo 	[TFRC_SSTATE_NO_FBACK] = "NO_FBACK",
1047c657876SArnaldo Carvalho de Melo 	[TFRC_SSTATE_FBACK]    = "FBACK",
1057c657876SArnaldo Carvalho de Melo 	[TFRC_SSTATE_TERM]     = "TERM",
1067c657876SArnaldo Carvalho de Melo 	};
1077c657876SArnaldo Carvalho de Melo 
1087c657876SArnaldo Carvalho de Melo 	return ccid3_state_names[state];
1097c657876SArnaldo Carvalho de Melo }
1107c657876SArnaldo Carvalho de Melo #endif
1117c657876SArnaldo Carvalho de Melo 
1121f2333aeSArnaldo Carvalho de Melo static inline void ccid3_hc_tx_set_state(struct sock *sk,
1131f2333aeSArnaldo Carvalho de Melo 					 enum ccid3_hc_tx_states state)
1147c657876SArnaldo Carvalho de Melo {
1157c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
1167c657876SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = dp->dccps_hc_tx_ccid_private;
1177c657876SArnaldo Carvalho de Melo 	enum ccid3_hc_tx_states oldstate = hctx->ccid3hctx_state;
1187c657876SArnaldo Carvalho de Melo 
1197c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s(%p) %-8.8s -> %s\n",
1201f2333aeSArnaldo Carvalho de Melo 		       dccp_role(sk), sk, ccid3_tx_state_name(oldstate),
1211f2333aeSArnaldo Carvalho de Melo 		       ccid3_tx_state_name(state));
1227c657876SArnaldo Carvalho de Melo 	WARN_ON(state == oldstate);
1237c657876SArnaldo Carvalho de Melo 	hctx->ccid3hctx_state = state;
1247c657876SArnaldo Carvalho de Melo }
1257c657876SArnaldo Carvalho de Melo 
1267c657876SArnaldo Carvalho de Melo /* Calculate new t_ipi (inter packet interval) by t_ipi = s / X_inst */
1277c657876SArnaldo Carvalho de Melo static inline void ccid3_calc_new_t_ipi(struct ccid3_hc_tx_sock *hctx)
1287c657876SArnaldo Carvalho de Melo {
1296b5e633aSArnaldo Carvalho de Melo 	/*
1306b5e633aSArnaldo Carvalho de Melo 	 * If no feedback spec says t_ipi is 1 second (set elsewhere and then
1316b5e633aSArnaldo Carvalho de Melo 	 * doubles after every no feedback timer (separate function)
1326b5e633aSArnaldo Carvalho de Melo 	 */
1336b5e633aSArnaldo Carvalho de Melo 	if (hctx->ccid3hctx_state != TFRC_SSTATE_NO_FBACK)
1346b5e633aSArnaldo Carvalho de Melo 		hctx->ccid3hctx_t_ipi = usecs_div(hctx->ccid3hctx_s,
1356b5e633aSArnaldo Carvalho de Melo 						  hctx->ccid3hctx_x);
1367c657876SArnaldo Carvalho de Melo }
1377c657876SArnaldo Carvalho de Melo 
1387c657876SArnaldo Carvalho de Melo /* Calculate new delta by delta = min(t_ipi / 2, t_gran / 2) */
1397c657876SArnaldo Carvalho de Melo static inline void ccid3_calc_new_delta(struct ccid3_hc_tx_sock *hctx)
1407c657876SArnaldo Carvalho de Melo {
1411f2333aeSArnaldo Carvalho de Melo 	hctx->ccid3hctx_delta = min_t(u32, hctx->ccid3hctx_t_ipi / 2,
1421f2333aeSArnaldo Carvalho de Melo 					   TFRC_OPSYS_HALF_TIME_GRAN);
1437c657876SArnaldo Carvalho de Melo }
1447c657876SArnaldo Carvalho de Melo 
1457c657876SArnaldo Carvalho de Melo /*
1467c657876SArnaldo Carvalho de Melo  * Update X by
1477c657876SArnaldo Carvalho de Melo  *    If (p > 0)
1487c657876SArnaldo Carvalho de Melo  *       x_calc = calcX(s, R, p);
1497c657876SArnaldo Carvalho de Melo  *       X = max(min(X_calc, 2 * X_recv), s / t_mbi);
1507c657876SArnaldo Carvalho de Melo  *    Else
1517c657876SArnaldo Carvalho de Melo  *       If (now - tld >= R)
1527c657876SArnaldo Carvalho de Melo  *          X = max(min(2 * X, 2 * X_recv), s / R);
1537c657876SArnaldo Carvalho de Melo  *          tld = now;
1547c657876SArnaldo Carvalho de Melo  */
1557c657876SArnaldo Carvalho de Melo static void ccid3_hc_tx_update_x(struct sock *sk)
1567c657876SArnaldo Carvalho de Melo {
1577c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
1587c657876SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = dp->dccps_hc_tx_ccid_private;
1597c657876SArnaldo Carvalho de Melo 
1601f2333aeSArnaldo Carvalho de Melo 	/* To avoid large error in calcX */
1611f2333aeSArnaldo Carvalho de Melo 	if (hctx->ccid3hctx_p >= TFRC_SMALLEST_P) {
16236729c1aSArnaldo Carvalho de Melo 		hctx->ccid3hctx_x_calc = tfrc_calc_x(hctx->ccid3hctx_s,
1637c657876SArnaldo Carvalho de Melo 						     hctx->ccid3hctx_rtt,
1647c657876SArnaldo Carvalho de Melo 						     hctx->ccid3hctx_p);
1651f2333aeSArnaldo Carvalho de Melo 		hctx->ccid3hctx_x = max_t(u32, min_t(u32, hctx->ccid3hctx_x_calc,
1661f2333aeSArnaldo Carvalho de Melo 							  2 * hctx->ccid3hctx_x_recv),
1671f2333aeSArnaldo Carvalho de Melo 					       (hctx->ccid3hctx_s /
1681f2333aeSArnaldo Carvalho de Melo 					        TFRC_MAX_BACK_OFF_TIME));
169b6ee3d4aSArnaldo Carvalho de Melo 	} else {
170b6ee3d4aSArnaldo Carvalho de Melo 		struct timeval now;
171b6ee3d4aSArnaldo Carvalho de Melo 
172b0e56780SArnaldo Carvalho de Melo 		dccp_timestamp(sk, &now);
173b6ee3d4aSArnaldo Carvalho de Melo 	       	if (timeval_delta(&now, &hctx->ccid3hctx_t_ld) >=
174b6ee3d4aSArnaldo Carvalho de Melo 		    hctx->ccid3hctx_rtt) {
1756b5e633aSArnaldo Carvalho de Melo 			hctx->ccid3hctx_x = max_t(u32, min_t(u32, hctx->ccid3hctx_x_recv,
1766b5e633aSArnaldo Carvalho de Melo 								  hctx->ccid3hctx_x) * 2,
1776b5e633aSArnaldo Carvalho de Melo 						       usecs_div(hctx->ccid3hctx_s,
1786b5e633aSArnaldo Carvalho de Melo 							       	 hctx->ccid3hctx_rtt));
179b6ee3d4aSArnaldo Carvalho de Melo 			hctx->ccid3hctx_t_ld = now;
180b6ee3d4aSArnaldo Carvalho de Melo 		}
1817c657876SArnaldo Carvalho de Melo 	}
1827c657876SArnaldo Carvalho de Melo }
1837c657876SArnaldo Carvalho de Melo 
1847c657876SArnaldo Carvalho de Melo static void ccid3_hc_tx_no_feedback_timer(unsigned long data)
1857c657876SArnaldo Carvalho de Melo {
1867c657876SArnaldo Carvalho de Melo 	struct sock *sk = (struct sock *)data;
1877c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
1887c657876SArnaldo Carvalho de Melo 	unsigned long next_tmout = 0;
1897c657876SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = dp->dccps_hc_tx_ccid_private;
1907c657876SArnaldo Carvalho de Melo 
1917c657876SArnaldo Carvalho de Melo 	bh_lock_sock(sk);
1927c657876SArnaldo Carvalho de Melo 	if (sock_owned_by_user(sk)) {
1937c657876SArnaldo Carvalho de Melo 		/* Try again later. */
1947c657876SArnaldo Carvalho de Melo 		/* XXX: set some sensible MIB */
1951f2333aeSArnaldo Carvalho de Melo 		sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
1961f2333aeSArnaldo Carvalho de Melo 			       jiffies + HZ / 5);
1977c657876SArnaldo Carvalho de Melo 		goto out;
1987c657876SArnaldo Carvalho de Melo 	}
1997c657876SArnaldo Carvalho de Melo 
2007c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p, state=%s\n", dccp_role(sk), sk,
2017c657876SArnaldo Carvalho de Melo 		       ccid3_tx_state_name(hctx->ccid3hctx_state));
2027c657876SArnaldo Carvalho de Melo 
2037c657876SArnaldo Carvalho de Melo 	switch (hctx->ccid3hctx_state) {
2047c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_TERM:
2057c657876SArnaldo Carvalho de Melo 		goto out;
2067c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_FBACK:
2077c657876SArnaldo Carvalho de Melo 		/* Halve send rate */
2087c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_x /= 2;
2096b5e633aSArnaldo Carvalho de Melo 		if (hctx->ccid3hctx_x < (hctx->ccid3hctx_s /
2106b5e633aSArnaldo Carvalho de Melo 					 TFRC_MAX_BACK_OFF_TIME))
2111f2333aeSArnaldo Carvalho de Melo 			hctx->ccid3hctx_x = (hctx->ccid3hctx_s /
2121f2333aeSArnaldo Carvalho de Melo 					     TFRC_MAX_BACK_OFF_TIME);
2137c657876SArnaldo Carvalho de Melo 
2141f2333aeSArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p, state=%s, updated tx rate to %d "
2151f2333aeSArnaldo Carvalho de Melo 			       "bytes/s\n",
2161f2333aeSArnaldo Carvalho de Melo 			       dccp_role(sk), sk,
2171f2333aeSArnaldo Carvalho de Melo 			       ccid3_tx_state_name(hctx->ccid3hctx_state),
2187c657876SArnaldo Carvalho de Melo 			       hctx->ccid3hctx_x);
2196b5e633aSArnaldo Carvalho de Melo 		next_tmout = max_t(u32, 2 * usecs_div(hctx->ccid3hctx_s,
2206b5e633aSArnaldo Carvalho de Melo 						      hctx->ccid3hctx_x),
2211f2333aeSArnaldo Carvalho de Melo 					TFRC_INITIAL_TIMEOUT);
2221f2333aeSArnaldo Carvalho de Melo 		/*
2231f2333aeSArnaldo Carvalho de Melo 		 * FIXME - not sure above calculation is correct. See section
2241f2333aeSArnaldo Carvalho de Melo 		 * 5 of CCID3 11 should adjust tx_t_ipi and double that to
2251f2333aeSArnaldo Carvalho de Melo 		 * achieve it really
2261f2333aeSArnaldo Carvalho de Melo 		 */
2277c657876SArnaldo Carvalho de Melo 		break;
2287c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_FBACK:
2291f2333aeSArnaldo Carvalho de Melo 		/*
2301f2333aeSArnaldo Carvalho de Melo 		 * Check if IDLE since last timeout and recv rate is less than
2311f2333aeSArnaldo Carvalho de Melo 		 * 4 packets per RTT
2321f2333aeSArnaldo Carvalho de Melo 		 */
2331f2333aeSArnaldo Carvalho de Melo 		if (!hctx->ccid3hctx_idle ||
2346b5e633aSArnaldo Carvalho de Melo 		    (hctx->ccid3hctx_x_recv >=
2356b5e633aSArnaldo Carvalho de Melo 		     4 * usecs_div(hctx->ccid3hctx_s, hctx->ccid3hctx_rtt))) {
2361f2333aeSArnaldo Carvalho de Melo 			ccid3_pr_debug("%s, sk=%p, state=%s, not idle\n",
2371f2333aeSArnaldo Carvalho de Melo 				       dccp_role(sk), sk,
2387c657876SArnaldo Carvalho de Melo 				       ccid3_tx_state_name(hctx->ccid3hctx_state));
2397c657876SArnaldo Carvalho de Melo 			/* Halve sending rate */
2407c657876SArnaldo Carvalho de Melo 
2417c657876SArnaldo Carvalho de Melo 			/*  If (X_calc > 2 * X_recv)
2427c657876SArnaldo Carvalho de Melo 			 *    X_recv = max(X_recv / 2, s / (2 * t_mbi));
2437c657876SArnaldo Carvalho de Melo 			 *  Else
2447c657876SArnaldo Carvalho de Melo 			 *    X_recv = X_calc / 4;
2457c657876SArnaldo Carvalho de Melo 			 */
2461f2333aeSArnaldo Carvalho de Melo 			BUG_ON(hctx->ccid3hctx_p >= TFRC_SMALLEST_P &&
2471f2333aeSArnaldo Carvalho de Melo 			       hctx->ccid3hctx_x_calc == 0);
2487c657876SArnaldo Carvalho de Melo 
2497c657876SArnaldo Carvalho de Melo 			/* check also if p is zero -> x_calc is infinity? */
2507c657876SArnaldo Carvalho de Melo 			if (hctx->ccid3hctx_p < TFRC_SMALLEST_P ||
2517c657876SArnaldo Carvalho de Melo 			    hctx->ccid3hctx_x_calc > 2 * hctx->ccid3hctx_x_recv)
2527c657876SArnaldo Carvalho de Melo 				hctx->ccid3hctx_x_recv = max_t(u32, hctx->ccid3hctx_x_recv / 2,
2537c657876SArnaldo Carvalho de Melo 								    hctx->ccid3hctx_s / (2 * TFRC_MAX_BACK_OFF_TIME));
2547c657876SArnaldo Carvalho de Melo 			else
2557c657876SArnaldo Carvalho de Melo 				hctx->ccid3hctx_x_recv = hctx->ccid3hctx_x_calc / 4;
2567c657876SArnaldo Carvalho de Melo 
2577c657876SArnaldo Carvalho de Melo 			/* Update sending rate */
2587c657876SArnaldo Carvalho de Melo 			ccid3_hc_tx_update_x(sk);
2597c657876SArnaldo Carvalho de Melo 		}
2606b5e633aSArnaldo Carvalho de Melo 		/*
2616b5e633aSArnaldo Carvalho de Melo 		 * Schedule no feedback timer to expire in
2626b5e633aSArnaldo Carvalho de Melo 		 * max(4 * R, 2 * s / X)
2636b5e633aSArnaldo Carvalho de Melo 		 */
264c68e64cfSArnaldo Carvalho de Melo 		next_tmout = max_t(u32, hctx->ccid3hctx_t_rto,
2656b5e633aSArnaldo Carvalho de Melo 					2 * usecs_div(hctx->ccid3hctx_s,
2666b5e633aSArnaldo Carvalho de Melo 						      hctx->ccid3hctx_x));
2677c657876SArnaldo Carvalho de Melo 		break;
2687c657876SArnaldo Carvalho de Melo 	default:
2697c657876SArnaldo Carvalho de Melo 		printk(KERN_CRIT "%s: %s, sk=%p, Illegal state (%d)!\n",
2707c657876SArnaldo Carvalho de Melo 		       __FUNCTION__, dccp_role(sk), sk, hctx->ccid3hctx_state);
2717c657876SArnaldo Carvalho de Melo 		dump_stack();
2727c657876SArnaldo Carvalho de Melo 		goto out;
2737c657876SArnaldo Carvalho de Melo 	}
2747c657876SArnaldo Carvalho de Melo 
2757c657876SArnaldo Carvalho de Melo 	sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
2767c657876SArnaldo Carvalho de Melo 		      jiffies + max_t(u32, 1, usecs_to_jiffies(next_tmout)));
2777c657876SArnaldo Carvalho de Melo 	hctx->ccid3hctx_idle = 1;
2787c657876SArnaldo Carvalho de Melo out:
2797c657876SArnaldo Carvalho de Melo 	bh_unlock_sock(sk);
2807c657876SArnaldo Carvalho de Melo 	sock_put(sk);
2817c657876SArnaldo Carvalho de Melo }
2827c657876SArnaldo Carvalho de Melo 
28327258ee5SArnaldo Carvalho de Melo static int ccid3_hc_tx_send_packet(struct sock *sk,
28427258ee5SArnaldo Carvalho de Melo 				   struct sk_buff *skb, int len)
2857c657876SArnaldo Carvalho de Melo {
2867c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
2877c657876SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = dp->dccps_hc_tx_ccid_private;
2888c60f3faSArnaldo Carvalho de Melo 	struct dccp_tx_hist_entry *new_packet;
2897c657876SArnaldo Carvalho de Melo 	struct timeval now;
29027258ee5SArnaldo Carvalho de Melo 	long delay;
2917c657876SArnaldo Carvalho de Melo 	int rc = -ENOTCONN;
2927c657876SArnaldo Carvalho de Melo 
2931f2333aeSArnaldo Carvalho de Melo 	/* Check if pure ACK or Terminating*/
2941f2333aeSArnaldo Carvalho de Melo 
2957c657876SArnaldo Carvalho de Melo 	/*
2961f2333aeSArnaldo Carvalho de Melo 	 * XXX: We only call this function for DATA and DATAACK, on, these
2971f2333aeSArnaldo Carvalho de Melo 	 * packets can have zero length, but why the comment about "pure ACK"?
2987c657876SArnaldo Carvalho de Melo 	 */
2991f2333aeSArnaldo Carvalho de Melo 	if (hctx == NULL || len == 0 ||
3001f2333aeSArnaldo Carvalho de Melo 	    hctx->ccid3hctx_state == TFRC_SSTATE_TERM)
3017c657876SArnaldo Carvalho de Melo 		goto out;
3027c657876SArnaldo Carvalho de Melo 
3037c657876SArnaldo Carvalho de Melo 	/* See if last packet allocated was not sent */
3048c60f3faSArnaldo Carvalho de Melo 	new_packet = dccp_tx_hist_head(&hctx->ccid3hctx_hist);
3058c60f3faSArnaldo Carvalho de Melo 	if (new_packet == NULL || new_packet->dccphtx_sent) {
3061f2333aeSArnaldo Carvalho de Melo 		new_packet = dccp_tx_hist_entry_new(ccid3_tx_hist,
3071f2333aeSArnaldo Carvalho de Melo 						    SLAB_ATOMIC);
3087c657876SArnaldo Carvalho de Melo 
3097c657876SArnaldo Carvalho de Melo 		rc = -ENOBUFS;
3107c657876SArnaldo Carvalho de Melo 		if (new_packet == NULL) {
3117c657876SArnaldo Carvalho de Melo 			ccid3_pr_debug("%s, sk=%p, not enough mem to add "
3121f2333aeSArnaldo Carvalho de Melo 				       "to history, send refused\n",
3131f2333aeSArnaldo Carvalho de Melo 				       dccp_role(sk), sk);
3147c657876SArnaldo Carvalho de Melo 			goto out;
3157c657876SArnaldo Carvalho de Melo 		}
3167c657876SArnaldo Carvalho de Melo 
3178c60f3faSArnaldo Carvalho de Melo 		dccp_tx_hist_add_entry(&hctx->ccid3hctx_hist, new_packet);
3187c657876SArnaldo Carvalho de Melo 	}
3197c657876SArnaldo Carvalho de Melo 
320b0e56780SArnaldo Carvalho de Melo 	dccp_timestamp(sk, &now);
3217c657876SArnaldo Carvalho de Melo 
3227c657876SArnaldo Carvalho de Melo 	switch (hctx->ccid3hctx_state) {
3237c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_SENT:
3241f2333aeSArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p, first packet(%llu)\n",
3251f2333aeSArnaldo Carvalho de Melo 			       dccp_role(sk), sk, dp->dccps_gss);
3267c657876SArnaldo Carvalho de Melo 
3277c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_no_feedback_timer.function = ccid3_hc_tx_no_feedback_timer;
3287c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_no_feedback_timer.data     = (unsigned long)sk;
3291f2333aeSArnaldo Carvalho de Melo 		sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
3301f2333aeSArnaldo Carvalho de Melo 			       jiffies + usecs_to_jiffies(TFRC_INITIAL_TIMEOUT));
3317c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_last_win_count	 = 0;
3327c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_t_last_win_count = now;
3337c657876SArnaldo Carvalho de Melo 		ccid3_hc_tx_set_state(sk, TFRC_SSTATE_NO_FBACK);
3347c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_t_ipi = TFRC_INITIAL_TIMEOUT;
3357c657876SArnaldo Carvalho de Melo 
3367c657876SArnaldo Carvalho de Melo 		/* Set nominal send time for initial packet */
3377c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_t_nom = now;
338b6ee3d4aSArnaldo Carvalho de Melo 		timeval_add_usecs(&hctx->ccid3hctx_t_nom,
339b6ee3d4aSArnaldo Carvalho de Melo 				  hctx->ccid3hctx_t_ipi);
3407c657876SArnaldo Carvalho de Melo 		ccid3_calc_new_delta(hctx);
3417c657876SArnaldo Carvalho de Melo 		rc = 0;
3427c657876SArnaldo Carvalho de Melo 		break;
3437c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_FBACK:
3447c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_FBACK:
345b6ee3d4aSArnaldo Carvalho de Melo 		delay = (timeval_delta(&now, &hctx->ccid3hctx_t_nom) -
346b6ee3d4aSArnaldo Carvalho de Melo 		         hctx->ccid3hctx_delta);
34727258ee5SArnaldo Carvalho de Melo 		ccid3_pr_debug("send_packet delay=%ld\n", delay);
34827258ee5SArnaldo Carvalho de Melo 		delay /= -1000;
3497c657876SArnaldo Carvalho de Melo 		/* divide by -1000 is to convert to ms and get sign right */
350d6809c12SArnaldo Carvalho de Melo 		rc = delay > 0 ? delay : 0;
3517c657876SArnaldo Carvalho de Melo 		break;
3527c657876SArnaldo Carvalho de Melo 	default:
3537c657876SArnaldo Carvalho de Melo 		printk(KERN_CRIT "%s: %s, sk=%p, Illegal state (%d)!\n",
3547c657876SArnaldo Carvalho de Melo 		       __FUNCTION__, dccp_role(sk), sk, hctx->ccid3hctx_state);
3557c657876SArnaldo Carvalho de Melo 		dump_stack();
3567c657876SArnaldo Carvalho de Melo 		rc = -EINVAL;
3577c657876SArnaldo Carvalho de Melo 		break;
3587c657876SArnaldo Carvalho de Melo 	}
3597c657876SArnaldo Carvalho de Melo 
3607c657876SArnaldo Carvalho de Melo 	/* Can we send? if so add options and add to packet history */
361507d37cfSArnaldo Carvalho de Melo 	if (rc == 0) {
362507d37cfSArnaldo Carvalho de Melo 		dp->dccps_hc_tx_insert_options = 1;
363c1734376SArnaldo Carvalho de Melo 		new_packet->dccphtx_ccval =
3648c60f3faSArnaldo Carvalho de Melo 			DCCP_SKB_CB(skb)->dccpd_ccval =
3658c60f3faSArnaldo Carvalho de Melo 				hctx->ccid3hctx_last_win_count;
366507d37cfSArnaldo Carvalho de Melo 	}
3677c657876SArnaldo Carvalho de Melo out:
3687c657876SArnaldo Carvalho de Melo 	return rc;
3697c657876SArnaldo Carvalho de Melo }
3707c657876SArnaldo Carvalho de Melo 
3717c657876SArnaldo Carvalho de Melo static void ccid3_hc_tx_packet_sent(struct sock *sk, int more, int len)
3727c657876SArnaldo Carvalho de Melo {
3737c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
3747c657876SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = dp->dccps_hc_tx_ccid_private;
3757c657876SArnaldo Carvalho de Melo 	struct timeval now;
3767c657876SArnaldo Carvalho de Melo 
3777c657876SArnaldo Carvalho de Melo 	BUG_ON(hctx == NULL);
3787c657876SArnaldo Carvalho de Melo 
3797c657876SArnaldo Carvalho de Melo 	if (hctx->ccid3hctx_state == TFRC_SSTATE_TERM) {
3807c657876SArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p, while state is TFRC_SSTATE_TERM!\n",
3817c657876SArnaldo Carvalho de Melo 			       dccp_role(sk), sk);
3827c657876SArnaldo Carvalho de Melo 		return;
3837c657876SArnaldo Carvalho de Melo 	}
3847c657876SArnaldo Carvalho de Melo 
385b0e56780SArnaldo Carvalho de Melo 	dccp_timestamp(sk, &now);
3867c657876SArnaldo Carvalho de Melo 
3877c657876SArnaldo Carvalho de Melo 	/* check if we have sent a data packet */
3887c657876SArnaldo Carvalho de Melo 	if (len > 0) {
3897c657876SArnaldo Carvalho de Melo 		unsigned long quarter_rtt;
3908c60f3faSArnaldo Carvalho de Melo 		struct dccp_tx_hist_entry *packet;
3917c657876SArnaldo Carvalho de Melo 
3928c60f3faSArnaldo Carvalho de Melo 		packet = dccp_tx_hist_head(&hctx->ccid3hctx_hist);
3938c60f3faSArnaldo Carvalho de Melo 		if (packet == NULL) {
3941f2333aeSArnaldo Carvalho de Melo 			printk(KERN_CRIT "%s: packet doesn't exists in "
3951f2333aeSArnaldo Carvalho de Melo 					 "history!\n", __FUNCTION__);
3967c657876SArnaldo Carvalho de Melo 			return;
3977c657876SArnaldo Carvalho de Melo 		}
3988c60f3faSArnaldo Carvalho de Melo 		if (packet->dccphtx_sent) {
3991f2333aeSArnaldo Carvalho de Melo 			printk(KERN_CRIT "%s: no unsent packet in history!\n",
4001f2333aeSArnaldo Carvalho de Melo 			       __FUNCTION__);
4017c657876SArnaldo Carvalho de Melo 			return;
4027c657876SArnaldo Carvalho de Melo 		}
4038c60f3faSArnaldo Carvalho de Melo 		packet->dccphtx_tstamp = now;
4048c60f3faSArnaldo Carvalho de Melo 		packet->dccphtx_seqno  = dp->dccps_gss;
4057c657876SArnaldo Carvalho de Melo 		/*
4061f2333aeSArnaldo Carvalho de Melo 		 * Check if win_count have changed
4071f2333aeSArnaldo Carvalho de Melo 		 * Algorithm in "8.1. Window Counter Valuer" in
4081f2333aeSArnaldo Carvalho de Melo 		 * draft-ietf-dccp-ccid3-11.txt
4097c657876SArnaldo Carvalho de Melo 		 */
4106b5e633aSArnaldo Carvalho de Melo 		quarter_rtt = timeval_delta(&now, &hctx->ccid3hctx_t_last_win_count);
4116b5e633aSArnaldo Carvalho de Melo 		if (likely(hctx->ccid3hctx_rtt > 8))
4126b5e633aSArnaldo Carvalho de Melo 			quarter_rtt /= hctx->ccid3hctx_rtt / 4;
4136b5e633aSArnaldo Carvalho de Melo 
4147c657876SArnaldo Carvalho de Melo 		if (quarter_rtt > 0) {
4157c657876SArnaldo Carvalho de Melo 			hctx->ccid3hctx_t_last_win_count = now;
4167c657876SArnaldo Carvalho de Melo 			hctx->ccid3hctx_last_win_count	 = (hctx->ccid3hctx_last_win_count +
4177c657876SArnaldo Carvalho de Melo 							    min_t(unsigned long, quarter_rtt, 5)) % 16;
4181f2333aeSArnaldo Carvalho de Melo 			ccid3_pr_debug("%s, sk=%p, window changed from "
4191f2333aeSArnaldo Carvalho de Melo 				       "%u to %u!\n",
4207c657876SArnaldo Carvalho de Melo 				       dccp_role(sk), sk,
421c1734376SArnaldo Carvalho de Melo 				       packet->dccphtx_ccval,
4227c657876SArnaldo Carvalho de Melo 				       hctx->ccid3hctx_last_win_count);
4237c657876SArnaldo Carvalho de Melo 		}
4241f2333aeSArnaldo Carvalho de Melo 
4257c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_idle = 0;
426c1734376SArnaldo Carvalho de Melo 		packet->dccphtx_rtt  = hctx->ccid3hctx_rtt;
4278c60f3faSArnaldo Carvalho de Melo 		packet->dccphtx_sent = 1;
4287c657876SArnaldo Carvalho de Melo 	} else
4297c657876SArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p, seqno=%llu NOT inserted!\n",
4307c657876SArnaldo Carvalho de Melo 			       dccp_role(sk), sk, dp->dccps_gss);
4317c657876SArnaldo Carvalho de Melo 
4327c657876SArnaldo Carvalho de Melo 	switch (hctx->ccid3hctx_state) {
4337c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_SENT:
4347c657876SArnaldo Carvalho de Melo 		/* if first wasn't pure ack */
4357c657876SArnaldo Carvalho de Melo 		if (len != 0)
4361f2333aeSArnaldo Carvalho de Melo 			printk(KERN_CRIT "%s: %s, First packet sent is noted "
4371f2333aeSArnaldo Carvalho de Melo 					 "as a data packet\n",
4387c657876SArnaldo Carvalho de Melo 			       __FUNCTION__, dccp_role(sk));
4397c657876SArnaldo Carvalho de Melo 		return;
4407c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_FBACK:
4417c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_FBACK:
4427c657876SArnaldo Carvalho de Melo 		if (len > 0) {
4437c657876SArnaldo Carvalho de Melo 			hctx->ccid3hctx_t_nom = now;
4447c657876SArnaldo Carvalho de Melo 			ccid3_calc_new_t_ipi(hctx);
4457c657876SArnaldo Carvalho de Melo 			ccid3_calc_new_delta(hctx);
446b6ee3d4aSArnaldo Carvalho de Melo 			timeval_add_usecs(&hctx->ccid3hctx_t_nom,
447b6ee3d4aSArnaldo Carvalho de Melo 					  hctx->ccid3hctx_t_ipi);
4487c657876SArnaldo Carvalho de Melo 		}
4497c657876SArnaldo Carvalho de Melo 		break;
4507c657876SArnaldo Carvalho de Melo 	default:
4517c657876SArnaldo Carvalho de Melo 		printk(KERN_CRIT "%s: %s, sk=%p, Illegal state (%d)!\n",
4527c657876SArnaldo Carvalho de Melo 		       __FUNCTION__, dccp_role(sk), sk, hctx->ccid3hctx_state);
4537c657876SArnaldo Carvalho de Melo 		dump_stack();
4547c657876SArnaldo Carvalho de Melo 		break;
4557c657876SArnaldo Carvalho de Melo 	}
4567c657876SArnaldo Carvalho de Melo }
4577c657876SArnaldo Carvalho de Melo 
4587c657876SArnaldo Carvalho de Melo static void ccid3_hc_tx_packet_recv(struct sock *sk, struct sk_buff *skb)
4597c657876SArnaldo Carvalho de Melo {
4607c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
4617c657876SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = dp->dccps_hc_tx_ccid_private;
4627c657876SArnaldo Carvalho de Melo 	struct ccid3_options_received *opt_recv;
4638c60f3faSArnaldo Carvalho de Melo 	struct dccp_tx_hist_entry *packet;
464b0e56780SArnaldo Carvalho de Melo 	struct timeval now;
4657c657876SArnaldo Carvalho de Melo 	unsigned long next_tmout;
4661bc09869SIan McDonald 	u32 t_elapsed;
4677c657876SArnaldo Carvalho de Melo 	u32 pinv;
4687c657876SArnaldo Carvalho de Melo 	u32 x_recv;
4697c657876SArnaldo Carvalho de Melo 	u32 r_sample;
4701f2333aeSArnaldo Carvalho de Melo 
4717c657876SArnaldo Carvalho de Melo 	if (hctx == NULL)
4727c657876SArnaldo Carvalho de Melo 		return;
4737c657876SArnaldo Carvalho de Melo 
4747c657876SArnaldo Carvalho de Melo 	if (hctx->ccid3hctx_state == TFRC_SSTATE_TERM) {
4751f2333aeSArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p, received a packet when "
4761f2333aeSArnaldo Carvalho de Melo 			       "terminating!\n", dccp_role(sk), sk);
4777c657876SArnaldo Carvalho de Melo 		return;
4787c657876SArnaldo Carvalho de Melo 	}
4797c657876SArnaldo Carvalho de Melo 
4807c657876SArnaldo Carvalho de Melo 	/* we are only interested in ACKs */
4817c657876SArnaldo Carvalho de Melo 	if (!(DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_ACK ||
4827c657876SArnaldo Carvalho de Melo 	      DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_DATAACK))
4837c657876SArnaldo Carvalho de Melo 		return;
4847c657876SArnaldo Carvalho de Melo 
4857c657876SArnaldo Carvalho de Melo 	opt_recv = &hctx->ccid3hctx_options_received;
4867c657876SArnaldo Carvalho de Melo 
4871a28599aSArnaldo Carvalho de Melo 	t_elapsed = dp->dccps_options_received.dccpor_elapsed_time * 10;
4887c657876SArnaldo Carvalho de Melo 	x_recv = opt_recv->ccid3or_receive_rate;
4897c657876SArnaldo Carvalho de Melo 	pinv = opt_recv->ccid3or_loss_event_rate;
4907c657876SArnaldo Carvalho de Melo 
4917c657876SArnaldo Carvalho de Melo 	switch (hctx->ccid3hctx_state) {
4927c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_SENT:
4937c657876SArnaldo Carvalho de Melo 		/* FIXME: what to do here? */
4947c657876SArnaldo Carvalho de Melo 		return;
4957c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_FBACK:
4967c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_FBACK:
4977c657876SArnaldo Carvalho de Melo 		/* Calculate new round trip sample by
4987c657876SArnaldo Carvalho de Melo 		 * R_sample = (now - t_recvdata) - t_delay */
4997c657876SArnaldo Carvalho de Melo 		/* get t_recvdata from history */
5008c60f3faSArnaldo Carvalho de Melo 		packet = dccp_tx_hist_find_entry(&hctx->ccid3hctx_hist,
5018c60f3faSArnaldo Carvalho de Melo 						 DCCP_SKB_CB(skb)->dccpd_ack_seq);
5027c657876SArnaldo Carvalho de Melo 		if (packet == NULL) {
5031f2333aeSArnaldo Carvalho de Melo 			ccid3_pr_debug("%s, sk=%p, seqno %llu(%s) does't "
5041f2333aeSArnaldo Carvalho de Melo 				       "exist in history!\n",
5051f2333aeSArnaldo Carvalho de Melo 				       dccp_role(sk), sk,
5061f2333aeSArnaldo Carvalho de Melo 				       DCCP_SKB_CB(skb)->dccpd_ack_seq,
5077c657876SArnaldo Carvalho de Melo 				       dccp_packet_name(DCCP_SKB_CB(skb)->dccpd_type));
5087c657876SArnaldo Carvalho de Melo 			return;
5097c657876SArnaldo Carvalho de Melo 		}
5107c657876SArnaldo Carvalho de Melo 
5117c657876SArnaldo Carvalho de Melo 		/* Update RTT */
512b0e56780SArnaldo Carvalho de Melo 		dccp_timestamp(sk, &now);
513b0e56780SArnaldo Carvalho de Melo 		r_sample = timeval_delta(&now, &packet->dccphtx_tstamp);
5141a28599aSArnaldo Carvalho de Melo 		if (unlikely(r_sample <= t_elapsed))
5151a28599aSArnaldo Carvalho de Melo 			LIMIT_NETDEBUG(KERN_WARNING
5161a28599aSArnaldo Carvalho de Melo 				       "%s: r_sample=%uus, t_elapsed=%uus\n",
5171a28599aSArnaldo Carvalho de Melo 				       __FUNCTION__, r_sample, t_elapsed);
5181a28599aSArnaldo Carvalho de Melo 		else
5191a28599aSArnaldo Carvalho de Melo 			r_sample -= t_elapsed;
5207c657876SArnaldo Carvalho de Melo 
5217c657876SArnaldo Carvalho de Melo 		/* Update RTT estimate by
5227c657876SArnaldo Carvalho de Melo 		 * If (No feedback recv)
5237c657876SArnaldo Carvalho de Melo 		 *    R = R_sample;
5247c657876SArnaldo Carvalho de Melo 		 * Else
5257c657876SArnaldo Carvalho de Melo 		 *    R = q * R + (1 - q) * R_sample;
5267c657876SArnaldo Carvalho de Melo 		 *
5277c657876SArnaldo Carvalho de Melo 		 * q is a constant, RFC 3448 recomments 0.9
5287c657876SArnaldo Carvalho de Melo 		 */
5297c657876SArnaldo Carvalho de Melo 		if (hctx->ccid3hctx_state == TFRC_SSTATE_NO_FBACK) {
5307c657876SArnaldo Carvalho de Melo 			ccid3_hc_tx_set_state(sk, TFRC_SSTATE_FBACK);
5317c657876SArnaldo Carvalho de Melo 			hctx->ccid3hctx_rtt = r_sample;
5327c657876SArnaldo Carvalho de Melo 		} else
5331f2333aeSArnaldo Carvalho de Melo 			hctx->ccid3hctx_rtt = (hctx->ccid3hctx_rtt * 9) / 10 +
5341f2333aeSArnaldo Carvalho de Melo 					      r_sample / 10;
5357c657876SArnaldo Carvalho de Melo 
5361f2333aeSArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p, New RTT estimate=%uus, "
5371f2333aeSArnaldo Carvalho de Melo 			       "r_sample=%us\n", dccp_role(sk), sk,
5381f2333aeSArnaldo Carvalho de Melo 			       hctx->ccid3hctx_rtt, r_sample);
5397c657876SArnaldo Carvalho de Melo 
5407c657876SArnaldo Carvalho de Melo 		/* Update timeout interval */
541c68e64cfSArnaldo Carvalho de Melo 		hctx->ccid3hctx_t_rto = max_t(u32, 4 * hctx->ccid3hctx_rtt,
542cef07fd6SArnaldo Carvalho de Melo 					      USEC_PER_SEC);
5437c657876SArnaldo Carvalho de Melo 
5447c657876SArnaldo Carvalho de Melo 		/* Update receive rate */
5451f2333aeSArnaldo Carvalho de Melo 		hctx->ccid3hctx_x_recv = x_recv;/* X_recv in bytes per sec */
5467c657876SArnaldo Carvalho de Melo 
5477c657876SArnaldo Carvalho de Melo 		/* Update loss event rate */
5487c657876SArnaldo Carvalho de Melo 		if (pinv == ~0 || pinv == 0)
5497c657876SArnaldo Carvalho de Melo 			hctx->ccid3hctx_p = 0;
5507c657876SArnaldo Carvalho de Melo 		else {
5517c657876SArnaldo Carvalho de Melo 			hctx->ccid3hctx_p = 1000000 / pinv;
5527c657876SArnaldo Carvalho de Melo 
5537c657876SArnaldo Carvalho de Melo 			if (hctx->ccid3hctx_p < TFRC_SMALLEST_P) {
5547c657876SArnaldo Carvalho de Melo 				hctx->ccid3hctx_p = TFRC_SMALLEST_P;
5551f2333aeSArnaldo Carvalho de Melo 				ccid3_pr_debug("%s, sk=%p, Smallest p used!\n",
5561f2333aeSArnaldo Carvalho de Melo 					       dccp_role(sk), sk);
5577c657876SArnaldo Carvalho de Melo 			}
5587c657876SArnaldo Carvalho de Melo 		}
5597c657876SArnaldo Carvalho de Melo 
5607c657876SArnaldo Carvalho de Melo 		/* unschedule no feedback timer */
5617c657876SArnaldo Carvalho de Melo 		sk_stop_timer(sk, &hctx->ccid3hctx_no_feedback_timer);
5627c657876SArnaldo Carvalho de Melo 
5637c657876SArnaldo Carvalho de Melo 		/* Update sending rate */
5647c657876SArnaldo Carvalho de Melo 		ccid3_hc_tx_update_x(sk);
5657c657876SArnaldo Carvalho de Melo 
5667c657876SArnaldo Carvalho de Melo 		/* Update next send time */
567b6ee3d4aSArnaldo Carvalho de Melo 		timeval_sub_usecs(&hctx->ccid3hctx_t_nom,
568b6ee3d4aSArnaldo Carvalho de Melo 				  hctx->ccid3hctx_t_ipi);
5697c657876SArnaldo Carvalho de Melo 		ccid3_calc_new_t_ipi(hctx);
570b6ee3d4aSArnaldo Carvalho de Melo 		timeval_add_usecs(&hctx->ccid3hctx_t_nom,
571b6ee3d4aSArnaldo Carvalho de Melo 				  hctx->ccid3hctx_t_ipi);
5727c657876SArnaldo Carvalho de Melo 		ccid3_calc_new_delta(hctx);
5737c657876SArnaldo Carvalho de Melo 
5747c657876SArnaldo Carvalho de Melo 		/* remove all packets older than the one acked from history */
5758c60f3faSArnaldo Carvalho de Melo 		dccp_tx_hist_purge_older(ccid3_tx_hist,
5768c60f3faSArnaldo Carvalho de Melo 					 &hctx->ccid3hctx_hist, packet);
577c530cfb1SArnaldo Carvalho de Melo 		/*
578c530cfb1SArnaldo Carvalho de Melo 		 * As we have calculated new ipi, delta, t_nom it is possible that
579c530cfb1SArnaldo Carvalho de Melo 		 * we now can send a packet, so wake up dccp_wait_for_ccids.
580c530cfb1SArnaldo Carvalho de Melo 		 */
581c530cfb1SArnaldo Carvalho de Melo 		sk->sk_write_space(sk);
5828c60f3faSArnaldo Carvalho de Melo 
5831f2333aeSArnaldo Carvalho de Melo 		/*
5841f2333aeSArnaldo Carvalho de Melo 		 * Schedule no feedback timer to expire in
5851f2333aeSArnaldo Carvalho de Melo 		 * max(4 * R, 2 * s / X)
5861f2333aeSArnaldo Carvalho de Melo 		 */
587c68e64cfSArnaldo Carvalho de Melo 		next_tmout = max(hctx->ccid3hctx_t_rto,
5886b5e633aSArnaldo Carvalho de Melo 				 2 * usecs_div(hctx->ccid3hctx_s,
5896b5e633aSArnaldo Carvalho de Melo 					       hctx->ccid3hctx_x));
5907c657876SArnaldo Carvalho de Melo 
5911f2333aeSArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p, Scheduled no feedback timer to "
5921f2333aeSArnaldo Carvalho de Melo 			       "expire in %lu jiffies (%luus)\n",
5931f2333aeSArnaldo Carvalho de Melo 			       dccp_role(sk), sk,
5941f2333aeSArnaldo Carvalho de Melo 			       usecs_to_jiffies(next_tmout), next_tmout);
5957c657876SArnaldo Carvalho de Melo 
5967c657876SArnaldo Carvalho de Melo 		sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
5977c657876SArnaldo Carvalho de Melo 			       jiffies + max_t(u32, 1, usecs_to_jiffies(next_tmout)));
5987c657876SArnaldo Carvalho de Melo 
5997c657876SArnaldo Carvalho de Melo 		/* set idle flag */
6007c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_idle = 1;
6017c657876SArnaldo Carvalho de Melo 		break;
6027c657876SArnaldo Carvalho de Melo 	default:
6037c657876SArnaldo Carvalho de Melo 		printk(KERN_CRIT "%s: %s, sk=%p, Illegal state (%d)!\n",
6047c657876SArnaldo Carvalho de Melo 		       __FUNCTION__, dccp_role(sk), sk, hctx->ccid3hctx_state);
6057c657876SArnaldo Carvalho de Melo 		dump_stack();
6067c657876SArnaldo Carvalho de Melo 		break;
6077c657876SArnaldo Carvalho de Melo 	}
6087c657876SArnaldo Carvalho de Melo }
6097c657876SArnaldo Carvalho de Melo 
6107c657876SArnaldo Carvalho de Melo static void ccid3_hc_tx_insert_options(struct sock *sk, struct sk_buff *skb)
6117c657876SArnaldo Carvalho de Melo {
6127c657876SArnaldo Carvalho de Melo 	const struct dccp_sock *dp = dccp_sk(sk);
6137c657876SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = dp->dccps_hc_tx_ccid_private;
6147c657876SArnaldo Carvalho de Melo 
6151f2333aeSArnaldo Carvalho de Melo 	if (hctx == NULL || !(sk->sk_state == DCCP_OPEN ||
6161f2333aeSArnaldo Carvalho de Melo 			      sk->sk_state == DCCP_PARTOPEN))
6177c657876SArnaldo Carvalho de Melo 		return;
6187c657876SArnaldo Carvalho de Melo 
6197c657876SArnaldo Carvalho de Melo 	 DCCP_SKB_CB(skb)->dccpd_ccval = hctx->ccid3hctx_last_win_count;
6207c657876SArnaldo Carvalho de Melo }
6217c657876SArnaldo Carvalho de Melo 
6227c657876SArnaldo Carvalho de Melo static int ccid3_hc_tx_parse_options(struct sock *sk, unsigned char option,
6231f2333aeSArnaldo Carvalho de Melo 				     unsigned char len, u16 idx,
6241f2333aeSArnaldo Carvalho de Melo 				     unsigned char *value)
6257c657876SArnaldo Carvalho de Melo {
6267c657876SArnaldo Carvalho de Melo 	int rc = 0;
6277c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
6287c657876SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = dp->dccps_hc_tx_ccid_private;
6297c657876SArnaldo Carvalho de Melo 	struct ccid3_options_received *opt_recv;
6307c657876SArnaldo Carvalho de Melo 
6317c657876SArnaldo Carvalho de Melo 	if (hctx == NULL)
6327c657876SArnaldo Carvalho de Melo 		return 0;
6337c657876SArnaldo Carvalho de Melo 
6347c657876SArnaldo Carvalho de Melo 	opt_recv = &hctx->ccid3hctx_options_received;
6357c657876SArnaldo Carvalho de Melo 
6367c657876SArnaldo Carvalho de Melo 	if (opt_recv->ccid3or_seqno != dp->dccps_gsr) {
6377c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_seqno		     = dp->dccps_gsr;
6387c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_event_rate    = ~0;
6397c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_intervals_idx = 0;
6407c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_intervals_len = 0;
6417c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_receive_rate	     = 0;
6427c657876SArnaldo Carvalho de Melo 	}
6437c657876SArnaldo Carvalho de Melo 
6447c657876SArnaldo Carvalho de Melo 	switch (option) {
6457c657876SArnaldo Carvalho de Melo 	case TFRC_OPT_LOSS_EVENT_RATE:
6467c657876SArnaldo Carvalho de Melo 		if (len != 4) {
6471f2333aeSArnaldo Carvalho de Melo 			ccid3_pr_debug("%s, sk=%p, invalid len for "
6481f2333aeSArnaldo Carvalho de Melo 				       "TFRC_OPT_LOSS_EVENT_RATE\n",
6497c657876SArnaldo Carvalho de Melo 				       dccp_role(sk), sk);
6507c657876SArnaldo Carvalho de Melo 			rc = -EINVAL;
6517c657876SArnaldo Carvalho de Melo 		} else {
6527c657876SArnaldo Carvalho de Melo 			opt_recv->ccid3or_loss_event_rate = ntohl(*(u32 *)value);
6537c657876SArnaldo Carvalho de Melo 			ccid3_pr_debug("%s, sk=%p, LOSS_EVENT_RATE=%u\n",
6547c657876SArnaldo Carvalho de Melo 				       dccp_role(sk), sk,
6557c657876SArnaldo Carvalho de Melo 				       opt_recv->ccid3or_loss_event_rate);
6567c657876SArnaldo Carvalho de Melo 		}
6577c657876SArnaldo Carvalho de Melo 		break;
6587c657876SArnaldo Carvalho de Melo 	case TFRC_OPT_LOSS_INTERVALS:
6597c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_intervals_idx = idx;
6607c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_intervals_len = len;
6617c657876SArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p, LOSS_INTERVALS=(%u, %u)\n",
6627c657876SArnaldo Carvalho de Melo 			       dccp_role(sk), sk,
6637c657876SArnaldo Carvalho de Melo 			       opt_recv->ccid3or_loss_intervals_idx,
6647c657876SArnaldo Carvalho de Melo 			       opt_recv->ccid3or_loss_intervals_len);
6657c657876SArnaldo Carvalho de Melo 		break;
6667c657876SArnaldo Carvalho de Melo 	case TFRC_OPT_RECEIVE_RATE:
6677c657876SArnaldo Carvalho de Melo 		if (len != 4) {
6681f2333aeSArnaldo Carvalho de Melo 			ccid3_pr_debug("%s, sk=%p, invalid len for "
6691f2333aeSArnaldo Carvalho de Melo 				       "TFRC_OPT_RECEIVE_RATE\n",
6707c657876SArnaldo Carvalho de Melo 				       dccp_role(sk), sk);
6717c657876SArnaldo Carvalho de Melo 			rc = -EINVAL;
6727c657876SArnaldo Carvalho de Melo 		} else {
6737c657876SArnaldo Carvalho de Melo 			opt_recv->ccid3or_receive_rate = ntohl(*(u32 *)value);
6747c657876SArnaldo Carvalho de Melo 			ccid3_pr_debug("%s, sk=%p, RECEIVE_RATE=%u\n",
6757c657876SArnaldo Carvalho de Melo 				       dccp_role(sk), sk,
6767c657876SArnaldo Carvalho de Melo 				       opt_recv->ccid3or_receive_rate);
6777c657876SArnaldo Carvalho de Melo 		}
6787c657876SArnaldo Carvalho de Melo 		break;
6797c657876SArnaldo Carvalho de Melo 	}
6807c657876SArnaldo Carvalho de Melo 
6817c657876SArnaldo Carvalho de Melo 	return rc;
6827c657876SArnaldo Carvalho de Melo }
6837c657876SArnaldo Carvalho de Melo 
6847c657876SArnaldo Carvalho de Melo static int ccid3_hc_tx_init(struct sock *sk)
6857c657876SArnaldo Carvalho de Melo {
6867c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
6877c657876SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx;
6887c657876SArnaldo Carvalho de Melo 
6897c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
6907c657876SArnaldo Carvalho de Melo 
6911f2333aeSArnaldo Carvalho de Melo 	hctx = dp->dccps_hc_tx_ccid_private = kmalloc(sizeof(*hctx),
6921f2333aeSArnaldo Carvalho de Melo 						      gfp_any());
6937c657876SArnaldo Carvalho de Melo 	if (hctx == NULL)
6947c657876SArnaldo Carvalho de Melo 		return -ENOMEM;
6957c657876SArnaldo Carvalho de Melo 
6967c657876SArnaldo Carvalho de Melo 	memset(hctx, 0, sizeof(*hctx));
6977c657876SArnaldo Carvalho de Melo 
698a84ffe43SArnaldo Carvalho de Melo 	if (dp->dccps_packet_size >= TFRC_MIN_PACKET_SIZE &&
699a84ffe43SArnaldo Carvalho de Melo 	    dp->dccps_packet_size <= TFRC_MAX_PACKET_SIZE)
700a84ffe43SArnaldo Carvalho de Melo 		hctx->ccid3hctx_s = dp->dccps_packet_size;
7017c657876SArnaldo Carvalho de Melo 	else
7027c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_s = TFRC_STD_PACKET_SIZE;
7037c657876SArnaldo Carvalho de Melo 
7041f2333aeSArnaldo Carvalho de Melo 	/* Set transmission rate to 1 packet per second */
7051f2333aeSArnaldo Carvalho de Melo 	hctx->ccid3hctx_x     = hctx->ccid3hctx_s;
706c68e64cfSArnaldo Carvalho de Melo 	hctx->ccid3hctx_t_rto = USEC_PER_SEC;
7077c657876SArnaldo Carvalho de Melo 	hctx->ccid3hctx_state = TFRC_SSTATE_NO_SENT;
7087c657876SArnaldo Carvalho de Melo 	INIT_LIST_HEAD(&hctx->ccid3hctx_hist);
7097c657876SArnaldo Carvalho de Melo 	init_timer(&hctx->ccid3hctx_no_feedback_timer);
7107c657876SArnaldo Carvalho de Melo 
7117c657876SArnaldo Carvalho de Melo 	return 0;
7127c657876SArnaldo Carvalho de Melo }
7137c657876SArnaldo Carvalho de Melo 
7147c657876SArnaldo Carvalho de Melo static void ccid3_hc_tx_exit(struct sock *sk)
7157c657876SArnaldo Carvalho de Melo {
7167c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
7177c657876SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = dp->dccps_hc_tx_ccid_private;
7187c657876SArnaldo Carvalho de Melo 
7197c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
7207c657876SArnaldo Carvalho de Melo 	BUG_ON(hctx == NULL);
7217c657876SArnaldo Carvalho de Melo 
7227c657876SArnaldo Carvalho de Melo 	ccid3_hc_tx_set_state(sk, TFRC_SSTATE_TERM);
7237c657876SArnaldo Carvalho de Melo 	sk_stop_timer(sk, &hctx->ccid3hctx_no_feedback_timer);
7247c657876SArnaldo Carvalho de Melo 
7257c657876SArnaldo Carvalho de Melo 	/* Empty packet history */
7268c60f3faSArnaldo Carvalho de Melo 	dccp_tx_hist_purge(ccid3_tx_hist, &hctx->ccid3hctx_hist);
7277c657876SArnaldo Carvalho de Melo 
7287c657876SArnaldo Carvalho de Melo 	kfree(dp->dccps_hc_tx_ccid_private);
7297c657876SArnaldo Carvalho de Melo 	dp->dccps_hc_tx_ccid_private = NULL;
7307c657876SArnaldo Carvalho de Melo }
7317c657876SArnaldo Carvalho de Melo 
7327c657876SArnaldo Carvalho de Melo /*
7337c657876SArnaldo Carvalho de Melo  * RX Half Connection methods
7347c657876SArnaldo Carvalho de Melo  */
7357c657876SArnaldo Carvalho de Melo 
7367c657876SArnaldo Carvalho de Melo /* TFRC receiver states */
7377c657876SArnaldo Carvalho de Melo enum ccid3_hc_rx_states {
7387c657876SArnaldo Carvalho de Melo        	TFRC_RSTATE_NO_DATA = 1,
7397c657876SArnaldo Carvalho de Melo 	TFRC_RSTATE_DATA,
7407c657876SArnaldo Carvalho de Melo 	TFRC_RSTATE_TERM    = 127,
7417c657876SArnaldo Carvalho de Melo };
7427c657876SArnaldo Carvalho de Melo 
7437c657876SArnaldo Carvalho de Melo #ifdef CCID3_DEBUG
7447c657876SArnaldo Carvalho de Melo static const char *ccid3_rx_state_name(enum ccid3_hc_rx_states state)
7457c657876SArnaldo Carvalho de Melo {
7467c657876SArnaldo Carvalho de Melo 	static char *ccid3_rx_state_names[] = {
7477c657876SArnaldo Carvalho de Melo 	[TFRC_RSTATE_NO_DATA] = "NO_DATA",
7487c657876SArnaldo Carvalho de Melo 	[TFRC_RSTATE_DATA]    = "DATA",
7497c657876SArnaldo Carvalho de Melo 	[TFRC_RSTATE_TERM]    = "TERM",
7507c657876SArnaldo Carvalho de Melo 	};
7517c657876SArnaldo Carvalho de Melo 
7527c657876SArnaldo Carvalho de Melo 	return ccid3_rx_state_names[state];
7537c657876SArnaldo Carvalho de Melo }
7547c657876SArnaldo Carvalho de Melo #endif
7557c657876SArnaldo Carvalho de Melo 
7561f2333aeSArnaldo Carvalho de Melo static inline void ccid3_hc_rx_set_state(struct sock *sk,
7571f2333aeSArnaldo Carvalho de Melo 					 enum ccid3_hc_rx_states state)
7587c657876SArnaldo Carvalho de Melo {
7597c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
7607c657876SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = dp->dccps_hc_rx_ccid_private;
7617c657876SArnaldo Carvalho de Melo 	enum ccid3_hc_rx_states oldstate = hcrx->ccid3hcrx_state;
7627c657876SArnaldo Carvalho de Melo 
7637c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s(%p) %-8.8s -> %s\n",
7641f2333aeSArnaldo Carvalho de Melo 		       dccp_role(sk), sk, ccid3_rx_state_name(oldstate),
7651f2333aeSArnaldo Carvalho de Melo 		       ccid3_rx_state_name(state));
7667c657876SArnaldo Carvalho de Melo 	WARN_ON(state == oldstate);
7677c657876SArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_state = state;
7687c657876SArnaldo Carvalho de Melo }
7697c657876SArnaldo Carvalho de Melo 
7707c657876SArnaldo Carvalho de Melo static void ccid3_hc_rx_send_feedback(struct sock *sk)
7717c657876SArnaldo Carvalho de Melo {
7727c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
7737c657876SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = dp->dccps_hc_rx_ccid_private;
7748c60f3faSArnaldo Carvalho de Melo 	struct dccp_rx_hist_entry *packet;
775b6ee3d4aSArnaldo Carvalho de Melo 	struct timeval now;
7767c657876SArnaldo Carvalho de Melo 
7777c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
7787c657876SArnaldo Carvalho de Melo 
779b0e56780SArnaldo Carvalho de Melo 	dccp_timestamp(sk, &now);
780b6ee3d4aSArnaldo Carvalho de Melo 
7817c657876SArnaldo Carvalho de Melo 	switch (hcrx->ccid3hcrx_state) {
7827c657876SArnaldo Carvalho de Melo 	case TFRC_RSTATE_NO_DATA:
7837c657876SArnaldo Carvalho de Melo 		hcrx->ccid3hcrx_x_recv = 0;
7847c657876SArnaldo Carvalho de Melo 		break;
7857c657876SArnaldo Carvalho de Melo 	case TFRC_RSTATE_DATA: {
786b6ee3d4aSArnaldo Carvalho de Melo 		const u32 delta = timeval_delta(&now,
787b6ee3d4aSArnaldo Carvalho de Melo 					&hcrx->ccid3hcrx_tstamp_last_feedback);
78827ae543eSArnaldo Carvalho de Melo 		hcrx->ccid3hcrx_x_recv = usecs_div(hcrx->ccid3hcrx_bytes_recv,
78927ae543eSArnaldo Carvalho de Melo 						   delta);
7907c657876SArnaldo Carvalho de Melo 	}
7917c657876SArnaldo Carvalho de Melo 		break;
7927c657876SArnaldo Carvalho de Melo 	default:
7937c657876SArnaldo Carvalho de Melo 		printk(KERN_CRIT "%s: %s, sk=%p, Illegal state (%d)!\n",
7947c657876SArnaldo Carvalho de Melo 		       __FUNCTION__, dccp_role(sk), sk, hcrx->ccid3hcrx_state);
7957c657876SArnaldo Carvalho de Melo 		dump_stack();
7967c657876SArnaldo Carvalho de Melo 		return;
7977c657876SArnaldo Carvalho de Melo 	}
7987c657876SArnaldo Carvalho de Melo 
7998c60f3faSArnaldo Carvalho de Melo 	packet = dccp_rx_hist_find_data_packet(&hcrx->ccid3hcrx_hist);
8007c657876SArnaldo Carvalho de Melo 	if (packet == NULL) {
8017c657876SArnaldo Carvalho de Melo 		printk(KERN_CRIT "%s: %s, sk=%p, no data packet in history!\n",
8027c657876SArnaldo Carvalho de Melo 		       __FUNCTION__, dccp_role(sk), sk);
8037c657876SArnaldo Carvalho de Melo 		dump_stack();
8047c657876SArnaldo Carvalho de Melo 		return;
8057c657876SArnaldo Carvalho de Melo 	}
8067c657876SArnaldo Carvalho de Melo 
807b6ee3d4aSArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_tstamp_last_feedback = now;
808c1734376SArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_last_counter	     = packet->dccphrx_ccval;
8098c60f3faSArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_seqno_last_counter   = packet->dccphrx_seqno;
8107c657876SArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_bytes_recv	     = 0;
8117c657876SArnaldo Carvalho de Melo 
8127c657876SArnaldo Carvalho de Melo 	/* Convert to multiples of 10us */
813b6ee3d4aSArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_elapsed_time =
814b6ee3d4aSArnaldo Carvalho de Melo 			timeval_delta(&now, &packet->dccphrx_tstamp) / 10;
8157c657876SArnaldo Carvalho de Melo 	if (hcrx->ccid3hcrx_p == 0)
8167c657876SArnaldo Carvalho de Melo 		hcrx->ccid3hcrx_pinv = ~0;
8177c657876SArnaldo Carvalho de Melo 	else
8187c657876SArnaldo Carvalho de Melo 		hcrx->ccid3hcrx_pinv = 1000000 / hcrx->ccid3hcrx_p;
819507d37cfSArnaldo Carvalho de Melo 	dp->dccps_hc_rx_insert_options = 1;
8207c657876SArnaldo Carvalho de Melo 	dccp_send_ack(sk);
8217c657876SArnaldo Carvalho de Melo }
8227c657876SArnaldo Carvalho de Melo 
8237c657876SArnaldo Carvalho de Melo static void ccid3_hc_rx_insert_options(struct sock *sk, struct sk_buff *skb)
8247c657876SArnaldo Carvalho de Melo {
8257c657876SArnaldo Carvalho de Melo 	const struct dccp_sock *dp = dccp_sk(sk);
8264fded33bSArnaldo Carvalho de Melo 	u32 x_recv, pinv;
8277c657876SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = dp->dccps_hc_rx_ccid_private;
8287c657876SArnaldo Carvalho de Melo 
8291f2333aeSArnaldo Carvalho de Melo 	if (hcrx == NULL || !(sk->sk_state == DCCP_OPEN ||
8301f2333aeSArnaldo Carvalho de Melo 			      sk->sk_state == DCCP_PARTOPEN))
8317c657876SArnaldo Carvalho de Melo 		return;
8327c657876SArnaldo Carvalho de Melo 
8337c657876SArnaldo Carvalho de Melo 	DCCP_SKB_CB(skb)->dccpd_ccval = hcrx->ccid3hcrx_last_counter;
8344fded33bSArnaldo Carvalho de Melo 
8354fded33bSArnaldo Carvalho de Melo 	if (dccp_packet_without_ack(skb))
8364fded33bSArnaldo Carvalho de Melo 		return;
8374fded33bSArnaldo Carvalho de Melo 
8384fded33bSArnaldo Carvalho de Melo 	if (hcrx->ccid3hcrx_elapsed_time != 0)
8394fded33bSArnaldo Carvalho de Melo 		dccp_insert_option_elapsed_time(sk, skb,
8404fded33bSArnaldo Carvalho de Melo 						hcrx->ccid3hcrx_elapsed_time);
8414fded33bSArnaldo Carvalho de Melo 	dccp_insert_option_timestamp(sk, skb);
8424fded33bSArnaldo Carvalho de Melo 	x_recv = htonl(hcrx->ccid3hcrx_x_recv);
8434fded33bSArnaldo Carvalho de Melo 	pinv   = htonl(hcrx->ccid3hcrx_pinv);
8444fded33bSArnaldo Carvalho de Melo 	dccp_insert_option(sk, skb, TFRC_OPT_LOSS_EVENT_RATE,
8454fded33bSArnaldo Carvalho de Melo 			   &pinv, sizeof(pinv));
8464fded33bSArnaldo Carvalho de Melo 	dccp_insert_option(sk, skb, TFRC_OPT_RECEIVE_RATE,
8474fded33bSArnaldo Carvalho de Melo 			   &x_recv, sizeof(x_recv));
8487c657876SArnaldo Carvalho de Melo }
8497c657876SArnaldo Carvalho de Melo 
8507c657876SArnaldo Carvalho de Melo /* calculate first loss interval
8517c657876SArnaldo Carvalho de Melo  *
8527c657876SArnaldo Carvalho de Melo  * returns estimated loss interval in usecs */
8537c657876SArnaldo Carvalho de Melo 
8547c657876SArnaldo Carvalho de Melo static u32 ccid3_hc_rx_calc_first_li(struct sock *sk)
8557c657876SArnaldo Carvalho de Melo {
8567c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
8577c657876SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = dp->dccps_hc_rx_ccid_private;
8588c60f3faSArnaldo Carvalho de Melo 	struct dccp_rx_hist_entry *entry, *next, *tail = NULL;
8597c657876SArnaldo Carvalho de Melo 	u32 rtt, delta, x_recv, fval, p, tmp2;
860b6ee3d4aSArnaldo Carvalho de Melo 	struct timeval tstamp = { 0, };
8617c657876SArnaldo Carvalho de Melo 	int interval = 0;
8627c657876SArnaldo Carvalho de Melo 	int win_count = 0;
8637c657876SArnaldo Carvalho de Melo 	int step = 0;
8647c657876SArnaldo Carvalho de Melo 	u64 tmp1;
8657c657876SArnaldo Carvalho de Melo 
8668c60f3faSArnaldo Carvalho de Melo 	list_for_each_entry_safe(entry, next, &hcrx->ccid3hcrx_hist,
8678c60f3faSArnaldo Carvalho de Melo 				 dccphrx_node) {
8688c60f3faSArnaldo Carvalho de Melo 		if (dccp_rx_hist_entry_data_packet(entry)) {
8697c657876SArnaldo Carvalho de Melo 			tail = entry;
8707c657876SArnaldo Carvalho de Melo 
8717c657876SArnaldo Carvalho de Melo 			switch (step) {
8727c657876SArnaldo Carvalho de Melo 			case 0:
8738c60f3faSArnaldo Carvalho de Melo 				tstamp	  = entry->dccphrx_tstamp;
874c1734376SArnaldo Carvalho de Melo 				win_count = entry->dccphrx_ccval;
8757c657876SArnaldo Carvalho de Melo 				step = 1;
8767c657876SArnaldo Carvalho de Melo 				break;
8777c657876SArnaldo Carvalho de Melo 			case 1:
878c1734376SArnaldo Carvalho de Melo 				interval = win_count - entry->dccphrx_ccval;
8797c657876SArnaldo Carvalho de Melo 				if (interval < 0)
8807c657876SArnaldo Carvalho de Melo 					interval += TFRC_WIN_COUNT_LIMIT;
8817c657876SArnaldo Carvalho de Melo 				if (interval > 4)
8827c657876SArnaldo Carvalho de Melo 					goto found;
8837c657876SArnaldo Carvalho de Melo 				break;
8847c657876SArnaldo Carvalho de Melo 			}
8857c657876SArnaldo Carvalho de Melo 		}
8867c657876SArnaldo Carvalho de Melo 	}
8877c657876SArnaldo Carvalho de Melo 
8887c657876SArnaldo Carvalho de Melo 	if (step == 0) {
8891f2333aeSArnaldo Carvalho de Melo 		printk(KERN_CRIT "%s: %s, sk=%p, packet history contains no "
8901f2333aeSArnaldo Carvalho de Melo 				 "data packets!\n",
8917c657876SArnaldo Carvalho de Melo 		       __FUNCTION__, dccp_role(sk), sk);
8927c657876SArnaldo Carvalho de Melo 		return ~0;
8937c657876SArnaldo Carvalho de Melo 	}
8947c657876SArnaldo Carvalho de Melo 
8957c657876SArnaldo Carvalho de Melo 	if (interval == 0) {
8961f2333aeSArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p, Could not find a win_count "
8971f2333aeSArnaldo Carvalho de Melo 			       "interval > 0. Defaulting to 1\n",
8987c657876SArnaldo Carvalho de Melo 			       dccp_role(sk), sk);
8997c657876SArnaldo Carvalho de Melo 		interval = 1;
9007c657876SArnaldo Carvalho de Melo 	}
9017c657876SArnaldo Carvalho de Melo found:
902b6ee3d4aSArnaldo Carvalho de Melo 	rtt = timeval_delta(&tstamp, &tail->dccphrx_tstamp) * 4 / interval;
9037c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p, approximated RTT to %uus\n",
9047c657876SArnaldo Carvalho de Melo 		       dccp_role(sk), sk, rtt);
9057c657876SArnaldo Carvalho de Melo 	if (rtt == 0)
9067c657876SArnaldo Carvalho de Melo 		rtt = 1;
9077c657876SArnaldo Carvalho de Melo 
908b0e56780SArnaldo Carvalho de Melo 	dccp_timestamp(sk, &tstamp);
909b0e56780SArnaldo Carvalho de Melo 	delta = timeval_delta(&tstamp, &hcrx->ccid3hcrx_tstamp_last_feedback);
910b0e56780SArnaldo Carvalho de Melo 	x_recv = usecs_div(hcrx->ccid3hcrx_bytes_recv, delta);
9117c657876SArnaldo Carvalho de Melo 
9127c657876SArnaldo Carvalho de Melo 	tmp1 = (u64)x_recv * (u64)rtt;
9137c657876SArnaldo Carvalho de Melo 	do_div(tmp1,10000000);
9147c657876SArnaldo Carvalho de Melo 	tmp2 = (u32)tmp1;
9157c657876SArnaldo Carvalho de Melo 	fval = (hcrx->ccid3hcrx_s * 100000) / tmp2;
9167c657876SArnaldo Carvalho de Melo 	/* do not alter order above or you will get overflow on 32 bit */
91736729c1aSArnaldo Carvalho de Melo 	p = tfrc_calc_x_reverse_lookup(fval);
9181f2333aeSArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p, receive rate=%u bytes/s, implied "
9191f2333aeSArnaldo Carvalho de Melo 		       "loss rate=%u\n", dccp_role(sk), sk, x_recv, p);
9207c657876SArnaldo Carvalho de Melo 
9217c657876SArnaldo Carvalho de Melo 	if (p == 0)
9227c657876SArnaldo Carvalho de Melo 		return ~0;
9237c657876SArnaldo Carvalho de Melo 	else
9247c657876SArnaldo Carvalho de Melo 		return 1000000 / p;
9257c657876SArnaldo Carvalho de Melo }
9267c657876SArnaldo Carvalho de Melo 
9277c657876SArnaldo Carvalho de Melo static void ccid3_hc_rx_update_li(struct sock *sk, u64 seq_loss, u8 win_loss)
9287c657876SArnaldo Carvalho de Melo {
9297c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
9307c657876SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = dp->dccps_hc_rx_ccid_private;
9317c657876SArnaldo Carvalho de Melo 
932ae6706f0SArnaldo Carvalho de Melo 	if (seq_loss != DCCP_MAX_SEQNO + 1 &&
933ae6706f0SArnaldo Carvalho de Melo 	    list_empty(&hcrx->ccid3hcrx_li_hist)) {
934ae6706f0SArnaldo Carvalho de Melo 		struct dccp_li_hist_entry *li_tail;
9357c657876SArnaldo Carvalho de Melo 
936ae6706f0SArnaldo Carvalho de Melo 		li_tail = dccp_li_hist_interval_new(ccid3_li_hist,
937ae6706f0SArnaldo Carvalho de Melo 						    &hcrx->ccid3hcrx_li_hist,
938ae6706f0SArnaldo Carvalho de Melo 						    seq_loss, win_loss);
9397c657876SArnaldo Carvalho de Melo 		if (li_tail == NULL)
940ae6706f0SArnaldo Carvalho de Melo 			return;
941ae6706f0SArnaldo Carvalho de Melo 		li_tail->dccplih_interval = ccid3_hc_rx_calc_first_li(sk);
9427c657876SArnaldo Carvalho de Melo 	}
9437c657876SArnaldo Carvalho de Melo 	/* FIXME: find end of interval */
9447c657876SArnaldo Carvalho de Melo }
9457c657876SArnaldo Carvalho de Melo 
9467c657876SArnaldo Carvalho de Melo static void ccid3_hc_rx_detect_loss(struct sock *sk)
9477c657876SArnaldo Carvalho de Melo {
9487c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
9497c657876SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = dp->dccps_hc_rx_ccid_private;
95029e4f8b3SArnaldo Carvalho de Melo 	u8 win_loss;
95129e4f8b3SArnaldo Carvalho de Melo 	const u64 seq_loss = dccp_rx_hist_detect_loss(&hcrx->ccid3hcrx_hist,
95229e4f8b3SArnaldo Carvalho de Melo 						      &hcrx->ccid3hcrx_li_hist,
95329e4f8b3SArnaldo Carvalho de Melo 						      &win_loss);
9547c657876SArnaldo Carvalho de Melo 
9557c657876SArnaldo Carvalho de Melo 	ccid3_hc_rx_update_li(sk, seq_loss, win_loss);
9567c657876SArnaldo Carvalho de Melo }
9577c657876SArnaldo Carvalho de Melo 
9587c657876SArnaldo Carvalho de Melo static void ccid3_hc_rx_packet_recv(struct sock *sk, struct sk_buff *skb)
9597c657876SArnaldo Carvalho de Melo {
9607c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
9617c657876SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = dp->dccps_hc_rx_ccid_private;
9624fded33bSArnaldo Carvalho de Melo 	const struct dccp_options_received *opt_recv;
9638c60f3faSArnaldo Carvalho de Melo 	struct dccp_rx_hist_entry *packet;
9647c657876SArnaldo Carvalho de Melo 	struct timeval now;
9657c657876SArnaldo Carvalho de Melo 	u8 win_count;
966b3a3077dSArnaldo Carvalho de Melo 	u32 p_prev, r_sample, t_elapsed;
9677c657876SArnaldo Carvalho de Melo 	int ins;
9681f2333aeSArnaldo Carvalho de Melo 
9697c657876SArnaldo Carvalho de Melo 	if (hcrx == NULL)
9707c657876SArnaldo Carvalho de Melo 		return;
9717c657876SArnaldo Carvalho de Melo 
9727c657876SArnaldo Carvalho de Melo 	BUG_ON(!(hcrx->ccid3hcrx_state == TFRC_RSTATE_NO_DATA ||
9737c657876SArnaldo Carvalho de Melo 		 hcrx->ccid3hcrx_state == TFRC_RSTATE_DATA));
9747c657876SArnaldo Carvalho de Melo 
9754fded33bSArnaldo Carvalho de Melo 	opt_recv = &dp->dccps_options_received;
9764fded33bSArnaldo Carvalho de Melo 
9777c657876SArnaldo Carvalho de Melo 	switch (DCCP_SKB_CB(skb)->dccpd_type) {
9787c657876SArnaldo Carvalho de Melo 	case DCCP_PKT_ACK:
9797c657876SArnaldo Carvalho de Melo 		if (hcrx->ccid3hcrx_state == TFRC_RSTATE_NO_DATA)
9807c657876SArnaldo Carvalho de Melo 			return;
9817c657876SArnaldo Carvalho de Melo 	case DCCP_PKT_DATAACK:
9824fded33bSArnaldo Carvalho de Melo 		if (opt_recv->dccpor_timestamp_echo == 0)
9837c657876SArnaldo Carvalho de Melo 			break;
9847c657876SArnaldo Carvalho de Melo 		p_prev = hcrx->ccid3hcrx_rtt;
985b0e56780SArnaldo Carvalho de Melo 		dccp_timestamp(sk, &now);
986b3a3077dSArnaldo Carvalho de Melo 		timeval_sub_usecs(&now, opt_recv->dccpor_timestamp_echo * 10);
987b3a3077dSArnaldo Carvalho de Melo 		r_sample = timeval_usecs(&now);
988b3a3077dSArnaldo Carvalho de Melo 		t_elapsed = opt_recv->dccpor_elapsed_time * 10;
989b3a3077dSArnaldo Carvalho de Melo 
990b3a3077dSArnaldo Carvalho de Melo 		if (unlikely(r_sample <= t_elapsed))
991b3a3077dSArnaldo Carvalho de Melo 			LIMIT_NETDEBUG(KERN_WARNING
992b3a3077dSArnaldo Carvalho de Melo 				       "%s: r_sample=%uus, t_elapsed=%uus\n",
993b3a3077dSArnaldo Carvalho de Melo 				       __FUNCTION__, r_sample, t_elapsed);
994b3a3077dSArnaldo Carvalho de Melo 		else
995b3a3077dSArnaldo Carvalho de Melo 			r_sample -= t_elapsed;
996b3a3077dSArnaldo Carvalho de Melo 
997b3a3077dSArnaldo Carvalho de Melo 		if (hcrx->ccid3hcrx_state == TFRC_RSTATE_NO_DATA)
998b3a3077dSArnaldo Carvalho de Melo 			hcrx->ccid3hcrx_rtt = r_sample;
999b3a3077dSArnaldo Carvalho de Melo 		else
1000b3a3077dSArnaldo Carvalho de Melo 			hcrx->ccid3hcrx_rtt = (hcrx->ccid3hcrx_rtt * 9) / 10 +
1001b3a3077dSArnaldo Carvalho de Melo 					      r_sample / 10;
1002b3a3077dSArnaldo Carvalho de Melo 
10037c657876SArnaldo Carvalho de Melo 		if (p_prev != hcrx->ccid3hcrx_rtt)
10044fded33bSArnaldo Carvalho de Melo 			ccid3_pr_debug("%s, New RTT=%luus, elapsed time=%u\n",
10054fded33bSArnaldo Carvalho de Melo 				       dccp_role(sk), hcrx->ccid3hcrx_rtt,
10064fded33bSArnaldo Carvalho de Melo 				       opt_recv->dccpor_elapsed_time);
10077c657876SArnaldo Carvalho de Melo 		break;
10087c657876SArnaldo Carvalho de Melo 	case DCCP_PKT_DATA:
10097c657876SArnaldo Carvalho de Melo 		break;
10107c657876SArnaldo Carvalho de Melo 	default:
10117c657876SArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p, not DATA/DATAACK/ACK packet(%s)\n",
10127c657876SArnaldo Carvalho de Melo 			       dccp_role(sk), sk,
10137c657876SArnaldo Carvalho de Melo 			       dccp_packet_name(DCCP_SKB_CB(skb)->dccpd_type));
10147c657876SArnaldo Carvalho de Melo 		return;
10157c657876SArnaldo Carvalho de Melo 	}
10167c657876SArnaldo Carvalho de Melo 
1017b0e56780SArnaldo Carvalho de Melo 	packet = dccp_rx_hist_entry_new(ccid3_rx_hist, sk, opt_recv->dccpor_ndp,
10188c60f3faSArnaldo Carvalho de Melo 					skb, SLAB_ATOMIC);
10197c657876SArnaldo Carvalho de Melo 	if (packet == NULL) {
10201f2333aeSArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p, Not enough mem to add rx packet "
10211f2333aeSArnaldo Carvalho de Melo 			       "to history (consider it lost)!",
10227c657876SArnaldo Carvalho de Melo 			       dccp_role(sk), sk);
10237c657876SArnaldo Carvalho de Melo 		return;
10247c657876SArnaldo Carvalho de Melo 	}
10257c657876SArnaldo Carvalho de Melo 
1026c1734376SArnaldo Carvalho de Melo 	win_count = packet->dccphrx_ccval;
10277c657876SArnaldo Carvalho de Melo 
1028072ab6c6SArnaldo Carvalho de Melo 	ins = dccp_rx_hist_add_packet(ccid3_rx_hist, &hcrx->ccid3hcrx_hist,
1029072ab6c6SArnaldo Carvalho de Melo 				      &hcrx->ccid3hcrx_li_hist, packet);
10307c657876SArnaldo Carvalho de Melo 
10317c657876SArnaldo Carvalho de Melo 	if (DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_ACK)
10327c657876SArnaldo Carvalho de Melo 		return;
10337c657876SArnaldo Carvalho de Melo 
10347c657876SArnaldo Carvalho de Melo 	switch (hcrx->ccid3hcrx_state) {
10357c657876SArnaldo Carvalho de Melo 	case TFRC_RSTATE_NO_DATA:
10361f2333aeSArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p(%s), skb=%p, sending initial "
10371f2333aeSArnaldo Carvalho de Melo 			       "feedback\n",
10381f2333aeSArnaldo Carvalho de Melo 			       dccp_role(sk), sk,
10391f2333aeSArnaldo Carvalho de Melo 			       dccp_state_name(sk->sk_state), skb);
10407c657876SArnaldo Carvalho de Melo 		ccid3_hc_rx_send_feedback(sk);
10417c657876SArnaldo Carvalho de Melo 		ccid3_hc_rx_set_state(sk, TFRC_RSTATE_DATA);
10427c657876SArnaldo Carvalho de Melo 		return;
10437c657876SArnaldo Carvalho de Melo 	case TFRC_RSTATE_DATA:
10441f2333aeSArnaldo Carvalho de Melo 		hcrx->ccid3hcrx_bytes_recv += skb->len -
10451f2333aeSArnaldo Carvalho de Melo 					      dccp_hdr(skb)->dccph_doff * 4;
1046b6ee3d4aSArnaldo Carvalho de Melo 		if (ins != 0)
1047b6ee3d4aSArnaldo Carvalho de Melo 			break;
1048b6ee3d4aSArnaldo Carvalho de Melo 
1049b0e56780SArnaldo Carvalho de Melo 		dccp_timestamp(sk, &now);
1050b6ee3d4aSArnaldo Carvalho de Melo 		if (timeval_delta(&now, &hcrx->ccid3hcrx_tstamp_last_ack) >=
10514fded33bSArnaldo Carvalho de Melo 		    hcrx->ccid3hcrx_rtt) {
1052b6ee3d4aSArnaldo Carvalho de Melo 			hcrx->ccid3hcrx_tstamp_last_ack = now;
10537c657876SArnaldo Carvalho de Melo 			ccid3_hc_rx_send_feedback(sk);
10547c657876SArnaldo Carvalho de Melo 		}
10557c657876SArnaldo Carvalho de Melo 		return;
10567c657876SArnaldo Carvalho de Melo 	default:
10577c657876SArnaldo Carvalho de Melo 		printk(KERN_CRIT "%s: %s, sk=%p, Illegal state (%d)!\n",
10587c657876SArnaldo Carvalho de Melo 		       __FUNCTION__, dccp_role(sk), sk, hcrx->ccid3hcrx_state);
10597c657876SArnaldo Carvalho de Melo 		dump_stack();
10607c657876SArnaldo Carvalho de Melo 		return;
10617c657876SArnaldo Carvalho de Melo 	}
10627c657876SArnaldo Carvalho de Melo 
10637c657876SArnaldo Carvalho de Melo 	/* Dealing with packet loss */
10644fded33bSArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p(%s), data loss! Reacting...\n",
10654fded33bSArnaldo Carvalho de Melo 		       dccp_role(sk), sk, dccp_state_name(sk->sk_state));
10667c657876SArnaldo Carvalho de Melo 
10677c657876SArnaldo Carvalho de Melo 	ccid3_hc_rx_detect_loss(sk);
10687c657876SArnaldo Carvalho de Melo 	p_prev = hcrx->ccid3hcrx_p;
10697c657876SArnaldo Carvalho de Melo 
10707c657876SArnaldo Carvalho de Melo 	/* Calculate loss event rate */
1071ae6706f0SArnaldo Carvalho de Melo 	if (!list_empty(&hcrx->ccid3hcrx_li_hist))
10727c657876SArnaldo Carvalho de Melo 		/* Scaling up by 1000000 as fixed decimal */
1073ae6706f0SArnaldo Carvalho de Melo 		hcrx->ccid3hcrx_p = 1000000 / dccp_li_hist_calc_i_mean(&hcrx->ccid3hcrx_li_hist);
10747c657876SArnaldo Carvalho de Melo 
10757c657876SArnaldo Carvalho de Melo 	if (hcrx->ccid3hcrx_p > p_prev) {
10767c657876SArnaldo Carvalho de Melo 		ccid3_hc_rx_send_feedback(sk);
10777c657876SArnaldo Carvalho de Melo 		return;
10787c657876SArnaldo Carvalho de Melo 	}
10797c657876SArnaldo Carvalho de Melo }
10807c657876SArnaldo Carvalho de Melo 
10817c657876SArnaldo Carvalho de Melo static int ccid3_hc_rx_init(struct sock *sk)
10827c657876SArnaldo Carvalho de Melo {
10837c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
10847c657876SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx;
10857c657876SArnaldo Carvalho de Melo 
10867c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
10877c657876SArnaldo Carvalho de Melo 
10881f2333aeSArnaldo Carvalho de Melo 	hcrx = dp->dccps_hc_rx_ccid_private = kmalloc(sizeof(*hcrx),
10891f2333aeSArnaldo Carvalho de Melo 						      gfp_any());
10907c657876SArnaldo Carvalho de Melo 	if (hcrx == NULL)
10917c657876SArnaldo Carvalho de Melo 		return -ENOMEM;
10927c657876SArnaldo Carvalho de Melo 
10937c657876SArnaldo Carvalho de Melo 	memset(hcrx, 0, sizeof(*hcrx));
10947c657876SArnaldo Carvalho de Melo 
1095a84ffe43SArnaldo Carvalho de Melo 	if (dp->dccps_packet_size >= TFRC_MIN_PACKET_SIZE &&
1096a84ffe43SArnaldo Carvalho de Melo 	    dp->dccps_packet_size <= TFRC_MAX_PACKET_SIZE)
1097a84ffe43SArnaldo Carvalho de Melo 		hcrx->ccid3hcrx_s = dp->dccps_packet_size;
10987c657876SArnaldo Carvalho de Melo 	else
10997c657876SArnaldo Carvalho de Melo 		hcrx->ccid3hcrx_s = TFRC_STD_PACKET_SIZE;
11007c657876SArnaldo Carvalho de Melo 
11017c657876SArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_state = TFRC_RSTATE_NO_DATA;
11027c657876SArnaldo Carvalho de Melo 	INIT_LIST_HEAD(&hcrx->ccid3hcrx_hist);
1103ae6706f0SArnaldo Carvalho de Melo 	INIT_LIST_HEAD(&hcrx->ccid3hcrx_li_hist);
1104b0e56780SArnaldo Carvalho de Melo 	dccp_timestamp(sk, &hcrx->ccid3hcrx_tstamp_last_ack);
1105954ee31fSArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_tstamp_last_feedback = hcrx->ccid3hcrx_tstamp_last_ack;
1106954ee31fSArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_rtt = 5000; /* XXX 5ms for now... */
11077c657876SArnaldo Carvalho de Melo 	return 0;
11087c657876SArnaldo Carvalho de Melo }
11097c657876SArnaldo Carvalho de Melo 
11107c657876SArnaldo Carvalho de Melo static void ccid3_hc_rx_exit(struct sock *sk)
11117c657876SArnaldo Carvalho de Melo {
11127c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
11137c657876SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = dp->dccps_hc_rx_ccid_private;
11147c657876SArnaldo Carvalho de Melo 
11157c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
11167c657876SArnaldo Carvalho de Melo 
11177c657876SArnaldo Carvalho de Melo 	if (hcrx == NULL)
11187c657876SArnaldo Carvalho de Melo 		return;
11197c657876SArnaldo Carvalho de Melo 
11207c657876SArnaldo Carvalho de Melo 	ccid3_hc_rx_set_state(sk, TFRC_RSTATE_TERM);
11217c657876SArnaldo Carvalho de Melo 
11227c657876SArnaldo Carvalho de Melo 	/* Empty packet history */
11238c60f3faSArnaldo Carvalho de Melo 	dccp_rx_hist_purge(ccid3_rx_hist, &hcrx->ccid3hcrx_hist);
11247c657876SArnaldo Carvalho de Melo 
11257c657876SArnaldo Carvalho de Melo 	/* Empty loss interval history */
1126ae6706f0SArnaldo Carvalho de Melo 	dccp_li_hist_purge(ccid3_li_hist, &hcrx->ccid3hcrx_li_hist);
11277c657876SArnaldo Carvalho de Melo 
11287c657876SArnaldo Carvalho de Melo 	kfree(dp->dccps_hc_rx_ccid_private);
11297c657876SArnaldo Carvalho de Melo 	dp->dccps_hc_rx_ccid_private = NULL;
11307c657876SArnaldo Carvalho de Melo }
11317c657876SArnaldo Carvalho de Melo 
11322babe1f6SArnaldo Carvalho de Melo static void ccid3_hc_rx_get_info(struct sock *sk, struct tcp_info *info)
11332babe1f6SArnaldo Carvalho de Melo {
11342babe1f6SArnaldo Carvalho de Melo 	const struct dccp_sock *dp = dccp_sk(sk);
11352babe1f6SArnaldo Carvalho de Melo 	const struct ccid3_hc_rx_sock *hcrx = dp->dccps_hc_rx_ccid_private;
11362babe1f6SArnaldo Carvalho de Melo 
11372babe1f6SArnaldo Carvalho de Melo 	if (hcrx == NULL)
11382babe1f6SArnaldo Carvalho de Melo 		return;
11392babe1f6SArnaldo Carvalho de Melo 
11402babe1f6SArnaldo Carvalho de Melo 	info->tcpi_ca_state	= hcrx->ccid3hcrx_state;
11412babe1f6SArnaldo Carvalho de Melo 	info->tcpi_options	|= TCPI_OPT_TIMESTAMPS;
11422babe1f6SArnaldo Carvalho de Melo 	info->tcpi_rcv_rtt	= hcrx->ccid3hcrx_rtt;
11432babe1f6SArnaldo Carvalho de Melo }
11442babe1f6SArnaldo Carvalho de Melo 
11452babe1f6SArnaldo Carvalho de Melo static void ccid3_hc_tx_get_info(struct sock *sk, struct tcp_info *info)
11462babe1f6SArnaldo Carvalho de Melo {
11472babe1f6SArnaldo Carvalho de Melo 	const struct dccp_sock *dp = dccp_sk(sk);
11482babe1f6SArnaldo Carvalho de Melo 	const struct ccid3_hc_tx_sock *hctx = dp->dccps_hc_tx_ccid_private;
11492babe1f6SArnaldo Carvalho de Melo 
11502babe1f6SArnaldo Carvalho de Melo 	if (hctx == NULL)
11512babe1f6SArnaldo Carvalho de Melo 		return;
11522babe1f6SArnaldo Carvalho de Melo 
11532babe1f6SArnaldo Carvalho de Melo 	info->tcpi_rto = hctx->ccid3hctx_t_rto;
11542babe1f6SArnaldo Carvalho de Melo 	info->tcpi_rtt = hctx->ccid3hctx_rtt;
11552babe1f6SArnaldo Carvalho de Melo }
11562babe1f6SArnaldo Carvalho de Melo 
11577c657876SArnaldo Carvalho de Melo static struct ccid ccid3 = {
11587c657876SArnaldo Carvalho de Melo 	.ccid_id		   = 3,
11597c657876SArnaldo Carvalho de Melo 	.ccid_name		   = "ccid3",
11607c657876SArnaldo Carvalho de Melo 	.ccid_owner		   = THIS_MODULE,
11617c657876SArnaldo Carvalho de Melo 	.ccid_init		   = ccid3_init,
11627c657876SArnaldo Carvalho de Melo 	.ccid_exit		   = ccid3_exit,
11637c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_init	   = ccid3_hc_tx_init,
11647c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_exit	   = ccid3_hc_tx_exit,
11657c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_send_packet	   = ccid3_hc_tx_send_packet,
11667c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_packet_sent	   = ccid3_hc_tx_packet_sent,
11677c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_packet_recv	   = ccid3_hc_tx_packet_recv,
11687c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_insert_options = ccid3_hc_tx_insert_options,
11697c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_parse_options  = ccid3_hc_tx_parse_options,
11707c657876SArnaldo Carvalho de Melo 	.ccid_hc_rx_init	   = ccid3_hc_rx_init,
11717c657876SArnaldo Carvalho de Melo 	.ccid_hc_rx_exit	   = ccid3_hc_rx_exit,
11727c657876SArnaldo Carvalho de Melo 	.ccid_hc_rx_insert_options = ccid3_hc_rx_insert_options,
11737c657876SArnaldo Carvalho de Melo 	.ccid_hc_rx_packet_recv	   = ccid3_hc_rx_packet_recv,
11742babe1f6SArnaldo Carvalho de Melo 	.ccid_hc_rx_get_info	   = ccid3_hc_rx_get_info,
11752babe1f6SArnaldo Carvalho de Melo 	.ccid_hc_tx_get_info	   = ccid3_hc_tx_get_info,
11767c657876SArnaldo Carvalho de Melo };
11777c657876SArnaldo Carvalho de Melo 
11787c657876SArnaldo Carvalho de Melo module_param(ccid3_debug, int, 0444);
11797c657876SArnaldo Carvalho de Melo MODULE_PARM_DESC(ccid3_debug, "Enable debug messages");
11807c657876SArnaldo Carvalho de Melo 
11817c657876SArnaldo Carvalho de Melo static __init int ccid3_module_init(void)
11827c657876SArnaldo Carvalho de Melo {
11838c60f3faSArnaldo Carvalho de Melo 	int rc = -ENOBUFS;
11847c657876SArnaldo Carvalho de Melo 
11858c60f3faSArnaldo Carvalho de Melo 	ccid3_rx_hist = dccp_rx_hist_new("ccid3");
11868c60f3faSArnaldo Carvalho de Melo 	if (ccid3_rx_hist == NULL)
11877c657876SArnaldo Carvalho de Melo 		goto out;
11887c657876SArnaldo Carvalho de Melo 
11898c60f3faSArnaldo Carvalho de Melo 	ccid3_tx_hist = dccp_tx_hist_new("ccid3");
11908c60f3faSArnaldo Carvalho de Melo 	if (ccid3_tx_hist == NULL)
11918c60f3faSArnaldo Carvalho de Melo 		goto out_free_rx;
11927c657876SArnaldo Carvalho de Melo 
1193ae6706f0SArnaldo Carvalho de Melo 	ccid3_li_hist = dccp_li_hist_new("ccid3");
1194ae6706f0SArnaldo Carvalho de Melo 	if (ccid3_li_hist == NULL)
11958c60f3faSArnaldo Carvalho de Melo 		goto out_free_tx;
11967c657876SArnaldo Carvalho de Melo 
11977c657876SArnaldo Carvalho de Melo 	rc = ccid_register(&ccid3);
11987c657876SArnaldo Carvalho de Melo 	if (rc != 0)
11997c657876SArnaldo Carvalho de Melo 		goto out_free_loss_interval_history;
12007c657876SArnaldo Carvalho de Melo out:
12017c657876SArnaldo Carvalho de Melo 	return rc;
12028c60f3faSArnaldo Carvalho de Melo 
12037c657876SArnaldo Carvalho de Melo out_free_loss_interval_history:
1204ae6706f0SArnaldo Carvalho de Melo 	dccp_li_hist_delete(ccid3_li_hist);
1205ae6706f0SArnaldo Carvalho de Melo 	ccid3_li_hist = NULL;
12068c60f3faSArnaldo Carvalho de Melo out_free_tx:
12078c60f3faSArnaldo Carvalho de Melo 	dccp_tx_hist_delete(ccid3_tx_hist);
12088c60f3faSArnaldo Carvalho de Melo 	ccid3_tx_hist = NULL;
12098c60f3faSArnaldo Carvalho de Melo out_free_rx:
12108c60f3faSArnaldo Carvalho de Melo 	dccp_rx_hist_delete(ccid3_rx_hist);
12118c60f3faSArnaldo Carvalho de Melo 	ccid3_rx_hist = NULL;
12127c657876SArnaldo Carvalho de Melo 	goto out;
12137c657876SArnaldo Carvalho de Melo }
12147c657876SArnaldo Carvalho de Melo module_init(ccid3_module_init);
12157c657876SArnaldo Carvalho de Melo 
12167c657876SArnaldo Carvalho de Melo static __exit void ccid3_module_exit(void)
12177c657876SArnaldo Carvalho de Melo {
1218725ba8eeSArnaldo Carvalho de Melo #ifdef CONFIG_IP_DCCP_UNLOAD_HACK
1219725ba8eeSArnaldo Carvalho de Melo 	/*
1220725ba8eeSArnaldo Carvalho de Melo 	 * Hack to use while developing, so that we get rid of the control
1221725ba8eeSArnaldo Carvalho de Melo 	 * sock, that is what keeps a refcount on dccp.ko -acme
1222725ba8eeSArnaldo Carvalho de Melo 	 */
1223725ba8eeSArnaldo Carvalho de Melo 	extern void dccp_ctl_sock_exit(void);
1224725ba8eeSArnaldo Carvalho de Melo 
1225725ba8eeSArnaldo Carvalho de Melo 	dccp_ctl_sock_exit();
1226725ba8eeSArnaldo Carvalho de Melo #endif
12277c657876SArnaldo Carvalho de Melo 	ccid_unregister(&ccid3);
12287c657876SArnaldo Carvalho de Melo 
12298c60f3faSArnaldo Carvalho de Melo 	if (ccid3_tx_hist != NULL) {
12308c60f3faSArnaldo Carvalho de Melo 		dccp_tx_hist_delete(ccid3_tx_hist);
12318c60f3faSArnaldo Carvalho de Melo 		ccid3_tx_hist = NULL;
12327c657876SArnaldo Carvalho de Melo 	}
12338c60f3faSArnaldo Carvalho de Melo 	if (ccid3_rx_hist != NULL) {
12348c60f3faSArnaldo Carvalho de Melo 		dccp_rx_hist_delete(ccid3_rx_hist);
12358c60f3faSArnaldo Carvalho de Melo 		ccid3_rx_hist = NULL;
12367c657876SArnaldo Carvalho de Melo 	}
1237ae6706f0SArnaldo Carvalho de Melo 	if (ccid3_li_hist != NULL) {
1238ae6706f0SArnaldo Carvalho de Melo 		dccp_li_hist_delete(ccid3_li_hist);
1239ae6706f0SArnaldo Carvalho de Melo 		ccid3_li_hist = NULL;
12407c657876SArnaldo Carvalho de Melo 	}
12417c657876SArnaldo Carvalho de Melo }
12427c657876SArnaldo Carvalho de Melo module_exit(ccid3_module_exit);
12437c657876SArnaldo Carvalho de Melo 
12441f2333aeSArnaldo Carvalho de Melo MODULE_AUTHOR("Ian McDonald <iam4@cs.waikato.ac.nz>, "
12451f2333aeSArnaldo Carvalho de Melo 	      "Arnaldo Carvalho de Melo <acme@ghostprotocols.net>");
12467c657876SArnaldo Carvalho de Melo MODULE_DESCRIPTION("DCCP TFRC CCID3 CCID");
12477c657876SArnaldo Carvalho de Melo MODULE_LICENSE("GPL");
12487c657876SArnaldo Carvalho de Melo MODULE_ALIAS("net-dccp-ccid-3");
1249