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 /* The free routine for skbuffs that sctp receives */
 104 static void sctp_rfree(struct sk_buff *skb)
 105 {
 106         atomic_sub(sizeof(struct sctp_chunk),&skb->sk->sk_rmem_alloc);
 107         sock_rfree(skb);
 108 }
 109
 110 /* The ownership wrapper routine to do receive buffer accounting */
 111 static void sctp_rcv_set_owner_r(struct sk_buff *skb, struct sock *sk)
 112 {
 113         skb_set_owner_r(skb,sk);
 114         skb->destructor = sctp_rfree;
 115         atomic_add(sizeof(struct sctp_chunk),&sk->sk_rmem_alloc);
 116 }
 117
 118 struct sctp_input_cb {
 119         union {
 120                 struct inet_skb_parm    h4;
 121 #if defined(CONFIG_IPV6) || defined (CONFIG_IPV6_MODULE)
 122                 struct inet6_skb_parm   h6;
 123 #endif
 124         } header;
 125         struct sctp_chunk *chunk;
 126 };
 127 #define SCTP_INPUT_CB(__skb)    ((struct sctp_input_cb *)&((__skb)->cb[0]))
 128
 129 /*
 130  * This is the routine which IP calls when receiving an SCTP packet.
 131  */
 132 int sctp_rcv(struct sk_buff *skb)
 133 {
 134         struct sock *sk;
 135         struct sctp_association *asoc;
 136         struct sctp_endpoint *ep = NULL;
 137         struct sctp_ep_common *rcvr;
 138         struct sctp_transport *transport = NULL;
 139         struct sctp_chunk *chunk;
 140         struct sctphdr *sh;
 141         union sctp_addr src;
 142         union sctp_addr dest;
 143         int family;
 144         struct sctp_af *af;
 145         int ret = 0;
 146
 147         if (skb->pkt_type!=PACKET_HOST)
 148                 goto discard_it;
 149
 150         SCTP_INC_STATS_BH(SCTP_MIB_INSCTPPACKS);
 151
 152         sh = (struct sctphdr *) skb->h.raw;
 153
 154         /* Pull up the IP and SCTP headers. */
 155         __skb_pull(skb, skb->h.raw - skb->data);
 156         if (skb->len < sizeof(struct sctphdr))
 157                 goto discard_it;
 158         if (sctp_rcv_checksum(skb) < 0)
 159                 goto discard_it;
 160
 161         skb_pull(skb, sizeof(struct sctphdr));
 162
 163         /* Make sure we at least have chunk headers worth of data left. */
 164         if (skb->len < sizeof(struct sctp_chunkhdr))
 165                 goto discard_it;
 166
 167         family = ipver2af(skb->nh.iph->version);
 168         af = sctp_get_af_specific(family);
 169         if (unlikely(!af))
 170                 goto discard_it;
 171
 172         /* Initialize local addresses for lookups. */
 173         af->from_skb(&src, skb, 1);
 174         af->from_skb(&dest, skb, 0);
 175
 176         /* If the packet is to or from a non-unicast address,
 177          * silently discard the packet.
 178          *
 179          * This is not clearly defined in the RFC except in section
 180          * 8.4 - OOTB handling.  However, based on the book "Stream Control
 181          * Transmission Protocol" 2.1, "It is important to note that the
 182          * IP address of an SCTP transport address must be a routable
 183          * unicast address.  In other words, IP multicast addresses and
 184          * IP broadcast addresses cannot be used in an SCTP transport
 185          * address."
 186          */
 187         if (!af->addr_valid(&src, NULL) || !af->addr_valid(&dest, NULL))
 188                 goto discard_it;
 189
 190         asoc = __sctp_rcv_lookup(skb, &src, &dest, &transport);
 191
 192         if (!asoc)
 193                 ep = __sctp_rcv_lookup_endpoint(&dest);
 194
 195         /* Retrieve the common input handling substructure. */
 196         rcvr = asoc ? &asoc->base : &ep->base;
 197         sk = rcvr->sk;
 198
 199         /*
 200          * If a frame arrives on an interface and the receiving socket is
 201          * bound to another interface, via SO_BINDTODEVICE, treat it as OOTB
 202          */
 203         if (sk->sk_bound_dev_if && (sk->sk_bound_dev_if != af->skb_iif(skb)))
 204         {
 205                 sock_put(sk);
 206                 if (asoc) {
 207                         sctp_association_put(asoc);
 208                         asoc = NULL;
 209                 } else {
 210                         sctp_endpoint_put(ep);
 211                         ep = NULL;
 212                 }
 213                 sk = sctp_get_ctl_sock();
 214                 ep = sctp_sk(sk)->ep;
 215                 sctp_endpoint_hold(ep);
 216                 sock_hold(sk);
 217                 rcvr = &ep->base;
 218         }
 219
 220         if (atomic_read(&sk->sk_rmem_alloc) >= sk->sk_rcvbuf)
 221                 goto discard_release;
 222
 223         /*
 224          * RFC 2960, 8.4 - Handle "Out of the blue" Packets.
 225          * An SCTP packet is called an "out of the blue" (OOTB)
 226          * packet if it is correctly formed, i.e., passed the
 227          * receiver's checksum check, but the receiver is not
 228          * able to identify the association to which this
 229          * packet belongs.
 230          */
 231         if (!asoc) {
 232                 if (sctp_rcv_ootb(skb)) {
 233                         SCTP_INC_STATS_BH(SCTP_MIB_OUTOFBLUES);
 234                         goto discard_release;
 235                 }
 236         }
 237
 238         /* SCTP seems to always need a timestamp right now (FIXME) */
 239         if (skb->tstamp.off_sec == 0) {
 240                 __net_timestamp(skb);
 241                 sock_enable_timestamp(sk);
 242         }
 243
 244         if (!xfrm_policy_check(sk, XFRM_POLICY_IN, skb, family))
 245                 goto discard_release;
 246
 247         ret = sk_filter(sk, skb, 1);
 248         if (ret)
 249                 goto discard_release;
 250
 251         /* Create an SCTP packet structure. */
 252         chunk = sctp_chunkify(skb, asoc, sk);
 253         if (!chunk) {
 254                 ret = -ENOMEM;
 255                 goto discard_release;
 256         }
 257         SCTP_INPUT_CB(skb)->chunk = chunk;
 258
 259         sctp_rcv_set_owner_r(skb,sk);
 260
 261         /* Remember what endpoint is to handle this packet. */
 262         chunk->rcvr = rcvr;
 263
 264         /* Remember the SCTP header. */
 265         chunk->sctp_hdr = sh;
 266
 267         /* Set the source and destination addresses of the incoming chunk.  */
 268         sctp_init_addrs(chunk, &src, &dest);
 269
 270         /* Remember where we came from.  */
 271         chunk->transport = transport;
 272
 273         /* Acquire access to the sock lock. Note: We are safe from other
 274          * bottom halves on this lock, but a user may be in the lock too,
 275          * so check if it is busy.
 276          */
 277         sctp_bh_lock_sock(sk);
 278
 279         if (sock_owned_by_user(sk))
 280                 sk_add_backlog(sk, skb);
 281         else
 282                 sctp_backlog_rcv(sk, skb);
 283
 284         /* Release the sock and any reference counts we took in the
 285          * lookup calls.
 286          */
 287         sctp_bh_unlock_sock(sk);
 288         if (asoc)
 289                 sctp_association_put(asoc);
 290         else
 291                 sctp_endpoint_put(ep);
 292         sock_put(sk);
 293         return ret;
 294
 295 discard_it:
 296         kfree_skb(skb);
 297         return ret;
 298
 299 discard_release:
 300         /* Release any structures we may be holding. */
 301         sock_put(sk);
 302         if (asoc)
 303                 sctp_association_put(asoc);
 304         else
 305                 sctp_endpoint_put(ep);
 306
 307         goto discard_it;
 308 }
 309
 310 /* Handle second half of inbound skb processing.  If the sock was busy,
 311  * we may have need to delay processing until later when the sock is
 312  * released (on the backlog).   If not busy, we call this routine
 313  * directly from the bottom half.
 314  */
 315 int sctp_backlog_rcv(struct sock *sk, struct sk_buff *skb)
 316 {
 317         struct sctp_chunk *chunk = SCTP_INPUT_CB(skb)->chunk;
 318         struct sctp_inq *inqueue = &chunk->rcvr->inqueue;
 319
 320         sctp_inq_push(inqueue, chunk);
 321         return 0;
 322 }
 323
 324 /* Handle icmp frag needed error. */
 325 void sctp_icmp_frag_needed(struct sock *sk, struct sctp_association *asoc,
 326                            struct sctp_transport *t, __u32 pmtu)
 327 {
 328         if (unlikely(pmtu < SCTP_DEFAULT_MINSEGMENT)) {
 329                 printk(KERN_WARNING "%s: Reported pmtu %d too low, "
 330                        "using default minimum of %d\n", __FUNCTION__, pmtu,
 331                        SCTP_DEFAULT_MINSEGMENT);
 332                 pmtu = SCTP_DEFAULT_MINSEGMENT;
 333         }
 334
 335         if (!sock_owned_by_user(sk) && t && (t->pmtu != pmtu)) {
 336                 t->pmtu = pmtu;
 337                 sctp_assoc_sync_pmtu(asoc);
 338                 sctp_retransmit(&asoc->outqueue, t, SCTP_RTXR_PMTUD);
 339         }
 340 }
 341
 342 /*
 343  * SCTP Implementer's Guide, 2.37 ICMP handling procedures
 344  *
 345  * ICMP8) If the ICMP code is a "Unrecognized next header type encountered"
 346  *        or a "Protocol Unreachable" treat this message as an abort
 347  *        with the T bit set.
 348  *
 349  * This function sends an event to the state machine, which will abort the
 350  * association.
 351  *
 352  */
 353 void sctp_icmp_proto_unreachable(struct sock *sk,
 354                            struct sctp_association *asoc,
 355                            struct sctp_transport *t)
 356 {
 357         SCTP_DEBUG_PRINTK("%s\n",  __FUNCTION__);
 358
 359         sctp_do_sm(SCTP_EVENT_T_OTHER,
 360                    SCTP_ST_OTHER(SCTP_EVENT_ICMP_PROTO_UNREACH),
 361                    asoc->state, asoc->ep, asoc, t,
 362                    GFP_ATOMIC);
 363
 364 }
 365
 366 /* Common lookup code for icmp/icmpv6 error handler. */
 367 struct sock *sctp_err_lookup(int family, struct sk_buff *skb,
 368                              struct sctphdr *sctphdr,
 369                              struct sctp_association **app,
 370                              struct sctp_transport **tpp)
 371 {
 372         union sctp_addr saddr;
 373         union sctp_addr daddr;
 374         struct sctp_af *af;
 375         struct sock *sk = NULL;
 376         struct sctp_association *asoc = NULL;
 377         struct sctp_transport *transport = NULL;
 378
 379         *app = NULL; *tpp = NULL;
 380
 381         af = sctp_get_af_specific(family);
 382         if (unlikely(!af)) {
 383                 return NULL;
 384         }
 385
 386         /* Initialize local addresses for lookups. */
 387         af->from_skb(&saddr, skb, 1);
 388         af->from_skb(&daddr, skb, 0);
 389
 390         /* Look for an association that matches the incoming ICMP error
 391          * packet.
 392          */
 393         asoc = __sctp_lookup_association(&saddr, &daddr, &transport);
 394         if (!asoc)
 395                 return NULL;
 396
 397         sk = asoc->base.sk;
 398
 399         if (ntohl(sctphdr->vtag) != asoc->c.peer_vtag) {
 400                 ICMP_INC_STATS_BH(ICMP_MIB_INERRORS);
 401                 goto out;
 402         }
 403
 404         sctp_bh_lock_sock(sk);
 405
 406         /* If too many ICMPs get dropped on busy
 407          * servers this needs to be solved differently.
 408          */
 409         if (sock_owned_by_user(sk))
 410                 NET_INC_STATS_BH(LINUX_MIB_LOCKDROPPEDICMPS);
 411
 412         *app = asoc;
 413         *tpp = transport;
 414         return sk;
 415
 416 out:
 417         sock_put(sk);
 418         if (asoc)
 419                 sctp_association_put(asoc);
 420         return NULL;
 421 }
 422
 423 /* Common cleanup code for icmp/icmpv6 error handler. */
 424 void sctp_err_finish(struct sock *sk, struct sctp_association *asoc)
 425 {
 426         sctp_bh_unlock_sock(sk);
 427         sock_put(sk);
 428         if (asoc)
 429                 sctp_association_put(asoc);
 430 }
 431
 432 /*
 433  * This routine is called by the ICMP module when it gets some
 434  * sort of error condition.  If err < 0 then the socket should
 435  * be closed and the error returned to the user.  If err > 0
 436  * it's just the icmp type << 8 | icmp code.  After adjustment
 437  * header points to the first 8 bytes of the sctp header.  We need
 438  * to find the appropriate port.
 439  *
 440  * The locking strategy used here is very "optimistic". When
 441  * someone else accesses the socket the ICMP is just dropped
 442  * and for some paths there is no check at all.
 443  * A more general error queue to queue errors for later handling
 444  * is probably better.
 445  *
 446  */
 447 void sctp_v4_err(struct sk_buff *skb, __u32 info)
 448 {
 449         struct iphdr *iph = (struct iphdr *)skb->data;
 450         struct sctphdr *sh = (struct sctphdr *)(skb->data + (iph->ihl <<2));
 451         int type = skb->h.icmph->type;
 452         int code = skb->h.icmph->code;
 453         struct sock *sk;
 454         struct sctp_association *asoc;
 455         struct sctp_transport *transport;
 456         struct inet_sock *inet;
 457         char *saveip, *savesctp;
 458         int err;
 459
 460         if (skb->len < ((iph->ihl << 2) + 8)) {
 461                 ICMP_INC_STATS_BH(ICMP_MIB_INERRORS);
 462                 return;
 463         }
 464
 465         /* Fix up skb to look at the embedded net header. */
 466         saveip = skb->nh.raw;
 467         savesctp  = skb->h.raw;
 468         skb->nh.iph = iph;
 469         skb->h.raw = (char *)sh;
 470         sk = sctp_err_lookup(AF_INET, skb, sh, &asoc, &transport);
 471         /* Put back, the original pointers. */
 472         skb->nh.raw = saveip;
 473         skb->h.raw = savesctp;
 474         if (!sk) {
 475                 ICMP_INC_STATS_BH(ICMP_MIB_INERRORS);
 476                 return;
 477         }
 478         /* Warning:  The sock lock is held.  Remember to call
 479          * sctp_err_finish!
 480          */
 481
 482         switch (type) {
 483         case ICMP_PARAMETERPROB:
 484                 err = EPROTO;
 485                 break;
 486         case ICMP_DEST_UNREACH:
 487                 if (code > NR_ICMP_UNREACH)
 488                         goto out_unlock;
 489
 490                 /* PMTU discovery (RFC1191) */
 491                 if (ICMP_FRAG_NEEDED == code) {
 492                         sctp_icmp_frag_needed(sk, asoc, transport, info);
 493                         goto out_unlock;
 494                 }
 495                 else {
 496                         if (ICMP_PROT_UNREACH == code) {
 497                                 sctp_icmp_proto_unreachable(sk, asoc,
 498                                                             transport);
 499                                 goto out_unlock;
 500                         }
 501                 }
 502                 err = icmp_err_convert[code].errno;
 503                 break;
 504         case ICMP_TIME_EXCEEDED:
 505                 /* Ignore any time exceeded errors due to fragment reassembly
 506                  * timeouts.
 507                  */
 508                 if (ICMP_EXC_FRAGTIME == code)
 509                         goto out_unlock;
 510
 511                 err = EHOSTUNREACH;
 512                 break;
 513         default:
 514                 goto out_unlock;
 515         }
 516
 517         inet = inet_sk(sk);
 518         if (!sock_owned_by_user(sk) && inet->recverr) {
 519                 sk->sk_err = err;
 520                 sk->sk_error_report(sk);
 521         } else {  /* Only an error on timeout */
 522                 sk->sk_err_soft = err;
 523         }
 524
 525 out_unlock:
 526         sctp_err_finish(sk, asoc);
 527 }
 528
 529 /*
 530  * RFC 2960, 8.4 - Handle "Out of the blue" Packets.
 531  *
 532  * This function scans all the chunks in the OOTB packet to determine if
 533  * the packet should be discarded right away.  If a response might be needed
 534  * for this packet, or, if further processing is possible, the packet will
 535  * be queued to a proper inqueue for the next phase of handling.
 536  *
 537  * Output:
 538  * Return 0 - If further processing is needed.
 539  * Return 1 - If the packet can be discarded right away.
 540  */
 541 int sctp_rcv_ootb(struct sk_buff *skb)
 542 {
 543         sctp_chunkhdr_t *ch;
 544         __u8 *ch_end;
 545         sctp_errhdr_t *err;
 546
 547         ch = (sctp_chunkhdr_t *) skb->data;
 548         ch_end = ((__u8 *) ch) + WORD_ROUND(ntohs(ch->length));
 549
 550         /* Scan through all the chunks in the packet.  */
 551         while (ch_end > (__u8 *)ch && ch_end < skb->tail) {
 552
 553                 /* RFC 8.4, 2) If the OOTB packet contains an ABORT chunk, the
 554                  * receiver MUST silently discard the OOTB packet and take no
 555                  * further action.
 556                  */
 557                 if (SCTP_CID_ABORT == ch->type)
 558                         goto discard;
 559
 560                 /* RFC 8.4, 6) If the packet contains a SHUTDOWN COMPLETE
 561                  * chunk, the receiver should silently discard the packet
 562                  * and take no further action.
 563                  */
 564                 if (SCTP_CID_SHUTDOWN_COMPLETE == ch->type)
 565                         goto discard;
 566
 567                 /* RFC 8.4, 7) If the packet contains a "Stale cookie" ERROR
 568                  * or a COOKIE ACK the SCTP Packet should be silently
 569                  * discarded.
 570                  */
 571                 if (SCTP_CID_COOKIE_ACK == ch->type)
 572                         goto discard;
 573
 574                 if (SCTP_CID_ERROR == ch->type) {
 575                         sctp_walk_errors(err, ch) {
 576                                 if (SCTP_ERROR_STALE_COOKIE == err->cause)
 577                                         goto discard;
 578                         }
 579                 }
 580
 581                 ch = (sctp_chunkhdr_t *) ch_end;
 582                 ch_end = ((__u8 *) ch) + WORD_ROUND(ntohs(ch->length));
 583         }
 584
 585         return 0;
 586
 587 discard:
 588         return 1;
 589 }
 590
 591 /* Insert endpoint into the hash table.  */
 592 static void __sctp_hash_endpoint(struct sctp_endpoint *ep)
 593 {
 594         struct sctp_ep_common **epp;
 595         struct sctp_ep_common *epb;
 596         struct sctp_hashbucket *head;
 597
 598         epb = &ep->base;
 599
 600         epb->hashent = sctp_ep_hashfn(epb->bind_addr.port);
 601         head = &sctp_ep_hashtable[epb->hashent];
 602
 603         sctp_write_lock(&head->lock);
 604         epp = &head->chain;
 605         epb->next = *epp;
 606         if (epb->next)
 607                 (*epp)->pprev = &epb->next;
 608         *epp = epb;
 609         epb->pprev = epp;
 610         sctp_write_unlock(&head->lock);
 611 }
 612
 613 /* Add an endpoint to the hash. Local BH-safe. */
 614 void sctp_hash_endpoint(struct sctp_endpoint *ep)
 615 {
 616         sctp_local_bh_disable();
 617         __sctp_hash_endpoint(ep);
 618         sctp_local_bh_enable();
 619 }
 620
 621 /* Remove endpoint from the hash table.  */
 622 static void __sctp_unhash_endpoint(struct sctp_endpoint *ep)
 623 {
 624         struct sctp_hashbucket *head;
 625         struct sctp_ep_common *epb;
 626
 627         epb = &ep->base;
 628
 629         epb->hashent = sctp_ep_hashfn(epb->bind_addr.port);
 630
 631         head = &sctp_ep_hashtable[epb->hashent];
 632
 633         sctp_write_lock(&head->lock);
 634
 635         if (epb->pprev) {
 636                 if (epb->next)
 637                         epb->next->pprev = epb->pprev;
 638                 *epb->pprev = epb->next;
 639                 epb->pprev = NULL;
 640         }
 641
 642         sctp_write_unlock(&head->lock);
 643 }
 644
 645 /* Remove endpoint from the hash.  Local BH-safe. */
 646 void sctp_unhash_endpoint(struct sctp_endpoint *ep)
 647 {
 648         sctp_local_bh_disable();
 649         __sctp_unhash_endpoint(ep);
 650         sctp_local_bh_enable();
 651 }
 652
 653 /* Look up an endpoint. */
 654 static struct sctp_endpoint *__sctp_rcv_lookup_endpoint(const union sctp_addr *laddr)
 655 {
 656         struct sctp_hashbucket *head;
 657         struct sctp_ep_common *epb;
 658         struct sctp_endpoint *ep;
 659         int hash;
 660
 661         hash = sctp_ep_hashfn(laddr->v4.sin_port);
 662         head = &sctp_ep_hashtable[hash];
 663         read_lock(&head->lock);
 664         for (epb = head->chain; epb; epb = epb->next) {
 665                 ep = sctp_ep(epb);
 666                 if (sctp_endpoint_is_match(ep, laddr))
 667                         goto hit;
 668         }
 669
 670         ep = sctp_sk((sctp_get_ctl_sock()))->ep;
 671         epb = &ep->base;
 672
 673 hit:
 674         sctp_endpoint_hold(ep);
 675         sock_hold(epb->sk);
 676         read_unlock(&head->lock);
 677         return ep;
 678 }
 679
 680 /* Insert association into the hash table.  */
 681 static void __sctp_hash_established(struct sctp_association *asoc)
 682 {
 683         struct sctp_ep_common **epp;
 684         struct sctp_ep_common *epb;
 685         struct sctp_hashbucket *head;
 686
 687         epb = &asoc->base;
 688
 689         /* Calculate which chain this entry will belong to. */
 690         epb->hashent = sctp_assoc_hashfn(epb->bind_addr.port, asoc->peer.port);
 691
 692         head = &sctp_assoc_hashtable[epb->hashent];
 693
 694         sctp_write_lock(&head->lock);
 695         epp = &head->chain;
 696         epb->next = *epp;
 697         if (epb->next)
 698                 (*epp)->pprev = &epb->next;
 699         *epp = epb;
 700         epb->pprev = epp;
 701         sctp_write_unlock(&head->lock);
 702 }
 703
 704 /* Add an association to the hash. Local BH-safe. */
 705 void sctp_hash_established(struct sctp_association *asoc)
 706 {
 707         sctp_local_bh_disable();
 708         __sctp_hash_established(asoc);
 709         sctp_local_bh_enable();
 710 }
 711
 712 /* Remove association from the hash table.  */
 713 static void __sctp_unhash_established(struct sctp_association *asoc)
 714 {
 715         struct sctp_hashbucket *head;
 716         struct sctp_ep_common *epb;
 717
 718         epb = &asoc->base;
 719
 720         epb->hashent = sctp_assoc_hashfn(epb->bind_addr.port,
 721                                          asoc->peer.port);
 722
 723         head = &sctp_assoc_hashtable[epb->hashent];
 724
 725         sctp_write_lock(&head->lock);
 726
 727         if (epb->pprev) {
 728                 if (epb->next)
 729                         epb->next->pprev = epb->pprev;
 730                 *epb->pprev = epb->next;
 731                 epb->pprev = NULL;
 732         }
 733
 734         sctp_write_unlock(&head->lock);
 735 }
 736
 737 /* Remove association from the hash table.  Local BH-safe. */
 738 void sctp_unhash_established(struct sctp_association *asoc)
 739 {
 740         sctp_local_bh_disable();
 741         __sctp_unhash_established(asoc);
 742         sctp_local_bh_enable();
 743 }
 744
 745 /* Look up an association. */
 746 static struct sctp_association *__sctp_lookup_association(
 747                                         const union sctp_addr *local,
 748                                         const union sctp_addr *peer,
 749                                         struct sctp_transport **pt)
 750 {
 751         struct sctp_hashbucket *head;
 752         struct sctp_ep_common *epb;
 753         struct sctp_association *asoc;
 754         struct sctp_transport *transport;
 755         int hash;
 756
 757         /* Optimize here for direct hit, only listening connections can
 758          * have wildcards anyways.
 759          */
 760         hash = sctp_assoc_hashfn(local->v4.sin_port, peer->v4.sin_port);
 761         head = &sctp_assoc_hashtable[hash];
 762         read_lock(&head->lock);
 763         for (epb = head->chain; epb; epb = epb->next) {
 764                 asoc = sctp_assoc(epb);
 765                 transport = sctp_assoc_is_match(asoc, local, peer);
 766                 if (transport)
 767                         goto hit;
 768         }
 769
 770         read_unlock(&head->lock);
 771
 772         return NULL;
 773
 774 hit:
 775         *pt = transport;
 776         sctp_association_hold(asoc);
 777         sock_hold(epb->sk);
 778         read_unlock(&head->lock);
 779         return asoc;
 780 }
 781
 782 /* Look up an association. BH-safe. */
 783 SCTP_STATIC
 784 struct sctp_association *sctp_lookup_association(const union sctp_addr *laddr,
 785                                                  const union sctp_addr *paddr,
 786                                             struct sctp_transport **transportp)
 787 {
 788         struct sctp_association *asoc;
 789
 790         sctp_local_bh_disable();
 791         asoc = __sctp_lookup_association(laddr, paddr, transportp);
 792         sctp_local_bh_enable();
 793
 794         return asoc;
 795 }
 796
 797 /* Is there an association matching the given local and peer addresses? */
 798 int sctp_has_association(const union sctp_addr *laddr,
 799                          const union sctp_addr *paddr)
 800 {
 801         struct sctp_association *asoc;
 802         struct sctp_transport *transport;
 803
 804         if ((asoc = sctp_lookup_association(laddr, paddr, &transport))) {
 805                 sock_put(asoc->base.sk);
 806                 sctp_association_put(asoc);
 807                 return 1;
 808         }
 809
 810         return 0;
 811 }
 812
 813 /*
 814  * SCTP Implementors Guide, 2.18 Handling of address
 815  * parameters within the INIT or INIT-ACK.
 816  *
 817  * D) When searching for a matching TCB upon reception of an INIT
 818  *    or INIT-ACK chunk the receiver SHOULD use not only the
 819  *    source address of the packet (containing the INIT or
 820  *    INIT-ACK) but the receiver SHOULD also use all valid
 821  *    address parameters contained within the chunk.
 822  *
 823  * 2.18.3 Solution description
 824  *
 825  * This new text clearly specifies to an implementor the need
 826  * to look within the INIT or INIT-ACK. Any implementation that
 827  * does not do this, may not be able to establish associations
 828  * in certain circumstances.
 829  *
 830  */
 831 static struct sctp_association *__sctp_rcv_init_lookup(struct sk_buff *skb,
 832         const union sctp_addr *laddr, struct sctp_transport **transportp)
 833 {
 834         struct sctp_association *asoc;
 835         union sctp_addr addr;
 836         union sctp_addr *paddr = &addr;
 837         struct sctphdr *sh = (struct sctphdr *) skb->h.raw;
 838         sctp_chunkhdr_t *ch;
 839         union sctp_params params;
 840         sctp_init_chunk_t *init;
 841         struct sctp_transport *transport;
 842         struct sctp_af *af;
 843
 844         ch = (sctp_chunkhdr_t *) skb->data;
 845
 846         /* If this is INIT/INIT-ACK look inside the chunk too. */
 847         switch (ch->type) {
 848         case SCTP_CID_INIT:
 849         case SCTP_CID_INIT_ACK:
 850                 break;
 851         default:
 852                 return NULL;
 853         }
 854
 855         /* The code below will attempt to walk the chunk and extract
 856          * parameter information.  Before we do that, we need to verify
 857          * that the chunk length doesn't cause overflow.  Otherwise, we'll
 858          * walk off the end.
 859          */
 860         if (WORD_ROUND(ntohs(ch->length)) > skb->len)
 861                 return NULL;
 862
 863         /*
 864          * This code will NOT touch anything inside the chunk--it is
 865          * strictly READ-ONLY.
 866          *
 867          * RFC 2960 3  SCTP packet Format
 868          *
 869          * Multiple chunks can be bundled into one SCTP packet up to
 870          * the MTU size, except for the INIT, INIT ACK, and SHUTDOWN
 871          * COMPLETE chunks.  These chunks MUST NOT be bundled with any
 872          * other chunk in a packet.  See Section 6.10 for more details
 873          * on chunk bundling.
 874          */
 875
 876         /* Find the start of the TLVs and the end of the chunk.  This is
 877          * the region we search for address parameters.
 878          */
 879         init = (sctp_init_chunk_t *)skb->data;
 880
 881         /* Walk the parameters looking for embedded addresses. */
 882         sctp_walk_params(params, init, init_hdr.params) {
 883
 884                 /* Note: Ignoring hostname addresses. */
 885                 af = sctp_get_af_specific(param_type2af(params.p->type));
 886                 if (!af)
 887                         continue;
 888
 889                 af->from_addr_param(paddr, params.addr, ntohs(sh->source), 0);
 890
 891                 asoc = __sctp_lookup_association(laddr, paddr, &transport);
 892                 if (asoc)
 893                         return asoc;
 894         }
 895
 896         return NULL;
 897 }
 898
 899 /* Lookup an association for an inbound skb. */
 900 static struct sctp_association *__sctp_rcv_lookup(struct sk_buff *skb,
 901                                       const union sctp_addr *paddr,
 902                                       const union sctp_addr *laddr,
 903                                       struct sctp_transport **transportp)
 904 {
 905         struct sctp_association *asoc;
 906
 907         asoc = __sctp_lookup_association(laddr, paddr, transportp);
 908
 909         /* Further lookup for INIT/INIT-ACK packets.
 910          * SCTP Implementors Guide, 2.18 Handling of address
 911          * parameters within the INIT or INIT-ACK.
 912          */
 913         if (!asoc)
 914                 asoc = __sctp_rcv_init_lookup(skb, laddr, transportp);
 915
 916         return asoc;
 917 }