[XFRM]: Fix aevent structuring to be more complete.
[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
2a1fda6f 248 * max(4 * R, 2 * s/X) = max(4 * R, 2 * t_ipi)
6b5e633a 249 */
2a1fda6f 250 t_nfb = max(4 * hctx->ccid3hctx_rtt, 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
ACM
296 new_packet = dccp_tx_hist_entry_new(ccid3_tx_hist,
297 SLAB_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 */
7da7f456
GR
341 if (delay >= hctx->ccid3hctx_delta)
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;
1bc09869 415 u32 t_elapsed;
7c657876
ACM
416 u32 pinv;
417 u32 x_recv;
418 u32 r_sample;
1f2333ae 419
59348b19 420 BUG_ON(hctx == NULL);
7c657876
ACM
421
422 /* we are only interested in ACKs */
423 if (!(DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_ACK ||
424 DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_DATAACK))
425 return;
426
427 opt_recv = &hctx->ccid3hctx_options_received;
428
1a28599a 429 t_elapsed = dp->dccps_options_received.dccpor_elapsed_time * 10;
7c657876
ACM
430 x_recv = opt_recv->ccid3or_receive_rate;
431 pinv = opt_recv->ccid3or_loss_event_rate;
432
433 switch (hctx->ccid3hctx_state) {
7c657876
ACM
434 case TFRC_SSTATE_NO_FBACK:
435 case TFRC_SSTATE_FBACK:
436 /* Calculate new round trip sample by
437 * R_sample = (now - t_recvdata) - t_delay */
438 /* get t_recvdata from history */
8c60f3fa
ACM
439 packet = dccp_tx_hist_find_entry(&hctx->ccid3hctx_hist,
440 DCCP_SKB_CB(skb)->dccpd_ack_seq);
59d203f9 441 if (unlikely(packet == NULL)) {
59348b19
GR
442 DCCP_WARN("%s, sk=%p, seqno %llu(%s) does't exist "
443 "in history!\n", dccp_role(sk), sk,
59d203f9 444 (unsigned long long)DCCP_SKB_CB(skb)->dccpd_ack_seq,
59348b19 445 dccp_packet_name(DCCP_SKB_CB(skb)->dccpd_type));
7c657876
ACM
446 return;
447 }
448
449 /* Update RTT */
b0e56780
ACM
450 dccp_timestamp(sk, &now);
451 r_sample = timeval_delta(&now, &packet->dccphtx_tstamp);
1a28599a 452 if (unlikely(r_sample <= t_elapsed))
59348b19
GR
453 DCCP_WARN("r_sample=%uus,t_elapsed=%uus\n",
454 r_sample, t_elapsed);
1a28599a
ACM
455 else
456 r_sample -= t_elapsed;
7c657876
ACM
457
458 /* Update RTT estimate by
459 * If (No feedback recv)
460 * R = R_sample;
461 * Else
462 * R = q * R + (1 - q) * R_sample;
463 *
464 * q is a constant, RFC 3448 recomments 0.9
465 */
466 if (hctx->ccid3hctx_state == TFRC_SSTATE_NO_FBACK) {
a79ef76f
GR
467 /* Use Larger Initial Windows [RFC 4342, sec. 5]
468 * We deviate in that we use `s' instead of `MSS'. */
469 u16 w_init = max( 4 * hctx->ccid3hctx_s,
470 max(2 * hctx->ccid3hctx_s, 4380));
471 hctx->ccid3hctx_rtt = r_sample;
472 hctx->ccid3hctx_x = usecs_div(w_init, r_sample);
473 hctx->ccid3hctx_t_ld = now;
474
475 ccid3_update_send_time(hctx);
7c657876 476 ccid3_hc_tx_set_state(sk, TFRC_SSTATE_FBACK);
a79ef76f 477 } else {
1f2333ae
ACM
478 hctx->ccid3hctx_rtt = (hctx->ccid3hctx_rtt * 9) / 10 +
479 r_sample / 10;
a79ef76f
GR
480 ccid3_hc_tx_update_x(sk, &now);
481 }
7c657876 482
1f2333ae
ACM
483 ccid3_pr_debug("%s, sk=%p, New RTT estimate=%uus, "
484 "r_sample=%us\n", dccp_role(sk), sk,
485 hctx->ccid3hctx_rtt, r_sample);
7c657876 486
7c657876 487 /* Update receive rate */
1f2333ae 488 hctx->ccid3hctx_x_recv = x_recv;/* X_recv in bytes per sec */
7c657876
ACM
489
490 /* Update loss event rate */
491 if (pinv == ~0 || pinv == 0)
492 hctx->ccid3hctx_p = 0;
493 else {
494 hctx->ccid3hctx_p = 1000000 / pinv;
495
496 if (hctx->ccid3hctx_p < TFRC_SMALLEST_P) {
497 hctx->ccid3hctx_p = TFRC_SMALLEST_P;
1f2333ae
ACM
498 ccid3_pr_debug("%s, sk=%p, Smallest p used!\n",
499 dccp_role(sk), sk);
7c657876
ACM
500 }
501 }
502
503 /* unschedule no feedback timer */
504 sk_stop_timer(sk, &hctx->ccid3hctx_no_feedback_timer);
505
7c657876 506 /* remove all packets older than the one acked from history */
8c60f3fa
ACM
507 dccp_tx_hist_purge_older(ccid3_tx_hist,
508 &hctx->ccid3hctx_hist, packet);
c530cfb1
ACM
509 /*
510 * As we have calculated new ipi, delta, t_nom it is possible that
5d0dbc4a 511 * we now can send a packet, so wake up dccp_wait_for_ccid
c530cfb1
ACM
512 */
513 sk->sk_write_space(sk);
8c60f3fa 514
5d0dbc4a
GR
515 /* Update timeout interval. We use the alternative variant of
516 * [RFC 3448, 3.1] which sets the upper bound of t_rto to one
517 * second, as it is suggested for TCP (see RFC 2988, 2.4). */
518 hctx->ccid3hctx_t_rto = max_t(u32, 4 * hctx->ccid3hctx_rtt,
519 USEC_PER_SEC );
1f2333ae
ACM
520 /*
521 * Schedule no feedback timer to expire in
2a1fda6f 522 * max(4 * R, 2 * s/X) = max(4 * R, 2 * t_ipi)
1f2333ae 523 */
2a1fda6f 524 t_nfb = max(4 * hctx->ccid3hctx_rtt, 2 * hctx->ccid3hctx_t_ipi);
6b5e633a 525
1f2333ae
ACM
526 ccid3_pr_debug("%s, sk=%p, Scheduled no feedback timer to "
527 "expire in %lu jiffies (%luus)\n",
528 dccp_role(sk), sk,
2a1fda6f 529 usecs_to_jiffies(t_nfb), t_nfb);
7c657876
ACM
530
531 sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
2a1fda6f 532 jiffies + usecs_to_jiffies(t_nfb));
7c657876
ACM
533
534 /* set idle flag */
535 hctx->ccid3hctx_idle = 1;
536 break;
5e19e3fc
GR
537 case TFRC_SSTATE_NO_SENT:
538 DCCP_WARN("Illegal ACK received - no packet has been sent\n");
539 /* fall through */
540 case TFRC_SSTATE_TERM: /* ignore feedback when closing */
7c657876
ACM
541 break;
542 }
543}
544
2d0817d1 545static int ccid3_hc_tx_insert_options(struct sock *sk, struct sk_buff *skb)
7c657876 546{
59d203f9 547 const struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
7c657876 548
59d203f9
ACM
549 BUG_ON(hctx == NULL);
550
2d0817d1
ACM
551 if (sk->sk_state == DCCP_OPEN || sk->sk_state == DCCP_PARTOPEN)
552 DCCP_SKB_CB(skb)->dccpd_ccval = hctx->ccid3hctx_last_win_count;
553 return 0;
7c657876
ACM
554}
555
556static int ccid3_hc_tx_parse_options(struct sock *sk, unsigned char option,
1f2333ae
ACM
557 unsigned char len, u16 idx,
558 unsigned char *value)
7c657876
ACM
559{
560 int rc = 0;
59725dc2
ACM
561 const struct dccp_sock *dp = dccp_sk(sk);
562 struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
7c657876
ACM
563 struct ccid3_options_received *opt_recv;
564
59d203f9 565 BUG_ON(hctx == NULL);
7c657876
ACM
566
567 opt_recv = &hctx->ccid3hctx_options_received;
568
569 if (opt_recv->ccid3or_seqno != dp->dccps_gsr) {
570 opt_recv->ccid3or_seqno = dp->dccps_gsr;
571 opt_recv->ccid3or_loss_event_rate = ~0;
572 opt_recv->ccid3or_loss_intervals_idx = 0;
573 opt_recv->ccid3or_loss_intervals_len = 0;
574 opt_recv->ccid3or_receive_rate = 0;
575 }
576
577 switch (option) {
578 case TFRC_OPT_LOSS_EVENT_RATE:
59d203f9 579 if (unlikely(len != 4)) {
59348b19
GR
580 DCCP_WARN("%s, sk=%p, invalid len %d "
581 "for TFRC_OPT_LOSS_EVENT_RATE\n",
582 dccp_role(sk), sk, len);
7c657876
ACM
583 rc = -EINVAL;
584 } else {
60fe62e7 585 opt_recv->ccid3or_loss_event_rate = ntohl(*(__be32 *)value);
7c657876
ACM
586 ccid3_pr_debug("%s, sk=%p, LOSS_EVENT_RATE=%u\n",
587 dccp_role(sk), sk,
588 opt_recv->ccid3or_loss_event_rate);
589 }
590 break;
591 case TFRC_OPT_LOSS_INTERVALS:
592 opt_recv->ccid3or_loss_intervals_idx = idx;
593 opt_recv->ccid3or_loss_intervals_len = len;
594 ccid3_pr_debug("%s, sk=%p, LOSS_INTERVALS=(%u, %u)\n",
595 dccp_role(sk), sk,
596 opt_recv->ccid3or_loss_intervals_idx,
597 opt_recv->ccid3or_loss_intervals_len);
598 break;
599 case TFRC_OPT_RECEIVE_RATE:
59d203f9 600 if (unlikely(len != 4)) {
59348b19
GR
601 DCCP_WARN("%s, sk=%p, invalid len %d "
602 "for TFRC_OPT_RECEIVE_RATE\n",
603 dccp_role(sk), sk, len);
7c657876
ACM
604 rc = -EINVAL;
605 } else {
60fe62e7 606 opt_recv->ccid3or_receive_rate = ntohl(*(__be32 *)value);
7c657876
ACM
607 ccid3_pr_debug("%s, sk=%p, RECEIVE_RATE=%u\n",
608 dccp_role(sk), sk,
609 opt_recv->ccid3or_receive_rate);
610 }
611 break;
612 }
613
614 return rc;
615}
616
91f0ebf7 617static int ccid3_hc_tx_init(struct ccid *ccid, struct sock *sk)
7c657876 618{
91f0ebf7 619 struct ccid3_hc_tx_sock *hctx = ccid_priv(ccid);
7c657876 620
78ad713d 621 hctx->ccid3hctx_s = 0;
7c657876
ACM
622 hctx->ccid3hctx_state = TFRC_SSTATE_NO_SENT;
623 INIT_LIST_HEAD(&hctx->ccid3hctx_hist);
aa5d7df3
ACM
624
625 hctx->ccid3hctx_no_feedback_timer.function = ccid3_hc_tx_no_feedback_timer;
626 hctx->ccid3hctx_no_feedback_timer.data = (unsigned long)sk;
7c657876
ACM
627 init_timer(&hctx->ccid3hctx_no_feedback_timer);
628
629 return 0;
630}
631
632static void ccid3_hc_tx_exit(struct sock *sk)
633{
59725dc2 634 struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
7c657876 635
7c657876
ACM
636 BUG_ON(hctx == NULL);
637
638 ccid3_hc_tx_set_state(sk, TFRC_SSTATE_TERM);
639 sk_stop_timer(sk, &hctx->ccid3hctx_no_feedback_timer);
640
641 /* Empty packet history */
8c60f3fa 642 dccp_tx_hist_purge(ccid3_tx_hist, &hctx->ccid3hctx_hist);
7c657876
ACM
643}
644
645/*
646 * RX Half Connection methods
647 */
648
56724aa4 649#ifdef CONFIG_IP_DCCP_CCID3_DEBUG
7c657876
ACM
650static const char *ccid3_rx_state_name(enum ccid3_hc_rx_states state)
651{
652 static char *ccid3_rx_state_names[] = {
653 [TFRC_RSTATE_NO_DATA] = "NO_DATA",
654 [TFRC_RSTATE_DATA] = "DATA",
655 [TFRC_RSTATE_TERM] = "TERM",
656 };
657
658 return ccid3_rx_state_names[state];
659}
660#endif
661
c25a18ba
ACM
662static void ccid3_hc_rx_set_state(struct sock *sk,
663 enum ccid3_hc_rx_states state)
7c657876 664{
59725dc2 665 struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
7c657876
ACM
666 enum ccid3_hc_rx_states oldstate = hcrx->ccid3hcrx_state;
667
668 ccid3_pr_debug("%s(%p) %-8.8s -> %s\n",
1f2333ae
ACM
669 dccp_role(sk), sk, ccid3_rx_state_name(oldstate),
670 ccid3_rx_state_name(state));
7c657876
ACM
671 WARN_ON(state == oldstate);
672 hcrx->ccid3hcrx_state = state;
673}
674
78ad713d
GR
675static inline void ccid3_hc_rx_update_s(struct ccid3_hc_rx_sock *hcrx, int len)
676{
677 if (unlikely(len == 0)) /* don't update on empty packets (e.g. ACKs) */
678 ccid3_pr_debug("Packet payload length is 0 - not updating\n");
679 else
680 hcrx->ccid3hcrx_s = hcrx->ccid3hcrx_s == 0 ? len :
681 (9 * hcrx->ccid3hcrx_s + len) / 10;
682}
683
7c657876
ACM
684static void ccid3_hc_rx_send_feedback(struct sock *sk)
685{
59725dc2 686 struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
7c657876 687 struct dccp_sock *dp = dccp_sk(sk);
8c60f3fa 688 struct dccp_rx_hist_entry *packet;
b6ee3d4a 689 struct timeval now;
7c657876
ACM
690
691 ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
692
b0e56780 693 dccp_timestamp(sk, &now);
b6ee3d4a 694
7c657876
ACM
695 switch (hcrx->ccid3hcrx_state) {
696 case TFRC_RSTATE_NO_DATA:
697 hcrx->ccid3hcrx_x_recv = 0;
698 break;
699 case TFRC_RSTATE_DATA: {
b6ee3d4a
ACM
700 const u32 delta = timeval_delta(&now,
701 &hcrx->ccid3hcrx_tstamp_last_feedback);
27ae543e
ACM
702 hcrx->ccid3hcrx_x_recv = usecs_div(hcrx->ccid3hcrx_bytes_recv,
703 delta);
7c657876
ACM
704 }
705 break;
59348b19
GR
706 case TFRC_RSTATE_TERM:
707 DCCP_BUG("Illegal %s state TERM, sk=%p", dccp_role(sk), sk);
7c657876
ACM
708 return;
709 }
710
8c60f3fa 711 packet = dccp_rx_hist_find_data_packet(&hcrx->ccid3hcrx_hist);
59d203f9 712 if (unlikely(packet == NULL)) {
59348b19
GR
713 DCCP_WARN("%s, sk=%p, no data packet in history!\n",
714 dccp_role(sk), sk);
7c657876
ACM
715 return;
716 }
717
b6ee3d4a 718 hcrx->ccid3hcrx_tstamp_last_feedback = now;
66a377c5 719 hcrx->ccid3hcrx_ccval_last_counter = packet->dccphrx_ccval;
7c657876
ACM
720 hcrx->ccid3hcrx_bytes_recv = 0;
721
722 /* Convert to multiples of 10us */
b6ee3d4a
ACM
723 hcrx->ccid3hcrx_elapsed_time =
724 timeval_delta(&now, &packet->dccphrx_tstamp) / 10;
7c657876
ACM
725 if (hcrx->ccid3hcrx_p == 0)
726 hcrx->ccid3hcrx_pinv = ~0;
727 else
728 hcrx->ccid3hcrx_pinv = 1000000 / hcrx->ccid3hcrx_p;
507d37cf 729 dp->dccps_hc_rx_insert_options = 1;
7c657876
ACM
730 dccp_send_ack(sk);
731}
732
2d0817d1 733static int ccid3_hc_rx_insert_options(struct sock *sk, struct sk_buff *skb)
7c657876 734{
59d203f9 735 const struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
60fe62e7 736 __be32 x_recv, pinv;
7c657876 737
59d203f9
ACM
738 BUG_ON(hcrx == NULL);
739
740 if (!(sk->sk_state == DCCP_OPEN || sk->sk_state == DCCP_PARTOPEN))
2d0817d1 741 return 0;
7c657876 742
66a377c5 743 DCCP_SKB_CB(skb)->dccpd_ccval = hcrx->ccid3hcrx_ccval_last_counter;
4fded33b
ACM
744
745 if (dccp_packet_without_ack(skb))
2d0817d1
ACM
746 return 0;
747
4fded33b
ACM
748 x_recv = htonl(hcrx->ccid3hcrx_x_recv);
749 pinv = htonl(hcrx->ccid3hcrx_pinv);
2d0817d1
ACM
750
751 if ((hcrx->ccid3hcrx_elapsed_time != 0 &&
752 dccp_insert_option_elapsed_time(sk, skb,
753 hcrx->ccid3hcrx_elapsed_time)) ||
754 dccp_insert_option_timestamp(sk, skb) ||
755 dccp_insert_option(sk, skb, TFRC_OPT_LOSS_EVENT_RATE,
756 &pinv, sizeof(pinv)) ||
757 dccp_insert_option(sk, skb, TFRC_OPT_RECEIVE_RATE,
758 &x_recv, sizeof(x_recv)))
759 return -1;
760
761 return 0;
7c657876
ACM
762}
763
7c657876
ACM
764/* calculate first loss interval
765 *
766 * returns estimated loss interval in usecs */
767
768static u32 ccid3_hc_rx_calc_first_li(struct sock *sk)
769{
59725dc2 770 struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
8c60f3fa 771 struct dccp_rx_hist_entry *entry, *next, *tail = NULL;
7c657876 772 u32 rtt, delta, x_recv, fval, p, tmp2;
b6ee3d4a 773 struct timeval tstamp = { 0, };
7c657876
ACM
774 int interval = 0;
775 int win_count = 0;
776 int step = 0;
777 u64 tmp1;
778
8c60f3fa
ACM
779 list_for_each_entry_safe(entry, next, &hcrx->ccid3hcrx_hist,
780 dccphrx_node) {
781 if (dccp_rx_hist_entry_data_packet(entry)) {
7c657876
ACM
782 tail = entry;
783
784 switch (step) {
785 case 0:
8c60f3fa 786 tstamp = entry->dccphrx_tstamp;
c1734376 787 win_count = entry->dccphrx_ccval;
7c657876
ACM
788 step = 1;
789 break;
790 case 1:
c1734376 791 interval = win_count - entry->dccphrx_ccval;
7c657876
ACM
792 if (interval < 0)
793 interval += TFRC_WIN_COUNT_LIMIT;
794 if (interval > 4)
795 goto found;
796 break;
797 }
798 }
799 }
800
59d203f9 801 if (unlikely(step == 0)) {
59348b19
GR
802 DCCP_WARN("%s, sk=%p, packet history has no data packets!\n",
803 dccp_role(sk), sk);
7c657876
ACM
804 return ~0;
805 }
806
59d203f9 807 if (unlikely(interval == 0)) {
59348b19
GR
808 DCCP_WARN("%s, sk=%p, Could not find a win_count interval > 0."
809 "Defaulting to 1\n", dccp_role(sk), sk);
7c657876
ACM
810 interval = 1;
811 }
812found:
66a377c5 813 if (!tail) {
59348b19 814 DCCP_CRIT("tail is null\n");
66a377c5
IM
815 return ~0;
816 }
b6ee3d4a 817 rtt = timeval_delta(&tstamp, &tail->dccphrx_tstamp) * 4 / interval;
7c657876
ACM
818 ccid3_pr_debug("%s, sk=%p, approximated RTT to %uus\n",
819 dccp_role(sk), sk, rtt);
59348b19
GR
820
821 if (rtt == 0) {
822 DCCP_WARN("RTT==0, setting to 1\n");
823 rtt = 1;
824 }
7c657876 825
b0e56780
ACM
826 dccp_timestamp(sk, &tstamp);
827 delta = timeval_delta(&tstamp, &hcrx->ccid3hcrx_tstamp_last_feedback);
828 x_recv = usecs_div(hcrx->ccid3hcrx_bytes_recv, delta);
7c657876 829
66a377c5
IM
830 if (x_recv == 0)
831 x_recv = hcrx->ccid3hcrx_x_recv;
832
7c657876
ACM
833 tmp1 = (u64)x_recv * (u64)rtt;
834 do_div(tmp1,10000000);
835 tmp2 = (u32)tmp1;
66a377c5
IM
836
837 if (!tmp2) {
59348b19 838 DCCP_CRIT("tmp2 = 0, x_recv = %u, rtt =%u\n", x_recv, rtt);
66a377c5
IM
839 return ~0;
840 }
841
7c657876
ACM
842 fval = (hcrx->ccid3hcrx_s * 100000) / tmp2;
843 /* do not alter order above or you will get overflow on 32 bit */
36729c1a 844 p = tfrc_calc_x_reverse_lookup(fval);
1f2333ae
ACM
845 ccid3_pr_debug("%s, sk=%p, receive rate=%u bytes/s, implied "
846 "loss rate=%u\n", dccp_role(sk), sk, x_recv, p);
7c657876
ACM
847
848 if (p == 0)
849 return ~0;
850 else
851 return 1000000 / p;
852}
853
854static void ccid3_hc_rx_update_li(struct sock *sk, u64 seq_loss, u8 win_loss)
855{
59725dc2 856 struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
fc747e82 857 struct dccp_li_hist_entry *head;
66a377c5 858 u64 seq_temp;
7c657876 859
66a377c5
IM
860 if (list_empty(&hcrx->ccid3hcrx_li_hist)) {
861 if (!dccp_li_hist_interval_new(ccid3_li_hist,
862 &hcrx->ccid3hcrx_li_hist, seq_loss, win_loss))
863 return;
7c657876 864
fc747e82
IM
865 head = list_entry(hcrx->ccid3hcrx_li_hist.next,
866 struct dccp_li_hist_entry, dccplih_node);
867 head->dccplih_interval = ccid3_hc_rx_calc_first_li(sk);
66a377c5
IM
868 } else {
869 struct dccp_li_hist_entry *entry;
870 struct list_head *tail;
871
fc747e82
IM
872 head = list_entry(hcrx->ccid3hcrx_li_hist.next,
873 struct dccp_li_hist_entry, dccplih_node);
66a377c5
IM
874 /* FIXME win count check removed as was wrong */
875 /* should make this check with receive history */
876 /* and compare there as per section 10.2 of RFC4342 */
877
878 /* new loss event detected */
879 /* calculate last interval length */
880 seq_temp = dccp_delta_seqno(head->dccplih_seqno, seq_loss);
881 entry = dccp_li_hist_entry_new(ccid3_li_hist, SLAB_ATOMIC);
882
883 if (entry == NULL) {
59348b19 884 DCCP_BUG("out of memory - can not allocate entry");
ae6706f0 885 return;
66a377c5
IM
886 }
887
888 list_add(&entry->dccplih_node, &hcrx->ccid3hcrx_li_hist);
889
890 tail = hcrx->ccid3hcrx_li_hist.prev;
891 list_del(tail);
892 kmem_cache_free(ccid3_li_hist->dccplih_slab, tail);
893
894 /* Create the newest interval */
895 entry->dccplih_seqno = seq_loss;
896 entry->dccplih_interval = seq_temp;
897 entry->dccplih_win_count = win_loss;
898 }
7c657876
ACM
899}
900
66a377c5
IM
901static int ccid3_hc_rx_detect_loss(struct sock *sk,
902 struct dccp_rx_hist_entry *packet)
7c657876 903{
59725dc2 904 struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
66a377c5
IM
905 struct dccp_rx_hist_entry *rx_hist = dccp_rx_hist_head(&hcrx->ccid3hcrx_hist);
906 u64 seqno = packet->dccphrx_seqno;
907 u64 tmp_seqno;
908 int loss = 0;
909 u8 ccval;
910
911
912 tmp_seqno = hcrx->ccid3hcrx_seqno_nonloss;
913
914 if (!rx_hist ||
915 follows48(packet->dccphrx_seqno, hcrx->ccid3hcrx_seqno_nonloss)) {
916 hcrx->ccid3hcrx_seqno_nonloss = seqno;
917 hcrx->ccid3hcrx_ccval_nonloss = packet->dccphrx_ccval;
918 goto detect_out;
919 }
920
7c657876 921
66a377c5
IM
922 while (dccp_delta_seqno(hcrx->ccid3hcrx_seqno_nonloss, seqno)
923 > TFRC_RECV_NUM_LATE_LOSS) {
924 loss = 1;
925 ccid3_hc_rx_update_li(sk, hcrx->ccid3hcrx_seqno_nonloss,
926 hcrx->ccid3hcrx_ccval_nonloss);
927 tmp_seqno = hcrx->ccid3hcrx_seqno_nonloss;
928 dccp_inc_seqno(&tmp_seqno);
929 hcrx->ccid3hcrx_seqno_nonloss = tmp_seqno;
930 dccp_inc_seqno(&tmp_seqno);
931 while (dccp_rx_hist_find_entry(&hcrx->ccid3hcrx_hist,
932 tmp_seqno, &ccval)) {
933 hcrx->ccid3hcrx_seqno_nonloss = tmp_seqno;
934 hcrx->ccid3hcrx_ccval_nonloss = ccval;
935 dccp_inc_seqno(&tmp_seqno);
936 }
937 }
938
939 /* FIXME - this code could be simplified with above while */
940 /* but works at moment */
941 if (follows48(packet->dccphrx_seqno, hcrx->ccid3hcrx_seqno_nonloss)) {
942 hcrx->ccid3hcrx_seqno_nonloss = seqno;
943 hcrx->ccid3hcrx_ccval_nonloss = packet->dccphrx_ccval;
944 }
945
946detect_out:
947 dccp_rx_hist_add_packet(ccid3_rx_hist, &hcrx->ccid3hcrx_hist,
948 &hcrx->ccid3hcrx_li_hist, packet,
949 hcrx->ccid3hcrx_seqno_nonloss);
950 return loss;
7c657876
ACM
951}
952
7c657876
ACM
953static void ccid3_hc_rx_packet_recv(struct sock *sk, struct sk_buff *skb)
954{
59725dc2 955 struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
4fded33b 956 const struct dccp_options_received *opt_recv;
8c60f3fa 957 struct dccp_rx_hist_entry *packet;
7c657876 958 struct timeval now;
66a377c5 959 u32 p_prev, rtt_prev, r_sample, t_elapsed;
78ad713d 960 int loss, payload_size;
1f2333ae 961
59348b19 962 BUG_ON(hcrx == NULL);
7c657876 963
59725dc2 964 opt_recv = &dccp_sk(sk)->dccps_options_received;
4fded33b 965
7c657876
ACM
966 switch (DCCP_SKB_CB(skb)->dccpd_type) {
967 case DCCP_PKT_ACK:
968 if (hcrx->ccid3hcrx_state == TFRC_RSTATE_NO_DATA)
969 return;
970 case DCCP_PKT_DATAACK:
4fded33b 971 if (opt_recv->dccpor_timestamp_echo == 0)
7c657876 972 break;
66a377c5 973 rtt_prev = hcrx->ccid3hcrx_rtt;
b0e56780 974 dccp_timestamp(sk, &now);
b3a3077d
ACM
975 timeval_sub_usecs(&now, opt_recv->dccpor_timestamp_echo * 10);
976 r_sample = timeval_usecs(&now);
977 t_elapsed = opt_recv->dccpor_elapsed_time * 10;
978
979 if (unlikely(r_sample <= t_elapsed))
59348b19
GR
980 DCCP_WARN("r_sample=%uus, t_elapsed=%uus\n",
981 r_sample, t_elapsed);
b3a3077d
ACM
982 else
983 r_sample -= t_elapsed;
984
985 if (hcrx->ccid3hcrx_state == TFRC_RSTATE_NO_DATA)
986 hcrx->ccid3hcrx_rtt = r_sample;
987 else
988 hcrx->ccid3hcrx_rtt = (hcrx->ccid3hcrx_rtt * 9) / 10 +
989 r_sample / 10;
990
66a377c5
IM
991 if (rtt_prev != hcrx->ccid3hcrx_rtt)
992 ccid3_pr_debug("%s, New RTT=%uus, elapsed time=%u\n",
4fded33b
ACM
993 dccp_role(sk), hcrx->ccid3hcrx_rtt,
994 opt_recv->dccpor_elapsed_time);
7c657876
ACM
995 break;
996 case DCCP_PKT_DATA:
997 break;
59d203f9 998 default: /* We're not interested in other packet types, move along */
7c657876
ACM
999 return;
1000 }
1001
b0e56780 1002 packet = dccp_rx_hist_entry_new(ccid3_rx_hist, sk, opt_recv->dccpor_ndp,
8c60f3fa 1003 skb, SLAB_ATOMIC);
59d203f9 1004 if (unlikely(packet == NULL)) {
59348b19
GR
1005 DCCP_WARN("%s, sk=%p, Not enough mem to add rx packet "
1006 "to history, consider it lost!\n", dccp_role(sk), sk);
7c657876
ACM
1007 return;
1008 }
1009
66a377c5 1010 loss = ccid3_hc_rx_detect_loss(sk, packet);
7c657876
ACM
1011
1012 if (DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_ACK)
1013 return;
1014
78ad713d
GR
1015 payload_size = skb->len - dccp_hdr(skb)->dccph_doff * 4;
1016 ccid3_hc_rx_update_s(hcrx, payload_size);
1017
7c657876
ACM
1018 switch (hcrx->ccid3hcrx_state) {
1019 case TFRC_RSTATE_NO_DATA:
1f2333ae
ACM
1020 ccid3_pr_debug("%s, sk=%p(%s), skb=%p, sending initial "
1021 "feedback\n",
1022 dccp_role(sk), sk,
1023 dccp_state_name(sk->sk_state), skb);
7c657876
ACM
1024 ccid3_hc_rx_send_feedback(sk);
1025 ccid3_hc_rx_set_state(sk, TFRC_RSTATE_DATA);
1026 return;
1027 case TFRC_RSTATE_DATA:
78ad713d 1028 hcrx->ccid3hcrx_bytes_recv += payload_size;
66a377c5 1029 if (loss)
b6ee3d4a
ACM
1030 break;
1031
b0e56780 1032 dccp_timestamp(sk, &now);
b6ee3d4a
ACM
1033 if (timeval_delta(&now, &hcrx->ccid3hcrx_tstamp_last_ack) >=
1034 hcrx->ccid3hcrx_rtt) {
1035 hcrx->ccid3hcrx_tstamp_last_ack = now;
1036 ccid3_hc_rx_send_feedback(sk);
7c657876 1037 }
b6ee3d4a 1038 return;
59348b19
GR
1039 case TFRC_RSTATE_TERM:
1040 DCCP_BUG("Illegal %s state TERM, sk=%p", dccp_role(sk), sk);
7c657876
ACM
1041 return;
1042 }
1043
1044 /* Dealing with packet loss */
4fded33b
ACM
1045 ccid3_pr_debug("%s, sk=%p(%s), data loss! Reacting...\n",
1046 dccp_role(sk), sk, dccp_state_name(sk->sk_state));
7c657876 1047
7c657876
ACM
1048 p_prev = hcrx->ccid3hcrx_p;
1049
1050 /* Calculate loss event rate */
c0996660
IM
1051 if (!list_empty(&hcrx->ccid3hcrx_li_hist)) {
1052 u32 i_mean = dccp_li_hist_calc_i_mean(&hcrx->ccid3hcrx_li_hist);
1053
7c657876 1054 /* Scaling up by 1000000 as fixed decimal */
c0996660
IM
1055 if (i_mean != 0)
1056 hcrx->ccid3hcrx_p = 1000000 / i_mean;
59348b19
GR
1057 } else
1058 DCCP_BUG("empty loss history");
7c657876
ACM
1059
1060 if (hcrx->ccid3hcrx_p > p_prev) {
1061 ccid3_hc_rx_send_feedback(sk);
1062 return;
1063 }
1064}
1065
91f0ebf7 1066static int ccid3_hc_rx_init(struct ccid *ccid, struct sock *sk)
7c657876 1067{
91f0ebf7 1068 struct ccid3_hc_rx_sock *hcrx = ccid_priv(ccid);
7c657876
ACM
1069
1070 ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
1071
7c657876
ACM
1072 hcrx->ccid3hcrx_state = TFRC_RSTATE_NO_DATA;
1073 INIT_LIST_HEAD(&hcrx->ccid3hcrx_hist);
ae6706f0 1074 INIT_LIST_HEAD(&hcrx->ccid3hcrx_li_hist);
b0e56780 1075 dccp_timestamp(sk, &hcrx->ccid3hcrx_tstamp_last_ack);
954ee31f 1076 hcrx->ccid3hcrx_tstamp_last_feedback = hcrx->ccid3hcrx_tstamp_last_ack;
78ad713d 1077 hcrx->ccid3hcrx_s = 0;
954ee31f 1078 hcrx->ccid3hcrx_rtt = 5000; /* XXX 5ms for now... */
7c657876
ACM
1079 return 0;
1080}
1081
1082static void ccid3_hc_rx_exit(struct sock *sk)
1083{
59725dc2 1084 struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
7c657876 1085
59d203f9 1086 BUG_ON(hcrx == NULL);
7c657876
ACM
1087
1088 ccid3_hc_rx_set_state(sk, TFRC_RSTATE_TERM);
1089
1090 /* Empty packet history */
8c60f3fa 1091 dccp_rx_hist_purge(ccid3_rx_hist, &hcrx->ccid3hcrx_hist);
7c657876
ACM
1092
1093 /* Empty loss interval history */
ae6706f0 1094 dccp_li_hist_purge(ccid3_li_hist, &hcrx->ccid3hcrx_li_hist);
7c657876
ACM
1095}
1096
2babe1f6
ACM
1097static void ccid3_hc_rx_get_info(struct sock *sk, struct tcp_info *info)
1098{
59725dc2 1099 const struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
2babe1f6 1100
59c2353d
ACM
1101 /* Listen socks doesn't have a private CCID block */
1102 if (sk->sk_state == DCCP_LISTEN)
1103 return;
1104
59d203f9 1105 BUG_ON(hcrx == NULL);
2babe1f6
ACM
1106
1107 info->tcpi_ca_state = hcrx->ccid3hcrx_state;
1108 info->tcpi_options |= TCPI_OPT_TIMESTAMPS;
1109 info->tcpi_rcv_rtt = hcrx->ccid3hcrx_rtt;
1110}
1111
1112static void ccid3_hc_tx_get_info(struct sock *sk, struct tcp_info *info)
1113{
59725dc2 1114 const struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
2babe1f6 1115
59c2353d
ACM
1116 /* Listen socks doesn't have a private CCID block */
1117 if (sk->sk_state == DCCP_LISTEN)
1118 return;
1119
59d203f9 1120 BUG_ON(hctx == NULL);
2babe1f6
ACM
1121
1122 info->tcpi_rto = hctx->ccid3hctx_t_rto;
1123 info->tcpi_rtt = hctx->ccid3hctx_rtt;
1124}
1125
88f964db
ACM
1126static int ccid3_hc_rx_getsockopt(struct sock *sk, const int optname, int len,
1127 u32 __user *optval, int __user *optlen)
1128{
1129 const struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);
1130 const void *val;
1131
1132 /* Listen socks doesn't have a private CCID block */
1133 if (sk->sk_state == DCCP_LISTEN)
1134 return -EINVAL;
1135
1136 switch (optname) {
1137 case DCCP_SOCKOPT_CCID_RX_INFO:
1138 if (len < sizeof(hcrx->ccid3hcrx_tfrc))
1139 return -EINVAL;
1140 len = sizeof(hcrx->ccid3hcrx_tfrc);
1141 val = &hcrx->ccid3hcrx_tfrc;
1142 break;
1143 default:
1144 return -ENOPROTOOPT;
1145 }
1146
1147 if (put_user(len, optlen) || copy_to_user(optval, val, len))
1148 return -EFAULT;
1149
1150 return 0;
1151}
1152
1153static int ccid3_hc_tx_getsockopt(struct sock *sk, const int optname, int len,
1154 u32 __user *optval, int __user *optlen)
1155{
1156 const struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);
1157 const void *val;
1158
1159 /* Listen socks doesn't have a private CCID block */
1160 if (sk->sk_state == DCCP_LISTEN)
1161 return -EINVAL;
1162
1163 switch (optname) {
1164 case DCCP_SOCKOPT_CCID_TX_INFO:
1165 if (len < sizeof(hctx->ccid3hctx_tfrc))
1166 return -EINVAL;
1167 len = sizeof(hctx->ccid3hctx_tfrc);
1168 val = &hctx->ccid3hctx_tfrc;
1169 break;
1170 default:
1171 return -ENOPROTOOPT;
1172 }
1173
1174 if (put_user(len, optlen) || copy_to_user(optval, val, len))
1175 return -EFAULT;
1176
1177 return 0;
1178}
1179
91f0ebf7 1180static struct ccid_operations ccid3 = {
3dd9a7c3 1181 .ccid_id = DCCPC_CCID3,
7c657876
ACM
1182 .ccid_name = "ccid3",
1183 .ccid_owner = THIS_MODULE,
91f0ebf7 1184 .ccid_hc_tx_obj_size = sizeof(struct ccid3_hc_tx_sock),
7c657876
ACM
1185 .ccid_hc_tx_init = ccid3_hc_tx_init,
1186 .ccid_hc_tx_exit = ccid3_hc_tx_exit,
1187 .ccid_hc_tx_send_packet = ccid3_hc_tx_send_packet,
1188 .ccid_hc_tx_packet_sent = ccid3_hc_tx_packet_sent,
1189 .ccid_hc_tx_packet_recv = ccid3_hc_tx_packet_recv,
1190 .ccid_hc_tx_insert_options = ccid3_hc_tx_insert_options,
1191 .ccid_hc_tx_parse_options = ccid3_hc_tx_parse_options,
91f0ebf7 1192 .ccid_hc_rx_obj_size = sizeof(struct ccid3_hc_rx_sock),
7c657876
ACM
1193 .ccid_hc_rx_init = ccid3_hc_rx_init,
1194 .ccid_hc_rx_exit = ccid3_hc_rx_exit,
1195 .ccid_hc_rx_insert_options = ccid3_hc_rx_insert_options,
1196 .ccid_hc_rx_packet_recv = ccid3_hc_rx_packet_recv,
2babe1f6
ACM
1197 .ccid_hc_rx_get_info = ccid3_hc_rx_get_info,
1198 .ccid_hc_tx_get_info = ccid3_hc_tx_get_info,
88f964db
ACM
1199 .ccid_hc_rx_getsockopt = ccid3_hc_rx_getsockopt,
1200 .ccid_hc_tx_getsockopt = ccid3_hc_tx_getsockopt,
7c657876
ACM
1201};
1202
56724aa4 1203#ifdef CONFIG_IP_DCCP_CCID3_DEBUG
7c657876
ACM
1204module_param(ccid3_debug, int, 0444);
1205MODULE_PARM_DESC(ccid3_debug, "Enable debug messages");
56724aa4 1206#endif
7c657876
ACM
1207
1208static __init int ccid3_module_init(void)
1209{
8c60f3fa 1210 int rc = -ENOBUFS;
7c657876 1211
8c60f3fa
ACM
1212 ccid3_rx_hist = dccp_rx_hist_new("ccid3");
1213 if (ccid3_rx_hist == NULL)
7c657876
ACM
1214 goto out;
1215
8c60f3fa
ACM
1216 ccid3_tx_hist = dccp_tx_hist_new("ccid3");
1217 if (ccid3_tx_hist == NULL)
1218 goto out_free_rx;
7c657876 1219
ae6706f0
ACM
1220 ccid3_li_hist = dccp_li_hist_new("ccid3");
1221 if (ccid3_li_hist == NULL)
8c60f3fa 1222 goto out_free_tx;
7c657876
ACM
1223
1224 rc = ccid_register(&ccid3);
1225 if (rc != 0)
1226 goto out_free_loss_interval_history;
7c657876
ACM
1227out:
1228 return rc;
8c60f3fa 1229
7c657876 1230out_free_loss_interval_history:
ae6706f0
ACM
1231 dccp_li_hist_delete(ccid3_li_hist);
1232 ccid3_li_hist = NULL;
8c60f3fa
ACM
1233out_free_tx:
1234 dccp_tx_hist_delete(ccid3_tx_hist);
1235 ccid3_tx_hist = NULL;
1236out_free_rx:
1237 dccp_rx_hist_delete(ccid3_rx_hist);
1238 ccid3_rx_hist = NULL;
7c657876
ACM
1239 goto out;
1240}
1241module_init(ccid3_module_init);
1242
1243static __exit void ccid3_module_exit(void)
1244{
1245 ccid_unregister(&ccid3);
1246
8c60f3fa
ACM
1247 if (ccid3_tx_hist != NULL) {
1248 dccp_tx_hist_delete(ccid3_tx_hist);
1249 ccid3_tx_hist = NULL;
7c657876 1250 }
8c60f3fa
ACM
1251 if (ccid3_rx_hist != NULL) {
1252 dccp_rx_hist_delete(ccid3_rx_hist);
1253 ccid3_rx_hist = NULL;
7c657876 1254 }
ae6706f0
ACM
1255 if (ccid3_li_hist != NULL) {
1256 dccp_li_hist_delete(ccid3_li_hist);
1257 ccid3_li_hist = NULL;
7c657876
ACM
1258 }
1259}
1260module_exit(ccid3_module_exit);
1261
e6bccd35 1262MODULE_AUTHOR("Ian McDonald <ian.mcdonald@jandi.co.nz>, "
1f2333ae 1263 "Arnaldo Carvalho de Melo <acme@ghostprotocols.net>");
7c657876
ACM
1264MODULE_DESCRIPTION("DCCP TFRC CCID3 CCID");
1265MODULE_LICENSE("GPL");
1266MODULE_ALIAS("net-dccp-ccid-3");
This page took 0.222406 seconds and 5 git commands to generate.