[NETFILTER]: ip_tables: reformat compat code
[linux-2.6] / 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