xref: /openbmc/linux/net/dccp/ccids/ccid3.c (revision f5c2d636)
17c657876SArnaldo Carvalho de Melo /*
27c657876SArnaldo Carvalho de Melo  *  net/dccp/ccids/ccid3.c
37c657876SArnaldo Carvalho de Melo  *
47c657876SArnaldo Carvalho de Melo  *  Copyright (c) 2005 The University of Waikato, Hamilton, New Zealand.
5e6bccd35SIan McDonald  *  Copyright (c) 2005-6 Ian McDonald <ian.mcdonald@jandi.co.nz>
67c657876SArnaldo Carvalho de Melo  *
77c657876SArnaldo Carvalho de Melo  *  An implementation of the DCCP protocol
87c657876SArnaldo Carvalho de Melo  *
97c657876SArnaldo Carvalho de Melo  *  This code has been developed by the University of Waikato WAND
107c657876SArnaldo Carvalho de Melo  *  research group. For further information please see http://www.wand.net.nz/
117c657876SArnaldo Carvalho de Melo  *
127c657876SArnaldo Carvalho de Melo  *  This code also uses code from Lulea University, rereleased as GPL by its
137c657876SArnaldo Carvalho de Melo  *  authors:
147c657876SArnaldo Carvalho de Melo  *  Copyright (c) 2003 Nils-Erik Mattsson, Joacim Haggmark, Magnus Erixzon
157c657876SArnaldo Carvalho de Melo  *
167c657876SArnaldo Carvalho de Melo  *  Changes to meet Linux coding standards, to make it meet latest ccid3 draft
177c657876SArnaldo Carvalho de Melo  *  and to make it work as a loadable module in the DCCP stack written by
187c657876SArnaldo Carvalho de Melo  *  Arnaldo Carvalho de Melo <acme@conectiva.com.br>.
197c657876SArnaldo Carvalho de Melo  *
207c657876SArnaldo Carvalho de Melo  *  Copyright (c) 2005 Arnaldo Carvalho de Melo <acme@conectiva.com.br>
217c657876SArnaldo Carvalho de Melo  *
227c657876SArnaldo Carvalho de Melo  *  This program is free software; you can redistribute it and/or modify
237c657876SArnaldo Carvalho de Melo  *  it under the terms of the GNU General Public License as published by
247c657876SArnaldo Carvalho de Melo  *  the Free Software Foundation; either version 2 of the License, or
257c657876SArnaldo Carvalho de Melo  *  (at your option) any later version.
267c657876SArnaldo Carvalho de Melo  *
277c657876SArnaldo Carvalho de Melo  *  This program is distributed in the hope that it will be useful,
287c657876SArnaldo Carvalho de Melo  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
297c657876SArnaldo Carvalho de Melo  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
307c657876SArnaldo Carvalho de Melo  *  GNU General Public License for more details.
317c657876SArnaldo Carvalho de Melo  *
327c657876SArnaldo Carvalho de Melo  *  You should have received a copy of the GNU General Public License
337c657876SArnaldo Carvalho de Melo  *  along with this program; if not, write to the Free Software
347c657876SArnaldo Carvalho de Melo  *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
357c657876SArnaldo Carvalho de Melo  */
367c657876SArnaldo Carvalho de Melo 
377c657876SArnaldo Carvalho de Melo #include "../ccid.h"
387c657876SArnaldo Carvalho de Melo #include "../dccp.h"
394524b259SArnaldo Carvalho de Melo #include "lib/packet_history.h"
40ae6706f0SArnaldo Carvalho de Melo #include "lib/loss_interval.h"
4136729c1aSArnaldo Carvalho de Melo #include "lib/tfrc.h"
427c657876SArnaldo Carvalho de Melo #include "ccid3.h"
437c657876SArnaldo Carvalho de Melo 
446b5e633aSArnaldo Carvalho de Melo /*
450ba7a3baSArnaldo Carvalho de Melo  * Reason for maths here is to avoid 32 bit overflow when a is big.
460ba7a3baSArnaldo Carvalho de Melo  * With this we get close to the limit.
476b5e633aSArnaldo Carvalho de Melo  */
48c25a18baSArnaldo Carvalho de Melo static u32 usecs_div(const u32 a, const u32 b)
496b5e633aSArnaldo Carvalho de Melo {
500ba7a3baSArnaldo Carvalho de Melo 	const u32 div = a < (UINT_MAX / (USEC_PER_SEC /    10)) ?    10 :
510ba7a3baSArnaldo Carvalho de Melo 			a < (UINT_MAX / (USEC_PER_SEC /    50)) ?    50 :
520ba7a3baSArnaldo Carvalho de Melo 			a < (UINT_MAX / (USEC_PER_SEC /   100)) ?   100 :
530ba7a3baSArnaldo Carvalho de Melo 			a < (UINT_MAX / (USEC_PER_SEC /   500)) ?   500 :
540ba7a3baSArnaldo Carvalho de Melo 			a < (UINT_MAX / (USEC_PER_SEC /  1000)) ?  1000 :
550ba7a3baSArnaldo Carvalho de Melo 			a < (UINT_MAX / (USEC_PER_SEC /  5000)) ?  5000 :
560ba7a3baSArnaldo Carvalho de Melo 			a < (UINT_MAX / (USEC_PER_SEC / 10000)) ? 10000 :
570ba7a3baSArnaldo Carvalho de Melo 			a < (UINT_MAX / (USEC_PER_SEC / 50000)) ? 50000 :
580ba7a3baSArnaldo Carvalho de Melo 								 100000;
590ba7a3baSArnaldo Carvalho de Melo 	const u32 tmp = a * (USEC_PER_SEC / div);
600ba7a3baSArnaldo Carvalho de Melo 	return (b >= 2 * div) ? tmp / (b / div) : tmp;
616b5e633aSArnaldo Carvalho de Melo }
626b5e633aSArnaldo Carvalho de Melo 
637c657876SArnaldo Carvalho de Melo 
6456724aa4SGerrit Renker 
6556724aa4SGerrit Renker #ifdef CONFIG_IP_DCCP_CCID3_DEBUG
6656724aa4SGerrit Renker static int ccid3_debug;
6756724aa4SGerrit Renker #define ccid3_pr_debug(format, a...)	DCCP_PR_DEBUG(ccid3_debug, format, ##a)
687c657876SArnaldo Carvalho de Melo #else
697c657876SArnaldo Carvalho de Melo #define ccid3_pr_debug(format, a...)
707c657876SArnaldo Carvalho de Melo #endif
717c657876SArnaldo Carvalho de Melo 
72a1d3a355SArnaldo Carvalho de Melo static struct dccp_tx_hist *ccid3_tx_hist;
73a1d3a355SArnaldo Carvalho de Melo static struct dccp_rx_hist *ccid3_rx_hist;
74ae6706f0SArnaldo Carvalho de Melo static struct dccp_li_hist *ccid3_li_hist;
757c657876SArnaldo Carvalho de Melo 
7656724aa4SGerrit Renker #ifdef CONFIG_IP_DCCP_CCID3_DEBUG
777c657876SArnaldo Carvalho de Melo static const char *ccid3_tx_state_name(enum ccid3_hc_tx_states state)
787c657876SArnaldo Carvalho de Melo {
797c657876SArnaldo Carvalho de Melo 	static char *ccid3_state_names[] = {
807c657876SArnaldo Carvalho de Melo 	[TFRC_SSTATE_NO_SENT]  = "NO_SENT",
817c657876SArnaldo Carvalho de Melo 	[TFRC_SSTATE_NO_FBACK] = "NO_FBACK",
827c657876SArnaldo Carvalho de Melo 	[TFRC_SSTATE_FBACK]    = "FBACK",
837c657876SArnaldo Carvalho de Melo 	[TFRC_SSTATE_TERM]     = "TERM",
847c657876SArnaldo Carvalho de Melo 	};
857c657876SArnaldo Carvalho de Melo 
867c657876SArnaldo Carvalho de Melo 	return ccid3_state_names[state];
877c657876SArnaldo Carvalho de Melo }
887c657876SArnaldo Carvalho de Melo #endif
897c657876SArnaldo Carvalho de Melo 
90c25a18baSArnaldo Carvalho de Melo static void ccid3_hc_tx_set_state(struct sock *sk,
911f2333aeSArnaldo Carvalho de Melo 				  enum ccid3_hc_tx_states state)
927c657876SArnaldo Carvalho de Melo {
9359725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
947c657876SArnaldo Carvalho de Melo 	enum ccid3_hc_tx_states oldstate = hctx->ccid3hctx_state;
957c657876SArnaldo Carvalho de Melo 
967c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s(%p) %-8.8s -> %s\n",
971f2333aeSArnaldo Carvalho de Melo 		       dccp_role(sk), sk, ccid3_tx_state_name(oldstate),
981f2333aeSArnaldo Carvalho de Melo 		       ccid3_tx_state_name(state));
997c657876SArnaldo Carvalho de Melo 	WARN_ON(state == oldstate);
1007c657876SArnaldo Carvalho de Melo 	hctx->ccid3hctx_state = state;
1017c657876SArnaldo Carvalho de Melo }
1027c657876SArnaldo Carvalho de Melo 
1037c657876SArnaldo Carvalho de Melo /* Calculate new t_ipi (inter packet interval) by t_ipi = s / X_inst */
1047c657876SArnaldo Carvalho de Melo static inline void ccid3_calc_new_t_ipi(struct ccid3_hc_tx_sock *hctx)
1057c657876SArnaldo Carvalho de Melo {
106f5c2d636SGerrit Renker 	hctx->ccid3hctx_t_ipi = usecs_div(hctx->ccid3hctx_s, hctx->ccid3hctx_x);
1077c657876SArnaldo Carvalho de Melo }
1087c657876SArnaldo Carvalho de Melo 
1097c657876SArnaldo Carvalho de Melo /* Calculate new delta by delta = min(t_ipi / 2, t_gran / 2) */
1107c657876SArnaldo Carvalho de Melo static inline void ccid3_calc_new_delta(struct ccid3_hc_tx_sock *hctx)
1117c657876SArnaldo Carvalho de Melo {
1121f2333aeSArnaldo Carvalho de Melo 	hctx->ccid3hctx_delta = min_t(u32, hctx->ccid3hctx_t_ipi / 2,
1131f2333aeSArnaldo Carvalho de Melo 					   TFRC_OPSYS_HALF_TIME_GRAN);
1147c657876SArnaldo Carvalho de Melo }
1157c657876SArnaldo Carvalho de Melo 
1167c657876SArnaldo Carvalho de Melo /*
1177c657876SArnaldo Carvalho de Melo  * Update X by
1187c657876SArnaldo Carvalho de Melo  *    If (p > 0)
1197c657876SArnaldo Carvalho de Melo  *       x_calc = calcX(s, R, p);
1207c657876SArnaldo Carvalho de Melo  *       X = max(min(X_calc, 2 * X_recv), s / t_mbi);
1217c657876SArnaldo Carvalho de Melo  *    Else
1227c657876SArnaldo Carvalho de Melo  *       If (now - tld >= R)
1237c657876SArnaldo Carvalho de Melo  *          X = max(min(2 * X, 2 * X_recv), s / R);
1247c657876SArnaldo Carvalho de Melo  *          tld = now;
1257c657876SArnaldo Carvalho de Melo  */
1267c657876SArnaldo Carvalho de Melo static void ccid3_hc_tx_update_x(struct sock *sk)
1277c657876SArnaldo Carvalho de Melo {
12859725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
1297c657876SArnaldo Carvalho de Melo 
1301f2333aeSArnaldo Carvalho de Melo 	/* To avoid large error in calcX */
1311f2333aeSArnaldo Carvalho de Melo 	if (hctx->ccid3hctx_p >= TFRC_SMALLEST_P) {
13236729c1aSArnaldo Carvalho de Melo 		hctx->ccid3hctx_x_calc = tfrc_calc_x(hctx->ccid3hctx_s,
1337c657876SArnaldo Carvalho de Melo 						     hctx->ccid3hctx_rtt,
1347c657876SArnaldo Carvalho de Melo 						     hctx->ccid3hctx_p);
1351f2333aeSArnaldo Carvalho de Melo 		hctx->ccid3hctx_x = max_t(u32, min_t(u32, hctx->ccid3hctx_x_calc,
1361f2333aeSArnaldo Carvalho de Melo 							  2 * hctx->ccid3hctx_x_recv),
1371f2333aeSArnaldo Carvalho de Melo 					       (hctx->ccid3hctx_s /
1381f2333aeSArnaldo Carvalho de Melo 					        TFRC_MAX_BACK_OFF_TIME));
139b6ee3d4aSArnaldo Carvalho de Melo 	} else {
140b6ee3d4aSArnaldo Carvalho de Melo 		struct timeval now;
141b6ee3d4aSArnaldo Carvalho de Melo 
142b0e56780SArnaldo Carvalho de Melo 		dccp_timestamp(sk, &now);
143b6ee3d4aSArnaldo Carvalho de Melo 	       	if (timeval_delta(&now, &hctx->ccid3hctx_t_ld) >=
144b6ee3d4aSArnaldo Carvalho de Melo 		    hctx->ccid3hctx_rtt) {
1456b5e633aSArnaldo Carvalho de Melo 			hctx->ccid3hctx_x = max_t(u32, min_t(u32, hctx->ccid3hctx_x_recv,
1466b5e633aSArnaldo Carvalho de Melo 								  hctx->ccid3hctx_x) * 2,
1476b5e633aSArnaldo Carvalho de Melo 						       usecs_div(hctx->ccid3hctx_s,
1486b5e633aSArnaldo Carvalho de Melo 							       	 hctx->ccid3hctx_rtt));
149b6ee3d4aSArnaldo Carvalho de Melo 			hctx->ccid3hctx_t_ld = now;
150b6ee3d4aSArnaldo Carvalho de Melo 		}
1517c657876SArnaldo Carvalho de Melo 	}
1527c657876SArnaldo Carvalho de Melo }
1537c657876SArnaldo Carvalho de Melo 
1547c657876SArnaldo Carvalho de Melo static void ccid3_hc_tx_no_feedback_timer(unsigned long data)
1557c657876SArnaldo Carvalho de Melo {
1567c657876SArnaldo Carvalho de Melo 	struct sock *sk = (struct sock *)data;
1577c657876SArnaldo Carvalho de Melo 	unsigned long next_tmout = 0;
15859725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
1597c657876SArnaldo Carvalho de Melo 
1607c657876SArnaldo Carvalho de Melo 	bh_lock_sock(sk);
1617c657876SArnaldo Carvalho de Melo 	if (sock_owned_by_user(sk)) {
1627c657876SArnaldo Carvalho de Melo 		/* Try again later. */
1637c657876SArnaldo Carvalho de Melo 		/* XXX: set some sensible MIB */
1641f2333aeSArnaldo Carvalho de Melo 		sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
1651f2333aeSArnaldo Carvalho de Melo 			       jiffies + HZ / 5);
1667c657876SArnaldo Carvalho de Melo 		goto out;
1677c657876SArnaldo Carvalho de Melo 	}
1687c657876SArnaldo Carvalho de Melo 
1697c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p, state=%s\n", dccp_role(sk), sk,
1707c657876SArnaldo Carvalho de Melo 		       ccid3_tx_state_name(hctx->ccid3hctx_state));
1717c657876SArnaldo Carvalho de Melo 
1727c657876SArnaldo Carvalho de Melo 	switch (hctx->ccid3hctx_state) {
1737c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_FBACK:
1747c657876SArnaldo Carvalho de Melo 		/* Halve send rate */
1757c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_x /= 2;
1766b5e633aSArnaldo Carvalho de Melo 		if (hctx->ccid3hctx_x < (hctx->ccid3hctx_s /
1776b5e633aSArnaldo Carvalho de Melo 					 TFRC_MAX_BACK_OFF_TIME))
1781f2333aeSArnaldo Carvalho de Melo 			hctx->ccid3hctx_x = (hctx->ccid3hctx_s /
1791f2333aeSArnaldo Carvalho de Melo 					     TFRC_MAX_BACK_OFF_TIME);
1807c657876SArnaldo Carvalho de Melo 
1811f2333aeSArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p, state=%s, updated tx rate to %d "
1821f2333aeSArnaldo Carvalho de Melo 			       "bytes/s\n",
1831f2333aeSArnaldo Carvalho de Melo 			       dccp_role(sk), sk,
1841f2333aeSArnaldo Carvalho de Melo 			       ccid3_tx_state_name(hctx->ccid3hctx_state),
1857c657876SArnaldo Carvalho de Melo 			       hctx->ccid3hctx_x);
1866b5e633aSArnaldo Carvalho de Melo 		next_tmout = max_t(u32, 2 * usecs_div(hctx->ccid3hctx_s,
1876b5e633aSArnaldo Carvalho de Melo 						      hctx->ccid3hctx_x),
1881f2333aeSArnaldo Carvalho de Melo 					TFRC_INITIAL_TIMEOUT);
1891f2333aeSArnaldo Carvalho de Melo 		/*
1901f2333aeSArnaldo Carvalho de Melo 		 * FIXME - not sure above calculation is correct. See section
1911f2333aeSArnaldo Carvalho de Melo 		 * 5 of CCID3 11 should adjust tx_t_ipi and double that to
1921f2333aeSArnaldo Carvalho de Melo 		 * achieve it really
1931f2333aeSArnaldo Carvalho de Melo 		 */
1947c657876SArnaldo Carvalho de Melo 		break;
1957c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_FBACK:
1961f2333aeSArnaldo Carvalho de Melo 		/*
1971f2333aeSArnaldo Carvalho de Melo 		 * Check if IDLE since last timeout and recv rate is less than
1981f2333aeSArnaldo Carvalho de Melo 		 * 4 packets per RTT
1991f2333aeSArnaldo Carvalho de Melo 		 */
2001f2333aeSArnaldo Carvalho de Melo 		if (!hctx->ccid3hctx_idle ||
2016b5e633aSArnaldo Carvalho de Melo 		    (hctx->ccid3hctx_x_recv >=
2026b5e633aSArnaldo Carvalho de Melo 		     4 * usecs_div(hctx->ccid3hctx_s, hctx->ccid3hctx_rtt))) {
2031f2333aeSArnaldo Carvalho de Melo 			ccid3_pr_debug("%s, sk=%p, state=%s, not idle\n",
2041f2333aeSArnaldo Carvalho de Melo 				       dccp_role(sk), sk,
2057c657876SArnaldo Carvalho de Melo 				       ccid3_tx_state_name(hctx->ccid3hctx_state));
2067c657876SArnaldo Carvalho de Melo 			/* Halve sending rate */
2077c657876SArnaldo Carvalho de Melo 
2087c657876SArnaldo Carvalho de Melo 			/*  If (X_calc > 2 * X_recv)
2097c657876SArnaldo Carvalho de Melo 			 *    X_recv = max(X_recv / 2, s / (2 * t_mbi));
2107c657876SArnaldo Carvalho de Melo 			 *  Else
2117c657876SArnaldo Carvalho de Melo 			 *    X_recv = X_calc / 4;
2127c657876SArnaldo Carvalho de Melo 			 */
2131f2333aeSArnaldo Carvalho de Melo 			BUG_ON(hctx->ccid3hctx_p >= TFRC_SMALLEST_P &&
2141f2333aeSArnaldo Carvalho de Melo 			       hctx->ccid3hctx_x_calc == 0);
2157c657876SArnaldo Carvalho de Melo 
2167c657876SArnaldo Carvalho de Melo 			/* check also if p is zero -> x_calc is infinity? */
2177c657876SArnaldo Carvalho de Melo 			if (hctx->ccid3hctx_p < TFRC_SMALLEST_P ||
2187c657876SArnaldo Carvalho de Melo 			    hctx->ccid3hctx_x_calc > 2 * hctx->ccid3hctx_x_recv)
2197c657876SArnaldo Carvalho de Melo 				hctx->ccid3hctx_x_recv = max_t(u32, hctx->ccid3hctx_x_recv / 2,
2207c657876SArnaldo Carvalho de Melo 								    hctx->ccid3hctx_s / (2 * TFRC_MAX_BACK_OFF_TIME));
2217c657876SArnaldo Carvalho de Melo 			else
2227c657876SArnaldo Carvalho de Melo 				hctx->ccid3hctx_x_recv = hctx->ccid3hctx_x_calc / 4;
2237c657876SArnaldo Carvalho de Melo 
2247c657876SArnaldo Carvalho de Melo 			/* Update sending rate */
2257c657876SArnaldo Carvalho de Melo 			ccid3_hc_tx_update_x(sk);
2267c657876SArnaldo Carvalho de Melo 		}
2276b5e633aSArnaldo Carvalho de Melo 		/*
2286b5e633aSArnaldo Carvalho de Melo 		 * Schedule no feedback timer to expire in
2296b5e633aSArnaldo Carvalho de Melo 		 * max(4 * R, 2 * s / X)
2306b5e633aSArnaldo Carvalho de Melo 		 */
231c68e64cfSArnaldo Carvalho de Melo 		next_tmout = max_t(u32, hctx->ccid3hctx_t_rto,
2326b5e633aSArnaldo Carvalho de Melo 					2 * usecs_div(hctx->ccid3hctx_s,
2336b5e633aSArnaldo Carvalho de Melo 						      hctx->ccid3hctx_x));
2347c657876SArnaldo Carvalho de Melo 		break;
23559348b19SGerrit Renker 	case TFRC_SSTATE_NO_SENT:
23659348b19SGerrit Renker 		DCCP_BUG("Illegal %s state NO_SENT, sk=%p", dccp_role(sk), sk);
23759348b19SGerrit Renker 		/* fall through */
23859348b19SGerrit Renker 	case TFRC_SSTATE_TERM:
2397c657876SArnaldo Carvalho de Melo 		goto out;
2407c657876SArnaldo Carvalho de Melo 	}
2417c657876SArnaldo Carvalho de Melo 
2427c657876SArnaldo Carvalho de Melo 	sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
2437c657876SArnaldo Carvalho de Melo 		      jiffies + max_t(u32, 1, usecs_to_jiffies(next_tmout)));
2447c657876SArnaldo Carvalho de Melo 	hctx->ccid3hctx_idle = 1;
2457c657876SArnaldo Carvalho de Melo out:
2467c657876SArnaldo Carvalho de Melo 	bh_unlock_sock(sk);
2477c657876SArnaldo Carvalho de Melo 	sock_put(sk);
2487c657876SArnaldo Carvalho de Melo }
2497c657876SArnaldo Carvalho de Melo 
25027258ee5SArnaldo Carvalho de Melo static int ccid3_hc_tx_send_packet(struct sock *sk,
25127258ee5SArnaldo Carvalho de Melo 				   struct sk_buff *skb, int len)
2527c657876SArnaldo Carvalho de Melo {
2537c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
25459725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
2558c60f3faSArnaldo Carvalho de Melo 	struct dccp_tx_hist_entry *new_packet;
2567c657876SArnaldo Carvalho de Melo 	struct timeval now;
25727258ee5SArnaldo Carvalho de Melo 	long delay;
2587c657876SArnaldo Carvalho de Melo 	int rc = -ENOTCONN;
2597c657876SArnaldo Carvalho de Melo 
26059348b19SGerrit Renker 	BUG_ON(hctx == NULL);
2611f2333aeSArnaldo Carvalho de Melo 
26259d203f9SArnaldo Carvalho de Melo 	/* Check if pure ACK or Terminating*/
2637c657876SArnaldo Carvalho de Melo 	/*
2641f2333aeSArnaldo Carvalho de Melo 	 * XXX: We only call this function for DATA and DATAACK, on, these
2651f2333aeSArnaldo Carvalho de Melo 	 * packets can have zero length, but why the comment about "pure ACK"?
2667c657876SArnaldo Carvalho de Melo 	 */
26759d203f9SArnaldo Carvalho de Melo 	if (unlikely(len == 0))
2687c657876SArnaldo Carvalho de Melo 		goto out;
2697c657876SArnaldo Carvalho de Melo 
2707c657876SArnaldo Carvalho de Melo 	/* See if last packet allocated was not sent */
2718c60f3faSArnaldo Carvalho de Melo 	new_packet = dccp_tx_hist_head(&hctx->ccid3hctx_hist);
2728c60f3faSArnaldo Carvalho de Melo 	if (new_packet == NULL || new_packet->dccphtx_sent) {
2731f2333aeSArnaldo Carvalho de Melo 		new_packet = dccp_tx_hist_entry_new(ccid3_tx_hist,
2741f2333aeSArnaldo Carvalho de Melo 						    SLAB_ATOMIC);
2757c657876SArnaldo Carvalho de Melo 
2767c657876SArnaldo Carvalho de Melo 		rc = -ENOBUFS;
27759d203f9SArnaldo Carvalho de Melo 		if (unlikely(new_packet == NULL)) {
27859348b19SGerrit Renker 			DCCP_WARN("%s, sk=%p, not enough mem to add to history,"
27959348b19SGerrit Renker 				  "send refused\n", dccp_role(sk), sk);
2807c657876SArnaldo Carvalho de Melo 			goto out;
2817c657876SArnaldo Carvalho de Melo 		}
2827c657876SArnaldo Carvalho de Melo 
2838c60f3faSArnaldo Carvalho de Melo 		dccp_tx_hist_add_entry(&hctx->ccid3hctx_hist, new_packet);
2847c657876SArnaldo Carvalho de Melo 	}
2857c657876SArnaldo Carvalho de Melo 
286b0e56780SArnaldo Carvalho de Melo 	dccp_timestamp(sk, &now);
2877c657876SArnaldo Carvalho de Melo 
2887c657876SArnaldo Carvalho de Melo 	switch (hctx->ccid3hctx_state) {
2897c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_SENT:
2901f2333aeSArnaldo Carvalho de Melo 		sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
2911f2333aeSArnaldo Carvalho de Melo 			       jiffies + usecs_to_jiffies(TFRC_INITIAL_TIMEOUT));
2927c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_last_win_count	 = 0;
2937c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_t_last_win_count = now;
2947c657876SArnaldo Carvalho de Melo 		ccid3_hc_tx_set_state(sk, TFRC_SSTATE_NO_FBACK);
2957c657876SArnaldo Carvalho de Melo 
29690feeb95SGerrit Renker 		/* First timeout, according to [RFC 3448, 4.2], is 1 second */
29790feeb95SGerrit Renker 		hctx->ccid3hctx_t_ipi = USEC_PER_SEC;
29890feeb95SGerrit Renker 		/* Initial delta: minimum of 0.5 sec and t_gran/2 */
29990feeb95SGerrit Renker 		hctx->ccid3hctx_delta = TFRC_OPSYS_HALF_TIME_GRAN;
30090feeb95SGerrit Renker 
30190feeb95SGerrit Renker 		/* Set t_0 for initial packet */
3027c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_t_nom = now;
3037c657876SArnaldo Carvalho de Melo 		rc = 0;
3047c657876SArnaldo Carvalho de Melo 		break;
3057c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_FBACK:
3067c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_FBACK:
307b6ee3d4aSArnaldo Carvalho de Melo 		delay = (timeval_delta(&now, &hctx->ccid3hctx_t_nom) -
308b6ee3d4aSArnaldo Carvalho de Melo 		         hctx->ccid3hctx_delta);
30927258ee5SArnaldo Carvalho de Melo 		delay /= -1000;
3107c657876SArnaldo Carvalho de Melo 		/* divide by -1000 is to convert to ms and get sign right */
311d6809c12SArnaldo Carvalho de Melo 		rc = delay > 0 ? delay : 0;
3127c657876SArnaldo Carvalho de Melo 		break;
31359348b19SGerrit Renker 	case TFRC_SSTATE_TERM:
31459348b19SGerrit Renker 		DCCP_BUG("Illegal %s state TERM, sk=%p", dccp_role(sk), sk);
3157c657876SArnaldo Carvalho de Melo 		rc = -EINVAL;
3167c657876SArnaldo Carvalho de Melo 		break;
3177c657876SArnaldo Carvalho de Melo 	}
3187c657876SArnaldo Carvalho de Melo 
3197c657876SArnaldo Carvalho de Melo 	/* Can we send? if so add options and add to packet history */
320507d37cfSArnaldo Carvalho de Melo 	if (rc == 0) {
321507d37cfSArnaldo Carvalho de Melo 		dp->dccps_hc_tx_insert_options = 1;
322c1734376SArnaldo Carvalho de Melo 		new_packet->dccphtx_ccval =
3238c60f3faSArnaldo Carvalho de Melo 			DCCP_SKB_CB(skb)->dccpd_ccval =
3248c60f3faSArnaldo Carvalho de Melo 				hctx->ccid3hctx_last_win_count;
32566a377c5SIan McDonald 		timeval_add_usecs(&hctx->ccid3hctx_t_nom,
32666a377c5SIan McDonald 				  hctx->ccid3hctx_t_ipi);
327507d37cfSArnaldo Carvalho de Melo 	}
3287c657876SArnaldo Carvalho de Melo out:
3297c657876SArnaldo Carvalho de Melo 	return rc;
3307c657876SArnaldo Carvalho de Melo }
3317c657876SArnaldo Carvalho de Melo 
3327c657876SArnaldo Carvalho de Melo static void ccid3_hc_tx_packet_sent(struct sock *sk, int more, int len)
3337c657876SArnaldo Carvalho de Melo {
33459725dc2SArnaldo Carvalho de Melo 	const struct dccp_sock *dp = dccp_sk(sk);
33559725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
3367c657876SArnaldo Carvalho de Melo 	struct timeval now;
3377c657876SArnaldo Carvalho de Melo 
33859348b19SGerrit Renker 	BUG_ON(hctx == NULL);
3397c657876SArnaldo Carvalho de Melo 
340b0e56780SArnaldo Carvalho de Melo 	dccp_timestamp(sk, &now);
3417c657876SArnaldo Carvalho de Melo 
3427c657876SArnaldo Carvalho de Melo 	/* check if we have sent a data packet */
3437c657876SArnaldo Carvalho de Melo 	if (len > 0) {
3447c657876SArnaldo Carvalho de Melo 		unsigned long quarter_rtt;
3458c60f3faSArnaldo Carvalho de Melo 		struct dccp_tx_hist_entry *packet;
3467c657876SArnaldo Carvalho de Melo 
3478c60f3faSArnaldo Carvalho de Melo 		packet = dccp_tx_hist_head(&hctx->ccid3hctx_hist);
34859d203f9SArnaldo Carvalho de Melo 		if (unlikely(packet == NULL)) {
34959348b19SGerrit Renker 			DCCP_WARN("packet doesn't exist in history!\n");
3507c657876SArnaldo Carvalho de Melo 			return;
3517c657876SArnaldo Carvalho de Melo 		}
35259d203f9SArnaldo Carvalho de Melo 		if (unlikely(packet->dccphtx_sent)) {
35359348b19SGerrit Renker 			DCCP_WARN("no unsent packet in history!\n");
3547c657876SArnaldo Carvalho de Melo 			return;
3557c657876SArnaldo Carvalho de Melo 		}
3568c60f3faSArnaldo Carvalho de Melo 		packet->dccphtx_tstamp = now;
3578c60f3faSArnaldo Carvalho de Melo 		packet->dccphtx_seqno  = dp->dccps_gss;
3587c657876SArnaldo Carvalho de Melo 		/*
3591f2333aeSArnaldo Carvalho de Melo 		 * Check if win_count have changed
3600e64e94eSGerrit Renker 		 * Algorithm in "8.1. Window Counter Value" in RFC 4342.
3617c657876SArnaldo Carvalho de Melo 		 */
3626b5e633aSArnaldo Carvalho de Melo 		quarter_rtt = timeval_delta(&now, &hctx->ccid3hctx_t_last_win_count);
3636b5e633aSArnaldo Carvalho de Melo 		if (likely(hctx->ccid3hctx_rtt > 8))
3646b5e633aSArnaldo Carvalho de Melo 			quarter_rtt /= hctx->ccid3hctx_rtt / 4;
3656b5e633aSArnaldo Carvalho de Melo 
3667c657876SArnaldo Carvalho de Melo 		if (quarter_rtt > 0) {
3677c657876SArnaldo Carvalho de Melo 			hctx->ccid3hctx_t_last_win_count = now;
3687c657876SArnaldo Carvalho de Melo 			hctx->ccid3hctx_last_win_count	 = (hctx->ccid3hctx_last_win_count +
3697c657876SArnaldo Carvalho de Melo 							    min_t(unsigned long, quarter_rtt, 5)) % 16;
3701f2333aeSArnaldo Carvalho de Melo 			ccid3_pr_debug("%s, sk=%p, window changed from "
3711f2333aeSArnaldo Carvalho de Melo 				       "%u to %u!\n",
3727c657876SArnaldo Carvalho de Melo 				       dccp_role(sk), sk,
373c1734376SArnaldo Carvalho de Melo 				       packet->dccphtx_ccval,
3747c657876SArnaldo Carvalho de Melo 				       hctx->ccid3hctx_last_win_count);
3757c657876SArnaldo Carvalho de Melo 		}
3761f2333aeSArnaldo Carvalho de Melo 
3777c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_idle = 0;
378c1734376SArnaldo Carvalho de Melo 		packet->dccphtx_rtt  = hctx->ccid3hctx_rtt;
3798c60f3faSArnaldo Carvalho de Melo 		packet->dccphtx_sent = 1;
3807c657876SArnaldo Carvalho de Melo 	} else
3817c657876SArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p, seqno=%llu NOT inserted!\n",
3827c657876SArnaldo Carvalho de Melo 			       dccp_role(sk), sk, dp->dccps_gss);
3837c657876SArnaldo Carvalho de Melo 
3847c657876SArnaldo Carvalho de Melo 	switch (hctx->ccid3hctx_state) {
3857c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_SENT:
3867c657876SArnaldo Carvalho de Melo 		/* if first wasn't pure ack */
3877c657876SArnaldo Carvalho de Melo 		if (len != 0)
38859348b19SGerrit Renker 			DCCP_CRIT("%s, First packet sent is noted "
38959348b19SGerrit Renker 				  "as a data packet",  dccp_role(sk));
3907c657876SArnaldo Carvalho de Melo 		return;
3917c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_FBACK:
392f5c2d636SGerrit Renker 		/* t_nom, t_ipi, delta do not change until feedback arrives */
393f5c2d636SGerrit Renker 		return;
3947c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_FBACK:
3957c657876SArnaldo Carvalho de Melo 		if (len > 0) {
39666a377c5SIan McDonald 			timeval_sub_usecs(&hctx->ccid3hctx_t_nom,
39766a377c5SIan McDonald 				  hctx->ccid3hctx_t_ipi);
3987c657876SArnaldo Carvalho de Melo 			ccid3_calc_new_t_ipi(hctx);
3997c657876SArnaldo Carvalho de Melo 			ccid3_calc_new_delta(hctx);
400b6ee3d4aSArnaldo Carvalho de Melo 			timeval_add_usecs(&hctx->ccid3hctx_t_nom,
401b6ee3d4aSArnaldo Carvalho de Melo 					  hctx->ccid3hctx_t_ipi);
4027c657876SArnaldo Carvalho de Melo 		}
4037c657876SArnaldo Carvalho de Melo 		break;
40459348b19SGerrit Renker 	case TFRC_SSTATE_TERM:
40559348b19SGerrit Renker 		DCCP_BUG("Illegal %s state TERM, sk=%p", dccp_role(sk), sk);
4067c657876SArnaldo Carvalho de Melo 		break;
4077c657876SArnaldo Carvalho de Melo 	}
4087c657876SArnaldo Carvalho de Melo }
4097c657876SArnaldo Carvalho de Melo 
4107c657876SArnaldo Carvalho de Melo static void ccid3_hc_tx_packet_recv(struct sock *sk, struct sk_buff *skb)
4117c657876SArnaldo Carvalho de Melo {
41259725dc2SArnaldo Carvalho de Melo 	const struct dccp_sock *dp = dccp_sk(sk);
41359725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
4147c657876SArnaldo Carvalho de Melo 	struct ccid3_options_received *opt_recv;
4158c60f3faSArnaldo Carvalho de Melo 	struct dccp_tx_hist_entry *packet;
416b0e56780SArnaldo Carvalho de Melo 	struct timeval now;
4177c657876SArnaldo Carvalho de Melo 	unsigned long next_tmout;
4181bc09869SIan McDonald 	u32 t_elapsed;
4197c657876SArnaldo Carvalho de Melo 	u32 pinv;
4207c657876SArnaldo Carvalho de Melo 	u32 x_recv;
4217c657876SArnaldo Carvalho de Melo 	u32 r_sample;
4221f2333aeSArnaldo Carvalho de Melo 
42359348b19SGerrit Renker 	BUG_ON(hctx == NULL);
4247c657876SArnaldo Carvalho de Melo 
4257c657876SArnaldo Carvalho de Melo 	/* we are only interested in ACKs */
4267c657876SArnaldo Carvalho de Melo 	if (!(DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_ACK ||
4277c657876SArnaldo Carvalho de Melo 	      DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_DATAACK))
4287c657876SArnaldo Carvalho de Melo 		return;
4297c657876SArnaldo Carvalho de Melo 
4307c657876SArnaldo Carvalho de Melo 	opt_recv = &hctx->ccid3hctx_options_received;
4317c657876SArnaldo Carvalho de Melo 
4321a28599aSArnaldo Carvalho de Melo 	t_elapsed = dp->dccps_options_received.dccpor_elapsed_time * 10;
4337c657876SArnaldo Carvalho de Melo 	x_recv = opt_recv->ccid3or_receive_rate;
4347c657876SArnaldo Carvalho de Melo 	pinv = opt_recv->ccid3or_loss_event_rate;
4357c657876SArnaldo Carvalho de Melo 
4367c657876SArnaldo Carvalho de Melo 	switch (hctx->ccid3hctx_state) {
4377c657876SArnaldo Carvalho de Melo 	case TFRC_SSTATE_NO_SENT:
4387c657876SArnaldo Carvalho de Melo 		/* FIXME: what to do here? */
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 		/* Calculate new round trip sample by
4437c657876SArnaldo Carvalho de Melo 		 * R_sample = (now - t_recvdata) - t_delay */
4447c657876SArnaldo Carvalho de Melo 		/* get t_recvdata from history */
4458c60f3faSArnaldo Carvalho de Melo 		packet = dccp_tx_hist_find_entry(&hctx->ccid3hctx_hist,
4468c60f3faSArnaldo Carvalho de Melo 						 DCCP_SKB_CB(skb)->dccpd_ack_seq);
44759d203f9SArnaldo Carvalho de Melo 		if (unlikely(packet == NULL)) {
44859348b19SGerrit Renker 			DCCP_WARN("%s, sk=%p, seqno %llu(%s) does't exist "
44959348b19SGerrit Renker 				  "in history!\n",  dccp_role(sk), sk,
45059d203f9SArnaldo Carvalho de Melo 			    (unsigned long long)DCCP_SKB_CB(skb)->dccpd_ack_seq,
4517c657876SArnaldo Carvalho de Melo 				  dccp_packet_name(DCCP_SKB_CB(skb)->dccpd_type));
4527c657876SArnaldo Carvalho de Melo 			return;
4537c657876SArnaldo Carvalho de Melo 		}
4547c657876SArnaldo Carvalho de Melo 
4557c657876SArnaldo Carvalho de Melo 		/* Update RTT */
456b0e56780SArnaldo Carvalho de Melo 		dccp_timestamp(sk, &now);
457b0e56780SArnaldo Carvalho de Melo 		r_sample = timeval_delta(&now, &packet->dccphtx_tstamp);
4581a28599aSArnaldo Carvalho de Melo 		if (unlikely(r_sample <= t_elapsed))
45959348b19SGerrit Renker 			DCCP_WARN("r_sample=%uus,t_elapsed=%uus\n",
46059348b19SGerrit Renker 				  r_sample, t_elapsed);
4611a28599aSArnaldo Carvalho de Melo 		else
4621a28599aSArnaldo Carvalho de Melo 			r_sample -= t_elapsed;
4637c657876SArnaldo Carvalho de Melo 
4647c657876SArnaldo Carvalho de Melo 		/* Update RTT estimate by
4657c657876SArnaldo Carvalho de Melo 		 * If (No feedback recv)
4667c657876SArnaldo Carvalho de Melo 		 *    R = R_sample;
4677c657876SArnaldo Carvalho de Melo 		 * Else
4687c657876SArnaldo Carvalho de Melo 		 *    R = q * R + (1 - q) * R_sample;
4697c657876SArnaldo Carvalho de Melo 		 *
4707c657876SArnaldo Carvalho de Melo 		 * q is a constant, RFC 3448 recomments 0.9
4717c657876SArnaldo Carvalho de Melo 		 */
4727c657876SArnaldo Carvalho de Melo 		if (hctx->ccid3hctx_state == TFRC_SSTATE_NO_FBACK) {
4737c657876SArnaldo Carvalho de Melo 			ccid3_hc_tx_set_state(sk, TFRC_SSTATE_FBACK);
4747c657876SArnaldo Carvalho de Melo 			hctx->ccid3hctx_rtt = r_sample;
4757c657876SArnaldo Carvalho de Melo 		} else
4761f2333aeSArnaldo Carvalho de Melo 			hctx->ccid3hctx_rtt = (hctx->ccid3hctx_rtt * 9) / 10 +
4771f2333aeSArnaldo Carvalho de Melo 					      r_sample / 10;
4787c657876SArnaldo Carvalho de Melo 
4791f2333aeSArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p, New RTT estimate=%uus, "
4801f2333aeSArnaldo Carvalho de Melo 			       "r_sample=%us\n", dccp_role(sk), sk,
4811f2333aeSArnaldo Carvalho de Melo 			       hctx->ccid3hctx_rtt, r_sample);
4827c657876SArnaldo Carvalho de Melo 
4837c657876SArnaldo Carvalho de Melo 		/* Update timeout interval */
484c68e64cfSArnaldo Carvalho de Melo 		hctx->ccid3hctx_t_rto = max_t(u32, 4 * hctx->ccid3hctx_rtt,
485cef07fd6SArnaldo Carvalho de Melo 					      USEC_PER_SEC);
4867c657876SArnaldo Carvalho de Melo 
4877c657876SArnaldo Carvalho de Melo 		/* Update receive rate */
4881f2333aeSArnaldo Carvalho de Melo 		hctx->ccid3hctx_x_recv = x_recv;/* X_recv in bytes per sec */
4897c657876SArnaldo Carvalho de Melo 
4907c657876SArnaldo Carvalho de Melo 		/* Update loss event rate */
4917c657876SArnaldo Carvalho de Melo 		if (pinv == ~0 || pinv == 0)
4927c657876SArnaldo Carvalho de Melo 			hctx->ccid3hctx_p = 0;
4937c657876SArnaldo Carvalho de Melo 		else {
4947c657876SArnaldo Carvalho de Melo 			hctx->ccid3hctx_p = 1000000 / pinv;
4957c657876SArnaldo Carvalho de Melo 
4967c657876SArnaldo Carvalho de Melo 			if (hctx->ccid3hctx_p < TFRC_SMALLEST_P) {
4977c657876SArnaldo Carvalho de Melo 				hctx->ccid3hctx_p = TFRC_SMALLEST_P;
4981f2333aeSArnaldo Carvalho de Melo 				ccid3_pr_debug("%s, sk=%p, Smallest p used!\n",
4991f2333aeSArnaldo Carvalho de Melo 					       dccp_role(sk), sk);
5007c657876SArnaldo Carvalho de Melo 			}
5017c657876SArnaldo Carvalho de Melo 		}
5027c657876SArnaldo Carvalho de Melo 
5037c657876SArnaldo Carvalho de Melo 		/* unschedule no feedback timer */
5047c657876SArnaldo Carvalho de Melo 		sk_stop_timer(sk, &hctx->ccid3hctx_no_feedback_timer);
5057c657876SArnaldo Carvalho de Melo 
5067c657876SArnaldo Carvalho de Melo 		/* Update sending rate */
5077c657876SArnaldo Carvalho de Melo 		ccid3_hc_tx_update_x(sk);
5087c657876SArnaldo Carvalho de Melo 
5097c657876SArnaldo Carvalho de Melo 		/* Update next send time */
510b6ee3d4aSArnaldo Carvalho de Melo 		timeval_sub_usecs(&hctx->ccid3hctx_t_nom,
511b6ee3d4aSArnaldo Carvalho de Melo 				  hctx->ccid3hctx_t_ipi);
5127c657876SArnaldo Carvalho de Melo 		ccid3_calc_new_t_ipi(hctx);
513b6ee3d4aSArnaldo Carvalho de Melo 		timeval_add_usecs(&hctx->ccid3hctx_t_nom,
514b6ee3d4aSArnaldo Carvalho de Melo 				  hctx->ccid3hctx_t_ipi);
5157c657876SArnaldo Carvalho de Melo 		ccid3_calc_new_delta(hctx);
5167c657876SArnaldo Carvalho de Melo 
5177c657876SArnaldo Carvalho de Melo 		/* remove all packets older than the one acked from history */
5188c60f3faSArnaldo Carvalho de Melo 		dccp_tx_hist_purge_older(ccid3_tx_hist,
5198c60f3faSArnaldo Carvalho de Melo 					 &hctx->ccid3hctx_hist, packet);
520c530cfb1SArnaldo Carvalho de Melo 		/*
521c530cfb1SArnaldo Carvalho de Melo 		 * As we have calculated new ipi, delta, t_nom it is possible that
522c530cfb1SArnaldo Carvalho de Melo 		 * we now can send a packet, so wake up dccp_wait_for_ccids.
523c530cfb1SArnaldo Carvalho de Melo 		 */
524c530cfb1SArnaldo Carvalho de Melo 		sk->sk_write_space(sk);
5258c60f3faSArnaldo Carvalho de Melo 
5261f2333aeSArnaldo Carvalho de Melo 		/*
5271f2333aeSArnaldo Carvalho de Melo 		 * Schedule no feedback timer to expire in
5281f2333aeSArnaldo Carvalho de Melo 		 * max(4 * R, 2 * s / X)
5291f2333aeSArnaldo Carvalho de Melo 		 */
530c68e64cfSArnaldo Carvalho de Melo 		next_tmout = max(hctx->ccid3hctx_t_rto,
5316b5e633aSArnaldo Carvalho de Melo 				 2 * usecs_div(hctx->ccid3hctx_s,
5326b5e633aSArnaldo Carvalho de Melo 					       hctx->ccid3hctx_x));
5337c657876SArnaldo Carvalho de Melo 
5341f2333aeSArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p, Scheduled no feedback timer to "
5351f2333aeSArnaldo Carvalho de Melo 			       "expire in %lu jiffies (%luus)\n",
5361f2333aeSArnaldo Carvalho de Melo 			       dccp_role(sk), sk,
5371f2333aeSArnaldo Carvalho de Melo 			       usecs_to_jiffies(next_tmout), next_tmout);
5387c657876SArnaldo Carvalho de Melo 
5397c657876SArnaldo Carvalho de Melo 		sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
5407c657876SArnaldo Carvalho de Melo 			       jiffies + max_t(u32, 1, usecs_to_jiffies(next_tmout)));
5417c657876SArnaldo Carvalho de Melo 
5427c657876SArnaldo Carvalho de Melo 		/* set idle flag */
5437c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_idle = 1;
5447c657876SArnaldo Carvalho de Melo 		break;
54559348b19SGerrit Renker 	case TFRC_SSTATE_TERM:
54659348b19SGerrit Renker 		DCCP_BUG("Illegal %s state TERM, sk=%p", dccp_role(sk), sk);
5477c657876SArnaldo Carvalho de Melo 		break;
5487c657876SArnaldo Carvalho de Melo 	}
5497c657876SArnaldo Carvalho de Melo }
5507c657876SArnaldo Carvalho de Melo 
5512d0817d1SArnaldo Carvalho de Melo static int ccid3_hc_tx_insert_options(struct sock *sk, struct sk_buff *skb)
5527c657876SArnaldo Carvalho de Melo {
55359d203f9SArnaldo Carvalho de Melo 	const struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
5547c657876SArnaldo Carvalho de Melo 
55559d203f9SArnaldo Carvalho de Melo 	BUG_ON(hctx == NULL);
55659d203f9SArnaldo Carvalho de Melo 
5572d0817d1SArnaldo Carvalho de Melo 	if (sk->sk_state == DCCP_OPEN || sk->sk_state == DCCP_PARTOPEN)
5587c657876SArnaldo Carvalho de Melo 		DCCP_SKB_CB(skb)->dccpd_ccval = hctx->ccid3hctx_last_win_count;
5592d0817d1SArnaldo Carvalho de Melo 	return 0;
5607c657876SArnaldo Carvalho de Melo }
5617c657876SArnaldo Carvalho de Melo 
5627c657876SArnaldo Carvalho de Melo static int ccid3_hc_tx_parse_options(struct sock *sk, unsigned char option,
5631f2333aeSArnaldo Carvalho de Melo 				     unsigned char len, u16 idx,
5641f2333aeSArnaldo Carvalho de Melo 				     unsigned char *value)
5657c657876SArnaldo Carvalho de Melo {
5667c657876SArnaldo Carvalho de Melo 	int rc = 0;
56759725dc2SArnaldo Carvalho de Melo 	const struct dccp_sock *dp = dccp_sk(sk);
56859725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
5697c657876SArnaldo Carvalho de Melo 	struct ccid3_options_received *opt_recv;
5707c657876SArnaldo Carvalho de Melo 
57159d203f9SArnaldo Carvalho de Melo 	BUG_ON(hctx == NULL);
5727c657876SArnaldo Carvalho de Melo 
5737c657876SArnaldo Carvalho de Melo 	opt_recv = &hctx->ccid3hctx_options_received;
5747c657876SArnaldo Carvalho de Melo 
5757c657876SArnaldo Carvalho de Melo 	if (opt_recv->ccid3or_seqno != dp->dccps_gsr) {
5767c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_seqno		     = dp->dccps_gsr;
5777c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_event_rate    = ~0;
5787c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_intervals_idx = 0;
5797c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_intervals_len = 0;
5807c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_receive_rate	     = 0;
5817c657876SArnaldo Carvalho de Melo 	}
5827c657876SArnaldo Carvalho de Melo 
5837c657876SArnaldo Carvalho de Melo 	switch (option) {
5847c657876SArnaldo Carvalho de Melo 	case TFRC_OPT_LOSS_EVENT_RATE:
58559d203f9SArnaldo Carvalho de Melo 		if (unlikely(len != 4)) {
58659348b19SGerrit Renker 			DCCP_WARN("%s, sk=%p, invalid len %d "
58759348b19SGerrit Renker 				  "for TFRC_OPT_LOSS_EVENT_RATE\n",
58859348b19SGerrit Renker 				  dccp_role(sk), sk, len);
5897c657876SArnaldo Carvalho de Melo 			rc = -EINVAL;
5907c657876SArnaldo Carvalho de Melo 		} else {
59160fe62e7SAndrea Bittau 			opt_recv->ccid3or_loss_event_rate = ntohl(*(__be32 *)value);
5927c657876SArnaldo Carvalho de Melo 			ccid3_pr_debug("%s, sk=%p, LOSS_EVENT_RATE=%u\n",
5937c657876SArnaldo Carvalho de Melo 				       dccp_role(sk), sk,
5947c657876SArnaldo Carvalho de Melo 				       opt_recv->ccid3or_loss_event_rate);
5957c657876SArnaldo Carvalho de Melo 		}
5967c657876SArnaldo Carvalho de Melo 		break;
5977c657876SArnaldo Carvalho de Melo 	case TFRC_OPT_LOSS_INTERVALS:
5987c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_intervals_idx = idx;
5997c657876SArnaldo Carvalho de Melo 		opt_recv->ccid3or_loss_intervals_len = len;
6007c657876SArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p, LOSS_INTERVALS=(%u, %u)\n",
6017c657876SArnaldo Carvalho de Melo 			       dccp_role(sk), sk,
6027c657876SArnaldo Carvalho de Melo 			       opt_recv->ccid3or_loss_intervals_idx,
6037c657876SArnaldo Carvalho de Melo 			       opt_recv->ccid3or_loss_intervals_len);
6047c657876SArnaldo Carvalho de Melo 		break;
6057c657876SArnaldo Carvalho de Melo 	case TFRC_OPT_RECEIVE_RATE:
60659d203f9SArnaldo Carvalho de Melo 		if (unlikely(len != 4)) {
60759348b19SGerrit Renker 			DCCP_WARN("%s, sk=%p, invalid len %d "
60859348b19SGerrit Renker 				  "for TFRC_OPT_RECEIVE_RATE\n",
60959348b19SGerrit Renker 				  dccp_role(sk), sk, len);
6107c657876SArnaldo Carvalho de Melo 			rc = -EINVAL;
6117c657876SArnaldo Carvalho de Melo 		} else {
61260fe62e7SAndrea Bittau 			opt_recv->ccid3or_receive_rate = ntohl(*(__be32 *)value);
6137c657876SArnaldo Carvalho de Melo 			ccid3_pr_debug("%s, sk=%p, RECEIVE_RATE=%u\n",
6147c657876SArnaldo Carvalho de Melo 				       dccp_role(sk), sk,
6157c657876SArnaldo Carvalho de Melo 				       opt_recv->ccid3or_receive_rate);
6167c657876SArnaldo Carvalho de Melo 		}
6177c657876SArnaldo Carvalho de Melo 		break;
6187c657876SArnaldo Carvalho de Melo 	}
6197c657876SArnaldo Carvalho de Melo 
6207c657876SArnaldo Carvalho de Melo 	return rc;
6217c657876SArnaldo Carvalho de Melo }
6227c657876SArnaldo Carvalho de Melo 
62391f0ebf7SArnaldo Carvalho de Melo static int ccid3_hc_tx_init(struct ccid *ccid, struct sock *sk)
6247c657876SArnaldo Carvalho de Melo {
6257c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
62691f0ebf7SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid_priv(ccid);
6277c657876SArnaldo Carvalho de Melo 
628a84ffe43SArnaldo Carvalho de Melo 	if (dp->dccps_packet_size >= TFRC_MIN_PACKET_SIZE &&
629a84ffe43SArnaldo Carvalho de Melo 	    dp->dccps_packet_size <= TFRC_MAX_PACKET_SIZE)
630a84ffe43SArnaldo Carvalho de Melo 		hctx->ccid3hctx_s = dp->dccps_packet_size;
6317c657876SArnaldo Carvalho de Melo 	else
6327c657876SArnaldo Carvalho de Melo 		hctx->ccid3hctx_s = TFRC_STD_PACKET_SIZE;
6337c657876SArnaldo Carvalho de Melo 
6341f2333aeSArnaldo Carvalho de Melo 	/* Set transmission rate to 1 packet per second */
6351f2333aeSArnaldo Carvalho de Melo 	hctx->ccid3hctx_x     = hctx->ccid3hctx_s;
636c68e64cfSArnaldo Carvalho de Melo 	hctx->ccid3hctx_t_rto = USEC_PER_SEC;
6377c657876SArnaldo Carvalho de Melo 	hctx->ccid3hctx_state = TFRC_SSTATE_NO_SENT;
6387c657876SArnaldo Carvalho de Melo 	INIT_LIST_HEAD(&hctx->ccid3hctx_hist);
639aa5d7df3SArnaldo Carvalho de Melo 
640aa5d7df3SArnaldo Carvalho de Melo 	hctx->ccid3hctx_no_feedback_timer.function = ccid3_hc_tx_no_feedback_timer;
641aa5d7df3SArnaldo Carvalho de Melo 	hctx->ccid3hctx_no_feedback_timer.data     = (unsigned long)sk;
6427c657876SArnaldo Carvalho de Melo 	init_timer(&hctx->ccid3hctx_no_feedback_timer);
6437c657876SArnaldo Carvalho de Melo 
6447c657876SArnaldo Carvalho de Melo 	return 0;
6457c657876SArnaldo Carvalho de Melo }
6467c657876SArnaldo Carvalho de Melo 
6477c657876SArnaldo Carvalho de Melo static void ccid3_hc_tx_exit(struct sock *sk)
6487c657876SArnaldo Carvalho de Melo {
64959725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
6507c657876SArnaldo Carvalho de Melo 
6517c657876SArnaldo Carvalho de Melo 	BUG_ON(hctx == NULL);
6527c657876SArnaldo Carvalho de Melo 
6537c657876SArnaldo Carvalho de Melo 	ccid3_hc_tx_set_state(sk, TFRC_SSTATE_TERM);
6547c657876SArnaldo Carvalho de Melo 	sk_stop_timer(sk, &hctx->ccid3hctx_no_feedback_timer);
6557c657876SArnaldo Carvalho de Melo 
6567c657876SArnaldo Carvalho de Melo 	/* Empty packet history */
6578c60f3faSArnaldo Carvalho de Melo 	dccp_tx_hist_purge(ccid3_tx_hist, &hctx->ccid3hctx_hist);
6587c657876SArnaldo Carvalho de Melo }
6597c657876SArnaldo Carvalho de Melo 
6607c657876SArnaldo Carvalho de Melo /*
6617c657876SArnaldo Carvalho de Melo  * RX Half Connection methods
6627c657876SArnaldo Carvalho de Melo  */
6637c657876SArnaldo Carvalho de Melo 
66456724aa4SGerrit Renker #ifdef CONFIG_IP_DCCP_CCID3_DEBUG
6657c657876SArnaldo Carvalho de Melo static const char *ccid3_rx_state_name(enum ccid3_hc_rx_states state)
6667c657876SArnaldo Carvalho de Melo {
6677c657876SArnaldo Carvalho de Melo 	static char *ccid3_rx_state_names[] = {
6687c657876SArnaldo Carvalho de Melo 	[TFRC_RSTATE_NO_DATA] = "NO_DATA",
6697c657876SArnaldo Carvalho de Melo 	[TFRC_RSTATE_DATA]    = "DATA",
6707c657876SArnaldo Carvalho de Melo 	[TFRC_RSTATE_TERM]    = "TERM",
6717c657876SArnaldo Carvalho de Melo 	};
6727c657876SArnaldo Carvalho de Melo 
6737c657876SArnaldo Carvalho de Melo 	return ccid3_rx_state_names[state];
6747c657876SArnaldo Carvalho de Melo }
6757c657876SArnaldo Carvalho de Melo #endif
6767c657876SArnaldo Carvalho de Melo 
677c25a18baSArnaldo Carvalho de Melo static void ccid3_hc_rx_set_state(struct sock *sk,
6781f2333aeSArnaldo Carvalho de Melo 				  enum ccid3_hc_rx_states state)
6797c657876SArnaldo Carvalho de Melo {
68059725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
6817c657876SArnaldo Carvalho de Melo 	enum ccid3_hc_rx_states oldstate = hcrx->ccid3hcrx_state;
6827c657876SArnaldo Carvalho de Melo 
6837c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s(%p) %-8.8s -> %s\n",
6841f2333aeSArnaldo Carvalho de Melo 		       dccp_role(sk), sk, ccid3_rx_state_name(oldstate),
6851f2333aeSArnaldo Carvalho de Melo 		       ccid3_rx_state_name(state));
6867c657876SArnaldo Carvalho de Melo 	WARN_ON(state == oldstate);
6877c657876SArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_state = state;
6887c657876SArnaldo Carvalho de Melo }
6897c657876SArnaldo Carvalho de Melo 
6907c657876SArnaldo Carvalho de Melo static void ccid3_hc_rx_send_feedback(struct sock *sk)
6917c657876SArnaldo Carvalho de Melo {
69259725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
6937c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
6948c60f3faSArnaldo Carvalho de Melo 	struct dccp_rx_hist_entry *packet;
695b6ee3d4aSArnaldo Carvalho de Melo 	struct timeval now;
6967c657876SArnaldo Carvalho de Melo 
6977c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
6987c657876SArnaldo Carvalho de Melo 
699b0e56780SArnaldo Carvalho de Melo 	dccp_timestamp(sk, &now);
700b6ee3d4aSArnaldo Carvalho de Melo 
7017c657876SArnaldo Carvalho de Melo 	switch (hcrx->ccid3hcrx_state) {
7027c657876SArnaldo Carvalho de Melo 	case TFRC_RSTATE_NO_DATA:
7037c657876SArnaldo Carvalho de Melo 		hcrx->ccid3hcrx_x_recv = 0;
7047c657876SArnaldo Carvalho de Melo 		break;
7057c657876SArnaldo Carvalho de Melo 	case TFRC_RSTATE_DATA: {
706b6ee3d4aSArnaldo Carvalho de Melo 		const u32 delta = timeval_delta(&now,
707b6ee3d4aSArnaldo Carvalho de Melo 					&hcrx->ccid3hcrx_tstamp_last_feedback);
70827ae543eSArnaldo Carvalho de Melo 		hcrx->ccid3hcrx_x_recv = usecs_div(hcrx->ccid3hcrx_bytes_recv,
70927ae543eSArnaldo Carvalho de Melo 						   delta);
7107c657876SArnaldo Carvalho de Melo 	}
7117c657876SArnaldo Carvalho de Melo 		break;
71259348b19SGerrit Renker 	case TFRC_RSTATE_TERM:
71359348b19SGerrit Renker 		DCCP_BUG("Illegal %s state TERM, sk=%p", dccp_role(sk), sk);
7147c657876SArnaldo Carvalho de Melo 		return;
7157c657876SArnaldo Carvalho de Melo 	}
7167c657876SArnaldo Carvalho de Melo 
7178c60f3faSArnaldo Carvalho de Melo 	packet = dccp_rx_hist_find_data_packet(&hcrx->ccid3hcrx_hist);
71859d203f9SArnaldo Carvalho de Melo 	if (unlikely(packet == NULL)) {
71959348b19SGerrit Renker 		DCCP_WARN("%s, sk=%p, no data packet in history!\n",
72059348b19SGerrit Renker 			  dccp_role(sk), sk);
7217c657876SArnaldo Carvalho de Melo 		return;
7227c657876SArnaldo Carvalho de Melo 	}
7237c657876SArnaldo Carvalho de Melo 
724b6ee3d4aSArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_tstamp_last_feedback = now;
72566a377c5SIan McDonald 	hcrx->ccid3hcrx_ccval_last_counter   = packet->dccphrx_ccval;
7267c657876SArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_bytes_recv	     = 0;
7277c657876SArnaldo Carvalho de Melo 
7287c657876SArnaldo Carvalho de Melo 	/* Convert to multiples of 10us */
729b6ee3d4aSArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_elapsed_time =
730b6ee3d4aSArnaldo Carvalho de Melo 			timeval_delta(&now, &packet->dccphrx_tstamp) / 10;
7317c657876SArnaldo Carvalho de Melo 	if (hcrx->ccid3hcrx_p == 0)
7327c657876SArnaldo Carvalho de Melo 		hcrx->ccid3hcrx_pinv = ~0;
7337c657876SArnaldo Carvalho de Melo 	else
7347c657876SArnaldo Carvalho de Melo 		hcrx->ccid3hcrx_pinv = 1000000 / hcrx->ccid3hcrx_p;
735507d37cfSArnaldo Carvalho de Melo 	dp->dccps_hc_rx_insert_options = 1;
7367c657876SArnaldo Carvalho de Melo 	dccp_send_ack(sk);
7377c657876SArnaldo Carvalho de Melo }
7387c657876SArnaldo Carvalho de Melo 
7392d0817d1SArnaldo Carvalho de Melo static int ccid3_hc_rx_insert_options(struct sock *sk, struct sk_buff *skb)
7407c657876SArnaldo Carvalho de Melo {
74159d203f9SArnaldo Carvalho de Melo 	const struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
74260fe62e7SAndrea Bittau 	__be32 x_recv, pinv;
7437c657876SArnaldo Carvalho de Melo 
74459d203f9SArnaldo Carvalho de Melo 	BUG_ON(hcrx == NULL);
74559d203f9SArnaldo Carvalho de Melo 
74659d203f9SArnaldo Carvalho de Melo 	if (!(sk->sk_state == DCCP_OPEN || sk->sk_state == DCCP_PARTOPEN))
7472d0817d1SArnaldo Carvalho de Melo 		return 0;
7487c657876SArnaldo Carvalho de Melo 
74966a377c5SIan McDonald 	DCCP_SKB_CB(skb)->dccpd_ccval = hcrx->ccid3hcrx_ccval_last_counter;
7504fded33bSArnaldo Carvalho de Melo 
7514fded33bSArnaldo Carvalho de Melo 	if (dccp_packet_without_ack(skb))
7522d0817d1SArnaldo Carvalho de Melo 		return 0;
7534fded33bSArnaldo Carvalho de Melo 
7544fded33bSArnaldo Carvalho de Melo 	x_recv = htonl(hcrx->ccid3hcrx_x_recv);
7554fded33bSArnaldo Carvalho de Melo 	pinv   = htonl(hcrx->ccid3hcrx_pinv);
7562d0817d1SArnaldo Carvalho de Melo 
7572d0817d1SArnaldo Carvalho de Melo 	if ((hcrx->ccid3hcrx_elapsed_time != 0 &&
7582d0817d1SArnaldo Carvalho de Melo 	     dccp_insert_option_elapsed_time(sk, skb,
7592d0817d1SArnaldo Carvalho de Melo 					     hcrx->ccid3hcrx_elapsed_time)) ||
7602d0817d1SArnaldo Carvalho de Melo 	    dccp_insert_option_timestamp(sk, skb) ||
7614fded33bSArnaldo Carvalho de Melo 	    dccp_insert_option(sk, skb, TFRC_OPT_LOSS_EVENT_RATE,
7622d0817d1SArnaldo Carvalho de Melo 		    	       &pinv, sizeof(pinv)) ||
7634fded33bSArnaldo Carvalho de Melo 	    dccp_insert_option(sk, skb, TFRC_OPT_RECEIVE_RATE,
7642d0817d1SArnaldo Carvalho de Melo 		    	       &x_recv, sizeof(x_recv)))
7652d0817d1SArnaldo Carvalho de Melo 		return -1;
7662d0817d1SArnaldo Carvalho de Melo 
7672d0817d1SArnaldo Carvalho de Melo 	return 0;
7687c657876SArnaldo Carvalho de Melo }
7697c657876SArnaldo Carvalho de Melo 
7707c657876SArnaldo Carvalho de Melo /* calculate first loss interval
7717c657876SArnaldo Carvalho de Melo  *
7727c657876SArnaldo Carvalho de Melo  * returns estimated loss interval in usecs */
7737c657876SArnaldo Carvalho de Melo 
7747c657876SArnaldo Carvalho de Melo static u32 ccid3_hc_rx_calc_first_li(struct sock *sk)
7757c657876SArnaldo Carvalho de Melo {
77659725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
7778c60f3faSArnaldo Carvalho de Melo 	struct dccp_rx_hist_entry *entry, *next, *tail = NULL;
7787c657876SArnaldo Carvalho de Melo 	u32 rtt, delta, x_recv, fval, p, tmp2;
779b6ee3d4aSArnaldo Carvalho de Melo 	struct timeval tstamp = { 0, };
7807c657876SArnaldo Carvalho de Melo 	int interval = 0;
7817c657876SArnaldo Carvalho de Melo 	int win_count = 0;
7827c657876SArnaldo Carvalho de Melo 	int step = 0;
7837c657876SArnaldo Carvalho de Melo 	u64 tmp1;
7847c657876SArnaldo Carvalho de Melo 
7858c60f3faSArnaldo Carvalho de Melo 	list_for_each_entry_safe(entry, next, &hcrx->ccid3hcrx_hist,
7868c60f3faSArnaldo Carvalho de Melo 				 dccphrx_node) {
7878c60f3faSArnaldo Carvalho de Melo 		if (dccp_rx_hist_entry_data_packet(entry)) {
7887c657876SArnaldo Carvalho de Melo 			tail = entry;
7897c657876SArnaldo Carvalho de Melo 
7907c657876SArnaldo Carvalho de Melo 			switch (step) {
7917c657876SArnaldo Carvalho de Melo 			case 0:
7928c60f3faSArnaldo Carvalho de Melo 				tstamp	  = entry->dccphrx_tstamp;
793c1734376SArnaldo Carvalho de Melo 				win_count = entry->dccphrx_ccval;
7947c657876SArnaldo Carvalho de Melo 				step = 1;
7957c657876SArnaldo Carvalho de Melo 				break;
7967c657876SArnaldo Carvalho de Melo 			case 1:
797c1734376SArnaldo Carvalho de Melo 				interval = win_count - entry->dccphrx_ccval;
7987c657876SArnaldo Carvalho de Melo 				if (interval < 0)
7997c657876SArnaldo Carvalho de Melo 					interval += TFRC_WIN_COUNT_LIMIT;
8007c657876SArnaldo Carvalho de Melo 				if (interval > 4)
8017c657876SArnaldo Carvalho de Melo 					goto found;
8027c657876SArnaldo Carvalho de Melo 				break;
8037c657876SArnaldo Carvalho de Melo 			}
8047c657876SArnaldo Carvalho de Melo 		}
8057c657876SArnaldo Carvalho de Melo 	}
8067c657876SArnaldo Carvalho de Melo 
80759d203f9SArnaldo Carvalho de Melo 	if (unlikely(step == 0)) {
80859348b19SGerrit Renker 		DCCP_WARN("%s, sk=%p, packet history has no data packets!\n",
80959348b19SGerrit Renker 			  dccp_role(sk), sk);
8107c657876SArnaldo Carvalho de Melo 		return ~0;
8117c657876SArnaldo Carvalho de Melo 	}
8127c657876SArnaldo Carvalho de Melo 
81359d203f9SArnaldo Carvalho de Melo 	if (unlikely(interval == 0)) {
81459348b19SGerrit Renker 		DCCP_WARN("%s, sk=%p, Could not find a win_count interval > 0."
81559348b19SGerrit Renker 			  "Defaulting to 1\n", dccp_role(sk), sk);
8167c657876SArnaldo Carvalho de Melo 		interval = 1;
8177c657876SArnaldo Carvalho de Melo 	}
8187c657876SArnaldo Carvalho de Melo found:
81966a377c5SIan McDonald 	if (!tail) {
82059348b19SGerrit Renker 		DCCP_CRIT("tail is null\n");
82166a377c5SIan McDonald 		return ~0;
82266a377c5SIan McDonald 	}
823b6ee3d4aSArnaldo Carvalho de Melo 	rtt = timeval_delta(&tstamp, &tail->dccphrx_tstamp) * 4 / interval;
8247c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p, approximated RTT to %uus\n",
8257c657876SArnaldo Carvalho de Melo 		       dccp_role(sk), sk, rtt);
82659348b19SGerrit Renker 
82759348b19SGerrit Renker 	if (rtt == 0) {
82859348b19SGerrit Renker 		DCCP_WARN("RTT==0, setting to 1\n");
8297c657876SArnaldo Carvalho de Melo  		rtt = 1;
83059348b19SGerrit Renker 	}
8317c657876SArnaldo Carvalho de Melo 
832b0e56780SArnaldo Carvalho de Melo 	dccp_timestamp(sk, &tstamp);
833b0e56780SArnaldo Carvalho de Melo 	delta = timeval_delta(&tstamp, &hcrx->ccid3hcrx_tstamp_last_feedback);
834b0e56780SArnaldo Carvalho de Melo 	x_recv = usecs_div(hcrx->ccid3hcrx_bytes_recv, delta);
8357c657876SArnaldo Carvalho de Melo 
83666a377c5SIan McDonald 	if (x_recv == 0)
83766a377c5SIan McDonald 		x_recv = hcrx->ccid3hcrx_x_recv;
83866a377c5SIan McDonald 
8397c657876SArnaldo Carvalho de Melo 	tmp1 = (u64)x_recv * (u64)rtt;
8407c657876SArnaldo Carvalho de Melo 	do_div(tmp1,10000000);
8417c657876SArnaldo Carvalho de Melo 	tmp2 = (u32)tmp1;
84266a377c5SIan McDonald 
84366a377c5SIan McDonald 	if (!tmp2) {
84459348b19SGerrit Renker 		DCCP_CRIT("tmp2 = 0, x_recv = %u, rtt =%u\n", x_recv, rtt);
84566a377c5SIan McDonald 		return ~0;
84666a377c5SIan McDonald 	}
84766a377c5SIan McDonald 
8487c657876SArnaldo Carvalho de Melo 	fval = (hcrx->ccid3hcrx_s * 100000) / tmp2;
8497c657876SArnaldo Carvalho de Melo 	/* do not alter order above or you will get overflow on 32 bit */
85036729c1aSArnaldo Carvalho de Melo 	p = tfrc_calc_x_reverse_lookup(fval);
8511f2333aeSArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p, receive rate=%u bytes/s, implied "
8521f2333aeSArnaldo Carvalho de Melo 		       "loss rate=%u\n", dccp_role(sk), sk, x_recv, p);
8537c657876SArnaldo Carvalho de Melo 
8547c657876SArnaldo Carvalho de Melo 	if (p == 0)
8557c657876SArnaldo Carvalho de Melo 		return ~0;
8567c657876SArnaldo Carvalho de Melo 	else
8577c657876SArnaldo Carvalho de Melo 		return 1000000 / p;
8587c657876SArnaldo Carvalho de Melo }
8597c657876SArnaldo Carvalho de Melo 
8607c657876SArnaldo Carvalho de Melo static void ccid3_hc_rx_update_li(struct sock *sk, u64 seq_loss, u8 win_loss)
8617c657876SArnaldo Carvalho de Melo {
86259725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
863fc747e82SIan McDonald 	struct dccp_li_hist_entry *head;
86466a377c5SIan McDonald 	u64 seq_temp;
8657c657876SArnaldo Carvalho de Melo 
86666a377c5SIan McDonald 	if (list_empty(&hcrx->ccid3hcrx_li_hist)) {
86766a377c5SIan McDonald 		if (!dccp_li_hist_interval_new(ccid3_li_hist,
86866a377c5SIan McDonald 		   &hcrx->ccid3hcrx_li_hist, seq_loss, win_loss))
869ae6706f0SArnaldo Carvalho de Melo 			return;
87066a377c5SIan McDonald 
871fc747e82SIan McDonald 		head = list_entry(hcrx->ccid3hcrx_li_hist.next,
872fc747e82SIan McDonald 		   struct dccp_li_hist_entry, dccplih_node);
873fc747e82SIan McDonald 		head->dccplih_interval = ccid3_hc_rx_calc_first_li(sk);
87466a377c5SIan McDonald 	} else {
87566a377c5SIan McDonald 		struct dccp_li_hist_entry *entry;
87666a377c5SIan McDonald 		struct list_head *tail;
87766a377c5SIan McDonald 
878fc747e82SIan McDonald 		head = list_entry(hcrx->ccid3hcrx_li_hist.next,
879fc747e82SIan McDonald 		   struct dccp_li_hist_entry, dccplih_node);
88066a377c5SIan McDonald 		/* FIXME win count check removed as was wrong */
88166a377c5SIan McDonald 		/* should make this check with receive history */
88266a377c5SIan McDonald 		/* and compare there as per section 10.2 of RFC4342 */
88366a377c5SIan McDonald 
88466a377c5SIan McDonald 		/* new loss event detected */
88566a377c5SIan McDonald 		/* calculate last interval length */
88666a377c5SIan McDonald 		seq_temp = dccp_delta_seqno(head->dccplih_seqno, seq_loss);
88766a377c5SIan McDonald 		entry = dccp_li_hist_entry_new(ccid3_li_hist, SLAB_ATOMIC);
88866a377c5SIan McDonald 
88966a377c5SIan McDonald 		if (entry == NULL) {
89059348b19SGerrit Renker 			DCCP_BUG("out of memory - can not allocate entry");
89166a377c5SIan McDonald 			return;
8927c657876SArnaldo Carvalho de Melo 		}
8937c657876SArnaldo Carvalho de Melo 
89466a377c5SIan McDonald 		list_add(&entry->dccplih_node, &hcrx->ccid3hcrx_li_hist);
89566a377c5SIan McDonald 
89666a377c5SIan McDonald 		tail = hcrx->ccid3hcrx_li_hist.prev;
89766a377c5SIan McDonald 		list_del(tail);
89866a377c5SIan McDonald 		kmem_cache_free(ccid3_li_hist->dccplih_slab, tail);
89966a377c5SIan McDonald 
90066a377c5SIan McDonald 		/* Create the newest interval */
90166a377c5SIan McDonald 		entry->dccplih_seqno = seq_loss;
90266a377c5SIan McDonald 		entry->dccplih_interval = seq_temp;
90366a377c5SIan McDonald 		entry->dccplih_win_count = win_loss;
90466a377c5SIan McDonald 	}
90566a377c5SIan McDonald }
90666a377c5SIan McDonald 
90766a377c5SIan McDonald static int ccid3_hc_rx_detect_loss(struct sock *sk,
90866a377c5SIan McDonald                                     struct dccp_rx_hist_entry *packet)
9097c657876SArnaldo Carvalho de Melo {
91059725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
91166a377c5SIan McDonald 	struct dccp_rx_hist_entry *rx_hist = dccp_rx_hist_head(&hcrx->ccid3hcrx_hist);
91266a377c5SIan McDonald 	u64 seqno = packet->dccphrx_seqno;
91366a377c5SIan McDonald 	u64 tmp_seqno;
91466a377c5SIan McDonald 	int loss = 0;
91566a377c5SIan McDonald 	u8 ccval;
9167c657876SArnaldo Carvalho de Melo 
91766a377c5SIan McDonald 
91866a377c5SIan McDonald 	tmp_seqno = hcrx->ccid3hcrx_seqno_nonloss;
91966a377c5SIan McDonald 
92066a377c5SIan McDonald 	if (!rx_hist ||
92166a377c5SIan McDonald 	   follows48(packet->dccphrx_seqno, hcrx->ccid3hcrx_seqno_nonloss)) {
92266a377c5SIan McDonald 		hcrx->ccid3hcrx_seqno_nonloss = seqno;
92366a377c5SIan McDonald 		hcrx->ccid3hcrx_ccval_nonloss = packet->dccphrx_ccval;
92466a377c5SIan McDonald 		goto detect_out;
92566a377c5SIan McDonald 	}
92666a377c5SIan McDonald 
92766a377c5SIan McDonald 
92866a377c5SIan McDonald 	while (dccp_delta_seqno(hcrx->ccid3hcrx_seqno_nonloss, seqno)
92966a377c5SIan McDonald 	   > TFRC_RECV_NUM_LATE_LOSS) {
93066a377c5SIan McDonald 		loss = 1;
93166a377c5SIan McDonald 		ccid3_hc_rx_update_li(sk, hcrx->ccid3hcrx_seqno_nonloss,
93266a377c5SIan McDonald 		   hcrx->ccid3hcrx_ccval_nonloss);
93366a377c5SIan McDonald 		tmp_seqno = hcrx->ccid3hcrx_seqno_nonloss;
93466a377c5SIan McDonald 		dccp_inc_seqno(&tmp_seqno);
93566a377c5SIan McDonald 		hcrx->ccid3hcrx_seqno_nonloss = tmp_seqno;
93666a377c5SIan McDonald 		dccp_inc_seqno(&tmp_seqno);
93766a377c5SIan McDonald 		while (dccp_rx_hist_find_entry(&hcrx->ccid3hcrx_hist,
93866a377c5SIan McDonald 		   tmp_seqno, &ccval)) {
93966a377c5SIan McDonald 		   	hcrx->ccid3hcrx_seqno_nonloss = tmp_seqno;
94066a377c5SIan McDonald 			hcrx->ccid3hcrx_ccval_nonloss = ccval;
94166a377c5SIan McDonald 			dccp_inc_seqno(&tmp_seqno);
94266a377c5SIan McDonald 		}
94366a377c5SIan McDonald 	}
94466a377c5SIan McDonald 
94566a377c5SIan McDonald 	/* FIXME - this code could be simplified with above while */
94666a377c5SIan McDonald 	/* but works at moment */
94766a377c5SIan McDonald 	if (follows48(packet->dccphrx_seqno, hcrx->ccid3hcrx_seqno_nonloss)) {
94866a377c5SIan McDonald 		hcrx->ccid3hcrx_seqno_nonloss = seqno;
94966a377c5SIan McDonald 		hcrx->ccid3hcrx_ccval_nonloss = packet->dccphrx_ccval;
95066a377c5SIan McDonald 	}
95166a377c5SIan McDonald 
95266a377c5SIan McDonald detect_out:
95366a377c5SIan McDonald 	dccp_rx_hist_add_packet(ccid3_rx_hist, &hcrx->ccid3hcrx_hist,
95466a377c5SIan McDonald 		   &hcrx->ccid3hcrx_li_hist, packet,
95566a377c5SIan McDonald 		   hcrx->ccid3hcrx_seqno_nonloss);
95666a377c5SIan McDonald 	return loss;
9577c657876SArnaldo Carvalho de Melo }
9587c657876SArnaldo Carvalho de Melo 
9597c657876SArnaldo Carvalho de Melo static void ccid3_hc_rx_packet_recv(struct sock *sk, struct sk_buff *skb)
9607c657876SArnaldo Carvalho de Melo {
96159725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
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;
96566a377c5SIan McDonald 	u32 p_prev, rtt_prev, r_sample, t_elapsed;
96666a377c5SIan McDonald 	int loss;
9671f2333aeSArnaldo Carvalho de Melo 
96859348b19SGerrit Renker 	BUG_ON(hcrx == NULL);
9697c657876SArnaldo Carvalho de Melo 
97059725dc2SArnaldo Carvalho de Melo 	opt_recv = &dccp_sk(sk)->dccps_options_received;
9714fded33bSArnaldo Carvalho de Melo 
9727c657876SArnaldo Carvalho de Melo 	switch (DCCP_SKB_CB(skb)->dccpd_type) {
9737c657876SArnaldo Carvalho de Melo 	case DCCP_PKT_ACK:
9747c657876SArnaldo Carvalho de Melo 		if (hcrx->ccid3hcrx_state == TFRC_RSTATE_NO_DATA)
9757c657876SArnaldo Carvalho de Melo 			return;
9767c657876SArnaldo Carvalho de Melo 	case DCCP_PKT_DATAACK:
9774fded33bSArnaldo Carvalho de Melo 		if (opt_recv->dccpor_timestamp_echo == 0)
9787c657876SArnaldo Carvalho de Melo 			break;
97966a377c5SIan McDonald 		rtt_prev = hcrx->ccid3hcrx_rtt;
980b0e56780SArnaldo Carvalho de Melo 		dccp_timestamp(sk, &now);
981b3a3077dSArnaldo Carvalho de Melo 		timeval_sub_usecs(&now, opt_recv->dccpor_timestamp_echo * 10);
982b3a3077dSArnaldo Carvalho de Melo 		r_sample = timeval_usecs(&now);
983b3a3077dSArnaldo Carvalho de Melo 		t_elapsed = opt_recv->dccpor_elapsed_time * 10;
984b3a3077dSArnaldo Carvalho de Melo 
985b3a3077dSArnaldo Carvalho de Melo 		if (unlikely(r_sample <= t_elapsed))
98659348b19SGerrit Renker 			DCCP_WARN("r_sample=%uus, t_elapsed=%uus\n",
98759348b19SGerrit Renker 				  r_sample, t_elapsed);
988b3a3077dSArnaldo Carvalho de Melo 		else
989b3a3077dSArnaldo Carvalho de Melo 			r_sample -= t_elapsed;
990b3a3077dSArnaldo Carvalho de Melo 
991b3a3077dSArnaldo Carvalho de Melo 		if (hcrx->ccid3hcrx_state == TFRC_RSTATE_NO_DATA)
992b3a3077dSArnaldo Carvalho de Melo 			hcrx->ccid3hcrx_rtt = r_sample;
993b3a3077dSArnaldo Carvalho de Melo 		else
994b3a3077dSArnaldo Carvalho de Melo 			hcrx->ccid3hcrx_rtt = (hcrx->ccid3hcrx_rtt * 9) / 10 +
995b3a3077dSArnaldo Carvalho de Melo 					      r_sample / 10;
996b3a3077dSArnaldo Carvalho de Melo 
99766a377c5SIan McDonald 		if (rtt_prev != hcrx->ccid3hcrx_rtt)
99866a377c5SIan McDonald 			ccid3_pr_debug("%s, New RTT=%uus, elapsed time=%u\n",
9994fded33bSArnaldo Carvalho de Melo 				       dccp_role(sk), hcrx->ccid3hcrx_rtt,
10004fded33bSArnaldo Carvalho de Melo 				       opt_recv->dccpor_elapsed_time);
10017c657876SArnaldo Carvalho de Melo 		break;
10027c657876SArnaldo Carvalho de Melo 	case DCCP_PKT_DATA:
10037c657876SArnaldo Carvalho de Melo 		break;
100459d203f9SArnaldo Carvalho de Melo 	default: /* We're not interested in other packet types, move along */
10057c657876SArnaldo Carvalho de Melo 		return;
10067c657876SArnaldo Carvalho de Melo 	}
10077c657876SArnaldo Carvalho de Melo 
1008b0e56780SArnaldo Carvalho de Melo 	packet = dccp_rx_hist_entry_new(ccid3_rx_hist, sk, opt_recv->dccpor_ndp,
10098c60f3faSArnaldo Carvalho de Melo 					skb, SLAB_ATOMIC);
101059d203f9SArnaldo Carvalho de Melo 	if (unlikely(packet == NULL)) {
101159348b19SGerrit Renker 		DCCP_WARN("%s, sk=%p, Not enough mem to add rx packet "
101259348b19SGerrit Renker 			  "to history, consider it lost!\n", dccp_role(sk), sk);
10137c657876SArnaldo Carvalho de Melo 		return;
10147c657876SArnaldo Carvalho de Melo 	}
10157c657876SArnaldo Carvalho de Melo 
101666a377c5SIan McDonald 	loss = ccid3_hc_rx_detect_loss(sk, packet);
10177c657876SArnaldo Carvalho de Melo 
10187c657876SArnaldo Carvalho de Melo 	if (DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_ACK)
10197c657876SArnaldo Carvalho de Melo 		return;
10207c657876SArnaldo Carvalho de Melo 
10217c657876SArnaldo Carvalho de Melo 	switch (hcrx->ccid3hcrx_state) {
10227c657876SArnaldo Carvalho de Melo 	case TFRC_RSTATE_NO_DATA:
10231f2333aeSArnaldo Carvalho de Melo 		ccid3_pr_debug("%s, sk=%p(%s), skb=%p, sending initial "
10241f2333aeSArnaldo Carvalho de Melo 			       "feedback\n",
10251f2333aeSArnaldo Carvalho de Melo 			       dccp_role(sk), sk,
10261f2333aeSArnaldo Carvalho de Melo 			       dccp_state_name(sk->sk_state), skb);
10277c657876SArnaldo Carvalho de Melo 		ccid3_hc_rx_send_feedback(sk);
10287c657876SArnaldo Carvalho de Melo 		ccid3_hc_rx_set_state(sk, TFRC_RSTATE_DATA);
10297c657876SArnaldo Carvalho de Melo 		return;
10307c657876SArnaldo Carvalho de Melo 	case TFRC_RSTATE_DATA:
10311f2333aeSArnaldo Carvalho de Melo 		hcrx->ccid3hcrx_bytes_recv += skb->len -
10321f2333aeSArnaldo Carvalho de Melo 					      dccp_hdr(skb)->dccph_doff * 4;
103366a377c5SIan McDonald 		if (loss)
1034b6ee3d4aSArnaldo Carvalho de Melo 			break;
1035b6ee3d4aSArnaldo Carvalho de Melo 
1036b0e56780SArnaldo Carvalho de Melo 		dccp_timestamp(sk, &now);
1037b6ee3d4aSArnaldo Carvalho de Melo 		if (timeval_delta(&now, &hcrx->ccid3hcrx_tstamp_last_ack) >=
10384fded33bSArnaldo Carvalho de Melo 		    hcrx->ccid3hcrx_rtt) {
1039b6ee3d4aSArnaldo Carvalho de Melo 			hcrx->ccid3hcrx_tstamp_last_ack = now;
10407c657876SArnaldo Carvalho de Melo 			ccid3_hc_rx_send_feedback(sk);
10417c657876SArnaldo Carvalho de Melo 		}
10427c657876SArnaldo Carvalho de Melo 		return;
104359348b19SGerrit Renker 	case TFRC_RSTATE_TERM:
104459348b19SGerrit Renker 		DCCP_BUG("Illegal %s state TERM, sk=%p", dccp_role(sk), sk);
10457c657876SArnaldo Carvalho de Melo 		return;
10467c657876SArnaldo Carvalho de Melo 	}
10477c657876SArnaldo Carvalho de Melo 
10487c657876SArnaldo Carvalho de Melo 	/* Dealing with packet loss */
10494fded33bSArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p(%s), data loss! Reacting...\n",
10504fded33bSArnaldo Carvalho de Melo 		       dccp_role(sk), sk, dccp_state_name(sk->sk_state));
10517c657876SArnaldo Carvalho de Melo 
10527c657876SArnaldo Carvalho de Melo 	p_prev = hcrx->ccid3hcrx_p;
10537c657876SArnaldo Carvalho de Melo 
10547c657876SArnaldo Carvalho de Melo 	/* Calculate loss event rate */
1055c0996660SIan McDonald 	if (!list_empty(&hcrx->ccid3hcrx_li_hist)) {
1056c0996660SIan McDonald 		u32 i_mean = dccp_li_hist_calc_i_mean(&hcrx->ccid3hcrx_li_hist);
1057c0996660SIan McDonald 
10587c657876SArnaldo Carvalho de Melo 		/* Scaling up by 1000000 as fixed decimal */
1059c0996660SIan McDonald 		if (i_mean != 0)
1060c0996660SIan McDonald 			hcrx->ccid3hcrx_p = 1000000 / i_mean;
106159348b19SGerrit Renker 	} else
106259348b19SGerrit Renker 		DCCP_BUG("empty loss history");
10637c657876SArnaldo Carvalho de Melo 
10647c657876SArnaldo Carvalho de Melo 	if (hcrx->ccid3hcrx_p > p_prev) {
10657c657876SArnaldo Carvalho de Melo 		ccid3_hc_rx_send_feedback(sk);
10667c657876SArnaldo Carvalho de Melo 		return;
10677c657876SArnaldo Carvalho de Melo 	}
10687c657876SArnaldo Carvalho de Melo }
10697c657876SArnaldo Carvalho de Melo 
107091f0ebf7SArnaldo Carvalho de Melo static int ccid3_hc_rx_init(struct ccid *ccid, struct sock *sk)
10717c657876SArnaldo Carvalho de Melo {
10727c657876SArnaldo Carvalho de Melo 	struct dccp_sock *dp = dccp_sk(sk);
107391f0ebf7SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid_priv(ccid);
10747c657876SArnaldo Carvalho de Melo 
10757c657876SArnaldo Carvalho de Melo 	ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
10767c657876SArnaldo Carvalho de Melo 
1077a84ffe43SArnaldo Carvalho de Melo 	if (dp->dccps_packet_size >= TFRC_MIN_PACKET_SIZE &&
1078a84ffe43SArnaldo Carvalho de Melo 	    dp->dccps_packet_size <= TFRC_MAX_PACKET_SIZE)
1079a84ffe43SArnaldo Carvalho de Melo 		hcrx->ccid3hcrx_s = dp->dccps_packet_size;
10807c657876SArnaldo Carvalho de Melo 	else
10817c657876SArnaldo Carvalho de Melo 		hcrx->ccid3hcrx_s = TFRC_STD_PACKET_SIZE;
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;
1088954ee31fSArnaldo Carvalho de Melo 	hcrx->ccid3hcrx_rtt = 5000; /* XXX 5ms for now... */
10897c657876SArnaldo Carvalho de Melo 	return 0;
10907c657876SArnaldo Carvalho de Melo }
10917c657876SArnaldo Carvalho de Melo 
10927c657876SArnaldo Carvalho de Melo static void ccid3_hc_rx_exit(struct sock *sk)
10937c657876SArnaldo Carvalho de Melo {
109459725dc2SArnaldo Carvalho de Melo 	struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
10957c657876SArnaldo Carvalho de Melo 
109659d203f9SArnaldo Carvalho de Melo 	BUG_ON(hcrx == NULL);
10977c657876SArnaldo Carvalho de Melo 
10987c657876SArnaldo Carvalho de Melo 	ccid3_hc_rx_set_state(sk, TFRC_RSTATE_TERM);
10997c657876SArnaldo Carvalho de Melo 
11007c657876SArnaldo Carvalho de Melo 	/* Empty packet history */
11018c60f3faSArnaldo Carvalho de Melo 	dccp_rx_hist_purge(ccid3_rx_hist, &hcrx->ccid3hcrx_hist);
11027c657876SArnaldo Carvalho de Melo 
11037c657876SArnaldo Carvalho de Melo 	/* Empty loss interval history */
1104ae6706f0SArnaldo Carvalho de Melo 	dccp_li_hist_purge(ccid3_li_hist, &hcrx->ccid3hcrx_li_hist);
11057c657876SArnaldo Carvalho de Melo }
11067c657876SArnaldo Carvalho de Melo 
11072babe1f6SArnaldo Carvalho de Melo static void ccid3_hc_rx_get_info(struct sock *sk, struct tcp_info *info)
11082babe1f6SArnaldo Carvalho de Melo {
110959725dc2SArnaldo Carvalho de Melo 	const struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
11102babe1f6SArnaldo Carvalho de Melo 
111159c2353dSArnaldo Carvalho de Melo 	/* Listen socks doesn't have a private CCID block */
111259c2353dSArnaldo Carvalho de Melo 	if (sk->sk_state == DCCP_LISTEN)
111359c2353dSArnaldo Carvalho de Melo 		return;
111459c2353dSArnaldo Carvalho de Melo 
111559d203f9SArnaldo Carvalho de Melo 	BUG_ON(hcrx == NULL);
11162babe1f6SArnaldo Carvalho de Melo 
11172babe1f6SArnaldo Carvalho de Melo 	info->tcpi_ca_state	= hcrx->ccid3hcrx_state;
11182babe1f6SArnaldo Carvalho de Melo 	info->tcpi_options	|= TCPI_OPT_TIMESTAMPS;
11192babe1f6SArnaldo Carvalho de Melo 	info->tcpi_rcv_rtt	= hcrx->ccid3hcrx_rtt;
11202babe1f6SArnaldo Carvalho de Melo }
11212babe1f6SArnaldo Carvalho de Melo 
11222babe1f6SArnaldo Carvalho de Melo static void ccid3_hc_tx_get_info(struct sock *sk, struct tcp_info *info)
11232babe1f6SArnaldo Carvalho de Melo {
112459725dc2SArnaldo Carvalho de Melo 	const struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
11252babe1f6SArnaldo Carvalho de Melo 
112659c2353dSArnaldo Carvalho de Melo 	/* Listen socks doesn't have a private CCID block */
112759c2353dSArnaldo Carvalho de Melo 	if (sk->sk_state == DCCP_LISTEN)
112859c2353dSArnaldo Carvalho de Melo 		return;
112959c2353dSArnaldo Carvalho de Melo 
113059d203f9SArnaldo Carvalho de Melo 	BUG_ON(hctx == NULL);
11312babe1f6SArnaldo Carvalho de Melo 
11322babe1f6SArnaldo Carvalho de Melo 	info->tcpi_rto = hctx->ccid3hctx_t_rto;
11332babe1f6SArnaldo Carvalho de Melo 	info->tcpi_rtt = hctx->ccid3hctx_rtt;
11342babe1f6SArnaldo Carvalho de Melo }
11352babe1f6SArnaldo Carvalho de Melo 
113688f964dbSArnaldo Carvalho de Melo static int ccid3_hc_rx_getsockopt(struct sock *sk, const int optname, int len,
113788f964dbSArnaldo Carvalho de Melo 				  u32 __user *optval, int __user *optlen)
113888f964dbSArnaldo Carvalho de Melo {
113988f964dbSArnaldo Carvalho de Melo 	const struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
114088f964dbSArnaldo Carvalho de Melo 	const void *val;
114188f964dbSArnaldo Carvalho de Melo 
114288f964dbSArnaldo Carvalho de Melo 	/* Listen socks doesn't have a private CCID block */
114388f964dbSArnaldo Carvalho de Melo 	if (sk->sk_state == DCCP_LISTEN)
114488f964dbSArnaldo Carvalho de Melo 		return -EINVAL;
114588f964dbSArnaldo Carvalho de Melo 
114688f964dbSArnaldo Carvalho de Melo 	switch (optname) {
114788f964dbSArnaldo Carvalho de Melo 	case DCCP_SOCKOPT_CCID_RX_INFO:
114888f964dbSArnaldo Carvalho de Melo 		if (len < sizeof(hcrx->ccid3hcrx_tfrc))
114988f964dbSArnaldo Carvalho de Melo 			return -EINVAL;
115088f964dbSArnaldo Carvalho de Melo 		len = sizeof(hcrx->ccid3hcrx_tfrc);
115188f964dbSArnaldo Carvalho de Melo 		val = &hcrx->ccid3hcrx_tfrc;
115288f964dbSArnaldo Carvalho de Melo 		break;
115388f964dbSArnaldo Carvalho de Melo 	default:
115488f964dbSArnaldo Carvalho de Melo 		return -ENOPROTOOPT;
115588f964dbSArnaldo Carvalho de Melo 	}
115688f964dbSArnaldo Carvalho de Melo 
115788f964dbSArnaldo Carvalho de Melo 	if (put_user(len, optlen) || copy_to_user(optval, val, len))
115888f964dbSArnaldo Carvalho de Melo 		return -EFAULT;
115988f964dbSArnaldo Carvalho de Melo 
116088f964dbSArnaldo Carvalho de Melo 	return 0;
116188f964dbSArnaldo Carvalho de Melo }
116288f964dbSArnaldo Carvalho de Melo 
116388f964dbSArnaldo Carvalho de Melo static int ccid3_hc_tx_getsockopt(struct sock *sk, const int optname, int len,
116488f964dbSArnaldo Carvalho de Melo 				  u32 __user *optval, int __user *optlen)
116588f964dbSArnaldo Carvalho de Melo {
116688f964dbSArnaldo Carvalho de Melo 	const struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
116788f964dbSArnaldo Carvalho de Melo 	const void *val;
116888f964dbSArnaldo Carvalho de Melo 
116988f964dbSArnaldo Carvalho de Melo 	/* Listen socks doesn't have a private CCID block */
117088f964dbSArnaldo Carvalho de Melo 	if (sk->sk_state == DCCP_LISTEN)
117188f964dbSArnaldo Carvalho de Melo 		return -EINVAL;
117288f964dbSArnaldo Carvalho de Melo 
117388f964dbSArnaldo Carvalho de Melo 	switch (optname) {
117488f964dbSArnaldo Carvalho de Melo 	case DCCP_SOCKOPT_CCID_TX_INFO:
117588f964dbSArnaldo Carvalho de Melo 		if (len < sizeof(hctx->ccid3hctx_tfrc))
117688f964dbSArnaldo Carvalho de Melo 			return -EINVAL;
117788f964dbSArnaldo Carvalho de Melo 		len = sizeof(hctx->ccid3hctx_tfrc);
117888f964dbSArnaldo Carvalho de Melo 		val = &hctx->ccid3hctx_tfrc;
117988f964dbSArnaldo Carvalho de Melo 		break;
118088f964dbSArnaldo Carvalho de Melo 	default:
118188f964dbSArnaldo Carvalho de Melo 		return -ENOPROTOOPT;
118288f964dbSArnaldo Carvalho de Melo 	}
118388f964dbSArnaldo Carvalho de Melo 
118488f964dbSArnaldo Carvalho de Melo 	if (put_user(len, optlen) || copy_to_user(optval, val, len))
118588f964dbSArnaldo Carvalho de Melo 		return -EFAULT;
118688f964dbSArnaldo Carvalho de Melo 
118788f964dbSArnaldo Carvalho de Melo 	return 0;
118888f964dbSArnaldo Carvalho de Melo }
118988f964dbSArnaldo Carvalho de Melo 
119091f0ebf7SArnaldo Carvalho de Melo static struct ccid_operations ccid3 = {
11913dd9a7c3SIan McDonald 	.ccid_id		   = DCCPC_CCID3,
11927c657876SArnaldo Carvalho de Melo 	.ccid_name		   = "ccid3",
11937c657876SArnaldo Carvalho de Melo 	.ccid_owner		   = THIS_MODULE,
119491f0ebf7SArnaldo Carvalho de Melo 	.ccid_hc_tx_obj_size	   = sizeof(struct ccid3_hc_tx_sock),
11957c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_init	   = ccid3_hc_tx_init,
11967c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_exit	   = ccid3_hc_tx_exit,
11977c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_send_packet	   = ccid3_hc_tx_send_packet,
11987c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_packet_sent	   = ccid3_hc_tx_packet_sent,
11997c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_packet_recv	   = ccid3_hc_tx_packet_recv,
12007c657876SArnaldo Carvalho de Melo 	.ccid_hc_tx_insert_options = ccid3_hc_tx_insert_options,
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