SAFE public projects git trees. - safe/jmp/linux-2.6/blob - net/dccp/ccids/ccid3.c

   1 /*
   2  *  net/dccp/ccids/ccid3.c
   3  *
   4  *  Copyright (c) 2005 The University of Waikato, Hamilton, New Zealand.
   5  *  Copyright (c) 2005 Ian McDonald <iam4@cs.waikato.ac.nz>
   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/
  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 <linux/config.h>
  38 #include "../ccid.h"
  39 #include "../dccp.h"
  40 #include "lib/packet_history.h"
  41 #include "lib/loss_interval.h"
  42 #include "lib/tfrc.h"
  43 #include "ccid3.h"
  44
  45 /*
  46  * Reason for maths here is to avoid 32 bit overflow when a is big.
  47  * With this we get close to the limit.
  48  */
  49 static inline u32 usecs_div(const u32 a, const u32 b)
  50 {
  51         const u32 div = a < (UINT_MAX / (USEC_PER_SEC /    10)) ?    10 :
  52                         a < (UINT_MAX / (USEC_PER_SEC /    50)) ?    50 :
  53                         a < (UINT_MAX / (USEC_PER_SEC /   100)) ?   100 :
  54                         a < (UINT_MAX / (USEC_PER_SEC /   500)) ?   500 :
  55                         a < (UINT_MAX / (USEC_PER_SEC /  1000)) ?  1000 :
  56                         a < (UINT_MAX / (USEC_PER_SEC /  5000)) ?  5000 :
  57                         a < (UINT_MAX / (USEC_PER_SEC / 10000)) ? 10000 :
  58                         a < (UINT_MAX / (USEC_PER_SEC / 50000)) ? 50000 :
  59                                                                  100000;
  60         const u32 tmp = a * (USEC_PER_SEC / div);
  61         return (b >= 2 * div) ? tmp / (b / div) : tmp;
  62 }
  63
  64 static int ccid3_debug;
  65
  66 #ifdef CCID3_DEBUG
  67 #define ccid3_pr_debug(format, a...) \
  68         do { if (ccid3_debug) \
  69                 printk(KERN_DEBUG "%s: " format, __FUNCTION__, ##a); \
  70         } while (0)
  71 #else
  72 #define ccid3_pr_debug(format, a...)
  73 #endif
  74
  75 static struct dccp_tx_hist *ccid3_tx_hist;
  76 static struct dccp_rx_hist *ccid3_rx_hist;
  77 static struct dccp_li_hist *ccid3_li_hist;
  78
  79 static int ccid3_init(struct sock *sk)
  80 {
  81         ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
  82         return 0;
  83 }
  84
  85 static void ccid3_exit(struct sock *sk)
  86 {
  87         ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
  88 }
  89
  90 /* TFRC sender states */
  91 enum ccid3_hc_tx_states {
  92         TFRC_SSTATE_NO_SENT = 1,
  93         TFRC_SSTATE_NO_FBACK,
  94         TFRC_SSTATE_FBACK,
  95         TFRC_SSTATE_TERM,
  96 };
  97
  98 #ifdef CCID3_DEBUG
  99 static const char *ccid3_tx_state_name(enum ccid3_hc_tx_states state)
 100 {
 101         static char *ccid3_state_names[] = {
 102         [TFRC_SSTATE_NO_SENT]  = "NO_SENT",
 103         [TFRC_SSTATE_NO_FBACK] = "NO_FBACK",
 104         [TFRC_SSTATE_FBACK]    = "FBACK",
 105         [TFRC_SSTATE_TERM]     = "TERM",
 106         };
 107
 108         return ccid3_state_names[state];
 109 }
 110 #endif
 111
 112 static inline void ccid3_hc_tx_set_state(struct sock *sk,
 113                                          enum ccid3_hc_tx_states state)
 114 {
 115         struct dccp_sock *dp = dccp_sk(sk);
 116         struct ccid3_hc_tx_sock *hctx = dp->dccps_hc_tx_ccid_private;
 117         enum ccid3_hc_tx_states oldstate = hctx->ccid3hctx_state;
 118
 119         ccid3_pr_debug("%s(%p) %-8.8s -> %s\n",
 120                        dccp_role(sk), sk, ccid3_tx_state_name(oldstate),
 121                        ccid3_tx_state_name(state));
 122         WARN_ON(state == oldstate);
 123         hctx->ccid3hctx_state = state;
 124 }
 125
 126 /* Calculate new t_ipi (inter packet interval) by t_ipi = s / X_inst */
 127 static inline void ccid3_calc_new_t_ipi(struct ccid3_hc_tx_sock *hctx)
 128 {
 129         /*
 130          * If no feedback spec says t_ipi is 1 second (set elsewhere and then
 131          * doubles after every no feedback timer (separate function)
 132          */
 133         if (hctx->ccid3hctx_state != TFRC_SSTATE_NO_FBACK)
 134                 hctx->ccid3hctx_t_ipi = usecs_div(hctx->ccid3hctx_s,
 135                                                   hctx->ccid3hctx_x);
 136 }
 137
 138 /* Calculate new delta by delta = min(t_ipi / 2, t_gran / 2) */
 139 static inline void ccid3_calc_new_delta(struct ccid3_hc_tx_sock *hctx)
 140 {
 141         hctx->ccid3hctx_delta = min_t(u32, hctx->ccid3hctx_t_ipi / 2,
 142                                            TFRC_OPSYS_HALF_TIME_GRAN);
 143 }
 144
 145 /*
 146  * Update X by
 147  *    If (p > 0)
 148  *       x_calc = calcX(s, R, p);
 149  *       X = max(min(X_calc, 2 * X_recv), s / t_mbi);
 150  *    Else
 151  *       If (now - tld >= R)
 152  *          X = max(min(2 * X, 2 * X_recv), s / R);
 153  *          tld = now;
 154  */
 155 static void ccid3_hc_tx_update_x(struct sock *sk)
 156 {
 157         struct dccp_sock *dp = dccp_sk(sk);
 158         struct ccid3_hc_tx_sock *hctx = dp->dccps_hc_tx_ccid_private;
 159
 160         /* To avoid large error in calcX */
 161         if (hctx->ccid3hctx_p >= TFRC_SMALLEST_P) {
 162                 hctx->ccid3hctx_x_calc = tfrc_calc_x(hctx->ccid3hctx_s,
 163                                                      hctx->ccid3hctx_rtt,
 164                                                      hctx->ccid3hctx_p);
 165                 hctx->ccid3hctx_x = max_t(u32, min_t(u32, hctx->ccid3hctx_x_calc,
 166                                                           2 * hctx->ccid3hctx_x_recv),
 167                                                (hctx->ccid3hctx_s /
 168                                                 TFRC_MAX_BACK_OFF_TIME));
 169         } else {
 170                 struct timeval now;
 171
 172                 dccp_timestamp(sk, &now);
 173                 if (timeval_delta(&now, &hctx->ccid3hctx_t_ld) >=
 174                     hctx->ccid3hctx_rtt) {
 175                         hctx->ccid3hctx_x = max_t(u32, min_t(u32, hctx->ccid3hctx_x_recv,
 176                                                                   hctx->ccid3hctx_x) * 2,
 177                                                        usecs_div(hctx->ccid3hctx_s,
 178                                                                  hctx->ccid3hctx_rtt));
 179                         hctx->ccid3hctx_t_ld = now;
 180                 }
 181         }
 182 }
 183
 184 static void ccid3_hc_tx_no_feedback_timer(unsigned long data)
 185 {
 186         struct sock *sk = (struct sock *)data;
 187         struct dccp_sock *dp = dccp_sk(sk);
 188         unsigned long next_tmout = 0;
 189         struct ccid3_hc_tx_sock *hctx = dp->dccps_hc_tx_ccid_private;
 190
 191         bh_lock_sock(sk);
 192         if (sock_owned_by_user(sk)) {
 193                 /* Try again later. */
 194                 /* XXX: set some sensible MIB */
 195                 sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
 196                                jiffies + HZ / 5);
 197                 goto out;
 198         }
 199
 200         ccid3_pr_debug("%s, sk=%p, state=%s\n", dccp_role(sk), sk,
 201                        ccid3_tx_state_name(hctx->ccid3hctx_state));
 202
 203         switch (hctx->ccid3hctx_state) {
 204         case TFRC_SSTATE_TERM:
 205                 goto out;
 206         case TFRC_SSTATE_NO_FBACK:
 207                 /* Halve send rate */
 208                 hctx->ccid3hctx_x /= 2;
 209                 if (hctx->ccid3hctx_x < (hctx->ccid3hctx_s /
 210                                          TFRC_MAX_BACK_OFF_TIME))
 211                         hctx->ccid3hctx_x = (hctx->ccid3hctx_s /
 212                                              TFRC_MAX_BACK_OFF_TIME);
 213
 214                 ccid3_pr_debug("%s, sk=%p, state=%s, updated tx rate to %d "
 215                                "bytes/s\n",
 216                                dccp_role(sk), sk,
 217                                ccid3_tx_state_name(hctx->ccid3hctx_state),
 218                                hctx->ccid3hctx_x);
 219                 next_tmout = max_t(u32, 2 * usecs_div(hctx->ccid3hctx_s,
 220                                                       hctx->ccid3hctx_x),
 221                                         TFRC_INITIAL_TIMEOUT);
 222                 /*
 223                  * FIXME - not sure above calculation is correct. See section
 224                  * 5 of CCID3 11 should adjust tx_t_ipi and double that to
 225                  * achieve it really
 226                  */
 227                 break;
 228         case TFRC_SSTATE_FBACK:
 229                 /*
 230                  * Check if IDLE since last timeout and recv rate is less than
 231                  * 4 packets per RTT
 232                  */
 233                 if (!hctx->ccid3hctx_idle ||
 234                     (hctx->ccid3hctx_x_recv >=
 235                      4 * usecs_div(hctx->ccid3hctx_s, hctx->ccid3hctx_rtt))) {
 236                         ccid3_pr_debug("%s, sk=%p, state=%s, not idle\n",
 237                                        dccp_role(sk), sk,
 238                                        ccid3_tx_state_name(hctx->ccid3hctx_state));
 239                         /* Halve sending rate */
 240
 241                         /*  If (X_calc > 2 * X_recv)
 242                          *    X_recv = max(X_recv / 2, s / (2 * t_mbi));
 243                          *  Else
 244                          *    X_recv = X_calc / 4;
 245                          */
 246                         BUG_ON(hctx->ccid3hctx_p >= TFRC_SMALLEST_P &&
 247                                hctx->ccid3hctx_x_calc == 0);
 248
 249                         /* check also if p is zero -> x_calc is infinity? */
 250                         if (hctx->ccid3hctx_p < TFRC_SMALLEST_P ||
 251                             hctx->ccid3hctx_x_calc > 2 * hctx->ccid3hctx_x_recv)
 252                                 hctx->ccid3hctx_x_recv = max_t(u32, hctx->ccid3hctx_x_recv / 2,
 253                                                                     hctx->ccid3hctx_s / (2 * TFRC_MAX_BACK_OFF_TIME));
 254                         else
 255                                 hctx->ccid3hctx_x_recv = hctx->ccid3hctx_x_calc / 4;
 256
 257                         /* Update sending rate */
 258                         ccid3_hc_tx_update_x(sk);
 259                 }
 260                 /*
 261                  * Schedule no feedback timer to expire in
 262                  * max(4 * R, 2 * s / X)
 263                  */
 264                 next_tmout = max_t(u32, hctx->ccid3hctx_t_rto,
 265                                         2 * usecs_div(hctx->ccid3hctx_s,
 266                                                       hctx->ccid3hctx_x));
 267                 break;
 268         default:
 269                 printk(KERN_CRIT "%s: %s, sk=%p, Illegal state (%d)!\n",
 270                        __FUNCTION__, dccp_role(sk), sk, hctx->ccid3hctx_state);
 271                 dump_stack();
 272                 goto out;
 273         }
 274
 275         sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
 276                       jiffies + max_t(u32, 1, usecs_to_jiffies(next_tmout)));
 277         hctx->ccid3hctx_idle = 1;
 278 out:
 279         bh_unlock_sock(sk);
 280         sock_put(sk);
 281 }
 282
 283 static int ccid3_hc_tx_send_packet(struct sock *sk,
 284                                    struct sk_buff *skb, int len)
 285 {
 286         struct dccp_sock *dp = dccp_sk(sk);
 287         struct ccid3_hc_tx_sock *hctx = dp->dccps_hc_tx_ccid_private;
 288         struct dccp_tx_hist_entry *new_packet;
 289         struct timeval now;
 290         long delay;
 291         int rc = -ENOTCONN;
 292
 293         /* Check if pure ACK or Terminating*/
 294
 295         /*
 296          * XXX: We only call this function for DATA and DATAACK, on, these
 297          * packets can have zero length, but why the comment about "pure ACK"?
 298          */
 299         if (hctx == NULL || len == 0 ||
 300             hctx->ccid3hctx_state == TFRC_SSTATE_TERM)
 301                 goto out;
 302
 303         /* See if last packet allocated was not sent */
 304         new_packet = dccp_tx_hist_head(&hctx->ccid3hctx_hist);
 305         if (new_packet == NULL || new_packet->dccphtx_sent) {
 306                 new_packet = dccp_tx_hist_entry_new(ccid3_tx_hist,
 307                                                     SLAB_ATOMIC);
 308
 309                 rc = -ENOBUFS;
 310                 if (new_packet == NULL) {
 311                         ccid3_pr_debug("%s, sk=%p, not enough mem to add "
 312                                        "to history, send refused\n",
 313                                        dccp_role(sk), sk);
 314                         goto out;
 315                 }
 316
 317                 dccp_tx_hist_add_entry(&hctx->ccid3hctx_hist, new_packet);
 318         }
 319
 320         dccp_timestamp(sk, &now);
 321
 322         switch (hctx->ccid3hctx_state) {
 323         case TFRC_SSTATE_NO_SENT:
 324                 ccid3_pr_debug("%s, sk=%p, first packet(%llu)\n",
 325                                dccp_role(sk), sk, dp->dccps_gss);
 326
 327                 hctx->ccid3hctx_no_feedback_timer.function = ccid3_hc_tx_no_feedback_timer;
 328                 hctx->ccid3hctx_no_feedback_timer.data     = (unsigned long)sk;
 329                 sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
 330                                jiffies + usecs_to_jiffies(TFRC_INITIAL_TIMEOUT));
 331                 hctx->ccid3hctx_last_win_count   = 0;
 332                 hctx->ccid3hctx_t_last_win_count = now;
 333                 ccid3_hc_tx_set_state(sk, TFRC_SSTATE_NO_FBACK);
 334                 hctx->ccid3hctx_t_ipi = TFRC_INITIAL_TIMEOUT;
 335
 336                 /* Set nominal send time for initial packet */
 337                 hctx->ccid3hctx_t_nom = now;
 338                 timeval_add_usecs(&hctx->ccid3hctx_t_nom,
 339                                   hctx->ccid3hctx_t_ipi);
 340                 ccid3_calc_new_delta(hctx);
 341                 rc = 0;
 342                 break;
 343         case TFRC_SSTATE_NO_FBACK:
 344         case TFRC_SSTATE_FBACK:
 345                 delay = (timeval_delta(&now, &hctx->ccid3hctx_t_nom) -
 346                          hctx->ccid3hctx_delta);
 347                 ccid3_pr_debug("send_packet delay=%ld\n", delay);
 348                 delay /= -1000;
 349                 /* divide by -1000 is to convert to ms and get sign right */
 350                 rc = delay > 0 ? delay : 0;
 351                 break;
 352         default:
 353                 printk(KERN_CRIT "%s: %s, sk=%p, Illegal state (%d)!\n",
 354                        __FUNCTION__, dccp_role(sk), sk, hctx->ccid3hctx_state);
 355                 dump_stack();
 356                 rc = -EINVAL;
 357                 break;
 358         }
 359
 360         /* Can we send? if so add options and add to packet history */
 361         if (rc == 0) {
 362                 dp->dccps_hc_tx_insert_options = 1;
 363                 new_packet->dccphtx_ccval =
 364                         DCCP_SKB_CB(skb)->dccpd_ccval =
 365                                 hctx->ccid3hctx_last_win_count;
 366         }
 367 out:
 368         return rc;
 369 }
 370
 371 static void ccid3_hc_tx_packet_sent(struct sock *sk, int more, int len)
 372 {
 373         struct dccp_sock *dp = dccp_sk(sk);
 374         struct ccid3_hc_tx_sock *hctx = dp->dccps_hc_tx_ccid_private;
 375         struct timeval now;
 376
 377         BUG_ON(hctx == NULL);
 378
 379         if (hctx->ccid3hctx_state == TFRC_SSTATE_TERM) {
 380                 ccid3_pr_debug("%s, sk=%p, while state is TFRC_SSTATE_TERM!\n",
 381                                dccp_role(sk), sk);
 382                 return;
 383         }
 384
 385         dccp_timestamp(sk, &now);
 386
 387         /* check if we have sent a data packet */
 388         if (len > 0) {
 389                 unsigned long quarter_rtt;
 390                 struct dccp_tx_hist_entry *packet;
 391
 392                 packet = dccp_tx_hist_head(&hctx->ccid3hctx_hist);
 393                 if (packet == NULL) {
 394                         printk(KERN_CRIT "%s: packet doesn't exists in "
 395                                          "history!\n", __FUNCTION__);
 396                         return;
 397                 }
 398                 if (packet->dccphtx_sent) {
 399                         printk(KERN_CRIT "%s: no unsent packet in history!\n",
 400                                __FUNCTION__);
 401                         return;
 402                 }
 403                 packet->dccphtx_tstamp = now;
 404                 packet->dccphtx_seqno  = dp->dccps_gss;
 405                 /*
 406                  * Check if win_count have changed
 407                  * Algorithm in "8.1. Window Counter Valuer" in
 408                  * draft-ietf-dccp-ccid3-11.txt
 409                  */
 410                 quarter_rtt = timeval_delta(&now, &hctx->ccid3hctx_t_last_win_count);
 411                 if (likely(hctx->ccid3hctx_rtt > 8))
 412                         quarter_rtt /= hctx->ccid3hctx_rtt / 4;
 413
 414                 if (quarter_rtt > 0) {
 415                         hctx->ccid3hctx_t_last_win_count = now;
 416                         hctx->ccid3hctx_last_win_count   = (hctx->ccid3hctx_last_win_count +
 417                                                             min_t(unsigned long, quarter_rtt, 5)) % 16;
 418                         ccid3_pr_debug("%s, sk=%p, window changed from "
 419                                        "%u to %u!\n",
 420                                        dccp_role(sk), sk,
 421                                        packet->dccphtx_ccval,
 422                                        hctx->ccid3hctx_last_win_count);
 423                 }
 424
 425                 hctx->ccid3hctx_idle = 0;
 426                 packet->dccphtx_rtt  = hctx->ccid3hctx_rtt;
 427                 packet->dccphtx_sent = 1;
 428         } else
 429                 ccid3_pr_debug("%s, sk=%p, seqno=%llu NOT inserted!\n",
 430                                dccp_role(sk), sk, dp->dccps_gss);
 431
 432         switch (hctx->ccid3hctx_state) {
 433         case TFRC_SSTATE_NO_SENT:
 434                 /* if first wasn't pure ack */
 435                 if (len != 0)
 436                         printk(KERN_CRIT "%s: %s, First packet sent is noted "
 437                                          "as a data packet\n",
 438                                __FUNCTION__, dccp_role(sk));
 439                 return;
 440         case TFRC_SSTATE_NO_FBACK:
 441         case TFRC_SSTATE_FBACK:
 442                 if (len > 0) {
 443                         hctx->ccid3hctx_t_nom = now;
 444                         ccid3_calc_new_t_ipi(hctx);
 445                         ccid3_calc_new_delta(hctx);
 446                         timeval_add_usecs(&hctx->ccid3hctx_t_nom,
 447                                           hctx->ccid3hctx_t_ipi);
 448                 }
 449                 break;
 450         default:
 451                 printk(KERN_CRIT "%s: %s, sk=%p, Illegal state (%d)!\n",
 452                        __FUNCTION__, dccp_role(sk), sk, hctx->ccid3hctx_state);
 453                 dump_stack();
 454                 break;
 455         }
 456 }
 457
 458 static void ccid3_hc_tx_packet_recv(struct sock *sk, struct sk_buff *skb)
 459 {
 460         struct dccp_sock *dp = dccp_sk(sk);
 461         struct ccid3_hc_tx_sock *hctx = dp->dccps_hc_tx_ccid_private;
 462         struct ccid3_options_received *opt_recv;
 463         struct dccp_tx_hist_entry *packet;
 464         struct timeval now;
 465         unsigned long next_tmout;
 466         u32 t_elapsed;
 467         u32 pinv;
 468         u32 x_recv;
 469         u32 r_sample;
 470
 471         if (hctx == NULL)
 472                 return;
 473
 474         if (hctx->ccid3hctx_state == TFRC_SSTATE_TERM) {
 475                 ccid3_pr_debug("%s, sk=%p, received a packet when "
 476                                "terminating!\n", dccp_role(sk), sk);
 477                 return;
 478         }
 479
 480         /* we are only interested in ACKs */
 481         if (!(DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_ACK ||
 482               DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_DATAACK))
 483                 return;
 484
 485         opt_recv = &hctx->ccid3hctx_options_received;
 486
 487         t_elapsed = dp->dccps_options_received.dccpor_elapsed_time * 10;
 488         x_recv = opt_recv->ccid3or_receive_rate;
 489         pinv = opt_recv->ccid3or_loss_event_rate;
 490
 491         switch (hctx->ccid3hctx_state) {
 492         case TFRC_SSTATE_NO_SENT:
 493                 /* FIXME: what to do here? */
 494                 return;
 495         case TFRC_SSTATE_NO_FBACK:
 496         case TFRC_SSTATE_FBACK:
 497                 /* Calculate new round trip sample by
 498                  * R_sample = (now - t_recvdata) - t_delay */
 499                 /* get t_recvdata from history */
 500                 packet = dccp_tx_hist_find_entry(&hctx->ccid3hctx_hist,
 501                                                  DCCP_SKB_CB(skb)->dccpd_ack_seq);
 502                 if (packet == NULL) {
 503                         ccid3_pr_debug("%s, sk=%p, seqno %llu(%s) does't "
 504                                        "exist in history!\n",
 505                                        dccp_role(sk), sk,
 506                                        DCCP_SKB_CB(skb)->dccpd_ack_seq,
 507                                        dccp_packet_name(DCCP_SKB_CB(skb)->dccpd_type));
 508                         return;
 509                 }
 510
 511                 /* Update RTT */
 512                 dccp_timestamp(sk, &now);
 513                 r_sample = timeval_delta(&now, &packet->dccphtx_tstamp);
 514                 if (unlikely(r_sample <= t_elapsed))
 515                         LIMIT_NETDEBUG(KERN_WARNING
 516                                        "%s: r_sample=%uus, t_elapsed=%uus\n",
 517                                        __FUNCTION__, r_sample, t_elapsed);
 518                 else
 519                         r_sample -= t_elapsed;
 520
 521                 /* Update RTT estimate by
 522                  * If (No feedback recv)
 523                  *    R = R_sample;
 524                  * Else
 525                  *    R = q * R + (1 - q) * R_sample;
 526                  *
 527                  * q is a constant, RFC 3448 recomments 0.9
 528                  */
 529                 if (hctx->ccid3hctx_state == TFRC_SSTATE_NO_FBACK) {
 530                         ccid3_hc_tx_set_state(sk, TFRC_SSTATE_FBACK);
 531                         hctx->ccid3hctx_rtt = r_sample;
 532                 } else
 533                         hctx->ccid3hctx_rtt = (hctx->ccid3hctx_rtt * 9) / 10 +
 534                                               r_sample / 10;
 535
 536                 ccid3_pr_debug("%s, sk=%p, New RTT estimate=%uus, "
 537                                "r_sample=%us\n", dccp_role(sk), sk,
 538                                hctx->ccid3hctx_rtt, r_sample);
 539
 540                 /* Update timeout interval */
 541                 hctx->ccid3hctx_t_rto = max_t(u32, 4 * hctx->ccid3hctx_rtt,
 542                                               USEC_PER_SEC);
 543
 544                 /* Update receive rate */
 545                 hctx->ccid3hctx_x_recv = x_recv;/* X_recv in bytes per sec */
 546
 547                 /* Update loss event rate */
 548                 if (pinv == ~0 || pinv == 0)
 549                         hctx->ccid3hctx_p = 0;
 550                 else {
 551                         hctx->ccid3hctx_p = 1000000 / pinv;
 552
 553                         if (hctx->ccid3hctx_p < TFRC_SMALLEST_P) {
 554                                 hctx->ccid3hctx_p = TFRC_SMALLEST_P;
 555                                 ccid3_pr_debug("%s, sk=%p, Smallest p used!\n",
 556                                                dccp_role(sk), sk);
 557                         }
 558                 }
 559
 560                 /* unschedule no feedback timer */
 561                 sk_stop_timer(sk, &hctx->ccid3hctx_no_feedback_timer);
 562
 563                 /* Update sending rate */
 564                 ccid3_hc_tx_update_x(sk);
 565
 566                 /* Update next send time */
 567                 timeval_sub_usecs(&hctx->ccid3hctx_t_nom,
 568                                   hctx->ccid3hctx_t_ipi);
 569                 ccid3_calc_new_t_ipi(hctx);
 570                 timeval_add_usecs(&hctx->ccid3hctx_t_nom,
 571                                   hctx->ccid3hctx_t_ipi);
 572                 ccid3_calc_new_delta(hctx);
 573
 574                 /* remove all packets older than the one acked from history */
 575                 dccp_tx_hist_purge_older(ccid3_tx_hist,
 576                                          &hctx->ccid3hctx_hist, packet);
 577                 /*
 578                  * As we have calculated new ipi, delta, t_nom it is possible that
 579                  * we now can send a packet, so wake up dccp_wait_for_ccids.
 580                  */
 581                 sk->sk_write_space(sk);
 582
 583                 /*
 584                  * Schedule no feedback timer to expire in
 585                  * max(4 * R, 2 * s / X)
 586                  */
 587                 next_tmout = max(hctx->ccid3hctx_t_rto,
 588                                  2 * usecs_div(hctx->ccid3hctx_s,
 589                                                hctx->ccid3hctx_x));
 590
 591                 ccid3_pr_debug("%s, sk=%p, Scheduled no feedback timer to "
 592                                "expire in %lu jiffies (%luus)\n",
 593                                dccp_role(sk), sk,
 594                                usecs_to_jiffies(next_tmout), next_tmout);
 595
 596                 sk_reset_timer(sk, &hctx->ccid3hctx_no_feedback_timer,
 597                                jiffies + max_t(u32, 1, usecs_to_jiffies(next_tmout)));
 598
 599                 /* set idle flag */
 600                 hctx->ccid3hctx_idle = 1;
 601                 break;
 602         default:
 603                 printk(KERN_CRIT "%s: %s, sk=%p, Illegal state (%d)!\n",
 604                        __FUNCTION__, dccp_role(sk), sk, hctx->ccid3hctx_state);
 605                 dump_stack();
 606                 break;
 607         }
 608 }
 609
 610 static void ccid3_hc_tx_insert_options(struct sock *sk, struct sk_buff *skb)
 611 {
 612         const struct dccp_sock *dp = dccp_sk(sk);
 613         struct ccid3_hc_tx_sock *hctx = dp->dccps_hc_tx_ccid_private;
 614
 615         if (hctx == NULL || !(sk->sk_state == DCCP_OPEN ||
 616                               sk->sk_state == DCCP_PARTOPEN))
 617                 return;
 618
 619          DCCP_SKB_CB(skb)->dccpd_ccval = hctx->ccid3hctx_last_win_count;
 620 }
 621
 622 static int ccid3_hc_tx_parse_options(struct sock *sk, unsigned char option,
 623                                      unsigned char len, u16 idx,
 624                                      unsigned char *value)
 625 {
 626         int rc = 0;
 627         struct dccp_sock *dp = dccp_sk(sk);
 628         struct ccid3_hc_tx_sock *hctx = dp->dccps_hc_tx_ccid_private;
 629         struct ccid3_options_received *opt_recv;
 630
 631         if (hctx == NULL)
 632                 return 0;
 633
 634         opt_recv = &hctx->ccid3hctx_options_received;
 635
 636         if (opt_recv->ccid3or_seqno != dp->dccps_gsr) {
 637                 opt_recv->ccid3or_seqno              = dp->dccps_gsr;
 638                 opt_recv->ccid3or_loss_event_rate    = ~0;
 639                 opt_recv->ccid3or_loss_intervals_idx = 0;
 640                 opt_recv->ccid3or_loss_intervals_len = 0;
 641                 opt_recv->ccid3or_receive_rate       = 0;
 642         }
 643
 644         switch (option) {
 645         case TFRC_OPT_LOSS_EVENT_RATE:
 646                 if (len != 4) {
 647                         ccid3_pr_debug("%s, sk=%p, invalid len for "
 648                                        "TFRC_OPT_LOSS_EVENT_RATE\n",
 649                                        dccp_role(sk), sk);
 650                         rc = -EINVAL;
 651                 } else {
 652                         opt_recv->ccid3or_loss_event_rate = ntohl(*(u32 *)value);
 653                         ccid3_pr_debug("%s, sk=%p, LOSS_EVENT_RATE=%u\n",
 654                                        dccp_role(sk), sk,
 655                                        opt_recv->ccid3or_loss_event_rate);
 656                 }
 657                 break;
 658         case TFRC_OPT_LOSS_INTERVALS:
 659                 opt_recv->ccid3or_loss_intervals_idx = idx;
 660                 opt_recv->ccid3or_loss_intervals_len = len;
 661                 ccid3_pr_debug("%s, sk=%p, LOSS_INTERVALS=(%u, %u)\n",
 662                                dccp_role(sk), sk,
 663                                opt_recv->ccid3or_loss_intervals_idx,
 664                                opt_recv->ccid3or_loss_intervals_len);
 665                 break;
 666         case TFRC_OPT_RECEIVE_RATE:
 667                 if (len != 4) {
 668                         ccid3_pr_debug("%s, sk=%p, invalid len for "
 669                                        "TFRC_OPT_RECEIVE_RATE\n",
 670                                        dccp_role(sk), sk);
 671                         rc = -EINVAL;
 672                 } else {
 673                         opt_recv->ccid3or_receive_rate = ntohl(*(u32 *)value);
 674                         ccid3_pr_debug("%s, sk=%p, RECEIVE_RATE=%u\n",
 675                                        dccp_role(sk), sk,
 676                                        opt_recv->ccid3or_receive_rate);
 677                 }
 678                 break;
 679         }
 680
 681         return rc;
 682 }
 683
 684 static int ccid3_hc_tx_init(struct sock *sk)
 685 {
 686         struct dccp_sock *dp = dccp_sk(sk);
 687         struct ccid3_hc_tx_sock *hctx;
 688
 689         ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
 690
 691         hctx = dp->dccps_hc_tx_ccid_private = kmalloc(sizeof(*hctx),
 692                                                       gfp_any());
 693         if (hctx == NULL)
 694                 return -ENOMEM;
 695
 696         memset(hctx, 0, sizeof(*hctx));
 697
 698         if (dp->dccps_packet_size >= TFRC_MIN_PACKET_SIZE &&
 699             dp->dccps_packet_size <= TFRC_MAX_PACKET_SIZE)
 700                 hctx->ccid3hctx_s = dp->dccps_packet_size;
 701         else
 702                 hctx->ccid3hctx_s = TFRC_STD_PACKET_SIZE;
 703
 704         /* Set transmission rate to 1 packet per second */
 705         hctx->ccid3hctx_x     = hctx->ccid3hctx_s;
 706         hctx->ccid3hctx_t_rto = USEC_PER_SEC;
 707         hctx->ccid3hctx_state = TFRC_SSTATE_NO_SENT;
 708         INIT_LIST_HEAD(&hctx->ccid3hctx_hist);
 709         init_timer(&hctx->ccid3hctx_no_feedback_timer);
 710
 711         return 0;
 712 }
 713
 714 static void ccid3_hc_tx_exit(struct sock *sk)
 715 {
 716         struct dccp_sock *dp = dccp_sk(sk);
 717         struct ccid3_hc_tx_sock *hctx = dp->dccps_hc_tx_ccid_private;
 718
 719         ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
 720         BUG_ON(hctx == NULL);
 721
 722         ccid3_hc_tx_set_state(sk, TFRC_SSTATE_TERM);
 723         sk_stop_timer(sk, &hctx->ccid3hctx_no_feedback_timer);
 724
 725         /* Empty packet history */
 726         dccp_tx_hist_purge(ccid3_tx_hist, &hctx->ccid3hctx_hist);
 727
 728         kfree(dp->dccps_hc_tx_ccid_private);
 729         dp->dccps_hc_tx_ccid_private = NULL;
 730 }
 731
 732 /*
 733  * RX Half Connection methods
 734  */
 735
 736 /* TFRC receiver states */
 737 enum ccid3_hc_rx_states {
 738         TFRC_RSTATE_NO_DATA = 1,
 739         TFRC_RSTATE_DATA,
 740         TFRC_RSTATE_TERM    = 127,
 741 };
 742
 743 #ifdef CCID3_DEBUG
 744 static const char *ccid3_rx_state_name(enum ccid3_hc_rx_states state)
 745 {
 746         static char *ccid3_rx_state_names[] = {
 747         [TFRC_RSTATE_NO_DATA] = "NO_DATA",
 748         [TFRC_RSTATE_DATA]    = "DATA",
 749         [TFRC_RSTATE_TERM]    = "TERM",
 750         };
 751
 752         return ccid3_rx_state_names[state];
 753 }
 754 #endif
 755
 756 static inline void ccid3_hc_rx_set_state(struct sock *sk,
 757                                          enum ccid3_hc_rx_states state)
 758 {
 759         struct dccp_sock *dp = dccp_sk(sk);
 760         struct ccid3_hc_rx_sock *hcrx = dp->dccps_hc_rx_ccid_private;
 761         enum ccid3_hc_rx_states oldstate = hcrx->ccid3hcrx_state;
 762
 763         ccid3_pr_debug("%s(%p) %-8.8s -> %s\n",
 764                        dccp_role(sk), sk, ccid3_rx_state_name(oldstate),
 765                        ccid3_rx_state_name(state));
 766         WARN_ON(state == oldstate);
 767         hcrx->ccid3hcrx_state = state;
 768 }
 769
 770 static void ccid3_hc_rx_send_feedback(struct sock *sk)
 771 {
 772         struct dccp_sock *dp = dccp_sk(sk);
 773         struct ccid3_hc_rx_sock *hcrx = dp->dccps_hc_rx_ccid_private;
 774         struct dccp_rx_hist_entry *packet;
 775         struct timeval now;
 776
 777         ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
 778
 779         dccp_timestamp(sk, &now);
 780
 781         switch (hcrx->ccid3hcrx_state) {
 782         case TFRC_RSTATE_NO_DATA:
 783                 hcrx->ccid3hcrx_x_recv = 0;
 784                 break;
 785         case TFRC_RSTATE_DATA: {
 786                 const u32 delta = timeval_delta(&now,
 787                                         &hcrx->ccid3hcrx_tstamp_last_feedback);
 788                 hcrx->ccid3hcrx_x_recv = usecs_div(hcrx->ccid3hcrx_bytes_recv,
 789                                                    delta);
 790         }
 791                 break;
 792         default:
 793                 printk(KERN_CRIT "%s: %s, sk=%p, Illegal state (%d)!\n",
 794                        __FUNCTION__, dccp_role(sk), sk, hcrx->ccid3hcrx_state);
 795                 dump_stack();
 796                 return;
 797         }
 798
 799         packet = dccp_rx_hist_find_data_packet(&hcrx->ccid3hcrx_hist);
 800         if (packet == NULL) {
 801                 printk(KERN_CRIT "%s: %s, sk=%p, no data packet in history!\n",
 802                        __FUNCTION__, dccp_role(sk), sk);
 803                 dump_stack();
 804                 return;
 805         }
 806
 807         hcrx->ccid3hcrx_tstamp_last_feedback = now;
 808         hcrx->ccid3hcrx_last_counter         = packet->dccphrx_ccval;
 809         hcrx->ccid3hcrx_seqno_last_counter   = packet->dccphrx_seqno;
 810         hcrx->ccid3hcrx_bytes_recv           = 0;
 811
 812         /* Convert to multiples of 10us */
 813         hcrx->ccid3hcrx_elapsed_time =
 814                         timeval_delta(&now, &packet->dccphrx_tstamp) / 10;
 815         if (hcrx->ccid3hcrx_p == 0)
 816                 hcrx->ccid3hcrx_pinv = ~0;
 817         else
 818                 hcrx->ccid3hcrx_pinv = 1000000 / hcrx->ccid3hcrx_p;
 819         dp->dccps_hc_rx_insert_options = 1;
 820         dccp_send_ack(sk);
 821 }
 822
 823 static void ccid3_hc_rx_insert_options(struct sock *sk, struct sk_buff *skb)
 824 {
 825         const struct dccp_sock *dp = dccp_sk(sk);
 826         u32 x_recv, pinv;
 827         struct ccid3_hc_rx_sock *hcrx = dp->dccps_hc_rx_ccid_private;
 828
 829         if (hcrx == NULL || !(sk->sk_state == DCCP_OPEN ||
 830                               sk->sk_state == DCCP_PARTOPEN))
 831                 return;
 832
 833         DCCP_SKB_CB(skb)->dccpd_ccval = hcrx->ccid3hcrx_last_counter;
 834
 835         if (dccp_packet_without_ack(skb))
 836                 return;
 837
 838         if (hcrx->ccid3hcrx_elapsed_time != 0)
 839                 dccp_insert_option_elapsed_time(sk, skb,
 840                                                 hcrx->ccid3hcrx_elapsed_time);
 841         dccp_insert_option_timestamp(sk, skb);
 842         x_recv = htonl(hcrx->ccid3hcrx_x_recv);
 843         pinv   = htonl(hcrx->ccid3hcrx_pinv);
 844         dccp_insert_option(sk, skb, TFRC_OPT_LOSS_EVENT_RATE,
 845                            &pinv, sizeof(pinv));
 846         dccp_insert_option(sk, skb, TFRC_OPT_RECEIVE_RATE,
 847                            &x_recv, sizeof(x_recv));
 848 }
 849
 850 /* calculate first loss interval
 851  *
 852  * returns estimated loss interval in usecs */
 853
 854 static u32 ccid3_hc_rx_calc_first_li(struct sock *sk)
 855 {
 856         struct dccp_sock *dp = dccp_sk(sk);
 857         struct ccid3_hc_rx_sock *hcrx = dp->dccps_hc_rx_ccid_private;
 858         struct dccp_rx_hist_entry *entry, *next, *tail = NULL;
 859         u32 rtt, delta, x_recv, fval, p, tmp2;
 860         struct timeval tstamp = { 0, };
 861         int interval = 0;
 862         int win_count = 0;
 863         int step = 0;
 864         u64 tmp1;
 865
 866         list_for_each_entry_safe(entry, next, &hcrx->ccid3hcrx_hist,
 867                                  dccphrx_node) {
 868                 if (dccp_rx_hist_entry_data_packet(entry)) {
 869                         tail = entry;
 870
 871                         switch (step) {
 872                         case 0:
 873                                 tstamp    = entry->dccphrx_tstamp;
 874                                 win_count = entry->dccphrx_ccval;
 875                                 step = 1;
 876                                 break;
 877                         case 1:
 878                                 interval = win_count - entry->dccphrx_ccval;
 879                                 if (interval < 0)
 880                                         interval += TFRC_WIN_COUNT_LIMIT;
 881                                 if (interval > 4)
 882                                         goto found;
 883                                 break;
 884                         }
 885                 }
 886         }
 887
 888         if (step == 0) {
 889                 printk(KERN_CRIT "%s: %s, sk=%p, packet history contains no "
 890                                  "data packets!\n",
 891                        __FUNCTION__, dccp_role(sk), sk);
 892                 return ~0;
 893         }
 894
 895         if (interval == 0) {
 896                 ccid3_pr_debug("%s, sk=%p, Could not find a win_count "
 897                                "interval > 0. Defaulting to 1\n",
 898                                dccp_role(sk), sk);
 899                 interval = 1;
 900         }
 901 found:
 902         rtt = timeval_delta(&tstamp, &tail->dccphrx_tstamp) * 4 / interval;
 903         ccid3_pr_debug("%s, sk=%p, approximated RTT to %uus\n",
 904                        dccp_role(sk), sk, rtt);
 905         if (rtt == 0)
 906                 rtt = 1;
 907
 908         dccp_timestamp(sk, &tstamp);
 909         delta = timeval_delta(&tstamp, &hcrx->ccid3hcrx_tstamp_last_feedback);
 910         x_recv = usecs_div(hcrx->ccid3hcrx_bytes_recv, delta);
 911
 912         tmp1 = (u64)x_recv * (u64)rtt;
 913         do_div(tmp1,10000000);
 914         tmp2 = (u32)tmp1;
 915         fval = (hcrx->ccid3hcrx_s * 100000) / tmp2;
 916         /* do not alter order above or you will get overflow on 32 bit */
 917         p = tfrc_calc_x_reverse_lookup(fval);
 918         ccid3_pr_debug("%s, sk=%p, receive rate=%u bytes/s, implied "
 919                        "loss rate=%u\n", dccp_role(sk), sk, x_recv, p);
 920
 921         if (p == 0)
 922                 return ~0;
 923         else
 924                 return 1000000 / p;
 925 }
 926
 927 static void ccid3_hc_rx_update_li(struct sock *sk, u64 seq_loss, u8 win_loss)
 928 {
 929         struct dccp_sock *dp = dccp_sk(sk);
 930         struct ccid3_hc_rx_sock *hcrx = dp->dccps_hc_rx_ccid_private;
 931
 932         if (seq_loss != DCCP_MAX_SEQNO + 1 &&
 933             list_empty(&hcrx->ccid3hcrx_li_hist)) {
 934                 struct dccp_li_hist_entry *li_tail;
 935
 936                 li_tail = dccp_li_hist_interval_new(ccid3_li_hist,
 937                                                     &hcrx->ccid3hcrx_li_hist,
 938                                                     seq_loss, win_loss);
 939                 if (li_tail == NULL)
 940                         return;
 941                 li_tail->dccplih_interval = ccid3_hc_rx_calc_first_li(sk);
 942         }
 943         /* FIXME: find end of interval */
 944 }
 945
 946 static void ccid3_hc_rx_detect_loss(struct sock *sk)
 947 {
 948         struct dccp_sock *dp = dccp_sk(sk);
 949         struct ccid3_hc_rx_sock *hcrx = dp->dccps_hc_rx_ccid_private;
 950         u8 win_loss;
 951         const u64 seq_loss = dccp_rx_hist_detect_loss(&hcrx->ccid3hcrx_hist,
 952                                                       &hcrx->ccid3hcrx_li_hist,
 953                                                       &win_loss);
 954
 955         ccid3_hc_rx_update_li(sk, seq_loss, win_loss);
 956 }
 957
 958 static void ccid3_hc_rx_packet_recv(struct sock *sk, struct sk_buff *skb)
 959 {
 960         struct dccp_sock *dp = dccp_sk(sk);
 961         struct ccid3_hc_rx_sock *hcrx = dp->dccps_hc_rx_ccid_private;
 962         const struct dccp_options_received *opt_recv;
 963         struct dccp_rx_hist_entry *packet;
 964         struct timeval now;
 965         u8 win_count;
 966         u32 p_prev, r_sample, t_elapsed;
 967         int ins;
 968
 969         if (hcrx == NULL)
 970                 return;
 971
 972         BUG_ON(!(hcrx->ccid3hcrx_state == TFRC_RSTATE_NO_DATA ||
 973                  hcrx->ccid3hcrx_state == TFRC_RSTATE_DATA));
 974
 975         opt_recv = &dp->dccps_options_received;
 976
 977         switch (DCCP_SKB_CB(skb)->dccpd_type) {
 978         case DCCP_PKT_ACK:
 979                 if (hcrx->ccid3hcrx_state == TFRC_RSTATE_NO_DATA)
 980                         return;
 981         case DCCP_PKT_DATAACK:
 982                 if (opt_recv->dccpor_timestamp_echo == 0)
 983                         break;
 984                 p_prev = hcrx->ccid3hcrx_rtt;
 985                 dccp_timestamp(sk, &now);
 986                 timeval_sub_usecs(&now, opt_recv->dccpor_timestamp_echo * 10);
 987                 r_sample = timeval_usecs(&now);
 988                 t_elapsed = opt_recv->dccpor_elapsed_time * 10;
 989
 990                 if (unlikely(r_sample <= t_elapsed))
 991                         LIMIT_NETDEBUG(KERN_WARNING
 992                                        "%s: r_sample=%uus, t_elapsed=%uus\n",
 993                                        __FUNCTION__, r_sample, t_elapsed);
 994                 else
 995                         r_sample -= t_elapsed;
 996
 997                 if (hcrx->ccid3hcrx_state == TFRC_RSTATE_NO_DATA)
 998                         hcrx->ccid3hcrx_rtt = r_sample;
 999                 else
1000                         hcrx->ccid3hcrx_rtt = (hcrx->ccid3hcrx_rtt * 9) / 10 +
1001                                               r_sample / 10;
1002
1003                 if (p_prev != hcrx->ccid3hcrx_rtt)
1004                         ccid3_pr_debug("%s, New RTT=%luus, elapsed time=%u\n",
1005                                        dccp_role(sk), hcrx->ccid3hcrx_rtt,
1006                                        opt_recv->dccpor_elapsed_time);
1007                 break;
1008         case DCCP_PKT_DATA:
1009                 break;
1010         default:
1011                 ccid3_pr_debug("%s, sk=%p, not DATA/DATAACK/ACK packet(%s)\n",
1012                                dccp_role(sk), sk,
1013                                dccp_packet_name(DCCP_SKB_CB(skb)->dccpd_type));
1014                 return;
1015         }
1016
1017         packet = dccp_rx_hist_entry_new(ccid3_rx_hist, sk, opt_recv->dccpor_ndp,
1018                                         skb, SLAB_ATOMIC);
1019         if (packet == NULL) {
1020                 ccid3_pr_debug("%s, sk=%p, Not enough mem to add rx packet "
1021                                "to history (consider it lost)!",
1022                                dccp_role(sk), sk);
1023                 return;
1024         }
1025
1026         win_count = packet->dccphrx_ccval;
1027
1028         ins = dccp_rx_hist_add_packet(ccid3_rx_hist, &hcrx->ccid3hcrx_hist,
1029                                       &hcrx->ccid3hcrx_li_hist, packet);
1030
1031         if (DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_ACK)
1032                 return;
1033
1034         switch (hcrx->ccid3hcrx_state) {
1035         case TFRC_RSTATE_NO_DATA:
1036                 ccid3_pr_debug("%s, sk=%p(%s), skb=%p, sending initial "
1037                                "feedback\n",
1038                                dccp_role(sk), sk,
1039                                dccp_state_name(sk->sk_state), skb);
1040                 ccid3_hc_rx_send_feedback(sk);
1041                 ccid3_hc_rx_set_state(sk, TFRC_RSTATE_DATA);
1042                 return;
1043         case TFRC_RSTATE_DATA:
1044                 hcrx->ccid3hcrx_bytes_recv += skb->len -
1045                                               dccp_hdr(skb)->dccph_doff * 4;
1046                 if (ins != 0)
1047                         break;
1048
1049                 dccp_timestamp(sk, &now);
1050                 if (timeval_delta(&now, &hcrx->ccid3hcrx_tstamp_last_ack) >=
1051                     hcrx->ccid3hcrx_rtt) {
1052                         hcrx->ccid3hcrx_tstamp_last_ack = now;
1053                         ccid3_hc_rx_send_feedback(sk);
1054                 }
1055                 return;
1056         default:
1057                 printk(KERN_CRIT "%s: %s, sk=%p, Illegal state (%d)!\n",
1058                        __FUNCTION__, dccp_role(sk), sk, hcrx->ccid3hcrx_state);
1059                 dump_stack();
1060                 return;
1061         }
1062
1063         /* Dealing with packet loss */
1064         ccid3_pr_debug("%s, sk=%p(%s), data loss! Reacting...\n",
1065                        dccp_role(sk), sk, dccp_state_name(sk->sk_state));
1066
1067         ccid3_hc_rx_detect_loss(sk);
1068         p_prev = hcrx->ccid3hcrx_p;
1069
1070         /* Calculate loss event rate */
1071         if (!list_empty(&hcrx->ccid3hcrx_li_hist))
1072                 /* Scaling up by 1000000 as fixed decimal */
1073                 hcrx->ccid3hcrx_p = 1000000 / dccp_li_hist_calc_i_mean(&hcrx->ccid3hcrx_li_hist);
1074
1075         if (hcrx->ccid3hcrx_p > p_prev) {
1076                 ccid3_hc_rx_send_feedback(sk);
1077                 return;
1078         }
1079 }
1080
1081 static int ccid3_hc_rx_init(struct sock *sk)
1082 {
1083         struct dccp_sock *dp = dccp_sk(sk);
1084         struct ccid3_hc_rx_sock *hcrx;
1085
1086         ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
1087
1088         hcrx = dp->dccps_hc_rx_ccid_private = kmalloc(sizeof(*hcrx),
1089                                                       gfp_any());
1090         if (hcrx == NULL)
1091                 return -ENOMEM;
1092
1093         memset(hcrx, 0, sizeof(*hcrx));
1094
1095         if (dp->dccps_packet_size >= TFRC_MIN_PACKET_SIZE &&
1096             dp->dccps_packet_size <= TFRC_MAX_PACKET_SIZE)
1097                 hcrx->ccid3hcrx_s = dp->dccps_packet_size;
1098         else
1099                 hcrx->ccid3hcrx_s = TFRC_STD_PACKET_SIZE;
1100
1101         hcrx->ccid3hcrx_state = TFRC_RSTATE_NO_DATA;
1102         INIT_LIST_HEAD(&hcrx->ccid3hcrx_hist);
1103         INIT_LIST_HEAD(&hcrx->ccid3hcrx_li_hist);
1104         dccp_timestamp(sk, &hcrx->ccid3hcrx_tstamp_last_ack);
1105         hcrx->ccid3hcrx_tstamp_last_feedback = hcrx->ccid3hcrx_tstamp_last_ack;
1106         hcrx->ccid3hcrx_rtt = 5000; /* XXX 5ms for now... */
1107         return 0;
1108 }
1109
1110 static void ccid3_hc_rx_exit(struct sock *sk)
1111 {
1112         struct dccp_sock *dp = dccp_sk(sk);
1113         struct ccid3_hc_rx_sock *hcrx = dp->dccps_hc_rx_ccid_private;
1114
1115         ccid3_pr_debug("%s, sk=%p\n", dccp_role(sk), sk);
1116
1117         if (hcrx == NULL)
1118                 return;
1119
1120         ccid3_hc_rx_set_state(sk, TFRC_RSTATE_TERM);
1121
1122         /* Empty packet history */
1123         dccp_rx_hist_purge(ccid3_rx_hist, &hcrx->ccid3hcrx_hist);
1124
1125         /* Empty loss interval history */
1126         dccp_li_hist_purge(ccid3_li_hist, &hcrx->ccid3hcrx_li_hist);
1127
1128         kfree(dp->dccps_hc_rx_ccid_private);
1129         dp->dccps_hc_rx_ccid_private = NULL;
1130 }
1131
1132 static void ccid3_hc_rx_get_info(struct sock *sk, struct tcp_info *info)
1133 {
1134         const struct dccp_sock *dp = dccp_sk(sk);
1135         const struct ccid3_hc_rx_sock *hcrx = dp->dccps_hc_rx_ccid_private;
1136
1137         if (hcrx == NULL)
1138                 return;
1139
1140         info->tcpi_ca_state     = hcrx->ccid3hcrx_state;
1141         info->tcpi_options      |= TCPI_OPT_TIMESTAMPS;
1142         info->tcpi_rcv_rtt      = hcrx->ccid3hcrx_rtt;
1143 }
1144
1145 static void ccid3_hc_tx_get_info(struct sock *sk, struct tcp_info *info)
1146 {
1147         const struct dccp_sock *dp = dccp_sk(sk);
1148         const struct ccid3_hc_tx_sock *hctx = dp->dccps_hc_tx_ccid_private;
1149
1150         if (hctx == NULL)
1151                 return;
1152
1153         info->tcpi_rto = hctx->ccid3hctx_t_rto;
1154         info->tcpi_rtt = hctx->ccid3hctx_rtt;
1155 }
1156
1157 static struct ccid ccid3 = {
1158         .ccid_id                   = 3,
1159         .ccid_name                 = "ccid3",
1160         .ccid_owner                = THIS_MODULE,
1161         .ccid_init                 = ccid3_init,
1162         .ccid_exit                 = ccid3_exit,
1163         .ccid_hc_tx_init           = ccid3_hc_tx_init,
1164         .ccid_hc_tx_exit           = ccid3_hc_tx_exit,
1165         .ccid_hc_tx_send_packet    = ccid3_hc_tx_send_packet,
1166         .ccid_hc_tx_packet_sent    = ccid3_hc_tx_packet_sent,
1167         .ccid_hc_tx_packet_recv    = ccid3_hc_tx_packet_recv,
1168         .ccid_hc_tx_insert_options = ccid3_hc_tx_insert_options,
1169         .ccid_hc_tx_parse_options  = ccid3_hc_tx_parse_options,
1170         .ccid_hc_rx_init           = ccid3_hc_rx_init,
1171         .ccid_hc_rx_exit           = ccid3_hc_rx_exit,
1172         .ccid_hc_rx_insert_options = ccid3_hc_rx_insert_options,
1173         .ccid_hc_rx_packet_recv    = ccid3_hc_rx_packet_recv,
1174         .ccid_hc_rx_get_info       = ccid3_hc_rx_get_info,
1175         .ccid_hc_tx_get_info       = ccid3_hc_tx_get_info,
1176 };
1177
1178 module_param(ccid3_debug, int, 0444);
1179 MODULE_PARM_DESC(ccid3_debug, "Enable debug messages");
1180
1181 static __init int ccid3_module_init(void)
1182 {
1183         int rc = -ENOBUFS;
1184
1185         ccid3_rx_hist = dccp_rx_hist_new("ccid3");
1186         if (ccid3_rx_hist == NULL)
1187                 goto out;
1188
1189         ccid3_tx_hist = dccp_tx_hist_new("ccid3");
1190         if (ccid3_tx_hist == NULL)
1191                 goto out_free_rx;
1192
1193         ccid3_li_hist = dccp_li_hist_new("ccid3");
1194         if (ccid3_li_hist == NULL)
1195                 goto out_free_tx;
1196
1197         rc = ccid_register(&ccid3);
1198         if (rc != 0)
1199                 goto out_free_loss_interval_history;
1200 out:
1201         return rc;
1202
1203 out_free_loss_interval_history:
1204         dccp_li_hist_delete(ccid3_li_hist);
1205         ccid3_li_hist = NULL;
1206 out_free_tx:
1207         dccp_tx_hist_delete(ccid3_tx_hist);
1208         ccid3_tx_hist = NULL;
1209 out_free_rx:
1210         dccp_rx_hist_delete(ccid3_rx_hist);
1211         ccid3_rx_hist = NULL;
1212         goto out;
1213 }
1214 module_init(ccid3_module_init);
1215
1216 static __exit void ccid3_module_exit(void)
1217 {
1218 #ifdef CONFIG_IP_DCCP_UNLOAD_HACK
1219         /*
1220          * Hack to use while developing, so that we get rid of the control
1221          * sock, that is what keeps a refcount on dccp.ko -acme
1222          */
1223         extern void dccp_ctl_sock_exit(void);
1224
1225         dccp_ctl_sock_exit();
1226 #endif
1227         ccid_unregister(&ccid3);
1228
1229         if (ccid3_tx_hist != NULL) {
1230                 dccp_tx_hist_delete(ccid3_tx_hist);
1231                 ccid3_tx_hist = NULL;
1232         }
1233         if (ccid3_rx_hist != NULL) {
1234                 dccp_rx_hist_delete(ccid3_rx_hist);
1235                 ccid3_rx_hist = NULL;
1236         }
1237         if (ccid3_li_hist != NULL) {
1238                 dccp_li_hist_delete(ccid3_li_hist);
1239                 ccid3_li_hist = NULL;
1240         }
1241 }
1242 module_exit(ccid3_module_exit);
1243
1244 MODULE_AUTHOR("Ian McDonald <iam4@cs.waikato.ac.nz>, "
1245               "Arnaldo Carvalho de Melo <acme@ghostprotocols.net>");
1246 MODULE_DESCRIPTION("DCCP TFRC CCID3 CCID");
1247 MODULE_LICENSE("GPL");
1248 MODULE_ALIAS("net-dccp-ccid-3");