blob: 9297fca7868305a40bbf35a2c6ec1cd4a8ea98df [file] [log] [blame]
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001/*
2 * net/dccp/ccids/ccid3.c
3 *
4 * Copyright (c) 2005 The University of Waikato, Hamilton, New Zealand.
Ian McDonalde6bccd32006-08-26 19:01:30 -07005 * Copyright (c) 2005-6 Ian McDonald <ian.mcdonald@jandi.co.nz>
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07006 *
7 * An implementation of the DCCP protocol
8 *
9 * This code has been developed by the University of Waikato WAND
10 * research group. For further information please see http://www.wand.net.nz/
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -070011 *
12 * This code also uses code from Lulea University, rereleased as GPL by its
13 * authors:
14 * Copyright (c) 2003 Nils-Erik Mattsson, Joacim Haggmark, Magnus Erixzon
15 *
16 * Changes to meet Linux coding standards, to make it meet latest ccid3 draft
17 * and to make it work as a loadable module in the DCCP stack written by
18 * Arnaldo Carvalho de Melo <acme@conectiva.com.br>.
19 *
20 * Copyright (c) 2005 Arnaldo Carvalho de Melo <acme@conectiva.com.br>
21 *
22 * This program is free software; you can redistribute it and/or modify
23 * it under the terms of the GNU General Public License as published by
24 * the Free Software Foundation; either version 2 of the License, or
25 * (at your option) any later version.
26 *
27 * This program is distributed in the hope that it will be useful,
28 * but WITHOUT ANY WARRANTY; without even the implied warranty of
29 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
30 * GNU General Public License for more details.
31 *
32 * You should have received a copy of the GNU General Public License
33 * along with this program; if not, write to the Free Software
34 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
35 */
36
37#include "../ccid.h"
38#include "../dccp.h"
Arnaldo Carvalho de Melo4524b252005-08-27 23:18:26 -030039#include "lib/packet_history.h"
Arnaldo Carvalho de Meloae6706f2005-08-27 23:03:09 -030040#include "lib/loss_interval.h"
Arnaldo Carvalho de Melo36729c12005-08-28 00:47:15 -030041#include "lib/tfrc.h"
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -070042#include "ccid3.h"
43
Arnaldo Carvalho de Melo6b5e6332005-08-27 20:11:28 -030044/*
Arnaldo Carvalho de Melo0ba7a3b2005-09-09 02:28:47 -030045 * Reason for maths here is to avoid 32 bit overflow when a is big.
46 * With this we get close to the limit.
Arnaldo Carvalho de Melo6b5e6332005-08-27 20:11:28 -030047 */
Arnaldo Carvalho de Meloc25a18b2006-03-20 21:58:56 -080048static u32 usecs_div(const u32 a, const u32 b)
Arnaldo Carvalho de Melo6b5e6332005-08-27 20:11:28 -030049{
Arnaldo Carvalho de Melo0ba7a3b2005-09-09 02:28:47 -030050 const u32 div = a < (UINT_MAX / (USEC_PER_SEC / 10)) ? 10 :
51 a < (UINT_MAX / (USEC_PER_SEC / 50)) ? 50 :
52 a < (UINT_MAX / (USEC_PER_SEC / 100)) ? 100 :
53 a < (UINT_MAX / (USEC_PER_SEC / 500)) ? 500 :
54 a < (UINT_MAX / (USEC_PER_SEC / 1000)) ? 1000 :
55 a < (UINT_MAX / (USEC_PER_SEC / 5000)) ? 5000 :
56 a < (UINT_MAX / (USEC_PER_SEC / 10000)) ? 10000 :
57 a < (UINT_MAX / (USEC_PER_SEC / 50000)) ? 50000 :
58 100000;
59 const u32 tmp = a * (USEC_PER_SEC / div);
60 return (b >= 2 * div) ? tmp / (b / div) : tmp;
Arnaldo Carvalho de Melo6b5e6332005-08-27 20:11:28 -030061}
62
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -070063
Gerrit Renker56724aa2006-11-20 18:28:09 -020064
65#ifdef CONFIG_IP_DCCP_CCID3_DEBUG
66static int ccid3_debug;
67#define ccid3_pr_debug(format, a...) DCCP_PR_DEBUG(ccid3_debug, format, ##a)
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -070068#else
69#define ccid3_pr_debug(format, a...)
70#endif
71
Arnaldo Carvalho de Meloa1d3a352005-08-13 22:42:25 -030072static struct dccp_tx_hist *ccid3_tx_hist;
73static struct dccp_rx_hist *ccid3_rx_hist;
Arnaldo Carvalho de Meloae6706f2005-08-27 23:03:09 -030074static struct dccp_li_hist *ccid3_li_hist;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -070075
Gerrit Renker56724aa2006-11-20 18:28:09 -020076#ifdef CONFIG_IP_DCCP_CCID3_DEBUG
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -070077static const char *ccid3_tx_state_name(enum ccid3_hc_tx_states state)
78{
79 static char *ccid3_state_names[] = {
80 [TFRC_SSTATE_NO_SENT] = "NO_SENT",
81 [TFRC_SSTATE_NO_FBACK] = "NO_FBACK",
82 [TFRC_SSTATE_FBACK] = "FBACK",
83 [TFRC_SSTATE_TERM] = "TERM",
84 };
85
86 return ccid3_state_names[state];
87}
88#endif
89
Arnaldo Carvalho de Meloc25a18b2006-03-20 21:58:56 -080090static void ccid3_hc_tx_set_state(struct sock *sk,
91 enum ccid3_hc_tx_states state)
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -070092{
Arnaldo Carvalho de Melo59725dc2005-09-09 02:40:58 -030093 struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -070094 enum ccid3_hc_tx_states oldstate = hctx->ccid3hctx_state;
95
96 ccid3_pr_debug("%s(%p) %-8.8s -> %s\n",
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -030097 dccp_role(sk), sk, ccid3_tx_state_name(oldstate),
98 ccid3_tx_state_name(state));
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -070099 WARN_ON(state == oldstate);
100 hctx->ccid3hctx_state = state;
101}
102
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700103/* Calculate new t_ipi (inter packet interval) by t_ipi = s / X_inst */
104static inline void ccid3_calc_new_t_ipi(struct ccid3_hc_tx_sock *hctx)
105{
Gerrit Renkerf5c2d632006-11-27 12:22:48 -0200106 hctx->ccid3hctx_t_ipi = usecs_div(hctx->ccid3hctx_s, hctx->ccid3hctx_x);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700107}
108
109/* Calculate new delta by delta = min(t_ipi / 2, t_gran / 2) */
110static inline void ccid3_calc_new_delta(struct ccid3_hc_tx_sock *hctx)
111{
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300112 hctx->ccid3hctx_delta = min_t(u32, hctx->ccid3hctx_t_ipi / 2,
113 TFRC_OPSYS_HALF_TIME_GRAN);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700114}
115
116/*
117 * Update X by
118 * If (p > 0)
119 * x_calc = calcX(s, R, p);
120 * X = max(min(X_calc, 2 * X_recv), s / t_mbi);
121 * Else
122 * If (now - tld >= R)
123 * X = max(min(2 * X, 2 * X_recv), s / R);
124 * tld = now;
125 */
126static void ccid3_hc_tx_update_x(struct sock *sk)
127{
Arnaldo Carvalho de Melo59725dc2005-09-09 02:40:58 -0300128 struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700129
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300130 /* To avoid large error in calcX */
131 if (hctx->ccid3hctx_p >= TFRC_SMALLEST_P) {
Arnaldo Carvalho de Melo36729c12005-08-28 00:47:15 -0300132 hctx->ccid3hctx_x_calc = tfrc_calc_x(hctx->ccid3hctx_s,
133 hctx->ccid3hctx_rtt,
134 hctx->ccid3hctx_p);
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300135 hctx->ccid3hctx_x = max_t(u32, min_t(u32, hctx->ccid3hctx_x_calc,
136 2 * hctx->ccid3hctx_x_recv),
137 (hctx->ccid3hctx_s /
138 TFRC_MAX_BACK_OFF_TIME));
Arnaldo Carvalho de Melob6ee3d42005-08-27 18:18:18 -0300139 } else {
140 struct timeval now;
141
Arnaldo Carvalho de Melob0e56782005-09-09 02:38:35 -0300142 dccp_timestamp(sk, &now);
Arnaldo Carvalho de Melob6ee3d42005-08-27 18:18:18 -0300143 if (timeval_delta(&now, &hctx->ccid3hctx_t_ld) >=
144 hctx->ccid3hctx_rtt) {
Arnaldo Carvalho de Melo6b5e6332005-08-27 20:11:28 -0300145 hctx->ccid3hctx_x = max_t(u32, min_t(u32, hctx->ccid3hctx_x_recv,
146 hctx->ccid3hctx_x) * 2,
147 usecs_div(hctx->ccid3hctx_s,
148 hctx->ccid3hctx_rtt));
Arnaldo Carvalho de Melob6ee3d42005-08-27 18:18:18 -0300149 hctx->ccid3hctx_t_ld = now;
150 }
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700151 }
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700152}
153
154static void ccid3_hc_tx_no_feedback_timer(unsigned long data)
155{
156 struct sock *sk = (struct sock *)data;
Arnaldo Carvalho de Melo59725dc2005-09-09 02:40:58 -0300157 struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
Gerrit Renker48e03ee2006-11-27 20:29:27 -0200158 unsigned long next_tmout = USEC_PER_SEC / 5;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700159
160 bh_lock_sock(sk);
161 if (sock_owned_by_user(sk)) {
162 /* Try again later. */
163 /* XXX: set some sensible MIB */
Gerrit Renker48e03ee2006-11-27 20:29:27 -0200164 goto restart_timer;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700165 }
166
167 ccid3_pr_debug("%s, sk=%p, state=%s\n", dccp_role(sk), sk,
168 ccid3_tx_state_name(hctx->ccid3hctx_state));
169
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700170 switch (hctx->ccid3hctx_state) {
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700171 case TFRC_SSTATE_NO_FBACK:
172 /* Halve send rate */
173 hctx->ccid3hctx_x /= 2;
Arnaldo Carvalho de Melo6b5e6332005-08-27 20:11:28 -0300174 if (hctx->ccid3hctx_x < (hctx->ccid3hctx_s /
175 TFRC_MAX_BACK_OFF_TIME))
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300176 hctx->ccid3hctx_x = (hctx->ccid3hctx_s /
177 TFRC_MAX_BACK_OFF_TIME);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700178
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300179 ccid3_pr_debug("%s, sk=%p, state=%s, updated tx rate to %d "
180 "bytes/s\n",
181 dccp_role(sk), sk,
182 ccid3_tx_state_name(hctx->ccid3hctx_state),
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700183 hctx->ccid3hctx_x);
Gerrit Renker48e03ee2006-11-27 20:29:27 -0200184 /* The value of R is still undefined and so we can not recompute
185 * the timout value. Keep initial value as per [RFC 4342, 5]. */
186 next_tmout = TFRC_INITIAL_TIMEOUT;
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300187 /*
188 * FIXME - not sure above calculation is correct. See section
189 * 5 of CCID3 11 should adjust tx_t_ipi and double that to
190 * achieve it really
191 */
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700192 break;
193 case TFRC_SSTATE_FBACK:
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300194 /*
195 * Check if IDLE since last timeout and recv rate is less than
196 * 4 packets per RTT
197 */
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300198 if (!hctx->ccid3hctx_idle ||
Arnaldo Carvalho de Melo6b5e6332005-08-27 20:11:28 -0300199 (hctx->ccid3hctx_x_recv >=
200 4 * usecs_div(hctx->ccid3hctx_s, hctx->ccid3hctx_rtt))) {
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300201 ccid3_pr_debug("%s, sk=%p, state=%s, not idle\n",
202 dccp_role(sk), sk,
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700203 ccid3_tx_state_name(hctx->ccid3hctx_state));
204 /* Halve sending rate */
205
206 /* If (X_calc > 2 * X_recv)
207 * X_recv = max(X_recv / 2, s / (2 * t_mbi));
208 * Else
209 * X_recv = X_calc / 4;
210 */
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300211 BUG_ON(hctx->ccid3hctx_p >= TFRC_SMALLEST_P &&
212 hctx->ccid3hctx_x_calc == 0);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700213
214 /* check also if p is zero -> x_calc is infinity? */
215 if (hctx->ccid3hctx_p < TFRC_SMALLEST_P ||
216 hctx->ccid3hctx_x_calc > 2 * hctx->ccid3hctx_x_recv)
217 hctx->ccid3hctx_x_recv = max_t(u32, hctx->ccid3hctx_x_recv / 2,
218 hctx->ccid3hctx_s / (2 * TFRC_MAX_BACK_OFF_TIME));
219 else
220 hctx->ccid3hctx_x_recv = hctx->ccid3hctx_x_calc / 4;
221
222 /* Update sending rate */
223 ccid3_hc_tx_update_x(sk);
224 }
Arnaldo Carvalho de Melo6b5e6332005-08-27 20:11:28 -0300225 /*
226 * Schedule no feedback timer to expire in
227 * max(4 * R, 2 * s / X)
228 */
Arnaldo Carvalho de Meloc68e64c2005-08-21 05:07:37 -0300229 next_tmout = max_t(u32, hctx->ccid3hctx_t_rto,
Arnaldo Carvalho de Melo6b5e6332005-08-27 20:11:28 -0300230 2 * usecs_div(hctx->ccid3hctx_s,
231 hctx->ccid3hctx_x));
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700232 break;
Gerrit Renker59348b12006-11-20 18:39:23 -0200233 case TFRC_SSTATE_NO_SENT:
234 DCCP_BUG("Illegal %s state NO_SENT, sk=%p", dccp_role(sk), sk);
235 /* fall through */
236 case TFRC_SSTATE_TERM:
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700237 goto out;
238 }
239
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700240 hctx->ccid3hctx_idle = 1;
Gerrit Renker48e03ee2006-11-27 20:29:27 -0200241
242restart_timer:
243 sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
244 jiffies + usecs_to_jiffies(next_tmout));
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700245out:
246 bh_unlock_sock(sk);
247 sock_put(sk);
248}
249
Gerrit Renker7da7f452006-11-27 12:26:03 -0200250/*
251 * returns
252 * > 0: delay (in msecs) that should pass before actually sending
253 * = 0: can send immediately
254 * < 0: error condition; do not send packet
255 */
Arnaldo Carvalho de Melo27258ee2005-08-09 20:30:56 -0700256static int ccid3_hc_tx_send_packet(struct sock *sk,
257 struct sk_buff *skb, int len)
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700258{
259 struct dccp_sock *dp = dccp_sk(sk);
Arnaldo Carvalho de Melo59725dc2005-09-09 02:40:58 -0300260 struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -0300261 struct dccp_tx_hist_entry *new_packet;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700262 struct timeval now;
Arnaldo Carvalho de Melo27258ee2005-08-09 20:30:56 -0700263 long delay;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700264
Gerrit Renker59348b12006-11-20 18:39:23 -0200265 BUG_ON(hctx == NULL);
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300266
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700267 /*
Gerrit Renkerda335ba2006-11-27 12:26:57 -0200268 * This function is called only for Data and DataAck packets. Sending
269 * zero-sized Data(Ack)s is theoretically possible, but for congestion
270 * control this case is pathological - ignore it.
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700271 */
Arnaldo Carvalho de Melo59d203f2005-09-09 20:01:25 -0300272 if (unlikely(len == 0))
Gerrit Renkerda335ba2006-11-27 12:26:57 -0200273 return -EBADMSG;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700274
275 /* See if last packet allocated was not sent */
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -0300276 new_packet = dccp_tx_hist_head(&hctx->ccid3hctx_hist);
277 if (new_packet == NULL || new_packet->dccphtx_sent) {
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300278 new_packet = dccp_tx_hist_entry_new(ccid3_tx_hist,
279 SLAB_ATOMIC);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700280
Arnaldo Carvalho de Melo59d203f2005-09-09 20:01:25 -0300281 if (unlikely(new_packet == NULL)) {
Gerrit Renker59348b12006-11-20 18:39:23 -0200282 DCCP_WARN("%s, sk=%p, not enough mem to add to history,"
283 "send refused\n", dccp_role(sk), sk);
Gerrit Renker7da7f452006-11-27 12:26:03 -0200284 return -ENOBUFS;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700285 }
286
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -0300287 dccp_tx_hist_add_entry(&hctx->ccid3hctx_hist, new_packet);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700288 }
289
Arnaldo Carvalho de Melob0e56782005-09-09 02:38:35 -0300290 dccp_timestamp(sk, &now);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700291
292 switch (hctx->ccid3hctx_state) {
293 case TFRC_SSTATE_NO_SENT:
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300294 sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
295 jiffies + usecs_to_jiffies(TFRC_INITIAL_TIMEOUT));
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700296 hctx->ccid3hctx_last_win_count = 0;
297 hctx->ccid3hctx_t_last_win_count = now;
298 ccid3_hc_tx_set_state(sk, TFRC_SSTATE_NO_FBACK);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700299
Gerrit Renker90feeb92006-11-27 12:13:38 -0200300 /* First timeout, according to [RFC 3448, 4.2], is 1 second */
301 hctx->ccid3hctx_t_ipi = USEC_PER_SEC;
302 /* Initial delta: minimum of 0.5 sec and t_gran/2 */
303 hctx->ccid3hctx_delta = TFRC_OPSYS_HALF_TIME_GRAN;
304
305 /* Set t_0 for initial packet */
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700306 hctx->ccid3hctx_t_nom = now;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700307 break;
308 case TFRC_SSTATE_NO_FBACK:
309 case TFRC_SSTATE_FBACK:
Gerrit Renker91cf5a12006-11-27 12:25:10 -0200310 delay = timeval_delta(&hctx->ccid3hctx_t_nom, &now);
311 /*
312 * Scheduling of packet transmissions [RFC 3448, 4.6]
313 *
314 * if (t_now > t_nom - delta)
315 * // send the packet now
316 * else
317 * // send the packet in (t_nom - t_now) milliseconds.
318 */
Gerrit Renker7da7f452006-11-27 12:26:03 -0200319 if (delay >= hctx->ccid3hctx_delta)
320 return delay / 1000L;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700321 break;
Gerrit Renker59348b12006-11-20 18:39:23 -0200322 case TFRC_SSTATE_TERM:
323 DCCP_BUG("Illegal %s state TERM, sk=%p", dccp_role(sk), sk);
Gerrit Renker7da7f452006-11-27 12:26:03 -0200324 return -EINVAL;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700325 }
326
Gerrit Renker7da7f452006-11-27 12:26:03 -0200327 /* prepare to send now (add options etc.) */
328 dp->dccps_hc_tx_insert_options = 1;
329 new_packet->dccphtx_ccval = DCCP_SKB_CB(skb)->dccpd_ccval =
330 hctx->ccid3hctx_last_win_count;
331 timeval_add_usecs(&hctx->ccid3hctx_t_nom, hctx->ccid3hctx_t_ipi);
332
333 return 0;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700334}
335
336static void ccid3_hc_tx_packet_sent(struct sock *sk, int more, int len)
337{
Arnaldo Carvalho de Melo59725dc2005-09-09 02:40:58 -0300338 const struct dccp_sock *dp = dccp_sk(sk);
339 struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700340 struct timeval now;
341
Gerrit Renker59348b12006-11-20 18:39:23 -0200342 BUG_ON(hctx == NULL);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700343
Arnaldo Carvalho de Melob0e56782005-09-09 02:38:35 -0300344 dccp_timestamp(sk, &now);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700345
346 /* check if we have sent a data packet */
347 if (len > 0) {
348 unsigned long quarter_rtt;
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -0300349 struct dccp_tx_hist_entry *packet;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700350
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -0300351 packet = dccp_tx_hist_head(&hctx->ccid3hctx_hist);
Arnaldo Carvalho de Melo59d203f2005-09-09 20:01:25 -0300352 if (unlikely(packet == NULL)) {
Gerrit Renker59348b12006-11-20 18:39:23 -0200353 DCCP_WARN("packet doesn't exist in history!\n");
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700354 return;
355 }
Arnaldo Carvalho de Melo59d203f2005-09-09 20:01:25 -0300356 if (unlikely(packet->dccphtx_sent)) {
Gerrit Renker59348b12006-11-20 18:39:23 -0200357 DCCP_WARN("no unsent packet in history!\n");
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700358 return;
359 }
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -0300360 packet->dccphtx_tstamp = now;
361 packet->dccphtx_seqno = dp->dccps_gss;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700362 /*
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300363 * Check if win_count have changed
Gerrit Renker0e64e942006-10-24 16:17:51 -0700364 * Algorithm in "8.1. Window Counter Value" in RFC 4342.
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700365 */
Arnaldo Carvalho de Melo6b5e6332005-08-27 20:11:28 -0300366 quarter_rtt = timeval_delta(&now, &hctx->ccid3hctx_t_last_win_count);
367 if (likely(hctx->ccid3hctx_rtt > 8))
368 quarter_rtt /= hctx->ccid3hctx_rtt / 4;
369
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700370 if (quarter_rtt > 0) {
371 hctx->ccid3hctx_t_last_win_count = now;
372 hctx->ccid3hctx_last_win_count = (hctx->ccid3hctx_last_win_count +
373 min_t(unsigned long, quarter_rtt, 5)) % 16;
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300374 ccid3_pr_debug("%s, sk=%p, window changed from "
375 "%u to %u!\n",
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700376 dccp_role(sk), sk,
Arnaldo Carvalho de Meloc1734372005-08-13 20:34:23 -0300377 packet->dccphtx_ccval,
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700378 hctx->ccid3hctx_last_win_count);
379 }
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300380
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700381 hctx->ccid3hctx_idle = 0;
Arnaldo Carvalho de Meloc1734372005-08-13 20:34:23 -0300382 packet->dccphtx_rtt = hctx->ccid3hctx_rtt;
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -0300383 packet->dccphtx_sent = 1;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700384 } else
385 ccid3_pr_debug("%s, sk=%p, seqno=%llu NOT inserted!\n",
386 dccp_role(sk), sk, dp->dccps_gss);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700387}
388
389static void ccid3_hc_tx_packet_recv(struct sock *sk, struct sk_buff *skb)
390{
Arnaldo Carvalho de Melo59725dc2005-09-09 02:40:58 -0300391 const struct dccp_sock *dp = dccp_sk(sk);
392 struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700393 struct ccid3_options_received *opt_recv;
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -0300394 struct dccp_tx_hist_entry *packet;
Arnaldo Carvalho de Melob0e56782005-09-09 02:38:35 -0300395 struct timeval now;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700396 unsigned long next_tmout;
Ian McDonald1bc09862005-08-20 00:23:43 -0300397 u32 t_elapsed;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700398 u32 pinv;
399 u32 x_recv;
400 u32 r_sample;
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300401
Gerrit Renker59348b12006-11-20 18:39:23 -0200402 BUG_ON(hctx == NULL);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700403
404 /* we are only interested in ACKs */
405 if (!(DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_ACK ||
406 DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_DATAACK))
407 return;
408
409 opt_recv = &hctx->ccid3hctx_options_received;
410
Arnaldo Carvalho de Melo1a285992005-09-09 02:32:56 -0300411 t_elapsed = dp->dccps_options_received.dccpor_elapsed_time * 10;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700412 x_recv = opt_recv->ccid3or_receive_rate;
413 pinv = opt_recv->ccid3or_loss_event_rate;
414
415 switch (hctx->ccid3hctx_state) {
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700416 case TFRC_SSTATE_NO_FBACK:
417 case TFRC_SSTATE_FBACK:
418 /* Calculate new round trip sample by
419 * R_sample = (now - t_recvdata) - t_delay */
420 /* get t_recvdata from history */
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -0300421 packet = dccp_tx_hist_find_entry(&hctx->ccid3hctx_hist,
422 DCCP_SKB_CB(skb)->dccpd_ack_seq);
Arnaldo Carvalho de Melo59d203f2005-09-09 20:01:25 -0300423 if (unlikely(packet == NULL)) {
Gerrit Renker59348b12006-11-20 18:39:23 -0200424 DCCP_WARN("%s, sk=%p, seqno %llu(%s) does't exist "
425 "in history!\n", dccp_role(sk), sk,
Arnaldo Carvalho de Melo59d203f2005-09-09 20:01:25 -0300426 (unsigned long long)DCCP_SKB_CB(skb)->dccpd_ack_seq,
Gerrit Renker59348b12006-11-20 18:39:23 -0200427 dccp_packet_name(DCCP_SKB_CB(skb)->dccpd_type));
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700428 return;
429 }
430
431 /* Update RTT */
Arnaldo Carvalho de Melob0e56782005-09-09 02:38:35 -0300432 dccp_timestamp(sk, &now);
433 r_sample = timeval_delta(&now, &packet->dccphtx_tstamp);
Arnaldo Carvalho de Melo1a285992005-09-09 02:32:56 -0300434 if (unlikely(r_sample <= t_elapsed))
Gerrit Renker59348b12006-11-20 18:39:23 -0200435 DCCP_WARN("r_sample=%uus,t_elapsed=%uus\n",
436 r_sample, t_elapsed);
Arnaldo Carvalho de Melo1a285992005-09-09 02:32:56 -0300437 else
438 r_sample -= t_elapsed;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700439
440 /* Update RTT estimate by
441 * If (No feedback recv)
442 * R = R_sample;
443 * Else
444 * R = q * R + (1 - q) * R_sample;
445 *
446 * q is a constant, RFC 3448 recomments 0.9
447 */
448 if (hctx->ccid3hctx_state == TFRC_SSTATE_NO_FBACK) {
449 ccid3_hc_tx_set_state(sk, TFRC_SSTATE_FBACK);
450 hctx->ccid3hctx_rtt = r_sample;
451 } else
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300452 hctx->ccid3hctx_rtt = (hctx->ccid3hctx_rtt * 9) / 10 +
453 r_sample / 10;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700454
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300455 ccid3_pr_debug("%s, sk=%p, New RTT estimate=%uus, "
456 "r_sample=%us\n", dccp_role(sk), sk,
457 hctx->ccid3hctx_rtt, r_sample);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700458
459 /* Update timeout interval */
Arnaldo Carvalho de Meloc68e64c2005-08-21 05:07:37 -0300460 hctx->ccid3hctx_t_rto = max_t(u32, 4 * hctx->ccid3hctx_rtt,
461 USEC_PER_SEC);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700462
463 /* Update receive rate */
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300464 hctx->ccid3hctx_x_recv = x_recv;/* X_recv in bytes per sec */
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700465
466 /* Update loss event rate */
467 if (pinv == ~0 || pinv == 0)
468 hctx->ccid3hctx_p = 0;
469 else {
470 hctx->ccid3hctx_p = 1000000 / pinv;
471
472 if (hctx->ccid3hctx_p < TFRC_SMALLEST_P) {
473 hctx->ccid3hctx_p = TFRC_SMALLEST_P;
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300474 ccid3_pr_debug("%s, sk=%p, Smallest p used!\n",
475 dccp_role(sk), sk);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700476 }
477 }
478
479 /* unschedule no feedback timer */
480 sk_stop_timer(sk, &hctx->ccid3hctx_no_feedback_timer);
481
482 /* Update sending rate */
483 ccid3_hc_tx_update_x(sk);
484
485 /* Update next send time */
Arnaldo Carvalho de Melob6ee3d42005-08-27 18:18:18 -0300486 timeval_sub_usecs(&hctx->ccid3hctx_t_nom,
487 hctx->ccid3hctx_t_ipi);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700488 ccid3_calc_new_t_ipi(hctx);
Arnaldo Carvalho de Melob6ee3d42005-08-27 18:18:18 -0300489 timeval_add_usecs(&hctx->ccid3hctx_t_nom,
490 hctx->ccid3hctx_t_ipi);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700491 ccid3_calc_new_delta(hctx);
492
493 /* remove all packets older than the one acked from history */
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -0300494 dccp_tx_hist_purge_older(ccid3_tx_hist,
495 &hctx->ccid3hctx_hist, packet);
Arnaldo Carvalho de Meloc530cfb2005-08-29 02:15:54 -0300496 /*
497 * As we have calculated new ipi, delta, t_nom it is possible that
498 * we now can send a packet, so wake up dccp_wait_for_ccids.
499 */
500 sk->sk_write_space(sk);
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -0300501
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300502 /*
503 * Schedule no feedback timer to expire in
504 * max(4 * R, 2 * s / X)
505 */
Arnaldo Carvalho de Meloc68e64c2005-08-21 05:07:37 -0300506 next_tmout = max(hctx->ccid3hctx_t_rto,
Arnaldo Carvalho de Melo6b5e6332005-08-27 20:11:28 -0300507 2 * usecs_div(hctx->ccid3hctx_s,
508 hctx->ccid3hctx_x));
509
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300510 ccid3_pr_debug("%s, sk=%p, Scheduled no feedback timer to "
511 "expire in %lu jiffies (%luus)\n",
512 dccp_role(sk), sk,
513 usecs_to_jiffies(next_tmout), next_tmout);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700514
515 sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300516 jiffies + max_t(u32, 1, usecs_to_jiffies(next_tmout)));
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700517
518 /* set idle flag */
519 hctx->ccid3hctx_idle = 1;
520 break;
Gerrit Renker5e19e3f2006-11-27 12:28:48 -0200521 case TFRC_SSTATE_NO_SENT:
522 DCCP_WARN("Illegal ACK received - no packet has been sent\n");
523 /* fall through */
524 case TFRC_SSTATE_TERM: /* ignore feedback when closing */
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700525 break;
526 }
527}
528
Arnaldo Carvalho de Melo2d0817d2006-03-20 22:32:06 -0800529static int ccid3_hc_tx_insert_options(struct sock *sk, struct sk_buff *skb)
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700530{
Arnaldo Carvalho de Melo59d203f2005-09-09 20:01:25 -0300531 const struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700532
Arnaldo Carvalho de Melo59d203f2005-09-09 20:01:25 -0300533 BUG_ON(hctx == NULL);
534
Arnaldo Carvalho de Melo2d0817d2006-03-20 22:32:06 -0800535 if (sk->sk_state == DCCP_OPEN || sk->sk_state == DCCP_PARTOPEN)
536 DCCP_SKB_CB(skb)->dccpd_ccval = hctx->ccid3hctx_last_win_count;
537 return 0;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700538}
539
540static int ccid3_hc_tx_parse_options(struct sock *sk, unsigned char option,
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300541 unsigned char len, u16 idx,
542 unsigned char *value)
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700543{
544 int rc = 0;
Arnaldo Carvalho de Melo59725dc2005-09-09 02:40:58 -0300545 const struct dccp_sock *dp = dccp_sk(sk);
546 struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700547 struct ccid3_options_received *opt_recv;
548
Arnaldo Carvalho de Melo59d203f2005-09-09 20:01:25 -0300549 BUG_ON(hctx == NULL);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700550
551 opt_recv = &hctx->ccid3hctx_options_received;
552
553 if (opt_recv->ccid3or_seqno != dp->dccps_gsr) {
554 opt_recv->ccid3or_seqno = dp->dccps_gsr;
555 opt_recv->ccid3or_loss_event_rate = ~0;
556 opt_recv->ccid3or_loss_intervals_idx = 0;
557 opt_recv->ccid3or_loss_intervals_len = 0;
558 opt_recv->ccid3or_receive_rate = 0;
559 }
560
561 switch (option) {
562 case TFRC_OPT_LOSS_EVENT_RATE:
Arnaldo Carvalho de Melo59d203f2005-09-09 20:01:25 -0300563 if (unlikely(len != 4)) {
Gerrit Renker59348b12006-11-20 18:39:23 -0200564 DCCP_WARN("%s, sk=%p, invalid len %d "
565 "for TFRC_OPT_LOSS_EVENT_RATE\n",
566 dccp_role(sk), sk, len);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700567 rc = -EINVAL;
568 } else {
Andrea Bittau60fe62e2006-03-20 19:23:32 -0800569 opt_recv->ccid3or_loss_event_rate = ntohl(*(__be32 *)value);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700570 ccid3_pr_debug("%s, sk=%p, LOSS_EVENT_RATE=%u\n",
571 dccp_role(sk), sk,
572 opt_recv->ccid3or_loss_event_rate);
573 }
574 break;
575 case TFRC_OPT_LOSS_INTERVALS:
576 opt_recv->ccid3or_loss_intervals_idx = idx;
577 opt_recv->ccid3or_loss_intervals_len = len;
578 ccid3_pr_debug("%s, sk=%p, LOSS_INTERVALS=(%u, %u)\n",
579 dccp_role(sk), sk,
580 opt_recv->ccid3or_loss_intervals_idx,
581 opt_recv->ccid3or_loss_intervals_len);
582 break;
583 case TFRC_OPT_RECEIVE_RATE:
Arnaldo Carvalho de Melo59d203f2005-09-09 20:01:25 -0300584 if (unlikely(len != 4)) {
Gerrit Renker59348b12006-11-20 18:39:23 -0200585 DCCP_WARN("%s, sk=%p, invalid len %d "
586 "for TFRC_OPT_RECEIVE_RATE\n",
587 dccp_role(sk), sk, len);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700588 rc = -EINVAL;
589 } else {
Andrea Bittau60fe62e2006-03-20 19:23:32 -0800590 opt_recv->ccid3or_receive_rate = ntohl(*(__be32 *)value);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700591 ccid3_pr_debug("%s, sk=%p, RECEIVE_RATE=%u\n",
592 dccp_role(sk), sk,
593 opt_recv->ccid3or_receive_rate);
594 }
595 break;
596 }
597
598 return rc;
599}
600
Arnaldo Carvalho de Melo91f0ebf2006-03-20 19:21:44 -0800601static int ccid3_hc_tx_init(struct ccid *ccid, struct sock *sk)
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700602{
603 struct dccp_sock *dp = dccp_sk(sk);
Arnaldo Carvalho de Melo91f0ebf2006-03-20 19:21:44 -0800604 struct ccid3_hc_tx_sock *hctx = ccid_priv(ccid);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700605
Arnaldo Carvalho de Meloa84ffe42005-08-28 04:51:32 -0300606 if (dp->dccps_packet_size >= TFRC_MIN_PACKET_SIZE &&
607 dp->dccps_packet_size <= TFRC_MAX_PACKET_SIZE)
608 hctx->ccid3hctx_s = dp->dccps_packet_size;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700609 else
610 hctx->ccid3hctx_s = TFRC_STD_PACKET_SIZE;
611
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300612 /* Set transmission rate to 1 packet per second */
613 hctx->ccid3hctx_x = hctx->ccid3hctx_s;
Arnaldo Carvalho de Meloc68e64c2005-08-21 05:07:37 -0300614 hctx->ccid3hctx_t_rto = USEC_PER_SEC;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700615 hctx->ccid3hctx_state = TFRC_SSTATE_NO_SENT;
616 INIT_LIST_HEAD(&hctx->ccid3hctx_hist);
Arnaldo Carvalho de Meloaa5d7df2006-03-20 17:35:13 -0800617
618 hctx->ccid3hctx_no_feedback_timer.function = ccid3_hc_tx_no_feedback_timer;
619 hctx->ccid3hctx_no_feedback_timer.data = (unsigned long)sk;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700620 init_timer(&hctx->ccid3hctx_no_feedback_timer);
621
622 return 0;
623}
624
625static void ccid3_hc_tx_exit(struct sock *sk)
626{
Arnaldo Carvalho de Melo59725dc2005-09-09 02:40:58 -0300627 struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700628
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700629 BUG_ON(hctx == NULL);
630
631 ccid3_hc_tx_set_state(sk, TFRC_SSTATE_TERM);
632 sk_stop_timer(sk, &hctx->ccid3hctx_no_feedback_timer);
633
634 /* Empty packet history */
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -0300635 dccp_tx_hist_purge(ccid3_tx_hist, &hctx->ccid3hctx_hist);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700636}
637
638/*
639 * RX Half Connection methods
640 */
641
Gerrit Renker56724aa2006-11-20 18:28:09 -0200642#ifdef CONFIG_IP_DCCP_CCID3_DEBUG
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700643static const char *ccid3_rx_state_name(enum ccid3_hc_rx_states state)
644{
645 static char *ccid3_rx_state_names[] = {
646 [TFRC_RSTATE_NO_DATA] = "NO_DATA",
647 [TFRC_RSTATE_DATA] = "DATA",
648 [TFRC_RSTATE_TERM] = "TERM",
649 };
650
651 return ccid3_rx_state_names[state];
652}
653#endif
654
Arnaldo Carvalho de Meloc25a18b2006-03-20 21:58:56 -0800655static void ccid3_hc_rx_set_state(struct sock *sk,
656 enum ccid3_hc_rx_states state)
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700657{
Arnaldo Carvalho de Melo59725dc2005-09-09 02:40:58 -0300658 struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700659 enum ccid3_hc_rx_states oldstate = hcrx->ccid3hcrx_state;
660
661 ccid3_pr_debug("%s(%p) %-8.8s -> %s\n",
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300662 dccp_role(sk), sk, ccid3_rx_state_name(oldstate),
663 ccid3_rx_state_name(state));
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700664 WARN_ON(state == oldstate);
665 hcrx->ccid3hcrx_state = state;
666}
667
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700668static void ccid3_hc_rx_send_feedback(struct sock *sk)
669{
Arnaldo Carvalho de Melo59725dc2005-09-09 02:40:58 -0300670 struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700671 struct dccp_sock *dp = dccp_sk(sk);
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -0300672 struct dccp_rx_hist_entry *packet;
Arnaldo Carvalho de Melob6ee3d42005-08-27 18:18:18 -0300673 struct timeval now;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700674
675 ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
676
Arnaldo Carvalho de Melob0e56782005-09-09 02:38:35 -0300677 dccp_timestamp(sk, &now);
Arnaldo Carvalho de Melob6ee3d42005-08-27 18:18:18 -0300678
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700679 switch (hcrx->ccid3hcrx_state) {
680 case TFRC_RSTATE_NO_DATA:
681 hcrx->ccid3hcrx_x_recv = 0;
682 break;
683 case TFRC_RSTATE_DATA: {
Arnaldo Carvalho de Melob6ee3d42005-08-27 18:18:18 -0300684 const u32 delta = timeval_delta(&now,
685 &hcrx->ccid3hcrx_tstamp_last_feedback);
Arnaldo Carvalho de Melo27ae543e2005-09-09 02:31:07 -0300686 hcrx->ccid3hcrx_x_recv = usecs_div(hcrx->ccid3hcrx_bytes_recv,
687 delta);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700688 }
689 break;
Gerrit Renker59348b12006-11-20 18:39:23 -0200690 case TFRC_RSTATE_TERM:
691 DCCP_BUG("Illegal %s state TERM, sk=%p", dccp_role(sk), sk);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700692 return;
693 }
694
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -0300695 packet = dccp_rx_hist_find_data_packet(&hcrx->ccid3hcrx_hist);
Arnaldo Carvalho de Melo59d203f2005-09-09 20:01:25 -0300696 if (unlikely(packet == NULL)) {
Gerrit Renker59348b12006-11-20 18:39:23 -0200697 DCCP_WARN("%s, sk=%p, no data packet in history!\n",
698 dccp_role(sk), sk);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700699 return;
700 }
701
Arnaldo Carvalho de Melob6ee3d42005-08-27 18:18:18 -0300702 hcrx->ccid3hcrx_tstamp_last_feedback = now;
Ian McDonald66a377c2006-08-26 23:40:50 -0700703 hcrx->ccid3hcrx_ccval_last_counter = packet->dccphrx_ccval;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700704 hcrx->ccid3hcrx_bytes_recv = 0;
705
706 /* Convert to multiples of 10us */
Arnaldo Carvalho de Melob6ee3d42005-08-27 18:18:18 -0300707 hcrx->ccid3hcrx_elapsed_time =
708 timeval_delta(&now, &packet->dccphrx_tstamp) / 10;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700709 if (hcrx->ccid3hcrx_p == 0)
710 hcrx->ccid3hcrx_pinv = ~0;
711 else
712 hcrx->ccid3hcrx_pinv = 1000000 / hcrx->ccid3hcrx_p;
Arnaldo Carvalho de Melo507d37c2005-09-09 02:30:07 -0300713 dp->dccps_hc_rx_insert_options = 1;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700714 dccp_send_ack(sk);
715}
716
Arnaldo Carvalho de Melo2d0817d2006-03-20 22:32:06 -0800717static int ccid3_hc_rx_insert_options(struct sock *sk, struct sk_buff *skb)
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700718{
Arnaldo Carvalho de Melo59d203f2005-09-09 20:01:25 -0300719 const struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
Andrea Bittau60fe62e2006-03-20 19:23:32 -0800720 __be32 x_recv, pinv;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700721
Arnaldo Carvalho de Melo59d203f2005-09-09 20:01:25 -0300722 BUG_ON(hcrx == NULL);
723
724 if (!(sk->sk_state == DCCP_OPEN || sk->sk_state == DCCP_PARTOPEN))
Arnaldo Carvalho de Melo2d0817d2006-03-20 22:32:06 -0800725 return 0;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700726
Ian McDonald66a377c2006-08-26 23:40:50 -0700727 DCCP_SKB_CB(skb)->dccpd_ccval = hcrx->ccid3hcrx_ccval_last_counter;
Arnaldo Carvalho de Melo4fded332005-08-23 21:51:59 -0700728
729 if (dccp_packet_without_ack(skb))
Arnaldo Carvalho de Melo2d0817d2006-03-20 22:32:06 -0800730 return 0;
731
Arnaldo Carvalho de Melo4fded332005-08-23 21:51:59 -0700732 x_recv = htonl(hcrx->ccid3hcrx_x_recv);
733 pinv = htonl(hcrx->ccid3hcrx_pinv);
Arnaldo Carvalho de Melo2d0817d2006-03-20 22:32:06 -0800734
735 if ((hcrx->ccid3hcrx_elapsed_time != 0 &&
736 dccp_insert_option_elapsed_time(sk, skb,
737 hcrx->ccid3hcrx_elapsed_time)) ||
738 dccp_insert_option_timestamp(sk, skb) ||
739 dccp_insert_option(sk, skb, TFRC_OPT_LOSS_EVENT_RATE,
740 &pinv, sizeof(pinv)) ||
741 dccp_insert_option(sk, skb, TFRC_OPT_RECEIVE_RATE,
742 &x_recv, sizeof(x_recv)))
743 return -1;
744
745 return 0;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700746}
747
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700748/* calculate first loss interval
749 *
750 * returns estimated loss interval in usecs */
751
752static u32 ccid3_hc_rx_calc_first_li(struct sock *sk)
753{
Arnaldo Carvalho de Melo59725dc2005-09-09 02:40:58 -0300754 struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -0300755 struct dccp_rx_hist_entry *entry, *next, *tail = NULL;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700756 u32 rtt, delta, x_recv, fval, p, tmp2;
Arnaldo Carvalho de Melob6ee3d42005-08-27 18:18:18 -0300757 struct timeval tstamp = { 0, };
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700758 int interval = 0;
759 int win_count = 0;
760 int step = 0;
761 u64 tmp1;
762
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -0300763 list_for_each_entry_safe(entry, next, &hcrx->ccid3hcrx_hist,
764 dccphrx_node) {
765 if (dccp_rx_hist_entry_data_packet(entry)) {
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700766 tail = entry;
767
768 switch (step) {
769 case 0:
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -0300770 tstamp = entry->dccphrx_tstamp;
Arnaldo Carvalho de Meloc1734372005-08-13 20:34:23 -0300771 win_count = entry->dccphrx_ccval;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700772 step = 1;
773 break;
774 case 1:
Arnaldo Carvalho de Meloc1734372005-08-13 20:34:23 -0300775 interval = win_count - entry->dccphrx_ccval;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700776 if (interval < 0)
777 interval += TFRC_WIN_COUNT_LIMIT;
778 if (interval > 4)
779 goto found;
780 break;
781 }
782 }
783 }
784
Arnaldo Carvalho de Melo59d203f2005-09-09 20:01:25 -0300785 if (unlikely(step == 0)) {
Gerrit Renker59348b12006-11-20 18:39:23 -0200786 DCCP_WARN("%s, sk=%p, packet history has no data packets!\n",
787 dccp_role(sk), sk);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700788 return ~0;
789 }
790
Arnaldo Carvalho de Melo59d203f2005-09-09 20:01:25 -0300791 if (unlikely(interval == 0)) {
Gerrit Renker59348b12006-11-20 18:39:23 -0200792 DCCP_WARN("%s, sk=%p, Could not find a win_count interval > 0."
793 "Defaulting to 1\n", dccp_role(sk), sk);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700794 interval = 1;
795 }
796found:
Ian McDonald66a377c2006-08-26 23:40:50 -0700797 if (!tail) {
Gerrit Renker59348b12006-11-20 18:39:23 -0200798 DCCP_CRIT("tail is null\n");
Ian McDonald66a377c2006-08-26 23:40:50 -0700799 return ~0;
800 }
Arnaldo Carvalho de Melob6ee3d42005-08-27 18:18:18 -0300801 rtt = timeval_delta(&tstamp, &tail->dccphrx_tstamp) * 4 / interval;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700802 ccid3_pr_debug("%s, sk=%p, approximated RTT to %uus\n",
803 dccp_role(sk), sk, rtt);
Gerrit Renker59348b12006-11-20 18:39:23 -0200804
805 if (rtt == 0) {
806 DCCP_WARN("RTT==0, setting to 1\n");
807 rtt = 1;
808 }
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700809
Arnaldo Carvalho de Melob0e56782005-09-09 02:38:35 -0300810 dccp_timestamp(sk, &tstamp);
811 delta = timeval_delta(&tstamp, &hcrx->ccid3hcrx_tstamp_last_feedback);
812 x_recv = usecs_div(hcrx->ccid3hcrx_bytes_recv, delta);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700813
Ian McDonald66a377c2006-08-26 23:40:50 -0700814 if (x_recv == 0)
815 x_recv = hcrx->ccid3hcrx_x_recv;
816
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700817 tmp1 = (u64)x_recv * (u64)rtt;
818 do_div(tmp1,10000000);
819 tmp2 = (u32)tmp1;
Ian McDonald66a377c2006-08-26 23:40:50 -0700820
821 if (!tmp2) {
Gerrit Renker59348b12006-11-20 18:39:23 -0200822 DCCP_CRIT("tmp2 = 0, x_recv = %u, rtt =%u\n", x_recv, rtt);
Ian McDonald66a377c2006-08-26 23:40:50 -0700823 return ~0;
824 }
825
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700826 fval = (hcrx->ccid3hcrx_s * 100000) / tmp2;
827 /* do not alter order above or you will get overflow on 32 bit */
Arnaldo Carvalho de Melo36729c12005-08-28 00:47:15 -0300828 p = tfrc_calc_x_reverse_lookup(fval);
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300829 ccid3_pr_debug("%s, sk=%p, receive rate=%u bytes/s, implied "
830 "loss rate=%u\n", dccp_role(sk), sk, x_recv, p);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700831
832 if (p == 0)
833 return ~0;
834 else
835 return 1000000 / p;
836}
837
838static void ccid3_hc_rx_update_li(struct sock *sk, u64 seq_loss, u8 win_loss)
839{
Arnaldo Carvalho de Melo59725dc2005-09-09 02:40:58 -0300840 struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
Ian McDonaldfc747e82006-08-29 17:50:19 -0700841 struct dccp_li_hist_entry *head;
Ian McDonald66a377c2006-08-26 23:40:50 -0700842 u64 seq_temp;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700843
Ian McDonald66a377c2006-08-26 23:40:50 -0700844 if (list_empty(&hcrx->ccid3hcrx_li_hist)) {
845 if (!dccp_li_hist_interval_new(ccid3_li_hist,
846 &hcrx->ccid3hcrx_li_hist, seq_loss, win_loss))
Arnaldo Carvalho de Meloae6706f2005-08-27 23:03:09 -0300847 return;
Ian McDonald66a377c2006-08-26 23:40:50 -0700848
Ian McDonaldfc747e82006-08-29 17:50:19 -0700849 head = list_entry(hcrx->ccid3hcrx_li_hist.next,
850 struct dccp_li_hist_entry, dccplih_node);
851 head->dccplih_interval = ccid3_hc_rx_calc_first_li(sk);
Ian McDonald66a377c2006-08-26 23:40:50 -0700852 } else {
853 struct dccp_li_hist_entry *entry;
854 struct list_head *tail;
855
Ian McDonaldfc747e82006-08-29 17:50:19 -0700856 head = list_entry(hcrx->ccid3hcrx_li_hist.next,
857 struct dccp_li_hist_entry, dccplih_node);
Ian McDonald66a377c2006-08-26 23:40:50 -0700858 /* FIXME win count check removed as was wrong */
859 /* should make this check with receive history */
860 /* and compare there as per section 10.2 of RFC4342 */
861
862 /* new loss event detected */
863 /* calculate last interval length */
864 seq_temp = dccp_delta_seqno(head->dccplih_seqno, seq_loss);
865 entry = dccp_li_hist_entry_new(ccid3_li_hist, SLAB_ATOMIC);
866
867 if (entry == NULL) {
Gerrit Renker59348b12006-11-20 18:39:23 -0200868 DCCP_BUG("out of memory - can not allocate entry");
Ian McDonald66a377c2006-08-26 23:40:50 -0700869 return;
870 }
871
872 list_add(&entry->dccplih_node, &hcrx->ccid3hcrx_li_hist);
873
874 tail = hcrx->ccid3hcrx_li_hist.prev;
875 list_del(tail);
876 kmem_cache_free(ccid3_li_hist->dccplih_slab, tail);
877
878 /* Create the newest interval */
879 entry->dccplih_seqno = seq_loss;
880 entry->dccplih_interval = seq_temp;
881 entry->dccplih_win_count = win_loss;
882 }
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700883}
884
Ian McDonald66a377c2006-08-26 23:40:50 -0700885static int ccid3_hc_rx_detect_loss(struct sock *sk,
886 struct dccp_rx_hist_entry *packet)
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700887{
Arnaldo Carvalho de Melo59725dc2005-09-09 02:40:58 -0300888 struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
Ian McDonald66a377c2006-08-26 23:40:50 -0700889 struct dccp_rx_hist_entry *rx_hist = dccp_rx_hist_head(&hcrx->ccid3hcrx_hist);
890 u64 seqno = packet->dccphrx_seqno;
891 u64 tmp_seqno;
892 int loss = 0;
893 u8 ccval;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700894
Ian McDonald66a377c2006-08-26 23:40:50 -0700895
896 tmp_seqno = hcrx->ccid3hcrx_seqno_nonloss;
897
898 if (!rx_hist ||
899 follows48(packet->dccphrx_seqno, hcrx->ccid3hcrx_seqno_nonloss)) {
900 hcrx->ccid3hcrx_seqno_nonloss = seqno;
901 hcrx->ccid3hcrx_ccval_nonloss = packet->dccphrx_ccval;
902 goto detect_out;
903 }
904
905
906 while (dccp_delta_seqno(hcrx->ccid3hcrx_seqno_nonloss, seqno)
907 > TFRC_RECV_NUM_LATE_LOSS) {
908 loss = 1;
909 ccid3_hc_rx_update_li(sk, hcrx->ccid3hcrx_seqno_nonloss,
910 hcrx->ccid3hcrx_ccval_nonloss);
911 tmp_seqno = hcrx->ccid3hcrx_seqno_nonloss;
912 dccp_inc_seqno(&tmp_seqno);
913 hcrx->ccid3hcrx_seqno_nonloss = tmp_seqno;
914 dccp_inc_seqno(&tmp_seqno);
915 while (dccp_rx_hist_find_entry(&hcrx->ccid3hcrx_hist,
916 tmp_seqno, &ccval)) {
917 hcrx->ccid3hcrx_seqno_nonloss = tmp_seqno;
918 hcrx->ccid3hcrx_ccval_nonloss = ccval;
919 dccp_inc_seqno(&tmp_seqno);
920 }
921 }
922
923 /* FIXME - this code could be simplified with above while */
924 /* but works at moment */
925 if (follows48(packet->dccphrx_seqno, hcrx->ccid3hcrx_seqno_nonloss)) {
926 hcrx->ccid3hcrx_seqno_nonloss = seqno;
927 hcrx->ccid3hcrx_ccval_nonloss = packet->dccphrx_ccval;
928 }
929
930detect_out:
931 dccp_rx_hist_add_packet(ccid3_rx_hist, &hcrx->ccid3hcrx_hist,
932 &hcrx->ccid3hcrx_li_hist, packet,
933 hcrx->ccid3hcrx_seqno_nonloss);
934 return loss;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700935}
936
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700937static void ccid3_hc_rx_packet_recv(struct sock *sk, struct sk_buff *skb)
938{
Arnaldo Carvalho de Melo59725dc2005-09-09 02:40:58 -0300939 struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
Arnaldo Carvalho de Melo4fded332005-08-23 21:51:59 -0700940 const struct dccp_options_received *opt_recv;
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -0300941 struct dccp_rx_hist_entry *packet;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700942 struct timeval now;
Ian McDonald66a377c2006-08-26 23:40:50 -0700943 u32 p_prev, rtt_prev, r_sample, t_elapsed;
944 int loss;
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -0300945
Gerrit Renker59348b12006-11-20 18:39:23 -0200946 BUG_ON(hcrx == NULL);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700947
Arnaldo Carvalho de Melo59725dc2005-09-09 02:40:58 -0300948 opt_recv = &dccp_sk(sk)->dccps_options_received;
Arnaldo Carvalho de Melo4fded332005-08-23 21:51:59 -0700949
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700950 switch (DCCP_SKB_CB(skb)->dccpd_type) {
951 case DCCP_PKT_ACK:
952 if (hcrx->ccid3hcrx_state == TFRC_RSTATE_NO_DATA)
953 return;
954 case DCCP_PKT_DATAACK:
Arnaldo Carvalho de Melo4fded332005-08-23 21:51:59 -0700955 if (opt_recv->dccpor_timestamp_echo == 0)
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700956 break;
Ian McDonald66a377c2006-08-26 23:40:50 -0700957 rtt_prev = hcrx->ccid3hcrx_rtt;
Arnaldo Carvalho de Melob0e56782005-09-09 02:38:35 -0300958 dccp_timestamp(sk, &now);
Arnaldo Carvalho de Melob3a30772005-09-09 02:34:10 -0300959 timeval_sub_usecs(&now, opt_recv->dccpor_timestamp_echo * 10);
960 r_sample = timeval_usecs(&now);
961 t_elapsed = opt_recv->dccpor_elapsed_time * 10;
962
963 if (unlikely(r_sample <= t_elapsed))
Gerrit Renker59348b12006-11-20 18:39:23 -0200964 DCCP_WARN("r_sample=%uus, t_elapsed=%uus\n",
965 r_sample, t_elapsed);
Arnaldo Carvalho de Melob3a30772005-09-09 02:34:10 -0300966 else
967 r_sample -= t_elapsed;
968
969 if (hcrx->ccid3hcrx_state == TFRC_RSTATE_NO_DATA)
970 hcrx->ccid3hcrx_rtt = r_sample;
971 else
972 hcrx->ccid3hcrx_rtt = (hcrx->ccid3hcrx_rtt * 9) / 10 +
973 r_sample / 10;
974
Ian McDonald66a377c2006-08-26 23:40:50 -0700975 if (rtt_prev != hcrx->ccid3hcrx_rtt)
976 ccid3_pr_debug("%s, New RTT=%uus, elapsed time=%u\n",
Arnaldo Carvalho de Melo4fded332005-08-23 21:51:59 -0700977 dccp_role(sk), hcrx->ccid3hcrx_rtt,
978 opt_recv->dccpor_elapsed_time);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700979 break;
980 case DCCP_PKT_DATA:
981 break;
Arnaldo Carvalho de Melo59d203f2005-09-09 20:01:25 -0300982 default: /* We're not interested in other packet types, move along */
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700983 return;
984 }
985
Arnaldo Carvalho de Melob0e56782005-09-09 02:38:35 -0300986 packet = dccp_rx_hist_entry_new(ccid3_rx_hist, sk, opt_recv->dccpor_ndp,
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -0300987 skb, SLAB_ATOMIC);
Arnaldo Carvalho de Melo59d203f2005-09-09 20:01:25 -0300988 if (unlikely(packet == NULL)) {
Gerrit Renker59348b12006-11-20 18:39:23 -0200989 DCCP_WARN("%s, sk=%p, Not enough mem to add rx packet "
990 "to history, consider it lost!\n", dccp_role(sk), sk);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700991 return;
992 }
993
Ian McDonald66a377c2006-08-26 23:40:50 -0700994 loss = ccid3_hc_rx_detect_loss(sk, packet);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -0700995
996 if (DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_ACK)
997 return;
998
999 switch (hcrx->ccid3hcrx_state) {
1000 case TFRC_RSTATE_NO_DATA:
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -03001001 ccid3_pr_debug("%s, sk=%p(%s), skb=%p, sending initial "
1002 "feedback\n",
1003 dccp_role(sk), sk,
1004 dccp_state_name(sk->sk_state), skb);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001005 ccid3_hc_rx_send_feedback(sk);
1006 ccid3_hc_rx_set_state(sk, TFRC_RSTATE_DATA);
1007 return;
1008 case TFRC_RSTATE_DATA:
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -03001009 hcrx->ccid3hcrx_bytes_recv += skb->len -
1010 dccp_hdr(skb)->dccph_doff * 4;
Ian McDonald66a377c2006-08-26 23:40:50 -07001011 if (loss)
Arnaldo Carvalho de Melob6ee3d42005-08-27 18:18:18 -03001012 break;
1013
Arnaldo Carvalho de Melob0e56782005-09-09 02:38:35 -03001014 dccp_timestamp(sk, &now);
Arnaldo Carvalho de Melob6ee3d42005-08-27 18:18:18 -03001015 if (timeval_delta(&now, &hcrx->ccid3hcrx_tstamp_last_ack) >=
1016 hcrx->ccid3hcrx_rtt) {
1017 hcrx->ccid3hcrx_tstamp_last_ack = now;
1018 ccid3_hc_rx_send_feedback(sk);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001019 }
Arnaldo Carvalho de Melob6ee3d42005-08-27 18:18:18 -03001020 return;
Gerrit Renker59348b12006-11-20 18:39:23 -02001021 case TFRC_RSTATE_TERM:
1022 DCCP_BUG("Illegal %s state TERM, sk=%p", dccp_role(sk), sk);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001023 return;
1024 }
1025
1026 /* Dealing with packet loss */
Arnaldo Carvalho de Melo4fded332005-08-23 21:51:59 -07001027 ccid3_pr_debug("%s, sk=%p(%s), data loss! Reacting...\n",
1028 dccp_role(sk), sk, dccp_state_name(sk->sk_state));
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001029
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001030 p_prev = hcrx->ccid3hcrx_p;
1031
1032 /* Calculate loss event rate */
Ian McDonaldc0996662006-03-03 17:54:46 -08001033 if (!list_empty(&hcrx->ccid3hcrx_li_hist)) {
1034 u32 i_mean = dccp_li_hist_calc_i_mean(&hcrx->ccid3hcrx_li_hist);
1035
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001036 /* Scaling up by 1000000 as fixed decimal */
Ian McDonaldc0996662006-03-03 17:54:46 -08001037 if (i_mean != 0)
1038 hcrx->ccid3hcrx_p = 1000000 / i_mean;
Gerrit Renker59348b12006-11-20 18:39:23 -02001039 } else
1040 DCCP_BUG("empty loss history");
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001041
1042 if (hcrx->ccid3hcrx_p > p_prev) {
1043 ccid3_hc_rx_send_feedback(sk);
1044 return;
1045 }
1046}
1047
Arnaldo Carvalho de Melo91f0ebf2006-03-20 19:21:44 -08001048static int ccid3_hc_rx_init(struct ccid *ccid, struct sock *sk)
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001049{
1050 struct dccp_sock *dp = dccp_sk(sk);
Arnaldo Carvalho de Melo91f0ebf2006-03-20 19:21:44 -08001051 struct ccid3_hc_rx_sock *hcrx = ccid_priv(ccid);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001052
1053 ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
1054
Arnaldo Carvalho de Meloa84ffe42005-08-28 04:51:32 -03001055 if (dp->dccps_packet_size >= TFRC_MIN_PACKET_SIZE &&
1056 dp->dccps_packet_size <= TFRC_MAX_PACKET_SIZE)
1057 hcrx->ccid3hcrx_s = dp->dccps_packet_size;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001058 else
1059 hcrx->ccid3hcrx_s = TFRC_STD_PACKET_SIZE;
1060
1061 hcrx->ccid3hcrx_state = TFRC_RSTATE_NO_DATA;
1062 INIT_LIST_HEAD(&hcrx->ccid3hcrx_hist);
Arnaldo Carvalho de Meloae6706f2005-08-27 23:03:09 -03001063 INIT_LIST_HEAD(&hcrx->ccid3hcrx_li_hist);
Arnaldo Carvalho de Melob0e56782005-09-09 02:38:35 -03001064 dccp_timestamp(sk, &hcrx->ccid3hcrx_tstamp_last_ack);
Arnaldo Carvalho de Melo954ee312005-09-09 02:37:05 -03001065 hcrx->ccid3hcrx_tstamp_last_feedback = hcrx->ccid3hcrx_tstamp_last_ack;
1066 hcrx->ccid3hcrx_rtt = 5000; /* XXX 5ms for now... */
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001067 return 0;
1068}
1069
1070static void ccid3_hc_rx_exit(struct sock *sk)
1071{
Arnaldo Carvalho de Melo59725dc2005-09-09 02:40:58 -03001072 struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001073
Arnaldo Carvalho de Melo59d203f2005-09-09 20:01:25 -03001074 BUG_ON(hcrx == NULL);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001075
1076 ccid3_hc_rx_set_state(sk, TFRC_RSTATE_TERM);
1077
1078 /* Empty packet history */
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -03001079 dccp_rx_hist_purge(ccid3_rx_hist, &hcrx->ccid3hcrx_hist);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001080
1081 /* Empty loss interval history */
Arnaldo Carvalho de Meloae6706f2005-08-27 23:03:09 -03001082 dccp_li_hist_purge(ccid3_li_hist, &hcrx->ccid3hcrx_li_hist);
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001083}
1084
Arnaldo Carvalho de Melo2babe1f2005-08-23 21:52:35 -07001085static void ccid3_hc_rx_get_info(struct sock *sk, struct tcp_info *info)
1086{
Arnaldo Carvalho de Melo59725dc2005-09-09 02:40:58 -03001087 const struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
Arnaldo Carvalho de Melo2babe1f2005-08-23 21:52:35 -07001088
Arnaldo Carvalho de Melo59c23532005-09-12 14:16:58 -07001089 /* Listen socks doesn't have a private CCID block */
1090 if (sk->sk_state == DCCP_LISTEN)
1091 return;
1092
Arnaldo Carvalho de Melo59d203f2005-09-09 20:01:25 -03001093 BUG_ON(hcrx == NULL);
Arnaldo Carvalho de Melo2babe1f2005-08-23 21:52:35 -07001094
1095 info->tcpi_ca_state = hcrx->ccid3hcrx_state;
1096 info->tcpi_options |= TCPI_OPT_TIMESTAMPS;
1097 info->tcpi_rcv_rtt = hcrx->ccid3hcrx_rtt;
1098}
1099
1100static void ccid3_hc_tx_get_info(struct sock *sk, struct tcp_info *info)
1101{
Arnaldo Carvalho de Melo59725dc2005-09-09 02:40:58 -03001102 const struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
Arnaldo Carvalho de Melo2babe1f2005-08-23 21:52:35 -07001103
Arnaldo Carvalho de Melo59c23532005-09-12 14:16:58 -07001104 /* Listen socks doesn't have a private CCID block */
1105 if (sk->sk_state == DCCP_LISTEN)
1106 return;
1107
Arnaldo Carvalho de Melo59d203f2005-09-09 20:01:25 -03001108 BUG_ON(hctx == NULL);
Arnaldo Carvalho de Melo2babe1f2005-08-23 21:52:35 -07001109
1110 info->tcpi_rto = hctx->ccid3hctx_t_rto;
1111 info->tcpi_rtt = hctx->ccid3hctx_rtt;
1112}
1113
Arnaldo Carvalho de Melo88f964d2005-09-18 00:19:32 -07001114static int ccid3_hc_rx_getsockopt(struct sock *sk, const int optname, int len,
1115 u32 __user *optval, int __user *optlen)
1116{
1117 const struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
1118 const void *val;
1119
1120 /* Listen socks doesn't have a private CCID block */
1121 if (sk->sk_state == DCCP_LISTEN)
1122 return -EINVAL;
1123
1124 switch (optname) {
1125 case DCCP_SOCKOPT_CCID_RX_INFO:
1126 if (len < sizeof(hcrx->ccid3hcrx_tfrc))
1127 return -EINVAL;
1128 len = sizeof(hcrx->ccid3hcrx_tfrc);
1129 val = &hcrx->ccid3hcrx_tfrc;
1130 break;
1131 default:
1132 return -ENOPROTOOPT;
1133 }
1134
1135 if (put_user(len, optlen) || copy_to_user(optval, val, len))
1136 return -EFAULT;
1137
1138 return 0;
1139}
1140
1141static int ccid3_hc_tx_getsockopt(struct sock *sk, const int optname, int len,
1142 u32 __user *optval, int __user *optlen)
1143{
1144 const struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
1145 const void *val;
1146
1147 /* Listen socks doesn't have a private CCID block */
1148 if (sk->sk_state == DCCP_LISTEN)
1149 return -EINVAL;
1150
1151 switch (optname) {
1152 case DCCP_SOCKOPT_CCID_TX_INFO:
1153 if (len < sizeof(hctx->ccid3hctx_tfrc))
1154 return -EINVAL;
1155 len = sizeof(hctx->ccid3hctx_tfrc);
1156 val = &hctx->ccid3hctx_tfrc;
1157 break;
1158 default:
1159 return -ENOPROTOOPT;
1160 }
1161
1162 if (put_user(len, optlen) || copy_to_user(optval, val, len))
1163 return -EFAULT;
1164
1165 return 0;
1166}
1167
Arnaldo Carvalho de Melo91f0ebf2006-03-20 19:21:44 -08001168static struct ccid_operations ccid3 = {
Ian McDonald3dd9a7c2006-09-22 14:26:44 +12001169 .ccid_id = DCCPC_CCID3,
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001170 .ccid_name = "ccid3",
1171 .ccid_owner = THIS_MODULE,
Arnaldo Carvalho de Melo91f0ebf2006-03-20 19:21:44 -08001172 .ccid_hc_tx_obj_size = sizeof(struct ccid3_hc_tx_sock),
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001173 .ccid_hc_tx_init = ccid3_hc_tx_init,
1174 .ccid_hc_tx_exit = ccid3_hc_tx_exit,
1175 .ccid_hc_tx_send_packet = ccid3_hc_tx_send_packet,
1176 .ccid_hc_tx_packet_sent = ccid3_hc_tx_packet_sent,
1177 .ccid_hc_tx_packet_recv = ccid3_hc_tx_packet_recv,
1178 .ccid_hc_tx_insert_options = ccid3_hc_tx_insert_options,
1179 .ccid_hc_tx_parse_options = ccid3_hc_tx_parse_options,
Arnaldo Carvalho de Melo91f0ebf2006-03-20 19:21:44 -08001180 .ccid_hc_rx_obj_size = sizeof(struct ccid3_hc_rx_sock),
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001181 .ccid_hc_rx_init = ccid3_hc_rx_init,
1182 .ccid_hc_rx_exit = ccid3_hc_rx_exit,
1183 .ccid_hc_rx_insert_options = ccid3_hc_rx_insert_options,
1184 .ccid_hc_rx_packet_recv = ccid3_hc_rx_packet_recv,
Arnaldo Carvalho de Melo2babe1f2005-08-23 21:52:35 -07001185 .ccid_hc_rx_get_info = ccid3_hc_rx_get_info,
1186 .ccid_hc_tx_get_info = ccid3_hc_tx_get_info,
Arnaldo Carvalho de Melo88f964d2005-09-18 00:19:32 -07001187 .ccid_hc_rx_getsockopt = ccid3_hc_rx_getsockopt,
1188 .ccid_hc_tx_getsockopt = ccid3_hc_tx_getsockopt,
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001189};
1190
Gerrit Renker56724aa2006-11-20 18:28:09 -02001191#ifdef CONFIG_IP_DCCP_CCID3_DEBUG
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001192module_param(ccid3_debug, int, 0444);
1193MODULE_PARM_DESC(ccid3_debug, "Enable debug messages");
Gerrit Renker56724aa2006-11-20 18:28:09 -02001194#endif
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001195
1196static __init int ccid3_module_init(void)
1197{
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -03001198 int rc = -ENOBUFS;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001199
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -03001200 ccid3_rx_hist = dccp_rx_hist_new("ccid3");
1201 if (ccid3_rx_hist == NULL)
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001202 goto out;
1203
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -03001204 ccid3_tx_hist = dccp_tx_hist_new("ccid3");
1205 if (ccid3_tx_hist == NULL)
1206 goto out_free_rx;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001207
Arnaldo Carvalho de Meloae6706f2005-08-27 23:03:09 -03001208 ccid3_li_hist = dccp_li_hist_new("ccid3");
1209 if (ccid3_li_hist == NULL)
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -03001210 goto out_free_tx;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001211
1212 rc = ccid_register(&ccid3);
1213 if (rc != 0)
1214 goto out_free_loss_interval_history;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001215out:
1216 return rc;
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -03001217
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001218out_free_loss_interval_history:
Arnaldo Carvalho de Meloae6706f2005-08-27 23:03:09 -03001219 dccp_li_hist_delete(ccid3_li_hist);
1220 ccid3_li_hist = NULL;
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -03001221out_free_tx:
1222 dccp_tx_hist_delete(ccid3_tx_hist);
1223 ccid3_tx_hist = NULL;
1224out_free_rx:
1225 dccp_rx_hist_delete(ccid3_rx_hist);
1226 ccid3_rx_hist = NULL;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001227 goto out;
1228}
1229module_init(ccid3_module_init);
1230
1231static __exit void ccid3_module_exit(void)
1232{
1233 ccid_unregister(&ccid3);
1234
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -03001235 if (ccid3_tx_hist != NULL) {
1236 dccp_tx_hist_delete(ccid3_tx_hist);
1237 ccid3_tx_hist = NULL;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001238 }
Arnaldo Carvalho de Melo8c60f3f2005-08-10 12:59:38 -03001239 if (ccid3_rx_hist != NULL) {
1240 dccp_rx_hist_delete(ccid3_rx_hist);
1241 ccid3_rx_hist = NULL;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001242 }
Arnaldo Carvalho de Meloae6706f2005-08-27 23:03:09 -03001243 if (ccid3_li_hist != NULL) {
1244 dccp_li_hist_delete(ccid3_li_hist);
1245 ccid3_li_hist = NULL;
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001246 }
1247}
1248module_exit(ccid3_module_exit);
1249
Ian McDonalde6bccd32006-08-26 19:01:30 -07001250MODULE_AUTHOR("Ian McDonald <ian.mcdonald@jandi.co.nz>, "
Arnaldo Carvalho de Melo1f2333a2005-08-27 03:51:58 -03001251 "Arnaldo Carvalho de Melo <acme@ghostprotocols.net>");
Arnaldo Carvalho de Melo7c657872005-08-09 20:14:34 -07001252MODULE_DESCRIPTION("DCCP TFRC CCID3 CCID");
1253MODULE_LICENSE("GPL");
1254MODULE_ALIAS("net-dccp-ccid-3");