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