Commit | Line | Data |
---|---|---|
7c657876 ACM |
1 | /* |
2 | * net/dccp/ccids/ccid3.c | |
3 | * | |
b2f41ff4 IM |
4 | * Copyright (c) 2005-7 The University of Waikato, Hamilton, New Zealand. |
5 | * Copyright (c) 2005-7 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 | */ | |
7c657876 ACM |
36 | #include "../ccid.h" |
37 | #include "../dccp.h" | |
4524b259 | 38 | #include "lib/packet_history.h" |
ae6706f0 | 39 | #include "lib/loss_interval.h" |
36729c1a | 40 | #include "lib/tfrc.h" |
7c657876 ACM |
41 | #include "ccid3.h" |
42 | ||
76fd1e87 GR |
43 | #include <asm/unaligned.h> |
44 | ||
56724aa4 GR |
45 | #ifdef CONFIG_IP_DCCP_CCID3_DEBUG |
46 | static int ccid3_debug; | |
47 | #define ccid3_pr_debug(format, a...) DCCP_PR_DEBUG(ccid3_debug, format, ##a) | |
7c657876 ACM |
48 | #else |
49 | #define ccid3_pr_debug(format, a...) | |
50 | #endif | |
51 | ||
a1d3a355 ACM |
52 | static struct dccp_tx_hist *ccid3_tx_hist; |
53 | static struct dccp_rx_hist *ccid3_rx_hist; | |
7c657876 | 54 | |
9bf17475 GR |
55 | /* |
56 | * Transmitter Half-Connection Routines | |
57 | */ | |
56724aa4 | 58 | #ifdef CONFIG_IP_DCCP_CCID3_DEBUG |
7c657876 ACM |
59 | static const char *ccid3_tx_state_name(enum ccid3_hc_tx_states state) |
60 | { | |
61 | static char *ccid3_state_names[] = { | |
62 | [TFRC_SSTATE_NO_SENT] = "NO_SENT", | |
63 | [TFRC_SSTATE_NO_FBACK] = "NO_FBACK", | |
64 | [TFRC_SSTATE_FBACK] = "FBACK", | |
65 | [TFRC_SSTATE_TERM] = "TERM", | |
66 | }; | |
67 | ||
68 | return ccid3_state_names[state]; | |
69 | } | |
70 | #endif | |
71 | ||
c25a18ba ACM |
72 | static void ccid3_hc_tx_set_state(struct sock *sk, |
73 | enum ccid3_hc_tx_states state) | |
7c657876 | 74 | { |
59725dc2 | 75 | struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk); |
7c657876 ACM |
76 | enum ccid3_hc_tx_states oldstate = hctx->ccid3hctx_state; |
77 | ||
78 | ccid3_pr_debug("%s(%p) %-8.8s -> %s\n", | |
1f2333ae ACM |
79 | dccp_role(sk), sk, ccid3_tx_state_name(oldstate), |
80 | ccid3_tx_state_name(state)); | |
7c657876 ACM |
81 | WARN_ON(state == oldstate); |
82 | hctx->ccid3hctx_state = state; | |
83 | } | |
84 | ||
a21f9f96 | 85 | /* |
6c08b2cf GR |
86 | * Compute the initial sending rate X_init in the manner of RFC 3390: |
87 | * | |
88 | * X_init = min(4 * s, max(2 * s, 4380 bytes)) / RTT | |
89 | * | |
90 | * Note that RFC 3390 uses MSS, RFC 4342 refers to RFC 3390, and rfc3448bis | |
91 | * (rev-02) clarifies the use of RFC 3390 with regard to the above formula. | |
a21f9f96 GR |
92 | * For consistency with other parts of the code, X_init is scaled by 2^6. |
93 | */ | |
94 | static inline u64 rfc3390_initial_rate(struct sock *sk) | |
95 | { | |
6c08b2cf GR |
96 | const struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk); |
97 | const __u32 w_init = min_t(__u32, 4 * hctx->ccid3hctx_s, | |
98 | max_t(__u32, 2 * hctx->ccid3hctx_s, 4380)); | |
a21f9f96 | 99 | |
6c08b2cf | 100 | return scaled_div(w_init << 6, hctx->ccid3hctx_rtt); |
a21f9f96 GR |
101 | } |
102 | ||
17893bc1 | 103 | /* |
1266adee | 104 | * Recalculate t_ipi and delta (should be called whenever X changes) |
17893bc1 | 105 | */ |
1266adee | 106 | static inline void ccid3_update_send_interval(struct ccid3_hc_tx_sock *hctx) |
7c657876 | 107 | { |
1a21e49a | 108 | /* Calculate new t_ipi = s / X_inst (X_inst is in 64 * bytes/second) */ |
b2449fdc GR |
109 | hctx->ccid3hctx_t_ipi = scaled_div32(((u64)hctx->ccid3hctx_s) << 6, |
110 | hctx->ccid3hctx_x); | |
7c657876 | 111 | |
17893bc1 | 112 | /* Calculate new delta by delta = min(t_ipi / 2, t_gran / 2) */ |
1f2333ae ACM |
113 | hctx->ccid3hctx_delta = min_t(u32, hctx->ccid3hctx_t_ipi / 2, |
114 | TFRC_OPSYS_HALF_TIME_GRAN); | |
8699be7d | 115 | |
1761f7d7 | 116 | ccid3_pr_debug("t_ipi=%u, delta=%u, s=%u, X=%u\n", |
8699be7d | 117 | hctx->ccid3hctx_t_ipi, hctx->ccid3hctx_delta, |
1761f7d7 | 118 | hctx->ccid3hctx_s, (unsigned)(hctx->ccid3hctx_x >> 6)); |
8699be7d | 119 | |
7c657876 | 120 | } |
aa97efd9 | 121 | |
a5358fdc GR |
122 | static u32 ccid3_hc_tx_idle_rtt(struct ccid3_hc_tx_sock *hctx, ktime_t now) |
123 | { | |
124 | u32 delta = ktime_us_delta(now, hctx->ccid3hctx_t_last_win_count); | |
125 | ||
126 | return delta / hctx->ccid3hctx_rtt; | |
127 | } | |
128 | ||
aa97efd9 GR |
129 | /** |
130 | * ccid3_hc_tx_update_x - Update allowed sending rate X | |
131 | * @stamp: most recent time if available - can be left NULL. | |
132 | * This function tracks draft rfc3448bis, check there for latest details. | |
5c3fbb6a | 133 | * |
1a21e49a GR |
134 | * Note: X and X_recv are both stored in units of 64 * bytes/second, to support |
135 | * fine-grained resolution of sending rates. This requires scaling by 2^6 | |
136 | * throughout the code. Only X_calc is unscaled (in bytes/second). | |
137 | * | |
1a21e49a | 138 | */ |
aa97efd9 | 139 | static void ccid3_hc_tx_update_x(struct sock *sk, ktime_t *stamp) |
a79ef76f | 140 | |
7c657876 | 141 | { |
59725dc2 | 142 | struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk); |
0c150efb | 143 | __u64 min_rate = 2 * hctx->ccid3hctx_x_recv; |
1a21e49a | 144 | const __u64 old_x = hctx->ccid3hctx_x; |
aa97efd9 | 145 | ktime_t now = stamp? *stamp : ktime_get_real(); |
7c657876 | 146 | |
0c150efb GR |
147 | /* |
148 | * Handle IDLE periods: do not reduce below RFC3390 initial sending rate | |
a5358fdc GR |
149 | * when idling [RFC 4342, 5.1]. Definition of idling is from rfc3448bis: |
150 | * a sender is idle if it has not sent anything over a 2-RTT-period. | |
0c150efb GR |
151 | * For consistency with X and X_recv, min_rate is also scaled by 2^6. |
152 | */ | |
a5358fdc | 153 | if (ccid3_hc_tx_idle_rtt(hctx, now) >= 2) { |
0c150efb GR |
154 | min_rate = rfc3390_initial_rate(sk); |
155 | min_rate = max(min_rate, 2 * hctx->ccid3hctx_x_recv); | |
156 | } | |
157 | ||
44158306 | 158 | if (hctx->ccid3hctx_p > 0) { |
1a21e49a | 159 | |
9e8efc82 | 160 | hctx->ccid3hctx_x = min(((__u64)hctx->ccid3hctx_x_calc) << 6, |
0c150efb | 161 | min_rate); |
9e8efc82 GR |
162 | hctx->ccid3hctx_x = max(hctx->ccid3hctx_x, |
163 | (((__u64)hctx->ccid3hctx_s) << 6) / | |
8109b02b | 164 | TFRC_T_MBI); |
a79ef76f | 165 | |
aa97efd9 GR |
166 | } else if (ktime_us_delta(now, hctx->ccid3hctx_t_ld) |
167 | - (s64)hctx->ccid3hctx_rtt >= 0) { | |
ac198ea8 | 168 | |
aa97efd9 GR |
169 | hctx->ccid3hctx_x = |
170 | max(min(2 * hctx->ccid3hctx_x, min_rate), | |
171 | scaled_div(((__u64)hctx->ccid3hctx_s) << 6, | |
172 | hctx->ccid3hctx_rtt)); | |
173 | hctx->ccid3hctx_t_ld = now; | |
ff586298 | 174 | } |
b6ee3d4a | 175 | |
8699be7d | 176 | if (hctx->ccid3hctx_x != old_x) { |
1761f7d7 GR |
177 | ccid3_pr_debug("X_prev=%u, X_now=%u, X_calc=%u, " |
178 | "X_recv=%u\n", (unsigned)(old_x >> 6), | |
179 | (unsigned)(hctx->ccid3hctx_x >> 6), | |
180 | hctx->ccid3hctx_x_calc, | |
181 | (unsigned)(hctx->ccid3hctx_x_recv >> 6)); | |
8699be7d | 182 | |
1266adee | 183 | ccid3_update_send_interval(hctx); |
8699be7d | 184 | } |
7c657876 ACM |
185 | } |
186 | ||
78ad713d | 187 | /* |
8109b02b ACM |
188 | * Track the mean packet size `s' (cf. RFC 4342, 5.3 and RFC 3448, 4.1) |
189 | * @len: DCCP packet payload size in bytes | |
78ad713d GR |
190 | */ |
191 | static inline void ccid3_hc_tx_update_s(struct ccid3_hc_tx_sock *hctx, int len) | |
192 | { | |
1266adee GR |
193 | const u16 old_s = hctx->ccid3hctx_s; |
194 | ||
195 | hctx->ccid3hctx_s = old_s == 0 ? len : (9 * old_s + len) / 10; | |
196 | ||
197 | if (hctx->ccid3hctx_s != old_s) | |
198 | ccid3_update_send_interval(hctx); | |
78ad713d GR |
199 | } |
200 | ||
9f8681db | 201 | /* |
8109b02b ACM |
202 | * Update Window Counter using the algorithm from [RFC 4342, 8.1]. |
203 | * The algorithm is not applicable if RTT < 4 microseconds. | |
9f8681db GR |
204 | */ |
205 | static inline void ccid3_hc_tx_update_win_count(struct ccid3_hc_tx_sock *hctx, | |
8132da4d | 206 | ktime_t now) |
9f8681db | 207 | { |
9f8681db GR |
208 | u32 quarter_rtts; |
209 | ||
210 | if (unlikely(hctx->ccid3hctx_rtt < 4)) /* avoid divide-by-zero */ | |
211 | return; | |
212 | ||
8132da4d GR |
213 | quarter_rtts = ktime_us_delta(now, hctx->ccid3hctx_t_last_win_count); |
214 | quarter_rtts /= hctx->ccid3hctx_rtt / 4; | |
9f8681db GR |
215 | |
216 | if (quarter_rtts > 0) { | |
8132da4d | 217 | hctx->ccid3hctx_t_last_win_count = now; |
9f8681db GR |
218 | hctx->ccid3hctx_last_win_count += min_t(u32, quarter_rtts, 5); |
219 | hctx->ccid3hctx_last_win_count &= 0xF; /* mod 16 */ | |
9f8681db GR |
220 | } |
221 | } | |
222 | ||
7c657876 ACM |
223 | static void ccid3_hc_tx_no_feedback_timer(unsigned long data) |
224 | { | |
225 | struct sock *sk = (struct sock *)data; | |
59725dc2 | 226 | struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk); |
2a1fda6f | 227 | unsigned long t_nfb = USEC_PER_SEC / 5; |
7c657876 ACM |
228 | |
229 | bh_lock_sock(sk); | |
230 | if (sock_owned_by_user(sk)) { | |
231 | /* Try again later. */ | |
232 | /* XXX: set some sensible MIB */ | |
48e03eee | 233 | goto restart_timer; |
7c657876 ACM |
234 | } |
235 | ||
a9672411 | 236 | ccid3_pr_debug("%s(%p, state=%s) - entry \n", dccp_role(sk), sk, |
7c657876 | 237 | ccid3_tx_state_name(hctx->ccid3hctx_state)); |
a9672411 | 238 | |
7c657876 | 239 | switch (hctx->ccid3hctx_state) { |
7c657876 | 240 | case TFRC_SSTATE_NO_FBACK: |
a79ef76f | 241 | /* RFC 3448, 4.4: Halve send rate directly */ |
9e8efc82 GR |
242 | hctx->ccid3hctx_x = max(hctx->ccid3hctx_x / 2, |
243 | (((__u64)hctx->ccid3hctx_s) << 6) / | |
244 | TFRC_T_MBI); | |
7c657876 | 245 | |
a9672411 GR |
246 | ccid3_pr_debug("%s(%p, state=%s), updated tx rate to %u " |
247 | "bytes/s\n", dccp_role(sk), sk, | |
1f2333ae | 248 | ccid3_tx_state_name(hctx->ccid3hctx_state), |
1a21e49a | 249 | (unsigned)(hctx->ccid3hctx_x >> 6)); |
48e03eee | 250 | /* The value of R is still undefined and so we can not recompute |
5e8e034c | 251 | * the timeout value. Keep initial value as per [RFC 4342, 5]. */ |
2a1fda6f | 252 | t_nfb = TFRC_INITIAL_TIMEOUT; |
1266adee | 253 | ccid3_update_send_interval(hctx); |
7c657876 ACM |
254 | break; |
255 | case TFRC_SSTATE_FBACK: | |
1f2333ae | 256 | /* |
0c150efb GR |
257 | * Modify the cached value of X_recv [RFC 3448, 4.4] |
258 | * | |
259 | * If (p == 0 || X_calc > 2 * X_recv) | |
260 | * X_recv = max(X_recv / 2, s / (2 * t_mbi)); | |
261 | * Else | |
262 | * X_recv = X_calc / 4; | |
263 | * | |
264 | * Note that X_recv is scaled by 2^6 while X_calc is not | |
1f2333ae | 265 | */ |
0c150efb GR |
266 | BUG_ON(hctx->ccid3hctx_p && !hctx->ccid3hctx_x_calc); |
267 | ||
268 | if (hctx->ccid3hctx_p == 0 || | |
269 | (hctx->ccid3hctx_x_calc > (hctx->ccid3hctx_x_recv >> 5))) { | |
270 | ||
271 | hctx->ccid3hctx_x_recv = | |
272 | max(hctx->ccid3hctx_x_recv / 2, | |
273 | (((__u64)hctx->ccid3hctx_s) << 6) / | |
274 | (2 * TFRC_T_MBI)); | |
0c150efb GR |
275 | } else { |
276 | hctx->ccid3hctx_x_recv = hctx->ccid3hctx_x_calc; | |
277 | hctx->ccid3hctx_x_recv <<= 4; | |
7c657876 | 278 | } |
0c150efb | 279 | /* Now recalculate X [RFC 3448, 4.3, step (4)] */ |
aa97efd9 | 280 | ccid3_hc_tx_update_x(sk, NULL); |
6b5e633a ACM |
281 | /* |
282 | * Schedule no feedback timer to expire in | |
8a508ac2 GR |
283 | * max(t_RTO, 2 * s/X) = max(t_RTO, 2 * t_ipi) |
284 | * See comments in packet_recv() regarding the value of t_RTO. | |
6b5e633a | 285 | */ |
8a508ac2 | 286 | t_nfb = max(hctx->ccid3hctx_t_rto, 2 * hctx->ccid3hctx_t_ipi); |
7c657876 | 287 | break; |
59348b19 | 288 | case TFRC_SSTATE_NO_SENT: |
a9672411 | 289 | DCCP_BUG("%s(%p) - Illegal state NO_SENT", dccp_role(sk), sk); |
59348b19 GR |
290 | /* fall through */ |
291 | case TFRC_SSTATE_TERM: | |
7c657876 ACM |
292 | goto out; |
293 | } | |
294 | ||
48e03eee GR |
295 | restart_timer: |
296 | sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer, | |
c9eaf173 | 297 | jiffies + usecs_to_jiffies(t_nfb)); |
7c657876 ACM |
298 | out: |
299 | bh_unlock_sock(sk); | |
300 | sock_put(sk); | |
301 | } | |
302 | ||
7da7f456 GR |
303 | /* |
304 | * returns | |
305 | * > 0: delay (in msecs) that should pass before actually sending | |
306 | * = 0: can send immediately | |
307 | * < 0: error condition; do not send packet | |
308 | */ | |
6b57c93d | 309 | static int ccid3_hc_tx_send_packet(struct sock *sk, struct sk_buff *skb) |
7c657876 ACM |
310 | { |
311 | struct dccp_sock *dp = dccp_sk(sk); | |
59725dc2 | 312 | struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk); |
8132da4d GR |
313 | ktime_t now = ktime_get_real(); |
314 | s64 delay; | |
7c657876 | 315 | |
7c657876 | 316 | /* |
da335baf GR |
317 | * This function is called only for Data and DataAck packets. Sending |
318 | * zero-sized Data(Ack)s is theoretically possible, but for congestion | |
319 | * control this case is pathological - ignore it. | |
7c657876 | 320 | */ |
6b57c93d | 321 | if (unlikely(skb->len == 0)) |
da335baf | 322 | return -EBADMSG; |
7c657876 | 323 | |
7c657876 ACM |
324 | switch (hctx->ccid3hctx_state) { |
325 | case TFRC_SSTATE_NO_SENT: | |
1f2333ae | 326 | sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer, |
8109b02b | 327 | (jiffies + |
c9eaf173 | 328 | usecs_to_jiffies(TFRC_INITIAL_TIMEOUT))); |
7c657876 ACM |
329 | hctx->ccid3hctx_last_win_count = 0; |
330 | hctx->ccid3hctx_t_last_win_count = now; | |
90feeb95 GR |
331 | |
332 | /* Set t_0 for initial packet */ | |
7c657876 | 333 | hctx->ccid3hctx_t_nom = now; |
30833ffe GR |
334 | |
335 | hctx->ccid3hctx_s = skb->len; | |
336 | ||
337 | /* | |
338 | * Use initial RTT sample when available: recommended by erratum | |
339 | * to RFC 4342. This implements the initialisation procedure of | |
340 | * draft rfc3448bis, section 4.2. Remember, X is scaled by 2^6. | |
341 | */ | |
342 | if (dp->dccps_syn_rtt) { | |
343 | ccid3_pr_debug("SYN RTT = %uus\n", dp->dccps_syn_rtt); | |
344 | hctx->ccid3hctx_rtt = dp->dccps_syn_rtt; | |
345 | hctx->ccid3hctx_x = rfc3390_initial_rate(sk); | |
23f062af | 346 | hctx->ccid3hctx_t_ld = now; |
30833ffe | 347 | } else { |
6c08b2cf GR |
348 | /* Sender does not have RTT sample: X_pps = 1 pkt/sec */ |
349 | hctx->ccid3hctx_x = hctx->ccid3hctx_s; | |
30833ffe GR |
350 | hctx->ccid3hctx_x <<= 6; |
351 | } | |
352 | ccid3_update_send_interval(hctx); | |
353 | ||
354 | ccid3_hc_tx_set_state(sk, TFRC_SSTATE_NO_FBACK); | |
7c657876 ACM |
355 | break; |
356 | case TFRC_SSTATE_NO_FBACK: | |
357 | case TFRC_SSTATE_FBACK: | |
8132da4d | 358 | delay = ktime_us_delta(hctx->ccid3hctx_t_nom, now); |
8699be7d | 359 | ccid3_pr_debug("delay=%ld\n", (long)delay); |
91cf5a17 | 360 | /* |
8109b02b | 361 | * Scheduling of packet transmissions [RFC 3448, 4.6] |
91cf5a17 GR |
362 | * |
363 | * if (t_now > t_nom - delta) | |
364 | * // send the packet now | |
365 | * else | |
366 | * // send the packet in (t_nom - t_now) milliseconds. | |
367 | */ | |
49d66a70 | 368 | if (delay - (s64)hctx->ccid3hctx_delta >= 1000) |
8132da4d | 369 | return (u32)delay / 1000L; |
9f8681db | 370 | |
8132da4d | 371 | ccid3_hc_tx_update_win_count(hctx, now); |
7c657876 | 372 | break; |
59348b19 | 373 | case TFRC_SSTATE_TERM: |
a9672411 | 374 | DCCP_BUG("%s(%p) - Illegal state TERM", dccp_role(sk), sk); |
7da7f456 | 375 | return -EINVAL; |
7c657876 ACM |
376 | } |
377 | ||
7da7f456 GR |
378 | /* prepare to send now (add options etc.) */ |
379 | dp->dccps_hc_tx_insert_options = 1; | |
e312d100 GR |
380 | DCCP_SKB_CB(skb)->dccpd_ccval = hctx->ccid3hctx_last_win_count; |
381 | ||
382 | /* set the nominal send time for the next following packet */ | |
8132da4d GR |
383 | hctx->ccid3hctx_t_nom = ktime_add_us(hctx->ccid3hctx_t_nom, |
384 | hctx->ccid3hctx_t_ipi); | |
7da7f456 | 385 | return 0; |
7c657876 ACM |
386 | } |
387 | ||
8109b02b ACM |
388 | static void ccid3_hc_tx_packet_sent(struct sock *sk, int more, |
389 | unsigned int len) | |
7c657876 | 390 | { |
59725dc2 | 391 | struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk); |
6b57c93d | 392 | struct dccp_tx_hist_entry *packet; |
7c657876 | 393 | |
6b57c93d | 394 | ccid3_hc_tx_update_s(hctx, len); |
7c657876 | 395 | |
c5a1ae9a | 396 | packet = dccp_tx_hist_entry_new(ccid3_tx_hist, GFP_ATOMIC); |
6b57c93d | 397 | if (unlikely(packet == NULL)) { |
c5a1ae9a | 398 | DCCP_CRIT("packet history - out of memory!"); |
6b57c93d GR |
399 | return; |
400 | } | |
c5a1ae9a GR |
401 | dccp_tx_hist_add_entry(&hctx->ccid3hctx_hist, packet); |
402 | ||
0740d49c | 403 | packet->dccphtx_tstamp = ktime_get_real(); |
c5a1ae9a GR |
404 | packet->dccphtx_seqno = dccp_sk(sk)->dccps_gss; |
405 | packet->dccphtx_rtt = hctx->ccid3hctx_rtt; | |
406 | packet->dccphtx_sent = 1; | |
7c657876 ACM |
407 | } |
408 | ||
409 | static void ccid3_hc_tx_packet_recv(struct sock *sk, struct sk_buff *skb) | |
410 | { | |
59725dc2 | 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; |
0740d49c | 414 | ktime_t now; |
2a1fda6f | 415 | unsigned long t_nfb; |
7dfee1a9 | 416 | u32 pinv, r_sample; |
1f2333ae | 417 | |
7c657876 ACM |
418 | /* we are only interested in ACKs */ |
419 | if (!(DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_ACK || | |
420 | DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_DATAACK)) | |
421 | return; | |
422 | ||
423 | opt_recv = &hctx->ccid3hctx_options_received; | |
424 | ||
7c657876 | 425 | switch (hctx->ccid3hctx_state) { |
7c657876 ACM |
426 | case TFRC_SSTATE_NO_FBACK: |
427 | case TFRC_SSTATE_FBACK: | |
5c3fbb6a | 428 | /* get packet from history to look up t_recvdata */ |
8c60f3fa | 429 | packet = dccp_tx_hist_find_entry(&hctx->ccid3hctx_hist, |
8109b02b | 430 | DCCP_SKB_CB(skb)->dccpd_ack_seq); |
59d203f9 | 431 | if (unlikely(packet == NULL)) { |
5c3fbb6a | 432 | DCCP_WARN("%s(%p), seqno %llu(%s) doesn't exist " |
59348b19 | 433 | "in history!\n", dccp_role(sk), sk, |
59d203f9 | 434 | (unsigned long long)DCCP_SKB_CB(skb)->dccpd_ack_seq, |
8109b02b | 435 | dccp_packet_name(DCCP_SKB_CB(skb)->dccpd_type)); |
7c657876 ACM |
436 | return; |
437 | } | |
438 | ||
1a21e49a | 439 | /* Update receive rate in units of 64 * bytes/second */ |
9e8efc82 GR |
440 | hctx->ccid3hctx_x_recv = opt_recv->ccid3or_receive_rate; |
441 | hctx->ccid3hctx_x_recv <<= 6; | |
5c3fbb6a GR |
442 | |
443 | /* Update loss event rate */ | |
444 | pinv = opt_recv->ccid3or_loss_event_rate; | |
45393a66 | 445 | if (pinv == ~0U || pinv == 0) /* see RFC 4342, 8.5 */ |
5c3fbb6a | 446 | hctx->ccid3hctx_p = 0; |
45393a66 | 447 | else /* can not exceed 100% */ |
8109b02b | 448 | hctx->ccid3hctx_p = 1000000 / pinv; |
5c3fbb6a | 449 | |
9823b7b5 | 450 | now = ktime_get_real(); |
5c3fbb6a GR |
451 | /* |
452 | * Calculate new round trip sample as per [RFC 3448, 4.3] by | |
8109b02b | 453 | * R_sample = (now - t_recvdata) - t_elapsed |
5c3fbb6a | 454 | */ |
3393da82 | 455 | r_sample = dccp_sample_rtt(sk, ktime_us_delta(now, packet->dccphtx_tstamp)); |
5c3fbb6a | 456 | |
7dfee1a9 GR |
457 | /* |
458 | * Update RTT estimate by | |
7c657876 ACM |
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) { | |
1a21e49a GR |
467 | /* |
468 | * Larger Initial Windows [RFC 4342, sec. 5] | |
1a21e49a | 469 | */ |
a79ef76f | 470 | hctx->ccid3hctx_rtt = r_sample; |
a21f9f96 | 471 | hctx->ccid3hctx_x = rfc3390_initial_rate(sk); |
9823b7b5 | 472 | hctx->ccid3hctx_t_ld = now; |
a79ef76f | 473 | |
1266adee | 474 | ccid3_update_send_interval(hctx); |
7c657876 | 475 | |
a21f9f96 | 476 | ccid3_pr_debug("%s(%p), s=%u, MSS=%u, " |
7dfee1a9 | 477 | "R_sample=%uus, X=%u\n", dccp_role(sk), |
0f08461e | 478 | sk, hctx->ccid3hctx_s, |
1b07a95a | 479 | dccp_sk(sk)->dccps_mss_cache, r_sample, |
1a21e49a | 480 | (unsigned)(hctx->ccid3hctx_x >> 6)); |
7c657876 | 481 | |
5c3fbb6a GR |
482 | ccid3_hc_tx_set_state(sk, TFRC_SSTATE_FBACK); |
483 | } else { | |
484 | hctx->ccid3hctx_rtt = (9 * hctx->ccid3hctx_rtt + | |
7dfee1a9 | 485 | r_sample) / 10; |
7c657876 | 486 | |
ff586298 GR |
487 | /* Update sending rate (step 4 of [RFC 3448, 4.3]) */ |
488 | if (hctx->ccid3hctx_p > 0) | |
489 | hctx->ccid3hctx_x_calc = | |
490 | tfrc_calc_x(hctx->ccid3hctx_s, | |
491 | hctx->ccid3hctx_rtt, | |
492 | hctx->ccid3hctx_p); | |
aa97efd9 | 493 | ccid3_hc_tx_update_x(sk, &now); |
7c657876 | 494 | |
7dfee1a9 | 495 | ccid3_pr_debug("%s(%p), RTT=%uus (sample=%uus), s=%u, " |
8109b02b ACM |
496 | "p=%u, X_calc=%u, X_recv=%u, X=%u\n", |
497 | dccp_role(sk), | |
7dfee1a9 | 498 | sk, hctx->ccid3hctx_rtt, r_sample, |
5c3fbb6a GR |
499 | hctx->ccid3hctx_s, hctx->ccid3hctx_p, |
500 | hctx->ccid3hctx_x_calc, | |
9e8efc82 | 501 | (unsigned)(hctx->ccid3hctx_x_recv >> 6), |
8109b02b | 502 | (unsigned)(hctx->ccid3hctx_x >> 6)); |
7c657876 ACM |
503 | } |
504 | ||
505 | /* unschedule no feedback timer */ | |
506 | sk_stop_timer(sk, &hctx->ccid3hctx_no_feedback_timer); | |
507 | ||
7c657876 | 508 | /* remove all packets older than the one acked from history */ |
8c60f3fa ACM |
509 | dccp_tx_hist_purge_older(ccid3_tx_hist, |
510 | &hctx->ccid3hctx_hist, packet); | |
c530cfb1 | 511 | /* |
8109b02b ACM |
512 | * As we have calculated new ipi, delta, t_nom it is possible |
513 | * that we now can send a packet, so wake up dccp_wait_for_ccid | |
c530cfb1 ACM |
514 | */ |
515 | sk->sk_write_space(sk); | |
8c60f3fa | 516 | |
8a508ac2 GR |
517 | /* |
518 | * Update timeout interval for the nofeedback timer. | |
519 | * We use a configuration option to increase the lower bound. | |
8109b02b ACM |
520 | * This can help avoid triggering the nofeedback timer too |
521 | * often ('spinning') on LANs with small RTTs. | |
8a508ac2 | 522 | */ |
5d0dbc4a | 523 | hctx->ccid3hctx_t_rto = max_t(u32, 4 * hctx->ccid3hctx_rtt, |
8a508ac2 | 524 | CONFIG_IP_DCCP_CCID3_RTO * |
8109b02b | 525 | (USEC_PER_SEC/1000)); |
1f2333ae ACM |
526 | /* |
527 | * Schedule no feedback timer to expire in | |
8a508ac2 | 528 | * max(t_RTO, 2 * s/X) = max(t_RTO, 2 * t_ipi) |
1f2333ae | 529 | */ |
8a508ac2 | 530 | t_nfb = max(hctx->ccid3hctx_t_rto, 2 * hctx->ccid3hctx_t_ipi); |
7c657876 | 531 | |
a9672411 | 532 | ccid3_pr_debug("%s(%p), Scheduled no feedback timer to " |
8109b02b ACM |
533 | "expire in %lu jiffies (%luus)\n", |
534 | dccp_role(sk), | |
a9672411 GR |
535 | sk, usecs_to_jiffies(t_nfb), t_nfb); |
536 | ||
537 | sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer, | |
2a1fda6f | 538 | jiffies + usecs_to_jiffies(t_nfb)); |
7c657876 | 539 | break; |
151a9931 | 540 | case TFRC_SSTATE_NO_SENT: /* fall through */ |
5e19e3fc | 541 | case TFRC_SSTATE_TERM: /* ignore feedback when closing */ |
7c657876 ACM |
542 | break; |
543 | } | |
544 | } | |
545 | ||
7c657876 | 546 | static int ccid3_hc_tx_parse_options(struct sock *sk, unsigned char option, |
1f2333ae ACM |
547 | unsigned char len, u16 idx, |
548 | unsigned char *value) | |
7c657876 ACM |
549 | { |
550 | int rc = 0; | |
59725dc2 ACM |
551 | const struct dccp_sock *dp = dccp_sk(sk); |
552 | struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk); | |
7c657876 | 553 | struct ccid3_options_received *opt_recv; |
76fd1e87 | 554 | __be32 opt_val; |
7c657876 | 555 | |
7c657876 ACM |
556 | opt_recv = &hctx->ccid3hctx_options_received; |
557 | ||
558 | if (opt_recv->ccid3or_seqno != dp->dccps_gsr) { | |
559 | opt_recv->ccid3or_seqno = dp->dccps_gsr; | |
560 | opt_recv->ccid3or_loss_event_rate = ~0; | |
561 | opt_recv->ccid3or_loss_intervals_idx = 0; | |
562 | opt_recv->ccid3or_loss_intervals_len = 0; | |
563 | opt_recv->ccid3or_receive_rate = 0; | |
564 | } | |
565 | ||
566 | switch (option) { | |
567 | case TFRC_OPT_LOSS_EVENT_RATE: | |
59d203f9 | 568 | if (unlikely(len != 4)) { |
a9672411 | 569 | DCCP_WARN("%s(%p), invalid len %d " |
59348b19 GR |
570 | "for TFRC_OPT_LOSS_EVENT_RATE\n", |
571 | dccp_role(sk), sk, len); | |
7c657876 ACM |
572 | rc = -EINVAL; |
573 | } else { | |
76fd1e87 GR |
574 | opt_val = get_unaligned((__be32 *)value); |
575 | opt_recv->ccid3or_loss_event_rate = ntohl(opt_val); | |
a9672411 | 576 | ccid3_pr_debug("%s(%p), LOSS_EVENT_RATE=%u\n", |
7c657876 ACM |
577 | dccp_role(sk), sk, |
578 | opt_recv->ccid3or_loss_event_rate); | |
579 | } | |
580 | break; | |
581 | case TFRC_OPT_LOSS_INTERVALS: | |
582 | opt_recv->ccid3or_loss_intervals_idx = idx; | |
583 | opt_recv->ccid3or_loss_intervals_len = len; | |
a9672411 | 584 | ccid3_pr_debug("%s(%p), LOSS_INTERVALS=(%u, %u)\n", |
7c657876 ACM |
585 | dccp_role(sk), sk, |
586 | opt_recv->ccid3or_loss_intervals_idx, | |
587 | opt_recv->ccid3or_loss_intervals_len); | |
588 | break; | |
589 | case TFRC_OPT_RECEIVE_RATE: | |
59d203f9 | 590 | if (unlikely(len != 4)) { |
a9672411 | 591 | DCCP_WARN("%s(%p), invalid len %d " |
59348b19 GR |
592 | "for TFRC_OPT_RECEIVE_RATE\n", |
593 | dccp_role(sk), sk, len); | |
7c657876 ACM |
594 | rc = -EINVAL; |
595 | } else { | |
76fd1e87 GR |
596 | opt_val = get_unaligned((__be32 *)value); |
597 | opt_recv->ccid3or_receive_rate = ntohl(opt_val); | |
a9672411 | 598 | ccid3_pr_debug("%s(%p), RECEIVE_RATE=%u\n", |
7c657876 ACM |
599 | dccp_role(sk), sk, |
600 | opt_recv->ccid3or_receive_rate); | |
601 | } | |
602 | break; | |
603 | } | |
604 | ||
605 | return rc; | |
606 | } | |
607 | ||
91f0ebf7 | 608 | static int ccid3_hc_tx_init(struct ccid *ccid, struct sock *sk) |
7c657876 | 609 | { |
91f0ebf7 | 610 | struct ccid3_hc_tx_sock *hctx = ccid_priv(ccid); |
7c657876 | 611 | |
7c657876 ACM |
612 | hctx->ccid3hctx_state = TFRC_SSTATE_NO_SENT; |
613 | INIT_LIST_HEAD(&hctx->ccid3hctx_hist); | |
b24b8a24 PE |
614 | setup_timer(&hctx->ccid3hctx_no_feedback_timer, |
615 | ccid3_hc_tx_no_feedback_timer, (unsigned long)sk); | |
7c657876 ACM |
616 | |
617 | return 0; | |
618 | } | |
619 | ||
620 | static 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 | ccid3_hc_tx_set_state(sk, TFRC_SSTATE_TERM); |
625 | sk_stop_timer(sk, &hctx->ccid3hctx_no_feedback_timer); | |
626 | ||
627 | /* Empty packet history */ | |
8c60f3fa | 628 | dccp_tx_hist_purge(ccid3_tx_hist, &hctx->ccid3hctx_hist); |
7c657876 ACM |
629 | } |
630 | ||
9bf17475 GR |
631 | static void ccid3_hc_tx_get_info(struct sock *sk, struct tcp_info *info) |
632 | { | |
2e86908f | 633 | struct ccid3_hc_tx_sock *hctx; |
9bf17475 GR |
634 | |
635 | /* Listen socks doesn't have a private CCID block */ | |
636 | if (sk->sk_state == DCCP_LISTEN) | |
637 | return; | |
638 | ||
2e86908f | 639 | hctx = ccid3_hc_tx_sk(sk); |
9bf17475 GR |
640 | info->tcpi_rto = hctx->ccid3hctx_t_rto; |
641 | info->tcpi_rtt = hctx->ccid3hctx_rtt; | |
642 | } | |
643 | ||
644 | static int ccid3_hc_tx_getsockopt(struct sock *sk, const int optname, int len, | |
645 | u32 __user *optval, int __user *optlen) | |
646 | { | |
2e86908f | 647 | const struct ccid3_hc_tx_sock *hctx; |
9bf17475 GR |
648 | const void *val; |
649 | ||
650 | /* Listen socks doesn't have a private CCID block */ | |
651 | if (sk->sk_state == DCCP_LISTEN) | |
652 | return -EINVAL; | |
653 | ||
2e86908f | 654 | hctx = ccid3_hc_tx_sk(sk); |
9bf17475 GR |
655 | switch (optname) { |
656 | case DCCP_SOCKOPT_CCID_TX_INFO: | |
657 | if (len < sizeof(hctx->ccid3hctx_tfrc)) | |
658 | return -EINVAL; | |
659 | len = sizeof(hctx->ccid3hctx_tfrc); | |
660 | val = &hctx->ccid3hctx_tfrc; | |
661 | break; | |
662 | default: | |
663 | return -ENOPROTOOPT; | |
664 | } | |
665 | ||
666 | if (put_user(len, optlen) || copy_to_user(optval, val, len)) | |
667 | return -EFAULT; | |
668 | ||
669 | return 0; | |
670 | } | |
671 | ||
7c657876 | 672 | /* |
9bf17475 | 673 | * Receiver Half-Connection Routines |
7c657876 | 674 | */ |
56724aa4 | 675 | #ifdef CONFIG_IP_DCCP_CCID3_DEBUG |
7c657876 ACM |
676 | static const char *ccid3_rx_state_name(enum ccid3_hc_rx_states state) |
677 | { | |
678 | static char *ccid3_rx_state_names[] = { | |
679 | [TFRC_RSTATE_NO_DATA] = "NO_DATA", | |
680 | [TFRC_RSTATE_DATA] = "DATA", | |
681 | [TFRC_RSTATE_TERM] = "TERM", | |
682 | }; | |
683 | ||
684 | return ccid3_rx_state_names[state]; | |
685 | } | |
686 | #endif | |
687 | ||
c25a18ba ACM |
688 | static void ccid3_hc_rx_set_state(struct sock *sk, |
689 | enum ccid3_hc_rx_states state) | |
7c657876 | 690 | { |
59725dc2 | 691 | struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk); |
7c657876 ACM |
692 | enum ccid3_hc_rx_states oldstate = hcrx->ccid3hcrx_state; |
693 | ||
694 | ccid3_pr_debug("%s(%p) %-8.8s -> %s\n", | |
1f2333ae ACM |
695 | dccp_role(sk), sk, ccid3_rx_state_name(oldstate), |
696 | ccid3_rx_state_name(state)); | |
7c657876 ACM |
697 | WARN_ON(state == oldstate); |
698 | hcrx->ccid3hcrx_state = state; | |
699 | } | |
700 | ||
78ad713d GR |
701 | static inline void ccid3_hc_rx_update_s(struct ccid3_hc_rx_sock *hcrx, int len) |
702 | { | |
703 | if (unlikely(len == 0)) /* don't update on empty packets (e.g. ACKs) */ | |
704 | ccid3_pr_debug("Packet payload length is 0 - not updating\n"); | |
705 | else | |
706 | hcrx->ccid3hcrx_s = hcrx->ccid3hcrx_s == 0 ? len : | |
707 | (9 * hcrx->ccid3hcrx_s + len) / 10; | |
708 | } | |
709 | ||
7c657876 ACM |
710 | static void ccid3_hc_rx_send_feedback(struct sock *sk) |
711 | { | |
59725dc2 | 712 | struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk); |
7c657876 | 713 | struct dccp_sock *dp = dccp_sk(sk); |
8c60f3fa | 714 | struct dccp_rx_hist_entry *packet; |
e7c23357 | 715 | ktime_t now; |
0f9e5b57 | 716 | suseconds_t delta; |
7c657876 | 717 | |
a9672411 | 718 | ccid3_pr_debug("%s(%p) - entry \n", dccp_role(sk), sk); |
7c657876 | 719 | |
e7a81c6d | 720 | now = ktime_get_real(); |
b6ee3d4a | 721 | |
7c657876 ACM |
722 | switch (hcrx->ccid3hcrx_state) { |
723 | case TFRC_RSTATE_NO_DATA: | |
724 | hcrx->ccid3hcrx_x_recv = 0; | |
725 | break; | |
0f9e5b57 | 726 | case TFRC_RSTATE_DATA: |
e7a81c6d ACM |
727 | delta = ktime_us_delta(now, |
728 | hcrx->ccid3hcrx_tstamp_last_feedback); | |
0f9e5b57 | 729 | DCCP_BUG_ON(delta < 0); |
b9039a2a GR |
730 | hcrx->ccid3hcrx_x_recv = |
731 | scaled_div32(hcrx->ccid3hcrx_bytes_recv, delta); | |
7c657876 | 732 | break; |
59348b19 | 733 | case TFRC_RSTATE_TERM: |
a9672411 | 734 | DCCP_BUG("%s(%p) - Illegal state TERM", dccp_role(sk), sk); |
7c657876 ACM |
735 | return; |
736 | } | |
737 | ||
8c60f3fa | 738 | packet = dccp_rx_hist_find_data_packet(&hcrx->ccid3hcrx_hist); |
59d203f9 | 739 | if (unlikely(packet == NULL)) { |
a9672411 | 740 | DCCP_WARN("%s(%p), no data packet in history!\n", |
59348b19 | 741 | dccp_role(sk), sk); |
7c657876 ACM |
742 | return; |
743 | } | |
744 | ||
b6ee3d4a | 745 | hcrx->ccid3hcrx_tstamp_last_feedback = now; |
66a377c5 | 746 | hcrx->ccid3hcrx_ccval_last_counter = packet->dccphrx_ccval; |
7c657876 ACM |
747 | hcrx->ccid3hcrx_bytes_recv = 0; |
748 | ||
7c657876 | 749 | if (hcrx->ccid3hcrx_p == 0) |
45393a66 GR |
750 | hcrx->ccid3hcrx_pinv = ~0U; /* see RFC 4342, 8.5 */ |
751 | else if (hcrx->ccid3hcrx_p > 1000000) { | |
752 | DCCP_WARN("p (%u) > 100%%\n", hcrx->ccid3hcrx_p); | |
753 | hcrx->ccid3hcrx_pinv = 1; /* use 100% in this case */ | |
754 | } else | |
7c657876 | 755 | hcrx->ccid3hcrx_pinv = 1000000 / hcrx->ccid3hcrx_p; |
45393a66 | 756 | |
507d37cf | 757 | dp->dccps_hc_rx_insert_options = 1; |
7c657876 ACM |
758 | dccp_send_ack(sk); |
759 | } | |
760 | ||
2d0817d1 | 761 | static int ccid3_hc_rx_insert_options(struct sock *sk, struct sk_buff *skb) |
7c657876 | 762 | { |
2e86908f | 763 | const struct ccid3_hc_rx_sock *hcrx; |
60fe62e7 | 764 | __be32 x_recv, pinv; |
7c657876 | 765 | |
59d203f9 | 766 | if (!(sk->sk_state == DCCP_OPEN || sk->sk_state == DCCP_PARTOPEN)) |
2d0817d1 | 767 | return 0; |
7c657876 | 768 | |
2e86908f | 769 | hcrx = ccid3_hc_rx_sk(sk); |
66a377c5 | 770 | DCCP_SKB_CB(skb)->dccpd_ccval = hcrx->ccid3hcrx_ccval_last_counter; |
4fded33b ACM |
771 | |
772 | if (dccp_packet_without_ack(skb)) | |
2d0817d1 ACM |
773 | return 0; |
774 | ||
4fded33b ACM |
775 | x_recv = htonl(hcrx->ccid3hcrx_x_recv); |
776 | pinv = htonl(hcrx->ccid3hcrx_pinv); | |
2d0817d1 | 777 | |
eb279b79 | 778 | if (dccp_insert_option_timestamp(sk, skb) || |
2d0817d1 | 779 | dccp_insert_option(sk, skb, TFRC_OPT_LOSS_EVENT_RATE, |
8109b02b | 780 | &pinv, sizeof(pinv)) || |
2d0817d1 | 781 | dccp_insert_option(sk, skb, TFRC_OPT_RECEIVE_RATE, |
8109b02b | 782 | &x_recv, sizeof(x_recv))) |
2d0817d1 ACM |
783 | return -1; |
784 | ||
785 | return 0; | |
7c657876 ACM |
786 | } |
787 | ||
66a377c5 | 788 | static int ccid3_hc_rx_detect_loss(struct sock *sk, |
c9eaf173 | 789 | struct dccp_rx_hist_entry *packet) |
7c657876 | 790 | { |
59725dc2 | 791 | struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk); |
8109b02b ACM |
792 | struct dccp_rx_hist_entry *rx_hist = |
793 | dccp_rx_hist_head(&hcrx->ccid3hcrx_hist); | |
66a377c5 IM |
794 | u64 seqno = packet->dccphrx_seqno; |
795 | u64 tmp_seqno; | |
796 | int loss = 0; | |
797 | u8 ccval; | |
798 | ||
799 | ||
800 | tmp_seqno = hcrx->ccid3hcrx_seqno_nonloss; | |
801 | ||
802 | if (!rx_hist || | |
803 | follows48(packet->dccphrx_seqno, hcrx->ccid3hcrx_seqno_nonloss)) { | |
804 | hcrx->ccid3hcrx_seqno_nonloss = seqno; | |
805 | hcrx->ccid3hcrx_ccval_nonloss = packet->dccphrx_ccval; | |
806 | goto detect_out; | |
807 | } | |
808 | ||
7c657876 | 809 | |
66a377c5 IM |
810 | while (dccp_delta_seqno(hcrx->ccid3hcrx_seqno_nonloss, seqno) |
811 | > TFRC_RECV_NUM_LATE_LOSS) { | |
812 | loss = 1; | |
cc4d6a3a | 813 | dccp_li_update_li(sk, |
cc0a910b ACM |
814 | &hcrx->ccid3hcrx_li_hist, |
815 | &hcrx->ccid3hcrx_hist, | |
e7c23357 | 816 | hcrx->ccid3hcrx_tstamp_last_feedback, |
cc0a910b ACM |
817 | hcrx->ccid3hcrx_s, |
818 | hcrx->ccid3hcrx_bytes_recv, | |
819 | hcrx->ccid3hcrx_x_recv, | |
820 | hcrx->ccid3hcrx_seqno_nonloss, | |
821 | hcrx->ccid3hcrx_ccval_nonloss); | |
66a377c5 IM |
822 | tmp_seqno = hcrx->ccid3hcrx_seqno_nonloss; |
823 | dccp_inc_seqno(&tmp_seqno); | |
824 | hcrx->ccid3hcrx_seqno_nonloss = tmp_seqno; | |
825 | dccp_inc_seqno(&tmp_seqno); | |
826 | while (dccp_rx_hist_find_entry(&hcrx->ccid3hcrx_hist, | |
827 | tmp_seqno, &ccval)) { | |
8109b02b | 828 | hcrx->ccid3hcrx_seqno_nonloss = tmp_seqno; |
66a377c5 IM |
829 | hcrx->ccid3hcrx_ccval_nonloss = ccval; |
830 | dccp_inc_seqno(&tmp_seqno); | |
831 | } | |
832 | } | |
833 | ||
834 | /* FIXME - this code could be simplified with above while */ | |
835 | /* but works at moment */ | |
836 | if (follows48(packet->dccphrx_seqno, hcrx->ccid3hcrx_seqno_nonloss)) { | |
837 | hcrx->ccid3hcrx_seqno_nonloss = seqno; | |
838 | hcrx->ccid3hcrx_ccval_nonloss = packet->dccphrx_ccval; | |
839 | } | |
840 | ||
841 | detect_out: | |
842 | dccp_rx_hist_add_packet(ccid3_rx_hist, &hcrx->ccid3hcrx_hist, | |
843 | &hcrx->ccid3hcrx_li_hist, packet, | |
844 | hcrx->ccid3hcrx_seqno_nonloss); | |
845 | return loss; | |
7c657876 ACM |
846 | } |
847 | ||
7c657876 ACM |
848 | static void ccid3_hc_rx_packet_recv(struct sock *sk, struct sk_buff *skb) |
849 | { | |
59725dc2 | 850 | struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk); |
4fded33b | 851 | const struct dccp_options_received *opt_recv; |
8c60f3fa | 852 | struct dccp_rx_hist_entry *packet; |
7dfee1a9 | 853 | u32 p_prev, r_sample, rtt_prev; |
78ad713d | 854 | int loss, payload_size; |
9823b7b5 | 855 | ktime_t now; |
1f2333ae | 856 | |
59725dc2 | 857 | opt_recv = &dccp_sk(sk)->dccps_options_received; |
4fded33b | 858 | |
7c657876 ACM |
859 | switch (DCCP_SKB_CB(skb)->dccpd_type) { |
860 | case DCCP_PKT_ACK: | |
861 | if (hcrx->ccid3hcrx_state == TFRC_RSTATE_NO_DATA) | |
862 | return; | |
9823b7b5 | 863 | case DCCP_PKT_DATAACK: |
4fded33b | 864 | if (opt_recv->dccpor_timestamp_echo == 0) |
7c657876 | 865 | break; |
3393da82 | 866 | r_sample = dccp_timestamp() - opt_recv->dccpor_timestamp_echo; |
66a377c5 | 867 | rtt_prev = hcrx->ccid3hcrx_rtt; |
3393da82 | 868 | r_sample = dccp_sample_rtt(sk, 10 * r_sample); |
b3a3077d ACM |
869 | |
870 | if (hcrx->ccid3hcrx_state == TFRC_RSTATE_NO_DATA) | |
871 | hcrx->ccid3hcrx_rtt = r_sample; | |
872 | else | |
873 | hcrx->ccid3hcrx_rtt = (hcrx->ccid3hcrx_rtt * 9) / 10 + | |
874 | r_sample / 10; | |
875 | ||
66a377c5 | 876 | if (rtt_prev != hcrx->ccid3hcrx_rtt) |
a9672411 GR |
877 | ccid3_pr_debug("%s(%p), New RTT=%uus, elapsed time=%u\n", |
878 | dccp_role(sk), sk, hcrx->ccid3hcrx_rtt, | |
4fded33b | 879 | opt_recv->dccpor_elapsed_time); |
7c657876 ACM |
880 | break; |
881 | case DCCP_PKT_DATA: | |
882 | break; | |
59d203f9 | 883 | default: /* We're not interested in other packet types, move along */ |
7c657876 ACM |
884 | return; |
885 | } | |
886 | ||
e7c23357 | 887 | packet = dccp_rx_hist_entry_new(ccid3_rx_hist, opt_recv->dccpor_ndp, |
54e6ecb2 | 888 | skb, GFP_ATOMIC); |
59d203f9 | 889 | if (unlikely(packet == NULL)) { |
a9672411 | 890 | DCCP_WARN("%s(%p), Not enough mem to add rx packet " |
59348b19 | 891 | "to history, consider it lost!\n", dccp_role(sk), sk); |
7c657876 ACM |
892 | return; |
893 | } | |
894 | ||
66a377c5 | 895 | loss = ccid3_hc_rx_detect_loss(sk, packet); |
7c657876 ACM |
896 | |
897 | if (DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_ACK) | |
898 | return; | |
899 | ||
78ad713d GR |
900 | payload_size = skb->len - dccp_hdr(skb)->dccph_doff * 4; |
901 | ccid3_hc_rx_update_s(hcrx, payload_size); | |
902 | ||
7c657876 ACM |
903 | switch (hcrx->ccid3hcrx_state) { |
904 | case TFRC_RSTATE_NO_DATA: | |
a9672411 GR |
905 | ccid3_pr_debug("%s(%p, state=%s), skb=%p, sending initial " |
906 | "feedback\n", dccp_role(sk), sk, | |
1f2333ae | 907 | dccp_state_name(sk->sk_state), skb); |
7c657876 ACM |
908 | ccid3_hc_rx_send_feedback(sk); |
909 | ccid3_hc_rx_set_state(sk, TFRC_RSTATE_DATA); | |
910 | return; | |
9823b7b5 | 911 | case TFRC_RSTATE_DATA: |
78ad713d | 912 | hcrx->ccid3hcrx_bytes_recv += payload_size; |
66a377c5 | 913 | if (loss) |
b6ee3d4a ACM |
914 | break; |
915 | ||
1faf0a1f ACM |
916 | now = ktime_get_real(); |
917 | if ((ktime_us_delta(now, hcrx->ccid3hcrx_tstamp_last_ack) - | |
918 | (s64)hcrx->ccid3hcrx_rtt) >= 0) { | |
b6ee3d4a ACM |
919 | hcrx->ccid3hcrx_tstamp_last_ack = now; |
920 | ccid3_hc_rx_send_feedback(sk); | |
7c657876 | 921 | } |
b6ee3d4a | 922 | return; |
59348b19 | 923 | case TFRC_RSTATE_TERM: |
a9672411 | 924 | DCCP_BUG("%s(%p) - Illegal state TERM", dccp_role(sk), sk); |
7c657876 ACM |
925 | return; |
926 | } | |
927 | ||
928 | /* Dealing with packet loss */ | |
a9672411 | 929 | ccid3_pr_debug("%s(%p, state=%s), data loss! Reacting...\n", |
4fded33b | 930 | dccp_role(sk), sk, dccp_state_name(sk->sk_state)); |
7c657876 | 931 | |
7c657876 | 932 | p_prev = hcrx->ccid3hcrx_p; |
c9eaf173 | 933 | |
7c657876 | 934 | /* Calculate loss event rate */ |
c0996660 IM |
935 | if (!list_empty(&hcrx->ccid3hcrx_li_hist)) { |
936 | u32 i_mean = dccp_li_hist_calc_i_mean(&hcrx->ccid3hcrx_li_hist); | |
937 | ||
7c657876 | 938 | /* Scaling up by 1000000 as fixed decimal */ |
c0996660 IM |
939 | if (i_mean != 0) |
940 | hcrx->ccid3hcrx_p = 1000000 / i_mean; | |
59348b19 GR |
941 | } else |
942 | DCCP_BUG("empty loss history"); | |
7c657876 ACM |
943 | |
944 | if (hcrx->ccid3hcrx_p > p_prev) { | |
945 | ccid3_hc_rx_send_feedback(sk); | |
946 | return; | |
947 | } | |
948 | } | |
949 | ||
91f0ebf7 | 950 | static int ccid3_hc_rx_init(struct ccid *ccid, struct sock *sk) |
7c657876 | 951 | { |
91f0ebf7 | 952 | struct ccid3_hc_rx_sock *hcrx = ccid_priv(ccid); |
7c657876 | 953 | |
a9672411 | 954 | ccid3_pr_debug("entry\n"); |
7c657876 | 955 | |
7c657876 ACM |
956 | hcrx->ccid3hcrx_state = TFRC_RSTATE_NO_DATA; |
957 | INIT_LIST_HEAD(&hcrx->ccid3hcrx_hist); | |
ae6706f0 | 958 | INIT_LIST_HEAD(&hcrx->ccid3hcrx_li_hist); |
1faf0a1f | 959 | hcrx->ccid3hcrx_tstamp_last_feedback = |
e7a81c6d | 960 | hcrx->ccid3hcrx_tstamp_last_ack = ktime_get_real(); |
7c657876 ACM |
961 | return 0; |
962 | } | |
963 | ||
964 | static void ccid3_hc_rx_exit(struct sock *sk) | |
965 | { | |
59725dc2 | 966 | struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk); |
7c657876 | 967 | |
7c657876 ACM |
968 | ccid3_hc_rx_set_state(sk, TFRC_RSTATE_TERM); |
969 | ||
970 | /* Empty packet history */ | |
8c60f3fa | 971 | dccp_rx_hist_purge(ccid3_rx_hist, &hcrx->ccid3hcrx_hist); |
7c657876 ACM |
972 | |
973 | /* Empty loss interval history */ | |
cc4d6a3a | 974 | dccp_li_hist_purge(&hcrx->ccid3hcrx_li_hist); |
7c657876 ACM |
975 | } |
976 | ||
2babe1f6 ACM |
977 | static void ccid3_hc_rx_get_info(struct sock *sk, struct tcp_info *info) |
978 | { | |
2e86908f | 979 | const struct ccid3_hc_rx_sock *hcrx; |
2babe1f6 | 980 | |
59c2353d ACM |
981 | /* Listen socks doesn't have a private CCID block */ |
982 | if (sk->sk_state == DCCP_LISTEN) | |
983 | return; | |
984 | ||
2e86908f | 985 | hcrx = ccid3_hc_rx_sk(sk); |
8109b02b ACM |
986 | info->tcpi_ca_state = hcrx->ccid3hcrx_state; |
987 | info->tcpi_options |= TCPI_OPT_TIMESTAMPS; | |
988 | info->tcpi_rcv_rtt = hcrx->ccid3hcrx_rtt; | |
2babe1f6 ACM |
989 | } |
990 | ||
88f964db ACM |
991 | static int ccid3_hc_rx_getsockopt(struct sock *sk, const int optname, int len, |
992 | u32 __user *optval, int __user *optlen) | |
993 | { | |
2e86908f | 994 | const struct ccid3_hc_rx_sock *hcrx; |
88f964db | 995 | const void *val; |
c9eaf173 | 996 | |
88f964db ACM |
997 | /* Listen socks doesn't have a private CCID block */ |
998 | if (sk->sk_state == DCCP_LISTEN) | |
999 | return -EINVAL; | |
1000 | ||
2e86908f | 1001 | hcrx = ccid3_hc_rx_sk(sk); |
88f964db ACM |
1002 | switch (optname) { |
1003 | case DCCP_SOCKOPT_CCID_RX_INFO: | |
1004 | if (len < sizeof(hcrx->ccid3hcrx_tfrc)) | |
1005 | return -EINVAL; | |
1006 | len = sizeof(hcrx->ccid3hcrx_tfrc); | |
1007 | val = &hcrx->ccid3hcrx_tfrc; | |
1008 | break; | |
1009 | default: | |
1010 | return -ENOPROTOOPT; | |
1011 | } | |
1012 | ||
1013 | if (put_user(len, optlen) || copy_to_user(optval, val, len)) | |
1014 | return -EFAULT; | |
1015 | ||
1016 | return 0; | |
1017 | } | |
1018 | ||
91f0ebf7 | 1019 | static struct ccid_operations ccid3 = { |
3dd9a7c3 | 1020 | .ccid_id = DCCPC_CCID3, |
7c657876 ACM |
1021 | .ccid_name = "ccid3", |
1022 | .ccid_owner = THIS_MODULE, | |
91f0ebf7 | 1023 | .ccid_hc_tx_obj_size = sizeof(struct ccid3_hc_tx_sock), |
7c657876 ACM |
1024 | .ccid_hc_tx_init = ccid3_hc_tx_init, |
1025 | .ccid_hc_tx_exit = ccid3_hc_tx_exit, | |
1026 | .ccid_hc_tx_send_packet = ccid3_hc_tx_send_packet, | |
1027 | .ccid_hc_tx_packet_sent = ccid3_hc_tx_packet_sent, | |
1028 | .ccid_hc_tx_packet_recv = ccid3_hc_tx_packet_recv, | |
7c657876 | 1029 | .ccid_hc_tx_parse_options = ccid3_hc_tx_parse_options, |
91f0ebf7 | 1030 | .ccid_hc_rx_obj_size = sizeof(struct ccid3_hc_rx_sock), |
7c657876 ACM |
1031 | .ccid_hc_rx_init = ccid3_hc_rx_init, |
1032 | .ccid_hc_rx_exit = ccid3_hc_rx_exit, | |
1033 | .ccid_hc_rx_insert_options = ccid3_hc_rx_insert_options, | |
1034 | .ccid_hc_rx_packet_recv = ccid3_hc_rx_packet_recv, | |
2babe1f6 ACM |
1035 | .ccid_hc_rx_get_info = ccid3_hc_rx_get_info, |
1036 | .ccid_hc_tx_get_info = ccid3_hc_tx_get_info, | |
88f964db ACM |
1037 | .ccid_hc_rx_getsockopt = ccid3_hc_rx_getsockopt, |
1038 | .ccid_hc_tx_getsockopt = ccid3_hc_tx_getsockopt, | |
7c657876 | 1039 | }; |
8109b02b | 1040 | |
56724aa4 | 1041 | #ifdef CONFIG_IP_DCCP_CCID3_DEBUG |
042d18f9 | 1042 | module_param(ccid3_debug, bool, 0444); |
7c657876 | 1043 | MODULE_PARM_DESC(ccid3_debug, "Enable debug messages"); |
56724aa4 | 1044 | #endif |
7c657876 ACM |
1045 | |
1046 | static __init int ccid3_module_init(void) | |
1047 | { | |
8c60f3fa | 1048 | int rc = -ENOBUFS; |
7c657876 | 1049 | |
8c60f3fa ACM |
1050 | ccid3_rx_hist = dccp_rx_hist_new("ccid3"); |
1051 | if (ccid3_rx_hist == NULL) | |
7c657876 ACM |
1052 | goto out; |
1053 | ||
8c60f3fa ACM |
1054 | ccid3_tx_hist = dccp_tx_hist_new("ccid3"); |
1055 | if (ccid3_tx_hist == NULL) | |
1056 | goto out_free_rx; | |
7c657876 | 1057 | |
7c657876 | 1058 | rc = ccid_register(&ccid3); |
8109b02b | 1059 | if (rc != 0) |
cc4d6a3a | 1060 | goto out_free_tx; |
7c657876 ACM |
1061 | out: |
1062 | return rc; | |
8c60f3fa | 1063 | |
8c60f3fa ACM |
1064 | out_free_tx: |
1065 | dccp_tx_hist_delete(ccid3_tx_hist); | |
1066 | ccid3_tx_hist = NULL; | |
1067 | out_free_rx: | |
1068 | dccp_rx_hist_delete(ccid3_rx_hist); | |
1069 | ccid3_rx_hist = NULL; | |
7c657876 ACM |
1070 | goto out; |
1071 | } | |
1072 | module_init(ccid3_module_init); | |
1073 | ||
1074 | static __exit void ccid3_module_exit(void) | |
1075 | { | |
1076 | ccid_unregister(&ccid3); | |
1077 | ||
8c60f3fa ACM |
1078 | if (ccid3_tx_hist != NULL) { |
1079 | dccp_tx_hist_delete(ccid3_tx_hist); | |
1080 | ccid3_tx_hist = NULL; | |
7c657876 | 1081 | } |
8c60f3fa ACM |
1082 | if (ccid3_rx_hist != NULL) { |
1083 | dccp_rx_hist_delete(ccid3_rx_hist); | |
1084 | ccid3_rx_hist = NULL; | |
7c657876 | 1085 | } |
7c657876 ACM |
1086 | } |
1087 | module_exit(ccid3_module_exit); | |
1088 | ||
e6bccd35 | 1089 | MODULE_AUTHOR("Ian McDonald <ian.mcdonald@jandi.co.nz>, " |
1f2333ae | 1090 | "Arnaldo Carvalho de Melo <acme@ghostprotocols.net>"); |
7c657876 ACM |
1091 | MODULE_DESCRIPTION("DCCP TFRC CCID3 CCID"); |
1092 | MODULE_LICENSE("GPL"); | |
1093 | MODULE_ALIAS("net-dccp-ccid-3"); |