SAFE public projects git trees. - safe/jmp/linux-2.6/blob - net/ipv4/udp.c

   1 /*
   2  * INET         An implementation of the TCP/IP protocol suite for the LINUX
   3  *              operating system.  INET is implemented using the  BSD Socket
   4  *              interface as the means of communication with the user level.
   5  *
   6  *              The User Datagram Protocol (UDP).
   7  *
   8  * Authors:     Ross Biro
   9  *              Fred N. van Kempen, <waltje@uWalt.NL.Mugnet.ORG>
  10  *              Arnt Gulbrandsen, <agulbra@nvg.unit.no>
  11  *              Alan Cox, <Alan.Cox@linux.org>
  12  *              Hirokazu Takahashi, <taka@valinux.co.jp>
  13  *
  14  * Fixes:
  15  *              Alan Cox        :       verify_area() calls
  16  *              Alan Cox        :       stopped close while in use off icmp
  17  *                                      messages. Not a fix but a botch that
  18  *                                      for udp at least is 'valid'.
  19  *              Alan Cox        :       Fixed icmp handling properly
  20  *              Alan Cox        :       Correct error for oversized datagrams
  21  *              Alan Cox        :       Tidied select() semantics.
  22  *              Alan Cox        :       udp_err() fixed properly, also now
  23  *                                      select and read wake correctly on errors
  24  *              Alan Cox        :       udp_send verify_area moved to avoid mem leak
  25  *              Alan Cox        :       UDP can count its memory
  26  *              Alan Cox        :       send to an unknown connection causes
  27  *                                      an ECONNREFUSED off the icmp, but
  28  *                                      does NOT close.
  29  *              Alan Cox        :       Switched to new sk_buff handlers. No more backlog!
  30  *              Alan Cox        :       Using generic datagram code. Even smaller and the PEEK
  31  *                                      bug no longer crashes it.
  32  *              Fred Van Kempen :       Net2e support for sk->broadcast.
  33  *              Alan Cox        :       Uses skb_free_datagram
  34  *              Alan Cox        :       Added get/set sockopt support.
  35  *              Alan Cox        :       Broadcasting without option set returns EACCES.
  36  *              Alan Cox        :       No wakeup calls. Instead we now use the callbacks.
  37  *              Alan Cox        :       Use ip_tos and ip_ttl
  38  *              Alan Cox        :       SNMP Mibs
  39  *              Alan Cox        :       MSG_DONTROUTE, and 0.0.0.0 support.
  40  *              Matt Dillon     :       UDP length checks.
  41  *              Alan Cox        :       Smarter af_inet used properly.
  42  *              Alan Cox        :       Use new kernel side addressing.
  43  *              Alan Cox        :       Incorrect return on truncated datagram receive.
  44  *      Arnt Gulbrandsen        :       New udp_send and stuff
  45  *              Alan Cox        :       Cache last socket
  46  *              Alan Cox        :       Route cache
  47  *              Jon Peatfield   :       Minor efficiency fix to sendto().
  48  *              Mike Shaver     :       RFC1122 checks.
  49  *              Alan Cox        :       Nonblocking error fix.
  50  *      Willy Konynenberg       :       Transparent proxying support.
  51  *              Mike McLagan    :       Routing by source
  52  *              David S. Miller :       New socket lookup architecture.
  53  *                                      Last socket cache retained as it
  54  *                                      does have a high hit rate.
  55  *              Olaf Kirch      :       Don't linearise iovec on sendmsg.
  56  *              Andi Kleen      :       Some cleanups, cache destination entry
  57  *                                      for connect.
  58  *      Vitaly E. Lavrov        :       Transparent proxy revived after year coma.
  59  *              Melvin Smith    :       Check msg_name not msg_namelen in sendto(),
  60  *                                      return ENOTCONN for unconnected sockets (POSIX)
  61  *              Janos Farkas    :       don't deliver multi/broadcasts to a different
  62  *                                      bound-to-device socket
  63  *      Hirokazu Takahashi      :       HW checksumming for outgoing UDP
  64  *                                      datagrams.
  65  *      Hirokazu Takahashi      :       sendfile() on UDP works now.
  66  *              Arnaldo C. Melo :       convert /proc/net/udp to seq_file
  67  *      YOSHIFUJI Hideaki @USAGI and:   Support IPV6_V6ONLY socket option, which
  68  *      Alexey Kuznetsov:               allow both IPv4 and IPv6 sockets to bind
  69  *                                      a single port at the same time.
  70  *      Derek Atkins <derek@ihtfp.com>: Add Encapulation Support
  71  *      James Chapman           :       Add L2TP encapsulation type.
  72  *
  73  *
  74  *              This program is free software; you can redistribute it and/or
  75  *              modify it under the terms of the GNU General Public License
  76  *              as published by the Free Software Foundation; either version
  77  *              2 of the License, or (at your option) any later version.
  78  */
  79
  80 #include <asm/system.h>
  81 #include <asm/uaccess.h>
  82 #include <asm/ioctls.h>
  83 #include <linux/bootmem.h>
  84 #include <linux/types.h>
  85 #include <linux/fcntl.h>
  86 #include <linux/module.h>
  87 #include <linux/socket.h>
  88 #include <linux/sockios.h>
  89 #include <linux/igmp.h>
  90 #include <linux/in.h>
  91 #include <linux/errno.h>
  92 #include <linux/timer.h>
  93 #include <linux/mm.h>
  94 #include <linux/inet.h>
  95 #include <linux/netdevice.h>
  96 #include <net/tcp_states.h>
  97 #include <linux/skbuff.h>
  98 #include <linux/proc_fs.h>
  99 #include <linux/seq_file.h>
 100 #include <net/net_namespace.h>
 101 #include <net/icmp.h>
 102 #include <net/route.h>
 103 #include <net/checksum.h>
 104 #include <net/xfrm.h>
 105 #include "udp_impl.h"
 106
 107 /*
 108  *      Snmp MIB for the UDP layer
 109  */
 110
 111 DEFINE_SNMP_STAT(struct udp_mib, udp_stats_in6) __read_mostly;
 112 EXPORT_SYMBOL(udp_stats_in6);
 113
 114 struct hlist_head udp_hash[UDP_HTABLE_SIZE];
 115 DEFINE_RWLOCK(udp_hash_lock);
 116
 117 int sysctl_udp_mem[3] __read_mostly;
 118 int sysctl_udp_rmem_min __read_mostly;
 119 int sysctl_udp_wmem_min __read_mostly;
 120
 121 EXPORT_SYMBOL(sysctl_udp_mem);
 122 EXPORT_SYMBOL(sysctl_udp_rmem_min);
 123 EXPORT_SYMBOL(sysctl_udp_wmem_min);
 124
 125 atomic_t udp_memory_allocated;
 126 EXPORT_SYMBOL(udp_memory_allocated);
 127
 128 static inline int __udp_lib_lport_inuse(struct net *net, __u16 num,
 129                                         const struct hlist_head udptable[])
 130 {
 131         struct sock *sk;
 132         struct hlist_node *node;
 133
 134         sk_for_each(sk, node, &udptable[udp_hashfn(net, num)])
 135                 if (net_eq(sock_net(sk), net) && sk->sk_hash == num)
 136                         return 1;
 137         return 0;
 138 }
 139
 140 /**
 141  *  udp_lib_get_port  -  UDP/-Lite port lookup for IPv4 and IPv6
 142  *
 143  *  @sk:          socket struct in question
 144  *  @snum:        port number to look up
 145  *  @saddr_comp:  AF-dependent comparison of bound local IP addresses
 146  */
 147 int udp_lib_get_port(struct sock *sk, unsigned short snum,
 148                        int (*saddr_comp)(const struct sock *sk1,
 149                                          const struct sock *sk2 )    )
 150 {
 151         struct hlist_head *udptable = sk->sk_prot->h.udp_hash;
 152         struct hlist_node *node;
 153         struct hlist_head *head;
 154         struct sock *sk2;
 155         int    error = 1;
 156         struct net *net = sock_net(sk);
 157
 158         write_lock_bh(&udp_hash_lock);
 159
 160         if (!snum) {
 161                 int i, low, high, remaining;
 162                 unsigned rover, best, best_size_so_far;
 163
 164                 inet_get_local_port_range(&low, &high);
 165                 remaining = (high - low) + 1;
 166
 167                 best_size_so_far = UINT_MAX;
 168                 best = rover = net_random() % remaining + low;
 169
 170                 /* 1st pass: look for empty (or shortest) hash chain */
 171                 for (i = 0; i < UDP_HTABLE_SIZE; i++) {
 172                         int size = 0;
 173
 174                         head = &udptable[udp_hashfn(net, rover)];
 175                         if (hlist_empty(head))
 176                                 goto gotit;
 177
 178                         sk_for_each(sk2, node, head) {
 179                                 if (++size >= best_size_so_far)
 180                                         goto next;
 181                         }
 182                         best_size_so_far = size;
 183                         best = rover;
 184                 next:
 185                         /* fold back if end of range */
 186                         if (++rover > high)
 187                                 rover = low + ((rover - low)
 188                                                & (UDP_HTABLE_SIZE - 1));
 189
 190
 191                 }
 192
 193                 /* 2nd pass: find hole in shortest hash chain */
 194                 rover = best;
 195                 for (i = 0; i < (1 << 16) / UDP_HTABLE_SIZE; i++) {
 196                         if (! __udp_lib_lport_inuse(net, rover, udptable))
 197                                 goto gotit;
 198                         rover += UDP_HTABLE_SIZE;
 199                         if (rover > high)
 200                                 rover = low + ((rover - low)
 201                                                & (UDP_HTABLE_SIZE - 1));
 202                 }
 203
 204
 205                 /* All ports in use! */
 206                 goto fail;
 207
 208 gotit:
 209                 snum = rover;
 210         } else {
 211                 head = &udptable[udp_hashfn(net, snum)];
 212
 213                 sk_for_each(sk2, node, head)
 214                         if (sk2->sk_hash == snum                             &&
 215                             sk2 != sk                                        &&
 216                             net_eq(sock_net(sk2), net)                       &&
 217                             (!sk2->sk_reuse        || !sk->sk_reuse)         &&
 218                             (!sk2->sk_bound_dev_if || !sk->sk_bound_dev_if
 219                              || sk2->sk_bound_dev_if == sk->sk_bound_dev_if) &&
 220                             (*saddr_comp)(sk, sk2)                             )
 221                                 goto fail;
 222         }
 223
 224         inet_sk(sk)->num = snum;
 225         sk->sk_hash = snum;
 226         if (sk_unhashed(sk)) {
 227                 head = &udptable[udp_hashfn(net, snum)];
 228                 sk_add_node(sk, head);
 229                 sock_prot_inuse_add(sock_net(sk), sk->sk_prot, 1);
 230         }
 231         error = 0;
 232 fail:
 233         write_unlock_bh(&udp_hash_lock);
 234         return error;
 235 }
 236
 237 static int ipv4_rcv_saddr_equal(const struct sock *sk1, const struct sock *sk2)
 238 {
 239         struct inet_sock *inet1 = inet_sk(sk1), *inet2 = inet_sk(sk2);
 240
 241         return  ( !ipv6_only_sock(sk2)  &&
 242                   (!inet1->rcv_saddr || !inet2->rcv_saddr ||
 243                    inet1->rcv_saddr == inet2->rcv_saddr      ));
 244 }
 245
 246 int udp_v4_get_port(struct sock *sk, unsigned short snum)
 247 {
 248         return udp_lib_get_port(sk, snum, ipv4_rcv_saddr_equal);
 249 }
 250
 251 /* UDP is nearly always wildcards out the wazoo, it makes no sense to try
 252  * harder than this. -DaveM
 253  */
 254 static struct sock *__udp4_lib_lookup(struct net *net, __be32 saddr,
 255                 __be16 sport, __be32 daddr, __be16 dport,
 256                 int dif, struct hlist_head udptable[])
 257 {
 258         struct sock *sk, *result = NULL;
 259         struct hlist_node *node;
 260         unsigned short hnum = ntohs(dport);
 261         int badness = -1;
 262
 263         read_lock(&udp_hash_lock);
 264         sk_for_each(sk, node, &udptable[udp_hashfn(net, hnum)]) {
 265                 struct inet_sock *inet = inet_sk(sk);
 266
 267                 if (net_eq(sock_net(sk), net) && sk->sk_hash == hnum &&
 268                                 !ipv6_only_sock(sk)) {
 269                         int score = (sk->sk_family == PF_INET ? 1 : 0);
 270                         if (inet->rcv_saddr) {
 271                                 if (inet->rcv_saddr != daddr)
 272                                         continue;
 273                                 score+=2;
 274                         }
 275                         if (inet->daddr) {
 276                                 if (inet->daddr != saddr)
 277                                         continue;
 278                                 score+=2;
 279                         }
 280                         if (inet->dport) {
 281                                 if (inet->dport != sport)
 282                                         continue;
 283                                 score+=2;
 284                         }
 285                         if (sk->sk_bound_dev_if) {
 286                                 if (sk->sk_bound_dev_if != dif)
 287                                         continue;
 288                                 score+=2;
 289                         }
 290                         if (score == 9) {
 291                                 result = sk;
 292                                 break;
 293                         } else if (score > badness) {
 294                                 result = sk;
 295                                 badness = score;
 296                         }
 297                 }
 298         }
 299         if (result)
 300                 sock_hold(result);
 301         read_unlock(&udp_hash_lock);
 302         return result;
 303 }
 304
 305 struct sock *udp4_lib_lookup(struct net *net, __be32 saddr, __be16 sport,
 306                              __be32 daddr, __be16 dport, int dif)
 307 {
 308         return __udp4_lib_lookup(net, saddr, sport, daddr, dport, dif, udp_hash);
 309 }
 310 EXPORT_SYMBOL_GPL(udp4_lib_lookup);
 311
 312 static inline struct sock *udp_v4_mcast_next(struct sock *sk,
 313                                              __be16 loc_port, __be32 loc_addr,
 314                                              __be16 rmt_port, __be32 rmt_addr,
 315                                              int dif)
 316 {
 317         struct hlist_node *node;
 318         struct sock *s = sk;
 319         unsigned short hnum = ntohs(loc_port);
 320
 321         sk_for_each_from(s, node) {
 322                 struct inet_sock *inet = inet_sk(s);
 323
 324                 if (s->sk_hash != hnum                                  ||
 325                     (inet->daddr && inet->daddr != rmt_addr)            ||
 326                     (inet->dport != rmt_port && inet->dport)            ||
 327                     (inet->rcv_saddr && inet->rcv_saddr != loc_addr)    ||
 328                     ipv6_only_sock(s)                                   ||
 329                     (s->sk_bound_dev_if && s->sk_bound_dev_if != dif))
 330                         continue;
 331                 if (!ip_mc_sf_allow(s, loc_addr, rmt_addr, dif))
 332                         continue;
 333                 goto found;
 334         }
 335         s = NULL;
 336 found:
 337         return s;
 338 }
 339
 340 /*
 341  * This routine is called by the ICMP module when it gets some
 342  * sort of error condition.  If err < 0 then the socket should
 343  * be closed and the error returned to the user.  If err > 0
 344  * it's just the icmp type << 8 | icmp code.
 345  * Header points to the ip header of the error packet. We move
 346  * on past this. Then (as it used to claim before adjustment)
 347  * header points to the first 8 bytes of the udp header.  We need
 348  * to find the appropriate port.
 349  */
 350
 351 void __udp4_lib_err(struct sk_buff *skb, u32 info, struct hlist_head udptable[])
 352 {
 353         struct inet_sock *inet;
 354         struct iphdr *iph = (struct iphdr*)skb->data;
 355         struct udphdr *uh = (struct udphdr*)(skb->data+(iph->ihl<<2));
 356         const int type = icmp_hdr(skb)->type;
 357         const int code = icmp_hdr(skb)->code;
 358         struct sock *sk;
 359         int harderr;
 360         int err;
 361         struct net *net = dev_net(skb->dev);
 362
 363         sk = __udp4_lib_lookup(net, iph->daddr, uh->dest,
 364                         iph->saddr, uh->source, skb->dev->ifindex, udptable);
 365         if (sk == NULL) {
 366                 ICMP_INC_STATS_BH(net, ICMP_MIB_INERRORS);
 367                 return; /* No socket for error */
 368         }
 369
 370         err = 0;
 371         harderr = 0;
 372         inet = inet_sk(sk);
 373
 374         switch (type) {
 375         default:
 376         case ICMP_TIME_EXCEEDED:
 377                 err = EHOSTUNREACH;
 378                 break;
 379         case ICMP_SOURCE_QUENCH:
 380                 goto out;
 381         case ICMP_PARAMETERPROB:
 382                 err = EPROTO;
 383                 harderr = 1;
 384                 break;
 385         case ICMP_DEST_UNREACH:
 386                 if (code == ICMP_FRAG_NEEDED) { /* Path MTU discovery */
 387                         if (inet->pmtudisc != IP_PMTUDISC_DONT) {
 388                                 err = EMSGSIZE;
 389                                 harderr = 1;
 390                                 break;
 391                         }
 392                         goto out;
 393                 }
 394                 err = EHOSTUNREACH;
 395                 if (code <= NR_ICMP_UNREACH) {
 396                         harderr = icmp_err_convert[code].fatal;
 397                         err = icmp_err_convert[code].errno;
 398                 }
 399                 break;
 400         }
 401
 402         /*
 403          *      RFC1122: OK.  Passes ICMP errors back to application, as per
 404          *      4.1.3.3.
 405          */
 406         if (!inet->recverr) {
 407                 if (!harderr || sk->sk_state != TCP_ESTABLISHED)
 408                         goto out;
 409         } else {
 410                 ip_icmp_error(sk, skb, err, uh->dest, info, (u8*)(uh+1));
 411         }
 412         sk->sk_err = err;
 413         sk->sk_error_report(sk);
 414 out:
 415         sock_put(sk);
 416 }
 417
 418 void udp_err(struct sk_buff *skb, u32 info)
 419 {
 420         __udp4_lib_err(skb, info, udp_hash);
 421 }
 422
 423 /*
 424  * Throw away all pending data and cancel the corking. Socket is locked.
 425  */
 426 void udp_flush_pending_frames(struct sock *sk)
 427 {
 428         struct udp_sock *up = udp_sk(sk);
 429
 430         if (up->pending) {
 431                 up->len = 0;
 432                 up->pending = 0;
 433                 ip_flush_pending_frames(sk);
 434         }
 435 }
 436 EXPORT_SYMBOL(udp_flush_pending_frames);
 437
 438 /**
 439  *      udp4_hwcsum_outgoing  -  handle outgoing HW checksumming
 440  *      @sk:    socket we are sending on
 441  *      @skb:   sk_buff containing the filled-in UDP header
 442  *              (checksum field must be zeroed out)
 443  */
 444 static void udp4_hwcsum_outgoing(struct sock *sk, struct sk_buff *skb,
 445                                  __be32 src, __be32 dst, int len      )
 446 {
 447         unsigned int offset;
 448         struct udphdr *uh = udp_hdr(skb);
 449         __wsum csum = 0;
 450
 451         if (skb_queue_len(&sk->sk_write_queue) == 1) {
 452                 /*
 453                  * Only one fragment on the socket.
 454                  */
 455                 skb->csum_start = skb_transport_header(skb) - skb->head;
 456                 skb->csum_offset = offsetof(struct udphdr, check);
 457                 uh->check = ~csum_tcpudp_magic(src, dst, len, IPPROTO_UDP, 0);
 458         } else {
 459                 /*
 460                  * HW-checksum won't work as there are two or more
 461                  * fragments on the socket so that all csums of sk_buffs
 462                  * should be together
 463                  */
 464                 offset = skb_transport_offset(skb);
 465                 skb->csum = skb_checksum(skb, offset, skb->len - offset, 0);
 466
 467                 skb->ip_summed = CHECKSUM_NONE;
 468
 469                 skb_queue_walk(&sk->sk_write_queue, skb) {
 470                         csum = csum_add(csum, skb->csum);
 471                 }
 472
 473                 uh->check = csum_tcpudp_magic(src, dst, len, IPPROTO_UDP, csum);
 474                 if (uh->check == 0)
 475                         uh->check = CSUM_MANGLED_0;
 476         }
 477 }
 478
 479 /*
 480  * Push out all pending data as one UDP datagram. Socket is locked.
 481  */
 482 static int udp_push_pending_frames(struct sock *sk)
 483 {
 484         struct udp_sock  *up = udp_sk(sk);
 485         struct inet_sock *inet = inet_sk(sk);
 486         struct flowi *fl = &inet->cork.fl;
 487         struct sk_buff *skb;
 488         struct udphdr *uh;
 489         int err = 0;
 490         int is_udplite = IS_UDPLITE(sk);
 491         __wsum csum = 0;
 492
 493         /* Grab the skbuff where UDP header space exists. */
 494         if ((skb = skb_peek(&sk->sk_write_queue)) == NULL)
 495                 goto out;
 496
 497         /*
 498          * Create a UDP header
 499          */
 500         uh = udp_hdr(skb);
 501         uh->source = fl->fl_ip_sport;
 502         uh->dest = fl->fl_ip_dport;
 503         uh->len = htons(up->len);
 504         uh->check = 0;
 505
 506         if (is_udplite)                                  /*     UDP-Lite      */
 507                 csum  = udplite_csum_outgoing(sk, skb);
 508
 509         else if (sk->sk_no_check == UDP_CSUM_NOXMIT) {   /* UDP csum disabled */
 510
 511                 skb->ip_summed = CHECKSUM_NONE;
 512                 goto send;
 513
 514         } else if (skb->ip_summed == CHECKSUM_PARTIAL) { /* UDP hardware csum */
 515
 516                 udp4_hwcsum_outgoing(sk, skb, fl->fl4_src,fl->fl4_dst, up->len);
 517                 goto send;
 518
 519         } else                                           /*   `normal' UDP    */
 520                 csum = udp_csum_outgoing(sk, skb);
 521
 522         /* add protocol-dependent pseudo-header */
 523         uh->check = csum_tcpudp_magic(fl->fl4_src, fl->fl4_dst, up->len,
 524                                       sk->sk_protocol, csum             );
 525         if (uh->check == 0)
 526                 uh->check = CSUM_MANGLED_0;
 527
 528 send:
 529         err = ip_push_pending_frames(sk);
 530 out:
 531         up->len = 0;
 532         up->pending = 0;
 533         if (!err)
 534                 UDP_INC_STATS_USER(sock_net(sk),
 535                                 UDP_MIB_OUTDATAGRAMS, is_udplite);
 536         return err;
 537 }
 538
 539 int udp_sendmsg(struct kiocb *iocb, struct sock *sk, struct msghdr *msg,
 540                 size_t len)
 541 {
 542         struct inet_sock *inet = inet_sk(sk);
 543         struct udp_sock *up = udp_sk(sk);
 544         int ulen = len;
 545         struct ipcm_cookie ipc;
 546         struct rtable *rt = NULL;
 547         int free = 0;
 548         int connected = 0;
 549         __be32 daddr, faddr, saddr;
 550         __be16 dport;
 551         u8  tos;
 552         int err, is_udplite = IS_UDPLITE(sk);
 553         int corkreq = up->corkflag || msg->msg_flags&MSG_MORE;
 554         int (*getfrag)(void *, char *, int, int, int, struct sk_buff *);
 555
 556         if (len > 0xFFFF)
 557                 return -EMSGSIZE;
 558
 559         /*
 560          *      Check the flags.
 561          */
 562
 563         if (msg->msg_flags&MSG_OOB)     /* Mirror BSD error message compatibility */
 564                 return -EOPNOTSUPP;
 565
 566         ipc.opt = NULL;
 567
 568         if (up->pending) {
 569                 /*
 570                  * There are pending frames.
 571                  * The socket lock must be held while it's corked.
 572                  */
 573                 lock_sock(sk);
 574                 if (likely(up->pending)) {
 575                         if (unlikely(up->pending != AF_INET)) {
 576                                 release_sock(sk);
 577                                 return -EINVAL;
 578                         }
 579                         goto do_append_data;
 580                 }
 581                 release_sock(sk);
 582         }
 583         ulen += sizeof(struct udphdr);
 584
 585         /*
 586          *      Get and verify the address.
 587          */
 588         if (msg->msg_name) {
 589                 struct sockaddr_in * usin = (struct sockaddr_in*)msg->msg_name;
 590                 if (msg->msg_namelen < sizeof(*usin))
 591                         return -EINVAL;
 592                 if (usin->sin_family != AF_INET) {
 593                         if (usin->sin_family != AF_UNSPEC)
 594                                 return -EAFNOSUPPORT;
 595                 }
 596
 597                 daddr = usin->sin_addr.s_addr;
 598                 dport = usin->sin_port;
 599                 if (dport == 0)
 600                         return -EINVAL;
 601         } else {
 602                 if (sk->sk_state != TCP_ESTABLISHED)
 603                         return -EDESTADDRREQ;
 604                 daddr = inet->daddr;
 605                 dport = inet->dport;
 606                 /* Open fast path for connected socket.
 607                    Route will not be used, if at least one option is set.
 608                  */
 609                 connected = 1;
 610         }
 611         ipc.addr = inet->saddr;
 612
 613         ipc.oif = sk->sk_bound_dev_if;
 614         if (msg->msg_controllen) {
 615                 err = ip_cmsg_send(sock_net(sk), msg, &ipc);
 616                 if (err)
 617                         return err;
 618                 if (ipc.opt)
 619                         free = 1;
 620                 connected = 0;
 621         }
 622         if (!ipc.opt)
 623                 ipc.opt = inet->opt;
 624
 625         saddr = ipc.addr;
 626         ipc.addr = faddr = daddr;
 627
 628         if (ipc.opt && ipc.opt->srr) {
 629                 if (!daddr)
 630                         return -EINVAL;
 631                 faddr = ipc.opt->faddr;
 632                 connected = 0;
 633         }
 634         tos = RT_TOS(inet->tos);
 635         if (sock_flag(sk, SOCK_LOCALROUTE) ||
 636             (msg->msg_flags & MSG_DONTROUTE) ||
 637             (ipc.opt && ipc.opt->is_strictroute)) {
 638                 tos |= RTO_ONLINK;
 639                 connected = 0;
 640         }
 641
 642         if (ipv4_is_multicast(daddr)) {
 643                 if (!ipc.oif)
 644                         ipc.oif = inet->mc_index;
 645                 if (!saddr)
 646                         saddr = inet->mc_addr;
 647                 connected = 0;
 648         }
 649
 650         if (connected)
 651                 rt = (struct rtable*)sk_dst_check(sk, 0);
 652
 653         if (rt == NULL) {
 654                 struct flowi fl = { .oif = ipc.oif,
 655                                     .nl_u = { .ip4_u =
 656                                               { .daddr = faddr,
 657                                                 .saddr = saddr,
 658                                                 .tos = tos } },
 659                                     .proto = sk->sk_protocol,
 660                                     .uli_u = { .ports =
 661                                                { .sport = inet->sport,
 662                                                  .dport = dport } } };
 663                 struct net *net = sock_net(sk);
 664
 665                 security_sk_classify_flow(sk, &fl);
 666                 err = ip_route_output_flow(net, &rt, &fl, sk, 1);
 667                 if (err) {
 668                         if (err == -ENETUNREACH)
 669                                 IP_INC_STATS_BH(net, IPSTATS_MIB_OUTNOROUTES);
 670                         goto out;
 671                 }
 672
 673                 err = -EACCES;
 674                 if ((rt->rt_flags & RTCF_BROADCAST) &&
 675                     !sock_flag(sk, SOCK_BROADCAST))
 676                         goto out;
 677                 if (connected)
 678                         sk_dst_set(sk, dst_clone(&rt->u.dst));
 679         }
 680
 681         if (msg->msg_flags&MSG_CONFIRM)
 682                 goto do_confirm;
 683 back_from_confirm:
 684
 685         saddr = rt->rt_src;
 686         if (!ipc.addr)
 687                 daddr = ipc.addr = rt->rt_dst;
 688
 689         lock_sock(sk);
 690         if (unlikely(up->pending)) {
 691                 /* The socket is already corked while preparing it. */
 692                 /* ... which is an evident application bug. --ANK */
 693                 release_sock(sk);
 694
 695                 LIMIT_NETDEBUG(KERN_DEBUG "udp cork app bug 2\n");
 696                 err = -EINVAL;
 697                 goto out;
 698         }
 699         /*
 700          *      Now cork the socket to pend data.
 701          */
 702         inet->cork.fl.fl4_dst = daddr;
 703         inet->cork.fl.fl_ip_dport = dport;
 704         inet->cork.fl.fl4_src = saddr;
 705         inet->cork.fl.fl_ip_sport = inet->sport;
 706         up->pending = AF_INET;
 707
 708 do_append_data:
 709         up->len += ulen;
 710         getfrag  =  is_udplite ?  udplite_getfrag : ip_generic_getfrag;
 711         err = ip_append_data(sk, getfrag, msg->msg_iov, ulen,
 712                         sizeof(struct udphdr), &ipc, rt,
 713                         corkreq ? msg->msg_flags|MSG_MORE : msg->msg_flags);
 714         if (err)
 715                 udp_flush_pending_frames(sk);
 716         else if (!corkreq)
 717                 err = udp_push_pending_frames(sk);
 718         else if (unlikely(skb_queue_empty(&sk->sk_write_queue)))
 719                 up->pending = 0;
 720         release_sock(sk);
 721
 722 out:
 723         ip_rt_put(rt);
 724         if (free)
 725                 kfree(ipc.opt);
 726         if (!err)
 727                 return len;
 728         /*
 729          * ENOBUFS = no kernel mem, SOCK_NOSPACE = no sndbuf space.  Reporting
 730          * ENOBUFS might not be good (it's not tunable per se), but otherwise
 731          * we don't have a good statistic (IpOutDiscards but it can be too many
 732          * things).  We could add another new stat but at least for now that
 733          * seems like overkill.
 734          */
 735         if (err == -ENOBUFS || test_bit(SOCK_NOSPACE, &sk->sk_socket->flags)) {
 736                 UDP_INC_STATS_USER(sock_net(sk),
 737                                 UDP_MIB_SNDBUFERRORS, is_udplite);
 738         }
 739         return err;
 740
 741 do_confirm:
 742         dst_confirm(&rt->u.dst);
 743         if (!(msg->msg_flags&MSG_PROBE) || len)
 744                 goto back_from_confirm;
 745         err = 0;
 746         goto out;
 747 }
 748
 749 int udp_sendpage(struct sock *sk, struct page *page, int offset,
 750                  size_t size, int flags)
 751 {
 752         struct udp_sock *up = udp_sk(sk);
 753         int ret;
 754
 755         if (!up->pending) {
 756                 struct msghdr msg = {   .msg_flags = flags|MSG_MORE };
 757
 758                 /* Call udp_sendmsg to specify destination address which
 759                  * sendpage interface can't pass.
 760                  * This will succeed only when the socket is connected.
 761                  */
 762                 ret = udp_sendmsg(NULL, sk, &msg, 0);
 763                 if (ret < 0)
 764                         return ret;
 765         }
 766
 767         lock_sock(sk);
 768
 769         if (unlikely(!up->pending)) {
 770                 release_sock(sk);
 771
 772                 LIMIT_NETDEBUG(KERN_DEBUG "udp cork app bug 3\n");
 773                 return -EINVAL;
 774         }
 775
 776         ret = ip_append_page(sk, page, offset, size, flags);
 777         if (ret == -EOPNOTSUPP) {
 778                 release_sock(sk);
 779                 return sock_no_sendpage(sk->sk_socket, page, offset,
 780                                         size, flags);
 781         }
 782         if (ret < 0) {
 783                 udp_flush_pending_frames(sk);
 784                 goto out;
 785         }
 786
 787         up->len += size;
 788         if (!(up->corkflag || (flags&MSG_MORE)))
 789                 ret = udp_push_pending_frames(sk);
 790         if (!ret)
 791                 ret = size;
 792 out:
 793         release_sock(sk);
 794         return ret;
 795 }
 796
 797 /*
 798  *      IOCTL requests applicable to the UDP protocol
 799  */
 800
 801 int udp_ioctl(struct sock *sk, int cmd, unsigned long arg)
 802 {
 803         switch (cmd) {
 804         case SIOCOUTQ:
 805         {
 806                 int amount = atomic_read(&sk->sk_wmem_alloc);
 807                 return put_user(amount, (int __user *)arg);
 808         }
 809
 810         case SIOCINQ:
 811         {
 812                 struct sk_buff *skb;
 813                 unsigned long amount;
 814
 815                 amount = 0;
 816                 spin_lock_bh(&sk->sk_receive_queue.lock);
 817                 skb = skb_peek(&sk->sk_receive_queue);
 818                 if (skb != NULL) {
 819                         /*
 820                          * We will only return the amount
 821                          * of this packet since that is all
 822                          * that will be read.
 823                          */
 824                         amount = skb->len - sizeof(struct udphdr);
 825                 }
 826                 spin_unlock_bh(&sk->sk_receive_queue.lock);
 827                 return put_user(amount, (int __user *)arg);
 828         }
 829
 830         default:
 831                 return -ENOIOCTLCMD;
 832         }
 833
 834         return 0;
 835 }
 836
 837 /*
 838  *      This should be easy, if there is something there we
 839  *      return it, otherwise we block.
 840  */
 841
 842 int udp_recvmsg(struct kiocb *iocb, struct sock *sk, struct msghdr *msg,
 843                 size_t len, int noblock, int flags, int *addr_len)
 844 {
 845         struct inet_sock *inet = inet_sk(sk);
 846         struct sockaddr_in *sin = (struct sockaddr_in *)msg->msg_name;
 847         struct sk_buff *skb;
 848         unsigned int ulen, copied;
 849         int peeked;
 850         int err;
 851         int is_udplite = IS_UDPLITE(sk);
 852
 853         /*
 854          *      Check any passed addresses
 855          */
 856         if (addr_len)
 857                 *addr_len=sizeof(*sin);
 858
 859         if (flags & MSG_ERRQUEUE)
 860                 return ip_recv_error(sk, msg, len);
 861
 862 try_again:
 863         skb = __skb_recv_datagram(sk, flags | (noblock ? MSG_DONTWAIT : 0),
 864                                   &peeked, &err);
 865         if (!skb)
 866                 goto out;
 867
 868         ulen = skb->len - sizeof(struct udphdr);
 869         copied = len;
 870         if (copied > ulen)
 871                 copied = ulen;
 872         else if (copied < ulen)
 873                 msg->msg_flags |= MSG_TRUNC;
 874
 875         /*
 876          * If checksum is needed at all, try to do it while copying the
 877          * data.  If the data is truncated, or if we only want a partial
 878          * coverage checksum (UDP-Lite), do it before the copy.
 879          */
 880
 881         if (copied < ulen || UDP_SKB_CB(skb)->partial_cov) {
 882                 if (udp_lib_checksum_complete(skb))
 883                         goto csum_copy_err;
 884         }
 885
 886         if (skb_csum_unnecessary(skb))
 887                 err = skb_copy_datagram_iovec(skb, sizeof(struct udphdr),
 888                                               msg->msg_iov, copied       );
 889         else {
 890                 err = skb_copy_and_csum_datagram_iovec(skb, sizeof(struct udphdr), msg->msg_iov);
 891
 892                 if (err == -EINVAL)
 893                         goto csum_copy_err;
 894         }
 895
 896         if (err)
 897                 goto out_free;
 898
 899         if (!peeked)
 900                 UDP_INC_STATS_USER(sock_net(sk),
 901                                 UDP_MIB_INDATAGRAMS, is_udplite);
 902
 903         sock_recv_timestamp(msg, sk, skb);
 904
 905         /* Copy the address. */
 906         if (sin)
 907         {
 908                 sin->sin_family = AF_INET;
 909                 sin->sin_port = udp_hdr(skb)->source;
 910                 sin->sin_addr.s_addr = ip_hdr(skb)->saddr;
 911                 memset(sin->sin_zero, 0, sizeof(sin->sin_zero));
 912         }
 913         if (inet->cmsg_flags)
 914                 ip_cmsg_recv(msg, skb);
 915
 916         err = copied;
 917         if (flags & MSG_TRUNC)
 918                 err = ulen;
 919
 920 out_free:
 921         lock_sock(sk);
 922         skb_free_datagram(sk, skb);
 923         release_sock(sk);
 924 out:
 925         return err;
 926
 927 csum_copy_err:
 928         lock_sock(sk);
 929         if (!skb_kill_datagram(sk, skb, flags))
 930                 UDP_INC_STATS_USER(sock_net(sk), UDP_MIB_INERRORS, is_udplite);
 931         release_sock(sk);
 932
 933         if (noblock)
 934                 return -EAGAIN;
 935         goto try_again;
 936 }
 937
 938
 939 int udp_disconnect(struct sock *sk, int flags)
 940 {
 941         struct inet_sock *inet = inet_sk(sk);
 942         /*
 943          *      1003.1g - break association.
 944          */
 945
 946         sk->sk_state = TCP_CLOSE;
 947         inet->daddr = 0;
 948         inet->dport = 0;
 949         sk->sk_bound_dev_if = 0;
 950         if (!(sk->sk_userlocks & SOCK_BINDADDR_LOCK))
 951                 inet_reset_saddr(sk);
 952
 953         if (!(sk->sk_userlocks & SOCK_BINDPORT_LOCK)) {
 954                 sk->sk_prot->unhash(sk);
 955                 inet->sport = 0;
 956         }
 957         sk_dst_reset(sk);
 958         return 0;
 959 }
 960
 961 static int __udp_queue_rcv_skb(struct sock *sk, struct sk_buff *skb)
 962 {
 963         int is_udplite = IS_UDPLITE(sk);
 964         int rc;
 965
 966         if ((rc = sock_queue_rcv_skb(sk, skb)) < 0) {
 967                 /* Note that an ENOMEM error is charged twice */
 968                 if (rc == -ENOMEM)
 969                         UDP_INC_STATS_BH(sock_net(sk), UDP_MIB_RCVBUFERRORS,
 970                                          is_udplite);
 971                 goto drop;
 972         }
 973
 974         return 0;
 975
 976 drop:
 977         UDP_INC_STATS_BH(sock_net(sk), UDP_MIB_INERRORS, is_udplite);
 978         kfree_skb(skb);
 979         return -1;
 980 }
 981
 982 /* returns:
 983  *  -1: error
 984  *   0: success
 985  *  >0: "udp encap" protocol resubmission
 986  *
 987  * Note that in the success and error cases, the skb is assumed to
 988  * have either been requeued or freed.
 989  */
 990 int udp_queue_rcv_skb(struct sock * sk, struct sk_buff *skb)
 991 {
 992         struct udp_sock *up = udp_sk(sk);
 993         int rc;
 994         int is_udplite = IS_UDPLITE(sk);
 995
 996         /*
 997          *      Charge it to the socket, dropping if the queue is full.
 998          */
 999         if (!xfrm4_policy_check(sk, XFRM_POLICY_IN, skb))
1000                 goto drop;
1001         nf_reset(skb);
1002
1003         if (up->encap_type) {
1004                 /*
1005                  * This is an encapsulation socket so pass the skb to
1006                  * the socket's udp_encap_rcv() hook. Otherwise, just
1007                  * fall through and pass this up the UDP socket.
1008                  * up->encap_rcv() returns the following value:
1009                  * =0 if skb was successfully passed to the encap
1010                  *    handler or was discarded by it.
1011                  * >0 if skb should be passed on to UDP.
1012                  * <0 if skb should be resubmitted as proto -N
1013                  */
1014
1015                 /* if we're overly short, let UDP handle it */
1016                 if (skb->len > sizeof(struct udphdr) &&
1017                     up->encap_rcv != NULL) {
1018                         int ret;
1019
1020                         ret = (*up->encap_rcv)(sk, skb);
1021                         if (ret <= 0) {
1022                                 UDP_INC_STATS_BH(sock_net(sk),
1023                                                  UDP_MIB_INDATAGRAMS,
1024                                                  is_udplite);
1025                                 return -ret;
1026                         }
1027                 }
1028
1029                 /* FALLTHROUGH -- it's a UDP Packet */
1030         }
1031
1032         /*
1033          *      UDP-Lite specific tests, ignored on UDP sockets
1034          */
1035         if ((is_udplite & UDPLITE_RECV_CC)  &&  UDP_SKB_CB(skb)->partial_cov) {
1036
1037                 /*
1038                  * MIB statistics other than incrementing the error count are
1039                  * disabled for the following two types of errors: these depend
1040                  * on the application settings, not on the functioning of the
1041                  * protocol stack as such.
1042                  *
1043                  * RFC 3828 here recommends (sec 3.3): "There should also be a
1044                  * way ... to ... at least let the receiving application block
1045                  * delivery of packets with coverage values less than a value
1046                  * provided by the application."
1047                  */
1048                 if (up->pcrlen == 0) {          /* full coverage was set  */
1049                         LIMIT_NETDEBUG(KERN_WARNING "UDPLITE: partial coverage "
1050                                 "%d while full coverage %d requested\n",
1051                                 UDP_SKB_CB(skb)->cscov, skb->len);
1052                         goto drop;
1053                 }
1054                 /* The next case involves violating the min. coverage requested
1055                  * by the receiver. This is subtle: if receiver wants x and x is
1056                  * greater than the buffersize/MTU then receiver will complain
1057                  * that it wants x while sender emits packets of smaller size y.
1058                  * Therefore the above ...()->partial_cov statement is essential.
1059                  */
1060                 if (UDP_SKB_CB(skb)->cscov  <  up->pcrlen) {
1061                         LIMIT_NETDEBUG(KERN_WARNING
1062                                 "UDPLITE: coverage %d too small, need min %d\n",
1063                                 UDP_SKB_CB(skb)->cscov, up->pcrlen);
1064                         goto drop;
1065                 }
1066         }
1067
1068         if (sk->sk_filter) {
1069                 if (udp_lib_checksum_complete(skb))
1070                         goto drop;
1071         }
1072
1073         rc = 0;
1074
1075         bh_lock_sock(sk);
1076         if (!sock_owned_by_user(sk))
1077                 rc = __udp_queue_rcv_skb(sk, skb);
1078         else
1079                 sk_add_backlog(sk, skb);
1080         bh_unlock_sock(sk);
1081
1082         return rc;
1083
1084 drop:
1085         UDP_INC_STATS_BH(sock_net(sk), UDP_MIB_INERRORS, is_udplite);
1086         kfree_skb(skb);
1087         return -1;
1088 }
1089
1090 /*
1091  *      Multicasts and broadcasts go to each listener.
1092  *
1093  *      Note: called only from the BH handler context,
1094  *      so we don't need to lock the hashes.
1095  */
1096 static int __udp4_lib_mcast_deliver(struct net *net, struct sk_buff *skb,
1097                                     struct udphdr  *uh,
1098                                     __be32 saddr, __be32 daddr,
1099                                     struct hlist_head udptable[])
1100 {
1101         struct sock *sk;
1102         int dif;
1103
1104         read_lock(&udp_hash_lock);
1105         sk = sk_head(&udptable[udp_hashfn(net, ntohs(uh->dest))]);
1106         dif = skb->dev->ifindex;
1107         sk = udp_v4_mcast_next(sk, uh->dest, daddr, uh->source, saddr, dif);
1108         if (sk) {
1109                 struct sock *sknext = NULL;
1110
1111                 do {
1112                         struct sk_buff *skb1 = skb;
1113
1114                         sknext = udp_v4_mcast_next(sk_next(sk), uh->dest, daddr,
1115                                                    uh->source, saddr, dif);
1116                         if (sknext)
1117                                 skb1 = skb_clone(skb, GFP_ATOMIC);
1118
1119                         if (skb1) {
1120                                 int ret = udp_queue_rcv_skb(sk, skb1);
1121                                 if (ret > 0)
1122                                         /* we should probably re-process instead
1123                                          * of dropping packets here. */
1124                                         kfree_skb(skb1);
1125                         }
1126                         sk = sknext;
1127                 } while (sknext);
1128         } else
1129                 kfree_skb(skb);
1130         read_unlock(&udp_hash_lock);
1131         return 0;
1132 }
1133
1134 /* Initialize UDP checksum. If exited with zero value (success),
1135  * CHECKSUM_UNNECESSARY means, that no more checks are required.
1136  * Otherwise, csum completion requires chacksumming packet body,
1137  * including udp header and folding it to skb->csum.
1138  */
1139 static inline int udp4_csum_init(struct sk_buff *skb, struct udphdr *uh,
1140                                  int proto)
1141 {
1142         const struct iphdr *iph;
1143         int err;
1144
1145         UDP_SKB_CB(skb)->partial_cov = 0;
1146         UDP_SKB_CB(skb)->cscov = skb->len;
1147
1148         if (proto == IPPROTO_UDPLITE) {
1149                 err = udplite_checksum_init(skb, uh);
1150                 if (err)
1151                         return err;
1152         }
1153
1154         iph = ip_hdr(skb);
1155         if (uh->check == 0) {
1156                 skb->ip_summed = CHECKSUM_UNNECESSARY;
1157         } else if (skb->ip_summed == CHECKSUM_COMPLETE) {
1158                if (!csum_tcpudp_magic(iph->saddr, iph->daddr, skb->len,
1159                                       proto, skb->csum))
1160                         skb->ip_summed = CHECKSUM_UNNECESSARY;
1161         }
1162         if (!skb_csum_unnecessary(skb))
1163                 skb->csum = csum_tcpudp_nofold(iph->saddr, iph->daddr,
1164                                                skb->len, proto, 0);
1165         /* Probably, we should checksum udp header (it should be in cache
1166          * in any case) and data in tiny packets (< rx copybreak).
1167          */
1168
1169         return 0;
1170 }
1171
1172 /*
1173  *      All we need to do is get the socket, and then do a checksum.
1174  */
1175
1176 int __udp4_lib_rcv(struct sk_buff *skb, struct hlist_head udptable[],
1177                    int proto)
1178 {
1179         struct sock *sk;
1180         struct udphdr *uh = udp_hdr(skb);
1181         unsigned short ulen;
1182         struct rtable *rt = (struct rtable*)skb->dst;
1183         __be32 saddr = ip_hdr(skb)->saddr;
1184         __be32 daddr = ip_hdr(skb)->daddr;
1185         struct net *net = dev_net(skb->dev);
1186
1187         /*
1188          *  Validate the packet.
1189          */
1190         if (!pskb_may_pull(skb, sizeof(struct udphdr)))
1191                 goto drop;              /* No space for header. */
1192
1193         ulen = ntohs(uh->len);
1194         if (ulen > skb->len)
1195                 goto short_packet;
1196
1197         if (proto == IPPROTO_UDP) {
1198                 /* UDP validates ulen. */
1199                 if (ulen < sizeof(*uh) || pskb_trim_rcsum(skb, ulen))
1200                         goto short_packet;
1201                 uh = udp_hdr(skb);
1202         }
1203
1204         if (udp4_csum_init(skb, uh, proto))
1205                 goto csum_error;
1206
1207         if (rt->rt_flags & (RTCF_BROADCAST|RTCF_MULTICAST))
1208                 return __udp4_lib_mcast_deliver(net, skb, uh,
1209                                 saddr, daddr, udptable);
1210
1211         sk = __udp4_lib_lookup(net, saddr, uh->source, daddr,
1212                         uh->dest, inet_iif(skb), udptable);
1213
1214         if (sk != NULL) {
1215                 int ret = udp_queue_rcv_skb(sk, skb);
1216                 sock_put(sk);
1217
1218                 /* a return value > 0 means to resubmit the input, but
1219                  * it wants the return to be -protocol, or 0
1220                  */
1221                 if (ret > 0)
1222                         return -ret;
1223                 return 0;
1224         }
1225
1226         if (!xfrm4_policy_check(NULL, XFRM_POLICY_IN, skb))
1227                 goto drop;
1228         nf_reset(skb);
1229
1230         /* No socket. Drop packet silently, if checksum is wrong */
1231         if (udp_lib_checksum_complete(skb))
1232                 goto csum_error;
1233
1234         UDP_INC_STATS_BH(net, UDP_MIB_NOPORTS, proto == IPPROTO_UDPLITE);
1235         icmp_send(skb, ICMP_DEST_UNREACH, ICMP_PORT_UNREACH, 0);
1236
1237         /*
1238          * Hmm.  We got an UDP packet to a port to which we
1239          * don't wanna listen.  Ignore it.
1240          */
1241         kfree_skb(skb);
1242         return 0;
1243
1244 short_packet:
1245         LIMIT_NETDEBUG(KERN_DEBUG "UDP%s: short packet: From " NIPQUAD_FMT ":%u %d/%d to " NIPQUAD_FMT ":%u\n",
1246                        proto == IPPROTO_UDPLITE ? "-Lite" : "",
1247                        NIPQUAD(saddr),
1248                        ntohs(uh->source),
1249                        ulen,
1250                        skb->len,
1251                        NIPQUAD(daddr),
1252                        ntohs(uh->dest));
1253         goto drop;
1254
1255 csum_error:
1256         /*
1257          * RFC1122: OK.  Discards the bad packet silently (as far as
1258          * the network is concerned, anyway) as per 4.1.3.4 (MUST).
1259          */
1260         LIMIT_NETDEBUG(KERN_DEBUG "UDP%s: bad checksum. From " NIPQUAD_FMT ":%u to " NIPQUAD_FMT ":%u ulen %d\n",
1261                        proto == IPPROTO_UDPLITE ? "-Lite" : "",
1262                        NIPQUAD(saddr),
1263                        ntohs(uh->source),
1264                        NIPQUAD(daddr),
1265                        ntohs(uh->dest),
1266                        ulen);
1267 drop:
1268         UDP_INC_STATS_BH(net, UDP_MIB_INERRORS, proto == IPPROTO_UDPLITE);
1269         kfree_skb(skb);
1270         return 0;
1271 }
1272
1273 int udp_rcv(struct sk_buff *skb)
1274 {
1275         return __udp4_lib_rcv(skb, udp_hash, IPPROTO_UDP);
1276 }
1277
1278 void udp_destroy_sock(struct sock *sk)
1279 {
1280         lock_sock(sk);
1281         udp_flush_pending_frames(sk);
1282         release_sock(sk);
1283 }
1284
1285 /*
1286  *      Socket option code for UDP
1287  */
1288 int udp_lib_setsockopt(struct sock *sk, int level, int optname,
1289                        char __user *optval, int optlen,
1290                        int (*push_pending_frames)(struct sock *))
1291 {
1292         struct udp_sock *up = udp_sk(sk);
1293         int val;
1294         int err = 0;
1295         int is_udplite = IS_UDPLITE(sk);
1296
1297         if (optlen<sizeof(int))
1298                 return -EINVAL;
1299
1300         if (get_user(val, (int __user *)optval))
1301                 return -EFAULT;
1302
1303         switch (optname) {
1304         case UDP_CORK:
1305                 if (val != 0) {
1306                         up->corkflag = 1;
1307                 } else {
1308                         up->corkflag = 0;
1309                         lock_sock(sk);
1310                         (*push_pending_frames)(sk);
1311                         release_sock(sk);
1312                 }
1313                 break;
1314
1315         case UDP_ENCAP:
1316                 switch (val) {
1317                 case 0:
1318                 case UDP_ENCAP_ESPINUDP:
1319                 case UDP_ENCAP_ESPINUDP_NON_IKE:
1320                         up->encap_rcv = xfrm4_udp_encap_rcv;
1321                         /* FALLTHROUGH */
1322                 case UDP_ENCAP_L2TPINUDP:
1323                         up->encap_type = val;
1324                         break;
1325                 default:
1326                         err = -ENOPROTOOPT;
1327                         break;
1328                 }
1329                 break;
1330
1331         /*
1332          *      UDP-Lite's partial checksum coverage (RFC 3828).
1333          */
1334         /* The sender sets actual checksum coverage length via this option.
1335          * The case coverage > packet length is handled by send module. */
1336         case UDPLITE_SEND_CSCOV:
1337                 if (!is_udplite)         /* Disable the option on UDP sockets */
1338                         return -ENOPROTOOPT;
1339                 if (val != 0 && val < 8) /* Illegal coverage: use default (8) */
1340                         val = 8;
1341                 else if (val > USHORT_MAX)
1342                         val = USHORT_MAX;
1343                 up->pcslen = val;
1344                 up->pcflag |= UDPLITE_SEND_CC;
1345                 break;
1346
1347         /* The receiver specifies a minimum checksum coverage value. To make
1348          * sense, this should be set to at least 8 (as done below). If zero is
1349          * used, this again means full checksum coverage.                     */
1350         case UDPLITE_RECV_CSCOV:
1351                 if (!is_udplite)         /* Disable the option on UDP sockets */
1352                         return -ENOPROTOOPT;
1353                 if (val != 0 && val < 8) /* Avoid silly minimal values.       */
1354                         val = 8;
1355                 else if (val > USHORT_MAX)
1356                         val = USHORT_MAX;
1357                 up->pcrlen = val;
1358                 up->pcflag |= UDPLITE_RECV_CC;
1359                 break;
1360
1361         default:
1362                 err = -ENOPROTOOPT;
1363                 break;
1364         }
1365
1366         return err;
1367 }
1368
1369 int udp_setsockopt(struct sock *sk, int level, int optname,
1370                    char __user *optval, int optlen)
1371 {
1372         if (level == SOL_UDP  ||  level == SOL_UDPLITE)
1373                 return udp_lib_setsockopt(sk, level, optname, optval, optlen,
1374                                           udp_push_pending_frames);
1375         return ip_setsockopt(sk, level, optname, optval, optlen);
1376 }
1377
1378 #ifdef CONFIG_COMPAT
1379 int compat_udp_setsockopt(struct sock *sk, int level, int optname,
1380                           char __user *optval, int optlen)
1381 {
1382         if (level == SOL_UDP  ||  level == SOL_UDPLITE)
1383                 return udp_lib_setsockopt(sk, level, optname, optval, optlen,
1384                                           udp_push_pending_frames);
1385         return compat_ip_setsockopt(sk, level, optname, optval, optlen);
1386 }
1387 #endif
1388
1389 int udp_lib_getsockopt(struct sock *sk, int level, int optname,
1390                        char __user *optval, int __user *optlen)
1391 {
1392         struct udp_sock *up = udp_sk(sk);
1393         int val, len;
1394
1395         if (get_user(len,optlen))
1396                 return -EFAULT;
1397
1398         len = min_t(unsigned int, len, sizeof(int));
1399
1400         if (len < 0)
1401                 return -EINVAL;
1402
1403         switch (optname) {
1404         case UDP_CORK:
1405                 val = up->corkflag;
1406                 break;
1407
1408         case UDP_ENCAP:
1409                 val = up->encap_type;
1410                 break;
1411
1412         /* The following two cannot be changed on UDP sockets, the return is
1413          * always 0 (which corresponds to the full checksum coverage of UDP). */
1414         case UDPLITE_SEND_CSCOV:
1415                 val = up->pcslen;
1416                 break;
1417
1418         case UDPLITE_RECV_CSCOV:
1419                 val = up->pcrlen;
1420                 break;
1421
1422         default:
1423                 return -ENOPROTOOPT;
1424         }
1425
1426         if (put_user(len, optlen))
1427                 return -EFAULT;
1428         if (copy_to_user(optval, &val,len))
1429                 return -EFAULT;
1430         return 0;
1431 }
1432
1433 int udp_getsockopt(struct sock *sk, int level, int optname,
1434                    char __user *optval, int __user *optlen)
1435 {
1436         if (level == SOL_UDP  ||  level == SOL_UDPLITE)
1437                 return udp_lib_getsockopt(sk, level, optname, optval, optlen);
1438         return ip_getsockopt(sk, level, optname, optval, optlen);
1439 }
1440
1441 #ifdef CONFIG_COMPAT
1442 int compat_udp_getsockopt(struct sock *sk, int level, int optname,
1443                                  char __user *optval, int __user *optlen)
1444 {
1445         if (level == SOL_UDP  ||  level == SOL_UDPLITE)
1446                 return udp_lib_getsockopt(sk, level, optname, optval, optlen);
1447         return compat_ip_getsockopt(sk, level, optname, optval, optlen);
1448 }
1449 #endif
1450 /**
1451  *      udp_poll - wait for a UDP event.
1452  *      @file - file struct
1453  *      @sock - socket
1454  *      @wait - poll table
1455  *
1456  *      This is same as datagram poll, except for the special case of
1457  *      blocking sockets. If application is using a blocking fd
1458  *      and a packet with checksum error is in the queue;
1459  *      then it could get return from select indicating data available
1460  *      but then block when reading it. Add special case code
1461  *      to work around these arguably broken applications.
1462  */
1463 unsigned int udp_poll(struct file *file, struct socket *sock, poll_table *wait)
1464 {
1465         unsigned int mask = datagram_poll(file, sock, wait);
1466         struct sock *sk = sock->sk;
1467         int     is_lite = IS_UDPLITE(sk);
1468
1469         /* Check for false positives due to checksum errors */
1470         if ( (mask & POLLRDNORM) &&
1471              !(file->f_flags & O_NONBLOCK) &&
1472              !(sk->sk_shutdown & RCV_SHUTDOWN)){
1473                 struct sk_buff_head *rcvq = &sk->sk_receive_queue;
1474                 struct sk_buff *skb;
1475
1476                 spin_lock_bh(&rcvq->lock);
1477                 while ((skb = skb_peek(rcvq)) != NULL &&
1478                        udp_lib_checksum_complete(skb)) {
1479                         UDP_INC_STATS_BH(sock_net(sk),
1480                                         UDP_MIB_INERRORS, is_lite);
1481                         __skb_unlink(skb, rcvq);
1482                         kfree_skb(skb);
1483                 }
1484                 spin_unlock_bh(&rcvq->lock);
1485
1486                 /* nothing to see, move along */
1487                 if (skb == NULL)
1488                         mask &= ~(POLLIN | POLLRDNORM);
1489         }
1490
1491         return mask;
1492
1493 }
1494
1495 struct proto udp_prot = {
1496         .name              = "UDP",
1497         .owner             = THIS_MODULE,
1498         .close             = udp_lib_close,
1499         .connect           = ip4_datagram_connect,
1500         .disconnect        = udp_disconnect,
1501         .ioctl             = udp_ioctl,
1502         .destroy           = udp_destroy_sock,
1503         .setsockopt        = udp_setsockopt,
1504         .getsockopt        = udp_getsockopt,
1505         .sendmsg           = udp_sendmsg,
1506         .recvmsg           = udp_recvmsg,
1507         .sendpage          = udp_sendpage,
1508         .backlog_rcv       = __udp_queue_rcv_skb,
1509         .hash              = udp_lib_hash,
1510         .unhash            = udp_lib_unhash,
1511         .get_port          = udp_v4_get_port,
1512         .memory_allocated  = &udp_memory_allocated,
1513         .sysctl_mem        = sysctl_udp_mem,
1514         .sysctl_wmem       = &sysctl_udp_wmem_min,
1515         .sysctl_rmem       = &sysctl_udp_rmem_min,
1516         .obj_size          = sizeof(struct udp_sock),
1517         .h.udp_hash        = udp_hash,
1518 #ifdef CONFIG_COMPAT
1519         .compat_setsockopt = compat_udp_setsockopt,
1520         .compat_getsockopt = compat_udp_getsockopt,
1521 #endif
1522 };
1523
1524 /* ------------------------------------------------------------------------ */
1525 #ifdef CONFIG_PROC_FS
1526
1527 static struct sock *udp_get_first(struct seq_file *seq)
1528 {
1529         struct sock *sk;
1530         struct udp_iter_state *state = seq->private;
1531         struct net *net = seq_file_net(seq);
1532
1533         for (state->bucket = 0; state->bucket < UDP_HTABLE_SIZE; ++state->bucket) {
1534                 struct hlist_node *node;
1535                 sk_for_each(sk, node, state->hashtable + state->bucket) {
1536                         if (!net_eq(sock_net(sk), net))
1537                                 continue;
1538                         if (sk->sk_family == state->family)
1539                                 goto found;
1540                 }
1541         }
1542         sk = NULL;
1543 found:
1544         return sk;
1545 }
1546
1547 static struct sock *udp_get_next(struct seq_file *seq, struct sock *sk)
1548 {
1549         struct udp_iter_state *state = seq->private;
1550         struct net *net = seq_file_net(seq);
1551
1552         do {
1553                 sk = sk_next(sk);
1554 try_again:
1555                 ;
1556         } while (sk && (!net_eq(sock_net(sk), net) || sk->sk_family != state->family));
1557
1558         if (!sk && ++state->bucket < UDP_HTABLE_SIZE) {
1559                 sk = sk_head(state->hashtable + state->bucket);
1560                 goto try_again;
1561         }
1562         return sk;
1563 }
1564
1565 static struct sock *udp_get_idx(struct seq_file *seq, loff_t pos)
1566 {
1567         struct sock *sk = udp_get_first(seq);
1568
1569         if (sk)
1570                 while (pos && (sk = udp_get_next(seq, sk)) != NULL)
1571                         --pos;
1572         return pos ? NULL : sk;
1573 }
1574
1575 static void *udp_seq_start(struct seq_file *seq, loff_t *pos)
1576         __acquires(udp_hash_lock)
1577 {
1578         read_lock(&udp_hash_lock);
1579         return *pos ? udp_get_idx(seq, *pos-1) : SEQ_START_TOKEN;
1580 }
1581
1582 static void *udp_seq_next(struct seq_file *seq, void *v, loff_t *pos)
1583 {
1584         struct sock *sk;
1585
1586         if (v == SEQ_START_TOKEN)
1587                 sk = udp_get_idx(seq, 0);
1588         else
1589                 sk = udp_get_next(seq, v);
1590
1591         ++*pos;
1592         return sk;
1593 }
1594
1595 static void udp_seq_stop(struct seq_file *seq, void *v)
1596         __releases(udp_hash_lock)
1597 {
1598         read_unlock(&udp_hash_lock);
1599 }
1600
1601 static int udp_seq_open(struct inode *inode, struct file *file)
1602 {
1603         struct udp_seq_afinfo *afinfo = PDE(inode)->data;
1604         struct udp_iter_state *s;
1605         int err;
1606
1607         err = seq_open_net(inode, file, &afinfo->seq_ops,
1608                            sizeof(struct udp_iter_state));
1609         if (err < 0)
1610                 return err;
1611
1612         s = ((struct seq_file *)file->private_data)->private;
1613         s->family               = afinfo->family;
1614         s->hashtable            = afinfo->hashtable;
1615         return err;
1616 }
1617
1618 /* ------------------------------------------------------------------------ */
1619 int udp_proc_register(struct net *net, struct udp_seq_afinfo *afinfo)
1620 {
1621         struct proc_dir_entry *p;
1622         int rc = 0;
1623
1624         afinfo->seq_fops.open           = udp_seq_open;
1625         afinfo->seq_fops.read           = seq_read;
1626         afinfo->seq_fops.llseek         = seq_lseek;
1627         afinfo->seq_fops.release        = seq_release_net;
1628
1629         afinfo->seq_ops.start           = udp_seq_start;
1630         afinfo->seq_ops.next            = udp_seq_next;
1631         afinfo->seq_ops.stop            = udp_seq_stop;
1632
1633         p = proc_create_data(afinfo->name, S_IRUGO, net->proc_net,
1634                              &afinfo->seq_fops, afinfo);
1635         if (!p)
1636                 rc = -ENOMEM;
1637         return rc;
1638 }
1639
1640 void udp_proc_unregister(struct net *net, struct udp_seq_afinfo *afinfo)
1641 {
1642         proc_net_remove(net, afinfo->name);
1643 }
1644
1645 /* ------------------------------------------------------------------------ */
1646 static void udp4_format_sock(struct sock *sp, struct seq_file *f,
1647                 int bucket, int *len)
1648 {
1649         struct inet_sock *inet = inet_sk(sp);
1650         __be32 dest = inet->daddr;
1651         __be32 src  = inet->rcv_saddr;
1652         __u16 destp       = ntohs(inet->dport);
1653         __u16 srcp        = ntohs(inet->sport);
1654
1655         seq_printf(f, "%4d: %08X:%04X %08X:%04X"
1656                 " %02X %08X:%08X %02X:%08lX %08X %5d %8d %lu %d %p %d%n",
1657                 bucket, src, srcp, dest, destp, sp->sk_state,
1658                 atomic_read(&sp->sk_wmem_alloc),
1659                 atomic_read(&sp->sk_rmem_alloc),
1660                 0, 0L, 0, sock_i_uid(sp), 0, sock_i_ino(sp),
1661                 atomic_read(&sp->sk_refcnt), sp,
1662                 atomic_read(&sp->sk_drops), len);
1663 }
1664
1665 int udp4_seq_show(struct seq_file *seq, void *v)
1666 {
1667         if (v == SEQ_START_TOKEN)
1668                 seq_printf(seq, "%-127s\n",
1669                            "  sl  local_address rem_address   st tx_queue "
1670                            "rx_queue tr tm->when retrnsmt   uid  timeout "
1671                            "inode ref pointer drops");
1672         else {
1673                 struct udp_iter_state *state = seq->private;
1674                 int len;
1675
1676                 udp4_format_sock(v, seq, state->bucket, &len);
1677                 seq_printf(seq, "%*s\n", 127 - len ,"");
1678         }
1679         return 0;
1680 }
1681
1682 /* ------------------------------------------------------------------------ */
1683 static struct udp_seq_afinfo udp4_seq_afinfo = {
1684         .name           = "udp",
1685         .family         = AF_INET,
1686         .hashtable      = udp_hash,
1687         .seq_fops       = {
1688                 .owner  =       THIS_MODULE,
1689         },
1690         .seq_ops        = {
1691                 .show           = udp4_seq_show,
1692         },
1693 };
1694
1695 static int udp4_proc_init_net(struct net *net)
1696 {
1697         return udp_proc_register(net, &udp4_seq_afinfo);
1698 }
1699
1700 static void udp4_proc_exit_net(struct net *net)
1701 {
1702         udp_proc_unregister(net, &udp4_seq_afinfo);
1703 }
1704
1705 static struct pernet_operations udp4_net_ops = {
1706         .init = udp4_proc_init_net,
1707         .exit = udp4_proc_exit_net,
1708 };
1709
1710 int __init udp4_proc_init(void)
1711 {
1712         return register_pernet_subsys(&udp4_net_ops);
1713 }
1714
1715 void udp4_proc_exit(void)
1716 {
1717         unregister_pernet_subsys(&udp4_net_ops);
1718 }
1719 #endif /* CONFIG_PROC_FS */
1720
1721 void __init udp_init(void)
1722 {
1723         unsigned long limit;
1724
1725         /* Set the pressure threshold up by the same strategy of TCP. It is a
1726          * fraction of global memory that is up to 1/2 at 256 MB, decreasing
1727          * toward zero with the amount of memory, with a floor of 128 pages.
1728          */
1729         limit = min(nr_all_pages, 1UL<<(28-PAGE_SHIFT)) >> (20-PAGE_SHIFT);
1730         limit = (limit * (nr_all_pages >> (20-PAGE_SHIFT))) >> (PAGE_SHIFT-11);
1731         limit = max(limit, 128UL);
1732         sysctl_udp_mem[0] = limit / 4 * 3;
1733         sysctl_udp_mem[1] = limit;
1734         sysctl_udp_mem[2] = sysctl_udp_mem[0] * 2;
1735
1736         sysctl_udp_rmem_min = SK_MEM_QUANTUM;
1737         sysctl_udp_wmem_min = SK_MEM_QUANTUM;
1738 }
1739
1740 EXPORT_SYMBOL(udp_disconnect);
1741 EXPORT_SYMBOL(udp_hash);
1742 EXPORT_SYMBOL(udp_hash_lock);
1743 EXPORT_SYMBOL(udp_ioctl);
1744 EXPORT_SYMBOL(udp_prot);
1745 EXPORT_SYMBOL(udp_sendmsg);
1746 EXPORT_SYMBOL(udp_lib_getsockopt);
1747 EXPORT_SYMBOL(udp_lib_setsockopt);
1748 EXPORT_SYMBOL(udp_poll);
1749 EXPORT_SYMBOL(udp_lib_get_port);
1750
1751 #ifdef CONFIG_PROC_FS
1752 EXPORT_SYMBOL(udp_proc_register);
1753 EXPORT_SYMBOL(udp_proc_unregister);
1754 #endif