[DCCP] ccid3: Fix two bugs in sending rate computation
[deliverable/linux.git] / net / dccp / ccids / ccid3.c
CommitLineData
7c657876
ACM
1/*
2 * net/dccp/ccids/ccid3.c
3 *
4 * Copyright (c) 2005 The University of Waikato, Hamilton, New Zealand.
e6bccd35 5 * Copyright (c) 2005-6 Ian McDonald <ian.mcdonald@jandi.co.nz>
7c657876
ACM
6 *
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/
7c657876
ACM
11 *
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"
4524b259 39#include "lib/packet_history.h"
ae6706f0 40#include "lib/loss_interval.h"
36729c1a 41#include "lib/tfrc.h"
7c657876
ACM
42#include "ccid3.h"
43
6b5e633a 44/*
0ba7a3ba
ACM
45 * Reason for maths here is to avoid 32 bit overflow when a is big.
46 * With this we get close to the limit.
6b5e633a 47 */
c25a18ba 48static u32 usecs_div(const u32 a, const u32 b)
6b5e633a 49{
0ba7a3ba
ACM
50 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;
6b5e633a
ACM
61}
62
7c657876 63
56724aa4
GR
64
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)
7c657876
ACM
68#else
69#define ccid3_pr_debug(format, a...)
70#endif
71
a1d3a355
ACM
72static struct dccp_tx_hist *ccid3_tx_hist;
73static struct dccp_rx_hist *ccid3_rx_hist;
ae6706f0 74static struct dccp_li_hist *ccid3_li_hist;
7c657876 75
56724aa4 76#ifdef CONFIG_IP_DCCP_CCID3_DEBUG
7c657876
ACM
77static 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
c25a18ba
ACM
90static void ccid3_hc_tx_set_state(struct sock *sk,
91 enum ccid3_hc_tx_states state)
7c657876 92{
59725dc2 93 struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
7c657876
ACM
94 enum ccid3_hc_tx_states oldstate = hctx->ccid3hctx_state;
95
96 ccid3_pr_debug("%s(%p) %-8.8s -> %s\n",
1f2333ae
ACM
97 dccp_role(sk), sk, ccid3_tx_state_name(oldstate),
98 ccid3_tx_state_name(state));
7c657876
ACM
99 WARN_ON(state == oldstate);
100 hctx->ccid3hctx_state = state;
101}
102
17893bc1
GR
103/*
104 * Recalculate scheduled nominal send time t_nom, inter-packet interval
105 * t_ipi, and delta value. Should be called after each change to X.
106 */
107static inline void ccid3_update_send_time(struct ccid3_hc_tx_sock *hctx)
7c657876 108{
17893bc1
GR
109 timeval_sub_usecs(&hctx->ccid3hctx_t_nom, hctx->ccid3hctx_t_ipi);
110
111 /* Calculate new t_ipi (inter packet interval) by t_ipi = s / X_inst */
f5c2d636 112 hctx->ccid3hctx_t_ipi = usecs_div(hctx->ccid3hctx_s, hctx->ccid3hctx_x);
7c657876 113
17893bc1
GR
114 /* Update nominal send time with regard to the new t_ipi */
115 timeval_add_usecs(&hctx->ccid3hctx_t_nom, hctx->ccid3hctx_t_ipi);
116
117 /* Calculate new delta by delta = min(t_ipi / 2, t_gran / 2) */
1f2333ae
ACM
118 hctx->ccid3hctx_delta = min_t(u32, hctx->ccid3hctx_t_ipi / 2,
119 TFRC_OPSYS_HALF_TIME_GRAN);
7c657876 120}
7c657876
ACM
121/*
122 * Update X by
123 * If (p > 0)
5c3fbb6a 124 * X_calc = calcX(s, R, p);
7c657876
ACM
125 * X = max(min(X_calc, 2 * X_recv), s / t_mbi);
126 * Else
127 * If (now - tld >= R)
128 * X = max(min(2 * X, 2 * X_recv), s / R);
129 * tld = now;
5c3fbb6a
GR
130 *
131 * If X has changed, we also update the scheduled send time t_now,
132 * the inter-packet interval t_ipi, and the delta value.
7c657876 133 */
a79ef76f
GR
134static void ccid3_hc_tx_update_x(struct sock *sk, struct timeval *now)
135
7c657876 136{
59725dc2 137 struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
17893bc1 138 const __u32 old_x = hctx->ccid3hctx_x;
7c657876 139
44158306 140 if (hctx->ccid3hctx_p > 0) {
a79ef76f
GR
141 hctx->ccid3hctx_x = max_t(u32, min(hctx->ccid3hctx_x_calc,
142 hctx->ccid3hctx_x_recv * 2),
143 hctx->ccid3hctx_s / TFRC_T_MBI);
144
145 } else if (timeval_delta(now, &hctx->ccid3hctx_t_ld) >=
146 hctx->ccid3hctx_rtt) {
147 hctx->ccid3hctx_x = max(min(hctx->ccid3hctx_x_recv,
148 hctx->ccid3hctx_x ) * 2,
149 usecs_div(hctx->ccid3hctx_s,
150 hctx->ccid3hctx_rtt) );
151 hctx->ccid3hctx_t_ld = *now;
ff586298 152 }
b6ee3d4a 153
17893bc1
GR
154 if (hctx->ccid3hctx_x != old_x)
155 ccid3_update_send_time(hctx);
7c657876
ACM
156}
157
78ad713d
GR
158/*
159 * Track the mean packet size `s' (cf. RFC 4342, 5.3 and RFC 3448, 4.1)
160 * @len: DCCP packet payload size in bytes
161 */
162static inline void ccid3_hc_tx_update_s(struct ccid3_hc_tx_sock *hctx, int len)
163{
164 if (unlikely(len == 0))
165 ccid3_pr_debug("Packet payload length is 0 - not updating\n");
166 else
167 hctx->ccid3hctx_s = hctx->ccid3hctx_s == 0 ? len :
168 (9 * hctx->ccid3hctx_s + len) / 10;
169 /*
170 * Note: We could do a potential optimisation here - when `s' changes,
171 * recalculate sending rate and consequently t_ipi, t_delta, and
172 * t_now. This is however non-standard, and the benefits are not
173 * clear, so it is currently left out.
174 */
175}
176
7c657876
ACM
177static void ccid3_hc_tx_no_feedback_timer(unsigned long data)
178{
179 struct sock *sk = (struct sock *)data;
59725dc2 180 struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
2a1fda6f 181 unsigned long t_nfb = USEC_PER_SEC / 5;
7c657876
ACM
182
183 bh_lock_sock(sk);
184 if (sock_owned_by_user(sk)) {
185 /* Try again later. */
186 /* XXX: set some sensible MIB */
48e03eee 187 goto restart_timer;
7c657876
ACM
188 }
189
190 ccid3_pr_debug("%s, sk=%p, state=%s\n", dccp_role(sk), sk,
191 ccid3_tx_state_name(hctx->ccid3hctx_state));
192
7c657876 193 switch (hctx->ccid3hctx_state) {
7c657876 194 case TFRC_SSTATE_NO_FBACK:
a79ef76f 195 /* RFC 3448, 4.4: Halve send rate directly */
179ebc9f 196 hctx->ccid3hctx_x = max_t(u32, hctx->ccid3hctx_x / 2,
a79ef76f 197 hctx->ccid3hctx_s / TFRC_T_MBI);
7c657876 198
1f2333ae
ACM
199 ccid3_pr_debug("%s, sk=%p, state=%s, updated tx rate to %d "
200 "bytes/s\n",
201 dccp_role(sk), sk,
202 ccid3_tx_state_name(hctx->ccid3hctx_state),
7c657876 203 hctx->ccid3hctx_x);
48e03eee
GR
204 /* The value of R is still undefined and so we can not recompute
205 * the timout value. Keep initial value as per [RFC 4342, 5]. */
2a1fda6f 206 t_nfb = TFRC_INITIAL_TIMEOUT;
17893bc1 207 ccid3_update_send_time(hctx);
7c657876
ACM
208 break;
209 case TFRC_SSTATE_FBACK:
1f2333ae
ACM
210 /*
211 * Check if IDLE since last timeout and recv rate is less than
212 * 4 packets per RTT
213 */
1f2333ae 214 if (!hctx->ccid3hctx_idle ||
6b5e633a
ACM
215 (hctx->ccid3hctx_x_recv >=
216 4 * usecs_div(hctx->ccid3hctx_s, hctx->ccid3hctx_rtt))) {
a79ef76f
GR
217 struct timeval now;
218
1f2333ae
ACM
219 ccid3_pr_debug("%s, sk=%p, state=%s, not idle\n",
220 dccp_role(sk), sk,
7c657876 221 ccid3_tx_state_name(hctx->ccid3hctx_state));
7c657876 222
ff586298
GR
223 /*
224 * Modify the cached value of X_recv [RFC 3448, 4.4]
225 *
226 * If (p == 0 || X_calc > 2 * X_recv)
7c657876
ACM
227 * X_recv = max(X_recv / 2, s / (2 * t_mbi));
228 * Else
229 * X_recv = X_calc / 4;
230 */
44158306 231 BUG_ON(hctx->ccid3hctx_p && !hctx->ccid3hctx_x_calc);
7c657876 232
44158306 233 if (hctx->ccid3hctx_p == 0 ||
ff586298 234 hctx->ccid3hctx_x_calc > 2 * hctx->ccid3hctx_x_recv) {
7c657876 235 hctx->ccid3hctx_x_recv = max_t(u32, hctx->ccid3hctx_x_recv / 2,
a79ef76f 236 hctx->ccid3hctx_s / (2 * TFRC_T_MBI));
ff586298
GR
237 if (hctx->ccid3hctx_p == 0)
238 dccp_timestamp(sk, &now);
239 } else
7c657876
ACM
240 hctx->ccid3hctx_x_recv = hctx->ccid3hctx_x_calc / 4;
241
ff586298 242 /* Now recalculate X [RFC 3448, 4.3, step (4)] */
a79ef76f 243 ccid3_hc_tx_update_x(sk, &now);
7c657876 244 }
6b5e633a
ACM
245 /*
246 * Schedule no feedback timer to expire in
8a508ac2
GR
247 * max(t_RTO, 2 * s/X) = max(t_RTO, 2 * t_ipi)
248 * See comments in packet_recv() regarding the value of t_RTO.
6b5e633a 249 */
8a508ac2 250 t_nfb = max(hctx->ccid3hctx_t_rto, 2 * hctx->ccid3hctx_t_ipi);
7c657876 251 break;
59348b19
GR
252 case TFRC_SSTATE_NO_SENT:
253 DCCP_BUG("Illegal %s state NO_SENT, sk=%p", dccp_role(sk), sk);
254 /* fall through */
255 case TFRC_SSTATE_TERM:
7c657876
ACM
256 goto out;
257 }
258
7c657876 259 hctx->ccid3hctx_idle = 1;
48e03eee
GR
260
261restart_timer:
262 sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
2a1fda6f 263 jiffies + usecs_to_jiffies(t_nfb));
7c657876
ACM
264out:
265 bh_unlock_sock(sk);
266 sock_put(sk);
267}
268
7da7f456
GR
269/*
270 * returns
271 * > 0: delay (in msecs) that should pass before actually sending
272 * = 0: can send immediately
273 * < 0: error condition; do not send packet
274 */
6b57c93d 275static int ccid3_hc_tx_send_packet(struct sock *sk, struct sk_buff *skb)
7c657876
ACM
276{
277 struct dccp_sock *dp = dccp_sk(sk);
59725dc2 278 struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
8c60f3fa 279 struct dccp_tx_hist_entry *new_packet;
7c657876 280 struct timeval now;
27258ee5 281 long delay;
7c657876 282
59348b19 283 BUG_ON(hctx == NULL);
1f2333ae 284
7c657876 285 /*
da335baf
GR
286 * This function is called only for Data and DataAck packets. Sending
287 * zero-sized Data(Ack)s is theoretically possible, but for congestion
288 * control this case is pathological - ignore it.
7c657876 289 */
6b57c93d 290 if (unlikely(skb->len == 0))
da335baf 291 return -EBADMSG;
7c657876
ACM
292
293 /* See if last packet allocated was not sent */
8c60f3fa
ACM
294 new_packet = dccp_tx_hist_head(&hctx->ccid3hctx_hist);
295 if (new_packet == NULL || new_packet->dccphtx_sent) {
1f2333ae 296 new_packet = dccp_tx_hist_entry_new(ccid3_tx_hist,
54e6ecb2 297 GFP_ATOMIC);
7c657876 298
59d203f9 299 if (unlikely(new_packet == NULL)) {
59348b19
GR
300 DCCP_WARN("%s, sk=%p, not enough mem to add to history,"
301 "send refused\n", dccp_role(sk), sk);
7da7f456 302 return -ENOBUFS;
7c657876
ACM
303 }
304
8c60f3fa 305 dccp_tx_hist_add_entry(&hctx->ccid3hctx_hist, new_packet);
7c657876
ACM
306 }
307
b0e56780 308 dccp_timestamp(sk, &now);
7c657876
ACM
309
310 switch (hctx->ccid3hctx_state) {
311 case TFRC_SSTATE_NO_SENT:
1f2333ae
ACM
312 sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
313 jiffies + usecs_to_jiffies(TFRC_INITIAL_TIMEOUT));
7c657876
ACM
314 hctx->ccid3hctx_last_win_count = 0;
315 hctx->ccid3hctx_t_last_win_count = now;
316 ccid3_hc_tx_set_state(sk, TFRC_SSTATE_NO_FBACK);
7c657876 317
78ad713d 318 /* Set initial sending rate to 1 packet per second */
6b57c93d 319 ccid3_hc_tx_update_s(hctx, skb->len);
78ad713d
GR
320 hctx->ccid3hctx_x = hctx->ccid3hctx_s;
321
90feeb95
GR
322 /* First timeout, according to [RFC 3448, 4.2], is 1 second */
323 hctx->ccid3hctx_t_ipi = USEC_PER_SEC;
324 /* Initial delta: minimum of 0.5 sec and t_gran/2 */
325 hctx->ccid3hctx_delta = TFRC_OPSYS_HALF_TIME_GRAN;
326
327 /* Set t_0 for initial packet */
7c657876 328 hctx->ccid3hctx_t_nom = now;
7c657876
ACM
329 break;
330 case TFRC_SSTATE_NO_FBACK:
331 case TFRC_SSTATE_FBACK:
91cf5a17
GR
332 delay = timeval_delta(&hctx->ccid3hctx_t_nom, &now);
333 /*
334 * Scheduling of packet transmissions [RFC 3448, 4.6]
335 *
336 * if (t_now > t_nom - delta)
337 * // send the packet now
338 * else
339 * // send the packet in (t_nom - t_now) milliseconds.
340 */
76d12777 341 if (delay - (long)hctx->ccid3hctx_delta >= 0)
7da7f456 342 return delay / 1000L;
7c657876 343 break;
59348b19
GR
344 case TFRC_SSTATE_TERM:
345 DCCP_BUG("Illegal %s state TERM, sk=%p", dccp_role(sk), sk);
7da7f456 346 return -EINVAL;
7c657876
ACM
347 }
348
7da7f456
GR
349 /* prepare to send now (add options etc.) */
350 dp->dccps_hc_tx_insert_options = 1;
351 new_packet->dccphtx_ccval = DCCP_SKB_CB(skb)->dccpd_ccval =
352 hctx->ccid3hctx_last_win_count;
353 timeval_add_usecs(&hctx->ccid3hctx_t_nom, hctx->ccid3hctx_t_ipi);
354
355 return 0;
7c657876
ACM
356}
357
6b57c93d 358static void ccid3_hc_tx_packet_sent(struct sock *sk, int more, unsigned int len)
7c657876 359{
59725dc2
ACM
360 const struct dccp_sock *dp = dccp_sk(sk);
361 struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
7c657876 362 struct timeval now;
6b57c93d
GR
363 unsigned long quarter_rtt;
364 struct dccp_tx_hist_entry *packet;
7c657876 365
59348b19 366 BUG_ON(hctx == NULL);
7c657876 367
b0e56780 368 dccp_timestamp(sk, &now);
7c657876 369
6b57c93d 370 ccid3_hc_tx_update_s(hctx, len);
7c657876 371
6b57c93d
GR
372 packet = dccp_tx_hist_head(&hctx->ccid3hctx_hist);
373 if (unlikely(packet == NULL)) {
374 DCCP_WARN("packet doesn't exist in history!\n");
375 return;
376 }
377 if (unlikely(packet->dccphtx_sent)) {
378 DCCP_WARN("no unsent packet in history!\n");
379 return;
380 }
381 packet->dccphtx_tstamp = now;
382 packet->dccphtx_seqno = dp->dccps_gss;
383 /*
384 * Check if win_count have changed
385 * Algorithm in "8.1. Window Counter Value" in RFC 4342.
386 */
387 quarter_rtt = timeval_delta(&now, &hctx->ccid3hctx_t_last_win_count);
388 if (likely(hctx->ccid3hctx_rtt > 8))
389 quarter_rtt /= hctx->ccid3hctx_rtt / 4;
78ad713d 390
6b57c93d
GR
391 if (quarter_rtt > 0) {
392 hctx->ccid3hctx_t_last_win_count = now;
393 hctx->ccid3hctx_last_win_count = (hctx->ccid3hctx_last_win_count +
394 min_t(unsigned long, quarter_rtt, 5)) % 16;
395 ccid3_pr_debug("%s, sk=%p, window changed from "
396 "%u to %u!\n",
397 dccp_role(sk), sk,
398 packet->dccphtx_ccval,
399 hctx->ccid3hctx_last_win_count);
400 }
1f2333ae 401
6b57c93d
GR
402 hctx->ccid3hctx_idle = 0;
403 packet->dccphtx_rtt = hctx->ccid3hctx_rtt;
404 packet->dccphtx_sent = 1;
7c657876
ACM
405}
406
407static void ccid3_hc_tx_packet_recv(struct sock *sk, struct sk_buff *skb)
408{
59725dc2
ACM
409 const struct dccp_sock *dp = dccp_sk(sk);
410 struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
7c657876 411 struct ccid3_options_received *opt_recv;
8c60f3fa 412 struct dccp_tx_hist_entry *packet;
b0e56780 413 struct timeval now;
2a1fda6f 414 unsigned long t_nfb;
7c657876 415 u32 pinv;
5c3fbb6a 416 long r_sample, t_elapsed;
1f2333ae 417
59348b19 418 BUG_ON(hctx == NULL);
7c657876
ACM
419
420 /* we are only interested in ACKs */
421 if (!(DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_ACK ||
422 DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_DATAACK))
423 return;
424
425 opt_recv = &hctx->ccid3hctx_options_received;
426
7c657876 427 switch (hctx->ccid3hctx_state) {
7c657876
ACM
428 case TFRC_SSTATE_NO_FBACK:
429 case TFRC_SSTATE_FBACK:
5c3fbb6a 430 /* get packet from history to look up t_recvdata */
8c60f3fa
ACM
431 packet = dccp_tx_hist_find_entry(&hctx->ccid3hctx_hist,
432 DCCP_SKB_CB(skb)->dccpd_ack_seq);
59d203f9 433 if (unlikely(packet == NULL)) {
5c3fbb6a 434 DCCP_WARN("%s(%p), seqno %llu(%s) doesn't exist "
59348b19 435 "in history!\n", dccp_role(sk), sk,
59d203f9 436 (unsigned long long)DCCP_SKB_CB(skb)->dccpd_ack_seq,
59348b19 437 dccp_packet_name(DCCP_SKB_CB(skb)->dccpd_type));
7c657876
ACM
438 return;
439 }
440
5c3fbb6a
GR
441 /* Update receive rate */
442 hctx->ccid3hctx_x_recv = opt_recv->ccid3or_receive_rate;
443
444 /* Update loss event rate */
445 pinv = opt_recv->ccid3or_loss_event_rate;
45393a66 446 if (pinv == ~0U || pinv == 0) /* see RFC 4342, 8.5 */
5c3fbb6a 447 hctx->ccid3hctx_p = 0;
45393a66 448 else /* can not exceed 100% */
44158306 449 hctx->ccid3hctx_p = 1000000 / pinv;
5c3fbb6a 450
b0e56780 451 dccp_timestamp(sk, &now);
5c3fbb6a
GR
452
453 /*
454 * Calculate new round trip sample as per [RFC 3448, 4.3] by
455 * R_sample = (now - t_recvdata) - t_elapsed
456 */
457 r_sample = timeval_delta(&now, &packet->dccphtx_tstamp);
458 t_elapsed = dp->dccps_options_received.dccpor_elapsed_time * 10;
459
460 if (unlikely(r_sample <= 0)) {
461 DCCP_WARN("WARNING: R_sample (%ld) <= 0!\n", r_sample);
462 r_sample = 0;
463 } else if (unlikely(r_sample <= t_elapsed))
464 DCCP_WARN("WARNING: r_sample=%ldus <= t_elapsed=%ldus\n",
59348b19 465 r_sample, t_elapsed);
1a28599a
ACM
466 else
467 r_sample -= t_elapsed;
7c657876
ACM
468
469 /* Update RTT estimate by
470 * If (No feedback recv)
471 * R = R_sample;
472 * Else
473 * R = q * R + (1 - q) * R_sample;
474 *
475 * q is a constant, RFC 3448 recomments 0.9
476 */
477 if (hctx->ccid3hctx_state == TFRC_SSTATE_NO_FBACK) {
a79ef76f
GR
478 /* Use Larger Initial Windows [RFC 4342, sec. 5]
479 * We deviate in that we use `s' instead of `MSS'. */
179ebc9f 480 u16 w_init = min( 4 * hctx->ccid3hctx_s,
a79ef76f
GR
481 max(2 * hctx->ccid3hctx_s, 4380));
482 hctx->ccid3hctx_rtt = r_sample;
483 hctx->ccid3hctx_x = usecs_div(w_init, r_sample);
484 hctx->ccid3hctx_t_ld = now;
485
486 ccid3_update_send_time(hctx);
7c657876 487
5c3fbb6a
GR
488 ccid3_pr_debug("%s(%p), s=%u, w_init=%u, "
489 "R_sample=%ldus, X=%u\n", dccp_role(sk),
490 sk, hctx->ccid3hctx_s, w_init, r_sample,
491 hctx->ccid3hctx_x);
7c657876 492
5c3fbb6a
GR
493 ccid3_hc_tx_set_state(sk, TFRC_SSTATE_FBACK);
494 } else {
495 hctx->ccid3hctx_rtt = (9 * hctx->ccid3hctx_rtt +
496 (u32)r_sample ) / 10;
7c657876 497
ff586298
GR
498 /* Update sending rate (step 4 of [RFC 3448, 4.3]) */
499 if (hctx->ccid3hctx_p > 0)
500 hctx->ccid3hctx_x_calc =
501 tfrc_calc_x(hctx->ccid3hctx_s,
502 hctx->ccid3hctx_rtt,
503 hctx->ccid3hctx_p);
5c3fbb6a 504 ccid3_hc_tx_update_x(sk, &now);
7c657876 505
5c3fbb6a
GR
506 ccid3_pr_debug("%s(%p), RTT=%uus (sample=%ldus), s=%u, "
507 "p=%u, X_calc=%u, X=%u\n", dccp_role(sk),
508 sk, hctx->ccid3hctx_rtt, r_sample,
509 hctx->ccid3hctx_s, hctx->ccid3hctx_p,
510 hctx->ccid3hctx_x_calc,
511 hctx->ccid3hctx_x);
7c657876
ACM
512 }
513
514 /* unschedule no feedback timer */
515 sk_stop_timer(sk, &hctx->ccid3hctx_no_feedback_timer);
516
7c657876 517 /* remove all packets older than the one acked from history */
8c60f3fa
ACM
518 dccp_tx_hist_purge_older(ccid3_tx_hist,
519 &hctx->ccid3hctx_hist, packet);
c530cfb1
ACM
520 /*
521 * As we have calculated new ipi, delta, t_nom it is possible that
5d0dbc4a 522 * we now can send a packet, so wake up dccp_wait_for_ccid
c530cfb1
ACM
523 */
524 sk->sk_write_space(sk);
8c60f3fa 525
8a508ac2
GR
526 /*
527 * Update timeout interval for the nofeedback timer.
528 * We use a configuration option to increase the lower bound.
529 * This can help avoid triggering the nofeedback timer too often
530 * ('spinning') on LANs with small RTTs.
531 */
5d0dbc4a 532 hctx->ccid3hctx_t_rto = max_t(u32, 4 * hctx->ccid3hctx_rtt,
8a508ac2
GR
533 CONFIG_IP_DCCP_CCID3_RTO *
534 (USEC_PER_SEC/1000) );
1f2333ae
ACM
535 /*
536 * Schedule no feedback timer to expire in
8a508ac2 537 * max(t_RTO, 2 * s/X) = max(t_RTO, 2 * t_ipi)
1f2333ae 538 */
8a508ac2 539 t_nfb = max(hctx->ccid3hctx_t_rto, 2 * hctx->ccid3hctx_t_ipi);
6b5e633a 540
1f2333ae
ACM
541 ccid3_pr_debug("%s, sk=%p, Scheduled no feedback timer to "
542 "expire in %lu jiffies (%luus)\n",
543 dccp_role(sk), sk,
2a1fda6f 544 usecs_to_jiffies(t_nfb), t_nfb);
7c657876
ACM
545
546 sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
2a1fda6f 547 jiffies + usecs_to_jiffies(t_nfb));
7c657876
ACM
548
549 /* set idle flag */
550 hctx->ccid3hctx_idle = 1;
551 break;
5e19e3fc 552 case TFRC_SSTATE_NO_SENT:
26af3072
GR
553 if (dccp_sk(sk)->dccps_role == DCCP_ROLE_CLIENT)
554 DCCP_WARN("Illegal ACK received - no packet sent\n");
5e19e3fc
GR
555 /* fall through */
556 case TFRC_SSTATE_TERM: /* ignore feedback when closing */
7c657876
ACM
557 break;
558 }
559}
560
2d0817d1 561static int ccid3_hc_tx_insert_options(struct sock *sk, struct sk_buff *skb)
7c657876 562{
59d203f9 563 const struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
7c657876 564
59d203f9
ACM
565 BUG_ON(hctx == NULL);
566
2d0817d1
ACM
567 if (sk->sk_state == DCCP_OPEN || sk->sk_state == DCCP_PARTOPEN)
568 DCCP_SKB_CB(skb)->dccpd_ccval = hctx->ccid3hctx_last_win_count;
569 return 0;
7c657876
ACM
570}
571
572static int ccid3_hc_tx_parse_options(struct sock *sk, unsigned char option,
1f2333ae
ACM
573 unsigned char len, u16 idx,
574 unsigned char *value)
7c657876
ACM
575{
576 int rc = 0;
59725dc2
ACM
577 const struct dccp_sock *dp = dccp_sk(sk);
578 struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
7c657876
ACM
579 struct ccid3_options_received *opt_recv;
580
59d203f9 581 BUG_ON(hctx == NULL);
7c657876
ACM
582
583 opt_recv = &hctx->ccid3hctx_options_received;
584
585 if (opt_recv->ccid3or_seqno != dp->dccps_gsr) {
586 opt_recv->ccid3or_seqno = dp->dccps_gsr;
587 opt_recv->ccid3or_loss_event_rate = ~0;
588 opt_recv->ccid3or_loss_intervals_idx = 0;
589 opt_recv->ccid3or_loss_intervals_len = 0;
590 opt_recv->ccid3or_receive_rate = 0;
591 }
592
593 switch (option) {
594 case TFRC_OPT_LOSS_EVENT_RATE:
59d203f9 595 if (unlikely(len != 4)) {
59348b19
GR
596 DCCP_WARN("%s, sk=%p, invalid len %d "
597 "for TFRC_OPT_LOSS_EVENT_RATE\n",
598 dccp_role(sk), sk, len);
7c657876
ACM
599 rc = -EINVAL;
600 } else {
60fe62e7 601 opt_recv->ccid3or_loss_event_rate = ntohl(*(__be32 *)value);
7c657876
ACM
602 ccid3_pr_debug("%s, sk=%p, LOSS_EVENT_RATE=%u\n",
603 dccp_role(sk), sk,
604 opt_recv->ccid3or_loss_event_rate);
605 }
606 break;
607 case TFRC_OPT_LOSS_INTERVALS:
608 opt_recv->ccid3or_loss_intervals_idx = idx;
609 opt_recv->ccid3or_loss_intervals_len = len;
610 ccid3_pr_debug("%s, sk=%p, LOSS_INTERVALS=(%u, %u)\n",
611 dccp_role(sk), sk,
612 opt_recv->ccid3or_loss_intervals_idx,
613 opt_recv->ccid3or_loss_intervals_len);
614 break;
615 case TFRC_OPT_RECEIVE_RATE:
59d203f9 616 if (unlikely(len != 4)) {
59348b19
GR
617 DCCP_WARN("%s, sk=%p, invalid len %d "
618 "for TFRC_OPT_RECEIVE_RATE\n",
619 dccp_role(sk), sk, len);
7c657876
ACM
620 rc = -EINVAL;
621 } else {
60fe62e7 622 opt_recv->ccid3or_receive_rate = ntohl(*(__be32 *)value);
7c657876
ACM
623 ccid3_pr_debug("%s, sk=%p, RECEIVE_RATE=%u\n",
624 dccp_role(sk), sk,
625 opt_recv->ccid3or_receive_rate);
626 }
627 break;
628 }
629
630 return rc;
631}
632
91f0ebf7 633static int ccid3_hc_tx_init(struct ccid *ccid, struct sock *sk)
7c657876 634{
91f0ebf7 635 struct ccid3_hc_tx_sock *hctx = ccid_priv(ccid);
7c657876 636
78ad713d 637 hctx->ccid3hctx_s = 0;
7c657876
ACM
638 hctx->ccid3hctx_state = TFRC_SSTATE_NO_SENT;
639 INIT_LIST_HEAD(&hctx->ccid3hctx_hist);
aa5d7df3
ACM
640
641 hctx->ccid3hctx_no_feedback_timer.function = ccid3_hc_tx_no_feedback_timer;
642 hctx->ccid3hctx_no_feedback_timer.data = (unsigned long)sk;
7c657876
ACM
643 init_timer(&hctx->ccid3hctx_no_feedback_timer);
644
645 return 0;
646}
647
648static void ccid3_hc_tx_exit(struct sock *sk)
649{
59725dc2 650 struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
7c657876 651
7c657876
ACM
652 BUG_ON(hctx == NULL);
653
654 ccid3_hc_tx_set_state(sk, TFRC_SSTATE_TERM);
655 sk_stop_timer(sk, &hctx->ccid3hctx_no_feedback_timer);
656
657 /* Empty packet history */
8c60f3fa 658 dccp_tx_hist_purge(ccid3_tx_hist, &hctx->ccid3hctx_hist);
7c657876
ACM
659}
660
661/*
662 * RX Half Connection methods
663 */
664
56724aa4 665#ifdef CONFIG_IP_DCCP_CCID3_DEBUG
7c657876
ACM
666static const char *ccid3_rx_state_name(enum ccid3_hc_rx_states state)
667{
668 static char *ccid3_rx_state_names[] = {
669 [TFRC_RSTATE_NO_DATA] = "NO_DATA",
670 [TFRC_RSTATE_DATA] = "DATA",
671 [TFRC_RSTATE_TERM] = "TERM",
672 };
673
674 return ccid3_rx_state_names[state];
675}
676#endif
677
c25a18ba
ACM
678static void ccid3_hc_rx_set_state(struct sock *sk,
679 enum ccid3_hc_rx_states state)
7c657876 680{
59725dc2 681 struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
7c657876
ACM
682 enum ccid3_hc_rx_states oldstate = hcrx->ccid3hcrx_state;
683
684 ccid3_pr_debug("%s(%p) %-8.8s -> %s\n",
1f2333ae
ACM
685 dccp_role(sk), sk, ccid3_rx_state_name(oldstate),
686 ccid3_rx_state_name(state));
7c657876
ACM
687 WARN_ON(state == oldstate);
688 hcrx->ccid3hcrx_state = state;
689}
690
78ad713d
GR
691static inline void ccid3_hc_rx_update_s(struct ccid3_hc_rx_sock *hcrx, int len)
692{
693 if (unlikely(len == 0)) /* don't update on empty packets (e.g. ACKs) */
694 ccid3_pr_debug("Packet payload length is 0 - not updating\n");
695 else
696 hcrx->ccid3hcrx_s = hcrx->ccid3hcrx_s == 0 ? len :
697 (9 * hcrx->ccid3hcrx_s + len) / 10;
698}
699
7c657876
ACM
700static void ccid3_hc_rx_send_feedback(struct sock *sk)
701{
59725dc2 702 struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
7c657876 703 struct dccp_sock *dp = dccp_sk(sk);
8c60f3fa 704 struct dccp_rx_hist_entry *packet;
b6ee3d4a 705 struct timeval now;
7c657876
ACM
706
707 ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
708
b0e56780 709 dccp_timestamp(sk, &now);
b6ee3d4a 710
7c657876
ACM
711 switch (hcrx->ccid3hcrx_state) {
712 case TFRC_RSTATE_NO_DATA:
713 hcrx->ccid3hcrx_x_recv = 0;
714 break;
715 case TFRC_RSTATE_DATA: {
b6ee3d4a
ACM
716 const u32 delta = timeval_delta(&now,
717 &hcrx->ccid3hcrx_tstamp_last_feedback);
27ae543e
ACM
718 hcrx->ccid3hcrx_x_recv = usecs_div(hcrx->ccid3hcrx_bytes_recv,
719 delta);
7c657876
ACM
720 }
721 break;
59348b19
GR
722 case TFRC_RSTATE_TERM:
723 DCCP_BUG("Illegal %s state TERM, sk=%p", dccp_role(sk), sk);
7c657876
ACM
724 return;
725 }
726
8c60f3fa 727 packet = dccp_rx_hist_find_data_packet(&hcrx->ccid3hcrx_hist);
59d203f9 728 if (unlikely(packet == NULL)) {
59348b19
GR
729 DCCP_WARN("%s, sk=%p, no data packet in history!\n",
730 dccp_role(sk), sk);
7c657876
ACM
731 return;
732 }
733
b6ee3d4a 734 hcrx->ccid3hcrx_tstamp_last_feedback = now;
66a377c5 735 hcrx->ccid3hcrx_ccval_last_counter = packet->dccphrx_ccval;
7c657876
ACM
736 hcrx->ccid3hcrx_bytes_recv = 0;
737
738 /* Convert to multiples of 10us */
b6ee3d4a
ACM
739 hcrx->ccid3hcrx_elapsed_time =
740 timeval_delta(&now, &packet->dccphrx_tstamp) / 10;
45393a66 741
7c657876 742 if (hcrx->ccid3hcrx_p == 0)
45393a66
GR
743 hcrx->ccid3hcrx_pinv = ~0U; /* see RFC 4342, 8.5 */
744 else if (hcrx->ccid3hcrx_p > 1000000) {
745 DCCP_WARN("p (%u) > 100%%\n", hcrx->ccid3hcrx_p);
746 hcrx->ccid3hcrx_pinv = 1; /* use 100% in this case */
747 } else
7c657876 748 hcrx->ccid3hcrx_pinv = 1000000 / hcrx->ccid3hcrx_p;
45393a66 749
507d37cf 750 dp->dccps_hc_rx_insert_options = 1;
7c657876
ACM
751 dccp_send_ack(sk);
752}
753
2d0817d1 754static int ccid3_hc_rx_insert_options(struct sock *sk, struct sk_buff *skb)
7c657876 755{
59d203f9 756 const struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
60fe62e7 757 __be32 x_recv, pinv;
7c657876 758
59d203f9
ACM
759 BUG_ON(hcrx == NULL);
760
761 if (!(sk->sk_state == DCCP_OPEN || sk->sk_state == DCCP_PARTOPEN))
2d0817d1 762 return 0;
7c657876 763
66a377c5 764 DCCP_SKB_CB(skb)->dccpd_ccval = hcrx->ccid3hcrx_ccval_last_counter;
4fded33b
ACM
765
766 if (dccp_packet_without_ack(skb))
2d0817d1
ACM
767 return 0;
768
4fded33b
ACM
769 x_recv = htonl(hcrx->ccid3hcrx_x_recv);
770 pinv = htonl(hcrx->ccid3hcrx_pinv);
2d0817d1
ACM
771
772 if ((hcrx->ccid3hcrx_elapsed_time != 0 &&
773 dccp_insert_option_elapsed_time(sk, skb,
774 hcrx->ccid3hcrx_elapsed_time)) ||
775 dccp_insert_option_timestamp(sk, skb) ||
776 dccp_insert_option(sk, skb, TFRC_OPT_LOSS_EVENT_RATE,
777 &pinv, sizeof(pinv)) ||
778 dccp_insert_option(sk, skb, TFRC_OPT_RECEIVE_RATE,
779 &x_recv, sizeof(x_recv)))
780 return -1;
781
782 return 0;
7c657876
ACM
783}
784
7c657876
ACM
785/* calculate first loss interval
786 *
787 * returns estimated loss interval in usecs */
788
789static u32 ccid3_hc_rx_calc_first_li(struct sock *sk)
790{
59725dc2 791 struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
8c60f3fa 792 struct dccp_rx_hist_entry *entry, *next, *tail = NULL;
7c657876 793 u32 rtt, delta, x_recv, fval, p, tmp2;
b6ee3d4a 794 struct timeval tstamp = { 0, };
7c657876
ACM
795 int interval = 0;
796 int win_count = 0;
797 int step = 0;
798 u64 tmp1;
799
8c60f3fa
ACM
800 list_for_each_entry_safe(entry, next, &hcrx->ccid3hcrx_hist,
801 dccphrx_node) {
802 if (dccp_rx_hist_entry_data_packet(entry)) {
7c657876
ACM
803 tail = entry;
804
805 switch (step) {
806 case 0:
8c60f3fa 807 tstamp = entry->dccphrx_tstamp;
c1734376 808 win_count = entry->dccphrx_ccval;
7c657876
ACM
809 step = 1;
810 break;
811 case 1:
c1734376 812 interval = win_count - entry->dccphrx_ccval;
7c657876
ACM
813 if (interval < 0)
814 interval += TFRC_WIN_COUNT_LIMIT;
815 if (interval > 4)
816 goto found;
817 break;
818 }
819 }
820 }
821
59d203f9 822 if (unlikely(step == 0)) {
59348b19
GR
823 DCCP_WARN("%s, sk=%p, packet history has no data packets!\n",
824 dccp_role(sk), sk);
7c657876
ACM
825 return ~0;
826 }
827
59d203f9 828 if (unlikely(interval == 0)) {
59348b19
GR
829 DCCP_WARN("%s, sk=%p, Could not find a win_count interval > 0."
830 "Defaulting to 1\n", dccp_role(sk), sk);
7c657876
ACM
831 interval = 1;
832 }
833found:
66a377c5 834 if (!tail) {
59348b19 835 DCCP_CRIT("tail is null\n");
66a377c5
IM
836 return ~0;
837 }
b6ee3d4a 838 rtt = timeval_delta(&tstamp, &tail->dccphrx_tstamp) * 4 / interval;
7c657876
ACM
839 ccid3_pr_debug("%s, sk=%p, approximated RTT to %uus\n",
840 dccp_role(sk), sk, rtt);
59348b19
GR
841
842 if (rtt == 0) {
843 DCCP_WARN("RTT==0, setting to 1\n");
844 rtt = 1;
845 }
7c657876 846
b0e56780
ACM
847 dccp_timestamp(sk, &tstamp);
848 delta = timeval_delta(&tstamp, &hcrx->ccid3hcrx_tstamp_last_feedback);
849 x_recv = usecs_div(hcrx->ccid3hcrx_bytes_recv, delta);
7c657876 850
66a377c5
IM
851 if (x_recv == 0)
852 x_recv = hcrx->ccid3hcrx_x_recv;
853
7c657876
ACM
854 tmp1 = (u64)x_recv * (u64)rtt;
855 do_div(tmp1,10000000);
856 tmp2 = (u32)tmp1;
66a377c5
IM
857
858 if (!tmp2) {
59348b19 859 DCCP_CRIT("tmp2 = 0, x_recv = %u, rtt =%u\n", x_recv, rtt);
66a377c5
IM
860 return ~0;
861 }
862
7c657876
ACM
863 fval = (hcrx->ccid3hcrx_s * 100000) / tmp2;
864 /* do not alter order above or you will get overflow on 32 bit */
36729c1a 865 p = tfrc_calc_x_reverse_lookup(fval);
1f2333ae
ACM
866 ccid3_pr_debug("%s, sk=%p, receive rate=%u bytes/s, implied "
867 "loss rate=%u\n", dccp_role(sk), sk, x_recv, p);
7c657876
ACM
868
869 if (p == 0)
870 return ~0;
871 else
872 return 1000000 / p;
873}
874
875static void ccid3_hc_rx_update_li(struct sock *sk, u64 seq_loss, u8 win_loss)
876{
59725dc2 877 struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
fc747e82 878 struct dccp_li_hist_entry *head;
66a377c5 879 u64 seq_temp;
7c657876 880
66a377c5
IM
881 if (list_empty(&hcrx->ccid3hcrx_li_hist)) {
882 if (!dccp_li_hist_interval_new(ccid3_li_hist,
883 &hcrx->ccid3hcrx_li_hist, seq_loss, win_loss))
884 return;
7c657876 885
fc747e82
IM
886 head = list_entry(hcrx->ccid3hcrx_li_hist.next,
887 struct dccp_li_hist_entry, dccplih_node);
888 head->dccplih_interval = ccid3_hc_rx_calc_first_li(sk);
66a377c5
IM
889 } else {
890 struct dccp_li_hist_entry *entry;
891 struct list_head *tail;
892
fc747e82
IM
893 head = list_entry(hcrx->ccid3hcrx_li_hist.next,
894 struct dccp_li_hist_entry, dccplih_node);
66a377c5
IM
895 /* FIXME win count check removed as was wrong */
896 /* should make this check with receive history */
897 /* and compare there as per section 10.2 of RFC4342 */
898
899 /* new loss event detected */
900 /* calculate last interval length */
901 seq_temp = dccp_delta_seqno(head->dccplih_seqno, seq_loss);
54e6ecb2 902 entry = dccp_li_hist_entry_new(ccid3_li_hist, GFP_ATOMIC);
66a377c5
IM
903
904 if (entry == NULL) {
59348b19 905 DCCP_BUG("out of memory - can not allocate entry");
ae6706f0 906 return;
66a377c5
IM
907 }
908
909 list_add(&entry->dccplih_node, &hcrx->ccid3hcrx_li_hist);
910
911 tail = hcrx->ccid3hcrx_li_hist.prev;
912 list_del(tail);
913 kmem_cache_free(ccid3_li_hist->dccplih_slab, tail);
914
915 /* Create the newest interval */
916 entry->dccplih_seqno = seq_loss;
917 entry->dccplih_interval = seq_temp;
918 entry->dccplih_win_count = win_loss;
919 }
7c657876
ACM
920}
921
66a377c5
IM
922static int ccid3_hc_rx_detect_loss(struct sock *sk,
923 struct dccp_rx_hist_entry *packet)
7c657876 924{
59725dc2 925 struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
66a377c5
IM
926 struct dccp_rx_hist_entry *rx_hist = dccp_rx_hist_head(&hcrx->ccid3hcrx_hist);
927 u64 seqno = packet->dccphrx_seqno;
928 u64 tmp_seqno;
929 int loss = 0;
930 u8 ccval;
931
932
933 tmp_seqno = hcrx->ccid3hcrx_seqno_nonloss;
934
935 if (!rx_hist ||
936 follows48(packet->dccphrx_seqno, hcrx->ccid3hcrx_seqno_nonloss)) {
937 hcrx->ccid3hcrx_seqno_nonloss = seqno;
938 hcrx->ccid3hcrx_ccval_nonloss = packet->dccphrx_ccval;
939 goto detect_out;
940 }
941
7c657876 942
66a377c5
IM
943 while (dccp_delta_seqno(hcrx->ccid3hcrx_seqno_nonloss, seqno)
944 > TFRC_RECV_NUM_LATE_LOSS) {
945 loss = 1;
946 ccid3_hc_rx_update_li(sk, hcrx->ccid3hcrx_seqno_nonloss,
947 hcrx->ccid3hcrx_ccval_nonloss);
948 tmp_seqno = hcrx->ccid3hcrx_seqno_nonloss;
949 dccp_inc_seqno(&tmp_seqno);
950 hcrx->ccid3hcrx_seqno_nonloss = tmp_seqno;
951 dccp_inc_seqno(&tmp_seqno);
952 while (dccp_rx_hist_find_entry(&hcrx->ccid3hcrx_hist,
953 tmp_seqno, &ccval)) {
954 hcrx->ccid3hcrx_seqno_nonloss = tmp_seqno;
955 hcrx->ccid3hcrx_ccval_nonloss = ccval;
956 dccp_inc_seqno(&tmp_seqno);
957 }
958 }
959
960 /* FIXME - this code could be simplified with above while */
961 /* but works at moment */
962 if (follows48(packet->dccphrx_seqno, hcrx->ccid3hcrx_seqno_nonloss)) {
963 hcrx->ccid3hcrx_seqno_nonloss = seqno;
964 hcrx->ccid3hcrx_ccval_nonloss = packet->dccphrx_ccval;
965 }
966
967detect_out:
968 dccp_rx_hist_add_packet(ccid3_rx_hist, &hcrx->ccid3hcrx_hist,
969 &hcrx->ccid3hcrx_li_hist, packet,
970 hcrx->ccid3hcrx_seqno_nonloss);
971 return loss;
7c657876
ACM
972}
973
7c657876
ACM
974static void ccid3_hc_rx_packet_recv(struct sock *sk, struct sk_buff *skb)
975{
59725dc2 976 struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
4fded33b 977 const struct dccp_options_received *opt_recv;
8c60f3fa 978 struct dccp_rx_hist_entry *packet;
7c657876 979 struct timeval now;
66a377c5 980 u32 p_prev, rtt_prev, r_sample, t_elapsed;
78ad713d 981 int loss, payload_size;
1f2333ae 982
59348b19 983 BUG_ON(hcrx == NULL);
7c657876 984
59725dc2 985 opt_recv = &dccp_sk(sk)->dccps_options_received;
4fded33b 986
7c657876
ACM
987 switch (DCCP_SKB_CB(skb)->dccpd_type) {
988 case DCCP_PKT_ACK:
989 if (hcrx->ccid3hcrx_state == TFRC_RSTATE_NO_DATA)
990 return;
991 case DCCP_PKT_DATAACK:
4fded33b 992 if (opt_recv->dccpor_timestamp_echo == 0)
7c657876 993 break;
66a377c5 994 rtt_prev = hcrx->ccid3hcrx_rtt;
b0e56780 995 dccp_timestamp(sk, &now);
b3a3077d
ACM
996 timeval_sub_usecs(&now, opt_recv->dccpor_timestamp_echo * 10);
997 r_sample = timeval_usecs(&now);
998 t_elapsed = opt_recv->dccpor_elapsed_time * 10;
999
1000 if (unlikely(r_sample <= t_elapsed))
59348b19
GR
1001 DCCP_WARN("r_sample=%uus, t_elapsed=%uus\n",
1002 r_sample, t_elapsed);
b3a3077d
ACM
1003 else
1004 r_sample -= t_elapsed;
1005
1006 if (hcrx->ccid3hcrx_state == TFRC_RSTATE_NO_DATA)
1007 hcrx->ccid3hcrx_rtt = r_sample;
1008 else
1009 hcrx->ccid3hcrx_rtt = (hcrx->ccid3hcrx_rtt * 9) / 10 +
1010 r_sample / 10;
1011
66a377c5
IM
1012 if (rtt_prev != hcrx->ccid3hcrx_rtt)
1013 ccid3_pr_debug("%s, New RTT=%uus, elapsed time=%u\n",
4fded33b
ACM
1014 dccp_role(sk), hcrx->ccid3hcrx_rtt,
1015 opt_recv->dccpor_elapsed_time);
7c657876
ACM
1016 break;
1017 case DCCP_PKT_DATA:
1018 break;
59d203f9 1019 default: /* We're not interested in other packet types, move along */
7c657876
ACM
1020 return;
1021 }
1022
b0e56780 1023 packet = dccp_rx_hist_entry_new(ccid3_rx_hist, sk, opt_recv->dccpor_ndp,
54e6ecb2 1024 skb, GFP_ATOMIC);
59d203f9 1025 if (unlikely(packet == NULL)) {
59348b19
GR
1026 DCCP_WARN("%s, sk=%p, Not enough mem to add rx packet "
1027 "to history, consider it lost!\n", dccp_role(sk), sk);
7c657876
ACM
1028 return;
1029 }
1030
66a377c5 1031 loss = ccid3_hc_rx_detect_loss(sk, packet);
7c657876
ACM
1032
1033 if (DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_ACK)
1034 return;
1035
78ad713d
GR
1036 payload_size = skb->len - dccp_hdr(skb)->dccph_doff * 4;
1037 ccid3_hc_rx_update_s(hcrx, payload_size);
1038
7c657876
ACM
1039 switch (hcrx->ccid3hcrx_state) {
1040 case TFRC_RSTATE_NO_DATA:
1f2333ae
ACM
1041 ccid3_pr_debug("%s, sk=%p(%s), skb=%p, sending initial "
1042 "feedback\n",
1043 dccp_role(sk), sk,
1044 dccp_state_name(sk->sk_state), skb);
7c657876
ACM
1045 ccid3_hc_rx_send_feedback(sk);
1046 ccid3_hc_rx_set_state(sk, TFRC_RSTATE_DATA);
1047 return;
1048 case TFRC_RSTATE_DATA:
78ad713d 1049 hcrx->ccid3hcrx_bytes_recv += payload_size;
66a377c5 1050 if (loss)
b6ee3d4a
ACM
1051 break;
1052
b0e56780 1053 dccp_timestamp(sk, &now);
b6ee3d4a
ACM
1054 if (timeval_delta(&now, &hcrx->ccid3hcrx_tstamp_last_ack) >=
1055 hcrx->ccid3hcrx_rtt) {
1056 hcrx->ccid3hcrx_tstamp_last_ack = now;
1057 ccid3_hc_rx_send_feedback(sk);
7c657876 1058 }
b6ee3d4a 1059 return;
59348b19
GR
1060 case TFRC_RSTATE_TERM:
1061 DCCP_BUG("Illegal %s state TERM, sk=%p", dccp_role(sk), sk);
7c657876
ACM
1062 return;
1063 }
1064
1065 /* Dealing with packet loss */
4fded33b
ACM
1066 ccid3_pr_debug("%s, sk=%p(%s), data loss! Reacting...\n",
1067 dccp_role(sk), sk, dccp_state_name(sk->sk_state));
7c657876 1068
7c657876
ACM
1069 p_prev = hcrx->ccid3hcrx_p;
1070
1071 /* Calculate loss event rate */
c0996660
IM
1072 if (!list_empty(&hcrx->ccid3hcrx_li_hist)) {
1073 u32 i_mean = dccp_li_hist_calc_i_mean(&hcrx->ccid3hcrx_li_hist);
1074
7c657876 1075 /* Scaling up by 1000000 as fixed decimal */
c0996660
IM
1076 if (i_mean != 0)
1077 hcrx->ccid3hcrx_p = 1000000 / i_mean;
59348b19
GR
1078 } else
1079 DCCP_BUG("empty loss history");
7c657876
ACM
1080
1081 if (hcrx->ccid3hcrx_p > p_prev) {
1082 ccid3_hc_rx_send_feedback(sk);
1083 return;
1084 }
1085}
1086
91f0ebf7 1087static int ccid3_hc_rx_init(struct ccid *ccid, struct sock *sk)
7c657876 1088{
91f0ebf7 1089 struct ccid3_hc_rx_sock *hcrx = ccid_priv(ccid);
7c657876
ACM
1090
1091 ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
1092
7c657876
ACM
1093 hcrx->ccid3hcrx_state = TFRC_RSTATE_NO_DATA;
1094 INIT_LIST_HEAD(&hcrx->ccid3hcrx_hist);
ae6706f0 1095 INIT_LIST_HEAD(&hcrx->ccid3hcrx_li_hist);
b0e56780 1096 dccp_timestamp(sk, &hcrx->ccid3hcrx_tstamp_last_ack);
954ee31f 1097 hcrx->ccid3hcrx_tstamp_last_feedback = hcrx->ccid3hcrx_tstamp_last_ack;
78ad713d 1098 hcrx->ccid3hcrx_s = 0;
954ee31f 1099 hcrx->ccid3hcrx_rtt = 5000; /* XXX 5ms for now... */
7c657876
ACM
1100 return 0;
1101}
1102
1103static void ccid3_hc_rx_exit(struct sock *sk)
1104{
59725dc2 1105 struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
7c657876 1106
59d203f9 1107 BUG_ON(hcrx == NULL);
7c657876
ACM
1108
1109 ccid3_hc_rx_set_state(sk, TFRC_RSTATE_TERM);
1110
1111 /* Empty packet history */
8c60f3fa 1112 dccp_rx_hist_purge(ccid3_rx_hist, &hcrx->ccid3hcrx_hist);
7c657876
ACM
1113
1114 /* Empty loss interval history */
ae6706f0 1115 dccp_li_hist_purge(ccid3_li_hist, &hcrx->ccid3hcrx_li_hist);
7c657876
ACM
1116}
1117
2babe1f6
ACM
1118static void ccid3_hc_rx_get_info(struct sock *sk, struct tcp_info *info)
1119{
59725dc2 1120 const struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
2babe1f6 1121
59c2353d
ACM
1122 /* Listen socks doesn't have a private CCID block */
1123 if (sk->sk_state == DCCP_LISTEN)
1124 return;
1125
59d203f9 1126 BUG_ON(hcrx == NULL);
2babe1f6
ACM
1127
1128 info->tcpi_ca_state = hcrx->ccid3hcrx_state;
1129 info->tcpi_options |= TCPI_OPT_TIMESTAMPS;
1130 info->tcpi_rcv_rtt = hcrx->ccid3hcrx_rtt;
1131}
1132
1133static void ccid3_hc_tx_get_info(struct sock *sk, struct tcp_info *info)
1134{
59725dc2 1135 const struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
2babe1f6 1136
59c2353d
ACM
1137 /* Listen socks doesn't have a private CCID block */
1138 if (sk->sk_state == DCCP_LISTEN)
1139 return;
1140
59d203f9 1141 BUG_ON(hctx == NULL);
2babe1f6
ACM
1142
1143 info->tcpi_rto = hctx->ccid3hctx_t_rto;
1144 info->tcpi_rtt = hctx->ccid3hctx_rtt;
1145}
1146
88f964db
ACM
1147static int ccid3_hc_rx_getsockopt(struct sock *sk, const int optname, int len,
1148 u32 __user *optval, int __user *optlen)
1149{
1150 const struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
1151 const void *val;
1152
1153 /* Listen socks doesn't have a private CCID block */
1154 if (sk->sk_state == DCCP_LISTEN)
1155 return -EINVAL;
1156
1157 switch (optname) {
1158 case DCCP_SOCKOPT_CCID_RX_INFO:
1159 if (len < sizeof(hcrx->ccid3hcrx_tfrc))
1160 return -EINVAL;
1161 len = sizeof(hcrx->ccid3hcrx_tfrc);
1162 val = &hcrx->ccid3hcrx_tfrc;
1163 break;
1164 default:
1165 return -ENOPROTOOPT;
1166 }
1167
1168 if (put_user(len, optlen) || copy_to_user(optval, val, len))
1169 return -EFAULT;
1170
1171 return 0;
1172}
1173
1174static int ccid3_hc_tx_getsockopt(struct sock *sk, const int optname, int len,
1175 u32 __user *optval, int __user *optlen)
1176{
1177 const struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
1178 const void *val;
1179
1180 /* Listen socks doesn't have a private CCID block */
1181 if (sk->sk_state == DCCP_LISTEN)
1182 return -EINVAL;
1183
1184 switch (optname) {
1185 case DCCP_SOCKOPT_CCID_TX_INFO:
1186 if (len < sizeof(hctx->ccid3hctx_tfrc))
1187 return -EINVAL;
1188 len = sizeof(hctx->ccid3hctx_tfrc);
1189 val = &hctx->ccid3hctx_tfrc;
1190 break;
1191 default:
1192 return -ENOPROTOOPT;
1193 }
1194
1195 if (put_user(len, optlen) || copy_to_user(optval, val, len))
1196 return -EFAULT;
1197
1198 return 0;
1199}
1200
91f0ebf7 1201static struct ccid_operations ccid3 = {
3dd9a7c3 1202 .ccid_id = DCCPC_CCID3,
7c657876
ACM
1203 .ccid_name = "ccid3",
1204 .ccid_owner = THIS_MODULE,
91f0ebf7 1205 .ccid_hc_tx_obj_size = sizeof(struct ccid3_hc_tx_sock),
7c657876
ACM
1206 .ccid_hc_tx_init = ccid3_hc_tx_init,
1207 .ccid_hc_tx_exit = ccid3_hc_tx_exit,
1208 .ccid_hc_tx_send_packet = ccid3_hc_tx_send_packet,
1209 .ccid_hc_tx_packet_sent = ccid3_hc_tx_packet_sent,
1210 .ccid_hc_tx_packet_recv = ccid3_hc_tx_packet_recv,
1211 .ccid_hc_tx_insert_options = ccid3_hc_tx_insert_options,
1212 .ccid_hc_tx_parse_options = ccid3_hc_tx_parse_options,
91f0ebf7 1213 .ccid_hc_rx_obj_size = sizeof(struct ccid3_hc_rx_sock),
7c657876
ACM
1214 .ccid_hc_rx_init = ccid3_hc_rx_init,
1215 .ccid_hc_rx_exit = ccid3_hc_rx_exit,
1216 .ccid_hc_rx_insert_options = ccid3_hc_rx_insert_options,
1217 .ccid_hc_rx_packet_recv = ccid3_hc_rx_packet_recv,
2babe1f6
ACM
1218 .ccid_hc_rx_get_info = ccid3_hc_rx_get_info,
1219 .ccid_hc_tx_get_info = ccid3_hc_tx_get_info,
88f964db
ACM
1220 .ccid_hc_rx_getsockopt = ccid3_hc_rx_getsockopt,
1221 .ccid_hc_tx_getsockopt = ccid3_hc_tx_getsockopt,
7c657876
ACM
1222};
1223
56724aa4 1224#ifdef CONFIG_IP_DCCP_CCID3_DEBUG
7c657876
ACM
1225module_param(ccid3_debug, int, 0444);
1226MODULE_PARM_DESC(ccid3_debug, "Enable debug messages");
56724aa4 1227#endif
7c657876
ACM
1228
1229static __init int ccid3_module_init(void)
1230{
8c60f3fa 1231 int rc = -ENOBUFS;
7c657876 1232
8c60f3fa
ACM
1233 ccid3_rx_hist = dccp_rx_hist_new("ccid3");
1234 if (ccid3_rx_hist == NULL)
7c657876
ACM
1235 goto out;
1236
8c60f3fa
ACM
1237 ccid3_tx_hist = dccp_tx_hist_new("ccid3");
1238 if (ccid3_tx_hist == NULL)
1239 goto out_free_rx;
7c657876 1240
ae6706f0
ACM
1241 ccid3_li_hist = dccp_li_hist_new("ccid3");
1242 if (ccid3_li_hist == NULL)
8c60f3fa 1243 goto out_free_tx;
7c657876
ACM
1244
1245 rc = ccid_register(&ccid3);
1246 if (rc != 0)
1247 goto out_free_loss_interval_history;
7c657876
ACM
1248out:
1249 return rc;
8c60f3fa 1250
7c657876 1251out_free_loss_interval_history:
ae6706f0
ACM
1252 dccp_li_hist_delete(ccid3_li_hist);
1253 ccid3_li_hist = NULL;
8c60f3fa
ACM
1254out_free_tx:
1255 dccp_tx_hist_delete(ccid3_tx_hist);
1256 ccid3_tx_hist = NULL;
1257out_free_rx:
1258 dccp_rx_hist_delete(ccid3_rx_hist);
1259 ccid3_rx_hist = NULL;
7c657876
ACM
1260 goto out;
1261}
1262module_init(ccid3_module_init);
1263
1264static __exit void ccid3_module_exit(void)
1265{
1266 ccid_unregister(&ccid3);
1267
8c60f3fa
ACM
1268 if (ccid3_tx_hist != NULL) {
1269 dccp_tx_hist_delete(ccid3_tx_hist);
1270 ccid3_tx_hist = NULL;
7c657876 1271 }
8c60f3fa
ACM
1272 if (ccid3_rx_hist != NULL) {
1273 dccp_rx_hist_delete(ccid3_rx_hist);
1274 ccid3_rx_hist = NULL;
7c657876 1275 }
ae6706f0
ACM
1276 if (ccid3_li_hist != NULL) {
1277 dccp_li_hist_delete(ccid3_li_hist);
1278 ccid3_li_hist = NULL;
7c657876
ACM
1279 }
1280}
1281module_exit(ccid3_module_exit);
1282
e6bccd35 1283MODULE_AUTHOR("Ian McDonald <ian.mcdonald@jandi.co.nz>, "
1f2333ae 1284 "Arnaldo Carvalho de Melo <acme@ghostprotocols.net>");
7c657876
ACM
1285MODULE_DESCRIPTION("DCCP TFRC CCID3 CCID");
1286MODULE_LICENSE("GPL");
1287MODULE_ALIAS("net-dccp-ccid-3");
This page took 0.235638 seconds and 5 git commands to generate.