net/sctp/associola.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /* SCTP kernel implementation
   3  * (C) Copyright IBM Corp. 2001, 2004
   4  * Copyright (c) 1999-2000 Cisco, Inc.
   5  * Copyright (c) 1999-2001 Motorola, Inc.
   6  * Copyright (c) 2001 Intel Corp.
   7  * Copyright (c) 2001 La Monte H.P. Yarroll
   8  *
   9  * This file is part of the SCTP kernel implementation
  10  *
  11  * This module provides the abstraction for an SCTP association.
  12  *
  13  * Please send any bug reports or fixes you make to the
  14  * email address(es):
  15  *    lksctp developers <[email protected]>
  16  *
  17  * Written or modified by:
  18  *    La Monte H.P. Yarroll <[email protected]>
  19  *    Karl Knutson          <[email protected]>
  20  *    Jon Grimm             <[email protected]>
  21  *    Xingang Guo           <[email protected]>
  22  *    Hui Huang             <[email protected]>
  23  *    Sridhar Samudrala     <[email protected]>
  24  *    Daisy Chang           <[email protected]>
  25  *    Ryan Layer            <[email protected]>
  26  *    Kevin Gao             <[email protected]>
  27  */
  28
  29 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  30
  31 #include <linux/types.h>
  32 #include <linux/fcntl.h>
  33 #include <linux/poll.h>
  34 #include <linux/init.h>
  35
  36 #include <linux/slab.h>
  37 #include <linux/in.h>
  38 #include <net/ipv6.h>
  39 #include <net/sctp/sctp.h>
  40 #include <net/sctp/sm.h>
  41
  42 /* Forward declarations for internal functions. */
  43 static void sctp_select_active_and_retran_path(struct sctp_association *asoc);
  44 static void sctp_assoc_bh_rcv(struct work_struct *work);
  45 static void sctp_assoc_free_asconf_acks(struct sctp_association *asoc);
  46 static void sctp_assoc_free_asconf_queue(struct sctp_association *asoc);
  47
  48 /* 1st Level Abstractions. */
  49
  50 /* Initialize a new association from provided memory. */
  51 static struct sctp_association *sctp_association_init(
  52                                         struct sctp_association *asoc,
  53                                         const struct sctp_endpoint *ep,
  54                                         const struct sock *sk,
  55                                         enum sctp_scope scope, gfp_t gfp)
  56 {
  57         struct sctp_sock *sp;
  58         struct sctp_paramhdr *p;
  59         int i;
  60
  61         /* Retrieve the SCTP per socket area.  */
  62         sp = sctp_sk((struct sock *)sk);
  63
  64         /* Discarding const is appropriate here.  */
  65         asoc->ep = (struct sctp_endpoint *)ep;
  66         asoc->base.sk = (struct sock *)sk;
  67
  68         sctp_endpoint_hold(asoc->ep);
  69         sock_hold(asoc->base.sk);
  70
  71         /* Initialize the common base substructure.  */
  72         asoc->base.type = SCTP_EP_TYPE_ASSOCIATION;
  73
  74         /* Initialize the object handling fields.  */
  75         refcount_set(&asoc->base.refcnt, 1);
  76
  77         /* Initialize the bind addr area.  */
  78         sctp_bind_addr_init(&asoc->base.bind_addr, ep->base.bind_addr.port);
  79
  80         asoc->state = SCTP_STATE_CLOSED;
  81         asoc->cookie_life = ms_to_ktime(sp->assocparams.sasoc_cookie_life);
  82         asoc->user_frag = sp->user_frag;
  83
  84         /* Set the association max_retrans and RTO values from the
  85          * socket values.
  86          */
  87         asoc->max_retrans = sp->assocparams.sasoc_asocmaxrxt;
  88         asoc->pf_retrans  = sp->pf_retrans;
  89         asoc->ps_retrans  = sp->ps_retrans;
  90         asoc->pf_expose   = sp->pf_expose;
  91
  92         asoc->rto_initial = msecs_to_jiffies(sp->rtoinfo.srto_initial);
  93         asoc->rto_max = msecs_to_jiffies(sp->rtoinfo.srto_max);
  94         asoc->rto_min = msecs_to_jiffies(sp->rtoinfo.srto_min);
  95
  96         /* Initialize the association's heartbeat interval based on the
  97          * sock configured value.
  98          */
  99         asoc->hbinterval = msecs_to_jiffies(sp->hbinterval);
 100
 101         /* Initialize path max retrans value. */
 102         asoc->pathmaxrxt = sp->pathmaxrxt;
 103
 104         asoc->flowlabel = sp->flowlabel;
 105         asoc->dscp = sp->dscp;
 106
 107         /* Set association default SACK delay */
 108         asoc->sackdelay = msecs_to_jiffies(sp->sackdelay);
 109         asoc->sackfreq = sp->sackfreq;
 110
 111         /* Set the association default flags controlling
 112          * Heartbeat, SACK delay, and Path MTU Discovery.
 113          */
 114         asoc->param_flags = sp->param_flags;
 115
 116         /* Initialize the maximum number of new data packets that can be sent
 117          * in a burst.
 118          */
 119         asoc->max_burst = sp->max_burst;
 120
 121         asoc->subscribe = sp->subscribe;
 122
 123         /* initialize association timers */
 124         asoc->timeouts[SCTP_EVENT_TIMEOUT_T1_COOKIE] = asoc->rto_initial;
 125         asoc->timeouts[SCTP_EVENT_TIMEOUT_T1_INIT] = asoc->rto_initial;
 126         asoc->timeouts[SCTP_EVENT_TIMEOUT_T2_SHUTDOWN] = asoc->rto_initial;
 127
 128         /* sctpimpguide Section 2.12.2
 129          * If the 'T5-shutdown-guard' timer is used, it SHOULD be set to the
 130          * recommended value of 5 times 'RTO.Max'.
 131          */
 132         asoc->timeouts[SCTP_EVENT_TIMEOUT_T5_SHUTDOWN_GUARD]
 133                 = 5 * asoc->rto_max;
 134
 135         asoc->timeouts[SCTP_EVENT_TIMEOUT_SACK] = asoc->sackdelay;
 136         asoc->timeouts[SCTP_EVENT_TIMEOUT_AUTOCLOSE] = sp->autoclose * HZ;
 137
 138         /* Initializes the timers */
 139         for (i = SCTP_EVENT_TIMEOUT_NONE; i < SCTP_NUM_TIMEOUT_TYPES; ++i)
 140                 timer_setup(&asoc->timers[i], sctp_timer_events[i], 0);
 141
 142         /* Pull default initialization values from the sock options.
 143          * Note: This assumes that the values have already been
 144          * validated in the sock.
 145          */
 146         asoc->c.sinit_max_instreams = sp->initmsg.sinit_max_instreams;
 147         asoc->c.sinit_num_ostreams  = sp->initmsg.sinit_num_ostreams;
 148         asoc->max_init_attempts = sp->initmsg.sinit_max_attempts;
 149
 150         asoc->max_init_timeo =
 151                  msecs_to_jiffies(sp->initmsg.sinit_max_init_timeo);
 152
 153         /* Set the local window size for receive.
 154          * This is also the rcvbuf space per association.
 155          * RFC 6 - A SCTP receiver MUST be able to receive a minimum of
 156          * 1500 bytes in one SCTP packet.
 157          */
 158         if ((sk->sk_rcvbuf/2) < SCTP_DEFAULT_MINWINDOW)
 159                 asoc->rwnd = SCTP_DEFAULT_MINWINDOW;
 160         else
 161                 asoc->rwnd = sk->sk_rcvbuf/2;
 162
 163         asoc->a_rwnd = asoc->rwnd;
 164
 165         /* Use my own max window until I learn something better.  */
 166         asoc->peer.rwnd = SCTP_DEFAULT_MAXWINDOW;
 167
 168         /* Initialize the receive memory counter */
 169         atomic_set(&asoc->rmem_alloc, 0);
 170
 171         init_waitqueue_head(&asoc->wait);
 172
 173         asoc->c.my_vtag = sctp_generate_tag(ep);
 174         asoc->c.my_port = ep->base.bind_addr.port;
 175
 176         asoc->c.initial_tsn = sctp_generate_tsn(ep);
 177
 178         asoc->next_tsn = asoc->c.initial_tsn;
 179
 180         asoc->ctsn_ack_point = asoc->next_tsn - 1;
 181         asoc->adv_peer_ack_point = asoc->ctsn_ack_point;
 182         asoc->highest_sacked = asoc->ctsn_ack_point;
 183         asoc->last_cwr_tsn = asoc->ctsn_ack_point;
 184
 185         /* ADDIP Section 4.1 Asconf Chunk Procedures
 186          *
 187          * When an endpoint has an ASCONF signaled change to be sent to the
 188          * remote endpoint it should do the following:
 189          * ...
 190          * A2) a serial number should be assigned to the chunk. The serial
 191          * number SHOULD be a monotonically increasing number. The serial
 192          * numbers SHOULD be initialized at the start of the
 193          * association to the same value as the initial TSN.
 194          */
 195         asoc->addip_serial = asoc->c.initial_tsn;
 196         asoc->strreset_outseq = asoc->c.initial_tsn;
 197
 198         INIT_LIST_HEAD(&asoc->addip_chunk_list);
 199         INIT_LIST_HEAD(&asoc->asconf_ack_list);
 200
 201         /* Make an empty list of remote transport addresses.  */
 202         INIT_LIST_HEAD(&asoc->peer.transport_addr_list);
 203
 204         /* RFC 2960 5.1 Normal Establishment of an Association
 205          *
 206          * After the reception of the first data chunk in an
 207          * association the endpoint must immediately respond with a
 208          * sack to acknowledge the data chunk.  Subsequent
 209          * acknowledgements should be done as described in Section
 210          * 6.2.
 211          *
 212          * [We implement this by telling a new association that it
 213          * already received one packet.]
 214          */
 215         asoc->peer.sack_needed = 1;
 216         asoc->peer.sack_generation = 1;
 217
 218         /* Create an input queue.  */
 219         sctp_inq_init(&asoc->base.inqueue);
 220         sctp_inq_set_th_handler(&asoc->base.inqueue, sctp_assoc_bh_rcv);
 221
 222         /* Create an output queue.  */
 223         sctp_outq_init(asoc, &asoc->outqueue);
 224
 225         if (!sctp_ulpq_init(&asoc->ulpq, asoc))
 226                 goto fail_init;
 227
 228         if (sctp_stream_init(&asoc->stream, asoc->c.sinit_num_ostreams,
 229                              0, gfp))
 230                 goto fail_init;
 231
 232         /* Initialize default path MTU. */
 233         asoc->pathmtu = sp->pathmtu;
 234         sctp_assoc_update_frag_point(asoc);
 235
 236         /* Assume that peer would support both address types unless we are
 237          * told otherwise.
 238          */
 239         asoc->peer.ipv4_address = 1;
 240         if (asoc->base.sk->sk_family == PF_INET6)
 241                 asoc->peer.ipv6_address = 1;
 242         INIT_LIST_HEAD(&asoc->asocs);
 243
 244         asoc->default_stream = sp->default_stream;
 245         asoc->default_ppid = sp->default_ppid;
 246         asoc->default_flags = sp->default_flags;
 247         asoc->default_context = sp->default_context;
 248         asoc->default_timetolive = sp->default_timetolive;
 249         asoc->default_rcv_context = sp->default_rcv_context;
 250
 251         /* AUTH related initializations */
 252         INIT_LIST_HEAD(&asoc->endpoint_shared_keys);
 253         if (sctp_auth_asoc_copy_shkeys(ep, asoc, gfp))
 254                 goto stream_free;
 255
 256         asoc->active_key_id = ep->active_key_id;
 257         asoc->strreset_enable = ep->strreset_enable;
 258
 259         /* Save the hmacs and chunks list into this association */
 260         if (ep->auth_hmacs_list)
 261                 memcpy(asoc->c.auth_hmacs, ep->auth_hmacs_list,
 262                         ntohs(ep->auth_hmacs_list->param_hdr.length));
 263         if (ep->auth_chunk_list)
 264                 memcpy(asoc->c.auth_chunks, ep->auth_chunk_list,
 265                         ntohs(ep->auth_chunk_list->param_hdr.length));
 266
 267         /* Get the AUTH random number for this association */
 268         p = (struct sctp_paramhdr *)asoc->c.auth_random;
 269         p->type = SCTP_PARAM_RANDOM;
 270         p->length = htons(sizeof(*p) + SCTP_AUTH_RANDOM_LENGTH);
 271         get_random_bytes(p+1, SCTP_AUTH_RANDOM_LENGTH);
 272
 273         return asoc;
 274
 275 stream_free:
 276         sctp_stream_free(&asoc->stream);
 277 fail_init:
 278         sock_put(asoc->base.sk);
 279         sctp_endpoint_put(asoc->ep);
 280         return NULL;
 281 }
 282
 283 /* Allocate and initialize a new association */
 284 struct sctp_association *sctp_association_new(const struct sctp_endpoint *ep,
 285                                               const struct sock *sk,
 286                                               enum sctp_scope scope, gfp_t gfp)
 287 {
 288         struct sctp_association *asoc;
 289
 290         asoc = kzalloc(sizeof(*asoc), gfp);
 291         if (!asoc)
 292                 goto fail;
 293
 294         if (!sctp_association_init(asoc, ep, sk, scope, gfp))
 295                 goto fail_init;
 296
 297         SCTP_DBG_OBJCNT_INC(assoc);
 298
 299         pr_debug("Created asoc %p\n", asoc);
 300
 301         return asoc;
 302
 303 fail_init:
 304         kfree(asoc);
 305 fail:
 306         return NULL;
 307 }
 308
 309 /* Free this association if possible.  There may still be users, so
 310  * the actual deallocation may be delayed.
 311  */
 312 void sctp_association_free(struct sctp_association *asoc)
 313 {
 314         struct sock *sk = asoc->base.sk;
 315         struct sctp_transport *transport;
 316         struct list_head *pos, *temp;
 317         int i;
 318
 319         /* Only real associations count against the endpoint, so
 320          * don't bother for if this is a temporary association.
 321          */
 322         if (!list_empty(&asoc->asocs)) {
 323                 list_del(&asoc->asocs);
 324
 325                 /* Decrement the backlog value for a TCP-style listening
 326                  * socket.
 327                  */
 328                 if (sctp_style(sk, TCP) && sctp_sstate(sk, LISTENING))
 329                         sk_acceptq_removed(sk);
 330         }
 331
 332         /* Mark as dead, so other users can know this structure is
 333          * going away.
 334          */
 335         asoc->base.dead = true;
 336
 337         /* Dispose of any data lying around in the outqueue. */
 338         sctp_outq_free(&asoc->outqueue);
 339
 340         /* Dispose of any pending messages for the upper layer. */
 341         sctp_ulpq_free(&asoc->ulpq);
 342
 343         /* Dispose of any pending chunks on the inqueue. */
 344         sctp_inq_free(&asoc->base.inqueue);
 345
 346         sctp_tsnmap_free(&asoc->peer.tsn_map);
 347
 348         /* Free stream information. */
 349         sctp_stream_free(&asoc->stream);
 350
 351         if (asoc->strreset_chunk)
 352                 sctp_chunk_free(asoc->strreset_chunk);
 353
 354         /* Clean up the bound address list. */
 355         sctp_bind_addr_free(&asoc->base.bind_addr);
 356
 357         /* Do we need to go through all of our timers and
 358          * delete them?   To be safe we will try to delete all, but we
 359          * should be able to go through and make a guess based
 360          * on our state.
 361          */
 362         for (i = SCTP_EVENT_TIMEOUT_NONE; i < SCTP_NUM_TIMEOUT_TYPES; ++i) {
 363                 if (del_timer(&asoc->timers[i]))
 364                         sctp_association_put(asoc);
 365         }
 366
 367         /* Free peer's cached cookie. */
 368         kfree(asoc->peer.cookie);
 369         kfree(asoc->peer.peer_random);
 370         kfree(asoc->peer.peer_chunks);
 371         kfree(asoc->peer.peer_hmacs);
 372
 373         /* Release the transport structures. */
 374         list_for_each_safe(pos, temp, &asoc->peer.transport_addr_list) {
 375                 transport = list_entry(pos, struct sctp_transport, transports);
 376                 list_del_rcu(pos);
 377                 sctp_unhash_transport(transport);
 378                 sctp_transport_free(transport);
 379         }
 380
 381         asoc->peer.transport_count = 0;
 382
 383         sctp_asconf_queue_teardown(asoc);
 384
 385         /* Free pending address space being deleted */
 386         kfree(asoc->asconf_addr_del_pending);
 387
 388         /* AUTH - Free the endpoint shared keys */
 389         sctp_auth_destroy_keys(&asoc->endpoint_shared_keys);
 390
 391         /* AUTH - Free the association shared key */
 392         sctp_auth_key_put(asoc->asoc_shared_key);
 393
 394         sctp_association_put(asoc);
 395 }
 396
 397 /* Cleanup and free up an association. */
 398 static void sctp_association_destroy(struct sctp_association *asoc)
 399 {
 400         if (unlikely(!asoc->base.dead)) {
 401                 WARN(1, "Attempt to destroy undead association %p!\n", asoc);
 402                 return;
 403         }
 404
 405         sctp_endpoint_put(asoc->ep);
 406         sock_put(asoc->base.sk);
 407
 408         if (asoc->assoc_id != 0) {
 409                 spin_lock_bh(&sctp_assocs_id_lock);
 410                 idr_remove(&sctp_assocs_id, asoc->assoc_id);
 411                 spin_unlock_bh(&sctp_assocs_id_lock);
 412         }
 413
 414         WARN_ON(atomic_read(&asoc->rmem_alloc));
 415
 416         kfree_rcu(asoc, rcu);
 417         SCTP_DBG_OBJCNT_DEC(assoc);
 418 }
 419
 420 /* Change the primary destination address for the peer. */
 421 void sctp_assoc_set_primary(struct sctp_association *asoc,
 422                             struct sctp_transport *transport)
 423 {
 424         int changeover = 0;
 425
 426         /* it's a changeover only if we already have a primary path
 427          * that we are changing
 428          */
 429         if (asoc->peer.primary_path != NULL &&
 430             asoc->peer.primary_path != transport)
 431                 changeover = 1 ;
 432
 433         asoc->peer.primary_path = transport;
 434         sctp_ulpevent_nofity_peer_addr_change(transport,
 435                                               SCTP_ADDR_MADE_PRIM, 0);
 436
 437         /* Set a default msg_name for events. */
 438         memcpy(&asoc->peer.primary_addr, &transport->ipaddr,
 439                sizeof(union sctp_addr));
 440
 441         /* If the primary path is changing, assume that the
 442          * user wants to use this new path.
 443          */
 444         if ((transport->state == SCTP_ACTIVE) ||
 445             (transport->state == SCTP_UNKNOWN))
 446                 asoc->peer.active_path = transport;
 447
 448         /*
 449          * SFR-CACC algorithm:
 450          * Upon the receipt of a request to change the primary
 451          * destination address, on the data structure for the new
 452          * primary destination, the sender MUST do the following:
 453          *
 454          * 1) If CHANGEOVER_ACTIVE is set, then there was a switch
 455          * to this destination address earlier. The sender MUST set
 456          * CYCLING_CHANGEOVER to indicate that this switch is a
 457          * double switch to the same destination address.
 458          *
 459          * Really, only bother is we have data queued or outstanding on
 460          * the association.
 461          */
 462         if (!asoc->outqueue.outstanding_bytes && !asoc->outqueue.out_qlen)
 463                 return;
 464
 465         if (transport->cacc.changeover_active)
 466                 transport->cacc.cycling_changeover = changeover;
 467
 468         /* 2) The sender MUST set CHANGEOVER_ACTIVE to indicate that
 469          * a changeover has occurred.
 470          */
 471         transport->cacc.changeover_active = changeover;
 472
 473         /* 3) The sender MUST store the next TSN to be sent in
 474          * next_tsn_at_change.
 475          */
 476         transport->cacc.next_tsn_at_change = asoc->next_tsn;
 477 }
 478
 479 /* Remove a transport from an association.  */
 480 void sctp_assoc_rm_peer(struct sctp_association *asoc,
 481                         struct sctp_transport *peer)
 482 {
 483         struct sctp_transport *transport;
 484         struct list_head *pos;
 485         struct sctp_chunk *ch;
 486
 487         pr_debug("%s: association:%p addr:%pISpc\n",
 488                  __func__, asoc, &peer->ipaddr.sa);
 489
 490         /* If we are to remove the current retran_path, update it
 491          * to the next peer before removing this peer from the list.
 492          */
 493         if (asoc->peer.retran_path == peer)
 494                 sctp_assoc_update_retran_path(asoc);
 495
 496         /* Remove this peer from the list. */
 497         list_del_rcu(&peer->transports);
 498         /* Remove this peer from the transport hashtable */
 499         sctp_unhash_transport(peer);
 500
 501         /* Get the first transport of asoc. */
 502         pos = asoc->peer.transport_addr_list.next;
 503         transport = list_entry(pos, struct sctp_transport, transports);
 504
 505         /* Update any entries that match the peer to be deleted. */
 506         if (asoc->peer.primary_path == peer)
 507                 sctp_assoc_set_primary(asoc, transport);
 508         if (asoc->peer.active_path == peer)
 509                 asoc->peer.active_path = transport;
 510         if (asoc->peer.retran_path == peer)
 511                 asoc->peer.retran_path = transport;
 512         if (asoc->peer.last_data_from == peer)
 513                 asoc->peer.last_data_from = transport;
 514
 515         if (asoc->strreset_chunk &&
 516             asoc->strreset_chunk->transport == peer) {
 517                 asoc->strreset_chunk->transport = transport;
 518                 sctp_transport_reset_reconf_timer(transport);
 519         }
 520
 521         /* If we remove the transport an INIT was last sent to, set it to
 522          * NULL. Combined with the update of the retran path above, this
 523          * will cause the next INIT to be sent to the next available
 524          * transport, maintaining the cycle.
 525          */
 526         if (asoc->init_last_sent_to == peer)
 527                 asoc->init_last_sent_to = NULL;
 528
 529         /* If we remove the transport an SHUTDOWN was last sent to, set it
 530          * to NULL. Combined with the update of the retran path above, this
 531          * will cause the next SHUTDOWN to be sent to the next available
 532          * transport, maintaining the cycle.
 533          */
 534         if (asoc->shutdown_last_sent_to == peer)
 535                 asoc->shutdown_last_sent_to = NULL;
 536
 537         /* If we remove the transport an ASCONF was last sent to, set it to
 538          * NULL.
 539          */
 540         if (asoc->addip_last_asconf &&
 541             asoc->addip_last_asconf->transport == peer)
 542                 asoc->addip_last_asconf->transport = NULL;
 543
 544         /* If we have something on the transmitted list, we have to
 545          * save it off.  The best place is the active path.
 546          */
 547         if (!list_empty(&peer->transmitted)) {
 548                 struct sctp_transport *active = asoc->peer.active_path;
 549
 550                 /* Reset the transport of each chunk on this list */
 551                 list_for_each_entry(ch, &peer->transmitted,
 552                                         transmitted_list) {
 553                         ch->transport = NULL;
 554                         ch->rtt_in_progress = 0;
 555                 }
 556
 557                 list_splice_tail_init(&peer->transmitted,
 558                                         &active->transmitted);
 559
 560                 /* Start a T3 timer here in case it wasn't running so
 561                  * that these migrated packets have a chance to get
 562                  * retransmitted.
 563                  */
 564                 if (!timer_pending(&active->T3_rtx_timer))
 565                         if (!mod_timer(&active->T3_rtx_timer,
 566                                         jiffies + active->rto))
 567                                 sctp_transport_hold(active);
 568         }
 569
 570         list_for_each_entry(ch, &asoc->outqueue.out_chunk_list, list)
 571                 if (ch->transport == peer)
 572                         ch->transport = NULL;
 573
 574         asoc->peer.transport_count--;
 575
 576         sctp_ulpevent_nofity_peer_addr_change(peer, SCTP_ADDR_REMOVED, 0);
 577         sctp_transport_free(peer);
 578 }
 579
 580 /* Add a transport address to an association.  */
 581 struct sctp_transport *sctp_assoc_add_peer(struct sctp_association *asoc,
 582                                            const union sctp_addr *addr,
 583                                            const gfp_t gfp,
 584                                            const int peer_state)
 585 {
 586         struct net *net = sock_net(asoc->base.sk);
 587         struct sctp_transport *peer;
 588         struct sctp_sock *sp;
 589         unsigned short port;
 590
 591         sp = sctp_sk(asoc->base.sk);
 592
 593         /* AF_INET and AF_INET6 share common port field. */
 594         port = ntohs(addr->v4.sin_port);
 595
 596         pr_debug("%s: association:%p addr:%pISpc state:%d\n", __func__,
 597                  asoc, &addr->sa, peer_state);
 598
 599         /* Set the port if it has not been set yet.  */
 600         if (0 == asoc->peer.port)
 601                 asoc->peer.port = port;
 602
 603         /* Check to see if this is a duplicate. */
 604         peer = sctp_assoc_lookup_paddr(asoc, addr);
 605         if (peer) {
 606                 /* An UNKNOWN state is only set on transports added by
 607                  * user in sctp_connectx() call.  Such transports should be
 608                  * considered CONFIRMED per RFC 4960, Section 5.4.
 609                  */
 610                 if (peer->state == SCTP_UNKNOWN) {
 611                         peer->state = SCTP_ACTIVE;
 612                 }
 613                 return peer;
 614         }
 615
 616         peer = sctp_transport_new(net, addr, gfp);
 617         if (!peer)
 618                 return NULL;
 619
 620         sctp_transport_set_owner(peer, asoc);
 621
 622         /* Initialize the peer's heartbeat interval based on the
 623          * association configured value.
 624          */
 625         peer->hbinterval = asoc->hbinterval;
 626
 627         /* Set the path max_retrans.  */
 628         peer->pathmaxrxt = asoc->pathmaxrxt;
 629
 630         /* And the partial failure retrans threshold */
 631         peer->pf_retrans = asoc->pf_retrans;
 632         /* And the primary path switchover retrans threshold */
 633         peer->ps_retrans = asoc->ps_retrans;
 634
 635         /* Initialize the peer's SACK delay timeout based on the
 636          * association configured value.
 637          */
 638         peer->sackdelay = asoc->sackdelay;
 639         peer->sackfreq = asoc->sackfreq;
 640
 641         if (addr->sa.sa_family == AF_INET6) {
 642                 __be32 info = addr->v6.sin6_flowinfo;
 643
 644                 if (info) {
 645                         peer->flowlabel = ntohl(info & IPV6_FLOWLABEL_MASK);
 646                         peer->flowlabel |= SCTP_FLOWLABEL_SET_MASK;
 647                 } else {
 648                         peer->flowlabel = asoc->flowlabel;
 649                 }
 650         }
 651         peer->dscp = asoc->dscp;
 652
 653         /* Enable/disable heartbeat, SACK delay, and path MTU discovery
 654          * based on association setting.
 655          */
 656         peer->param_flags = asoc->param_flags;
 657
 658         /* Initialize the pmtu of the transport. */
 659         sctp_transport_route(peer, NULL, sp);
 660
 661         /* If this is the first transport addr on this association,
 662          * initialize the association PMTU to the peer's PMTU.
 663          * If not and the current association PMTU is higher than the new
 664          * peer's PMTU, reset the association PMTU to the new peer's PMTU.
 665          */
 666         sctp_assoc_set_pmtu(asoc, asoc->pathmtu ?
 667                                   min_t(int, peer->pathmtu, asoc->pathmtu) :
 668                                   peer->pathmtu);
 669
 670         peer->pmtu_pending = 0;
 671
 672         /* The asoc->peer.port might not be meaningful yet, but
 673          * initialize the packet structure anyway.
 674          */
 675         sctp_packet_init(&peer->packet, peer, asoc->base.bind_addr.port,
 676                          asoc->peer.port);
 677
 678         /* 7.2.1 Slow-Start
 679          *
 680          * o The initial cwnd before DATA transmission or after a sufficiently
 681          *   long idle period MUST be set to
 682          *      min(4*MTU, max(2*MTU, 4380 bytes))
 683          *
 684          * o The initial value of ssthresh MAY be arbitrarily high
 685          *   (for example, implementations MAY use the size of the
 686          *   receiver advertised window).
 687          */
 688         peer->cwnd = min(4*asoc->pathmtu, max_t(__u32, 2*asoc->pathmtu, 4380));
 689
 690         /* At this point, we may not have the receiver's advertised window,
 691          * so initialize ssthresh to the default value and it will be set
 692          * later when we process the INIT.
 693          */
 694         peer->ssthresh = SCTP_DEFAULT_MAXWINDOW;
 695
 696         peer->partial_bytes_acked = 0;
 697         peer->flight_size = 0;
 698         peer->burst_limited = 0;
 699
 700         /* Set the transport's RTO.initial value */
 701         peer->rto = asoc->rto_initial;
 702         sctp_max_rto(asoc, peer);
 703
 704         /* Set the peer's active state. */
 705         peer->state = peer_state;
 706
 707         /* Add this peer into the transport hashtable */
 708         if (sctp_hash_transport(peer)) {
 709                 sctp_transport_free(peer);
 710                 return NULL;
 711         }
 712
 713         /* Attach the remote transport to our asoc.  */
 714         list_add_tail_rcu(&peer->transports, &asoc->peer.transport_addr_list);
 715         asoc->peer.transport_count++;
 716
 717         sctp_ulpevent_nofity_peer_addr_change(peer, SCTP_ADDR_ADDED, 0);
 718
 719         /* If we do not yet have a primary path, set one.  */
 720         if (!asoc->peer.primary_path) {
 721                 sctp_assoc_set_primary(asoc, peer);
 722                 asoc->peer.retran_path = peer;
 723         }
 724
 725         if (asoc->peer.active_path == asoc->peer.retran_path &&
 726             peer->state != SCTP_UNCONFIRMED) {
 727                 asoc->peer.retran_path = peer;
 728         }
 729
 730         return peer;
 731 }
 732
 733 /* Delete a transport address from an association.  */
 734 void sctp_assoc_del_peer(struct sctp_association *asoc,
 735                          const union sctp_addr *addr)
 736 {
 737         struct list_head        *pos;
 738         struct list_head        *temp;
 739         struct sctp_transport   *transport;
 740
 741         list_for_each_safe(pos, temp, &asoc->peer.transport_addr_list) {
 742                 transport = list_entry(pos, struct sctp_transport, transports);
 743                 if (sctp_cmp_addr_exact(addr, &transport->ipaddr)) {
 744                         /* Do book keeping for removing the peer and free it. */
 745                         sctp_assoc_rm_peer(asoc, transport);
 746                         break;
 747                 }
 748         }
 749 }
 750
 751 /* Lookup a transport by address. */
 752 struct sctp_transport *sctp_assoc_lookup_paddr(
 753                                         const struct sctp_association *asoc,
 754                                         const union sctp_addr *address)
 755 {
 756         struct sctp_transport *t;
 757
 758         /* Cycle through all transports searching for a peer address. */
 759
 760         list_for_each_entry(t, &asoc->peer.transport_addr_list,
 761                         transports) {
 762                 if (sctp_cmp_addr_exact(address, &t->ipaddr))
 763                         return t;
 764         }
 765
 766         return NULL;
 767 }
 768
 769 /* Remove all transports except a give one */
 770 void sctp_assoc_del_nonprimary_peers(struct sctp_association *asoc,
 771                                      struct sctp_transport *primary)
 772 {
 773         struct sctp_transport   *temp;
 774         struct sctp_transport   *t;
 775
 776         list_for_each_entry_safe(t, temp, &asoc->peer.transport_addr_list,
 777                                  transports) {
 778                 /* if the current transport is not the primary one, delete it */
 779                 if (t != primary)
 780                         sctp_assoc_rm_peer(asoc, t);
 781         }
 782 }
 783
 784 /* Engage in transport control operations.
 785  * Mark the transport up or down and send a notification to the user.
 786  * Select and update the new active and retran paths.
 787  */
 788 void sctp_assoc_control_transport(struct sctp_association *asoc,
 789                                   struct sctp_transport *transport,
 790                                   enum sctp_transport_cmd command,
 791                                   sctp_sn_error_t error)
 792 {
 793         int spc_state = SCTP_ADDR_AVAILABLE;
 794         bool ulp_notify = true;
 795
 796         /* Record the transition on the transport.  */
 797         switch (command) {
 798         case SCTP_TRANSPORT_UP:
 799                 /* If we are moving from UNCONFIRMED state due
 800                  * to heartbeat success, report the SCTP_ADDR_CONFIRMED
 801                  * state to the user, otherwise report SCTP_ADDR_AVAILABLE.
 802                  */
 803                 if (transport->state == SCTP_PF &&
 804                     asoc->pf_expose != SCTP_PF_EXPOSE_ENABLE)
 805                         ulp_notify = false;
 806                 else if (transport->state == SCTP_UNCONFIRMED &&
 807                          error == SCTP_HEARTBEAT_SUCCESS)
 808                         spc_state = SCTP_ADDR_CONFIRMED;
 809
 810                 transport->state = SCTP_ACTIVE;
 811                 break;
 812
 813         case SCTP_TRANSPORT_DOWN:
 814                 /* If the transport was never confirmed, do not transition it
 815                  * to inactive state.  Also, release the cached route since
 816                  * there may be a better route next time.
 817                  */
 818                 if (transport->state != SCTP_UNCONFIRMED) {
 819                         transport->state = SCTP_INACTIVE;
 820                         spc_state = SCTP_ADDR_UNREACHABLE;
 821                 } else {
 822                         sctp_transport_dst_release(transport);
 823                         ulp_notify = false;
 824                 }
 825                 break;
 826
 827         case SCTP_TRANSPORT_PF:
 828                 transport->state = SCTP_PF;
 829                 if (asoc->pf_expose != SCTP_PF_EXPOSE_ENABLE)
 830                         ulp_notify = false;
 831                 else
 832                         spc_state = SCTP_ADDR_POTENTIALLY_FAILED;
 833                 break;
 834
 835         default:
 836                 return;
 837         }
 838
 839         /* Generate and send a SCTP_PEER_ADDR_CHANGE notification
 840          * to the user.
 841          */
 842         if (ulp_notify)
 843                 sctp_ulpevent_nofity_peer_addr_change(transport,
 844                                                       spc_state, error);
 845
 846         /* Select new active and retran paths. */
 847         sctp_select_active_and_retran_path(asoc);
 848 }
 849
 850 /* Hold a reference to an association. */
 851 void sctp_association_hold(struct sctp_association *asoc)
 852 {
 853         refcount_inc(&asoc->base.refcnt);
 854 }
 855
 856 /* Release a reference to an association and cleanup
 857  * if there are no more references.
 858  */
 859 void sctp_association_put(struct sctp_association *asoc)
 860 {
 861         if (refcount_dec_and_test(&asoc->base.refcnt))
 862                 sctp_association_destroy(asoc);
 863 }
 864
 865 /* Allocate the next TSN, Transmission Sequence Number, for the given
 866  * association.
 867  */
 868 __u32 sctp_association_get_next_tsn(struct sctp_association *asoc)
 869 {
 870         /* From Section 1.6 Serial Number Arithmetic:
 871          * Transmission Sequence Numbers wrap around when they reach
 872          * 2**32 - 1.  That is, the next TSN a DATA chunk MUST use
 873          * after transmitting TSN = 2*32 - 1 is TSN = 0.
 874          */
 875         __u32 retval = asoc->next_tsn;
 876         asoc->next_tsn++;
 877         asoc->unack_data++;
 878
 879         return retval;
 880 }
 881
 882 /* Compare two addresses to see if they match.  Wildcard addresses
 883  * only match themselves.
 884  */
 885 int sctp_cmp_addr_exact(const union sctp_addr *ss1,
 886                         const union sctp_addr *ss2)
 887 {
 888         struct sctp_af *af;
 889
 890         af = sctp_get_af_specific(ss1->sa.sa_family);
 891         if (unlikely(!af))
 892                 return 0;
 893
 894         return af->cmp_addr(ss1, ss2);
 895 }
 896
 897 /* Return an ecne chunk to get prepended to a packet.
 898  * Note:  We are sly and return a shared, prealloced chunk.  FIXME:
 899  * No we don't, but we could/should.
 900  */
 901 struct sctp_chunk *sctp_get_ecne_prepend(struct sctp_association *asoc)
 902 {
 903         if (!asoc->need_ecne)
 904                 return NULL;
 905
 906         /* Send ECNE if needed.
 907          * Not being able to allocate a chunk here is not deadly.
 908          */
 909         return sctp_make_ecne(asoc, asoc->last_ecne_tsn);
 910 }
 911
 912 /*
 913  * Find which transport this TSN was sent on.
 914  */
 915 struct sctp_transport *sctp_assoc_lookup_tsn(struct sctp_association *asoc,
 916                                              __u32 tsn)
 917 {
 918         struct sctp_transport *active;
 919         struct sctp_transport *match;
 920         struct sctp_transport *transport;
 921         struct sctp_chunk *chunk;
 922         __be32 key = htonl(tsn);
 923
 924         match = NULL;
 925
 926         /*
 927          * FIXME: In general, find a more efficient data structure for
 928          * searching.
 929          */
 930
 931         /*
 932          * The general strategy is to search each transport's transmitted
 933          * list.   Return which transport this TSN lives on.
 934          *
 935          * Let's be hopeful and check the active_path first.
 936          * Another optimization would be to know if there is only one
 937          * outbound path and not have to look for the TSN at all.
 938          *
 939          */
 940
 941         active = asoc->peer.active_path;
 942
 943         list_for_each_entry(chunk, &active->transmitted,
 944                         transmitted_list) {
 945
 946                 if (key == chunk->subh.data_hdr->tsn) {
 947                         match = active;
 948                         goto out;
 949                 }
 950         }
 951
 952         /* If not found, go search all the other transports. */
 953         list_for_each_entry(transport, &asoc->peer.transport_addr_list,
 954                         transports) {
 955
 956                 if (transport == active)
 957                         continue;
 958                 list_for_each_entry(chunk, &transport->transmitted,
 959                                 transmitted_list) {
 960                         if (key == chunk->subh.data_hdr->tsn) {
 961                                 match = transport;
 962                                 goto out;
 963                         }
 964                 }
 965         }
 966 out:
 967         return match;
 968 }
 969
 970 /* Do delayed input processing.  This is scheduled by sctp_rcv(). */
 971 static void sctp_assoc_bh_rcv(struct work_struct *work)
 972 {
 973         struct sctp_association *asoc =
 974                 container_of(work, struct sctp_association,
 975                              base.inqueue.immediate);
 976         struct net *net = sock_net(asoc->base.sk);
 977         union sctp_subtype subtype;
 978         struct sctp_endpoint *ep;
 979         struct sctp_chunk *chunk;
 980         struct sctp_inq *inqueue;
 981         int first_time = 1;     /* is this the first time through the loop */
 982         int error = 0;
 983         int state;
 984
 985         /* The association should be held so we should be safe. */
 986         ep = asoc->ep;
 987
 988         inqueue = &asoc->base.inqueue;
 989         sctp_association_hold(asoc);
 990         while (NULL != (chunk = sctp_inq_pop(inqueue))) {
 991                 state = asoc->state;
 992                 subtype = SCTP_ST_CHUNK(chunk->chunk_hdr->type);
 993
 994                 /* If the first chunk in the packet is AUTH, do special
 995                  * processing specified in Section 6.3 of SCTP-AUTH spec
 996                  */
 997                 if (first_time && subtype.chunk == SCTP_CID_AUTH) {
 998                         struct sctp_chunkhdr *next_hdr;
 999
1000                         next_hdr = sctp_inq_peek(inqueue);
1001                         if (!next_hdr)
1002                                 goto normal;
1003
1004                         /* If the next chunk is COOKIE-ECHO, skip the AUTH
1005                          * chunk while saving a pointer to it so we can do
1006                          * Authentication later (during cookie-echo
1007                          * processing).
1008                          */
1009                         if (next_hdr->type == SCTP_CID_COOKIE_ECHO) {
1010                                 chunk->auth_chunk = skb_clone(chunk->skb,
1011                                                               GFP_ATOMIC);
1012                                 chunk->auth = 1;
1013                                 continue;
1014                         }
1015                 }
1016
1017 normal:
1018                 /* SCTP-AUTH, Section 6.3:
1019                  *    The receiver has a list of chunk types which it expects
1020                  *    to be received only after an AUTH-chunk.  This list has
1021                  *    been sent to the peer during the association setup.  It
1022                  *    MUST silently discard these chunks if they are not placed
1023                  *    after an AUTH chunk in the packet.
1024                  */
1025                 if (sctp_auth_recv_cid(subtype.chunk, asoc) && !chunk->auth)
1026                         continue;
1027
1028                 /* Remember where the last DATA chunk came from so we
1029                  * know where to send the SACK.
1030                  */
1031                 if (sctp_chunk_is_data(chunk))
1032                         asoc->peer.last_data_from = chunk->transport;
1033                 else {
1034                         SCTP_INC_STATS(net, SCTP_MIB_INCTRLCHUNKS);
1035                         asoc->stats.ictrlchunks++;
1036                         if (chunk->chunk_hdr->type == SCTP_CID_SACK)
1037                                 asoc->stats.isacks++;
1038                 }
1039
1040                 if (chunk->transport)
1041                         chunk->transport->last_time_heard = ktime_get();
1042
1043                 /* Run through the state machine. */
1044                 error = sctp_do_sm(net, SCTP_EVENT_T_CHUNK, subtype,
1045                                    state, ep, asoc, chunk, GFP_ATOMIC);
1046
1047                 /* Check to see if the association is freed in response to
1048                  * the incoming chunk.  If so, get out of the while loop.
1049                  */
1050                 if (asoc->base.dead)
1051                         break;
1052
1053                 /* If there is an error on chunk, discard this packet. */
1054                 if (error && chunk)
1055                         chunk->pdiscard = 1;
1056
1057                 if (first_time)
1058                         first_time = 0;
1059         }
1060         sctp_association_put(asoc);
1061 }
1062
1063 /* This routine moves an association from its old sk to a new sk.  */
1064 void sctp_assoc_migrate(struct sctp_association *assoc, struct sock *newsk)
1065 {
1066         struct sctp_sock *newsp = sctp_sk(newsk);
1067         struct sock *oldsk = assoc->base.sk;
1068
1069         /* Delete the association from the old endpoint's list of
1070          * associations.
1071          */
1072         list_del_init(&assoc->asocs);
1073
1074         /* Decrement the backlog value for a TCP-style socket. */
1075         if (sctp_style(oldsk, TCP))
1076                 sk_acceptq_removed(oldsk);
1077
1078         /* Release references to the old endpoint and the sock.  */
1079         sctp_endpoint_put(assoc->ep);
1080         sock_put(assoc->base.sk);
1081
1082         /* Get a reference to the new endpoint.  */
1083         assoc->ep = newsp->ep;
1084         sctp_endpoint_hold(assoc->ep);
1085
1086         /* Get a reference to the new sock.  */
1087         assoc->base.sk = newsk;
1088         sock_hold(assoc->base.sk);
1089
1090         /* Add the association to the new endpoint's list of associations.  */
1091         sctp_endpoint_add_asoc(newsp->ep, assoc);
1092 }
1093
1094 /* Update an association (possibly from unexpected COOKIE-ECHO processing).  */
1095 int sctp_assoc_update(struct sctp_association *asoc,
1096                       struct sctp_association *new)
1097 {
1098         struct sctp_transport *trans;
1099         struct list_head *pos, *temp;
1100
1101         /* Copy in new parameters of peer. */
1102         asoc->c = new->c;
1103         asoc->peer.rwnd = new->peer.rwnd;
1104         asoc->peer.sack_needed = new->peer.sack_needed;
1105         asoc->peer.auth_capable = new->peer.auth_capable;
1106         asoc->peer.i = new->peer.i;
1107
1108         if (!sctp_tsnmap_init(&asoc->peer.tsn_map, SCTP_TSN_MAP_INITIAL,
1109                               asoc->peer.i.initial_tsn, GFP_ATOMIC))
1110                 return -ENOMEM;
1111
1112         /* Remove any peer addresses not present in the new association. */
1113         list_for_each_safe(pos, temp, &asoc->peer.transport_addr_list) {
1114                 trans = list_entry(pos, struct sctp_transport, transports);
1115                 if (!sctp_assoc_lookup_paddr(new, &trans->ipaddr)) {
1116                         sctp_assoc_rm_peer(asoc, trans);
1117                         continue;
1118                 }
1119
1120                 if (asoc->state >= SCTP_STATE_ESTABLISHED)
1121                         sctp_transport_reset(trans);
1122         }
1123
1124         /* If the case is A (association restart), use
1125          * initial_tsn as next_tsn. If the case is B, use
1126          * current next_tsn in case data sent to peer
1127          * has been discarded and needs retransmission.
1128          */
1129         if (asoc->state >= SCTP_STATE_ESTABLISHED) {
1130                 asoc->next_tsn = new->next_tsn;
1131                 asoc->ctsn_ack_point = new->ctsn_ack_point;
1132                 asoc->adv_peer_ack_point = new->adv_peer_ack_point;
1133
1134                 /* Reinitialize SSN for both local streams
1135                  * and peer's streams.
1136                  */
1137                 sctp_stream_clear(&asoc->stream);
1138
1139                 /* Flush the ULP reassembly and ordered queue.
1140                  * Any data there will now be stale and will
1141                  * cause problems.
1142                  */
1143                 sctp_ulpq_flush(&asoc->ulpq);
1144
1145                 /* reset the overall association error count so
1146                  * that the restarted association doesn't get torn
1147                  * down on the next retransmission timer.
1148                  */
1149                 asoc->overall_error_count = 0;
1150
1151         } else {
1152                 /* Add any peer addresses from the new association. */
1153                 list_for_each_entry(trans, &new->peer.transport_addr_list,
1154                                     transports)
1155                         if (!sctp_assoc_lookup_paddr(asoc, &trans->ipaddr) &&
1156                             !sctp_assoc_add_peer(asoc, &trans->ipaddr,
1157                                                  GFP_ATOMIC, trans->state))
1158                                 return -ENOMEM;
1159
1160                 asoc->ctsn_ack_point = asoc->next_tsn - 1;
1161                 asoc->adv_peer_ack_point = asoc->ctsn_ack_point;
1162
1163                 if (sctp_state(asoc, COOKIE_WAIT))
1164                         sctp_stream_update(&asoc->stream, &new->stream);
1165
1166                 /* get a new assoc id if we don't have one yet. */
1167                 if (sctp_assoc_set_id(asoc, GFP_ATOMIC))
1168                         return -ENOMEM;
1169         }
1170
1171         /* SCTP-AUTH: Save the peer parameters from the new associations
1172          * and also move the association shared keys over
1173          */
1174         kfree(asoc->peer.peer_random);
1175         asoc->peer.peer_random = new->peer.peer_random;
1176         new->peer.peer_random = NULL;
1177
1178         kfree(asoc->peer.peer_chunks);
1179         asoc->peer.peer_chunks = new->peer.peer_chunks;
1180         new->peer.peer_chunks = NULL;
1181
1182         kfree(asoc->peer.peer_hmacs);
1183         asoc->peer.peer_hmacs = new->peer.peer_hmacs;
1184         new->peer.peer_hmacs = NULL;
1185
1186         return sctp_auth_asoc_init_active_key(asoc, GFP_ATOMIC);
1187 }
1188
1189 /* Update the retran path for sending a retransmitted packet.
1190  * See also RFC4960, 6.4. Multi-Homed SCTP Endpoints:
1191  *
1192  *   When there is outbound data to send and the primary path
1193  *   becomes inactive (e.g., due to failures), or where the
1194  *   SCTP user explicitly requests to send data to an
1195  *   inactive destination transport address, before reporting
1196  *   an error to its ULP, the SCTP endpoint should try to send
1197  *   the data to an alternate active destination transport
1198  *   address if one exists.
1199  *
1200  *   When retransmitting data that timed out, if the endpoint
1201  *   is multihomed, it should consider each source-destination
1202  *   address pair in its retransmission selection policy.
1203  *   When retransmitting timed-out data, the endpoint should
1204  *   attempt to pick the most divergent source-destination
1205  *   pair from the original source-destination pair to which
1206  *   the packet was transmitted.
1207  *
1208  *   Note: Rules for picking the most divergent source-destination
1209  *   pair are an implementation decision and are not specified
1210  *   within this document.
1211  *
1212  * Our basic strategy is to round-robin transports in priorities
1213  * according to sctp_trans_score() e.g., if no such
1214  * transport with state SCTP_ACTIVE exists, round-robin through
1215  * SCTP_UNKNOWN, etc. You get the picture.
1216  */
1217 static u8 sctp_trans_score(const struct sctp_transport *trans)
1218 {
1219         switch (trans->state) {
1220         case SCTP_ACTIVE:
1221                 return 3;       /* best case */
1222         case SCTP_UNKNOWN:
1223                 return 2;
1224         case SCTP_PF:
1225                 return 1;
1226         default: /* case SCTP_INACTIVE */
1227                 return 0;       /* worst case */
1228         }
1229 }
1230
1231 static struct sctp_transport *sctp_trans_elect_tie(struct sctp_transport *trans1,
1232                                                    struct sctp_transport *trans2)
1233 {
1234         if (trans1->error_count > trans2->error_count) {
1235                 return trans2;
1236         } else if (trans1->error_count == trans2->error_count &&
1237                    ktime_after(trans2->last_time_heard,
1238                                trans1->last_time_heard)) {
1239                 return trans2;
1240         } else {
1241                 return trans1;
1242         }
1243 }
1244
1245 static struct sctp_transport *sctp_trans_elect_best(struct sctp_transport *curr,
1246                                                     struct sctp_transport *best)
1247 {
1248         u8 score_curr, score_best;
1249
1250         if (best == NULL || curr == best)
1251                 return curr;
1252
1253         score_curr = sctp_trans_score(curr);
1254         score_best = sctp_trans_score(best);
1255
1256         /* First, try a score-based selection if both transport states
1257          * differ. If we're in a tie, lets try to make a more clever
1258          * decision here based on error counts and last time heard.
1259          */
1260         if (score_curr > score_best)
1261                 return curr;
1262         else if (score_curr == score_best)
1263                 return sctp_trans_elect_tie(best, curr);
1264         else
1265                 return best;
1266 }
1267
1268 void sctp_assoc_update_retran_path(struct sctp_association *asoc)
1269 {
1270         struct sctp_transport *trans = asoc->peer.retran_path;
1271         struct sctp_transport *trans_next = NULL;
1272
1273         /* We're done as we only have the one and only path. */
1274         if (asoc->peer.transport_count == 1)
1275                 return;
1276         /* If active_path and retran_path are the same and active,
1277          * then this is the only active path. Use it.
1278          */
1279         if (asoc->peer.active_path == asoc->peer.retran_path &&
1280             asoc->peer.active_path->state == SCTP_ACTIVE)
1281                 return;
1282
1283         /* Iterate from retran_path's successor back to retran_path. */
1284         for (trans = list_next_entry(trans, transports); 1;
1285              trans = list_next_entry(trans, transports)) {
1286                 /* Manually skip the head element. */
1287                 if (&trans->transports == &asoc->peer.transport_addr_list)
1288                         continue;
1289                 if (trans->state == SCTP_UNCONFIRMED)
1290                         continue;
1291                 trans_next = sctp_trans_elect_best(trans, trans_next);
1292                 /* Active is good enough for immediate return. */
1293                 if (trans_next->state == SCTP_ACTIVE)
1294                         break;
1295                 /* We've reached the end, time to update path. */
1296                 if (trans == asoc->peer.retran_path)
1297                         break;
1298         }
1299
1300         asoc->peer.retran_path = trans_next;
1301
1302         pr_debug("%s: association:%p updated new path to addr:%pISpc\n",
1303                  __func__, asoc, &asoc->peer.retran_path->ipaddr.sa);
1304 }
1305
1306 static void sctp_select_active_and_retran_path(struct sctp_association *asoc)
1307 {
1308         struct sctp_transport *trans, *trans_pri = NULL, *trans_sec = NULL;
1309         struct sctp_transport *trans_pf = NULL;
1310
1311         /* Look for the two most recently used active transports. */
1312         list_for_each_entry(trans, &asoc->peer.transport_addr_list,
1313                             transports) {
1314                 /* Skip uninteresting transports. */
1315                 if (trans->state == SCTP_INACTIVE ||
1316                     trans->state == SCTP_UNCONFIRMED)
1317                         continue;
1318                 /* Keep track of the best PF transport from our
1319                  * list in case we don't find an active one.
1320                  */
1321                 if (trans->state == SCTP_PF) {
1322                         trans_pf = sctp_trans_elect_best(trans, trans_pf);
1323                         continue;
1324                 }
1325                 /* For active transports, pick the most recent ones. */
1326                 if (trans_pri == NULL ||
1327                     ktime_after(trans->last_time_heard,
1328                                 trans_pri->last_time_heard)) {
1329                         trans_sec = trans_pri;
1330                         trans_pri = trans;
1331                 } else if (trans_sec == NULL ||
1332                            ktime_after(trans->last_time_heard,
1333                                        trans_sec->last_time_heard)) {
1334                         trans_sec = trans;
1335                 }
1336         }
1337
1338         /* RFC 2960 6.4 Multi-Homed SCTP Endpoints
1339          *
1340          * By default, an endpoint should always transmit to the primary
1341          * path, unless the SCTP user explicitly specifies the
1342          * destination transport address (and possibly source transport
1343          * address) to use. [If the primary is active but not most recent,
1344          * bump the most recently used transport.]
1345          */
1346         if ((asoc->peer.primary_path->state == SCTP_ACTIVE ||
1347              asoc->peer.primary_path->state == SCTP_UNKNOWN) &&
1348              asoc->peer.primary_path != trans_pri) {
1349                 trans_sec = trans_pri;
1350                 trans_pri = asoc->peer.primary_path;
1351         }
1352
1353         /* We did not find anything useful for a possible retransmission
1354          * path; either primary path that we found is the the same as
1355          * the current one, or we didn't generally find an active one.
1356          */
1357         if (trans_sec == NULL)
1358                 trans_sec = trans_pri;
1359
1360         /* If we failed to find a usable transport, just camp on the
1361          * active or pick a PF iff it's the better choice.
1362          */
1363         if (trans_pri == NULL) {
1364                 trans_pri = sctp_trans_elect_best(asoc->peer.active_path, trans_pf);
1365                 trans_sec = trans_pri;
1366         }
1367
1368         /* Set the active and retran transports. */
1369         asoc->peer.active_path = trans_pri;
1370         asoc->peer.retran_path = trans_sec;
1371 }
1372
1373 struct sctp_transport *
1374 sctp_assoc_choose_alter_transport(struct sctp_association *asoc,
1375                                   struct sctp_transport *last_sent_to)
1376 {
1377         /* If this is the first time packet is sent, use the active path,
1378          * else use the retran path. If the last packet was sent over the
1379          * retran path, update the retran path and use it.
1380          */
1381         if (last_sent_to == NULL) {
1382                 return asoc->peer.active_path;
1383         } else {
1384                 if (last_sent_to == asoc->peer.retran_path)
1385                         sctp_assoc_update_retran_path(asoc);
1386
1387                 return asoc->peer.retran_path;
1388         }
1389 }
1390
1391 void sctp_assoc_update_frag_point(struct sctp_association *asoc)
1392 {
1393         int frag = sctp_mtu_payload(sctp_sk(asoc->base.sk), asoc->pathmtu,
1394                                     sctp_datachk_len(&asoc->stream));
1395
1396         if (asoc->user_frag)
1397                 frag = min_t(int, frag, asoc->user_frag);
1398
1399         frag = min_t(int, frag, SCTP_MAX_CHUNK_LEN -
1400                                 sctp_datachk_len(&asoc->stream));
1401
1402         asoc->frag_point = SCTP_TRUNC4(frag);
1403 }
1404
1405 void sctp_assoc_set_pmtu(struct sctp_association *asoc, __u32 pmtu)
1406 {
1407         if (asoc->pathmtu != pmtu) {
1408                 asoc->pathmtu = pmtu;
1409                 sctp_assoc_update_frag_point(asoc);
1410         }
1411
1412         pr_debug("%s: asoc:%p, pmtu:%d, frag_point:%d\n", __func__, asoc,
1413                  asoc->pathmtu, asoc->frag_point);
1414 }
1415
1416 /* Update the association's pmtu and frag_point by going through all the
1417  * transports. This routine is called when a transport's PMTU has changed.
1418  */
1419 void sctp_assoc_sync_pmtu(struct sctp_association *asoc)
1420 {
1421         struct sctp_transport *t;
1422         __u32 pmtu = 0;
1423
1424         if (!asoc)
1425                 return;
1426
1427         /* Get the lowest pmtu of all the transports. */
1428         list_for_each_entry(t, &asoc->peer.transport_addr_list, transports) {
1429                 if (t->pmtu_pending && t->dst) {
1430                         sctp_transport_update_pmtu(t,
1431                                                    atomic_read(&t->mtu_info));
1432                         t->pmtu_pending = 0;
1433                 }
1434                 if (!pmtu || (t->pathmtu < pmtu))
1435                         pmtu = t->pathmtu;
1436         }
1437
1438         sctp_assoc_set_pmtu(asoc, pmtu);
1439 }
1440
1441 /* Should we send a SACK to update our peer? */
1442 static inline bool sctp_peer_needs_update(struct sctp_association *asoc)
1443 {
1444         struct net *net = sock_net(asoc->base.sk);
1445         switch (asoc->state) {
1446         case SCTP_STATE_ESTABLISHED:
1447         case SCTP_STATE_SHUTDOWN_PENDING:
1448         case SCTP_STATE_SHUTDOWN_RECEIVED:
1449         case SCTP_STATE_SHUTDOWN_SENT:
1450                 if ((asoc->rwnd > asoc->a_rwnd) &&
1451                     ((asoc->rwnd - asoc->a_rwnd) >= max_t(__u32,
1452                            (asoc->base.sk->sk_rcvbuf >> net->sctp.rwnd_upd_shift),
1453                            asoc->pathmtu)))
1454                         return true;
1455                 break;
1456         default:
1457                 break;
1458         }
1459         return false;
1460 }
1461
1462 /* Increase asoc's rwnd by len and send any window update SACK if needed. */
1463 void sctp_assoc_rwnd_increase(struct sctp_association *asoc, unsigned int len)
1464 {
1465         struct sctp_chunk *sack;
1466         struct timer_list *timer;
1467
1468         if (asoc->rwnd_over) {
1469                 if (asoc->rwnd_over >= len) {
1470                         asoc->rwnd_over -= len;
1471                 } else {
1472                         asoc->rwnd += (len - asoc->rwnd_over);
1473                         asoc->rwnd_over = 0;
1474                 }
1475         } else {
1476                 asoc->rwnd += len;
1477         }
1478
1479         /* If we had window pressure, start recovering it
1480          * once our rwnd had reached the accumulated pressure
1481          * threshold.  The idea is to recover slowly, but up
1482          * to the initial advertised window.
1483          */
1484         if (asoc->rwnd_press) {
1485                 int change = min(asoc->pathmtu, asoc->rwnd_press);
1486                 asoc->rwnd += change;
1487                 asoc->rwnd_press -= change;
1488         }
1489
1490         pr_debug("%s: asoc:%p rwnd increased by %d to (%u, %u) - %u\n",
1491                  __func__, asoc, len, asoc->rwnd, asoc->rwnd_over,
1492                  asoc->a_rwnd);
1493
1494         /* Send a window update SACK if the rwnd has increased by at least the
1495          * minimum of the association's PMTU and half of the receive buffer.
1496          * The algorithm used is similar to the one described in
1497          * Section 4.2.3.3 of RFC 1122.
1498          */
1499         if (sctp_peer_needs_update(asoc)) {
1500                 asoc->a_rwnd = asoc->rwnd;
1501
1502                 pr_debug("%s: sending window update SACK- asoc:%p rwnd:%u "
1503                          "a_rwnd:%u\n", __func__, asoc, asoc->rwnd,
1504                          asoc->a_rwnd);
1505
1506                 sack = sctp_make_sack(asoc);
1507                 if (!sack)
1508                         return;
1509
1510                 asoc->peer.sack_needed = 0;
1511
1512                 sctp_outq_tail(&asoc->outqueue, sack, GFP_ATOMIC);
1513
1514                 /* Stop the SACK timer.  */
1515                 timer = &asoc->timers[SCTP_EVENT_TIMEOUT_SACK];
1516                 if (del_timer(timer))
1517                         sctp_association_put(asoc);
1518         }
1519 }
1520
1521 /* Decrease asoc's rwnd by len. */
1522 void sctp_assoc_rwnd_decrease(struct sctp_association *asoc, unsigned int len)
1523 {
1524         int rx_count;
1525         int over = 0;
1526
1527         if (unlikely(!asoc->rwnd || asoc->rwnd_over))
1528                 pr_debug("%s: association:%p has asoc->rwnd:%u, "
1529                          "asoc->rwnd_over:%u!\n", __func__, asoc,
1530                          asoc->rwnd, asoc->rwnd_over);
1531
1532         if (asoc->ep->rcvbuf_policy)
1533                 rx_count = atomic_read(&asoc->rmem_alloc);
1534         else
1535                 rx_count = atomic_read(&asoc->base.sk->sk_rmem_alloc);
1536
1537         /* If we've reached or overflowed our receive buffer, announce
1538          * a 0 rwnd if rwnd would still be positive.  Store the
1539          * the potential pressure overflow so that the window can be restored
1540          * back to original value.
1541          */
1542         if (rx_count >= asoc->base.sk->sk_rcvbuf)
1543                 over = 1;
1544
1545         if (asoc->rwnd >= len) {
1546                 asoc->rwnd -= len;
1547                 if (over) {
1548                         asoc->rwnd_press += asoc->rwnd;
1549                         asoc->rwnd = 0;
1550                 }
1551         } else {
1552                 asoc->rwnd_over += len - asoc->rwnd;
1553                 asoc->rwnd = 0;
1554         }
1555
1556         pr_debug("%s: asoc:%p rwnd decreased by %d to (%u, %u, %u)\n",
1557                  __func__, asoc, len, asoc->rwnd, asoc->rwnd_over,
1558                  asoc->rwnd_press);
1559 }
1560
1561 /* Build the bind address list for the association based on info from the
1562  * local endpoint and the remote peer.
1563  */
1564 int sctp_assoc_set_bind_addr_from_ep(struct sctp_association *asoc,
1565                                      enum sctp_scope scope, gfp_t gfp)
1566 {
1567         int flags;
1568
1569         /* Use scoping rules to determine the subset of addresses from
1570          * the endpoint.
1571          */
1572         flags = (PF_INET6 == asoc->base.sk->sk_family) ? SCTP_ADDR6_ALLOWED : 0;
1573         if (asoc->peer.ipv4_address)
1574                 flags |= SCTP_ADDR4_PEERSUPP;
1575         if (asoc->peer.ipv6_address)
1576                 flags |= SCTP_ADDR6_PEERSUPP;
1577
1578         return sctp_bind_addr_copy(sock_net(asoc->base.sk),
1579                                    &asoc->base.bind_addr,
1580                                    &asoc->ep->base.bind_addr,
1581                                    scope, gfp, flags);
1582 }
1583
1584 /* Build the association's bind address list from the cookie.  */
1585 int sctp_assoc_set_bind_addr_from_cookie(struct sctp_association *asoc,
1586                                          struct sctp_cookie *cookie,
1587                                          gfp_t gfp)
1588 {
1589         int var_size2 = ntohs(cookie->peer_init->chunk_hdr.length);
1590         int var_size3 = cookie->raw_addr_list_len;
1591         __u8 *raw = (__u8 *)cookie->peer_init + var_size2;
1592
1593         return sctp_raw_to_bind_addrs(&asoc->base.bind_addr, raw, var_size3,
1594                                       asoc->ep->base.bind_addr.port, gfp);
1595 }
1596
1597 /* Lookup laddr in the bind address list of an association. */
1598 int sctp_assoc_lookup_laddr(struct sctp_association *asoc,
1599                             const union sctp_addr *laddr)
1600 {
1601         int found = 0;
1602
1603         if ((asoc->base.bind_addr.port == ntohs(laddr->v4.sin_port)) &&
1604             sctp_bind_addr_match(&asoc->base.bind_addr, laddr,
1605                                  sctp_sk(asoc->base.sk)))
1606                 found = 1;
1607
1608         return found;
1609 }
1610
1611 /* Set an association id for a given association */
1612 int sctp_assoc_set_id(struct sctp_association *asoc, gfp_t gfp)
1613 {
1614         bool preload = gfpflags_allow_blocking(gfp);
1615         int ret;
1616
1617         /* If the id is already assigned, keep it. */
1618         if (asoc->assoc_id)
1619                 return 0;
1620
1621         if (preload)
1622                 idr_preload(gfp);
1623         spin_lock_bh(&sctp_assocs_id_lock);
1624         /* 0, 1, 2 are used as SCTP_FUTURE_ASSOC, SCTP_CURRENT_ASSOC and
1625          * SCTP_ALL_ASSOC, so an available id must be > SCTP_ALL_ASSOC.
1626          */
1627         ret = idr_alloc_cyclic(&sctp_assocs_id, asoc, SCTP_ALL_ASSOC + 1, 0,
1628                                GFP_NOWAIT);
1629         spin_unlock_bh(&sctp_assocs_id_lock);
1630         if (preload)
1631                 idr_preload_end();
1632         if (ret < 0)
1633                 return ret;
1634
1635         asoc->assoc_id = (sctp_assoc_t)ret;
1636         return 0;
1637 }
1638
1639 /* Free the ASCONF queue */
1640 static void sctp_assoc_free_asconf_queue(struct sctp_association *asoc)
1641 {
1642         struct sctp_chunk *asconf;
1643         struct sctp_chunk *tmp;
1644
1645         list_for_each_entry_safe(asconf, tmp, &asoc->addip_chunk_list, list) {
1646                 list_del_init(&asconf->list);
1647                 sctp_chunk_free(asconf);
1648         }
1649 }
1650
1651 /* Free asconf_ack cache */
1652 static void sctp_assoc_free_asconf_acks(struct sctp_association *asoc)
1653 {
1654         struct sctp_chunk *ack;
1655         struct sctp_chunk *tmp;
1656
1657         list_for_each_entry_safe(ack, tmp, &asoc->asconf_ack_list,
1658                                 transmitted_list) {
1659                 list_del_init(&ack->transmitted_list);
1660                 sctp_chunk_free(ack);
1661         }
1662 }
1663
1664 /* Clean up the ASCONF_ACK queue */
1665 void sctp_assoc_clean_asconf_ack_cache(const struct sctp_association *asoc)
1666 {
1667         struct sctp_chunk *ack;
1668         struct sctp_chunk *tmp;
1669
1670         /* We can remove all the entries from the queue up to
1671          * the "Peer-Sequence-Number".
1672          */
1673         list_for_each_entry_safe(ack, tmp, &asoc->asconf_ack_list,
1674                                 transmitted_list) {
1675                 if (ack->subh.addip_hdr->serial ==
1676                                 htonl(asoc->peer.addip_serial))
1677                         break;
1678
1679                 list_del_init(&ack->transmitted_list);
1680                 sctp_chunk_free(ack);
1681         }
1682 }
1683
1684 /* Find the ASCONF_ACK whose serial number matches ASCONF */
1685 struct sctp_chunk *sctp_assoc_lookup_asconf_ack(
1686                                         const struct sctp_association *asoc,
1687                                         __be32 serial)
1688 {
1689         struct sctp_chunk *ack;
1690
1691         /* Walk through the list of cached ASCONF-ACKs and find the
1692          * ack chunk whose serial number matches that of the request.
1693          */
1694         list_for_each_entry(ack, &asoc->asconf_ack_list, transmitted_list) {
1695                 if (sctp_chunk_pending(ack))
1696                         continue;
1697                 if (ack->subh.addip_hdr->serial == serial) {
1698                         sctp_chunk_hold(ack);
1699                         return ack;
1700                 }
1701         }
1702
1703         return NULL;
1704 }
1705
1706 void sctp_asconf_queue_teardown(struct sctp_association *asoc)
1707 {
1708         /* Free any cached ASCONF_ACK chunk. */
1709         sctp_assoc_free_asconf_acks(asoc);
1710
1711         /* Free the ASCONF queue. */
1712         sctp_assoc_free_asconf_queue(asoc);
1713
1714         /* Free any cached ASCONF chunk. */
1715         if (asoc->addip_last_asconf)
1716                 sctp_chunk_free(asoc->addip_last_asconf);
1717 }