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