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