xref: /openbmc/linux/net/ipv4/ip_output.c (revision ede2059dbaf9c6557a49d466c8c7778343b208ff)
11da177e4SLinus Torvalds /*
21da177e4SLinus Torvalds  * INET		An implementation of the TCP/IP protocol suite for the LINUX
31da177e4SLinus Torvalds  *		operating system.  INET is implemented using the  BSD Socket
41da177e4SLinus Torvalds  *		interface as the means of communication with the user level.
51da177e4SLinus Torvalds  *
61da177e4SLinus Torvalds  *		The Internet Protocol (IP) output module.
71da177e4SLinus Torvalds  *
802c30a84SJesper Juhl  * Authors:	Ross Biro
91da177e4SLinus Torvalds  *		Fred N. van Kempen, <waltje@uWalt.NL.Mugnet.ORG>
101da177e4SLinus Torvalds  *		Donald Becker, <becker@super.org>
111da177e4SLinus Torvalds  *		Alan Cox, <Alan.Cox@linux.org>
121da177e4SLinus Torvalds  *		Richard Underwood
131da177e4SLinus Torvalds  *		Stefan Becker, <stefanb@yello.ping.de>
141da177e4SLinus Torvalds  *		Jorge Cwik, <jorge@laser.satlink.net>
151da177e4SLinus Torvalds  *		Arnt Gulbrandsen, <agulbra@nvg.unit.no>
161da177e4SLinus Torvalds  *		Hirokazu Takahashi, <taka@valinux.co.jp>
171da177e4SLinus Torvalds  *
181da177e4SLinus Torvalds  *	See ip_input.c for original log
191da177e4SLinus Torvalds  *
201da177e4SLinus Torvalds  *	Fixes:
211da177e4SLinus Torvalds  *		Alan Cox	:	Missing nonblock feature in ip_build_xmit.
221da177e4SLinus Torvalds  *		Mike Kilburn	:	htons() missing in ip_build_xmit.
231da177e4SLinus Torvalds  *		Bradford Johnson:	Fix faulty handling of some frames when
241da177e4SLinus Torvalds  *					no route is found.
251da177e4SLinus Torvalds  *		Alexander Demenshin:	Missing sk/skb free in ip_queue_xmit
261da177e4SLinus Torvalds  *					(in case if packet not accepted by
271da177e4SLinus Torvalds  *					output firewall rules)
281da177e4SLinus Torvalds  *		Mike McLagan	:	Routing by source
291da177e4SLinus Torvalds  *		Alexey Kuznetsov:	use new route cache
301da177e4SLinus Torvalds  *		Andi Kleen:		Fix broken PMTU recovery and remove
311da177e4SLinus Torvalds  *					some redundant tests.
321da177e4SLinus Torvalds  *	Vitaly E. Lavrov	:	Transparent proxy revived after year coma.
331da177e4SLinus Torvalds  *		Andi Kleen	: 	Replace ip_reply with ip_send_reply.
341da177e4SLinus Torvalds  *		Andi Kleen	:	Split fast and slow ip_build_xmit path
351da177e4SLinus Torvalds  *					for decreased register pressure on x86
361da177e4SLinus Torvalds  *					and more readibility.
371da177e4SLinus Torvalds  *		Marc Boucher	:	When call_out_firewall returns FW_QUEUE,
381da177e4SLinus Torvalds  *					silently drop skb instead of failing with -EPERM.
391da177e4SLinus Torvalds  *		Detlev Wengorz	:	Copy protocol for fragments.
401da177e4SLinus Torvalds  *		Hirokazu Takahashi:	HW checksumming for outgoing UDP
411da177e4SLinus Torvalds  *					datagrams.
421da177e4SLinus Torvalds  *		Hirokazu Takahashi:	sendfile() on UDP works now.
431da177e4SLinus Torvalds  */
441da177e4SLinus Torvalds 
451da177e4SLinus Torvalds #include <asm/uaccess.h>
461da177e4SLinus Torvalds #include <linux/module.h>
471da177e4SLinus Torvalds #include <linux/types.h>
481da177e4SLinus Torvalds #include <linux/kernel.h>
491da177e4SLinus Torvalds #include <linux/mm.h>
501da177e4SLinus Torvalds #include <linux/string.h>
511da177e4SLinus Torvalds #include <linux/errno.h>
52a1f8e7f7SAl Viro #include <linux/highmem.h>
535a0e3ad6STejun Heo #include <linux/slab.h>
541da177e4SLinus Torvalds 
551da177e4SLinus Torvalds #include <linux/socket.h>
561da177e4SLinus Torvalds #include <linux/sockios.h>
571da177e4SLinus Torvalds #include <linux/in.h>
581da177e4SLinus Torvalds #include <linux/inet.h>
591da177e4SLinus Torvalds #include <linux/netdevice.h>
601da177e4SLinus Torvalds #include <linux/etherdevice.h>
611da177e4SLinus Torvalds #include <linux/proc_fs.h>
621da177e4SLinus Torvalds #include <linux/stat.h>
631da177e4SLinus Torvalds #include <linux/init.h>
641da177e4SLinus Torvalds 
651da177e4SLinus Torvalds #include <net/snmp.h>
661da177e4SLinus Torvalds #include <net/ip.h>
671da177e4SLinus Torvalds #include <net/protocol.h>
681da177e4SLinus Torvalds #include <net/route.h>
69cfacb057SPatrick McHardy #include <net/xfrm.h>
701da177e4SLinus Torvalds #include <linux/skbuff.h>
711da177e4SLinus Torvalds #include <net/sock.h>
721da177e4SLinus Torvalds #include <net/arp.h>
731da177e4SLinus Torvalds #include <net/icmp.h>
741da177e4SLinus Torvalds #include <net/checksum.h>
751da177e4SLinus Torvalds #include <net/inetpeer.h>
761da177e4SLinus Torvalds #include <linux/igmp.h>
771da177e4SLinus Torvalds #include <linux/netfilter_ipv4.h>
781da177e4SLinus Torvalds #include <linux/netfilter_bridge.h>
791da177e4SLinus Torvalds #include <linux/mroute.h>
801da177e4SLinus Torvalds #include <linux/netlink.h>
816cbb0df7SArnaldo Carvalho de Melo #include <linux/tcp.h>
821da177e4SLinus Torvalds 
83ab32ea5dSBrian Haley int sysctl_ip_default_ttl __read_mostly = IPDEFTTL;
84323e126fSDavid S. Miller EXPORT_SYMBOL(sysctl_ip_default_ttl);
851da177e4SLinus Torvalds 
86694869b3SEric W. Biederman static int
87694869b3SEric W. Biederman ip_fragment(struct net *net, struct sock *sk, struct sk_buff *skb,
88c5501eb3SFlorian Westphal 	    unsigned int mtu,
89694869b3SEric W. Biederman 	    int (*output)(struct net *, struct sock *, struct sk_buff *));
9049d16b23SAndy Zhou 
911da177e4SLinus Torvalds /* Generate a checksum for an outgoing IP datagram. */
922fbd9679SDenis Efremov void ip_send_check(struct iphdr *iph)
931da177e4SLinus Torvalds {
941da177e4SLinus Torvalds 	iph->check = 0;
951da177e4SLinus Torvalds 	iph->check = ip_fast_csum((unsigned char *)iph, iph->ihl);
961da177e4SLinus Torvalds }
974bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_send_check);
981da177e4SLinus Torvalds 
99cf91a99dSEric W. Biederman int __ip_local_out(struct net *net, struct sock *sk, struct sk_buff *skb)
100c439cb2eSHerbert Xu {
101c439cb2eSHerbert Xu 	struct iphdr *iph = ip_hdr(skb);
102c439cb2eSHerbert Xu 
103c439cb2eSHerbert Xu 	iph->tot_len = htons(skb->len);
104c439cb2eSHerbert Xu 	ip_send_check(iph);
10529a26a56SEric W. Biederman 	return nf_hook(NFPROTO_IPV4, NF_INET_LOCAL_OUT,
10629a26a56SEric W. Biederman 		       net, sk, skb, NULL, skb_dst(skb)->dev,
10713206b6bSEric W. Biederman 		       dst_output);
1087026b1ddSDavid Miller }
1097026b1ddSDavid Miller 
11033224b16SEric W. Biederman int ip_local_out(struct net *net, struct sock *sk, struct sk_buff *skb)
111c439cb2eSHerbert Xu {
112c439cb2eSHerbert Xu 	int err;
113c439cb2eSHerbert Xu 
114cf91a99dSEric W. Biederman 	err = __ip_local_out(net, sk, skb);
115c439cb2eSHerbert Xu 	if (likely(err == 1))
11613206b6bSEric W. Biederman 		err = dst_output(net, sk, skb);
117c439cb2eSHerbert Xu 
118c439cb2eSHerbert Xu 	return err;
119c439cb2eSHerbert Xu }
120e2cb77dbSEric W. Biederman EXPORT_SYMBOL_GPL(ip_local_out);
121c439cb2eSHerbert Xu 
1221da177e4SLinus Torvalds static inline int ip_select_ttl(struct inet_sock *inet, struct dst_entry *dst)
1231da177e4SLinus Torvalds {
1241da177e4SLinus Torvalds 	int ttl = inet->uc_ttl;
1251da177e4SLinus Torvalds 
1261da177e4SLinus Torvalds 	if (ttl < 0)
127323e126fSDavid S. Miller 		ttl = ip4_dst_hoplimit(dst);
1281da177e4SLinus Torvalds 	return ttl;
1291da177e4SLinus Torvalds }
1301da177e4SLinus Torvalds 
1311da177e4SLinus Torvalds /*
1321da177e4SLinus Torvalds  *		Add an ip header to a skbuff and send it out.
1331da177e4SLinus Torvalds  *
1341da177e4SLinus Torvalds  */
135cfe673b0SEric Dumazet int ip_build_and_send_pkt(struct sk_buff *skb, const struct sock *sk,
136f6d8bd05SEric Dumazet 			  __be32 saddr, __be32 daddr, struct ip_options_rcu *opt)
1371da177e4SLinus Torvalds {
1381da177e4SLinus Torvalds 	struct inet_sock *inet = inet_sk(sk);
139511c3f92SEric Dumazet 	struct rtable *rt = skb_rtable(skb);
14077589ce0SEric W. Biederman 	struct net *net = sock_net(sk);
1411da177e4SLinus Torvalds 	struct iphdr *iph;
1421da177e4SLinus Torvalds 
1431da177e4SLinus Torvalds 	/* Build the IP header. */
144f6d8bd05SEric Dumazet 	skb_push(skb, sizeof(struct iphdr) + (opt ? opt->opt.optlen : 0));
1458856dfa3SArnaldo Carvalho de Melo 	skb_reset_network_header(skb);
146eddc9ec5SArnaldo Carvalho de Melo 	iph = ip_hdr(skb);
1471da177e4SLinus Torvalds 	iph->version  = 4;
1481da177e4SLinus Torvalds 	iph->ihl      = 5;
1491da177e4SLinus Torvalds 	iph->tos      = inet->tos;
150d8d1f30bSChangli Gao 	iph->ttl      = ip_select_ttl(inet, &rt->dst);
151dd927a26SDavid S. Miller 	iph->daddr    = (opt && opt->opt.srr ? opt->opt.faddr : daddr);
152dd927a26SDavid S. Miller 	iph->saddr    = saddr;
1531da177e4SLinus Torvalds 	iph->protocol = sk->sk_protocol;
154cfe673b0SEric Dumazet 	if (ip_dont_fragment(sk, &rt->dst)) {
155cfe673b0SEric Dumazet 		iph->frag_off = htons(IP_DF);
156cfe673b0SEric Dumazet 		iph->id = 0;
157cfe673b0SEric Dumazet 	} else {
158cfe673b0SEric Dumazet 		iph->frag_off = 0;
15977589ce0SEric W. Biederman 		__ip_select_ident(net, iph, 1);
160cfe673b0SEric Dumazet 	}
1611da177e4SLinus Torvalds 
162f6d8bd05SEric Dumazet 	if (opt && opt->opt.optlen) {
163f6d8bd05SEric Dumazet 		iph->ihl += opt->opt.optlen>>2;
164f6d8bd05SEric Dumazet 		ip_options_build(skb, &opt->opt, daddr, rt, 0);
1651da177e4SLinus Torvalds 	}
1661da177e4SLinus Torvalds 
1671da177e4SLinus Torvalds 	skb->priority = sk->sk_priority;
1684a19ec58SLaszlo Attila Toth 	skb->mark = sk->sk_mark;
1691da177e4SLinus Torvalds 
1701da177e4SLinus Torvalds 	/* Send it out. */
17133224b16SEric W. Biederman 	return ip_local_out(net, skb->sk, skb);
1721da177e4SLinus Torvalds }
173d8c97a94SArnaldo Carvalho de Melo EXPORT_SYMBOL_GPL(ip_build_and_send_pkt);
174d8c97a94SArnaldo Carvalho de Melo 
175694869b3SEric W. Biederman static int ip_finish_output2(struct net *net, struct sock *sk, struct sk_buff *skb)
1761da177e4SLinus Torvalds {
177adf30907SEric Dumazet 	struct dst_entry *dst = skb_dst(skb);
17880787ebcSMitsuru Chinen 	struct rtable *rt = (struct rtable *)dst;
1791da177e4SLinus Torvalds 	struct net_device *dev = dst->dev;
180c2636b4dSChuck Lever 	unsigned int hh_len = LL_RESERVED_SPACE(dev);
181f6b72b62SDavid S. Miller 	struct neighbour *neigh;
182a263b309SDavid S. Miller 	u32 nexthop;
1831da177e4SLinus Torvalds 
184edf391ffSNeil Horman 	if (rt->rt_type == RTN_MULTICAST) {
1854ba1bf42SEric W. Biederman 		IP_UPD_PO_STATS(net, IPSTATS_MIB_OUTMCAST, skb->len);
186edf391ffSNeil Horman 	} else if (rt->rt_type == RTN_BROADCAST)
1874ba1bf42SEric W. Biederman 		IP_UPD_PO_STATS(net, IPSTATS_MIB_OUTBCAST, skb->len);
18880787ebcSMitsuru Chinen 
1891da177e4SLinus Torvalds 	/* Be paranoid, rather than too clever. */
1903b04dddeSStephen Hemminger 	if (unlikely(skb_headroom(skb) < hh_len && dev->header_ops)) {
1911da177e4SLinus Torvalds 		struct sk_buff *skb2;
1921da177e4SLinus Torvalds 
1931da177e4SLinus Torvalds 		skb2 = skb_realloc_headroom(skb, LL_RESERVED_SPACE(dev));
19451456b29SIan Morris 		if (!skb2) {
1951da177e4SLinus Torvalds 			kfree_skb(skb);
1961da177e4SLinus Torvalds 			return -ENOMEM;
1971da177e4SLinus Torvalds 		}
1981da177e4SLinus Torvalds 		if (skb->sk)
1991da177e4SLinus Torvalds 			skb_set_owner_w(skb2, skb->sk);
2005d0ba55bSEric Dumazet 		consume_skb(skb);
2011da177e4SLinus Torvalds 		skb = skb2;
2021da177e4SLinus Torvalds 	}
2031da177e4SLinus Torvalds 
204a263b309SDavid S. Miller 	rcu_read_lock_bh();
205155e8336SJulian Anastasov 	nexthop = (__force u32) rt_nexthop(rt, ip_hdr(skb)->daddr);
206a263b309SDavid S. Miller 	neigh = __ipv4_neigh_lookup_noref(dev, nexthop);
207a263b309SDavid S. Miller 	if (unlikely(!neigh))
208a263b309SDavid S. Miller 		neigh = __neigh_create(&arp_tbl, &nexthop, dev, false);
2099871f1adSVasiliy Kulikov 	if (!IS_ERR(neigh)) {
2105110effeSDavid S. Miller 		int res = dst_neigh_output(dst, neigh, skb);
211f2c31e32SEric Dumazet 
212a263b309SDavid S. Miller 		rcu_read_unlock_bh();
213f2c31e32SEric Dumazet 		return res;
214f2c31e32SEric Dumazet 	}
215a263b309SDavid S. Miller 	rcu_read_unlock_bh();
21605e3aa09SDavid S. Miller 
217e87cc472SJoe Perches 	net_dbg_ratelimited("%s: No header cache and no neighbour!\n",
218e87cc472SJoe Perches 			    __func__);
2191da177e4SLinus Torvalds 	kfree_skb(skb);
2201da177e4SLinus Torvalds 	return -EINVAL;
2211da177e4SLinus Torvalds }
2221da177e4SLinus Torvalds 
223694869b3SEric W. Biederman static int ip_finish_output_gso(struct net *net, struct sock *sk,
224694869b3SEric W. Biederman 				struct sk_buff *skb, unsigned int mtu)
225c7ba65d7SFlorian Westphal {
226c7ba65d7SFlorian Westphal 	netdev_features_t features;
227c7ba65d7SFlorian Westphal 	struct sk_buff *segs;
228c7ba65d7SFlorian Westphal 	int ret = 0;
229c7ba65d7SFlorian Westphal 
230c7ba65d7SFlorian Westphal 	/* common case: locally created skb or seglen is <= mtu */
231c7ba65d7SFlorian Westphal 	if (((IPCB(skb)->flags & IPSKB_FORWARDED) == 0) ||
232c5501eb3SFlorian Westphal 	      skb_gso_network_seglen(skb) <= mtu)
233694869b3SEric W. Biederman 		return ip_finish_output2(net, sk, skb);
234c7ba65d7SFlorian Westphal 
235c7ba65d7SFlorian Westphal 	/* Slowpath -  GSO segment length is exceeding the dst MTU.
236c7ba65d7SFlorian Westphal 	 *
237c7ba65d7SFlorian Westphal 	 * This can happen in two cases:
238c7ba65d7SFlorian Westphal 	 * 1) TCP GRO packet, DF bit not set
239c7ba65d7SFlorian Westphal 	 * 2) skb arrived via virtio-net, we thus get TSO/GSO skbs directly
240c7ba65d7SFlorian Westphal 	 * from host network stack.
241c7ba65d7SFlorian Westphal 	 */
242c7ba65d7SFlorian Westphal 	features = netif_skb_features(skb);
243c7ba65d7SFlorian Westphal 	segs = skb_gso_segment(skb, features & ~NETIF_F_GSO_MASK);
244330966e5SFlorian Westphal 	if (IS_ERR_OR_NULL(segs)) {
245c7ba65d7SFlorian Westphal 		kfree_skb(skb);
246c7ba65d7SFlorian Westphal 		return -ENOMEM;
247c7ba65d7SFlorian Westphal 	}
248c7ba65d7SFlorian Westphal 
249c7ba65d7SFlorian Westphal 	consume_skb(skb);
250c7ba65d7SFlorian Westphal 
251c7ba65d7SFlorian Westphal 	do {
252c7ba65d7SFlorian Westphal 		struct sk_buff *nskb = segs->next;
253c7ba65d7SFlorian Westphal 		int err;
254c7ba65d7SFlorian Westphal 
255c7ba65d7SFlorian Westphal 		segs->next = NULL;
256694869b3SEric W. Biederman 		err = ip_fragment(net, sk, segs, mtu, ip_finish_output2);
257c7ba65d7SFlorian Westphal 
258c7ba65d7SFlorian Westphal 		if (err && ret == 0)
259c7ba65d7SFlorian Westphal 			ret = err;
260c7ba65d7SFlorian Westphal 		segs = nskb;
261c7ba65d7SFlorian Westphal 	} while (segs);
262c7ba65d7SFlorian Westphal 
263c7ba65d7SFlorian Westphal 	return ret;
264c7ba65d7SFlorian Westphal }
265c7ba65d7SFlorian Westphal 
2660c4b51f0SEric W. Biederman static int ip_finish_output(struct net *net, struct sock *sk, struct sk_buff *skb)
2671da177e4SLinus Torvalds {
268c5501eb3SFlorian Westphal 	unsigned int mtu;
269c5501eb3SFlorian Westphal 
2705c901daaSPatrick McHardy #if defined(CONFIG_NETFILTER) && defined(CONFIG_XFRM)
2715c901daaSPatrick McHardy 	/* Policy lookup after SNAT yielded a new policy */
27200db4124SIan Morris 	if (skb_dst(skb)->xfrm) {
27348d5cad8SPatrick McHardy 		IPCB(skb)->flags |= IPSKB_REROUTED;
27413206b6bSEric W. Biederman 		return dst_output(net, sk, skb);
27548d5cad8SPatrick McHardy 	}
2765c901daaSPatrick McHardy #endif
277c5501eb3SFlorian Westphal 	mtu = ip_skb_dst_mtu(skb);
278c7ba65d7SFlorian Westphal 	if (skb_is_gso(skb))
279694869b3SEric W. Biederman 		return ip_finish_output_gso(net, sk, skb, mtu);
280c7ba65d7SFlorian Westphal 
281d6b915e2SFlorian Westphal 	if (skb->len > mtu || (IPCB(skb)->flags & IPSKB_FRAG_PMTU))
282694869b3SEric W. Biederman 		return ip_fragment(net, sk, skb, mtu, ip_finish_output2);
283c7ba65d7SFlorian Westphal 
284694869b3SEric W. Biederman 	return ip_finish_output2(net, sk, skb);
2851da177e4SLinus Torvalds }
2861da177e4SLinus Torvalds 
287*ede2059dSEric W. Biederman int ip_mc_output(struct net *net, struct sock *sk, struct sk_buff *skb)
2881da177e4SLinus Torvalds {
289511c3f92SEric Dumazet 	struct rtable *rt = skb_rtable(skb);
290d8d1f30bSChangli Gao 	struct net_device *dev = rt->dst.dev;
2911da177e4SLinus Torvalds 
2921da177e4SLinus Torvalds 	/*
2931da177e4SLinus Torvalds 	 *	If the indicated interface is up and running, send the packet.
2941da177e4SLinus Torvalds 	 */
29588f5cc24SEric W. Biederman 	IP_UPD_PO_STATS(net, IPSTATS_MIB_OUT, skb->len);
2961da177e4SLinus Torvalds 
2971da177e4SLinus Torvalds 	skb->dev = dev;
2981da177e4SLinus Torvalds 	skb->protocol = htons(ETH_P_IP);
2991da177e4SLinus Torvalds 
3001da177e4SLinus Torvalds 	/*
3011da177e4SLinus Torvalds 	 *	Multicasts are looped back for other local users
3021da177e4SLinus Torvalds 	 */
3031da177e4SLinus Torvalds 
3041da177e4SLinus Torvalds 	if (rt->rt_flags&RTCF_MULTICAST) {
3057ad6848cSOctavian Purdila 		if (sk_mc_loop(sk)
3061da177e4SLinus Torvalds #ifdef CONFIG_IP_MROUTE
3071da177e4SLinus Torvalds 		/* Small optimization: do not loopback not local frames,
3081da177e4SLinus Torvalds 		   which returned after forwarding; they will be  dropped
3091da177e4SLinus Torvalds 		   by ip_mr_input in any case.
3101da177e4SLinus Torvalds 		   Note, that local frames are looped back to be delivered
3111da177e4SLinus Torvalds 		   to local recipients.
3121da177e4SLinus Torvalds 
3131da177e4SLinus Torvalds 		   This check is duplicated in ip_mr_input at the moment.
3141da177e4SLinus Torvalds 		 */
3159d4fb27dSJoe Perches 		    &&
3169d4fb27dSJoe Perches 		    ((rt->rt_flags & RTCF_LOCAL) ||
3179d4fb27dSJoe Perches 		     !(IPCB(skb)->flags & IPSKB_FORWARDED))
3181da177e4SLinus Torvalds #endif
3191da177e4SLinus Torvalds 		   ) {
3201da177e4SLinus Torvalds 			struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC);
3211da177e4SLinus Torvalds 			if (newskb)
3229bbc768aSJan Engelhardt 				NF_HOOK(NFPROTO_IPV4, NF_INET_POST_ROUTING,
32329a26a56SEric W. Biederman 					net, sk, newskb, NULL, newskb->dev,
32495603e22SMichel Machado 					dev_loopback_xmit);
3251da177e4SLinus Torvalds 		}
3261da177e4SLinus Torvalds 
3271da177e4SLinus Torvalds 		/* Multicasts with ttl 0 must not go beyond the host */
3281da177e4SLinus Torvalds 
329eddc9ec5SArnaldo Carvalho de Melo 		if (ip_hdr(skb)->ttl == 0) {
3301da177e4SLinus Torvalds 			kfree_skb(skb);
3311da177e4SLinus Torvalds 			return 0;
3321da177e4SLinus Torvalds 		}
3331da177e4SLinus Torvalds 	}
3341da177e4SLinus Torvalds 
3351da177e4SLinus Torvalds 	if (rt->rt_flags&RTCF_BROADCAST) {
3361da177e4SLinus Torvalds 		struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC);
3371da177e4SLinus Torvalds 		if (newskb)
33829a26a56SEric W. Biederman 			NF_HOOK(NFPROTO_IPV4, NF_INET_POST_ROUTING,
33929a26a56SEric W. Biederman 				net, sk, newskb, NULL, newskb->dev,
34029a26a56SEric W. Biederman 				dev_loopback_xmit);
3411da177e4SLinus Torvalds 	}
3421da177e4SLinus Torvalds 
34329a26a56SEric W. Biederman 	return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING,
34429a26a56SEric W. Biederman 			    net, sk, skb, NULL, skb->dev,
34529a26a56SEric W. Biederman 			    ip_finish_output,
34648d5cad8SPatrick McHardy 			    !(IPCB(skb)->flags & IPSKB_REROUTED));
3471da177e4SLinus Torvalds }
3481da177e4SLinus Torvalds 
349*ede2059dSEric W. Biederman int ip_output(struct net *net, struct sock *sk, struct sk_buff *skb)
3501da177e4SLinus Torvalds {
351adf30907SEric Dumazet 	struct net_device *dev = skb_dst(skb)->dev;
3521bd9bef6SPatrick McHardy 
35388f5cc24SEric W. Biederman 	IP_UPD_PO_STATS(net, IPSTATS_MIB_OUT, skb->len);
3541da177e4SLinus Torvalds 
3551bd9bef6SPatrick McHardy 	skb->dev = dev;
3561bd9bef6SPatrick McHardy 	skb->protocol = htons(ETH_P_IP);
3571bd9bef6SPatrick McHardy 
35829a26a56SEric W. Biederman 	return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING,
35929a26a56SEric W. Biederman 			    net, sk, skb, NULL, dev,
36048d5cad8SPatrick McHardy 			    ip_finish_output,
36148d5cad8SPatrick McHardy 			    !(IPCB(skb)->flags & IPSKB_REROUTED));
3621da177e4SLinus Torvalds }
3631da177e4SLinus Torvalds 
36484f9307cSEric Dumazet /*
36584f9307cSEric Dumazet  * copy saddr and daddr, possibly using 64bit load/stores
36684f9307cSEric Dumazet  * Equivalent to :
36784f9307cSEric Dumazet  *   iph->saddr = fl4->saddr;
36884f9307cSEric Dumazet  *   iph->daddr = fl4->daddr;
36984f9307cSEric Dumazet  */
37084f9307cSEric Dumazet static void ip_copy_addrs(struct iphdr *iph, const struct flowi4 *fl4)
37184f9307cSEric Dumazet {
37284f9307cSEric Dumazet 	BUILD_BUG_ON(offsetof(typeof(*fl4), daddr) !=
37384f9307cSEric Dumazet 		     offsetof(typeof(*fl4), saddr) + sizeof(fl4->saddr));
37484f9307cSEric Dumazet 	memcpy(&iph->saddr, &fl4->saddr,
37584f9307cSEric Dumazet 	       sizeof(fl4->saddr) + sizeof(fl4->daddr));
37684f9307cSEric Dumazet }
37784f9307cSEric Dumazet 
378b0270e91SEric Dumazet /* Note: skb->sk can be different from sk, in case of tunnels */
379b0270e91SEric Dumazet int ip_queue_xmit(struct sock *sk, struct sk_buff *skb, struct flowi *fl)
3801da177e4SLinus Torvalds {
3811da177e4SLinus Torvalds 	struct inet_sock *inet = inet_sk(sk);
38277589ce0SEric W. Biederman 	struct net *net = sock_net(sk);
383f6d8bd05SEric Dumazet 	struct ip_options_rcu *inet_opt;
384b57ae01aSDavid S. Miller 	struct flowi4 *fl4;
3851da177e4SLinus Torvalds 	struct rtable *rt;
3861da177e4SLinus Torvalds 	struct iphdr *iph;
387ab6e3febSEric Dumazet 	int res;
3881da177e4SLinus Torvalds 
3891da177e4SLinus Torvalds 	/* Skip all of this if the packet is already routed,
3901da177e4SLinus Torvalds 	 * f.e. by something like SCTP.
3911da177e4SLinus Torvalds 	 */
392ab6e3febSEric Dumazet 	rcu_read_lock();
393f6d8bd05SEric Dumazet 	inet_opt = rcu_dereference(inet->inet_opt);
394ea4fc0d6SDavid S. Miller 	fl4 = &fl->u.ip4;
395511c3f92SEric Dumazet 	rt = skb_rtable(skb);
39600db4124SIan Morris 	if (rt)
3971da177e4SLinus Torvalds 		goto packet_routed;
3981da177e4SLinus Torvalds 
3991da177e4SLinus Torvalds 	/* Make sure we can route this packet. */
4001da177e4SLinus Torvalds 	rt = (struct rtable *)__sk_dst_check(sk, 0);
40151456b29SIan Morris 	if (!rt) {
4023ca3c68eSAl Viro 		__be32 daddr;
4031da177e4SLinus Torvalds 
4041da177e4SLinus Torvalds 		/* Use correct destination address if we have options. */
405c720c7e8SEric Dumazet 		daddr = inet->inet_daddr;
406f6d8bd05SEric Dumazet 		if (inet_opt && inet_opt->opt.srr)
407f6d8bd05SEric Dumazet 			daddr = inet_opt->opt.faddr;
4081da177e4SLinus Torvalds 
4091da177e4SLinus Torvalds 		/* If this fails, retransmit mechanism of transport layer will
4101da177e4SLinus Torvalds 		 * keep trying until route appears or the connection times
4111da177e4SLinus Torvalds 		 * itself out.
4121da177e4SLinus Torvalds 		 */
41377589ce0SEric W. Biederman 		rt = ip_route_output_ports(net, fl4, sk,
41478fbfd8aSDavid S. Miller 					   daddr, inet->inet_saddr,
41578fbfd8aSDavid S. Miller 					   inet->inet_dport,
41678fbfd8aSDavid S. Miller 					   inet->inet_sport,
41778fbfd8aSDavid S. Miller 					   sk->sk_protocol,
41878fbfd8aSDavid S. Miller 					   RT_CONN_FLAGS(sk),
41978fbfd8aSDavid S. Miller 					   sk->sk_bound_dev_if);
420b23dd4feSDavid S. Miller 		if (IS_ERR(rt))
4211da177e4SLinus Torvalds 			goto no_route;
422d8d1f30bSChangli Gao 		sk_setup_caps(sk, &rt->dst);
4231da177e4SLinus Torvalds 	}
424d8d1f30bSChangli Gao 	skb_dst_set_noref(skb, &rt->dst);
4251da177e4SLinus Torvalds 
4261da177e4SLinus Torvalds packet_routed:
427155e8336SJulian Anastasov 	if (inet_opt && inet_opt->opt.is_strictroute && rt->rt_uses_gateway)
4281da177e4SLinus Torvalds 		goto no_route;
4291da177e4SLinus Torvalds 
4301da177e4SLinus Torvalds 	/* OK, we know where to send it, allocate and build IP header. */
431f6d8bd05SEric Dumazet 	skb_push(skb, sizeof(struct iphdr) + (inet_opt ? inet_opt->opt.optlen : 0));
4328856dfa3SArnaldo Carvalho de Melo 	skb_reset_network_header(skb);
433eddc9ec5SArnaldo Carvalho de Melo 	iph = ip_hdr(skb);
434714e85beSAl Viro 	*((__be16 *)iph) = htons((4 << 12) | (5 << 8) | (inet->tos & 0xff));
43560ff7467SWANG Cong 	if (ip_dont_fragment(sk, &rt->dst) && !skb->ignore_df)
4361da177e4SLinus Torvalds 		iph->frag_off = htons(IP_DF);
4371da177e4SLinus Torvalds 	else
4381da177e4SLinus Torvalds 		iph->frag_off = 0;
439d8d1f30bSChangli Gao 	iph->ttl      = ip_select_ttl(inet, &rt->dst);
4401da177e4SLinus Torvalds 	iph->protocol = sk->sk_protocol;
44184f9307cSEric Dumazet 	ip_copy_addrs(iph, fl4);
44284f9307cSEric Dumazet 
4431da177e4SLinus Torvalds 	/* Transport layer set skb->h.foo itself. */
4441da177e4SLinus Torvalds 
445f6d8bd05SEric Dumazet 	if (inet_opt && inet_opt->opt.optlen) {
446f6d8bd05SEric Dumazet 		iph->ihl += inet_opt->opt.optlen >> 2;
447f6d8bd05SEric Dumazet 		ip_options_build(skb, &inet_opt->opt, inet->inet_daddr, rt, 0);
4481da177e4SLinus Torvalds 	}
4491da177e4SLinus Torvalds 
45077589ce0SEric W. Biederman 	ip_select_ident_segs(net, skb, sk,
451b6a7719aSHannes Frederic Sowa 			     skb_shinfo(skb)->gso_segs ?: 1);
4521da177e4SLinus Torvalds 
453b0270e91SEric Dumazet 	/* TODO : should we use skb->sk here instead of sk ? */
4541da177e4SLinus Torvalds 	skb->priority = sk->sk_priority;
4554a19ec58SLaszlo Attila Toth 	skb->mark = sk->sk_mark;
4561da177e4SLinus Torvalds 
45733224b16SEric W. Biederman 	res = ip_local_out(net, sk, skb);
458ab6e3febSEric Dumazet 	rcu_read_unlock();
459ab6e3febSEric Dumazet 	return res;
4601da177e4SLinus Torvalds 
4611da177e4SLinus Torvalds no_route:
462ab6e3febSEric Dumazet 	rcu_read_unlock();
46377589ce0SEric W. Biederman 	IP_INC_STATS(net, IPSTATS_MIB_OUTNOROUTES);
4641da177e4SLinus Torvalds 	kfree_skb(skb);
4651da177e4SLinus Torvalds 	return -EHOSTUNREACH;
4661da177e4SLinus Torvalds }
4674bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_queue_xmit);
4681da177e4SLinus Torvalds 
4691da177e4SLinus Torvalds static void ip_copy_metadata(struct sk_buff *to, struct sk_buff *from)
4701da177e4SLinus Torvalds {
4711da177e4SLinus Torvalds 	to->pkt_type = from->pkt_type;
4721da177e4SLinus Torvalds 	to->priority = from->priority;
4731da177e4SLinus Torvalds 	to->protocol = from->protocol;
474adf30907SEric Dumazet 	skb_dst_drop(to);
475fe76cda3SEric Dumazet 	skb_dst_copy(to, from);
4761da177e4SLinus Torvalds 	to->dev = from->dev;
47782e91ffeSThomas Graf 	to->mark = from->mark;
4781da177e4SLinus Torvalds 
4791da177e4SLinus Torvalds 	/* Copy the flags to each fragment. */
4801da177e4SLinus Torvalds 	IPCB(to)->flags = IPCB(from)->flags;
4811da177e4SLinus Torvalds 
4821da177e4SLinus Torvalds #ifdef CONFIG_NET_SCHED
4831da177e4SLinus Torvalds 	to->tc_index = from->tc_index;
4841da177e4SLinus Torvalds #endif
485e7ac05f3SYasuyuki Kozakai 	nf_copy(to, from);
486c98d80edSJulian Anastasov #if defined(CONFIG_IP_VS) || defined(CONFIG_IP_VS_MODULE)
487c98d80edSJulian Anastasov 	to->ipvs_property = from->ipvs_property;
488c98d80edSJulian Anastasov #endif
489984bc16cSJames Morris 	skb_copy_secmark(to, from);
4901da177e4SLinus Torvalds }
4911da177e4SLinus Torvalds 
492694869b3SEric W. Biederman static int ip_fragment(struct net *net, struct sock *sk, struct sk_buff *skb,
493c5501eb3SFlorian Westphal 		       unsigned int mtu,
494694869b3SEric W. Biederman 		       int (*output)(struct net *, struct sock *, struct sk_buff *))
49549d16b23SAndy Zhou {
49649d16b23SAndy Zhou 	struct iphdr *iph = ip_hdr(skb);
49749d16b23SAndy Zhou 
498d6b915e2SFlorian Westphal 	if ((iph->frag_off & htons(IP_DF)) == 0)
499694869b3SEric W. Biederman 		return ip_do_fragment(net, sk, skb, output);
500d6b915e2SFlorian Westphal 
501d6b915e2SFlorian Westphal 	if (unlikely(!skb->ignore_df ||
50249d16b23SAndy Zhou 		     (IPCB(skb)->frag_max_size &&
50349d16b23SAndy Zhou 		      IPCB(skb)->frag_max_size > mtu))) {
5049479b0afSEric W. Biederman 		IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS);
50549d16b23SAndy Zhou 		icmp_send(skb, ICMP_DEST_UNREACH, ICMP_FRAG_NEEDED,
50649d16b23SAndy Zhou 			  htonl(mtu));
50749d16b23SAndy Zhou 		kfree_skb(skb);
50849d16b23SAndy Zhou 		return -EMSGSIZE;
50949d16b23SAndy Zhou 	}
51049d16b23SAndy Zhou 
511694869b3SEric W. Biederman 	return ip_do_fragment(net, sk, skb, output);
51249d16b23SAndy Zhou }
51349d16b23SAndy Zhou 
5141da177e4SLinus Torvalds /*
5151da177e4SLinus Torvalds  *	This IP datagram is too large to be sent in one piece.  Break it up into
5161da177e4SLinus Torvalds  *	smaller pieces (each of size equal to IP header plus
5171da177e4SLinus Torvalds  *	a block of the data of the original IP data part) that will yet fit in a
5181da177e4SLinus Torvalds  *	single device frame, and queue such a frame for sending.
5191da177e4SLinus Torvalds  */
5201da177e4SLinus Torvalds 
521694869b3SEric W. Biederman int ip_do_fragment(struct net *net, struct sock *sk, struct sk_buff *skb,
522694869b3SEric W. Biederman 		   int (*output)(struct net *, struct sock *, struct sk_buff *))
5231da177e4SLinus Torvalds {
5241da177e4SLinus Torvalds 	struct iphdr *iph;
5251da177e4SLinus Torvalds 	int ptr;
5261da177e4SLinus Torvalds 	struct net_device *dev;
5271da177e4SLinus Torvalds 	struct sk_buff *skb2;
528c893b806SChangli Gao 	unsigned int mtu, hlen, left, len, ll_rs;
5291da177e4SLinus Torvalds 	int offset;
53076ab608dSAlexey Dobriyan 	__be16 not_last_frag;
531511c3f92SEric Dumazet 	struct rtable *rt = skb_rtable(skb);
5321da177e4SLinus Torvalds 	int err = 0;
5331da177e4SLinus Torvalds 
534d8d1f30bSChangli Gao 	dev = rt->dst.dev;
5351da177e4SLinus Torvalds 
5361da177e4SLinus Torvalds 	/*
5371da177e4SLinus Torvalds 	 *	Point into the IP datagram header.
5381da177e4SLinus Torvalds 	 */
5391da177e4SLinus Torvalds 
540eddc9ec5SArnaldo Carvalho de Melo 	iph = ip_hdr(skb);
5411da177e4SLinus Torvalds 
54269647ce4SHannes Frederic Sowa 	mtu = ip_skb_dst_mtu(skb);
543d6b915e2SFlorian Westphal 	if (IPCB(skb)->frag_max_size && IPCB(skb)->frag_max_size < mtu)
544d6b915e2SFlorian Westphal 		mtu = IPCB(skb)->frag_max_size;
5451da177e4SLinus Torvalds 
5461da177e4SLinus Torvalds 	/*
5471da177e4SLinus Torvalds 	 *	Setup starting values.
5481da177e4SLinus Torvalds 	 */
5491da177e4SLinus Torvalds 
5501da177e4SLinus Torvalds 	hlen = iph->ihl * 4;
551f87c10a8SHannes Frederic Sowa 	mtu = mtu - hlen;	/* Size of data space */
55289cee8b1SHerbert Xu 	IPCB(skb)->flags |= IPSKB_FRAG_COMPLETE;
5531da177e4SLinus Torvalds 
5541da177e4SLinus Torvalds 	/* When frag_list is given, use it. First, check its validity:
5551da177e4SLinus Torvalds 	 * some transformers could create wrong frag_list or break existing
5561da177e4SLinus Torvalds 	 * one, it is not prohibited. In this case fall back to copying.
5571da177e4SLinus Torvalds 	 *
5581da177e4SLinus Torvalds 	 * LATER: this step can be merged to real generation of fragments,
5591da177e4SLinus Torvalds 	 * we can switch to copy when see the first bad fragment.
5601da177e4SLinus Torvalds 	 */
56121dc3301SDavid S. Miller 	if (skb_has_frag_list(skb)) {
5623d13008eSEric Dumazet 		struct sk_buff *frag, *frag2;
5631da177e4SLinus Torvalds 		int first_len = skb_pagelen(skb);
5641da177e4SLinus Torvalds 
5651da177e4SLinus Torvalds 		if (first_len - hlen > mtu ||
5661da177e4SLinus Torvalds 		    ((first_len - hlen) & 7) ||
56756f8a75cSPaul Gortmaker 		    ip_is_fragment(iph) ||
5681da177e4SLinus Torvalds 		    skb_cloned(skb))
5691da177e4SLinus Torvalds 			goto slow_path;
5701da177e4SLinus Torvalds 
571d7fcf1a5SDavid S. Miller 		skb_walk_frags(skb, frag) {
5721da177e4SLinus Torvalds 			/* Correct geometry. */
5731da177e4SLinus Torvalds 			if (frag->len > mtu ||
5741da177e4SLinus Torvalds 			    ((frag->len & 7) && frag->next) ||
5751da177e4SLinus Torvalds 			    skb_headroom(frag) < hlen)
5763d13008eSEric Dumazet 				goto slow_path_clean;
5771da177e4SLinus Torvalds 
5781da177e4SLinus Torvalds 			/* Partially cloned skb? */
5791da177e4SLinus Torvalds 			if (skb_shared(frag))
5803d13008eSEric Dumazet 				goto slow_path_clean;
5812fdba6b0SHerbert Xu 
5822fdba6b0SHerbert Xu 			BUG_ON(frag->sk);
5832fdba6b0SHerbert Xu 			if (skb->sk) {
5842fdba6b0SHerbert Xu 				frag->sk = skb->sk;
5852fdba6b0SHerbert Xu 				frag->destructor = sock_wfree;
5862fdba6b0SHerbert Xu 			}
5873d13008eSEric Dumazet 			skb->truesize -= frag->truesize;
5881da177e4SLinus Torvalds 		}
5891da177e4SLinus Torvalds 
5901da177e4SLinus Torvalds 		/* Everything is OK. Generate! */
5911da177e4SLinus Torvalds 
5921da177e4SLinus Torvalds 		err = 0;
5931da177e4SLinus Torvalds 		offset = 0;
5941da177e4SLinus Torvalds 		frag = skb_shinfo(skb)->frag_list;
595d7fcf1a5SDavid S. Miller 		skb_frag_list_init(skb);
5961da177e4SLinus Torvalds 		skb->data_len = first_len - skb_headlen(skb);
5971da177e4SLinus Torvalds 		skb->len = first_len;
5981da177e4SLinus Torvalds 		iph->tot_len = htons(first_len);
5991da177e4SLinus Torvalds 		iph->frag_off = htons(IP_MF);
6001da177e4SLinus Torvalds 		ip_send_check(iph);
6011da177e4SLinus Torvalds 
6021da177e4SLinus Torvalds 		for (;;) {
6031da177e4SLinus Torvalds 			/* Prepare header of the next frame,
6041da177e4SLinus Torvalds 			 * before previous one went down. */
6051da177e4SLinus Torvalds 			if (frag) {
6061da177e4SLinus Torvalds 				frag->ip_summed = CHECKSUM_NONE;
607badff6d0SArnaldo Carvalho de Melo 				skb_reset_transport_header(frag);
608e2d1bca7SArnaldo Carvalho de Melo 				__skb_push(frag, hlen);
609e2d1bca7SArnaldo Carvalho de Melo 				skb_reset_network_header(frag);
610d56f90a7SArnaldo Carvalho de Melo 				memcpy(skb_network_header(frag), iph, hlen);
611eddc9ec5SArnaldo Carvalho de Melo 				iph = ip_hdr(frag);
6121da177e4SLinus Torvalds 				iph->tot_len = htons(frag->len);
6131da177e4SLinus Torvalds 				ip_copy_metadata(frag, skb);
6141da177e4SLinus Torvalds 				if (offset == 0)
6151da177e4SLinus Torvalds 					ip_options_fragment(frag);
6161da177e4SLinus Torvalds 				offset += skb->len - hlen;
6171da177e4SLinus Torvalds 				iph->frag_off = htons(offset>>3);
61800db4124SIan Morris 				if (frag->next)
6191da177e4SLinus Torvalds 					iph->frag_off |= htons(IP_MF);
6201da177e4SLinus Torvalds 				/* Ready, complete checksum */
6211da177e4SLinus Torvalds 				ip_send_check(iph);
6221da177e4SLinus Torvalds 			}
6231da177e4SLinus Torvalds 
624694869b3SEric W. Biederman 			err = output(net, sk, skb);
6251da177e4SLinus Torvalds 
626dafee490SWei Dong 			if (!err)
62726a949dbSEric W. Biederman 				IP_INC_STATS(net, IPSTATS_MIB_FRAGCREATES);
6281da177e4SLinus Torvalds 			if (err || !frag)
6291da177e4SLinus Torvalds 				break;
6301da177e4SLinus Torvalds 
6311da177e4SLinus Torvalds 			skb = frag;
6321da177e4SLinus Torvalds 			frag = skb->next;
6331da177e4SLinus Torvalds 			skb->next = NULL;
6341da177e4SLinus Torvalds 		}
6351da177e4SLinus Torvalds 
6361da177e4SLinus Torvalds 		if (err == 0) {
63726a949dbSEric W. Biederman 			IP_INC_STATS(net, IPSTATS_MIB_FRAGOKS);
6381da177e4SLinus Torvalds 			return 0;
6391da177e4SLinus Torvalds 		}
6401da177e4SLinus Torvalds 
6411da177e4SLinus Torvalds 		while (frag) {
6421da177e4SLinus Torvalds 			skb = frag->next;
6431da177e4SLinus Torvalds 			kfree_skb(frag);
6441da177e4SLinus Torvalds 			frag = skb;
6451da177e4SLinus Torvalds 		}
64626a949dbSEric W. Biederman 		IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS);
6471da177e4SLinus Torvalds 		return err;
6483d13008eSEric Dumazet 
6493d13008eSEric Dumazet slow_path_clean:
6503d13008eSEric Dumazet 		skb_walk_frags(skb, frag2) {
6513d13008eSEric Dumazet 			if (frag2 == frag)
6523d13008eSEric Dumazet 				break;
6533d13008eSEric Dumazet 			frag2->sk = NULL;
6543d13008eSEric Dumazet 			frag2->destructor = NULL;
6553d13008eSEric Dumazet 			skb->truesize += frag2->truesize;
6563d13008eSEric Dumazet 		}
6571da177e4SLinus Torvalds 	}
6581da177e4SLinus Torvalds 
6591da177e4SLinus Torvalds slow_path:
660fc70fb64SAlexander Duyck 	/* for offloaded checksums cleanup checksum before fragmentation */
661fc70fb64SAlexander Duyck 	if ((skb->ip_summed == CHECKSUM_PARTIAL) && skb_checksum_help(skb))
662fc70fb64SAlexander Duyck 		goto fail;
663c9af6db4SPravin B Shelar 	iph = ip_hdr(skb);
664fc70fb64SAlexander Duyck 
6651da177e4SLinus Torvalds 	left = skb->len - hlen;		/* Space per frame */
66649085bd7SGeorge Kadianakis 	ptr = hlen;		/* Where to start from */
6671da177e4SLinus Torvalds 
6688d045163SFlorian Westphal 	ll_rs = LL_RESERVED_SPACE(rt->dst.dev);
6699bcfcaf5SStephen Hemminger 
6701da177e4SLinus Torvalds 	/*
6711da177e4SLinus Torvalds 	 *	Fragment the datagram.
6721da177e4SLinus Torvalds 	 */
6731da177e4SLinus Torvalds 
6741da177e4SLinus Torvalds 	offset = (ntohs(iph->frag_off) & IP_OFFSET) << 3;
6751da177e4SLinus Torvalds 	not_last_frag = iph->frag_off & htons(IP_MF);
6761da177e4SLinus Torvalds 
6771da177e4SLinus Torvalds 	/*
6781da177e4SLinus Torvalds 	 *	Keep copying data until we run out.
6791da177e4SLinus Torvalds 	 */
6801da177e4SLinus Torvalds 
6811da177e4SLinus Torvalds 	while (left > 0) {
6821da177e4SLinus Torvalds 		len = left;
6831da177e4SLinus Torvalds 		/* IF: it doesn't fit, use 'mtu' - the data space left */
6841da177e4SLinus Torvalds 		if (len > mtu)
6851da177e4SLinus Torvalds 			len = mtu;
6861da177e4SLinus Torvalds 		/* IF: we are not sending up to and including the packet end
6871da177e4SLinus Torvalds 		   then align the next start on an eight byte boundary */
6881da177e4SLinus Torvalds 		if (len < left)	{
6891da177e4SLinus Torvalds 			len &= ~7;
6901da177e4SLinus Torvalds 		}
6911da177e4SLinus Torvalds 
692cbffccc9SJoe Perches 		/* Allocate buffer */
693cbffccc9SJoe Perches 		skb2 = alloc_skb(len + hlen + ll_rs, GFP_ATOMIC);
694cbffccc9SJoe Perches 		if (!skb2) {
6951da177e4SLinus Torvalds 			err = -ENOMEM;
6961da177e4SLinus Torvalds 			goto fail;
6971da177e4SLinus Torvalds 		}
6981da177e4SLinus Torvalds 
6991da177e4SLinus Torvalds 		/*
7001da177e4SLinus Torvalds 		 *	Set up data on packet
7011da177e4SLinus Torvalds 		 */
7021da177e4SLinus Torvalds 
7031da177e4SLinus Torvalds 		ip_copy_metadata(skb2, skb);
7041da177e4SLinus Torvalds 		skb_reserve(skb2, ll_rs);
7051da177e4SLinus Torvalds 		skb_put(skb2, len + hlen);
706c1d2bbe1SArnaldo Carvalho de Melo 		skb_reset_network_header(skb2);
707b0e380b1SArnaldo Carvalho de Melo 		skb2->transport_header = skb2->network_header + hlen;
7081da177e4SLinus Torvalds 
7091da177e4SLinus Torvalds 		/*
7101da177e4SLinus Torvalds 		 *	Charge the memory for the fragment to any owner
7111da177e4SLinus Torvalds 		 *	it might possess
7121da177e4SLinus Torvalds 		 */
7131da177e4SLinus Torvalds 
7141da177e4SLinus Torvalds 		if (skb->sk)
7151da177e4SLinus Torvalds 			skb_set_owner_w(skb2, skb->sk);
7161da177e4SLinus Torvalds 
7171da177e4SLinus Torvalds 		/*
7181da177e4SLinus Torvalds 		 *	Copy the packet header into the new buffer.
7191da177e4SLinus Torvalds 		 */
7201da177e4SLinus Torvalds 
721d626f62bSArnaldo Carvalho de Melo 		skb_copy_from_linear_data(skb, skb_network_header(skb2), hlen);
7221da177e4SLinus Torvalds 
7231da177e4SLinus Torvalds 		/*
7241da177e4SLinus Torvalds 		 *	Copy a block of the IP datagram.
7251da177e4SLinus Torvalds 		 */
726bff9b61cSArnaldo Carvalho de Melo 		if (skb_copy_bits(skb, ptr, skb_transport_header(skb2), len))
7271da177e4SLinus Torvalds 			BUG();
7281da177e4SLinus Torvalds 		left -= len;
7291da177e4SLinus Torvalds 
7301da177e4SLinus Torvalds 		/*
7311da177e4SLinus Torvalds 		 *	Fill in the new header fields.
7321da177e4SLinus Torvalds 		 */
733eddc9ec5SArnaldo Carvalho de Melo 		iph = ip_hdr(skb2);
7341da177e4SLinus Torvalds 		iph->frag_off = htons((offset >> 3));
7351da177e4SLinus Torvalds 
736d6b915e2SFlorian Westphal 		if (IPCB(skb)->flags & IPSKB_FRAG_PMTU)
737d6b915e2SFlorian Westphal 			iph->frag_off |= htons(IP_DF);
738d6b915e2SFlorian Westphal 
7391da177e4SLinus Torvalds 		/* ANK: dirty, but effective trick. Upgrade options only if
7401da177e4SLinus Torvalds 		 * the segment to be fragmented was THE FIRST (otherwise,
7411da177e4SLinus Torvalds 		 * options are already fixed) and make it ONCE
7421da177e4SLinus Torvalds 		 * on the initial skb, so that all the following fragments
7431da177e4SLinus Torvalds 		 * will inherit fixed options.
7441da177e4SLinus Torvalds 		 */
7451da177e4SLinus Torvalds 		if (offset == 0)
7461da177e4SLinus Torvalds 			ip_options_fragment(skb);
7471da177e4SLinus Torvalds 
7481da177e4SLinus Torvalds 		/*
7491da177e4SLinus Torvalds 		 *	Added AC : If we are fragmenting a fragment that's not the
7501da177e4SLinus Torvalds 		 *		   last fragment then keep MF on each bit
7511da177e4SLinus Torvalds 		 */
7521da177e4SLinus Torvalds 		if (left > 0 || not_last_frag)
7531da177e4SLinus Torvalds 			iph->frag_off |= htons(IP_MF);
7541da177e4SLinus Torvalds 		ptr += len;
7551da177e4SLinus Torvalds 		offset += len;
7561da177e4SLinus Torvalds 
7571da177e4SLinus Torvalds 		/*
7581da177e4SLinus Torvalds 		 *	Put this fragment into the sending queue.
7591da177e4SLinus Torvalds 		 */
7601da177e4SLinus Torvalds 		iph->tot_len = htons(len + hlen);
7611da177e4SLinus Torvalds 
7621da177e4SLinus Torvalds 		ip_send_check(iph);
7631da177e4SLinus Torvalds 
764694869b3SEric W. Biederman 		err = output(net, sk, skb2);
7651da177e4SLinus Torvalds 		if (err)
7661da177e4SLinus Torvalds 			goto fail;
767dafee490SWei Dong 
76826a949dbSEric W. Biederman 		IP_INC_STATS(net, IPSTATS_MIB_FRAGCREATES);
7691da177e4SLinus Torvalds 	}
7705d0ba55bSEric Dumazet 	consume_skb(skb);
77126a949dbSEric W. Biederman 	IP_INC_STATS(net, IPSTATS_MIB_FRAGOKS);
7721da177e4SLinus Torvalds 	return err;
7731da177e4SLinus Torvalds 
7741da177e4SLinus Torvalds fail:
7751da177e4SLinus Torvalds 	kfree_skb(skb);
77626a949dbSEric W. Biederman 	IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS);
7771da177e4SLinus Torvalds 	return err;
7781da177e4SLinus Torvalds }
77949d16b23SAndy Zhou EXPORT_SYMBOL(ip_do_fragment);
7802e2f7aefSPatrick McHardy 
7811da177e4SLinus Torvalds int
7821da177e4SLinus Torvalds ip_generic_getfrag(void *from, char *to, int offset, int len, int odd, struct sk_buff *skb)
7831da177e4SLinus Torvalds {
784f69e6d13SAl Viro 	struct msghdr *msg = from;
7851da177e4SLinus Torvalds 
78684fa7933SPatrick McHardy 	if (skb->ip_summed == CHECKSUM_PARTIAL) {
78721226abbSAl Viro 		if (copy_from_iter(to, len, &msg->msg_iter) != len)
7881da177e4SLinus Torvalds 			return -EFAULT;
7891da177e4SLinus Torvalds 	} else {
79044bb9363SAl Viro 		__wsum csum = 0;
79121226abbSAl Viro 		if (csum_and_copy_from_iter(to, len, &csum, &msg->msg_iter) != len)
7921da177e4SLinus Torvalds 			return -EFAULT;
7931da177e4SLinus Torvalds 		skb->csum = csum_block_add(skb->csum, csum, odd);
7941da177e4SLinus Torvalds 	}
7951da177e4SLinus Torvalds 	return 0;
7961da177e4SLinus Torvalds }
7974bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_generic_getfrag);
7981da177e4SLinus Torvalds 
79944bb9363SAl Viro static inline __wsum
8001da177e4SLinus Torvalds csum_page(struct page *page, int offset, int copy)
8011da177e4SLinus Torvalds {
8021da177e4SLinus Torvalds 	char *kaddr;
80344bb9363SAl Viro 	__wsum csum;
8041da177e4SLinus Torvalds 	kaddr = kmap(page);
8051da177e4SLinus Torvalds 	csum = csum_partial(kaddr + offset, copy, 0);
8061da177e4SLinus Torvalds 	kunmap(page);
8071da177e4SLinus Torvalds 	return csum;
8081da177e4SLinus Torvalds }
8091da177e4SLinus Torvalds 
8104b30b1c6SAdrian Bunk static inline int ip_ufo_append_data(struct sock *sk,
8111470ddf7SHerbert Xu 			struct sk_buff_head *queue,
812e89e9cf5SAnanda Raju 			int getfrag(void *from, char *to, int offset, int len,
813e89e9cf5SAnanda Raju 			       int odd, struct sk_buff *skb),
814e89e9cf5SAnanda Raju 			void *from, int length, int hh_len, int fragheaderlen,
815d9be4f7aSBill Sommerfeld 			int transhdrlen, int maxfraglen, unsigned int flags)
816e89e9cf5SAnanda Raju {
817e89e9cf5SAnanda Raju 	struct sk_buff *skb;
818e89e9cf5SAnanda Raju 	int err;
819e89e9cf5SAnanda Raju 
820e89e9cf5SAnanda Raju 	/* There is support for UDP fragmentation offload by network
821e89e9cf5SAnanda Raju 	 * device, so create one single skb packet containing complete
822e89e9cf5SAnanda Raju 	 * udp datagram
823e89e9cf5SAnanda Raju 	 */
82451456b29SIan Morris 	skb = skb_peek_tail(queue);
82551456b29SIan Morris 	if (!skb) {
826e89e9cf5SAnanda Raju 		skb = sock_alloc_send_skb(sk,
827e89e9cf5SAnanda Raju 			hh_len + fragheaderlen + transhdrlen + 20,
828e89e9cf5SAnanda Raju 			(flags & MSG_DONTWAIT), &err);
829e89e9cf5SAnanda Raju 
83051456b29SIan Morris 		if (!skb)
831e89e9cf5SAnanda Raju 			return err;
832e89e9cf5SAnanda Raju 
833e89e9cf5SAnanda Raju 		/* reserve space for Hardware header */
834e89e9cf5SAnanda Raju 		skb_reserve(skb, hh_len);
835e89e9cf5SAnanda Raju 
836e89e9cf5SAnanda Raju 		/* create space for UDP/IP header */
837e89e9cf5SAnanda Raju 		skb_put(skb, fragheaderlen + transhdrlen);
838e89e9cf5SAnanda Raju 
839e89e9cf5SAnanda Raju 		/* initialize network header pointer */
840c1d2bbe1SArnaldo Carvalho de Melo 		skb_reset_network_header(skb);
841e89e9cf5SAnanda Raju 
842e89e9cf5SAnanda Raju 		/* initialize protocol header pointer */
843b0e380b1SArnaldo Carvalho de Melo 		skb->transport_header = skb->network_header + fragheaderlen;
844e89e9cf5SAnanda Raju 
845e89e9cf5SAnanda Raju 		skb->csum = 0;
846e89e9cf5SAnanda Raju 
847e93b7d74SJiri Pirko 		__skb_queue_tail(queue, skb);
848e93b7d74SJiri Pirko 	} else if (skb_is_gso(skb)) {
849e93b7d74SJiri Pirko 		goto append;
850e93b7d74SJiri Pirko 	}
851e93b7d74SJiri Pirko 
852e93b7d74SJiri Pirko 	skb->ip_summed = CHECKSUM_PARTIAL;
853e89e9cf5SAnanda Raju 	/* specify the length of each IP datagram fragment */
854d9be4f7aSBill Sommerfeld 	skb_shinfo(skb)->gso_size = maxfraglen - fragheaderlen;
855f83ef8c0SHerbert Xu 	skb_shinfo(skb)->gso_type = SKB_GSO_UDP;
856be9164e7SKostya B 
857e93b7d74SJiri Pirko append:
858be9164e7SKostya B 	return skb_append_datato_frags(sk, skb, getfrag, from,
859be9164e7SKostya B 				       (length - transhdrlen));
860e89e9cf5SAnanda Raju }
861e89e9cf5SAnanda Raju 
862f5fca608SDavid S. Miller static int __ip_append_data(struct sock *sk,
863f5fca608SDavid S. Miller 			    struct flowi4 *fl4,
864f5fca608SDavid S. Miller 			    struct sk_buff_head *queue,
8651470ddf7SHerbert Xu 			    struct inet_cork *cork,
8665640f768SEric Dumazet 			    struct page_frag *pfrag,
8671470ddf7SHerbert Xu 			    int getfrag(void *from, char *to, int offset,
8681470ddf7SHerbert Xu 					int len, int odd, struct sk_buff *skb),
8691da177e4SLinus Torvalds 			    void *from, int length, int transhdrlen,
8701da177e4SLinus Torvalds 			    unsigned int flags)
8711da177e4SLinus Torvalds {
8721da177e4SLinus Torvalds 	struct inet_sock *inet = inet_sk(sk);
8731da177e4SLinus Torvalds 	struct sk_buff *skb;
8741da177e4SLinus Torvalds 
87507df5294SHerbert Xu 	struct ip_options *opt = cork->opt;
8761da177e4SLinus Torvalds 	int hh_len;
8771da177e4SLinus Torvalds 	int exthdrlen;
8781da177e4SLinus Torvalds 	int mtu;
8791da177e4SLinus Torvalds 	int copy;
8801da177e4SLinus Torvalds 	int err;
8811da177e4SLinus Torvalds 	int offset = 0;
882daba287bSHannes Frederic Sowa 	unsigned int maxfraglen, fragheaderlen, maxnonfragsize;
8831da177e4SLinus Torvalds 	int csummode = CHECKSUM_NONE;
8841470ddf7SHerbert Xu 	struct rtable *rt = (struct rtable *)cork->dst;
88509c2d251SWillem de Bruijn 	u32 tskey = 0;
8861da177e4SLinus Torvalds 
88796d7303eSSteffen Klassert 	skb = skb_peek_tail(queue);
88896d7303eSSteffen Klassert 
88996d7303eSSteffen Klassert 	exthdrlen = !skb ? rt->dst.header_len : 0;
89007df5294SHerbert Xu 	mtu = cork->fragsize;
89109c2d251SWillem de Bruijn 	if (cork->tx_flags & SKBTX_ANY_SW_TSTAMP &&
89209c2d251SWillem de Bruijn 	    sk->sk_tsflags & SOF_TIMESTAMPING_OPT_ID)
89309c2d251SWillem de Bruijn 		tskey = sk->sk_tskey++;
8941470ddf7SHerbert Xu 
895d8d1f30bSChangli Gao 	hh_len = LL_RESERVED_SPACE(rt->dst.dev);
8961da177e4SLinus Torvalds 
8971da177e4SLinus Torvalds 	fragheaderlen = sizeof(struct iphdr) + (opt ? opt->optlen : 0);
8981da177e4SLinus Torvalds 	maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen;
89960ff7467SWANG Cong 	maxnonfragsize = ip_sk_ignore_df(sk) ? 0xFFFF : mtu;
9001da177e4SLinus Torvalds 
901daba287bSHannes Frederic Sowa 	if (cork->length + length > maxnonfragsize - fragheaderlen) {
902f5fca608SDavid S. Miller 		ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport,
90361e7f09dSHannes Frederic Sowa 			       mtu - (opt ? opt->optlen : 0));
9041da177e4SLinus Torvalds 		return -EMSGSIZE;
9051da177e4SLinus Torvalds 	}
9061da177e4SLinus Torvalds 
9071da177e4SLinus Torvalds 	/*
9081da177e4SLinus Torvalds 	 * transhdrlen > 0 means that this is the first fragment and we wish
9091da177e4SLinus Torvalds 	 * it won't be fragmented in the future.
9101da177e4SLinus Torvalds 	 */
9111da177e4SLinus Torvalds 	if (transhdrlen &&
9121da177e4SLinus Torvalds 	    length + fragheaderlen <= mtu &&
913d8d1f30bSChangli Gao 	    rt->dst.dev->features & NETIF_F_V4_CSUM &&
9141da177e4SLinus Torvalds 	    !exthdrlen)
91584fa7933SPatrick McHardy 		csummode = CHECKSUM_PARTIAL;
9161da177e4SLinus Torvalds 
9171470ddf7SHerbert Xu 	cork->length += length;
91826cde9f7SHerbert Xu 	if (((length > mtu) || (skb && skb_is_gso(skb))) &&
919be9164e7SKostya B 	    (sk->sk_protocol == IPPROTO_UDP) &&
920acf8dd0aSMichal Kubeček 	    (rt->dst.dev->features & NETIF_F_UFO) && !rt->dst.header_len &&
921acf8dd0aSMichal Kubeček 	    (sk->sk_type == SOCK_DGRAM)) {
9221470ddf7SHerbert Xu 		err = ip_ufo_append_data(sk, queue, getfrag, from, length,
9231470ddf7SHerbert Xu 					 hh_len, fragheaderlen, transhdrlen,
924d9be4f7aSBill Sommerfeld 					 maxfraglen, flags);
925baa829d8SPatrick McHardy 		if (err)
926e89e9cf5SAnanda Raju 			goto error;
927e89e9cf5SAnanda Raju 		return 0;
928e89e9cf5SAnanda Raju 	}
9291da177e4SLinus Torvalds 
9301da177e4SLinus Torvalds 	/* So, what's going on in the loop below?
9311da177e4SLinus Torvalds 	 *
9321da177e4SLinus Torvalds 	 * We use calculated fragment length to generate chained skb,
9331da177e4SLinus Torvalds 	 * each of segments is IP fragment ready for sending to network after
9341da177e4SLinus Torvalds 	 * adding appropriate IP header.
9351da177e4SLinus Torvalds 	 */
9361da177e4SLinus Torvalds 
93726cde9f7SHerbert Xu 	if (!skb)
9381da177e4SLinus Torvalds 		goto alloc_new_skb;
9391da177e4SLinus Torvalds 
9401da177e4SLinus Torvalds 	while (length > 0) {
9411da177e4SLinus Torvalds 		/* Check if the remaining data fits into current packet. */
9421da177e4SLinus Torvalds 		copy = mtu - skb->len;
9431da177e4SLinus Torvalds 		if (copy < length)
9441da177e4SLinus Torvalds 			copy = maxfraglen - skb->len;
9451da177e4SLinus Torvalds 		if (copy <= 0) {
9461da177e4SLinus Torvalds 			char *data;
9471da177e4SLinus Torvalds 			unsigned int datalen;
9481da177e4SLinus Torvalds 			unsigned int fraglen;
9491da177e4SLinus Torvalds 			unsigned int fraggap;
9501da177e4SLinus Torvalds 			unsigned int alloclen;
9511da177e4SLinus Torvalds 			struct sk_buff *skb_prev;
9521da177e4SLinus Torvalds alloc_new_skb:
9531da177e4SLinus Torvalds 			skb_prev = skb;
9541da177e4SLinus Torvalds 			if (skb_prev)
9551da177e4SLinus Torvalds 				fraggap = skb_prev->len - maxfraglen;
9561da177e4SLinus Torvalds 			else
9571da177e4SLinus Torvalds 				fraggap = 0;
9581da177e4SLinus Torvalds 
9591da177e4SLinus Torvalds 			/*
9601da177e4SLinus Torvalds 			 * If remaining data exceeds the mtu,
9611da177e4SLinus Torvalds 			 * we know we need more fragment(s).
9621da177e4SLinus Torvalds 			 */
9631da177e4SLinus Torvalds 			datalen = length + fraggap;
9641da177e4SLinus Torvalds 			if (datalen > mtu - fragheaderlen)
9651da177e4SLinus Torvalds 				datalen = maxfraglen - fragheaderlen;
9661da177e4SLinus Torvalds 			fraglen = datalen + fragheaderlen;
9671da177e4SLinus Torvalds 
9681da177e4SLinus Torvalds 			if ((flags & MSG_MORE) &&
969d8d1f30bSChangli Gao 			    !(rt->dst.dev->features&NETIF_F_SG))
9701da177e4SLinus Torvalds 				alloclen = mtu;
9711da177e4SLinus Torvalds 			else
97259104f06SEric Dumazet 				alloclen = fraglen;
9731da177e4SLinus Torvalds 
974353e5c9aSSteffen Klassert 			alloclen += exthdrlen;
975353e5c9aSSteffen Klassert 
9761da177e4SLinus Torvalds 			/* The last fragment gets additional space at tail.
9771da177e4SLinus Torvalds 			 * Note, with MSG_MORE we overallocate on fragments,
9781da177e4SLinus Torvalds 			 * because we have no idea what fragment will be
9791da177e4SLinus Torvalds 			 * the last.
9801da177e4SLinus Torvalds 			 */
98133f99dc7SSteffen Klassert 			if (datalen == length + fraggap)
982d8d1f30bSChangli Gao 				alloclen += rt->dst.trailer_len;
98333f99dc7SSteffen Klassert 
9841da177e4SLinus Torvalds 			if (transhdrlen) {
9851da177e4SLinus Torvalds 				skb = sock_alloc_send_skb(sk,
9861da177e4SLinus Torvalds 						alloclen + hh_len + 15,
9871da177e4SLinus Torvalds 						(flags & MSG_DONTWAIT), &err);
9881da177e4SLinus Torvalds 			} else {
9891da177e4SLinus Torvalds 				skb = NULL;
9901da177e4SLinus Torvalds 				if (atomic_read(&sk->sk_wmem_alloc) <=
9911da177e4SLinus Torvalds 				    2 * sk->sk_sndbuf)
9921da177e4SLinus Torvalds 					skb = sock_wmalloc(sk,
9931da177e4SLinus Torvalds 							   alloclen + hh_len + 15, 1,
9941da177e4SLinus Torvalds 							   sk->sk_allocation);
99551456b29SIan Morris 				if (unlikely(!skb))
9961da177e4SLinus Torvalds 					err = -ENOBUFS;
9971da177e4SLinus Torvalds 			}
99851456b29SIan Morris 			if (!skb)
9991da177e4SLinus Torvalds 				goto error;
10001da177e4SLinus Torvalds 
10011da177e4SLinus Torvalds 			/*
10021da177e4SLinus Torvalds 			 *	Fill in the control structures
10031da177e4SLinus Torvalds 			 */
10041da177e4SLinus Torvalds 			skb->ip_summed = csummode;
10051da177e4SLinus Torvalds 			skb->csum = 0;
10061da177e4SLinus Torvalds 			skb_reserve(skb, hh_len);
100711878b40SWillem de Bruijn 
100811878b40SWillem de Bruijn 			/* only the initial fragment is time stamped */
10091470ddf7SHerbert Xu 			skb_shinfo(skb)->tx_flags = cork->tx_flags;
101011878b40SWillem de Bruijn 			cork->tx_flags = 0;
101109c2d251SWillem de Bruijn 			skb_shinfo(skb)->tskey = tskey;
101209c2d251SWillem de Bruijn 			tskey = 0;
10131da177e4SLinus Torvalds 
10141da177e4SLinus Torvalds 			/*
10151da177e4SLinus Torvalds 			 *	Find where to start putting bytes.
10161da177e4SLinus Torvalds 			 */
1017353e5c9aSSteffen Klassert 			data = skb_put(skb, fraglen + exthdrlen);
1018c14d2450SArnaldo Carvalho de Melo 			skb_set_network_header(skb, exthdrlen);
1019b0e380b1SArnaldo Carvalho de Melo 			skb->transport_header = (skb->network_header +
1020b0e380b1SArnaldo Carvalho de Melo 						 fragheaderlen);
1021353e5c9aSSteffen Klassert 			data += fragheaderlen + exthdrlen;
10221da177e4SLinus Torvalds 
10231da177e4SLinus Torvalds 			if (fraggap) {
10241da177e4SLinus Torvalds 				skb->csum = skb_copy_and_csum_bits(
10251da177e4SLinus Torvalds 					skb_prev, maxfraglen,
10261da177e4SLinus Torvalds 					data + transhdrlen, fraggap, 0);
10271da177e4SLinus Torvalds 				skb_prev->csum = csum_sub(skb_prev->csum,
10281da177e4SLinus Torvalds 							  skb->csum);
10291da177e4SLinus Torvalds 				data += fraggap;
1030e9fa4f7bSHerbert Xu 				pskb_trim_unique(skb_prev, maxfraglen);
10311da177e4SLinus Torvalds 			}
10321da177e4SLinus Torvalds 
10331da177e4SLinus Torvalds 			copy = datalen - transhdrlen - fraggap;
10341da177e4SLinus Torvalds 			if (copy > 0 && getfrag(from, data + transhdrlen, offset, copy, fraggap, skb) < 0) {
10351da177e4SLinus Torvalds 				err = -EFAULT;
10361da177e4SLinus Torvalds 				kfree_skb(skb);
10371da177e4SLinus Torvalds 				goto error;
10381da177e4SLinus Torvalds 			}
10391da177e4SLinus Torvalds 
10401da177e4SLinus Torvalds 			offset += copy;
10411da177e4SLinus Torvalds 			length -= datalen - fraggap;
10421da177e4SLinus Torvalds 			transhdrlen = 0;
10431da177e4SLinus Torvalds 			exthdrlen = 0;
10441da177e4SLinus Torvalds 			csummode = CHECKSUM_NONE;
10451da177e4SLinus Torvalds 
10461da177e4SLinus Torvalds 			/*
10471da177e4SLinus Torvalds 			 * Put the packet on the pending queue.
10481da177e4SLinus Torvalds 			 */
10491470ddf7SHerbert Xu 			__skb_queue_tail(queue, skb);
10501da177e4SLinus Torvalds 			continue;
10511da177e4SLinus Torvalds 		}
10521da177e4SLinus Torvalds 
10531da177e4SLinus Torvalds 		if (copy > length)
10541da177e4SLinus Torvalds 			copy = length;
10551da177e4SLinus Torvalds 
1056d8d1f30bSChangli Gao 		if (!(rt->dst.dev->features&NETIF_F_SG)) {
10571da177e4SLinus Torvalds 			unsigned int off;
10581da177e4SLinus Torvalds 
10591da177e4SLinus Torvalds 			off = skb->len;
10601da177e4SLinus Torvalds 			if (getfrag(from, skb_put(skb, copy),
10611da177e4SLinus Torvalds 					offset, copy, off, skb) < 0) {
10621da177e4SLinus Torvalds 				__skb_trim(skb, off);
10631da177e4SLinus Torvalds 				err = -EFAULT;
10641da177e4SLinus Torvalds 				goto error;
10651da177e4SLinus Torvalds 			}
10661da177e4SLinus Torvalds 		} else {
10671da177e4SLinus Torvalds 			int i = skb_shinfo(skb)->nr_frags;
10681da177e4SLinus Torvalds 
10691da177e4SLinus Torvalds 			err = -ENOMEM;
10705640f768SEric Dumazet 			if (!sk_page_frag_refill(sk, pfrag))
10711da177e4SLinus Torvalds 				goto error;
10721da177e4SLinus Torvalds 
10735640f768SEric Dumazet 			if (!skb_can_coalesce(skb, i, pfrag->page,
10745640f768SEric Dumazet 					      pfrag->offset)) {
10751da177e4SLinus Torvalds 				err = -EMSGSIZE;
10765640f768SEric Dumazet 				if (i == MAX_SKB_FRAGS)
10771da177e4SLinus Torvalds 					goto error;
10785640f768SEric Dumazet 
10795640f768SEric Dumazet 				__skb_fill_page_desc(skb, i, pfrag->page,
10805640f768SEric Dumazet 						     pfrag->offset, 0);
10815640f768SEric Dumazet 				skb_shinfo(skb)->nr_frags = ++i;
10825640f768SEric Dumazet 				get_page(pfrag->page);
10831da177e4SLinus Torvalds 			}
10845640f768SEric Dumazet 			copy = min_t(int, copy, pfrag->size - pfrag->offset);
10855640f768SEric Dumazet 			if (getfrag(from,
10865640f768SEric Dumazet 				    page_address(pfrag->page) + pfrag->offset,
10875640f768SEric Dumazet 				    offset, copy, skb->len, skb) < 0)
10885640f768SEric Dumazet 				goto error_efault;
10895640f768SEric Dumazet 
10905640f768SEric Dumazet 			pfrag->offset += copy;
10915640f768SEric Dumazet 			skb_frag_size_add(&skb_shinfo(skb)->frags[i - 1], copy);
10921da177e4SLinus Torvalds 			skb->len += copy;
10931da177e4SLinus Torvalds 			skb->data_len += copy;
1094f945fa7aSHerbert Xu 			skb->truesize += copy;
1095f945fa7aSHerbert Xu 			atomic_add(copy, &sk->sk_wmem_alloc);
10961da177e4SLinus Torvalds 		}
10971da177e4SLinus Torvalds 		offset += copy;
10981da177e4SLinus Torvalds 		length -= copy;
10991da177e4SLinus Torvalds 	}
11001da177e4SLinus Torvalds 
11011da177e4SLinus Torvalds 	return 0;
11021da177e4SLinus Torvalds 
11035640f768SEric Dumazet error_efault:
11045640f768SEric Dumazet 	err = -EFAULT;
11051da177e4SLinus Torvalds error:
11061470ddf7SHerbert Xu 	cork->length -= length;
11075e38e270SPavel Emelyanov 	IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTDISCARDS);
11081da177e4SLinus Torvalds 	return err;
11091da177e4SLinus Torvalds }
11101da177e4SLinus Torvalds 
11111470ddf7SHerbert Xu static int ip_setup_cork(struct sock *sk, struct inet_cork *cork,
11121470ddf7SHerbert Xu 			 struct ipcm_cookie *ipc, struct rtable **rtp)
11131470ddf7SHerbert Xu {
1114f6d8bd05SEric Dumazet 	struct ip_options_rcu *opt;
11151470ddf7SHerbert Xu 	struct rtable *rt;
11161470ddf7SHerbert Xu 
11171470ddf7SHerbert Xu 	/*
11181470ddf7SHerbert Xu 	 * setup for corking.
11191470ddf7SHerbert Xu 	 */
11201470ddf7SHerbert Xu 	opt = ipc->opt;
11211470ddf7SHerbert Xu 	if (opt) {
112251456b29SIan Morris 		if (!cork->opt) {
11231470ddf7SHerbert Xu 			cork->opt = kmalloc(sizeof(struct ip_options) + 40,
11241470ddf7SHerbert Xu 					    sk->sk_allocation);
112551456b29SIan Morris 			if (unlikely(!cork->opt))
11261470ddf7SHerbert Xu 				return -ENOBUFS;
11271470ddf7SHerbert Xu 		}
1128f6d8bd05SEric Dumazet 		memcpy(cork->opt, &opt->opt, sizeof(struct ip_options) + opt->opt.optlen);
11291470ddf7SHerbert Xu 		cork->flags |= IPCORK_OPT;
11301470ddf7SHerbert Xu 		cork->addr = ipc->addr;
11311470ddf7SHerbert Xu 	}
11321470ddf7SHerbert Xu 	rt = *rtp;
11331470ddf7SHerbert Xu 	if (unlikely(!rt))
11341470ddf7SHerbert Xu 		return -EFAULT;
11351470ddf7SHerbert Xu 	/*
11361470ddf7SHerbert Xu 	 * We steal reference to this route, caller should not release it
11371470ddf7SHerbert Xu 	 */
11381470ddf7SHerbert Xu 	*rtp = NULL;
1139482fc609SHannes Frederic Sowa 	cork->fragsize = ip_sk_use_pmtu(sk) ?
1140482fc609SHannes Frederic Sowa 			 dst_mtu(&rt->dst) : rt->dst.dev->mtu;
11411470ddf7SHerbert Xu 	cork->dst = &rt->dst;
11421470ddf7SHerbert Xu 	cork->length = 0;
1143aa661581SFrancesco Fusco 	cork->ttl = ipc->ttl;
1144aa661581SFrancesco Fusco 	cork->tos = ipc->tos;
1145aa661581SFrancesco Fusco 	cork->priority = ipc->priority;
11461470ddf7SHerbert Xu 	cork->tx_flags = ipc->tx_flags;
11471470ddf7SHerbert Xu 
11481470ddf7SHerbert Xu 	return 0;
11491470ddf7SHerbert Xu }
11501470ddf7SHerbert Xu 
11511470ddf7SHerbert Xu /*
11521470ddf7SHerbert Xu  *	ip_append_data() and ip_append_page() can make one large IP datagram
11531470ddf7SHerbert Xu  *	from many pieces of data. Each pieces will be holded on the socket
11541470ddf7SHerbert Xu  *	until ip_push_pending_frames() is called. Each piece can be a page
11551470ddf7SHerbert Xu  *	or non-page data.
11561470ddf7SHerbert Xu  *
11571470ddf7SHerbert Xu  *	Not only UDP, other transport protocols - e.g. raw sockets - can use
11581470ddf7SHerbert Xu  *	this interface potentially.
11591470ddf7SHerbert Xu  *
11601470ddf7SHerbert Xu  *	LATER: length must be adjusted by pad at tail, when it is required.
11611470ddf7SHerbert Xu  */
1162f5fca608SDavid S. Miller int ip_append_data(struct sock *sk, struct flowi4 *fl4,
11631470ddf7SHerbert Xu 		   int getfrag(void *from, char *to, int offset, int len,
11641470ddf7SHerbert Xu 			       int odd, struct sk_buff *skb),
11651470ddf7SHerbert Xu 		   void *from, int length, int transhdrlen,
11661470ddf7SHerbert Xu 		   struct ipcm_cookie *ipc, struct rtable **rtp,
11671470ddf7SHerbert Xu 		   unsigned int flags)
11681470ddf7SHerbert Xu {
11691470ddf7SHerbert Xu 	struct inet_sock *inet = inet_sk(sk);
11701470ddf7SHerbert Xu 	int err;
11711470ddf7SHerbert Xu 
11721470ddf7SHerbert Xu 	if (flags&MSG_PROBE)
11731470ddf7SHerbert Xu 		return 0;
11741470ddf7SHerbert Xu 
11751470ddf7SHerbert Xu 	if (skb_queue_empty(&sk->sk_write_queue)) {
1176bdc712b4SDavid S. Miller 		err = ip_setup_cork(sk, &inet->cork.base, ipc, rtp);
11771470ddf7SHerbert Xu 		if (err)
11781470ddf7SHerbert Xu 			return err;
11791470ddf7SHerbert Xu 	} else {
11801470ddf7SHerbert Xu 		transhdrlen = 0;
11811470ddf7SHerbert Xu 	}
11821470ddf7SHerbert Xu 
11835640f768SEric Dumazet 	return __ip_append_data(sk, fl4, &sk->sk_write_queue, &inet->cork.base,
11845640f768SEric Dumazet 				sk_page_frag(sk), getfrag,
11851470ddf7SHerbert Xu 				from, length, transhdrlen, flags);
11861470ddf7SHerbert Xu }
11871470ddf7SHerbert Xu 
1188f5fca608SDavid S. Miller ssize_t	ip_append_page(struct sock *sk, struct flowi4 *fl4, struct page *page,
11891da177e4SLinus Torvalds 		       int offset, size_t size, int flags)
11901da177e4SLinus Torvalds {
11911da177e4SLinus Torvalds 	struct inet_sock *inet = inet_sk(sk);
11921da177e4SLinus Torvalds 	struct sk_buff *skb;
11931da177e4SLinus Torvalds 	struct rtable *rt;
11941da177e4SLinus Torvalds 	struct ip_options *opt = NULL;
1195bdc712b4SDavid S. Miller 	struct inet_cork *cork;
11961da177e4SLinus Torvalds 	int hh_len;
11971da177e4SLinus Torvalds 	int mtu;
11981da177e4SLinus Torvalds 	int len;
11991da177e4SLinus Torvalds 	int err;
1200daba287bSHannes Frederic Sowa 	unsigned int maxfraglen, fragheaderlen, fraggap, maxnonfragsize;
12011da177e4SLinus Torvalds 
12021da177e4SLinus Torvalds 	if (inet->hdrincl)
12031da177e4SLinus Torvalds 		return -EPERM;
12041da177e4SLinus Torvalds 
12051da177e4SLinus Torvalds 	if (flags&MSG_PROBE)
12061da177e4SLinus Torvalds 		return 0;
12071da177e4SLinus Torvalds 
12081da177e4SLinus Torvalds 	if (skb_queue_empty(&sk->sk_write_queue))
12091da177e4SLinus Torvalds 		return -EINVAL;
12101da177e4SLinus Torvalds 
1211bdc712b4SDavid S. Miller 	cork = &inet->cork.base;
1212bdc712b4SDavid S. Miller 	rt = (struct rtable *)cork->dst;
1213bdc712b4SDavid S. Miller 	if (cork->flags & IPCORK_OPT)
1214bdc712b4SDavid S. Miller 		opt = cork->opt;
12151da177e4SLinus Torvalds 
1216d8d1f30bSChangli Gao 	if (!(rt->dst.dev->features&NETIF_F_SG))
12171da177e4SLinus Torvalds 		return -EOPNOTSUPP;
12181da177e4SLinus Torvalds 
1219d8d1f30bSChangli Gao 	hh_len = LL_RESERVED_SPACE(rt->dst.dev);
1220bdc712b4SDavid S. Miller 	mtu = cork->fragsize;
12211da177e4SLinus Torvalds 
12221da177e4SLinus Torvalds 	fragheaderlen = sizeof(struct iphdr) + (opt ? opt->optlen : 0);
12231da177e4SLinus Torvalds 	maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen;
122460ff7467SWANG Cong 	maxnonfragsize = ip_sk_ignore_df(sk) ? 0xFFFF : mtu;
12251da177e4SLinus Torvalds 
1226daba287bSHannes Frederic Sowa 	if (cork->length + size > maxnonfragsize - fragheaderlen) {
122761e7f09dSHannes Frederic Sowa 		ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport,
122861e7f09dSHannes Frederic Sowa 			       mtu - (opt ? opt->optlen : 0));
12291da177e4SLinus Torvalds 		return -EMSGSIZE;
12301da177e4SLinus Torvalds 	}
12311da177e4SLinus Torvalds 
123251456b29SIan Morris 	skb = skb_peek_tail(&sk->sk_write_queue);
123351456b29SIan Morris 	if (!skb)
12341da177e4SLinus Torvalds 		return -EINVAL;
12351da177e4SLinus Torvalds 
1236bdc712b4SDavid S. Miller 	cork->length += size;
123726cde9f7SHerbert Xu 	if ((size + skb->len > mtu) &&
123826cde9f7SHerbert Xu 	    (sk->sk_protocol == IPPROTO_UDP) &&
1239d8d1f30bSChangli Gao 	    (rt->dst.dev->features & NETIF_F_UFO)) {
12407967168cSHerbert Xu 		skb_shinfo(skb)->gso_size = mtu - fragheaderlen;
1241f83ef8c0SHerbert Xu 		skb_shinfo(skb)->gso_type = SKB_GSO_UDP;
12427967168cSHerbert Xu 	}
1243e89e9cf5SAnanda Raju 
12441da177e4SLinus Torvalds 	while (size > 0) {
1245be12a1feSHannes Frederic Sowa 		if (skb_is_gso(skb)) {
1246e89e9cf5SAnanda Raju 			len = size;
1247be12a1feSHannes Frederic Sowa 		} else {
1248e89e9cf5SAnanda Raju 
12491da177e4SLinus Torvalds 			/* Check if the remaining data fits into current packet. */
12501da177e4SLinus Torvalds 			len = mtu - skb->len;
12511da177e4SLinus Torvalds 			if (len < size)
12521da177e4SLinus Torvalds 				len = maxfraglen - skb->len;
1253e89e9cf5SAnanda Raju 		}
12541da177e4SLinus Torvalds 		if (len <= 0) {
12551da177e4SLinus Torvalds 			struct sk_buff *skb_prev;
12561da177e4SLinus Torvalds 			int alloclen;
12571da177e4SLinus Torvalds 
12581da177e4SLinus Torvalds 			skb_prev = skb;
12591da177e4SLinus Torvalds 			fraggap = skb_prev->len - maxfraglen;
12601da177e4SLinus Torvalds 
12611da177e4SLinus Torvalds 			alloclen = fragheaderlen + hh_len + fraggap + 15;
12621da177e4SLinus Torvalds 			skb = sock_wmalloc(sk, alloclen, 1, sk->sk_allocation);
12631da177e4SLinus Torvalds 			if (unlikely(!skb)) {
12641da177e4SLinus Torvalds 				err = -ENOBUFS;
12651da177e4SLinus Torvalds 				goto error;
12661da177e4SLinus Torvalds 			}
12671da177e4SLinus Torvalds 
12681da177e4SLinus Torvalds 			/*
12691da177e4SLinus Torvalds 			 *	Fill in the control structures
12701da177e4SLinus Torvalds 			 */
12711da177e4SLinus Torvalds 			skb->ip_summed = CHECKSUM_NONE;
12721da177e4SLinus Torvalds 			skb->csum = 0;
12731da177e4SLinus Torvalds 			skb_reserve(skb, hh_len);
12741da177e4SLinus Torvalds 
12751da177e4SLinus Torvalds 			/*
12761da177e4SLinus Torvalds 			 *	Find where to start putting bytes.
12771da177e4SLinus Torvalds 			 */
1278967b05f6SArnaldo Carvalho de Melo 			skb_put(skb, fragheaderlen + fraggap);
12792ca9e6f2SArnaldo Carvalho de Melo 			skb_reset_network_header(skb);
1280b0e380b1SArnaldo Carvalho de Melo 			skb->transport_header = (skb->network_header +
1281b0e380b1SArnaldo Carvalho de Melo 						 fragheaderlen);
12821da177e4SLinus Torvalds 			if (fraggap) {
1283967b05f6SArnaldo Carvalho de Melo 				skb->csum = skb_copy_and_csum_bits(skb_prev,
1284967b05f6SArnaldo Carvalho de Melo 								   maxfraglen,
12859c70220bSArnaldo Carvalho de Melo 						    skb_transport_header(skb),
1286967b05f6SArnaldo Carvalho de Melo 								   fraggap, 0);
12871da177e4SLinus Torvalds 				skb_prev->csum = csum_sub(skb_prev->csum,
12881da177e4SLinus Torvalds 							  skb->csum);
1289e9fa4f7bSHerbert Xu 				pskb_trim_unique(skb_prev, maxfraglen);
12901da177e4SLinus Torvalds 			}
12911da177e4SLinus Torvalds 
12921da177e4SLinus Torvalds 			/*
12931da177e4SLinus Torvalds 			 * Put the packet on the pending queue.
12941da177e4SLinus Torvalds 			 */
12951da177e4SLinus Torvalds 			__skb_queue_tail(&sk->sk_write_queue, skb);
12961da177e4SLinus Torvalds 			continue;
12971da177e4SLinus Torvalds 		}
12981da177e4SLinus Torvalds 
12991da177e4SLinus Torvalds 		if (len > size)
13001da177e4SLinus Torvalds 			len = size;
1301be12a1feSHannes Frederic Sowa 
1302be12a1feSHannes Frederic Sowa 		if (skb_append_pagefrags(skb, page, offset, len)) {
13031da177e4SLinus Torvalds 			err = -EMSGSIZE;
13041da177e4SLinus Torvalds 			goto error;
13051da177e4SLinus Torvalds 		}
13061da177e4SLinus Torvalds 
13071da177e4SLinus Torvalds 		if (skb->ip_summed == CHECKSUM_NONE) {
130844bb9363SAl Viro 			__wsum csum;
13091da177e4SLinus Torvalds 			csum = csum_page(page, offset, len);
13101da177e4SLinus Torvalds 			skb->csum = csum_block_add(skb->csum, csum, skb->len);
13111da177e4SLinus Torvalds 		}
13121da177e4SLinus Torvalds 
13131da177e4SLinus Torvalds 		skb->len += len;
13141da177e4SLinus Torvalds 		skb->data_len += len;
13151e34a11dSDavid S. Miller 		skb->truesize += len;
13161e34a11dSDavid S. Miller 		atomic_add(len, &sk->sk_wmem_alloc);
13171da177e4SLinus Torvalds 		offset += len;
13181da177e4SLinus Torvalds 		size -= len;
13191da177e4SLinus Torvalds 	}
13201da177e4SLinus Torvalds 	return 0;
13211da177e4SLinus Torvalds 
13221da177e4SLinus Torvalds error:
1323bdc712b4SDavid S. Miller 	cork->length -= size;
13245e38e270SPavel Emelyanov 	IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTDISCARDS);
13251da177e4SLinus Torvalds 	return err;
13261da177e4SLinus Torvalds }
13271da177e4SLinus Torvalds 
13281470ddf7SHerbert Xu static void ip_cork_release(struct inet_cork *cork)
1329429f08e9SPavel Emelyanov {
13301470ddf7SHerbert Xu 	cork->flags &= ~IPCORK_OPT;
13311470ddf7SHerbert Xu 	kfree(cork->opt);
13321470ddf7SHerbert Xu 	cork->opt = NULL;
13331470ddf7SHerbert Xu 	dst_release(cork->dst);
13341470ddf7SHerbert Xu 	cork->dst = NULL;
1335429f08e9SPavel Emelyanov }
1336429f08e9SPavel Emelyanov 
13371da177e4SLinus Torvalds /*
13381da177e4SLinus Torvalds  *	Combined all pending IP fragments on the socket as one IP datagram
13391da177e4SLinus Torvalds  *	and push them out.
13401da177e4SLinus Torvalds  */
13411c32c5adSHerbert Xu struct sk_buff *__ip_make_skb(struct sock *sk,
134277968b78SDavid S. Miller 			      struct flowi4 *fl4,
13431470ddf7SHerbert Xu 			      struct sk_buff_head *queue,
13441470ddf7SHerbert Xu 			      struct inet_cork *cork)
13451da177e4SLinus Torvalds {
13461da177e4SLinus Torvalds 	struct sk_buff *skb, *tmp_skb;
13471da177e4SLinus Torvalds 	struct sk_buff **tail_skb;
13481da177e4SLinus Torvalds 	struct inet_sock *inet = inet_sk(sk);
13490388b004SPavel Emelyanov 	struct net *net = sock_net(sk);
13501da177e4SLinus Torvalds 	struct ip_options *opt = NULL;
13511470ddf7SHerbert Xu 	struct rtable *rt = (struct rtable *)cork->dst;
13521da177e4SLinus Torvalds 	struct iphdr *iph;
135376ab608dSAlexey Dobriyan 	__be16 df = 0;
13541da177e4SLinus Torvalds 	__u8 ttl;
13551da177e4SLinus Torvalds 
135651456b29SIan Morris 	skb = __skb_dequeue(queue);
135751456b29SIan Morris 	if (!skb)
13581da177e4SLinus Torvalds 		goto out;
13591da177e4SLinus Torvalds 	tail_skb = &(skb_shinfo(skb)->frag_list);
13601da177e4SLinus Torvalds 
13611da177e4SLinus Torvalds 	/* move skb->data to ip header from ext header */
1362d56f90a7SArnaldo Carvalho de Melo 	if (skb->data < skb_network_header(skb))
1363bbe735e4SArnaldo Carvalho de Melo 		__skb_pull(skb, skb_network_offset(skb));
13641470ddf7SHerbert Xu 	while ((tmp_skb = __skb_dequeue(queue)) != NULL) {
1365cfe1fc77SArnaldo Carvalho de Melo 		__skb_pull(tmp_skb, skb_network_header_len(skb));
13661da177e4SLinus Torvalds 		*tail_skb = tmp_skb;
13671da177e4SLinus Torvalds 		tail_skb = &(tmp_skb->next);
13681da177e4SLinus Torvalds 		skb->len += tmp_skb->len;
13691da177e4SLinus Torvalds 		skb->data_len += tmp_skb->len;
13701da177e4SLinus Torvalds 		skb->truesize += tmp_skb->truesize;
13711da177e4SLinus Torvalds 		tmp_skb->destructor = NULL;
13721da177e4SLinus Torvalds 		tmp_skb->sk = NULL;
13731da177e4SLinus Torvalds 	}
13741da177e4SLinus Torvalds 
13751da177e4SLinus Torvalds 	/* Unless user demanded real pmtu discovery (IP_PMTUDISC_DO), we allow
13761da177e4SLinus Torvalds 	 * to fragment the frame generated here. No matter, what transforms
13771da177e4SLinus Torvalds 	 * how transforms change size of the packet, it will come out.
13781da177e4SLinus Torvalds 	 */
137960ff7467SWANG Cong 	skb->ignore_df = ip_sk_ignore_df(sk);
13801da177e4SLinus Torvalds 
13811da177e4SLinus Torvalds 	/* DF bit is set when we want to see DF on outgoing frames.
138260ff7467SWANG Cong 	 * If ignore_df is set too, we still allow to fragment this frame
13831da177e4SLinus Torvalds 	 * locally. */
1384482fc609SHannes Frederic Sowa 	if (inet->pmtudisc == IP_PMTUDISC_DO ||
1385482fc609SHannes Frederic Sowa 	    inet->pmtudisc == IP_PMTUDISC_PROBE ||
1386d8d1f30bSChangli Gao 	    (skb->len <= dst_mtu(&rt->dst) &&
1387d8d1f30bSChangli Gao 	     ip_dont_fragment(sk, &rt->dst)))
13881da177e4SLinus Torvalds 		df = htons(IP_DF);
13891da177e4SLinus Torvalds 
13901470ddf7SHerbert Xu 	if (cork->flags & IPCORK_OPT)
13911470ddf7SHerbert Xu 		opt = cork->opt;
13921da177e4SLinus Torvalds 
1393aa661581SFrancesco Fusco 	if (cork->ttl != 0)
1394aa661581SFrancesco Fusco 		ttl = cork->ttl;
1395aa661581SFrancesco Fusco 	else if (rt->rt_type == RTN_MULTICAST)
13961da177e4SLinus Torvalds 		ttl = inet->mc_ttl;
13971da177e4SLinus Torvalds 	else
1398d8d1f30bSChangli Gao 		ttl = ip_select_ttl(inet, &rt->dst);
13991da177e4SLinus Torvalds 
1400749154aaSAnsis Atteka 	iph = ip_hdr(skb);
14011da177e4SLinus Torvalds 	iph->version = 4;
14021da177e4SLinus Torvalds 	iph->ihl = 5;
1403aa661581SFrancesco Fusco 	iph->tos = (cork->tos != -1) ? cork->tos : inet->tos;
14041da177e4SLinus Torvalds 	iph->frag_off = df;
14051da177e4SLinus Torvalds 	iph->ttl = ttl;
14061da177e4SLinus Torvalds 	iph->protocol = sk->sk_protocol;
140784f9307cSEric Dumazet 	ip_copy_addrs(iph, fl4);
1408b6a7719aSHannes Frederic Sowa 	ip_select_ident(net, skb, sk);
14091da177e4SLinus Torvalds 
141022f728f8SDavid S. Miller 	if (opt) {
141122f728f8SDavid S. Miller 		iph->ihl += opt->optlen>>2;
141222f728f8SDavid S. Miller 		ip_options_build(skb, opt, cork->addr, rt, 0);
141322f728f8SDavid S. Miller 	}
141422f728f8SDavid S. Miller 
1415aa661581SFrancesco Fusco 	skb->priority = (cork->tos != -1) ? cork->priority: sk->sk_priority;
14164a19ec58SLaszlo Attila Toth 	skb->mark = sk->sk_mark;
1417a21bba94SEric Dumazet 	/*
1418a21bba94SEric Dumazet 	 * Steal rt from cork.dst to avoid a pair of atomic_inc/atomic_dec
1419a21bba94SEric Dumazet 	 * on dst refcount
1420a21bba94SEric Dumazet 	 */
14211470ddf7SHerbert Xu 	cork->dst = NULL;
1422d8d1f30bSChangli Gao 	skb_dst_set(skb, &rt->dst);
14231da177e4SLinus Torvalds 
142496793b48SDavid L Stevens 	if (iph->protocol == IPPROTO_ICMP)
14250388b004SPavel Emelyanov 		icmp_out_count(net, ((struct icmphdr *)
142696793b48SDavid L Stevens 			skb_transport_header(skb))->type);
142796793b48SDavid L Stevens 
14281c32c5adSHerbert Xu 	ip_cork_release(cork);
14291c32c5adSHerbert Xu out:
14301c32c5adSHerbert Xu 	return skb;
14311c32c5adSHerbert Xu }
14321c32c5adSHerbert Xu 
1433b5ec8eeaSEric Dumazet int ip_send_skb(struct net *net, struct sk_buff *skb)
14341c32c5adSHerbert Xu {
14351c32c5adSHerbert Xu 	int err;
14361c32c5adSHerbert Xu 
143733224b16SEric W. Biederman 	err = ip_local_out(net, skb->sk, skb);
14381da177e4SLinus Torvalds 	if (err) {
14391da177e4SLinus Torvalds 		if (err > 0)
14406ce9e7b5SEric Dumazet 			err = net_xmit_errno(err);
14411da177e4SLinus Torvalds 		if (err)
14421c32c5adSHerbert Xu 			IP_INC_STATS(net, IPSTATS_MIB_OUTDISCARDS);
14431da177e4SLinus Torvalds 	}
14441da177e4SLinus Torvalds 
14451da177e4SLinus Torvalds 	return err;
14461da177e4SLinus Torvalds }
14471da177e4SLinus Torvalds 
144877968b78SDavid S. Miller int ip_push_pending_frames(struct sock *sk, struct flowi4 *fl4)
14491470ddf7SHerbert Xu {
14501c32c5adSHerbert Xu 	struct sk_buff *skb;
14511c32c5adSHerbert Xu 
145277968b78SDavid S. Miller 	skb = ip_finish_skb(sk, fl4);
14531c32c5adSHerbert Xu 	if (!skb)
14541c32c5adSHerbert Xu 		return 0;
14551c32c5adSHerbert Xu 
14561c32c5adSHerbert Xu 	/* Netfilter gets whole the not fragmented skb. */
1457b5ec8eeaSEric Dumazet 	return ip_send_skb(sock_net(sk), skb);
14581470ddf7SHerbert Xu }
14591470ddf7SHerbert Xu 
14601da177e4SLinus Torvalds /*
14611da177e4SLinus Torvalds  *	Throw away all pending data on the socket.
14621da177e4SLinus Torvalds  */
14631470ddf7SHerbert Xu static void __ip_flush_pending_frames(struct sock *sk,
14641470ddf7SHerbert Xu 				      struct sk_buff_head *queue,
14651470ddf7SHerbert Xu 				      struct inet_cork *cork)
14661da177e4SLinus Torvalds {
14671da177e4SLinus Torvalds 	struct sk_buff *skb;
14681da177e4SLinus Torvalds 
14691470ddf7SHerbert Xu 	while ((skb = __skb_dequeue_tail(queue)) != NULL)
14701da177e4SLinus Torvalds 		kfree_skb(skb);
14711da177e4SLinus Torvalds 
14721470ddf7SHerbert Xu 	ip_cork_release(cork);
14731470ddf7SHerbert Xu }
14741470ddf7SHerbert Xu 
14751470ddf7SHerbert Xu void ip_flush_pending_frames(struct sock *sk)
14761470ddf7SHerbert Xu {
1477bdc712b4SDavid S. Miller 	__ip_flush_pending_frames(sk, &sk->sk_write_queue, &inet_sk(sk)->cork.base);
14781da177e4SLinus Torvalds }
14791da177e4SLinus Torvalds 
14801c32c5adSHerbert Xu struct sk_buff *ip_make_skb(struct sock *sk,
148177968b78SDavid S. Miller 			    struct flowi4 *fl4,
14821c32c5adSHerbert Xu 			    int getfrag(void *from, char *to, int offset,
14831c32c5adSHerbert Xu 					int len, int odd, struct sk_buff *skb),
14841c32c5adSHerbert Xu 			    void *from, int length, int transhdrlen,
14851c32c5adSHerbert Xu 			    struct ipcm_cookie *ipc, struct rtable **rtp,
14861c32c5adSHerbert Xu 			    unsigned int flags)
14871c32c5adSHerbert Xu {
1488b80d7226SDavid S. Miller 	struct inet_cork cork;
14891c32c5adSHerbert Xu 	struct sk_buff_head queue;
14901c32c5adSHerbert Xu 	int err;
14911c32c5adSHerbert Xu 
14921c32c5adSHerbert Xu 	if (flags & MSG_PROBE)
14931c32c5adSHerbert Xu 		return NULL;
14941c32c5adSHerbert Xu 
14951c32c5adSHerbert Xu 	__skb_queue_head_init(&queue);
14961c32c5adSHerbert Xu 
1497b80d7226SDavid S. Miller 	cork.flags = 0;
1498b80d7226SDavid S. Miller 	cork.addr = 0;
149970652728SDavid S. Miller 	cork.opt = NULL;
15001c32c5adSHerbert Xu 	err = ip_setup_cork(sk, &cork, ipc, rtp);
15011c32c5adSHerbert Xu 	if (err)
15021c32c5adSHerbert Xu 		return ERR_PTR(err);
15031c32c5adSHerbert Xu 
15045640f768SEric Dumazet 	err = __ip_append_data(sk, fl4, &queue, &cork,
15055640f768SEric Dumazet 			       &current->task_frag, getfrag,
15061c32c5adSHerbert Xu 			       from, length, transhdrlen, flags);
15071c32c5adSHerbert Xu 	if (err) {
15081c32c5adSHerbert Xu 		__ip_flush_pending_frames(sk, &queue, &cork);
15091c32c5adSHerbert Xu 		return ERR_PTR(err);
15101c32c5adSHerbert Xu 	}
15111c32c5adSHerbert Xu 
151277968b78SDavid S. Miller 	return __ip_make_skb(sk, fl4, &queue, &cork);
15131c32c5adSHerbert Xu }
15141da177e4SLinus Torvalds 
15151da177e4SLinus Torvalds /*
15161da177e4SLinus Torvalds  *	Fetch data from kernel space and fill in checksum if needed.
15171da177e4SLinus Torvalds  */
15181da177e4SLinus Torvalds static int ip_reply_glue_bits(void *dptr, char *to, int offset,
15191da177e4SLinus Torvalds 			      int len, int odd, struct sk_buff *skb)
15201da177e4SLinus Torvalds {
15215084205fSAl Viro 	__wsum csum;
15221da177e4SLinus Torvalds 
15231da177e4SLinus Torvalds 	csum = csum_partial_copy_nocheck(dptr+offset, to, len, 0);
15241da177e4SLinus Torvalds 	skb->csum = csum_block_add(skb->csum, csum, odd);
15251da177e4SLinus Torvalds 	return 0;
15261da177e4SLinus Torvalds }
15271da177e4SLinus Torvalds 
15281da177e4SLinus Torvalds /*
15291da177e4SLinus Torvalds  *	Generic function to send a packet as reply to another packet.
1530be9f4a44SEric Dumazet  *	Used to send some TCP resets/acks so far.
15311da177e4SLinus Torvalds  */
1532bdbbb852SEric Dumazet void ip_send_unicast_reply(struct sock *sk, struct sk_buff *skb,
153324a2d43dSEric Dumazet 			   const struct ip_options *sopt,
153424a2d43dSEric Dumazet 			   __be32 daddr, __be32 saddr,
153524a2d43dSEric Dumazet 			   const struct ip_reply_arg *arg,
153670e73416SDavid S. Miller 			   unsigned int len)
15371da177e4SLinus Torvalds {
1538f6d8bd05SEric Dumazet 	struct ip_options_data replyopts;
15391da177e4SLinus Torvalds 	struct ipcm_cookie ipc;
154077968b78SDavid S. Miller 	struct flowi4 fl4;
1541511c3f92SEric Dumazet 	struct rtable *rt = skb_rtable(skb);
1542bdbbb852SEric Dumazet 	struct net *net = sock_net(sk);
1543be9f4a44SEric Dumazet 	struct sk_buff *nskb;
15444062090eSVasily Averin 	int err;
1545f7ba868bSDavid Ahern 	int oif;
15461da177e4SLinus Torvalds 
154724a2d43dSEric Dumazet 	if (__ip_options_echo(&replyopts.opt.opt, skb, sopt))
15481da177e4SLinus Torvalds 		return;
15491da177e4SLinus Torvalds 
15500a5ebb80SDavid S. Miller 	ipc.addr = daddr;
15511da177e4SLinus Torvalds 	ipc.opt = NULL;
15522244d07bSOliver Hartkopp 	ipc.tx_flags = 0;
1553aa661581SFrancesco Fusco 	ipc.ttl = 0;
1554aa661581SFrancesco Fusco 	ipc.tos = -1;
15551da177e4SLinus Torvalds 
1556f6d8bd05SEric Dumazet 	if (replyopts.opt.opt.optlen) {
15571da177e4SLinus Torvalds 		ipc.opt = &replyopts.opt;
15581da177e4SLinus Torvalds 
1559f6d8bd05SEric Dumazet 		if (replyopts.opt.opt.srr)
1560f6d8bd05SEric Dumazet 			daddr = replyopts.opt.opt.faddr;
15611da177e4SLinus Torvalds 	}
15621da177e4SLinus Torvalds 
1563f7ba868bSDavid Ahern 	oif = arg->bound_dev_if;
1564007979eaSDavid Ahern 	if (!oif && netif_index_is_l3_master(net, skb->skb_iif))
1565f7ba868bSDavid Ahern 		oif = skb->skb_iif;
1566f7ba868bSDavid Ahern 
1567f7ba868bSDavid Ahern 	flowi4_init_output(&fl4, oif,
1568e110861fSLorenzo Colitti 			   IP4_REPLY_MARK(net, skb->mark),
156966b13d99SEric Dumazet 			   RT_TOS(arg->tos),
1570be9f4a44SEric Dumazet 			   RT_SCOPE_UNIVERSE, ip_hdr(skb)->protocol,
1571538de0e0SDavid S. Miller 			   ip_reply_arg_flowi_flags(arg),
157270e73416SDavid S. Miller 			   daddr, saddr,
1573538de0e0SDavid S. Miller 			   tcp_hdr(skb)->source, tcp_hdr(skb)->dest);
15749d6ec938SDavid S. Miller 	security_skb_classify_flow(skb, flowi4_to_flowi(&fl4));
1575be9f4a44SEric Dumazet 	rt = ip_route_output_key(net, &fl4);
1576b23dd4feSDavid S. Miller 	if (IS_ERR(rt))
15771da177e4SLinus Torvalds 		return;
15781da177e4SLinus Torvalds 
1579bdbbb852SEric Dumazet 	inet_sk(sk)->tos = arg->tos;
15801da177e4SLinus Torvalds 
15811da177e4SLinus Torvalds 	sk->sk_priority = skb->priority;
1582eddc9ec5SArnaldo Carvalho de Melo 	sk->sk_protocol = ip_hdr(skb)->protocol;
1583f0e48dbfSPatrick McHardy 	sk->sk_bound_dev_if = arg->bound_dev_if;
1584be9f4a44SEric Dumazet 	sk->sk_sndbuf = sysctl_wmem_default;
15854062090eSVasily Averin 	err = ip_append_data(sk, &fl4, ip_reply_glue_bits, arg->iov->iov_base,
15864062090eSVasily Averin 			     len, 0, &ipc, &rt, MSG_DONTWAIT);
15874062090eSVasily Averin 	if (unlikely(err)) {
15884062090eSVasily Averin 		ip_flush_pending_frames(sk);
15894062090eSVasily Averin 		goto out;
15904062090eSVasily Averin 	}
15914062090eSVasily Averin 
1592be9f4a44SEric Dumazet 	nskb = skb_peek(&sk->sk_write_queue);
1593be9f4a44SEric Dumazet 	if (nskb) {
15941da177e4SLinus Torvalds 		if (arg->csumoffset >= 0)
1595be9f4a44SEric Dumazet 			*((__sum16 *)skb_transport_header(nskb) +
1596be9f4a44SEric Dumazet 			  arg->csumoffset) = csum_fold(csum_add(nskb->csum,
15979c70220bSArnaldo Carvalho de Melo 								arg->csum));
1598be9f4a44SEric Dumazet 		nskb->ip_summed = CHECKSUM_NONE;
1599be9f4a44SEric Dumazet 		skb_set_queue_mapping(nskb, skb_get_queue_mapping(skb));
160077968b78SDavid S. Miller 		ip_push_pending_frames(sk, &fl4);
16011da177e4SLinus Torvalds 	}
16024062090eSVasily Averin out:
16031da177e4SLinus Torvalds 	ip_rt_put(rt);
16041da177e4SLinus Torvalds }
16051da177e4SLinus Torvalds 
16061da177e4SLinus Torvalds void __init ip_init(void)
16071da177e4SLinus Torvalds {
16081da177e4SLinus Torvalds 	ip_rt_init();
16091da177e4SLinus Torvalds 	inet_initpeers();
16101da177e4SLinus Torvalds 
161172c1d3bdSWANG Cong #if defined(CONFIG_IP_MULTICAST)
161272c1d3bdSWANG Cong 	igmp_mc_init();
16131da177e4SLinus Torvalds #endif
16141da177e4SLinus Torvalds }
1615