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 *		RAW - implementation of IP "raw" sockets.
7 *
8 * Authors:	Ross Biro
9 *		Fred N. van Kempen, <waltje@uWalt.NL.Mugnet.ORG>
10 *
11 * Fixes:
12 *		Alan Cox	:	verify_area() fixed up
13 *		Alan Cox	:	ICMP error handling
14 *		Alan Cox	:	EMSGSIZE if you send too big a packet
15 *		Alan Cox	: 	Now uses generic datagrams and shared
16 *					skbuff library. No more peek crashes,
17 *					no more backlogs
18 *		Alan Cox	:	Checks sk->broadcast.
19 *		Alan Cox	:	Uses skb_free_datagram/skb_copy_datagram
20 *		Alan Cox	:	Raw passes ip options too
21 *		Alan Cox	:	Setsocketopt added
22 *		Alan Cox	:	Fixed error return for broadcasts
23 *		Alan Cox	:	Removed wake_up calls
24 *		Alan Cox	:	Use ttl/tos
25 *		Alan Cox	:	Cleaned up old debugging
26 *		Alan Cox	:	Use new kernel side addresses
27 *	Arnt Gulbrandsen	:	Fixed MSG_DONTROUTE in raw sockets.
28 *		Alan Cox	:	BSD style RAW socket demultiplexing.
29 *		Alan Cox	:	Beginnings of mrouted support.
30 *		Alan Cox	:	Added IP_HDRINCL option.
31 *		Alan Cox	:	Skip broadcast check if BSDism set.
32 *		David S. Miller	:	New socket lookup architecture.
33 *
34 *		This program is free software; you can redistribute it and/or
35 *		modify it under the terms of the GNU General Public License
36 *		as published by the Free Software Foundation; either version
37 *		2 of the License, or (at your option) any later version.
38 */
39
40#include <linux/types.h>
41#include <linux/atomic.h>
42#include <asm/byteorder.h>
43#include <asm/current.h>
44#include <asm/uaccess.h>
45#include <asm/ioctls.h>
46#include <linux/stddef.h>
47#include <linux/slab.h>
48#include <linux/errno.h>
49#include <linux/aio.h>
50#include <linux/kernel.h>
51#include <linux/export.h>
52#include <linux/spinlock.h>
53#include <linux/sockios.h>
54#include <linux/socket.h>
55#include <linux/in.h>
56#include <linux/mroute.h>
57#include <linux/netdevice.h>
58#include <linux/in_route.h>
59#include <linux/route.h>
60#include <linux/skbuff.h>
61#include <linux/igmp.h>
62#include <net/net_namespace.h>
63#include <net/dst.h>
64#include <net/sock.h>
65#include <linux/ip.h>
66#include <linux/net.h>
67#include <net/ip.h>
68#include <net/icmp.h>
69#include <net/udp.h>
70#include <net/raw.h>
71#include <net/snmp.h>
72#include <net/tcp_states.h>
73#include <net/inet_common.h>
74#include <net/checksum.h>
75#include <net/xfrm.h>
76#include <linux/rtnetlink.h>
77#include <linux/proc_fs.h>
78#include <linux/seq_file.h>
79#include <linux/netfilter.h>
80#include <linux/netfilter_ipv4.h>
81#include <linux/compat.h>
82
83static struct raw_hashinfo raw_v4_hashinfo = {
84	.lock = __RW_LOCK_UNLOCKED(raw_v4_hashinfo.lock),
85};
86
87void raw_hash_sk(struct sock *sk)
88{
89	struct raw_hashinfo *h = sk->sk_prot->h.raw_hash;
90	struct hlist_head *head;
91
92	head = &h->ht[inet_sk(sk)->inet_num & (RAW_HTABLE_SIZE - 1)];
93
94	write_lock_bh(&h->lock);
95	sk_add_node(sk, head);
96	sock_prot_inuse_add(sock_net(sk), sk->sk_prot, 1);
97	write_unlock_bh(&h->lock);
98}
99EXPORT_SYMBOL_GPL(raw_hash_sk);
100
101void raw_unhash_sk(struct sock *sk)
102{
103	struct raw_hashinfo *h = sk->sk_prot->h.raw_hash;
104
105	write_lock_bh(&h->lock);
106	if (sk_del_node_init(sk))
107		sock_prot_inuse_add(sock_net(sk), sk->sk_prot, -1);
108	write_unlock_bh(&h->lock);
109}
110EXPORT_SYMBOL_GPL(raw_unhash_sk);
111
112static struct sock *__raw_v4_lookup(struct net *net, struct sock *sk,
113		unsigned short num, __be32 raddr, __be32 laddr, int dif)
114{
115	sk_for_each_from(sk) {
116		struct inet_sock *inet = inet_sk(sk);
117
118		if (net_eq(sock_net(sk), net) && inet->inet_num == num	&&
119		    !(inet->inet_daddr && inet->inet_daddr != raddr) 	&&
120		    !(inet->inet_rcv_saddr && inet->inet_rcv_saddr != laddr) &&
121		    !(sk->sk_bound_dev_if && sk->sk_bound_dev_if != dif))
122			goto found; /* gotcha */
123	}
124	sk = NULL;
125found:
126	return sk;
127}
128
129/*
130 *	0 - deliver
131 *	1 - block
132 */
133static int icmp_filter(const struct sock *sk, const struct sk_buff *skb)
134{
135	struct icmphdr _hdr;
136	const struct icmphdr *hdr;
137
138	hdr = skb_header_pointer(skb, skb_transport_offset(skb),
139				 sizeof(_hdr), &_hdr);
140	if (!hdr)
141		return 1;
142
143	if (hdr->type < 32) {
144		__u32 data = raw_sk(sk)->filter.data;
145
146		return ((1U << hdr->type) & data) != 0;
147	}
148
149	/* Do not block unknown ICMP types */
150	return 0;
151}
152
153/* IP input processing comes here for RAW socket delivery.
154 * Caller owns SKB, so we must make clones.
155 *
156 * RFC 1122: SHOULD pass TOS value up to the transport layer.
157 * -> It does. And not only TOS, but all IP header.
158 */
159static int raw_v4_input(struct sk_buff *skb, const struct iphdr *iph, int hash)
160{
161	struct sock *sk;
162	struct hlist_head *head;
163	int delivered = 0;
164	struct net *net;
165
166	read_lock(&raw_v4_hashinfo.lock);
167	head = &raw_v4_hashinfo.ht[hash];
168	if (hlist_empty(head))
169		goto out;
170
171	net = dev_net(skb->dev);
172	sk = __raw_v4_lookup(net, __sk_head(head), iph->protocol,
173			     iph->saddr, iph->daddr,
174			     skb->dev->ifindex);
175
176	while (sk) {
177		delivered = 1;
178		if ((iph->protocol != IPPROTO_ICMP || !icmp_filter(sk, skb)) &&
179		    ip_mc_sf_allow(sk, iph->daddr, iph->saddr,
180				   skb->dev->ifindex)) {
181			struct sk_buff *clone = skb_clone(skb, GFP_ATOMIC);
182
183			/* Not releasing hash table! */
184			if (clone)
185				raw_rcv(sk, clone);
186		}
187		sk = __raw_v4_lookup(net, sk_next(sk), iph->protocol,
188				     iph->saddr, iph->daddr,
189				     skb->dev->ifindex);
190	}
191out:
192	read_unlock(&raw_v4_hashinfo.lock);
193	return delivered;
194}
195
196int raw_local_deliver(struct sk_buff *skb, int protocol)
197{
198	int hash;
199	struct sock *raw_sk;
200
201	hash = protocol & (RAW_HTABLE_SIZE - 1);
202	raw_sk = sk_head(&raw_v4_hashinfo.ht[hash]);
203
204	/* If there maybe a raw socket we must check - if not we
205	 * don't care less
206	 */
207	if (raw_sk && !raw_v4_input(skb, ip_hdr(skb), hash))
208		raw_sk = NULL;
209
210	return raw_sk != NULL;
211
212}
213
214static void raw_err(struct sock *sk, struct sk_buff *skb, u32 info)
215{
216	struct inet_sock *inet = inet_sk(sk);
217	const int type = icmp_hdr(skb)->type;
218	const int code = icmp_hdr(skb)->code;
219	int err = 0;
220	int harderr = 0;
221
222	if (type == ICMP_DEST_UNREACH && code == ICMP_FRAG_NEEDED)
223		ipv4_sk_update_pmtu(skb, sk, info);
224	else if (type == ICMP_REDIRECT) {
225		ipv4_sk_redirect(skb, sk);
226		return;
227	}
228
229	/* Report error on raw socket, if:
230	   1. User requested ip_recverr.
231	   2. Socket is connected (otherwise the error indication
232	      is useless without ip_recverr and error is hard.
233	 */
234	if (!inet->recverr && sk->sk_state != TCP_ESTABLISHED)
235		return;
236
237	switch (type) {
238	default:
239	case ICMP_TIME_EXCEEDED:
240		err = EHOSTUNREACH;
241		break;
242	case ICMP_SOURCE_QUENCH:
243		return;
244	case ICMP_PARAMETERPROB:
245		err = EPROTO;
246		harderr = 1;
247		break;
248	case ICMP_DEST_UNREACH:
249		err = EHOSTUNREACH;
250		if (code > NR_ICMP_UNREACH)
251			break;
252		err = icmp_err_convert[code].errno;
253		harderr = icmp_err_convert[code].fatal;
254		if (code == ICMP_FRAG_NEEDED) {
255			harderr = inet->pmtudisc != IP_PMTUDISC_DONT;
256			err = EMSGSIZE;
257		}
258	}
259
260	if (inet->recverr) {
261		const struct iphdr *iph = (const struct iphdr *)skb->data;
262		u8 *payload = skb->data + (iph->ihl << 2);
263
264		if (inet->hdrincl)
265			payload = skb->data;
266		ip_icmp_error(sk, skb, err, 0, info, payload);
267	}
268
269	if (inet->recverr || harderr) {
270		sk->sk_err = err;
271		sk->sk_error_report(sk);
272	}
273}
274
275void raw_icmp_error(struct sk_buff *skb, int protocol, u32 info)
276{
277	int hash;
278	struct sock *raw_sk;
279	const struct iphdr *iph;
280	struct net *net;
281
282	hash = protocol & (RAW_HTABLE_SIZE - 1);
283
284	read_lock(&raw_v4_hashinfo.lock);
285	raw_sk = sk_head(&raw_v4_hashinfo.ht[hash]);
286	if (raw_sk != NULL) {
287		iph = (const struct iphdr *)skb->data;
288		net = dev_net(skb->dev);
289
290		while ((raw_sk = __raw_v4_lookup(net, raw_sk, protocol,
291						iph->daddr, iph->saddr,
292						skb->dev->ifindex)) != NULL) {
293			raw_err(raw_sk, skb, info);
294			raw_sk = sk_next(raw_sk);
295			iph = (const struct iphdr *)skb->data;
296		}
297	}
298	read_unlock(&raw_v4_hashinfo.lock);
299}
300
301static int raw_rcv_skb(struct sock *sk, struct sk_buff *skb)
302{
303	/* Charge it to the socket. */
304
305	ipv4_pktinfo_prepare(sk, skb);
306	if (sock_queue_rcv_skb(sk, skb) < 0) {
307		kfree_skb(skb);
308		return NET_RX_DROP;
309	}
310
311	return NET_RX_SUCCESS;
312}
313
314int raw_rcv(struct sock *sk, struct sk_buff *skb)
315{
316	if (!xfrm4_policy_check(sk, XFRM_POLICY_IN, skb)) {
317		atomic_inc(&sk->sk_drops);
318		kfree_skb(skb);
319		return NET_RX_DROP;
320	}
321	nf_reset(skb);
322
323	skb_push(skb, skb->data - skb_network_header(skb));
324
325	raw_rcv_skb(sk, skb);
326	return 0;
327}
328
329static int raw_send_hdrinc(struct sock *sk, struct flowi4 *fl4,
330			   void *from, size_t length,
331			   struct rtable **rtp,
332			   unsigned int flags)
333{
334	struct inet_sock *inet = inet_sk(sk);
335	struct net *net = sock_net(sk);
336	struct iphdr *iph;
337	struct sk_buff *skb;
338	unsigned int iphlen;
339	int err;
340	struct rtable *rt = *rtp;
341	int hlen, tlen;
342
343	if (length > rt->dst.dev->mtu) {
344		ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport,
345			       rt->dst.dev->mtu);
346		return -EMSGSIZE;
347	}
348	if (flags&MSG_PROBE)
349		goto out;
350
351	hlen = LL_RESERVED_SPACE(rt->dst.dev);
352	tlen = rt->dst.dev->needed_tailroom;
353	skb = sock_alloc_send_skb(sk,
354				  length + hlen + tlen + 15,
355				  flags & MSG_DONTWAIT, &err);
356	if (skb == NULL)
357		goto error;
358	skb_reserve(skb, hlen);
359
360	skb->priority = sk->sk_priority;
361	skb->mark = sk->sk_mark;
362	skb_dst_set(skb, &rt->dst);
363	*rtp = NULL;
364
365	skb_reset_network_header(skb);
366	iph = ip_hdr(skb);
367	skb_put(skb, length);
368
369	skb->ip_summed = CHECKSUM_NONE;
370
371	sock_tx_timestamp(sk, &skb_shinfo(skb)->tx_flags);
372
373	skb->transport_header = skb->network_header;
374	err = -EFAULT;
375	if (memcpy_fromiovecend((void *)iph, from, 0, length))
376		goto error_free;
377
378	iphlen = iph->ihl * 4;
379
380	/*
381	 * We don't want to modify the ip header, but we do need to
382	 * be sure that it won't cause problems later along the network
383	 * stack.  Specifically we want to make sure that iph->ihl is a
384	 * sane value.  If ihl points beyond the length of the buffer passed
385	 * in, reject the frame as invalid
386	 */
387	err = -EINVAL;
388	if (iphlen > length)
389		goto error_free;
390
391	if (iphlen >= sizeof(*iph)) {
392		if (!iph->saddr)
393			iph->saddr = fl4->saddr;
394		iph->check   = 0;
395		iph->tot_len = htons(length);
396		if (!iph->id)
397			ip_select_ident(skb, NULL);
398
399		iph->check = ip_fast_csum((unsigned char *)iph, iph->ihl);
400	}
401	if (iph->protocol == IPPROTO_ICMP)
402		icmp_out_count(net, ((struct icmphdr *)
403			skb_transport_header(skb))->type);
404
405	err = NF_HOOK(NFPROTO_IPV4, NF_INET_LOCAL_OUT, skb, NULL,
406		      rt->dst.dev, dst_output);
407	if (err > 0)
408		err = net_xmit_errno(err);
409	if (err)
410		goto error;
411out:
412	return 0;
413
414error_free:
415	kfree_skb(skb);
416error:
417	IP_INC_STATS(net, IPSTATS_MIB_OUTDISCARDS);
418	if (err == -ENOBUFS && !inet->recverr)
419		err = 0;
420	return err;
421}
422
423static int raw_probe_proto_opt(struct flowi4 *fl4, struct msghdr *msg)
424{
425	struct iovec *iov;
426	u8 __user *type = NULL;
427	u8 __user *code = NULL;
428	int probed = 0;
429	unsigned int i;
430
431	if (!msg->msg_iov)
432		return 0;
433
434	for (i = 0; i < msg->msg_iovlen; i++) {
435		iov = &msg->msg_iov[i];
436		if (!iov)
437			continue;
438
439		switch (fl4->flowi4_proto) {
440		case IPPROTO_ICMP:
441			/* check if one-byte field is readable or not. */
442			if (iov->iov_base && iov->iov_len < 1)
443				break;
444
445			if (!type) {
446				type = iov->iov_base;
447				/* check if code field is readable or not. */
448				if (iov->iov_len > 1)
449					code = type + 1;
450			} else if (!code)
451				code = iov->iov_base;
452
453			if (type && code) {
454				if (get_user(fl4->fl4_icmp_type, type) ||
455				    get_user(fl4->fl4_icmp_code, code))
456					return -EFAULT;
457				probed = 1;
458			}
459			break;
460		default:
461			probed = 1;
462			break;
463		}
464		if (probed)
465			break;
466	}
467	return 0;
468}
469
470static int raw_sendmsg(struct kiocb *iocb, struct sock *sk, struct msghdr *msg,
471		       size_t len)
472{
473	struct inet_sock *inet = inet_sk(sk);
474	struct ipcm_cookie ipc;
475	struct rtable *rt = NULL;
476	struct flowi4 fl4;
477	int free = 0;
478	__be32 daddr;
479	__be32 saddr;
480	u8  tos;
481	int err;
482	struct ip_options_data opt_copy;
483
484	err = -EMSGSIZE;
485	if (len > 0xFFFF)
486		goto out;
487
488	/*
489	 *	Check the flags.
490	 */
491
492	err = -EOPNOTSUPP;
493	if (msg->msg_flags & MSG_OOB)	/* Mirror BSD error message */
494		goto out;               /* compatibility */
495
496	/*
497	 *	Get and verify the address.
498	 */
499
500	if (msg->msg_namelen) {
501		DECLARE_SOCKADDR(struct sockaddr_in *, usin, msg->msg_name);
502		err = -EINVAL;
503		if (msg->msg_namelen < sizeof(*usin))
504			goto out;
505		if (usin->sin_family != AF_INET) {
506			pr_info_once("%s: %s forgot to set AF_INET. Fix it!\n",
507				     __func__, current->comm);
508			err = -EAFNOSUPPORT;
509			if (usin->sin_family)
510				goto out;
511		}
512		daddr = usin->sin_addr.s_addr;
513		/* ANK: I did not forget to get protocol from port field.
514		 * I just do not know, who uses this weirdness.
515		 * IP_HDRINCL is much more convenient.
516		 */
517	} else {
518		err = -EDESTADDRREQ;
519		if (sk->sk_state != TCP_ESTABLISHED)
520			goto out;
521		daddr = inet->inet_daddr;
522	}
523
524	ipc.addr = inet->inet_saddr;
525	ipc.opt = NULL;
526	ipc.tx_flags = 0;
527	ipc.ttl = 0;
528	ipc.tos = -1;
529	ipc.oif = sk->sk_bound_dev_if;
530
531	if (msg->msg_controllen) {
532		err = ip_cmsg_send(sock_net(sk), msg, &ipc, false);
533		if (err)
534			goto out;
535		if (ipc.opt)
536			free = 1;
537	}
538
539	saddr = ipc.addr;
540	ipc.addr = daddr;
541
542	if (!ipc.opt) {
543		struct ip_options_rcu *inet_opt;
544
545		rcu_read_lock();
546		inet_opt = rcu_dereference(inet->inet_opt);
547		if (inet_opt) {
548			memcpy(&opt_copy, inet_opt,
549			       sizeof(*inet_opt) + inet_opt->opt.optlen);
550			ipc.opt = &opt_copy.opt;
551		}
552		rcu_read_unlock();
553	}
554
555	if (ipc.opt) {
556		err = -EINVAL;
557		/* Linux does not mangle headers on raw sockets,
558		 * so that IP options + IP_HDRINCL is non-sense.
559		 */
560		if (inet->hdrincl)
561			goto done;
562		if (ipc.opt->opt.srr) {
563			if (!daddr)
564				goto done;
565			daddr = ipc.opt->opt.faddr;
566		}
567	}
568	tos = get_rtconn_flags(&ipc, sk);
569	if (msg->msg_flags & MSG_DONTROUTE)
570		tos |= RTO_ONLINK;
571
572	if (ipv4_is_multicast(daddr)) {
573		if (!ipc.oif)
574			ipc.oif = inet->mc_index;
575		if (!saddr)
576			saddr = inet->mc_addr;
577	} else if (!ipc.oif)
578		ipc.oif = inet->uc_index;
579
580	flowi4_init_output(&fl4, ipc.oif, sk->sk_mark, tos,
581			   RT_SCOPE_UNIVERSE,
582			   inet->hdrincl ? IPPROTO_RAW : sk->sk_protocol,
583			   inet_sk_flowi_flags(sk) |
584			    (inet->hdrincl ? FLOWI_FLAG_KNOWN_NH : 0),
585			   daddr, saddr, 0, 0,
586			   sock_i_uid(sk));
587
588	if (!inet->hdrincl) {
589		err = raw_probe_proto_opt(&fl4, msg);
590		if (err)
591			goto done;
592	}
593
594	security_sk_classify_flow(sk, flowi4_to_flowi(&fl4));
595	rt = ip_route_output_flow(sock_net(sk), &fl4, sk);
596	if (IS_ERR(rt)) {
597		err = PTR_ERR(rt);
598		rt = NULL;
599		goto done;
600	}
601
602	err = -EACCES;
603	if (rt->rt_flags & RTCF_BROADCAST && !sock_flag(sk, SOCK_BROADCAST))
604		goto done;
605
606	if (msg->msg_flags & MSG_CONFIRM)
607		goto do_confirm;
608back_from_confirm:
609
610	if (inet->hdrincl)
611		err = raw_send_hdrinc(sk, &fl4, msg->msg_iov, len,
612				      &rt, msg->msg_flags);
613
614	 else {
615		sock_tx_timestamp(sk, &ipc.tx_flags);
616
617		if (!ipc.addr)
618			ipc.addr = fl4.daddr;
619		lock_sock(sk);
620		err = ip_append_data(sk, &fl4, ip_generic_getfrag,
621				     msg->msg_iov, len, 0,
622				     &ipc, &rt, msg->msg_flags);
623		if (err)
624			ip_flush_pending_frames(sk);
625		else if (!(msg->msg_flags & MSG_MORE)) {
626			err = ip_push_pending_frames(sk, &fl4);
627			if (err == -ENOBUFS && !inet->recverr)
628				err = 0;
629		}
630		release_sock(sk);
631	}
632done:
633	if (free)
634		kfree(ipc.opt);
635	ip_rt_put(rt);
636
637out:
638	if (err < 0)
639		return err;
640	return len;
641
642do_confirm:
643	dst_confirm(&rt->dst);
644	if (!(msg->msg_flags & MSG_PROBE) || len)
645		goto back_from_confirm;
646	err = 0;
647	goto done;
648}
649
650static void raw_close(struct sock *sk, long timeout)
651{
652	/*
653	 * Raw sockets may have direct kernel references. Kill them.
654	 */
655	ip_ra_control(sk, 0, NULL);
656
657	sk_common_release(sk);
658}
659
660static void raw_destroy(struct sock *sk)
661{
662	lock_sock(sk);
663	ip_flush_pending_frames(sk);
664	release_sock(sk);
665}
666
667/* This gets rid of all the nasties in af_inet. -DaveM */
668static int raw_bind(struct sock *sk, struct sockaddr *uaddr, int addr_len)
669{
670	struct inet_sock *inet = inet_sk(sk);
671	struct sockaddr_in *addr = (struct sockaddr_in *) uaddr;
672	int ret = -EINVAL;
673	int chk_addr_ret;
674
675	if (sk->sk_state != TCP_CLOSE || addr_len < sizeof(struct sockaddr_in))
676		goto out;
677	chk_addr_ret = inet_addr_type(sock_net(sk), addr->sin_addr.s_addr);
678	ret = -EADDRNOTAVAIL;
679	if (addr->sin_addr.s_addr && chk_addr_ret != RTN_LOCAL &&
680	    chk_addr_ret != RTN_MULTICAST && chk_addr_ret != RTN_BROADCAST)
681		goto out;
682	inet->inet_rcv_saddr = inet->inet_saddr = addr->sin_addr.s_addr;
683	if (chk_addr_ret == RTN_MULTICAST || chk_addr_ret == RTN_BROADCAST)
684		inet->inet_saddr = 0;  /* Use device */
685	sk_dst_reset(sk);
686	ret = 0;
687out:	return ret;
688}
689
690/*
691 *	This should be easy, if there is something there
692 *	we return it, otherwise we block.
693 */
694
695static int raw_recvmsg(struct kiocb *iocb, struct sock *sk, struct msghdr *msg,
696		       size_t len, int noblock, int flags, int *addr_len)
697{
698	struct inet_sock *inet = inet_sk(sk);
699	size_t copied = 0;
700	int err = -EOPNOTSUPP;
701	DECLARE_SOCKADDR(struct sockaddr_in *, sin, msg->msg_name);
702	struct sk_buff *skb;
703
704	if (flags & MSG_OOB)
705		goto out;
706
707	if (flags & MSG_ERRQUEUE) {
708		err = ip_recv_error(sk, msg, len, addr_len);
709		goto out;
710	}
711
712	skb = skb_recv_datagram(sk, flags, noblock, &err);
713	if (!skb)
714		goto out;
715
716	copied = skb->len;
717	if (len < copied) {
718		msg->msg_flags |= MSG_TRUNC;
719		copied = len;
720	}
721
722	err = skb_copy_datagram_iovec(skb, 0, msg->msg_iov, copied);
723	if (err)
724		goto done;
725
726	sock_recv_ts_and_drops(msg, sk, skb);
727
728	/* Copy the address. */
729	if (sin) {
730		sin->sin_family = AF_INET;
731		sin->sin_addr.s_addr = ip_hdr(skb)->saddr;
732		sin->sin_port = 0;
733		memset(&sin->sin_zero, 0, sizeof(sin->sin_zero));
734		*addr_len = sizeof(*sin);
735	}
736	if (inet->cmsg_flags)
737		ip_cmsg_recv(msg, skb);
738	if (flags & MSG_TRUNC)
739		copied = skb->len;
740done:
741	skb_free_datagram(sk, skb);
742out:
743	if (err)
744		return err;
745	return copied;
746}
747
748static int raw_init(struct sock *sk)
749{
750	struct raw_sock *rp = raw_sk(sk);
751
752	if (inet_sk(sk)->inet_num == IPPROTO_ICMP)
753		memset(&rp->filter, 0, sizeof(rp->filter));
754	return 0;
755}
756
757static int raw_seticmpfilter(struct sock *sk, char __user *optval, int optlen)
758{
759	if (optlen > sizeof(struct icmp_filter))
760		optlen = sizeof(struct icmp_filter);
761	if (copy_from_user(&raw_sk(sk)->filter, optval, optlen))
762		return -EFAULT;
763	return 0;
764}
765
766static int raw_geticmpfilter(struct sock *sk, char __user *optval, int __user *optlen)
767{
768	int len, ret = -EFAULT;
769
770	if (get_user(len, optlen))
771		goto out;
772	ret = -EINVAL;
773	if (len < 0)
774		goto out;
775	if (len > sizeof(struct icmp_filter))
776		len = sizeof(struct icmp_filter);
777	ret = -EFAULT;
778	if (put_user(len, optlen) ||
779	    copy_to_user(optval, &raw_sk(sk)->filter, len))
780		goto out;
781	ret = 0;
782out:	return ret;
783}
784
785static int do_raw_setsockopt(struct sock *sk, int level, int optname,
786			  char __user *optval, unsigned int optlen)
787{
788	if (optname == ICMP_FILTER) {
789		if (inet_sk(sk)->inet_num != IPPROTO_ICMP)
790			return -EOPNOTSUPP;
791		else
792			return raw_seticmpfilter(sk, optval, optlen);
793	}
794	return -ENOPROTOOPT;
795}
796
797static int raw_setsockopt(struct sock *sk, int level, int optname,
798			  char __user *optval, unsigned int optlen)
799{
800	if (level != SOL_RAW)
801		return ip_setsockopt(sk, level, optname, optval, optlen);
802	return do_raw_setsockopt(sk, level, optname, optval, optlen);
803}
804
805#ifdef CONFIG_COMPAT
806static int compat_raw_setsockopt(struct sock *sk, int level, int optname,
807				 char __user *optval, unsigned int optlen)
808{
809	if (level != SOL_RAW)
810		return compat_ip_setsockopt(sk, level, optname, optval, optlen);
811	return do_raw_setsockopt(sk, level, optname, optval, optlen);
812}
813#endif
814
815static int do_raw_getsockopt(struct sock *sk, int level, int optname,
816			  char __user *optval, int __user *optlen)
817{
818	if (optname == ICMP_FILTER) {
819		if (inet_sk(sk)->inet_num != IPPROTO_ICMP)
820			return -EOPNOTSUPP;
821		else
822			return raw_geticmpfilter(sk, optval, optlen);
823	}
824	return -ENOPROTOOPT;
825}
826
827static int raw_getsockopt(struct sock *sk, int level, int optname,
828			  char __user *optval, int __user *optlen)
829{
830	if (level != SOL_RAW)
831		return ip_getsockopt(sk, level, optname, optval, optlen);
832	return do_raw_getsockopt(sk, level, optname, optval, optlen);
833}
834
835#ifdef CONFIG_COMPAT
836static int compat_raw_getsockopt(struct sock *sk, int level, int optname,
837				 char __user *optval, int __user *optlen)
838{
839	if (level != SOL_RAW)
840		return compat_ip_getsockopt(sk, level, optname, optval, optlen);
841	return do_raw_getsockopt(sk, level, optname, optval, optlen);
842}
843#endif
844
845static int raw_ioctl(struct sock *sk, int cmd, unsigned long arg)
846{
847	switch (cmd) {
848	case SIOCOUTQ: {
849		int amount = sk_wmem_alloc_get(sk);
850
851		return put_user(amount, (int __user *)arg);
852	}
853	case SIOCINQ: {
854		struct sk_buff *skb;
855		int amount = 0;
856
857		spin_lock_bh(&sk->sk_receive_queue.lock);
858		skb = skb_peek(&sk->sk_receive_queue);
859		if (skb != NULL)
860			amount = skb->len;
861		spin_unlock_bh(&sk->sk_receive_queue.lock);
862		return put_user(amount, (int __user *)arg);
863	}
864
865	default:
866#ifdef CONFIG_IP_MROUTE
867		return ipmr_ioctl(sk, cmd, (void __user *)arg);
868#else
869		return -ENOIOCTLCMD;
870#endif
871	}
872}
873
874#ifdef CONFIG_COMPAT
875static int compat_raw_ioctl(struct sock *sk, unsigned int cmd, unsigned long arg)
876{
877	switch (cmd) {
878	case SIOCOUTQ:
879	case SIOCINQ:
880		return -ENOIOCTLCMD;
881	default:
882#ifdef CONFIG_IP_MROUTE
883		return ipmr_compat_ioctl(sk, cmd, compat_ptr(arg));
884#else
885		return -ENOIOCTLCMD;
886#endif
887	}
888}
889#endif
890
891struct proto raw_prot = {
892	.name		   = "RAW",
893	.owner		   = THIS_MODULE,
894	.close		   = raw_close,
895	.destroy	   = raw_destroy,
896	.connect	   = ip4_datagram_connect,
897	.disconnect	   = udp_disconnect,
898	.ioctl		   = raw_ioctl,
899	.init		   = raw_init,
900	.setsockopt	   = raw_setsockopt,
901	.getsockopt	   = raw_getsockopt,
902	.sendmsg	   = raw_sendmsg,
903	.recvmsg	   = raw_recvmsg,
904	.bind		   = raw_bind,
905	.backlog_rcv	   = raw_rcv_skb,
906	.release_cb	   = ip4_datagram_release_cb,
907	.hash		   = raw_hash_sk,
908	.unhash		   = raw_unhash_sk,
909	.obj_size	   = sizeof(struct raw_sock),
910	.h.raw_hash	   = &raw_v4_hashinfo,
911#ifdef CONFIG_COMPAT
912	.compat_setsockopt = compat_raw_setsockopt,
913	.compat_getsockopt = compat_raw_getsockopt,
914	.compat_ioctl	   = compat_raw_ioctl,
915#endif
916};
917
918#ifdef CONFIG_PROC_FS
919static struct sock *raw_get_first(struct seq_file *seq)
920{
921	struct sock *sk;
922	struct raw_iter_state *state = raw_seq_private(seq);
923
924	for (state->bucket = 0; state->bucket < RAW_HTABLE_SIZE;
925			++state->bucket) {
926		sk_for_each(sk, &state->h->ht[state->bucket])
927			if (sock_net(sk) == seq_file_net(seq))
928				goto found;
929	}
930	sk = NULL;
931found:
932	return sk;
933}
934
935static struct sock *raw_get_next(struct seq_file *seq, struct sock *sk)
936{
937	struct raw_iter_state *state = raw_seq_private(seq);
938
939	do {
940		sk = sk_next(sk);
941try_again:
942		;
943	} while (sk && sock_net(sk) != seq_file_net(seq));
944
945	if (!sk && ++state->bucket < RAW_HTABLE_SIZE) {
946		sk = sk_head(&state->h->ht[state->bucket]);
947		goto try_again;
948	}
949	return sk;
950}
951
952static struct sock *raw_get_idx(struct seq_file *seq, loff_t pos)
953{
954	struct sock *sk = raw_get_first(seq);
955
956	if (sk)
957		while (pos && (sk = raw_get_next(seq, sk)) != NULL)
958			--pos;
959	return pos ? NULL : sk;
960}
961
962void *raw_seq_start(struct seq_file *seq, loff_t *pos)
963{
964	struct raw_iter_state *state = raw_seq_private(seq);
965
966	read_lock(&state->h->lock);
967	return *pos ? raw_get_idx(seq, *pos - 1) : SEQ_START_TOKEN;
968}
969EXPORT_SYMBOL_GPL(raw_seq_start);
970
971void *raw_seq_next(struct seq_file *seq, void *v, loff_t *pos)
972{
973	struct sock *sk;
974
975	if (v == SEQ_START_TOKEN)
976		sk = raw_get_first(seq);
977	else
978		sk = raw_get_next(seq, v);
979	++*pos;
980	return sk;
981}
982EXPORT_SYMBOL_GPL(raw_seq_next);
983
984void raw_seq_stop(struct seq_file *seq, void *v)
985{
986	struct raw_iter_state *state = raw_seq_private(seq);
987
988	read_unlock(&state->h->lock);
989}
990EXPORT_SYMBOL_GPL(raw_seq_stop);
991
992static void raw_sock_seq_show(struct seq_file *seq, struct sock *sp, int i)
993{
994	struct inet_sock *inet = inet_sk(sp);
995	__be32 dest = inet->inet_daddr,
996	       src = inet->inet_rcv_saddr;
997	__u16 destp = 0,
998	      srcp  = inet->inet_num;
999
1000	seq_printf(seq, "%4d: %08X:%04X %08X:%04X"
1001		" %02X %08X:%08X %02X:%08lX %08X %5u %8d %lu %d %pK %d\n",
1002		i, src, srcp, dest, destp, sp->sk_state,
1003		sk_wmem_alloc_get(sp),
1004		sk_rmem_alloc_get(sp),
1005		0, 0L, 0,
1006		from_kuid_munged(seq_user_ns(seq), sock_i_uid(sp)),
1007		0, sock_i_ino(sp),
1008		atomic_read(&sp->sk_refcnt), sp, atomic_read(&sp->sk_drops));
1009}
1010
1011static int raw_seq_show(struct seq_file *seq, void *v)
1012{
1013	if (v == SEQ_START_TOKEN)
1014		seq_printf(seq, "  sl  local_address rem_address   st tx_queue "
1015				"rx_queue tr tm->when retrnsmt   uid  timeout "
1016				"inode ref pointer drops\n");
1017	else
1018		raw_sock_seq_show(seq, v, raw_seq_private(seq)->bucket);
1019	return 0;
1020}
1021
1022static const struct seq_operations raw_seq_ops = {
1023	.start = raw_seq_start,
1024	.next  = raw_seq_next,
1025	.stop  = raw_seq_stop,
1026	.show  = raw_seq_show,
1027};
1028
1029int raw_seq_open(struct inode *ino, struct file *file,
1030		 struct raw_hashinfo *h, const struct seq_operations *ops)
1031{
1032	int err;
1033	struct raw_iter_state *i;
1034
1035	err = seq_open_net(ino, file, ops, sizeof(struct raw_iter_state));
1036	if (err < 0)
1037		return err;
1038
1039	i = raw_seq_private((struct seq_file *)file->private_data);
1040	i->h = h;
1041	return 0;
1042}
1043EXPORT_SYMBOL_GPL(raw_seq_open);
1044
1045static int raw_v4_seq_open(struct inode *inode, struct file *file)
1046{
1047	return raw_seq_open(inode, file, &raw_v4_hashinfo, &raw_seq_ops);
1048}
1049
1050static const struct file_operations raw_seq_fops = {
1051	.owner	 = THIS_MODULE,
1052	.open	 = raw_v4_seq_open,
1053	.read	 = seq_read,
1054	.llseek	 = seq_lseek,
1055	.release = seq_release_net,
1056};
1057
1058static __net_init int raw_init_net(struct net *net)
1059{
1060	if (!proc_create("raw", S_IRUGO, net->proc_net, &raw_seq_fops))
1061		return -ENOMEM;
1062
1063	return 0;
1064}
1065
1066static __net_exit void raw_exit_net(struct net *net)
1067{
1068	remove_proc_entry("raw", net->proc_net);
1069}
1070
1071static __net_initdata struct pernet_operations raw_net_ops = {
1072	.init = raw_init_net,
1073	.exit = raw_exit_net,
1074};
1075
1076int __init raw_proc_init(void)
1077{
1078	return register_pernet_subsys(&raw_net_ops);
1079}
1080
1081void __init raw_proc_exit(void)
1082{
1083	unregister_pernet_subsys(&raw_net_ops);
1084}
1085#endif /* CONFIG_PROC_FS */
1086