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