net/sctp/input.c

   1 /* SCTP kernel reference Implementation
   2  * Copyright (c) 1999-2000 Cisco, Inc.
   3  * Copyright (c) 1999-2001 Motorola, Inc.
   4  * Copyright (c) 2001-2003 International Business Machines, Corp.
   5  * Copyright (c) 2001 Intel Corp.
   6  * Copyright (c) 2001 Nokia, Inc.
   7  * Copyright (c) 2001 La Monte H.P. Yarroll
   8  *
   9  * This file is part of the SCTP kernel reference Implementation
  10  *
  11  * These functions handle all input from the IP layer into SCTP.
  12  *
  13  * The SCTP reference implementation is free software;
  14  * you can redistribute it and/or modify it under the terms of
  15  * the GNU General Public License as published by
  16  * the Free Software Foundation; either version 2, or (at your option)
  17  * any later version.
  18  *
  19  * The SCTP reference implementation is distributed in the hope that it
  20  * will be useful, but WITHOUT ANY WARRANTY; without even the implied
  21  *                 ************************
  22  * warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
  23  * See the GNU General Public License for more details.
  24  *
  25  * You should have received a copy of the GNU General Public License
  26  * along with GNU CC; see the file COPYING.  If not, write to
  27  * the Free Software Foundation, 59 Temple Place - Suite 330,
  28  * Boston, MA 02111-1307, USA.
  29  *
  30  * Please send any bug reports or fixes you make to the
  31  * email address(es):
  32  *    lksctp developers <lksctp-developers@lists.sourceforge.net>
  33  *
  34  * Or submit a bug report through the following website:
  35  *    http://www.sf.net/projects/lksctp
  36  *
  37  * Written or modified by:
  38  *    La Monte H.P. Yarroll <piggy@acm.org>
  39  *    Karl Knutson <karl@athena.chicago.il.us>
  40  *    Xingang Guo <xingang.guo@intel.com>
  41  *    Jon Grimm <jgrimm@us.ibm.com>
  42  *    Hui Huang <hui.huang@nokia.com>
  43  *    Daisy Chang <daisyc@us.ibm.com>
  44  *    Sridhar Samudrala <sri@us.ibm.com>
  45  *    Ardelle Fan <ardelle.fan@intel.com>
  46  *
  47  * Any bugs reported given to us we will try to fix... any fixes shared will
  48  * be incorporated into the next SCTP release.
  49  */
  50
  51 #include <linux/types.h>
  52 #include <linux/list.h> /* For struct list_head */
  53 #include <linux/socket.h>
  54 #include <linux/ip.h>
  55 #include <linux/time.h> /* For struct timeval */
  56 #include <net/ip.h>
  57 #include <net/icmp.h>
  58 #include <net/snmp.h>
  59 #include <net/sock.h>
  60 #include <net/xfrm.h>
  61 #include <net/sctp/sctp.h>
  62 #include <net/sctp/sm.h>
  63
  64 /* Forward declarations for internal helpers. */
  65 static int sctp_rcv_ootb(struct sk_buff *);
  66 static struct sctp_association *__sctp_rcv_lookup(struct sk_buff *skb,
  67                                       const union sctp_addr *laddr,
  68                                       const union sctp_addr *paddr,
  69                                       struct sctp_transport **transportp);
  70 static struct sctp_endpoint *__sctp_rcv_lookup_endpoint(const union sctp_addr *laddr);
  71 static struct sctp_association *__sctp_lookup_association(
  72                                         const union sctp_addr *local,
  73                                         const union sctp_addr *peer,
  74                                         struct sctp_transport **pt);
  75
  76
  77 /* Calculate the SCTP checksum of an SCTP packet.  */
  78 static inline int sctp_rcv_checksum(struct sk_buff *skb)
  79 {
  80         struct sctphdr *sh;
  81         __u32 cmp, val;
  82         struct sk_buff *list = skb_shinfo(skb)->frag_list;
  83
  84         sh = (struct sctphdr *) skb->h.raw;
  85         cmp = ntohl(sh->checksum);
  86
  87         val = sctp_start_cksum((__u8 *)sh, skb_headlen(skb));
  88
  89         for (; list; list = list->next)
  90                 val = sctp_update_cksum((__u8 *)list->data, skb_headlen(list),
  91                                         val);
  92
  93         val = sctp_end_cksum(val);
  94
  95         if (val != cmp) {
  96                 /* CRC failure, dump it. */
  97                 SCTP_INC_STATS_BH(SCTP_MIB_CHECKSUMERRORS);
  98                 return -1;
  99         }
 100         return 0;
 101 }
 102
 103 struct sctp_input_cb {
 104         union {
 105                 struct inet_skb_parm    h4;
 106 #if defined(CONFIG_IPV6) || defined (CONFIG_IPV6_MODULE)
 107                 struct inet6_skb_parm   h6;
 108 #endif
 109         } header;
 110         struct sctp_chunk *chunk;
 111 };
 112 #define SCTP_INPUT_CB(__skb)    ((struct sctp_input_cb *)&((__skb)->cb[0]))
 113
 114 /*
 115  * This is the routine which IP calls when receiving an SCTP packet.
 116  */
 117 int sctp_rcv(struct sk_buff *skb)
 118 {
 119         struct sock *sk;
 120         struct sctp_association *asoc;
 121         struct sctp_endpoint *ep = NULL;
 122         struct sctp_ep_common *rcvr;
 123         struct sctp_transport *transport = NULL;
 124         struct sctp_chunk *chunk;
 125         struct sctphdr *sh;
 126         union sctp_addr src;
 127         union sctp_addr dest;
 128         int family;
 129         struct sctp_af *af;
 130
 131         if (skb->pkt_type!=PACKET_HOST)
 132                 goto discard_it;
 133
 134         SCTP_INC_STATS_BH(SCTP_MIB_INSCTPPACKS);
 135
 136         sh = (struct sctphdr *) skb->h.raw;
 137
 138         /* Pull up the IP and SCTP headers. */
 139         __skb_pull(skb, skb->h.raw - skb->data);
 140         if (skb->len < sizeof(struct sctphdr))
 141                 goto discard_it;
 142         if (sctp_rcv_checksum(skb) < 0)
 143                 goto discard_it;
 144
 145         skb_pull(skb, sizeof(struct sctphdr));
 146
 147         /* Make sure we at least have chunk headers worth of data left. */
 148         if (skb->len < sizeof(struct sctp_chunkhdr))
 149                 goto discard_it;
 150
 151         family = ipver2af(skb->nh.iph->version);
 152         af = sctp_get_af_specific(family);
 153         if (unlikely(!af))
 154                 goto discard_it;
 155
 156         /* Initialize local addresses for lookups. */
 157         af->from_skb(&src, skb, 1);
 158         af->from_skb(&dest, skb, 0);
 159
 160         /* If the packet is to or from a non-unicast address,
 161          * silently discard the packet.
 162          *
 163          * This is not clearly defined in the RFC except in section
 164          * 8.4 - OOTB handling.  However, based on the book "Stream Control
 165          * Transmission Protocol" 2.1, "It is important to note that the
 166          * IP address of an SCTP transport address must be a routable
 167          * unicast address.  In other words, IP multicast addresses and
 168          * IP broadcast addresses cannot be used in an SCTP transport
 169          * address."
 170          */
 171         if (!af->addr_valid(&src, NULL) || !af->addr_valid(&dest, NULL))
 172                 goto discard_it;
 173
 174         asoc = __sctp_rcv_lookup(skb, &src, &dest, &transport);
 175
 176         if (!asoc)
 177                 ep = __sctp_rcv_lookup_endpoint(&dest);
 178
 179         /* Retrieve the common input handling substructure. */
 180         rcvr = asoc ? &asoc->base : &ep->base;
 181         sk = rcvr->sk;
 182
 183         /*
 184          * If a frame arrives on an interface and the receiving socket is
 185          * bound to another interface, via SO_BINDTODEVICE, treat it as OOTB
 186          */
 187         if (sk->sk_bound_dev_if && (sk->sk_bound_dev_if != af->skb_iif(skb)))
 188         {
 189                 sock_put(sk);
 190                 if (asoc) {
 191                         sctp_association_put(asoc);
 192                         asoc = NULL;
 193                 } else {
 194                         sctp_endpoint_put(ep);
 195                         ep = NULL;
 196                 }
 197                 sk = sctp_get_ctl_sock();
 198                 ep = sctp_sk(sk)->ep;
 199                 sctp_endpoint_hold(ep);
 200                 sock_hold(sk);
 201                 rcvr = &ep->base;
 202         }
 203
 204         /*
 205          * RFC 2960, 8.4 - Handle "Out of the blue" Packets.
 206          * An SCTP packet is called an "out of the blue" (OOTB)
 207          * packet if it is correctly formed, i.e., passed the
 208          * receiver's checksum check, but the receiver is not
 209          * able to identify the association to which this
 210          * packet belongs.
 211          */
 212         if (!asoc) {
 213                 if (sctp_rcv_ootb(skb)) {
 214                         SCTP_INC_STATS_BH(SCTP_MIB_OUTOFBLUES);
 215                         goto discard_release;
 216                 }
 217         }
 218
 219         /* SCTP seems to always need a timestamp right now (FIXME) */
 220         if (skb->tstamp.off_sec == 0) {
 221                 __net_timestamp(skb);
 222                 sock_enable_timestamp(sk);
 223         }
 224
 225         if (!xfrm_policy_check(sk, XFRM_POLICY_IN, skb, family))
 226                 goto discard_release;
 227         nf_reset(skb);
 228
 229         if (sk_filter(sk, skb, 1))
 230                 goto discard_release;
 231
 232         /* Create an SCTP packet structure. */
 233         chunk = sctp_chunkify(skb, asoc, sk);
 234         if (!chunk)
 235                 goto discard_release;
 236         SCTP_INPUT_CB(skb)->chunk = chunk;
 237
 238         /* Remember what endpoint is to handle this packet. */
 239         chunk->rcvr = rcvr;
 240
 241         /* Remember the SCTP header. */
 242         chunk->sctp_hdr = sh;
 243
 244         /* Set the source and destination addresses of the incoming chunk.  */
 245         sctp_init_addrs(chunk, &src, &dest);
 246
 247         /* Remember where we came from.  */
 248         chunk->transport = transport;
 249
 250         /* Acquire access to the sock lock. Note: We are safe from other
 251          * bottom halves on this lock, but a user may be in the lock too,
 252          * so check if it is busy.
 253          */
 254         sctp_bh_lock_sock(sk);
 255
 256         /* It is possible that the association could have moved to a different
 257          * socket if it is peeled off. If so, update the sk.
 258          */
 259         if (sk != rcvr->sk) {
 260                 sctp_bh_lock_sock(rcvr->sk);
 261                 sctp_bh_unlock_sock(sk);
 262                 sk = rcvr->sk;
 263         }
 264
 265         if (sock_owned_by_user(sk))
 266                 sk_add_backlog(sk, skb);
 267         else
 268                 sctp_backlog_rcv(sk, skb);
 269
 270         /* Release the sock and the sock ref we took in the lookup calls.
 271          * The asoc/ep ref will be released in sctp_backlog_rcv.
 272          */
 273         sctp_bh_unlock_sock(sk);
 274         sock_put(sk);
 275
 276         return 0;
 277
 278 discard_it:
 279         kfree_skb(skb);
 280         return 0;
 281
 282 discard_release:
 283         /* Release any structures we may be holding. */
 284         sock_put(sk);
 285         if (asoc)
 286                 sctp_association_put(asoc);
 287         else
 288                 sctp_endpoint_put(ep);
 289
 290         goto discard_it;
 291 }
 292
 293 /* Handle second half of inbound skb processing.  If the sock was busy,
 294  * we may have need to delay processing until later when the sock is
 295  * released (on the backlog).   If not busy, we call this routine
 296  * directly from the bottom half.
 297  */
 298 int sctp_backlog_rcv(struct sock *sk, struct sk_buff *skb)
 299 {
 300         struct sctp_chunk *chunk = SCTP_INPUT_CB(skb)->chunk;
 301         struct sctp_inq *inqueue = NULL;
 302         struct sctp_ep_common *rcvr = NULL;
 303
 304         rcvr = chunk->rcvr;
 305
 306         BUG_TRAP(rcvr->sk == sk);
 307
 308         if (rcvr->dead) {
 309                 sctp_chunk_free(chunk);
 310         } else {
 311                 inqueue = &chunk->rcvr->inqueue;
 312                 sctp_inq_push(inqueue, chunk);
 313         }
 314
 315         /* Release the asoc/ep ref we took in the lookup calls in sctp_rcv. */
 316         if (SCTP_EP_TYPE_ASSOCIATION == rcvr->type)
 317                 sctp_association_put(sctp_assoc(rcvr));
 318         else
 319                 sctp_endpoint_put(sctp_ep(rcvr));
 320
 321         return 0;
 322 }
 323
 324 void sctp_backlog_migrate(struct sctp_association *assoc,
 325                           struct sock *oldsk, struct sock *newsk)
 326 {
 327         struct sk_buff *skb;
 328         struct sctp_chunk *chunk;
 329
 330         skb = oldsk->sk_backlog.head;
 331         oldsk->sk_backlog.head = oldsk->sk_backlog.tail = NULL;
 332         while (skb != NULL) {
 333                 struct sk_buff *next = skb->next;
 334
 335                 chunk = SCTP_INPUT_CB(skb)->chunk;
 336                 skb->next = NULL;
 337                 if (&assoc->base == chunk->rcvr)
 338                         sk_add_backlog(newsk, skb);
 339                 else
 340                         sk_add_backlog(oldsk, skb);
 341                 skb = next;
 342         }
 343 }
 344
 345 /* Handle icmp frag needed error. */
 346 void sctp_icmp_frag_needed(struct sock *sk, struct sctp_association *asoc,
 347                            struct sctp_transport *t, __u32 pmtu)
 348 {
 349         if (sock_owned_by_user(sk) || !t || (t->pathmtu == pmtu))
 350                 return;
 351
 352         if (t->param_flags & SPP_PMTUD_ENABLE) {
 353                 if (unlikely(pmtu < SCTP_DEFAULT_MINSEGMENT)) {
 354                         printk(KERN_WARNING "%s: Reported pmtu %d too low, "
 355                                "using default minimum of %d\n",
 356                                __FUNCTION__, pmtu,
 357                                SCTP_DEFAULT_MINSEGMENT);
 358                         /* Use default minimum segment size and disable
 359                          * pmtu discovery on this transport.
 360                          */
 361                         t->pathmtu = SCTP_DEFAULT_MINSEGMENT;
 362                         t->param_flags = (t->param_flags & ~SPP_HB) |
 363                                 SPP_PMTUD_DISABLE;
 364                 } else {
 365                         t->pathmtu = pmtu;
 366                 }
 367
 368                 /* Update association pmtu. */
 369                 sctp_assoc_sync_pmtu(asoc);
 370         }
 371
 372         /* Retransmit with the new pmtu setting.
 373          * Normally, if PMTU discovery is disabled, an ICMP Fragmentation
 374          * Needed will never be sent, but if a message was sent before
 375          * PMTU discovery was disabled that was larger than the PMTU, it
 376          * would not be fragmented, so it must be re-transmitted fragmented.
 377          */
 378         sctp_retransmit(&asoc->outqueue, t, SCTP_RTXR_PMTUD);
 379 }
 380
 381 /*
 382  * SCTP Implementer's Guide, 2.37 ICMP handling procedures
 383  *
 384  * ICMP8) If the ICMP code is a "Unrecognized next header type encountered"
 385  *        or a "Protocol Unreachable" treat this message as an abort
 386  *        with the T bit set.
 387  *
 388  * This function sends an event to the state machine, which will abort the
 389  * association.
 390  *
 391  */
 392 void sctp_icmp_proto_unreachable(struct sock *sk,
 393                            struct sctp_association *asoc,
 394                            struct sctp_transport *t)
 395 {
 396         SCTP_DEBUG_PRINTK("%s\n",  __FUNCTION__);
 397
 398         sctp_do_sm(SCTP_EVENT_T_OTHER,
 399                    SCTP_ST_OTHER(SCTP_EVENT_ICMP_PROTO_UNREACH),
 400                    asoc->state, asoc->ep, asoc, t,
 401                    GFP_ATOMIC);
 402
 403 }
 404
 405 /* Common lookup code for icmp/icmpv6 error handler. */
 406 struct sock *sctp_err_lookup(int family, struct sk_buff *skb,
 407                              struct sctphdr *sctphdr,
 408                              struct sctp_association **app,
 409                              struct sctp_transport **tpp)
 410 {
 411         union sctp_addr saddr;
 412         union sctp_addr daddr;
 413         struct sctp_af *af;
 414         struct sock *sk = NULL;
 415         struct sctp_association *asoc = NULL;
 416         struct sctp_transport *transport = NULL;
 417
 418         *app = NULL; *tpp = NULL;
 419
 420         af = sctp_get_af_specific(family);
 421         if (unlikely(!af)) {
 422                 return NULL;
 423         }
 424
 425         /* Initialize local addresses for lookups. */
 426         af->from_skb(&saddr, skb, 1);
 427         af->from_skb(&daddr, skb, 0);
 428
 429         /* Look for an association that matches the incoming ICMP error
 430          * packet.
 431          */
 432         asoc = __sctp_lookup_association(&saddr, &daddr, &transport);
 433         if (!asoc)
 434                 return NULL;
 435
 436         sk = asoc->base.sk;
 437
 438         if (ntohl(sctphdr->vtag) != asoc->c.peer_vtag) {
 439                 ICMP_INC_STATS_BH(ICMP_MIB_INERRORS);
 440                 goto out;
 441         }
 442
 443         sctp_bh_lock_sock(sk);
 444
 445         /* If too many ICMPs get dropped on busy
 446          * servers this needs to be solved differently.
 447          */
 448         if (sock_owned_by_user(sk))
 449                 NET_INC_STATS_BH(LINUX_MIB_LOCKDROPPEDICMPS);
 450
 451         *app = asoc;
 452         *tpp = transport;
 453         return sk;
 454
 455 out:
 456         sock_put(sk);
 457         if (asoc)
 458                 sctp_association_put(asoc);
 459         return NULL;
 460 }
 461
 462 /* Common cleanup code for icmp/icmpv6 error handler. */
 463 void sctp_err_finish(struct sock *sk, struct sctp_association *asoc)
 464 {
 465         sctp_bh_unlock_sock(sk);
 466         sock_put(sk);
 467         if (asoc)
 468                 sctp_association_put(asoc);
 469 }
 470
 471 /*
 472  * This routine is called by the ICMP module when it gets some
 473  * sort of error condition.  If err < 0 then the socket should
 474  * be closed and the error returned to the user.  If err > 0
 475  * it's just the icmp type << 8 | icmp code.  After adjustment
 476  * header points to the first 8 bytes of the sctp header.  We need
 477  * to find the appropriate port.
 478  *
 479  * The locking strategy used here is very "optimistic". When
 480  * someone else accesses the socket the ICMP is just dropped
 481  * and for some paths there is no check at all.
 482  * A more general error queue to queue errors for later handling
 483  * is probably better.
 484  *
 485  */
 486 void sctp_v4_err(struct sk_buff *skb, __u32 info)
 487 {
 488         struct iphdr *iph = (struct iphdr *)skb->data;
 489         struct sctphdr *sh = (struct sctphdr *)(skb->data + (iph->ihl <<2));
 490         int type = skb->h.icmph->type;
 491         int code = skb->h.icmph->code;
 492         struct sock *sk;
 493         struct sctp_association *asoc;
 494         struct sctp_transport *transport;
 495         struct inet_sock *inet;
 496         char *saveip, *savesctp;
 497         int err;
 498
 499         if (skb->len < ((iph->ihl << 2) + 8)) {
 500                 ICMP_INC_STATS_BH(ICMP_MIB_INERRORS);
 501                 return;
 502         }
 503
 504         /* Fix up skb to look at the embedded net header. */
 505         saveip = skb->nh.raw;
 506         savesctp  = skb->h.raw;
 507         skb->nh.iph = iph;
 508         skb->h.raw = (char *)sh;
 509         sk = sctp_err_lookup(AF_INET, skb, sh, &asoc, &transport);
 510         /* Put back, the original pointers. */
 511         skb->nh.raw = saveip;
 512         skb->h.raw = savesctp;
 513         if (!sk) {
 514                 ICMP_INC_STATS_BH(ICMP_MIB_INERRORS);
 515                 return;
 516         }
 517         /* Warning:  The sock lock is held.  Remember to call
 518          * sctp_err_finish!
 519          */
 520
 521         switch (type) {
 522         case ICMP_PARAMETERPROB:
 523                 err = EPROTO;
 524                 break;
 525         case ICMP_DEST_UNREACH:
 526                 if (code > NR_ICMP_UNREACH)
 527                         goto out_unlock;
 528
 529                 /* PMTU discovery (RFC1191) */
 530                 if (ICMP_FRAG_NEEDED == code) {
 531                         sctp_icmp_frag_needed(sk, asoc, transport, info);
 532                         goto out_unlock;
 533                 }
 534                 else {
 535                         if (ICMP_PROT_UNREACH == code) {
 536                                 sctp_icmp_proto_unreachable(sk, asoc,
 537                                                             transport);
 538                                 goto out_unlock;
 539                         }
 540                 }
 541                 err = icmp_err_convert[code].errno;
 542                 break;
 543         case ICMP_TIME_EXCEEDED:
 544                 /* Ignore any time exceeded errors due to fragment reassembly
 545                  * timeouts.
 546                  */
 547                 if (ICMP_EXC_FRAGTIME == code)
 548                         goto out_unlock;
 549
 550                 err = EHOSTUNREACH;
 551                 break;
 552         default:
 553                 goto out_unlock;
 554         }
 555
 556         inet = inet_sk(sk);
 557         if (!sock_owned_by_user(sk) && inet->recverr) {
 558                 sk->sk_err = err;
 559                 sk->sk_error_report(sk);
 560         } else {  /* Only an error on timeout */
 561                 sk->sk_err_soft = err;
 562         }
 563
 564 out_unlock:
 565         sctp_err_finish(sk, asoc);
 566 }
 567
 568 /*
 569  * RFC 2960, 8.4 - Handle "Out of the blue" Packets.
 570  *
 571  * This function scans all the chunks in the OOTB packet to determine if
 572  * the packet should be discarded right away.  If a response might be needed
 573  * for this packet, or, if further processing is possible, the packet will
 574  * be queued to a proper inqueue for the next phase of handling.
 575  *
 576  * Output:
 577  * Return 0 - If further processing is needed.
 578  * Return 1 - If the packet can be discarded right away.
 579  */
 580 int sctp_rcv_ootb(struct sk_buff *skb)
 581 {
 582         sctp_chunkhdr_t *ch;
 583         __u8 *ch_end;
 584         sctp_errhdr_t *err;
 585
 586         ch = (sctp_chunkhdr_t *) skb->data;
 587
 588         /* Scan through all the chunks in the packet.  */
 589         do {
 590                 /* Break out if chunk length is less then minimal. */
 591                 if (ntohs(ch->length) < sizeof(sctp_chunkhdr_t))
 592                         break;
 593
 594                 ch_end = ((__u8 *)ch) + WORD_ROUND(ntohs(ch->length));
 595                 if (ch_end > skb->tail)
 596                         break;
 597
 598                 /* RFC 8.4, 2) If the OOTB packet contains an ABORT chunk, the
 599                  * receiver MUST silently discard the OOTB packet and take no
 600                  * further action.
 601                  */
 602                 if (SCTP_CID_ABORT == ch->type)
 603                         goto discard;
 604
 605                 /* RFC 8.4, 6) If the packet contains a SHUTDOWN COMPLETE
 606                  * chunk, the receiver should silently discard the packet
 607                  * and take no further action.
 608                  */
 609                 if (SCTP_CID_SHUTDOWN_COMPLETE == ch->type)
 610                         goto discard;
 611
 612                 /* RFC 8.4, 7) If the packet contains a "Stale cookie" ERROR
 613                  * or a COOKIE ACK the SCTP Packet should be silently
 614                  * discarded.
 615                  */
 616                 if (SCTP_CID_COOKIE_ACK == ch->type)
 617                         goto discard;
 618
 619                 if (SCTP_CID_ERROR == ch->type) {
 620                         sctp_walk_errors(err, ch) {
 621                                 if (SCTP_ERROR_STALE_COOKIE == err->cause)
 622                                         goto discard;
 623                         }
 624                 }
 625
 626                 ch = (sctp_chunkhdr_t *) ch_end;
 627         } while (ch_end < skb->tail);
 628
 629         return 0;
 630
 631 discard:
 632         return 1;
 633 }
 634
 635 /* Insert endpoint into the hash table.  */
 636 static void __sctp_hash_endpoint(struct sctp_endpoint *ep)
 637 {
 638         struct sctp_ep_common **epp;
 639         struct sctp_ep_common *epb;
 640         struct sctp_hashbucket *head;
 641
 642         epb = &ep->base;
 643
 644         epb->hashent = sctp_ep_hashfn(epb->bind_addr.port);
 645         head = &sctp_ep_hashtable[epb->hashent];
 646
 647         sctp_write_lock(&head->lock);
 648         epp = &head->chain;
 649         epb->next = *epp;
 650         if (epb->next)
 651                 (*epp)->pprev = &epb->next;
 652         *epp = epb;
 653         epb->pprev = epp;
 654         sctp_write_unlock(&head->lock);
 655 }
 656
 657 /* Add an endpoint to the hash. Local BH-safe. */
 658 void sctp_hash_endpoint(struct sctp_endpoint *ep)
 659 {
 660         sctp_local_bh_disable();
 661         __sctp_hash_endpoint(ep);
 662         sctp_local_bh_enable();
 663 }
 664
 665 /* Remove endpoint from the hash table.  */
 666 static void __sctp_unhash_endpoint(struct sctp_endpoint *ep)
 667 {
 668         struct sctp_hashbucket *head;
 669         struct sctp_ep_common *epb;
 670
 671         epb = &ep->base;
 672
 673         epb->hashent = sctp_ep_hashfn(epb->bind_addr.port);
 674
 675         head = &sctp_ep_hashtable[epb->hashent];
 676
 677         sctp_write_lock(&head->lock);
 678
 679         if (epb->pprev) {
 680                 if (epb->next)
 681                         epb->next->pprev = epb->pprev;
 682                 *epb->pprev = epb->next;
 683                 epb->pprev = NULL;
 684         }
 685
 686         sctp_write_unlock(&head->lock);
 687 }
 688
 689 /* Remove endpoint from the hash.  Local BH-safe. */
 690 void sctp_unhash_endpoint(struct sctp_endpoint *ep)
 691 {
 692         sctp_local_bh_disable();
 693         __sctp_unhash_endpoint(ep);
 694         sctp_local_bh_enable();
 695 }
 696
 697 /* Look up an endpoint. */
 698 static struct sctp_endpoint *__sctp_rcv_lookup_endpoint(const union sctp_addr *laddr)
 699 {
 700         struct sctp_hashbucket *head;
 701         struct sctp_ep_common *epb;
 702         struct sctp_endpoint *ep;
 703         int hash;
 704
 705         hash = sctp_ep_hashfn(laddr->v4.sin_port);
 706         head = &sctp_ep_hashtable[hash];
 707         read_lock(&head->lock);
 708         for (epb = head->chain; epb; epb = epb->next) {
 709                 ep = sctp_ep(epb);
 710                 if (sctp_endpoint_is_match(ep, laddr))
 711                         goto hit;
 712         }
 713
 714         ep = sctp_sk((sctp_get_ctl_sock()))->ep;
 715         epb = &ep->base;
 716
 717 hit:
 718         sctp_endpoint_hold(ep);
 719         sock_hold(epb->sk);
 720         read_unlock(&head->lock);
 721         return ep;
 722 }
 723
 724 /* Insert association into the hash table.  */
 725 static void __sctp_hash_established(struct sctp_association *asoc)
 726 {
 727         struct sctp_ep_common **epp;
 728         struct sctp_ep_common *epb;
 729         struct sctp_hashbucket *head;
 730
 731         epb = &asoc->base;
 732
 733         /* Calculate which chain this entry will belong to. */
 734         epb->hashent = sctp_assoc_hashfn(epb->bind_addr.port, asoc->peer.port);
 735
 736         head = &sctp_assoc_hashtable[epb->hashent];
 737
 738         sctp_write_lock(&head->lock);
 739         epp = &head->chain;
 740         epb->next = *epp;
 741         if (epb->next)
 742                 (*epp)->pprev = &epb->next;
 743         *epp = epb;
 744         epb->pprev = epp;
 745         sctp_write_unlock(&head->lock);
 746 }
 747
 748 /* Add an association to the hash. Local BH-safe. */
 749 void sctp_hash_established(struct sctp_association *asoc)
 750 {
 751         sctp_local_bh_disable();
 752         __sctp_hash_established(asoc);
 753         sctp_local_bh_enable();
 754 }
 755
 756 /* Remove association from the hash table.  */
 757 static void __sctp_unhash_established(struct sctp_association *asoc)
 758 {
 759         struct sctp_hashbucket *head;
 760         struct sctp_ep_common *epb;
 761
 762         epb = &asoc->base;
 763
 764         epb->hashent = sctp_assoc_hashfn(epb->bind_addr.port,
 765                                          asoc->peer.port);
 766
 767         head = &sctp_assoc_hashtable[epb->hashent];
 768
 769         sctp_write_lock(&head->lock);
 770
 771         if (epb->pprev) {
 772                 if (epb->next)
 773                         epb->next->pprev = epb->pprev;
 774                 *epb->pprev = epb->next;
 775                 epb->pprev = NULL;
 776         }
 777
 778         sctp_write_unlock(&head->lock);
 779 }
 780
 781 /* Remove association from the hash table.  Local BH-safe. */
 782 void sctp_unhash_established(struct sctp_association *asoc)
 783 {
 784         sctp_local_bh_disable();
 785         __sctp_unhash_established(asoc);
 786         sctp_local_bh_enable();
 787 }
 788
 789 /* Look up an association. */
 790 static struct sctp_association *__sctp_lookup_association(
 791                                         const union sctp_addr *local,
 792                                         const union sctp_addr *peer,
 793                                         struct sctp_transport **pt)
 794 {
 795         struct sctp_hashbucket *head;
 796         struct sctp_ep_common *epb;
 797         struct sctp_association *asoc;
 798         struct sctp_transport *transport;
 799         int hash;
 800
 801         /* Optimize here for direct hit, only listening connections can
 802          * have wildcards anyways.
 803          */
 804         hash = sctp_assoc_hashfn(local->v4.sin_port, peer->v4.sin_port);
 805         head = &sctp_assoc_hashtable[hash];
 806         read_lock(&head->lock);
 807         for (epb = head->chain; epb; epb = epb->next) {
 808                 asoc = sctp_assoc(epb);
 809                 transport = sctp_assoc_is_match(asoc, local, peer);
 810                 if (transport)
 811                         goto hit;
 812         }
 813
 814         read_unlock(&head->lock);
 815
 816         return NULL;
 817
 818 hit:
 819         *pt = transport;
 820         sctp_association_hold(asoc);
 821         sock_hold(epb->sk);
 822         read_unlock(&head->lock);
 823         return asoc;
 824 }
 825
 826 /* Look up an association. BH-safe. */
 827 SCTP_STATIC
 828 struct sctp_association *sctp_lookup_association(const union sctp_addr *laddr,
 829                                                  const union sctp_addr *paddr,
 830                                             struct sctp_transport **transportp)
 831 {
 832         struct sctp_association *asoc;
 833
 834         sctp_local_bh_disable();
 835         asoc = __sctp_lookup_association(laddr, paddr, transportp);
 836         sctp_local_bh_enable();
 837
 838         return asoc;
 839 }
 840
 841 /* Is there an association matching the given local and peer addresses? */
 842 int sctp_has_association(const union sctp_addr *laddr,
 843                          const union sctp_addr *paddr)
 844 {
 845         struct sctp_association *asoc;
 846         struct sctp_transport *transport;
 847
 848         if ((asoc = sctp_lookup_association(laddr, paddr, &transport))) {
 849                 sock_put(asoc->base.sk);
 850                 sctp_association_put(asoc);
 851                 return 1;
 852         }
 853
 854         return 0;
 855 }
 856
 857 /*
 858  * SCTP Implementors Guide, 2.18 Handling of address
 859  * parameters within the INIT or INIT-ACK.
 860  *
 861  * D) When searching for a matching TCB upon reception of an INIT
 862  *    or INIT-ACK chunk the receiver SHOULD use not only the
 863  *    source address of the packet (containing the INIT or
 864  *    INIT-ACK) but the receiver SHOULD also use all valid
 865  *    address parameters contained within the chunk.
 866  *
 867  * 2.18.3 Solution description
 868  *
 869  * This new text clearly specifies to an implementor the need
 870  * to look within the INIT or INIT-ACK. Any implementation that
 871  * does not do this, may not be able to establish associations
 872  * in certain circumstances.
 873  *
 874  */
 875 static struct sctp_association *__sctp_rcv_init_lookup(struct sk_buff *skb,
 876         const union sctp_addr *laddr, struct sctp_transport **transportp)
 877 {
 878         struct sctp_association *asoc;
 879         union sctp_addr addr;
 880         union sctp_addr *paddr = &addr;
 881         struct sctphdr *sh = (struct sctphdr *) skb->h.raw;
 882         sctp_chunkhdr_t *ch;
 883         union sctp_params params;
 884         sctp_init_chunk_t *init;
 885         struct sctp_transport *transport;
 886         struct sctp_af *af;
 887
 888         ch = (sctp_chunkhdr_t *) skb->data;
 889
 890         /* If this is INIT/INIT-ACK look inside the chunk too. */
 891         switch (ch->type) {
 892         case SCTP_CID_INIT:
 893         case SCTP_CID_INIT_ACK:
 894                 break;
 895         default:
 896                 return NULL;
 897         }
 898
 899         /* The code below will attempt to walk the chunk and extract
 900          * parameter information.  Before we do that, we need to verify
 901          * that the chunk length doesn't cause overflow.  Otherwise, we'll
 902          * walk off the end.
 903          */
 904         if (WORD_ROUND(ntohs(ch->length)) > skb->len)
 905                 return NULL;
 906
 907         /*
 908          * This code will NOT touch anything inside the chunk--it is
 909          * strictly READ-ONLY.
 910          *
 911          * RFC 2960 3  SCTP packet Format
 912          *
 913          * Multiple chunks can be bundled into one SCTP packet up to
 914          * the MTU size, except for the INIT, INIT ACK, and SHUTDOWN
 915          * COMPLETE chunks.  These chunks MUST NOT be bundled with any
 916          * other chunk in a packet.  See Section 6.10 for more details
 917          * on chunk bundling.
 918          */
 919
 920         /* Find the start of the TLVs and the end of the chunk.  This is
 921          * the region we search for address parameters.
 922          */
 923         init = (sctp_init_chunk_t *)skb->data;
 924
 925         /* Walk the parameters looking for embedded addresses. */
 926         sctp_walk_params(params, init, init_hdr.params) {
 927
 928                 /* Note: Ignoring hostname addresses. */
 929                 af = sctp_get_af_specific(param_type2af(params.p->type));
 930                 if (!af)
 931                         continue;
 932
 933                 af->from_addr_param(paddr, params.addr, ntohs(sh->source), 0);
 934
 935                 asoc = __sctp_lookup_association(laddr, paddr, &transport);
 936                 if (asoc)
 937                         return asoc;
 938         }
 939
 940         return NULL;
 941 }
 942
 943 /* Lookup an association for an inbound skb. */
 944 static struct sctp_association *__sctp_rcv_lookup(struct sk_buff *skb,
 945                                       const union sctp_addr *paddr,
 946                                       const union sctp_addr *laddr,
 947                                       struct sctp_transport **transportp)
 948 {
 949         struct sctp_association *asoc;
 950
 951         asoc = __sctp_lookup_association(laddr, paddr, transportp);
 952
 953         /* Further lookup for INIT/INIT-ACK packets.
 954          * SCTP Implementors Guide, 2.18 Handling of address
 955          * parameters within the INIT or INIT-ACK.
 956          */
 957         if (!asoc)
 958                 asoc = __sctp_rcv_init_lookup(skb, laddr, transportp);
 959
 960         return asoc;
 961 }