xref: /openbmc/linux/net/ipv4/ip_output.c (revision f4180439109aa720774baafdd798b3234ab1a0d2)
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>
7614972cbdSRoopa Prabhu #include <net/lwtunnel.h>
771da177e4SLinus Torvalds #include <linux/igmp.h>
781da177e4SLinus Torvalds #include <linux/netfilter_ipv4.h>
791da177e4SLinus Torvalds #include <linux/netfilter_bridge.h>
801da177e4SLinus Torvalds #include <linux/netlink.h>
816cbb0df7SArnaldo Carvalho de Melo #include <linux/tcp.h>
821da177e4SLinus Torvalds 
83694869b3SEric W. Biederman static int
84694869b3SEric W. Biederman ip_fragment(struct net *net, struct sock *sk, struct sk_buff *skb,
85c5501eb3SFlorian Westphal 	    unsigned int mtu,
86694869b3SEric W. Biederman 	    int (*output)(struct net *, struct sock *, struct sk_buff *));
8749d16b23SAndy Zhou 
881da177e4SLinus Torvalds /* Generate a checksum for an outgoing IP datagram. */
892fbd9679SDenis Efremov void ip_send_check(struct iphdr *iph)
901da177e4SLinus Torvalds {
911da177e4SLinus Torvalds 	iph->check = 0;
921da177e4SLinus Torvalds 	iph->check = ip_fast_csum((unsigned char *)iph, iph->ihl);
931da177e4SLinus Torvalds }
944bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_send_check);
951da177e4SLinus Torvalds 
96cf91a99dSEric W. Biederman int __ip_local_out(struct net *net, struct sock *sk, struct sk_buff *skb)
97c439cb2eSHerbert Xu {
98c439cb2eSHerbert Xu 	struct iphdr *iph = ip_hdr(skb);
99c439cb2eSHerbert Xu 
100c439cb2eSHerbert Xu 	iph->tot_len = htons(skb->len);
101c439cb2eSHerbert Xu 	ip_send_check(iph);
102a8e3e1a9SDavid Ahern 
103a8e3e1a9SDavid Ahern 	/* if egress device is enslaved to an L3 master device pass the
104a8e3e1a9SDavid Ahern 	 * skb to its handler for processing
105a8e3e1a9SDavid Ahern 	 */
106a8e3e1a9SDavid Ahern 	skb = l3mdev_ip_out(sk, skb);
107a8e3e1a9SDavid Ahern 	if (unlikely(!skb))
108a8e3e1a9SDavid Ahern 		return 0;
109a8e3e1a9SDavid Ahern 
110*f4180439SEli Cooper 	skb->protocol = htons(ETH_P_IP);
111*f4180439SEli Cooper 
11229a26a56SEric W. Biederman 	return nf_hook(NFPROTO_IPV4, NF_INET_LOCAL_OUT,
11329a26a56SEric W. Biederman 		       net, sk, skb, NULL, skb_dst(skb)->dev,
11413206b6bSEric W. Biederman 		       dst_output);
1157026b1ddSDavid Miller }
1167026b1ddSDavid Miller 
11733224b16SEric W. Biederman int ip_local_out(struct net *net, struct sock *sk, struct sk_buff *skb)
118c439cb2eSHerbert Xu {
119c439cb2eSHerbert Xu 	int err;
120c439cb2eSHerbert Xu 
121cf91a99dSEric W. Biederman 	err = __ip_local_out(net, sk, skb);
122c439cb2eSHerbert Xu 	if (likely(err == 1))
12313206b6bSEric W. Biederman 		err = dst_output(net, sk, skb);
124c439cb2eSHerbert Xu 
125c439cb2eSHerbert Xu 	return err;
126c439cb2eSHerbert Xu }
127e2cb77dbSEric W. Biederman EXPORT_SYMBOL_GPL(ip_local_out);
128c439cb2eSHerbert Xu 
1291da177e4SLinus Torvalds static inline int ip_select_ttl(struct inet_sock *inet, struct dst_entry *dst)
1301da177e4SLinus Torvalds {
1311da177e4SLinus Torvalds 	int ttl = inet->uc_ttl;
1321da177e4SLinus Torvalds 
1331da177e4SLinus Torvalds 	if (ttl < 0)
134323e126fSDavid S. Miller 		ttl = ip4_dst_hoplimit(dst);
1351da177e4SLinus Torvalds 	return ttl;
1361da177e4SLinus Torvalds }
1371da177e4SLinus Torvalds 
1381da177e4SLinus Torvalds /*
1391da177e4SLinus Torvalds  *		Add an ip header to a skbuff and send it out.
1401da177e4SLinus Torvalds  *
1411da177e4SLinus Torvalds  */
142cfe673b0SEric Dumazet int ip_build_and_send_pkt(struct sk_buff *skb, const struct sock *sk,
143f6d8bd05SEric Dumazet 			  __be32 saddr, __be32 daddr, struct ip_options_rcu *opt)
1441da177e4SLinus Torvalds {
1451da177e4SLinus Torvalds 	struct inet_sock *inet = inet_sk(sk);
146511c3f92SEric Dumazet 	struct rtable *rt = skb_rtable(skb);
14777589ce0SEric W. Biederman 	struct net *net = sock_net(sk);
1481da177e4SLinus Torvalds 	struct iphdr *iph;
1491da177e4SLinus Torvalds 
1501da177e4SLinus Torvalds 	/* Build the IP header. */
151f6d8bd05SEric Dumazet 	skb_push(skb, sizeof(struct iphdr) + (opt ? opt->opt.optlen : 0));
1528856dfa3SArnaldo Carvalho de Melo 	skb_reset_network_header(skb);
153eddc9ec5SArnaldo Carvalho de Melo 	iph = ip_hdr(skb);
1541da177e4SLinus Torvalds 	iph->version  = 4;
1551da177e4SLinus Torvalds 	iph->ihl      = 5;
1561da177e4SLinus Torvalds 	iph->tos      = inet->tos;
157d8d1f30bSChangli Gao 	iph->ttl      = ip_select_ttl(inet, &rt->dst);
158dd927a26SDavid S. Miller 	iph->daddr    = (opt && opt->opt.srr ? opt->opt.faddr : daddr);
159dd927a26SDavid S. Miller 	iph->saddr    = saddr;
1601da177e4SLinus Torvalds 	iph->protocol = sk->sk_protocol;
161cfe673b0SEric Dumazet 	if (ip_dont_fragment(sk, &rt->dst)) {
162cfe673b0SEric Dumazet 		iph->frag_off = htons(IP_DF);
163cfe673b0SEric Dumazet 		iph->id = 0;
164cfe673b0SEric Dumazet 	} else {
165cfe673b0SEric Dumazet 		iph->frag_off = 0;
16677589ce0SEric W. Biederman 		__ip_select_ident(net, iph, 1);
167cfe673b0SEric Dumazet 	}
1681da177e4SLinus Torvalds 
169f6d8bd05SEric Dumazet 	if (opt && opt->opt.optlen) {
170f6d8bd05SEric Dumazet 		iph->ihl += opt->opt.optlen>>2;
171f6d8bd05SEric Dumazet 		ip_options_build(skb, &opt->opt, daddr, rt, 0);
1721da177e4SLinus Torvalds 	}
1731da177e4SLinus Torvalds 
1741da177e4SLinus Torvalds 	skb->priority = sk->sk_priority;
1754a19ec58SLaszlo Attila Toth 	skb->mark = sk->sk_mark;
1761da177e4SLinus Torvalds 
1771da177e4SLinus Torvalds 	/* Send it out. */
17833224b16SEric W. Biederman 	return ip_local_out(net, skb->sk, skb);
1791da177e4SLinus Torvalds }
180d8c97a94SArnaldo Carvalho de Melo EXPORT_SYMBOL_GPL(ip_build_and_send_pkt);
181d8c97a94SArnaldo Carvalho de Melo 
182694869b3SEric W. Biederman static int ip_finish_output2(struct net *net, struct sock *sk, struct sk_buff *skb)
1831da177e4SLinus Torvalds {
184adf30907SEric Dumazet 	struct dst_entry *dst = skb_dst(skb);
18580787ebcSMitsuru Chinen 	struct rtable *rt = (struct rtable *)dst;
1861da177e4SLinus Torvalds 	struct net_device *dev = dst->dev;
187c2636b4dSChuck Lever 	unsigned int hh_len = LL_RESERVED_SPACE(dev);
188f6b72b62SDavid S. Miller 	struct neighbour *neigh;
189a263b309SDavid S. Miller 	u32 nexthop;
1901da177e4SLinus Torvalds 
191edf391ffSNeil Horman 	if (rt->rt_type == RTN_MULTICAST) {
1924ba1bf42SEric W. Biederman 		IP_UPD_PO_STATS(net, IPSTATS_MIB_OUTMCAST, skb->len);
193edf391ffSNeil Horman 	} else if (rt->rt_type == RTN_BROADCAST)
1944ba1bf42SEric W. Biederman 		IP_UPD_PO_STATS(net, IPSTATS_MIB_OUTBCAST, skb->len);
19580787ebcSMitsuru Chinen 
1961da177e4SLinus Torvalds 	/* Be paranoid, rather than too clever. */
1973b04dddeSStephen Hemminger 	if (unlikely(skb_headroom(skb) < hh_len && dev->header_ops)) {
1981da177e4SLinus Torvalds 		struct sk_buff *skb2;
1991da177e4SLinus Torvalds 
2001da177e4SLinus Torvalds 		skb2 = skb_realloc_headroom(skb, LL_RESERVED_SPACE(dev));
20151456b29SIan Morris 		if (!skb2) {
2021da177e4SLinus Torvalds 			kfree_skb(skb);
2031da177e4SLinus Torvalds 			return -ENOMEM;
2041da177e4SLinus Torvalds 		}
2051da177e4SLinus Torvalds 		if (skb->sk)
2061da177e4SLinus Torvalds 			skb_set_owner_w(skb2, skb->sk);
2075d0ba55bSEric Dumazet 		consume_skb(skb);
2081da177e4SLinus Torvalds 		skb = skb2;
2091da177e4SLinus Torvalds 	}
2101da177e4SLinus Torvalds 
21114972cbdSRoopa Prabhu 	if (lwtunnel_xmit_redirect(dst->lwtstate)) {
21214972cbdSRoopa Prabhu 		int res = lwtunnel_xmit(skb);
21314972cbdSRoopa Prabhu 
21414972cbdSRoopa Prabhu 		if (res < 0 || res == LWTUNNEL_XMIT_DONE)
21514972cbdSRoopa Prabhu 			return res;
21614972cbdSRoopa Prabhu 	}
21714972cbdSRoopa Prabhu 
218a263b309SDavid S. Miller 	rcu_read_lock_bh();
219155e8336SJulian Anastasov 	nexthop = (__force u32) rt_nexthop(rt, ip_hdr(skb)->daddr);
220a263b309SDavid S. Miller 	neigh = __ipv4_neigh_lookup_noref(dev, nexthop);
221a263b309SDavid S. Miller 	if (unlikely(!neigh))
222a263b309SDavid S. Miller 		neigh = __neigh_create(&arp_tbl, &nexthop, dev, false);
2239871f1adSVasiliy Kulikov 	if (!IS_ERR(neigh)) {
2245110effeSDavid S. Miller 		int res = dst_neigh_output(dst, neigh, skb);
225f2c31e32SEric Dumazet 
226a263b309SDavid S. Miller 		rcu_read_unlock_bh();
227f2c31e32SEric Dumazet 		return res;
228f2c31e32SEric Dumazet 	}
229a263b309SDavid S. Miller 	rcu_read_unlock_bh();
23005e3aa09SDavid S. Miller 
231e87cc472SJoe Perches 	net_dbg_ratelimited("%s: No header cache and no neighbour!\n",
232e87cc472SJoe Perches 			    __func__);
2331da177e4SLinus Torvalds 	kfree_skb(skb);
2341da177e4SLinus Torvalds 	return -EINVAL;
2351da177e4SLinus Torvalds }
2361da177e4SLinus Torvalds 
237694869b3SEric W. Biederman static int ip_finish_output_gso(struct net *net, struct sock *sk,
238694869b3SEric W. Biederman 				struct sk_buff *skb, unsigned int mtu)
239c7ba65d7SFlorian Westphal {
240c7ba65d7SFlorian Westphal 	netdev_features_t features;
241c7ba65d7SFlorian Westphal 	struct sk_buff *segs;
242c7ba65d7SFlorian Westphal 	int ret = 0;
243c7ba65d7SFlorian Westphal 
2449ee6c5dcSLance Richardson 	/* common case: seglen is <= mtu
245359ebda2SShmulik Ladkani 	 */
2469ee6c5dcSLance Richardson 	if (skb_gso_validate_mtu(skb, mtu))
247694869b3SEric W. Biederman 		return ip_finish_output2(net, sk, skb);
248c7ba65d7SFlorian Westphal 
2490ace81ecSLance Richardson 	/* Slowpath -  GSO segment length exceeds the egress MTU.
250c7ba65d7SFlorian Westphal 	 *
2510ace81ecSLance Richardson 	 * This can happen in several cases:
2520ace81ecSLance Richardson 	 *  - Forwarding of a TCP GRO skb, when DF flag is not set.
2530ace81ecSLance Richardson 	 *  - Forwarding of an skb that arrived on a virtualization interface
2540ace81ecSLance Richardson 	 *    (virtio-net/vhost/tap) with TSO/GSO size set by other network
2550ace81ecSLance Richardson 	 *    stack.
2560ace81ecSLance Richardson 	 *  - Local GSO skb transmitted on an NETIF_F_TSO tunnel stacked over an
2570ace81ecSLance Richardson 	 *    interface with a smaller MTU.
2580ace81ecSLance Richardson 	 *  - Arriving GRO skb (or GSO skb in a virtualized environment) that is
2590ace81ecSLance Richardson 	 *    bridged to a NETIF_F_TSO tunnel stacked over an interface with an
2600ace81ecSLance Richardson 	 *    insufficent MTU.
261c7ba65d7SFlorian Westphal 	 */
262c7ba65d7SFlorian Westphal 	features = netif_skb_features(skb);
2639207f9d4SKonstantin Khlebnikov 	BUILD_BUG_ON(sizeof(*IPCB(skb)) > SKB_SGO_CB_OFFSET);
264c7ba65d7SFlorian Westphal 	segs = skb_gso_segment(skb, features & ~NETIF_F_GSO_MASK);
265330966e5SFlorian Westphal 	if (IS_ERR_OR_NULL(segs)) {
266c7ba65d7SFlorian Westphal 		kfree_skb(skb);
267c7ba65d7SFlorian Westphal 		return -ENOMEM;
268c7ba65d7SFlorian Westphal 	}
269c7ba65d7SFlorian Westphal 
270c7ba65d7SFlorian Westphal 	consume_skb(skb);
271c7ba65d7SFlorian Westphal 
272c7ba65d7SFlorian Westphal 	do {
273c7ba65d7SFlorian Westphal 		struct sk_buff *nskb = segs->next;
274c7ba65d7SFlorian Westphal 		int err;
275c7ba65d7SFlorian Westphal 
276c7ba65d7SFlorian Westphal 		segs->next = NULL;
277694869b3SEric W. Biederman 		err = ip_fragment(net, sk, segs, mtu, ip_finish_output2);
278c7ba65d7SFlorian Westphal 
279c7ba65d7SFlorian Westphal 		if (err && ret == 0)
280c7ba65d7SFlorian Westphal 			ret = err;
281c7ba65d7SFlorian Westphal 		segs = nskb;
282c7ba65d7SFlorian Westphal 	} while (segs);
283c7ba65d7SFlorian Westphal 
284c7ba65d7SFlorian Westphal 	return ret;
285c7ba65d7SFlorian Westphal }
286c7ba65d7SFlorian Westphal 
2870c4b51f0SEric W. Biederman static int ip_finish_output(struct net *net, struct sock *sk, struct sk_buff *skb)
2881da177e4SLinus Torvalds {
289c5501eb3SFlorian Westphal 	unsigned int mtu;
290c5501eb3SFlorian Westphal 
2915c901daaSPatrick McHardy #if defined(CONFIG_NETFILTER) && defined(CONFIG_XFRM)
2925c901daaSPatrick McHardy 	/* Policy lookup after SNAT yielded a new policy */
29300db4124SIan Morris 	if (skb_dst(skb)->xfrm) {
29448d5cad8SPatrick McHardy 		IPCB(skb)->flags |= IPSKB_REROUTED;
29513206b6bSEric W. Biederman 		return dst_output(net, sk, skb);
29648d5cad8SPatrick McHardy 	}
2975c901daaSPatrick McHardy #endif
298fedbb6b4SShmulik Ladkani 	mtu = ip_skb_dst_mtu(sk, skb);
299c7ba65d7SFlorian Westphal 	if (skb_is_gso(skb))
300694869b3SEric W. Biederman 		return ip_finish_output_gso(net, sk, skb, mtu);
301c7ba65d7SFlorian Westphal 
302d6b915e2SFlorian Westphal 	if (skb->len > mtu || (IPCB(skb)->flags & IPSKB_FRAG_PMTU))
303694869b3SEric W. Biederman 		return ip_fragment(net, sk, skb, mtu, ip_finish_output2);
304c7ba65d7SFlorian Westphal 
305694869b3SEric W. Biederman 	return ip_finish_output2(net, sk, skb);
3061da177e4SLinus Torvalds }
3071da177e4SLinus Torvalds 
308ede2059dSEric W. Biederman int ip_mc_output(struct net *net, struct sock *sk, struct sk_buff *skb)
3091da177e4SLinus Torvalds {
310511c3f92SEric Dumazet 	struct rtable *rt = skb_rtable(skb);
311d8d1f30bSChangli Gao 	struct net_device *dev = rt->dst.dev;
3121da177e4SLinus Torvalds 
3131da177e4SLinus Torvalds 	/*
3141da177e4SLinus Torvalds 	 *	If the indicated interface is up and running, send the packet.
3151da177e4SLinus Torvalds 	 */
31688f5cc24SEric W. Biederman 	IP_UPD_PO_STATS(net, IPSTATS_MIB_OUT, skb->len);
3171da177e4SLinus Torvalds 
3181da177e4SLinus Torvalds 	skb->dev = dev;
3191da177e4SLinus Torvalds 	skb->protocol = htons(ETH_P_IP);
3201da177e4SLinus Torvalds 
3211da177e4SLinus Torvalds 	/*
3221da177e4SLinus Torvalds 	 *	Multicasts are looped back for other local users
3231da177e4SLinus Torvalds 	 */
3241da177e4SLinus Torvalds 
3251da177e4SLinus Torvalds 	if (rt->rt_flags&RTCF_MULTICAST) {
3267ad6848cSOctavian Purdila 		if (sk_mc_loop(sk)
3271da177e4SLinus Torvalds #ifdef CONFIG_IP_MROUTE
3281da177e4SLinus Torvalds 		/* Small optimization: do not loopback not local frames,
3291da177e4SLinus Torvalds 		   which returned after forwarding; they will be  dropped
3301da177e4SLinus Torvalds 		   by ip_mr_input in any case.
3311da177e4SLinus Torvalds 		   Note, that local frames are looped back to be delivered
3321da177e4SLinus Torvalds 		   to local recipients.
3331da177e4SLinus Torvalds 
3341da177e4SLinus Torvalds 		   This check is duplicated in ip_mr_input at the moment.
3351da177e4SLinus Torvalds 		 */
3369d4fb27dSJoe Perches 		    &&
3379d4fb27dSJoe Perches 		    ((rt->rt_flags & RTCF_LOCAL) ||
3389d4fb27dSJoe Perches 		     !(IPCB(skb)->flags & IPSKB_FORWARDED))
3391da177e4SLinus Torvalds #endif
3401da177e4SLinus Torvalds 		   ) {
3411da177e4SLinus Torvalds 			struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC);
3421da177e4SLinus Torvalds 			if (newskb)
3439bbc768aSJan Engelhardt 				NF_HOOK(NFPROTO_IPV4, NF_INET_POST_ROUTING,
34429a26a56SEric W. Biederman 					net, sk, newskb, NULL, newskb->dev,
34595603e22SMichel Machado 					dev_loopback_xmit);
3461da177e4SLinus Torvalds 		}
3471da177e4SLinus Torvalds 
3481da177e4SLinus Torvalds 		/* Multicasts with ttl 0 must not go beyond the host */
3491da177e4SLinus Torvalds 
350eddc9ec5SArnaldo Carvalho de Melo 		if (ip_hdr(skb)->ttl == 0) {
3511da177e4SLinus Torvalds 			kfree_skb(skb);
3521da177e4SLinus Torvalds 			return 0;
3531da177e4SLinus Torvalds 		}
3541da177e4SLinus Torvalds 	}
3551da177e4SLinus Torvalds 
3561da177e4SLinus Torvalds 	if (rt->rt_flags&RTCF_BROADCAST) {
3571da177e4SLinus Torvalds 		struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC);
3581da177e4SLinus Torvalds 		if (newskb)
35929a26a56SEric W. Biederman 			NF_HOOK(NFPROTO_IPV4, NF_INET_POST_ROUTING,
36029a26a56SEric W. Biederman 				net, sk, newskb, NULL, newskb->dev,
36129a26a56SEric W. Biederman 				dev_loopback_xmit);
3621da177e4SLinus Torvalds 	}
3631da177e4SLinus Torvalds 
36429a26a56SEric W. Biederman 	return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING,
36529a26a56SEric W. Biederman 			    net, sk, skb, NULL, skb->dev,
36629a26a56SEric W. Biederman 			    ip_finish_output,
36748d5cad8SPatrick McHardy 			    !(IPCB(skb)->flags & IPSKB_REROUTED));
3681da177e4SLinus Torvalds }
3691da177e4SLinus Torvalds 
370ede2059dSEric W. Biederman int ip_output(struct net *net, struct sock *sk, struct sk_buff *skb)
3711da177e4SLinus Torvalds {
372adf30907SEric Dumazet 	struct net_device *dev = skb_dst(skb)->dev;
3731bd9bef6SPatrick McHardy 
37488f5cc24SEric W. Biederman 	IP_UPD_PO_STATS(net, IPSTATS_MIB_OUT, skb->len);
3751da177e4SLinus Torvalds 
3761bd9bef6SPatrick McHardy 	skb->dev = dev;
3771bd9bef6SPatrick McHardy 	skb->protocol = htons(ETH_P_IP);
3781bd9bef6SPatrick McHardy 
37929a26a56SEric W. Biederman 	return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING,
38029a26a56SEric W. Biederman 			    net, sk, skb, NULL, dev,
38148d5cad8SPatrick McHardy 			    ip_finish_output,
38248d5cad8SPatrick McHardy 			    !(IPCB(skb)->flags & IPSKB_REROUTED));
3831da177e4SLinus Torvalds }
3841da177e4SLinus Torvalds 
38584f9307cSEric Dumazet /*
38684f9307cSEric Dumazet  * copy saddr and daddr, possibly using 64bit load/stores
38784f9307cSEric Dumazet  * Equivalent to :
38884f9307cSEric Dumazet  *   iph->saddr = fl4->saddr;
38984f9307cSEric Dumazet  *   iph->daddr = fl4->daddr;
39084f9307cSEric Dumazet  */
39184f9307cSEric Dumazet static void ip_copy_addrs(struct iphdr *iph, const struct flowi4 *fl4)
39284f9307cSEric Dumazet {
39384f9307cSEric Dumazet 	BUILD_BUG_ON(offsetof(typeof(*fl4), daddr) !=
39484f9307cSEric Dumazet 		     offsetof(typeof(*fl4), saddr) + sizeof(fl4->saddr));
39584f9307cSEric Dumazet 	memcpy(&iph->saddr, &fl4->saddr,
39684f9307cSEric Dumazet 	       sizeof(fl4->saddr) + sizeof(fl4->daddr));
39784f9307cSEric Dumazet }
39884f9307cSEric Dumazet 
399b0270e91SEric Dumazet /* Note: skb->sk can be different from sk, in case of tunnels */
400b0270e91SEric Dumazet int ip_queue_xmit(struct sock *sk, struct sk_buff *skb, struct flowi *fl)
4011da177e4SLinus Torvalds {
4021da177e4SLinus Torvalds 	struct inet_sock *inet = inet_sk(sk);
40377589ce0SEric W. Biederman 	struct net *net = sock_net(sk);
404f6d8bd05SEric Dumazet 	struct ip_options_rcu *inet_opt;
405b57ae01aSDavid S. Miller 	struct flowi4 *fl4;
4061da177e4SLinus Torvalds 	struct rtable *rt;
4071da177e4SLinus Torvalds 	struct iphdr *iph;
408ab6e3febSEric Dumazet 	int res;
4091da177e4SLinus Torvalds 
4101da177e4SLinus Torvalds 	/* Skip all of this if the packet is already routed,
4111da177e4SLinus Torvalds 	 * f.e. by something like SCTP.
4121da177e4SLinus Torvalds 	 */
413ab6e3febSEric Dumazet 	rcu_read_lock();
414f6d8bd05SEric Dumazet 	inet_opt = rcu_dereference(inet->inet_opt);
415ea4fc0d6SDavid S. Miller 	fl4 = &fl->u.ip4;
416511c3f92SEric Dumazet 	rt = skb_rtable(skb);
41700db4124SIan Morris 	if (rt)
4181da177e4SLinus Torvalds 		goto packet_routed;
4191da177e4SLinus Torvalds 
4201da177e4SLinus Torvalds 	/* Make sure we can route this packet. */
4211da177e4SLinus Torvalds 	rt = (struct rtable *)__sk_dst_check(sk, 0);
42251456b29SIan Morris 	if (!rt) {
4233ca3c68eSAl Viro 		__be32 daddr;
4241da177e4SLinus Torvalds 
4251da177e4SLinus Torvalds 		/* Use correct destination address if we have options. */
426c720c7e8SEric Dumazet 		daddr = inet->inet_daddr;
427f6d8bd05SEric Dumazet 		if (inet_opt && inet_opt->opt.srr)
428f6d8bd05SEric Dumazet 			daddr = inet_opt->opt.faddr;
4291da177e4SLinus Torvalds 
4301da177e4SLinus Torvalds 		/* If this fails, retransmit mechanism of transport layer will
4311da177e4SLinus Torvalds 		 * keep trying until route appears or the connection times
4321da177e4SLinus Torvalds 		 * itself out.
4331da177e4SLinus Torvalds 		 */
43477589ce0SEric W. Biederman 		rt = ip_route_output_ports(net, fl4, sk,
43578fbfd8aSDavid S. Miller 					   daddr, inet->inet_saddr,
43678fbfd8aSDavid S. Miller 					   inet->inet_dport,
43778fbfd8aSDavid S. Miller 					   inet->inet_sport,
43878fbfd8aSDavid S. Miller 					   sk->sk_protocol,
43978fbfd8aSDavid S. Miller 					   RT_CONN_FLAGS(sk),
44078fbfd8aSDavid S. Miller 					   sk->sk_bound_dev_if);
441b23dd4feSDavid S. Miller 		if (IS_ERR(rt))
4421da177e4SLinus Torvalds 			goto no_route;
443d8d1f30bSChangli Gao 		sk_setup_caps(sk, &rt->dst);
4441da177e4SLinus Torvalds 	}
445d8d1f30bSChangli Gao 	skb_dst_set_noref(skb, &rt->dst);
4461da177e4SLinus Torvalds 
4471da177e4SLinus Torvalds packet_routed:
448155e8336SJulian Anastasov 	if (inet_opt && inet_opt->opt.is_strictroute && rt->rt_uses_gateway)
4491da177e4SLinus Torvalds 		goto no_route;
4501da177e4SLinus Torvalds 
4511da177e4SLinus Torvalds 	/* OK, we know where to send it, allocate and build IP header. */
452f6d8bd05SEric Dumazet 	skb_push(skb, sizeof(struct iphdr) + (inet_opt ? inet_opt->opt.optlen : 0));
4538856dfa3SArnaldo Carvalho de Melo 	skb_reset_network_header(skb);
454eddc9ec5SArnaldo Carvalho de Melo 	iph = ip_hdr(skb);
455714e85beSAl Viro 	*((__be16 *)iph) = htons((4 << 12) | (5 << 8) | (inet->tos & 0xff));
45660ff7467SWANG Cong 	if (ip_dont_fragment(sk, &rt->dst) && !skb->ignore_df)
4571da177e4SLinus Torvalds 		iph->frag_off = htons(IP_DF);
4581da177e4SLinus Torvalds 	else
4591da177e4SLinus Torvalds 		iph->frag_off = 0;
460d8d1f30bSChangli Gao 	iph->ttl      = ip_select_ttl(inet, &rt->dst);
4611da177e4SLinus Torvalds 	iph->protocol = sk->sk_protocol;
46284f9307cSEric Dumazet 	ip_copy_addrs(iph, fl4);
46384f9307cSEric Dumazet 
4641da177e4SLinus Torvalds 	/* Transport layer set skb->h.foo itself. */
4651da177e4SLinus Torvalds 
466f6d8bd05SEric Dumazet 	if (inet_opt && inet_opt->opt.optlen) {
467f6d8bd05SEric Dumazet 		iph->ihl += inet_opt->opt.optlen >> 2;
468f6d8bd05SEric Dumazet 		ip_options_build(skb, &inet_opt->opt, inet->inet_daddr, rt, 0);
4691da177e4SLinus Torvalds 	}
4701da177e4SLinus Torvalds 
47177589ce0SEric W. Biederman 	ip_select_ident_segs(net, skb, sk,
472b6a7719aSHannes Frederic Sowa 			     skb_shinfo(skb)->gso_segs ?: 1);
4731da177e4SLinus Torvalds 
474b0270e91SEric Dumazet 	/* TODO : should we use skb->sk here instead of sk ? */
4751da177e4SLinus Torvalds 	skb->priority = sk->sk_priority;
4764a19ec58SLaszlo Attila Toth 	skb->mark = sk->sk_mark;
4771da177e4SLinus Torvalds 
47833224b16SEric W. Biederman 	res = ip_local_out(net, sk, skb);
479ab6e3febSEric Dumazet 	rcu_read_unlock();
480ab6e3febSEric Dumazet 	return res;
4811da177e4SLinus Torvalds 
4821da177e4SLinus Torvalds no_route:
483ab6e3febSEric Dumazet 	rcu_read_unlock();
48477589ce0SEric W. Biederman 	IP_INC_STATS(net, IPSTATS_MIB_OUTNOROUTES);
4851da177e4SLinus Torvalds 	kfree_skb(skb);
4861da177e4SLinus Torvalds 	return -EHOSTUNREACH;
4871da177e4SLinus Torvalds }
4884bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_queue_xmit);
4891da177e4SLinus Torvalds 
4901da177e4SLinus Torvalds static void ip_copy_metadata(struct sk_buff *to, struct sk_buff *from)
4911da177e4SLinus Torvalds {
4921da177e4SLinus Torvalds 	to->pkt_type = from->pkt_type;
4931da177e4SLinus Torvalds 	to->priority = from->priority;
4941da177e4SLinus Torvalds 	to->protocol = from->protocol;
495adf30907SEric Dumazet 	skb_dst_drop(to);
496fe76cda3SEric Dumazet 	skb_dst_copy(to, from);
4971da177e4SLinus Torvalds 	to->dev = from->dev;
49882e91ffeSThomas Graf 	to->mark = from->mark;
4991da177e4SLinus Torvalds 
5001da177e4SLinus Torvalds 	/* Copy the flags to each fragment. */
5011da177e4SLinus Torvalds 	IPCB(to)->flags = IPCB(from)->flags;
5021da177e4SLinus Torvalds 
5031da177e4SLinus Torvalds #ifdef CONFIG_NET_SCHED
5041da177e4SLinus Torvalds 	to->tc_index = from->tc_index;
5051da177e4SLinus Torvalds #endif
506e7ac05f3SYasuyuki Kozakai 	nf_copy(to, from);
5076ca40d4eSJavier Martinez Canillas #if IS_ENABLED(CONFIG_IP_VS)
508c98d80edSJulian Anastasov 	to->ipvs_property = from->ipvs_property;
509c98d80edSJulian Anastasov #endif
510984bc16cSJames Morris 	skb_copy_secmark(to, from);
5111da177e4SLinus Torvalds }
5121da177e4SLinus Torvalds 
513694869b3SEric W. Biederman static int ip_fragment(struct net *net, struct sock *sk, struct sk_buff *skb,
514c5501eb3SFlorian Westphal 		       unsigned int mtu,
515694869b3SEric W. Biederman 		       int (*output)(struct net *, struct sock *, struct sk_buff *))
51649d16b23SAndy Zhou {
51749d16b23SAndy Zhou 	struct iphdr *iph = ip_hdr(skb);
51849d16b23SAndy Zhou 
519d6b915e2SFlorian Westphal 	if ((iph->frag_off & htons(IP_DF)) == 0)
520694869b3SEric W. Biederman 		return ip_do_fragment(net, sk, skb, output);
521d6b915e2SFlorian Westphal 
522d6b915e2SFlorian Westphal 	if (unlikely(!skb->ignore_df ||
52349d16b23SAndy Zhou 		     (IPCB(skb)->frag_max_size &&
52449d16b23SAndy Zhou 		      IPCB(skb)->frag_max_size > mtu))) {
5259479b0afSEric W. Biederman 		IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS);
52649d16b23SAndy Zhou 		icmp_send(skb, ICMP_DEST_UNREACH, ICMP_FRAG_NEEDED,
52749d16b23SAndy Zhou 			  htonl(mtu));
52849d16b23SAndy Zhou 		kfree_skb(skb);
52949d16b23SAndy Zhou 		return -EMSGSIZE;
53049d16b23SAndy Zhou 	}
53149d16b23SAndy Zhou 
532694869b3SEric W. Biederman 	return ip_do_fragment(net, sk, skb, output);
53349d16b23SAndy Zhou }
53449d16b23SAndy Zhou 
5351da177e4SLinus Torvalds /*
5361da177e4SLinus Torvalds  *	This IP datagram is too large to be sent in one piece.  Break it up into
5371da177e4SLinus Torvalds  *	smaller pieces (each of size equal to IP header plus
5381da177e4SLinus Torvalds  *	a block of the data of the original IP data part) that will yet fit in a
5391da177e4SLinus Torvalds  *	single device frame, and queue such a frame for sending.
5401da177e4SLinus Torvalds  */
5411da177e4SLinus Torvalds 
542694869b3SEric W. Biederman int ip_do_fragment(struct net *net, struct sock *sk, struct sk_buff *skb,
543694869b3SEric W. Biederman 		   int (*output)(struct net *, struct sock *, struct sk_buff *))
5441da177e4SLinus Torvalds {
5451da177e4SLinus Torvalds 	struct iphdr *iph;
5461da177e4SLinus Torvalds 	int ptr;
5471da177e4SLinus Torvalds 	struct sk_buff *skb2;
548c893b806SChangli Gao 	unsigned int mtu, hlen, left, len, ll_rs;
5491da177e4SLinus Torvalds 	int offset;
55076ab608dSAlexey Dobriyan 	__be16 not_last_frag;
551511c3f92SEric Dumazet 	struct rtable *rt = skb_rtable(skb);
5521da177e4SLinus Torvalds 	int err = 0;
5531da177e4SLinus Torvalds 
554dbd3393cSHannes Frederic Sowa 	/* for offloaded checksums cleanup checksum before fragmentation */
555dbd3393cSHannes Frederic Sowa 	if (skb->ip_summed == CHECKSUM_PARTIAL &&
556dbd3393cSHannes Frederic Sowa 	    (err = skb_checksum_help(skb)))
557dbd3393cSHannes Frederic Sowa 		goto fail;
558dbd3393cSHannes Frederic Sowa 
5591da177e4SLinus Torvalds 	/*
5601da177e4SLinus Torvalds 	 *	Point into the IP datagram header.
5611da177e4SLinus Torvalds 	 */
5621da177e4SLinus Torvalds 
563eddc9ec5SArnaldo Carvalho de Melo 	iph = ip_hdr(skb);
5641da177e4SLinus Torvalds 
565fedbb6b4SShmulik Ladkani 	mtu = ip_skb_dst_mtu(sk, skb);
566d6b915e2SFlorian Westphal 	if (IPCB(skb)->frag_max_size && IPCB(skb)->frag_max_size < mtu)
567d6b915e2SFlorian Westphal 		mtu = IPCB(skb)->frag_max_size;
5681da177e4SLinus Torvalds 
5691da177e4SLinus Torvalds 	/*
5701da177e4SLinus Torvalds 	 *	Setup starting values.
5711da177e4SLinus Torvalds 	 */
5721da177e4SLinus Torvalds 
5731da177e4SLinus Torvalds 	hlen = iph->ihl * 4;
574f87c10a8SHannes Frederic Sowa 	mtu = mtu - hlen;	/* Size of data space */
57589cee8b1SHerbert Xu 	IPCB(skb)->flags |= IPSKB_FRAG_COMPLETE;
5761da177e4SLinus Torvalds 
5771da177e4SLinus Torvalds 	/* When frag_list is given, use it. First, check its validity:
5781da177e4SLinus Torvalds 	 * some transformers could create wrong frag_list or break existing
5791da177e4SLinus Torvalds 	 * one, it is not prohibited. In this case fall back to copying.
5801da177e4SLinus Torvalds 	 *
5811da177e4SLinus Torvalds 	 * LATER: this step can be merged to real generation of fragments,
5821da177e4SLinus Torvalds 	 * we can switch to copy when see the first bad fragment.
5831da177e4SLinus Torvalds 	 */
58421dc3301SDavid S. Miller 	if (skb_has_frag_list(skb)) {
5853d13008eSEric Dumazet 		struct sk_buff *frag, *frag2;
5861da177e4SLinus Torvalds 		int first_len = skb_pagelen(skb);
5871da177e4SLinus Torvalds 
5881da177e4SLinus Torvalds 		if (first_len - hlen > mtu ||
5891da177e4SLinus Torvalds 		    ((first_len - hlen) & 7) ||
59056f8a75cSPaul Gortmaker 		    ip_is_fragment(iph) ||
5911da177e4SLinus Torvalds 		    skb_cloned(skb))
5921da177e4SLinus Torvalds 			goto slow_path;
5931da177e4SLinus Torvalds 
594d7fcf1a5SDavid S. Miller 		skb_walk_frags(skb, frag) {
5951da177e4SLinus Torvalds 			/* Correct geometry. */
5961da177e4SLinus Torvalds 			if (frag->len > mtu ||
5971da177e4SLinus Torvalds 			    ((frag->len & 7) && frag->next) ||
5981da177e4SLinus Torvalds 			    skb_headroom(frag) < hlen)
5993d13008eSEric Dumazet 				goto slow_path_clean;
6001da177e4SLinus Torvalds 
6011da177e4SLinus Torvalds 			/* Partially cloned skb? */
6021da177e4SLinus Torvalds 			if (skb_shared(frag))
6033d13008eSEric Dumazet 				goto slow_path_clean;
6042fdba6b0SHerbert Xu 
6052fdba6b0SHerbert Xu 			BUG_ON(frag->sk);
6062fdba6b0SHerbert Xu 			if (skb->sk) {
6072fdba6b0SHerbert Xu 				frag->sk = skb->sk;
6082fdba6b0SHerbert Xu 				frag->destructor = sock_wfree;
6092fdba6b0SHerbert Xu 			}
6103d13008eSEric Dumazet 			skb->truesize -= frag->truesize;
6111da177e4SLinus Torvalds 		}
6121da177e4SLinus Torvalds 
6131da177e4SLinus Torvalds 		/* Everything is OK. Generate! */
6141da177e4SLinus Torvalds 
6151da177e4SLinus Torvalds 		err = 0;
6161da177e4SLinus Torvalds 		offset = 0;
6171da177e4SLinus Torvalds 		frag = skb_shinfo(skb)->frag_list;
618d7fcf1a5SDavid S. Miller 		skb_frag_list_init(skb);
6191da177e4SLinus Torvalds 		skb->data_len = first_len - skb_headlen(skb);
6201da177e4SLinus Torvalds 		skb->len = first_len;
6211da177e4SLinus Torvalds 		iph->tot_len = htons(first_len);
6221da177e4SLinus Torvalds 		iph->frag_off = htons(IP_MF);
6231da177e4SLinus Torvalds 		ip_send_check(iph);
6241da177e4SLinus Torvalds 
6251da177e4SLinus Torvalds 		for (;;) {
6261da177e4SLinus Torvalds 			/* Prepare header of the next frame,
6271da177e4SLinus Torvalds 			 * before previous one went down. */
6281da177e4SLinus Torvalds 			if (frag) {
6291da177e4SLinus Torvalds 				frag->ip_summed = CHECKSUM_NONE;
630badff6d0SArnaldo Carvalho de Melo 				skb_reset_transport_header(frag);
631e2d1bca7SArnaldo Carvalho de Melo 				__skb_push(frag, hlen);
632e2d1bca7SArnaldo Carvalho de Melo 				skb_reset_network_header(frag);
633d56f90a7SArnaldo Carvalho de Melo 				memcpy(skb_network_header(frag), iph, hlen);
634eddc9ec5SArnaldo Carvalho de Melo 				iph = ip_hdr(frag);
6351da177e4SLinus Torvalds 				iph->tot_len = htons(frag->len);
6361da177e4SLinus Torvalds 				ip_copy_metadata(frag, skb);
6371da177e4SLinus Torvalds 				if (offset == 0)
6381da177e4SLinus Torvalds 					ip_options_fragment(frag);
6391da177e4SLinus Torvalds 				offset += skb->len - hlen;
6401da177e4SLinus Torvalds 				iph->frag_off = htons(offset>>3);
64100db4124SIan Morris 				if (frag->next)
6421da177e4SLinus Torvalds 					iph->frag_off |= htons(IP_MF);
6431da177e4SLinus Torvalds 				/* Ready, complete checksum */
6441da177e4SLinus Torvalds 				ip_send_check(iph);
6451da177e4SLinus Torvalds 			}
6461da177e4SLinus Torvalds 
647694869b3SEric W. Biederman 			err = output(net, sk, skb);
6481da177e4SLinus Torvalds 
649dafee490SWei Dong 			if (!err)
65026a949dbSEric W. Biederman 				IP_INC_STATS(net, IPSTATS_MIB_FRAGCREATES);
6511da177e4SLinus Torvalds 			if (err || !frag)
6521da177e4SLinus Torvalds 				break;
6531da177e4SLinus Torvalds 
6541da177e4SLinus Torvalds 			skb = frag;
6551da177e4SLinus Torvalds 			frag = skb->next;
6561da177e4SLinus Torvalds 			skb->next = NULL;
6571da177e4SLinus Torvalds 		}
6581da177e4SLinus Torvalds 
6591da177e4SLinus Torvalds 		if (err == 0) {
66026a949dbSEric W. Biederman 			IP_INC_STATS(net, IPSTATS_MIB_FRAGOKS);
6611da177e4SLinus Torvalds 			return 0;
6621da177e4SLinus Torvalds 		}
6631da177e4SLinus Torvalds 
6641da177e4SLinus Torvalds 		while (frag) {
6651da177e4SLinus Torvalds 			skb = frag->next;
6661da177e4SLinus Torvalds 			kfree_skb(frag);
6671da177e4SLinus Torvalds 			frag = skb;
6681da177e4SLinus Torvalds 		}
66926a949dbSEric W. Biederman 		IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS);
6701da177e4SLinus Torvalds 		return err;
6713d13008eSEric Dumazet 
6723d13008eSEric Dumazet slow_path_clean:
6733d13008eSEric Dumazet 		skb_walk_frags(skb, frag2) {
6743d13008eSEric Dumazet 			if (frag2 == frag)
6753d13008eSEric Dumazet 				break;
6763d13008eSEric Dumazet 			frag2->sk = NULL;
6773d13008eSEric Dumazet 			frag2->destructor = NULL;
6783d13008eSEric Dumazet 			skb->truesize += frag2->truesize;
6793d13008eSEric Dumazet 		}
6801da177e4SLinus Torvalds 	}
6811da177e4SLinus Torvalds 
6821da177e4SLinus Torvalds slow_path:
683c9af6db4SPravin B Shelar 	iph = ip_hdr(skb);
684fc70fb64SAlexander Duyck 
6851da177e4SLinus Torvalds 	left = skb->len - hlen;		/* Space per frame */
68649085bd7SGeorge Kadianakis 	ptr = hlen;		/* Where to start from */
6871da177e4SLinus Torvalds 
6888d045163SFlorian Westphal 	ll_rs = LL_RESERVED_SPACE(rt->dst.dev);
6899bcfcaf5SStephen Hemminger 
6901da177e4SLinus Torvalds 	/*
6911da177e4SLinus Torvalds 	 *	Fragment the datagram.
6921da177e4SLinus Torvalds 	 */
6931da177e4SLinus Torvalds 
6941da177e4SLinus Torvalds 	offset = (ntohs(iph->frag_off) & IP_OFFSET) << 3;
6951da177e4SLinus Torvalds 	not_last_frag = iph->frag_off & htons(IP_MF);
6961da177e4SLinus Torvalds 
6971da177e4SLinus Torvalds 	/*
6981da177e4SLinus Torvalds 	 *	Keep copying data until we run out.
6991da177e4SLinus Torvalds 	 */
7001da177e4SLinus Torvalds 
7011da177e4SLinus Torvalds 	while (left > 0) {
7021da177e4SLinus Torvalds 		len = left;
7031da177e4SLinus Torvalds 		/* IF: it doesn't fit, use 'mtu' - the data space left */
7041da177e4SLinus Torvalds 		if (len > mtu)
7051da177e4SLinus Torvalds 			len = mtu;
7061da177e4SLinus Torvalds 		/* IF: we are not sending up to and including the packet end
7071da177e4SLinus Torvalds 		   then align the next start on an eight byte boundary */
7081da177e4SLinus Torvalds 		if (len < left)	{
7091da177e4SLinus Torvalds 			len &= ~7;
7101da177e4SLinus Torvalds 		}
7111da177e4SLinus Torvalds 
712cbffccc9SJoe Perches 		/* Allocate buffer */
713cbffccc9SJoe Perches 		skb2 = alloc_skb(len + hlen + ll_rs, GFP_ATOMIC);
714cbffccc9SJoe Perches 		if (!skb2) {
7151da177e4SLinus Torvalds 			err = -ENOMEM;
7161da177e4SLinus Torvalds 			goto fail;
7171da177e4SLinus Torvalds 		}
7181da177e4SLinus Torvalds 
7191da177e4SLinus Torvalds 		/*
7201da177e4SLinus Torvalds 		 *	Set up data on packet
7211da177e4SLinus Torvalds 		 */
7221da177e4SLinus Torvalds 
7231da177e4SLinus Torvalds 		ip_copy_metadata(skb2, skb);
7241da177e4SLinus Torvalds 		skb_reserve(skb2, ll_rs);
7251da177e4SLinus Torvalds 		skb_put(skb2, len + hlen);
726c1d2bbe1SArnaldo Carvalho de Melo 		skb_reset_network_header(skb2);
727b0e380b1SArnaldo Carvalho de Melo 		skb2->transport_header = skb2->network_header + hlen;
7281da177e4SLinus Torvalds 
7291da177e4SLinus Torvalds 		/*
7301da177e4SLinus Torvalds 		 *	Charge the memory for the fragment to any owner
7311da177e4SLinus Torvalds 		 *	it might possess
7321da177e4SLinus Torvalds 		 */
7331da177e4SLinus Torvalds 
7341da177e4SLinus Torvalds 		if (skb->sk)
7351da177e4SLinus Torvalds 			skb_set_owner_w(skb2, skb->sk);
7361da177e4SLinus Torvalds 
7371da177e4SLinus Torvalds 		/*
7381da177e4SLinus Torvalds 		 *	Copy the packet header into the new buffer.
7391da177e4SLinus Torvalds 		 */
7401da177e4SLinus Torvalds 
741d626f62bSArnaldo Carvalho de Melo 		skb_copy_from_linear_data(skb, skb_network_header(skb2), hlen);
7421da177e4SLinus Torvalds 
7431da177e4SLinus Torvalds 		/*
7441da177e4SLinus Torvalds 		 *	Copy a block of the IP datagram.
7451da177e4SLinus Torvalds 		 */
746bff9b61cSArnaldo Carvalho de Melo 		if (skb_copy_bits(skb, ptr, skb_transport_header(skb2), len))
7471da177e4SLinus Torvalds 			BUG();
7481da177e4SLinus Torvalds 		left -= len;
7491da177e4SLinus Torvalds 
7501da177e4SLinus Torvalds 		/*
7511da177e4SLinus Torvalds 		 *	Fill in the new header fields.
7521da177e4SLinus Torvalds 		 */
753eddc9ec5SArnaldo Carvalho de Melo 		iph = ip_hdr(skb2);
7541da177e4SLinus Torvalds 		iph->frag_off = htons((offset >> 3));
7551da177e4SLinus Torvalds 
756d6b915e2SFlorian Westphal 		if (IPCB(skb)->flags & IPSKB_FRAG_PMTU)
757d6b915e2SFlorian Westphal 			iph->frag_off |= htons(IP_DF);
758d6b915e2SFlorian Westphal 
7591da177e4SLinus Torvalds 		/* ANK: dirty, but effective trick. Upgrade options only if
7601da177e4SLinus Torvalds 		 * the segment to be fragmented was THE FIRST (otherwise,
7611da177e4SLinus Torvalds 		 * options are already fixed) and make it ONCE
7621da177e4SLinus Torvalds 		 * on the initial skb, so that all the following fragments
7631da177e4SLinus Torvalds 		 * will inherit fixed options.
7641da177e4SLinus Torvalds 		 */
7651da177e4SLinus Torvalds 		if (offset == 0)
7661da177e4SLinus Torvalds 			ip_options_fragment(skb);
7671da177e4SLinus Torvalds 
7681da177e4SLinus Torvalds 		/*
7691da177e4SLinus Torvalds 		 *	Added AC : If we are fragmenting a fragment that's not the
7701da177e4SLinus Torvalds 		 *		   last fragment then keep MF on each bit
7711da177e4SLinus Torvalds 		 */
7721da177e4SLinus Torvalds 		if (left > 0 || not_last_frag)
7731da177e4SLinus Torvalds 			iph->frag_off |= htons(IP_MF);
7741da177e4SLinus Torvalds 		ptr += len;
7751da177e4SLinus Torvalds 		offset += len;
7761da177e4SLinus Torvalds 
7771da177e4SLinus Torvalds 		/*
7781da177e4SLinus Torvalds 		 *	Put this fragment into the sending queue.
7791da177e4SLinus Torvalds 		 */
7801da177e4SLinus Torvalds 		iph->tot_len = htons(len + hlen);
7811da177e4SLinus Torvalds 
7821da177e4SLinus Torvalds 		ip_send_check(iph);
7831da177e4SLinus Torvalds 
784694869b3SEric W. Biederman 		err = output(net, sk, skb2);
7851da177e4SLinus Torvalds 		if (err)
7861da177e4SLinus Torvalds 			goto fail;
787dafee490SWei Dong 
78826a949dbSEric W. Biederman 		IP_INC_STATS(net, IPSTATS_MIB_FRAGCREATES);
7891da177e4SLinus Torvalds 	}
7905d0ba55bSEric Dumazet 	consume_skb(skb);
79126a949dbSEric W. Biederman 	IP_INC_STATS(net, IPSTATS_MIB_FRAGOKS);
7921da177e4SLinus Torvalds 	return err;
7931da177e4SLinus Torvalds 
7941da177e4SLinus Torvalds fail:
7951da177e4SLinus Torvalds 	kfree_skb(skb);
79626a949dbSEric W. Biederman 	IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS);
7971da177e4SLinus Torvalds 	return err;
7981da177e4SLinus Torvalds }
79949d16b23SAndy Zhou EXPORT_SYMBOL(ip_do_fragment);
8002e2f7aefSPatrick McHardy 
8011da177e4SLinus Torvalds int
8021da177e4SLinus Torvalds ip_generic_getfrag(void *from, char *to, int offset, int len, int odd, struct sk_buff *skb)
8031da177e4SLinus Torvalds {
804f69e6d13SAl Viro 	struct msghdr *msg = from;
8051da177e4SLinus Torvalds 
80684fa7933SPatrick McHardy 	if (skb->ip_summed == CHECKSUM_PARTIAL) {
80721226abbSAl Viro 		if (copy_from_iter(to, len, &msg->msg_iter) != len)
8081da177e4SLinus Torvalds 			return -EFAULT;
8091da177e4SLinus Torvalds 	} else {
81044bb9363SAl Viro 		__wsum csum = 0;
81121226abbSAl Viro 		if (csum_and_copy_from_iter(to, len, &csum, &msg->msg_iter) != len)
8121da177e4SLinus Torvalds 			return -EFAULT;
8131da177e4SLinus Torvalds 		skb->csum = csum_block_add(skb->csum, csum, odd);
8141da177e4SLinus Torvalds 	}
8151da177e4SLinus Torvalds 	return 0;
8161da177e4SLinus Torvalds }
8174bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_generic_getfrag);
8181da177e4SLinus Torvalds 
81944bb9363SAl Viro static inline __wsum
8201da177e4SLinus Torvalds csum_page(struct page *page, int offset, int copy)
8211da177e4SLinus Torvalds {
8221da177e4SLinus Torvalds 	char *kaddr;
82344bb9363SAl Viro 	__wsum csum;
8241da177e4SLinus Torvalds 	kaddr = kmap(page);
8251da177e4SLinus Torvalds 	csum = csum_partial(kaddr + offset, copy, 0);
8261da177e4SLinus Torvalds 	kunmap(page);
8271da177e4SLinus Torvalds 	return csum;
8281da177e4SLinus Torvalds }
8291da177e4SLinus Torvalds 
8304b30b1c6SAdrian Bunk static inline int ip_ufo_append_data(struct sock *sk,
8311470ddf7SHerbert Xu 			struct sk_buff_head *queue,
832e89e9cf5SAnanda Raju 			int getfrag(void *from, char *to, int offset, int len,
833e89e9cf5SAnanda Raju 			       int odd, struct sk_buff *skb),
834e89e9cf5SAnanda Raju 			void *from, int length, int hh_len, int fragheaderlen,
835d9be4f7aSBill Sommerfeld 			int transhdrlen, int maxfraglen, unsigned int flags)
836e89e9cf5SAnanda Raju {
837e89e9cf5SAnanda Raju 	struct sk_buff *skb;
838e89e9cf5SAnanda Raju 	int err;
839e89e9cf5SAnanda Raju 
840e89e9cf5SAnanda Raju 	/* There is support for UDP fragmentation offload by network
841e89e9cf5SAnanda Raju 	 * device, so create one single skb packet containing complete
842e89e9cf5SAnanda Raju 	 * udp datagram
843e89e9cf5SAnanda Raju 	 */
84451456b29SIan Morris 	skb = skb_peek_tail(queue);
84551456b29SIan Morris 	if (!skb) {
846e89e9cf5SAnanda Raju 		skb = sock_alloc_send_skb(sk,
847e89e9cf5SAnanda Raju 			hh_len + fragheaderlen + transhdrlen + 20,
848e89e9cf5SAnanda Raju 			(flags & MSG_DONTWAIT), &err);
849e89e9cf5SAnanda Raju 
85051456b29SIan Morris 		if (!skb)
851e89e9cf5SAnanda Raju 			return err;
852e89e9cf5SAnanda Raju 
853e89e9cf5SAnanda Raju 		/* reserve space for Hardware header */
854e89e9cf5SAnanda Raju 		skb_reserve(skb, hh_len);
855e89e9cf5SAnanda Raju 
856e89e9cf5SAnanda Raju 		/* create space for UDP/IP header */
857e89e9cf5SAnanda Raju 		skb_put(skb, fragheaderlen + transhdrlen);
858e89e9cf5SAnanda Raju 
859e89e9cf5SAnanda Raju 		/* initialize network header pointer */
860c1d2bbe1SArnaldo Carvalho de Melo 		skb_reset_network_header(skb);
861e89e9cf5SAnanda Raju 
862e89e9cf5SAnanda Raju 		/* initialize protocol header pointer */
863b0e380b1SArnaldo Carvalho de Melo 		skb->transport_header = skb->network_header + fragheaderlen;
864e89e9cf5SAnanda Raju 
865e89e9cf5SAnanda Raju 		skb->csum = 0;
866e89e9cf5SAnanda Raju 
867e93b7d74SJiri Pirko 		__skb_queue_tail(queue, skb);
868e93b7d74SJiri Pirko 	} else if (skb_is_gso(skb)) {
869e93b7d74SJiri Pirko 		goto append;
870e93b7d74SJiri Pirko 	}
871e93b7d74SJiri Pirko 
872e93b7d74SJiri Pirko 	skb->ip_summed = CHECKSUM_PARTIAL;
873e89e9cf5SAnanda Raju 	/* specify the length of each IP datagram fragment */
874d9be4f7aSBill Sommerfeld 	skb_shinfo(skb)->gso_size = maxfraglen - fragheaderlen;
875f83ef8c0SHerbert Xu 	skb_shinfo(skb)->gso_type = SKB_GSO_UDP;
876be9164e7SKostya B 
877e93b7d74SJiri Pirko append:
878be9164e7SKostya B 	return skb_append_datato_frags(sk, skb, getfrag, from,
879be9164e7SKostya B 				       (length - transhdrlen));
880e89e9cf5SAnanda Raju }
881e89e9cf5SAnanda Raju 
882f5fca608SDavid S. Miller static int __ip_append_data(struct sock *sk,
883f5fca608SDavid S. Miller 			    struct flowi4 *fl4,
884f5fca608SDavid S. Miller 			    struct sk_buff_head *queue,
8851470ddf7SHerbert Xu 			    struct inet_cork *cork,
8865640f768SEric Dumazet 			    struct page_frag *pfrag,
8871470ddf7SHerbert Xu 			    int getfrag(void *from, char *to, int offset,
8881470ddf7SHerbert Xu 					int len, int odd, struct sk_buff *skb),
8891da177e4SLinus Torvalds 			    void *from, int length, int transhdrlen,
8901da177e4SLinus Torvalds 			    unsigned int flags)
8911da177e4SLinus Torvalds {
8921da177e4SLinus Torvalds 	struct inet_sock *inet = inet_sk(sk);
8931da177e4SLinus Torvalds 	struct sk_buff *skb;
8941da177e4SLinus Torvalds 
89507df5294SHerbert Xu 	struct ip_options *opt = cork->opt;
8961da177e4SLinus Torvalds 	int hh_len;
8971da177e4SLinus Torvalds 	int exthdrlen;
8981da177e4SLinus Torvalds 	int mtu;
8991da177e4SLinus Torvalds 	int copy;
9001da177e4SLinus Torvalds 	int err;
9011da177e4SLinus Torvalds 	int offset = 0;
902daba287bSHannes Frederic Sowa 	unsigned int maxfraglen, fragheaderlen, maxnonfragsize;
9031da177e4SLinus Torvalds 	int csummode = CHECKSUM_NONE;
9041470ddf7SHerbert Xu 	struct rtable *rt = (struct rtable *)cork->dst;
90509c2d251SWillem de Bruijn 	u32 tskey = 0;
9061da177e4SLinus Torvalds 
90796d7303eSSteffen Klassert 	skb = skb_peek_tail(queue);
90896d7303eSSteffen Klassert 
90996d7303eSSteffen Klassert 	exthdrlen = !skb ? rt->dst.header_len : 0;
91007df5294SHerbert Xu 	mtu = cork->fragsize;
91109c2d251SWillem de Bruijn 	if (cork->tx_flags & SKBTX_ANY_SW_TSTAMP &&
91209c2d251SWillem de Bruijn 	    sk->sk_tsflags & SOF_TIMESTAMPING_OPT_ID)
91309c2d251SWillem de Bruijn 		tskey = sk->sk_tskey++;
9141470ddf7SHerbert Xu 
915d8d1f30bSChangli Gao 	hh_len = LL_RESERVED_SPACE(rt->dst.dev);
9161da177e4SLinus Torvalds 
9171da177e4SLinus Torvalds 	fragheaderlen = sizeof(struct iphdr) + (opt ? opt->optlen : 0);
9181da177e4SLinus Torvalds 	maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen;
91960ff7467SWANG Cong 	maxnonfragsize = ip_sk_ignore_df(sk) ? 0xFFFF : mtu;
9201da177e4SLinus Torvalds 
921daba287bSHannes Frederic Sowa 	if (cork->length + length > maxnonfragsize - fragheaderlen) {
922f5fca608SDavid S. Miller 		ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport,
92361e7f09dSHannes Frederic Sowa 			       mtu - (opt ? opt->optlen : 0));
9241da177e4SLinus Torvalds 		return -EMSGSIZE;
9251da177e4SLinus Torvalds 	}
9261da177e4SLinus Torvalds 
9271da177e4SLinus Torvalds 	/*
9281da177e4SLinus Torvalds 	 * transhdrlen > 0 means that this is the first fragment and we wish
9291da177e4SLinus Torvalds 	 * it won't be fragmented in the future.
9301da177e4SLinus Torvalds 	 */
9311da177e4SLinus Torvalds 	if (transhdrlen &&
9321da177e4SLinus Torvalds 	    length + fragheaderlen <= mtu &&
933c8cd0989STom Herbert 	    rt->dst.dev->features & (NETIF_F_HW_CSUM | NETIF_F_IP_CSUM) &&
934d749c9cbSHannes Frederic Sowa 	    !(flags & MSG_MORE) &&
9351da177e4SLinus Torvalds 	    !exthdrlen)
93684fa7933SPatrick McHardy 		csummode = CHECKSUM_PARTIAL;
9371da177e4SLinus Torvalds 
9381470ddf7SHerbert Xu 	cork->length += length;
93926cde9f7SHerbert Xu 	if (((length > mtu) || (skb && skb_is_gso(skb))) &&
940be9164e7SKostya B 	    (sk->sk_protocol == IPPROTO_UDP) &&
941acf8dd0aSMichal Kubeček 	    (rt->dst.dev->features & NETIF_F_UFO) && !rt->dst.header_len &&
94240ba3302SMichal Kubeček 	    (sk->sk_type == SOCK_DGRAM) && !sk->sk_no_check_tx) {
9431470ddf7SHerbert Xu 		err = ip_ufo_append_data(sk, queue, getfrag, from, length,
9441470ddf7SHerbert Xu 					 hh_len, fragheaderlen, transhdrlen,
945d9be4f7aSBill Sommerfeld 					 maxfraglen, flags);
946baa829d8SPatrick McHardy 		if (err)
947e89e9cf5SAnanda Raju 			goto error;
948e89e9cf5SAnanda Raju 		return 0;
949e89e9cf5SAnanda Raju 	}
9501da177e4SLinus Torvalds 
9511da177e4SLinus Torvalds 	/* So, what's going on in the loop below?
9521da177e4SLinus Torvalds 	 *
9531da177e4SLinus Torvalds 	 * We use calculated fragment length to generate chained skb,
9541da177e4SLinus Torvalds 	 * each of segments is IP fragment ready for sending to network after
9551da177e4SLinus Torvalds 	 * adding appropriate IP header.
9561da177e4SLinus Torvalds 	 */
9571da177e4SLinus Torvalds 
95826cde9f7SHerbert Xu 	if (!skb)
9591da177e4SLinus Torvalds 		goto alloc_new_skb;
9601da177e4SLinus Torvalds 
9611da177e4SLinus Torvalds 	while (length > 0) {
9621da177e4SLinus Torvalds 		/* Check if the remaining data fits into current packet. */
9631da177e4SLinus Torvalds 		copy = mtu - skb->len;
9641da177e4SLinus Torvalds 		if (copy < length)
9651da177e4SLinus Torvalds 			copy = maxfraglen - skb->len;
9661da177e4SLinus Torvalds 		if (copy <= 0) {
9671da177e4SLinus Torvalds 			char *data;
9681da177e4SLinus Torvalds 			unsigned int datalen;
9691da177e4SLinus Torvalds 			unsigned int fraglen;
9701da177e4SLinus Torvalds 			unsigned int fraggap;
9711da177e4SLinus Torvalds 			unsigned int alloclen;
9721da177e4SLinus Torvalds 			struct sk_buff *skb_prev;
9731da177e4SLinus Torvalds alloc_new_skb:
9741da177e4SLinus Torvalds 			skb_prev = skb;
9751da177e4SLinus Torvalds 			if (skb_prev)
9761da177e4SLinus Torvalds 				fraggap = skb_prev->len - maxfraglen;
9771da177e4SLinus Torvalds 			else
9781da177e4SLinus Torvalds 				fraggap = 0;
9791da177e4SLinus Torvalds 
9801da177e4SLinus Torvalds 			/*
9811da177e4SLinus Torvalds 			 * If remaining data exceeds the mtu,
9821da177e4SLinus Torvalds 			 * we know we need more fragment(s).
9831da177e4SLinus Torvalds 			 */
9841da177e4SLinus Torvalds 			datalen = length + fraggap;
9851da177e4SLinus Torvalds 			if (datalen > mtu - fragheaderlen)
9861da177e4SLinus Torvalds 				datalen = maxfraglen - fragheaderlen;
9871da177e4SLinus Torvalds 			fraglen = datalen + fragheaderlen;
9881da177e4SLinus Torvalds 
9891da177e4SLinus Torvalds 			if ((flags & MSG_MORE) &&
990d8d1f30bSChangli Gao 			    !(rt->dst.dev->features&NETIF_F_SG))
9911da177e4SLinus Torvalds 				alloclen = mtu;
9921da177e4SLinus Torvalds 			else
99359104f06SEric Dumazet 				alloclen = fraglen;
9941da177e4SLinus Torvalds 
995353e5c9aSSteffen Klassert 			alloclen += exthdrlen;
996353e5c9aSSteffen Klassert 
9971da177e4SLinus Torvalds 			/* The last fragment gets additional space at tail.
9981da177e4SLinus Torvalds 			 * Note, with MSG_MORE we overallocate on fragments,
9991da177e4SLinus Torvalds 			 * because we have no idea what fragment will be
10001da177e4SLinus Torvalds 			 * the last.
10011da177e4SLinus Torvalds 			 */
100233f99dc7SSteffen Klassert 			if (datalen == length + fraggap)
1003d8d1f30bSChangli Gao 				alloclen += rt->dst.trailer_len;
100433f99dc7SSteffen Klassert 
10051da177e4SLinus Torvalds 			if (transhdrlen) {
10061da177e4SLinus Torvalds 				skb = sock_alloc_send_skb(sk,
10071da177e4SLinus Torvalds 						alloclen + hh_len + 15,
10081da177e4SLinus Torvalds 						(flags & MSG_DONTWAIT), &err);
10091da177e4SLinus Torvalds 			} else {
10101da177e4SLinus Torvalds 				skb = NULL;
10111da177e4SLinus Torvalds 				if (atomic_read(&sk->sk_wmem_alloc) <=
10121da177e4SLinus Torvalds 				    2 * sk->sk_sndbuf)
10131da177e4SLinus Torvalds 					skb = sock_wmalloc(sk,
10141da177e4SLinus Torvalds 							   alloclen + hh_len + 15, 1,
10151da177e4SLinus Torvalds 							   sk->sk_allocation);
101651456b29SIan Morris 				if (unlikely(!skb))
10171da177e4SLinus Torvalds 					err = -ENOBUFS;
10181da177e4SLinus Torvalds 			}
101951456b29SIan Morris 			if (!skb)
10201da177e4SLinus Torvalds 				goto error;
10211da177e4SLinus Torvalds 
10221da177e4SLinus Torvalds 			/*
10231da177e4SLinus Torvalds 			 *	Fill in the control structures
10241da177e4SLinus Torvalds 			 */
10251da177e4SLinus Torvalds 			skb->ip_summed = csummode;
10261da177e4SLinus Torvalds 			skb->csum = 0;
10271da177e4SLinus Torvalds 			skb_reserve(skb, hh_len);
102811878b40SWillem de Bruijn 
102911878b40SWillem de Bruijn 			/* only the initial fragment is time stamped */
10301470ddf7SHerbert Xu 			skb_shinfo(skb)->tx_flags = cork->tx_flags;
103111878b40SWillem de Bruijn 			cork->tx_flags = 0;
103209c2d251SWillem de Bruijn 			skb_shinfo(skb)->tskey = tskey;
103309c2d251SWillem de Bruijn 			tskey = 0;
10341da177e4SLinus Torvalds 
10351da177e4SLinus Torvalds 			/*
10361da177e4SLinus Torvalds 			 *	Find where to start putting bytes.
10371da177e4SLinus Torvalds 			 */
1038353e5c9aSSteffen Klassert 			data = skb_put(skb, fraglen + exthdrlen);
1039c14d2450SArnaldo Carvalho de Melo 			skb_set_network_header(skb, exthdrlen);
1040b0e380b1SArnaldo Carvalho de Melo 			skb->transport_header = (skb->network_header +
1041b0e380b1SArnaldo Carvalho de Melo 						 fragheaderlen);
1042353e5c9aSSteffen Klassert 			data += fragheaderlen + exthdrlen;
10431da177e4SLinus Torvalds 
10441da177e4SLinus Torvalds 			if (fraggap) {
10451da177e4SLinus Torvalds 				skb->csum = skb_copy_and_csum_bits(
10461da177e4SLinus Torvalds 					skb_prev, maxfraglen,
10471da177e4SLinus Torvalds 					data + transhdrlen, fraggap, 0);
10481da177e4SLinus Torvalds 				skb_prev->csum = csum_sub(skb_prev->csum,
10491da177e4SLinus Torvalds 							  skb->csum);
10501da177e4SLinus Torvalds 				data += fraggap;
1051e9fa4f7bSHerbert Xu 				pskb_trim_unique(skb_prev, maxfraglen);
10521da177e4SLinus Torvalds 			}
10531da177e4SLinus Torvalds 
10541da177e4SLinus Torvalds 			copy = datalen - transhdrlen - fraggap;
10551da177e4SLinus Torvalds 			if (copy > 0 && getfrag(from, data + transhdrlen, offset, copy, fraggap, skb) < 0) {
10561da177e4SLinus Torvalds 				err = -EFAULT;
10571da177e4SLinus Torvalds 				kfree_skb(skb);
10581da177e4SLinus Torvalds 				goto error;
10591da177e4SLinus Torvalds 			}
10601da177e4SLinus Torvalds 
10611da177e4SLinus Torvalds 			offset += copy;
10621da177e4SLinus Torvalds 			length -= datalen - fraggap;
10631da177e4SLinus Torvalds 			transhdrlen = 0;
10641da177e4SLinus Torvalds 			exthdrlen = 0;
10651da177e4SLinus Torvalds 			csummode = CHECKSUM_NONE;
10661da177e4SLinus Torvalds 
10671da177e4SLinus Torvalds 			/*
10681da177e4SLinus Torvalds 			 * Put the packet on the pending queue.
10691da177e4SLinus Torvalds 			 */
10701470ddf7SHerbert Xu 			__skb_queue_tail(queue, skb);
10711da177e4SLinus Torvalds 			continue;
10721da177e4SLinus Torvalds 		}
10731da177e4SLinus Torvalds 
10741da177e4SLinus Torvalds 		if (copy > length)
10751da177e4SLinus Torvalds 			copy = length;
10761da177e4SLinus Torvalds 
1077d8d1f30bSChangli Gao 		if (!(rt->dst.dev->features&NETIF_F_SG)) {
10781da177e4SLinus Torvalds 			unsigned int off;
10791da177e4SLinus Torvalds 
10801da177e4SLinus Torvalds 			off = skb->len;
10811da177e4SLinus Torvalds 			if (getfrag(from, skb_put(skb, copy),
10821da177e4SLinus Torvalds 					offset, copy, off, skb) < 0) {
10831da177e4SLinus Torvalds 				__skb_trim(skb, off);
10841da177e4SLinus Torvalds 				err = -EFAULT;
10851da177e4SLinus Torvalds 				goto error;
10861da177e4SLinus Torvalds 			}
10871da177e4SLinus Torvalds 		} else {
10881da177e4SLinus Torvalds 			int i = skb_shinfo(skb)->nr_frags;
10891da177e4SLinus Torvalds 
10901da177e4SLinus Torvalds 			err = -ENOMEM;
10915640f768SEric Dumazet 			if (!sk_page_frag_refill(sk, pfrag))
10921da177e4SLinus Torvalds 				goto error;
10931da177e4SLinus Torvalds 
10945640f768SEric Dumazet 			if (!skb_can_coalesce(skb, i, pfrag->page,
10955640f768SEric Dumazet 					      pfrag->offset)) {
10961da177e4SLinus Torvalds 				err = -EMSGSIZE;
10975640f768SEric Dumazet 				if (i == MAX_SKB_FRAGS)
10981da177e4SLinus Torvalds 					goto error;
10995640f768SEric Dumazet 
11005640f768SEric Dumazet 				__skb_fill_page_desc(skb, i, pfrag->page,
11015640f768SEric Dumazet 						     pfrag->offset, 0);
11025640f768SEric Dumazet 				skb_shinfo(skb)->nr_frags = ++i;
11035640f768SEric Dumazet 				get_page(pfrag->page);
11041da177e4SLinus Torvalds 			}
11055640f768SEric Dumazet 			copy = min_t(int, copy, pfrag->size - pfrag->offset);
11065640f768SEric Dumazet 			if (getfrag(from,
11075640f768SEric Dumazet 				    page_address(pfrag->page) + pfrag->offset,
11085640f768SEric Dumazet 				    offset, copy, skb->len, skb) < 0)
11095640f768SEric Dumazet 				goto error_efault;
11105640f768SEric Dumazet 
11115640f768SEric Dumazet 			pfrag->offset += copy;
11125640f768SEric Dumazet 			skb_frag_size_add(&skb_shinfo(skb)->frags[i - 1], copy);
11131da177e4SLinus Torvalds 			skb->len += copy;
11141da177e4SLinus Torvalds 			skb->data_len += copy;
1115f945fa7aSHerbert Xu 			skb->truesize += copy;
1116f945fa7aSHerbert Xu 			atomic_add(copy, &sk->sk_wmem_alloc);
11171da177e4SLinus Torvalds 		}
11181da177e4SLinus Torvalds 		offset += copy;
11191da177e4SLinus Torvalds 		length -= copy;
11201da177e4SLinus Torvalds 	}
11211da177e4SLinus Torvalds 
11221da177e4SLinus Torvalds 	return 0;
11231da177e4SLinus Torvalds 
11245640f768SEric Dumazet error_efault:
11255640f768SEric Dumazet 	err = -EFAULT;
11261da177e4SLinus Torvalds error:
11271470ddf7SHerbert Xu 	cork->length -= length;
11285e38e270SPavel Emelyanov 	IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTDISCARDS);
11291da177e4SLinus Torvalds 	return err;
11301da177e4SLinus Torvalds }
11311da177e4SLinus Torvalds 
11321470ddf7SHerbert Xu static int ip_setup_cork(struct sock *sk, struct inet_cork *cork,
11331470ddf7SHerbert Xu 			 struct ipcm_cookie *ipc, struct rtable **rtp)
11341470ddf7SHerbert Xu {
1135f6d8bd05SEric Dumazet 	struct ip_options_rcu *opt;
11361470ddf7SHerbert Xu 	struct rtable *rt;
11371470ddf7SHerbert Xu 
11381470ddf7SHerbert Xu 	/*
11391470ddf7SHerbert Xu 	 * setup for corking.
11401470ddf7SHerbert Xu 	 */
11411470ddf7SHerbert Xu 	opt = ipc->opt;
11421470ddf7SHerbert Xu 	if (opt) {
114351456b29SIan Morris 		if (!cork->opt) {
11441470ddf7SHerbert Xu 			cork->opt = kmalloc(sizeof(struct ip_options) + 40,
11451470ddf7SHerbert Xu 					    sk->sk_allocation);
114651456b29SIan Morris 			if (unlikely(!cork->opt))
11471470ddf7SHerbert Xu 				return -ENOBUFS;
11481470ddf7SHerbert Xu 		}
1149f6d8bd05SEric Dumazet 		memcpy(cork->opt, &opt->opt, sizeof(struct ip_options) + opt->opt.optlen);
11501470ddf7SHerbert Xu 		cork->flags |= IPCORK_OPT;
11511470ddf7SHerbert Xu 		cork->addr = ipc->addr;
11521470ddf7SHerbert Xu 	}
11531470ddf7SHerbert Xu 	rt = *rtp;
11541470ddf7SHerbert Xu 	if (unlikely(!rt))
11551470ddf7SHerbert Xu 		return -EFAULT;
11561470ddf7SHerbert Xu 	/*
11571470ddf7SHerbert Xu 	 * We steal reference to this route, caller should not release it
11581470ddf7SHerbert Xu 	 */
11591470ddf7SHerbert Xu 	*rtp = NULL;
1160482fc609SHannes Frederic Sowa 	cork->fragsize = ip_sk_use_pmtu(sk) ?
1161482fc609SHannes Frederic Sowa 			 dst_mtu(&rt->dst) : rt->dst.dev->mtu;
11621470ddf7SHerbert Xu 	cork->dst = &rt->dst;
11631470ddf7SHerbert Xu 	cork->length = 0;
1164aa661581SFrancesco Fusco 	cork->ttl = ipc->ttl;
1165aa661581SFrancesco Fusco 	cork->tos = ipc->tos;
1166aa661581SFrancesco Fusco 	cork->priority = ipc->priority;
11671470ddf7SHerbert Xu 	cork->tx_flags = ipc->tx_flags;
11681470ddf7SHerbert Xu 
11691470ddf7SHerbert Xu 	return 0;
11701470ddf7SHerbert Xu }
11711470ddf7SHerbert Xu 
11721470ddf7SHerbert Xu /*
11731470ddf7SHerbert Xu  *	ip_append_data() and ip_append_page() can make one large IP datagram
11741470ddf7SHerbert Xu  *	from many pieces of data. Each pieces will be holded on the socket
11751470ddf7SHerbert Xu  *	until ip_push_pending_frames() is called. Each piece can be a page
11761470ddf7SHerbert Xu  *	or non-page data.
11771470ddf7SHerbert Xu  *
11781470ddf7SHerbert Xu  *	Not only UDP, other transport protocols - e.g. raw sockets - can use
11791470ddf7SHerbert Xu  *	this interface potentially.
11801470ddf7SHerbert Xu  *
11811470ddf7SHerbert Xu  *	LATER: length must be adjusted by pad at tail, when it is required.
11821470ddf7SHerbert Xu  */
1183f5fca608SDavid S. Miller int ip_append_data(struct sock *sk, struct flowi4 *fl4,
11841470ddf7SHerbert Xu 		   int getfrag(void *from, char *to, int offset, int len,
11851470ddf7SHerbert Xu 			       int odd, struct sk_buff *skb),
11861470ddf7SHerbert Xu 		   void *from, int length, int transhdrlen,
11871470ddf7SHerbert Xu 		   struct ipcm_cookie *ipc, struct rtable **rtp,
11881470ddf7SHerbert Xu 		   unsigned int flags)
11891470ddf7SHerbert Xu {
11901470ddf7SHerbert Xu 	struct inet_sock *inet = inet_sk(sk);
11911470ddf7SHerbert Xu 	int err;
11921470ddf7SHerbert Xu 
11931470ddf7SHerbert Xu 	if (flags&MSG_PROBE)
11941470ddf7SHerbert Xu 		return 0;
11951470ddf7SHerbert Xu 
11961470ddf7SHerbert Xu 	if (skb_queue_empty(&sk->sk_write_queue)) {
1197bdc712b4SDavid S. Miller 		err = ip_setup_cork(sk, &inet->cork.base, ipc, rtp);
11981470ddf7SHerbert Xu 		if (err)
11991470ddf7SHerbert Xu 			return err;
12001470ddf7SHerbert Xu 	} else {
12011470ddf7SHerbert Xu 		transhdrlen = 0;
12021470ddf7SHerbert Xu 	}
12031470ddf7SHerbert Xu 
12045640f768SEric Dumazet 	return __ip_append_data(sk, fl4, &sk->sk_write_queue, &inet->cork.base,
12055640f768SEric Dumazet 				sk_page_frag(sk), getfrag,
12061470ddf7SHerbert Xu 				from, length, transhdrlen, flags);
12071470ddf7SHerbert Xu }
12081470ddf7SHerbert Xu 
1209f5fca608SDavid S. Miller ssize_t	ip_append_page(struct sock *sk, struct flowi4 *fl4, struct page *page,
12101da177e4SLinus Torvalds 		       int offset, size_t size, int flags)
12111da177e4SLinus Torvalds {
12121da177e4SLinus Torvalds 	struct inet_sock *inet = inet_sk(sk);
12131da177e4SLinus Torvalds 	struct sk_buff *skb;
12141da177e4SLinus Torvalds 	struct rtable *rt;
12151da177e4SLinus Torvalds 	struct ip_options *opt = NULL;
1216bdc712b4SDavid S. Miller 	struct inet_cork *cork;
12171da177e4SLinus Torvalds 	int hh_len;
12181da177e4SLinus Torvalds 	int mtu;
12191da177e4SLinus Torvalds 	int len;
12201da177e4SLinus Torvalds 	int err;
1221daba287bSHannes Frederic Sowa 	unsigned int maxfraglen, fragheaderlen, fraggap, maxnonfragsize;
12221da177e4SLinus Torvalds 
12231da177e4SLinus Torvalds 	if (inet->hdrincl)
12241da177e4SLinus Torvalds 		return -EPERM;
12251da177e4SLinus Torvalds 
12261da177e4SLinus Torvalds 	if (flags&MSG_PROBE)
12271da177e4SLinus Torvalds 		return 0;
12281da177e4SLinus Torvalds 
12291da177e4SLinus Torvalds 	if (skb_queue_empty(&sk->sk_write_queue))
12301da177e4SLinus Torvalds 		return -EINVAL;
12311da177e4SLinus Torvalds 
1232bdc712b4SDavid S. Miller 	cork = &inet->cork.base;
1233bdc712b4SDavid S. Miller 	rt = (struct rtable *)cork->dst;
1234bdc712b4SDavid S. Miller 	if (cork->flags & IPCORK_OPT)
1235bdc712b4SDavid S. Miller 		opt = cork->opt;
12361da177e4SLinus Torvalds 
1237d8d1f30bSChangli Gao 	if (!(rt->dst.dev->features&NETIF_F_SG))
12381da177e4SLinus Torvalds 		return -EOPNOTSUPP;
12391da177e4SLinus Torvalds 
1240d8d1f30bSChangli Gao 	hh_len = LL_RESERVED_SPACE(rt->dst.dev);
1241bdc712b4SDavid S. Miller 	mtu = cork->fragsize;
12421da177e4SLinus Torvalds 
12431da177e4SLinus Torvalds 	fragheaderlen = sizeof(struct iphdr) + (opt ? opt->optlen : 0);
12441da177e4SLinus Torvalds 	maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen;
124560ff7467SWANG Cong 	maxnonfragsize = ip_sk_ignore_df(sk) ? 0xFFFF : mtu;
12461da177e4SLinus Torvalds 
1247daba287bSHannes Frederic Sowa 	if (cork->length + size > maxnonfragsize - fragheaderlen) {
124861e7f09dSHannes Frederic Sowa 		ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport,
124961e7f09dSHannes Frederic Sowa 			       mtu - (opt ? opt->optlen : 0));
12501da177e4SLinus Torvalds 		return -EMSGSIZE;
12511da177e4SLinus Torvalds 	}
12521da177e4SLinus Torvalds 
125351456b29SIan Morris 	skb = skb_peek_tail(&sk->sk_write_queue);
125451456b29SIan Morris 	if (!skb)
12551da177e4SLinus Torvalds 		return -EINVAL;
12561da177e4SLinus Torvalds 
125726cde9f7SHerbert Xu 	if ((size + skb->len > mtu) &&
125826cde9f7SHerbert Xu 	    (sk->sk_protocol == IPPROTO_UDP) &&
1259d8d1f30bSChangli Gao 	    (rt->dst.dev->features & NETIF_F_UFO)) {
1260a8c4a252SHannes Frederic Sowa 		if (skb->ip_summed != CHECKSUM_PARTIAL)
1261a8c4a252SHannes Frederic Sowa 			return -EOPNOTSUPP;
1262a8c4a252SHannes Frederic Sowa 
12637967168cSHerbert Xu 		skb_shinfo(skb)->gso_size = mtu - fragheaderlen;
1264f83ef8c0SHerbert Xu 		skb_shinfo(skb)->gso_type = SKB_GSO_UDP;
12657967168cSHerbert Xu 	}
1266a8c4a252SHannes Frederic Sowa 	cork->length += size;
1267e89e9cf5SAnanda Raju 
12681da177e4SLinus Torvalds 	while (size > 0) {
1269be12a1feSHannes Frederic Sowa 		if (skb_is_gso(skb)) {
1270e89e9cf5SAnanda Raju 			len = size;
1271be12a1feSHannes Frederic Sowa 		} else {
1272e89e9cf5SAnanda Raju 
12731da177e4SLinus Torvalds 			/* Check if the remaining data fits into current packet. */
12741da177e4SLinus Torvalds 			len = mtu - skb->len;
12751da177e4SLinus Torvalds 			if (len < size)
12761da177e4SLinus Torvalds 				len = maxfraglen - skb->len;
1277e89e9cf5SAnanda Raju 		}
12781da177e4SLinus Torvalds 		if (len <= 0) {
12791da177e4SLinus Torvalds 			struct sk_buff *skb_prev;
12801da177e4SLinus Torvalds 			int alloclen;
12811da177e4SLinus Torvalds 
12821da177e4SLinus Torvalds 			skb_prev = skb;
12831da177e4SLinus Torvalds 			fraggap = skb_prev->len - maxfraglen;
12841da177e4SLinus Torvalds 
12851da177e4SLinus Torvalds 			alloclen = fragheaderlen + hh_len + fraggap + 15;
12861da177e4SLinus Torvalds 			skb = sock_wmalloc(sk, alloclen, 1, sk->sk_allocation);
12871da177e4SLinus Torvalds 			if (unlikely(!skb)) {
12881da177e4SLinus Torvalds 				err = -ENOBUFS;
12891da177e4SLinus Torvalds 				goto error;
12901da177e4SLinus Torvalds 			}
12911da177e4SLinus Torvalds 
12921da177e4SLinus Torvalds 			/*
12931da177e4SLinus Torvalds 			 *	Fill in the control structures
12941da177e4SLinus Torvalds 			 */
12951da177e4SLinus Torvalds 			skb->ip_summed = CHECKSUM_NONE;
12961da177e4SLinus Torvalds 			skb->csum = 0;
12971da177e4SLinus Torvalds 			skb_reserve(skb, hh_len);
12981da177e4SLinus Torvalds 
12991da177e4SLinus Torvalds 			/*
13001da177e4SLinus Torvalds 			 *	Find where to start putting bytes.
13011da177e4SLinus Torvalds 			 */
1302967b05f6SArnaldo Carvalho de Melo 			skb_put(skb, fragheaderlen + fraggap);
13032ca9e6f2SArnaldo Carvalho de Melo 			skb_reset_network_header(skb);
1304b0e380b1SArnaldo Carvalho de Melo 			skb->transport_header = (skb->network_header +
1305b0e380b1SArnaldo Carvalho de Melo 						 fragheaderlen);
13061da177e4SLinus Torvalds 			if (fraggap) {
1307967b05f6SArnaldo Carvalho de Melo 				skb->csum = skb_copy_and_csum_bits(skb_prev,
1308967b05f6SArnaldo Carvalho de Melo 								   maxfraglen,
13099c70220bSArnaldo Carvalho de Melo 						    skb_transport_header(skb),
1310967b05f6SArnaldo Carvalho de Melo 								   fraggap, 0);
13111da177e4SLinus Torvalds 				skb_prev->csum = csum_sub(skb_prev->csum,
13121da177e4SLinus Torvalds 							  skb->csum);
1313e9fa4f7bSHerbert Xu 				pskb_trim_unique(skb_prev, maxfraglen);
13141da177e4SLinus Torvalds 			}
13151da177e4SLinus Torvalds 
13161da177e4SLinus Torvalds 			/*
13171da177e4SLinus Torvalds 			 * Put the packet on the pending queue.
13181da177e4SLinus Torvalds 			 */
13191da177e4SLinus Torvalds 			__skb_queue_tail(&sk->sk_write_queue, skb);
13201da177e4SLinus Torvalds 			continue;
13211da177e4SLinus Torvalds 		}
13221da177e4SLinus Torvalds 
13231da177e4SLinus Torvalds 		if (len > size)
13241da177e4SLinus Torvalds 			len = size;
1325be12a1feSHannes Frederic Sowa 
1326be12a1feSHannes Frederic Sowa 		if (skb_append_pagefrags(skb, page, offset, len)) {
13271da177e4SLinus Torvalds 			err = -EMSGSIZE;
13281da177e4SLinus Torvalds 			goto error;
13291da177e4SLinus Torvalds 		}
13301da177e4SLinus Torvalds 
13311da177e4SLinus Torvalds 		if (skb->ip_summed == CHECKSUM_NONE) {
133244bb9363SAl Viro 			__wsum csum;
13331da177e4SLinus Torvalds 			csum = csum_page(page, offset, len);
13341da177e4SLinus Torvalds 			skb->csum = csum_block_add(skb->csum, csum, skb->len);
13351da177e4SLinus Torvalds 		}
13361da177e4SLinus Torvalds 
13371da177e4SLinus Torvalds 		skb->len += len;
13381da177e4SLinus Torvalds 		skb->data_len += len;
13391e34a11dSDavid S. Miller 		skb->truesize += len;
13401e34a11dSDavid S. Miller 		atomic_add(len, &sk->sk_wmem_alloc);
13411da177e4SLinus Torvalds 		offset += len;
13421da177e4SLinus Torvalds 		size -= len;
13431da177e4SLinus Torvalds 	}
13441da177e4SLinus Torvalds 	return 0;
13451da177e4SLinus Torvalds 
13461da177e4SLinus Torvalds error:
1347bdc712b4SDavid S. Miller 	cork->length -= size;
13485e38e270SPavel Emelyanov 	IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTDISCARDS);
13491da177e4SLinus Torvalds 	return err;
13501da177e4SLinus Torvalds }
13511da177e4SLinus Torvalds 
13521470ddf7SHerbert Xu static void ip_cork_release(struct inet_cork *cork)
1353429f08e9SPavel Emelyanov {
13541470ddf7SHerbert Xu 	cork->flags &= ~IPCORK_OPT;
13551470ddf7SHerbert Xu 	kfree(cork->opt);
13561470ddf7SHerbert Xu 	cork->opt = NULL;
13571470ddf7SHerbert Xu 	dst_release(cork->dst);
13581470ddf7SHerbert Xu 	cork->dst = NULL;
1359429f08e9SPavel Emelyanov }
1360429f08e9SPavel Emelyanov 
13611da177e4SLinus Torvalds /*
13621da177e4SLinus Torvalds  *	Combined all pending IP fragments on the socket as one IP datagram
13631da177e4SLinus Torvalds  *	and push them out.
13641da177e4SLinus Torvalds  */
13651c32c5adSHerbert Xu struct sk_buff *__ip_make_skb(struct sock *sk,
136677968b78SDavid S. Miller 			      struct flowi4 *fl4,
13671470ddf7SHerbert Xu 			      struct sk_buff_head *queue,
13681470ddf7SHerbert Xu 			      struct inet_cork *cork)
13691da177e4SLinus Torvalds {
13701da177e4SLinus Torvalds 	struct sk_buff *skb, *tmp_skb;
13711da177e4SLinus Torvalds 	struct sk_buff **tail_skb;
13721da177e4SLinus Torvalds 	struct inet_sock *inet = inet_sk(sk);
13730388b004SPavel Emelyanov 	struct net *net = sock_net(sk);
13741da177e4SLinus Torvalds 	struct ip_options *opt = NULL;
13751470ddf7SHerbert Xu 	struct rtable *rt = (struct rtable *)cork->dst;
13761da177e4SLinus Torvalds 	struct iphdr *iph;
137776ab608dSAlexey Dobriyan 	__be16 df = 0;
13781da177e4SLinus Torvalds 	__u8 ttl;
13791da177e4SLinus Torvalds 
138051456b29SIan Morris 	skb = __skb_dequeue(queue);
138151456b29SIan Morris 	if (!skb)
13821da177e4SLinus Torvalds 		goto out;
13831da177e4SLinus Torvalds 	tail_skb = &(skb_shinfo(skb)->frag_list);
13841da177e4SLinus Torvalds 
13851da177e4SLinus Torvalds 	/* move skb->data to ip header from ext header */
1386d56f90a7SArnaldo Carvalho de Melo 	if (skb->data < skb_network_header(skb))
1387bbe735e4SArnaldo Carvalho de Melo 		__skb_pull(skb, skb_network_offset(skb));
13881470ddf7SHerbert Xu 	while ((tmp_skb = __skb_dequeue(queue)) != NULL) {
1389cfe1fc77SArnaldo Carvalho de Melo 		__skb_pull(tmp_skb, skb_network_header_len(skb));
13901da177e4SLinus Torvalds 		*tail_skb = tmp_skb;
13911da177e4SLinus Torvalds 		tail_skb = &(tmp_skb->next);
13921da177e4SLinus Torvalds 		skb->len += tmp_skb->len;
13931da177e4SLinus Torvalds 		skb->data_len += tmp_skb->len;
13941da177e4SLinus Torvalds 		skb->truesize += tmp_skb->truesize;
13951da177e4SLinus Torvalds 		tmp_skb->destructor = NULL;
13961da177e4SLinus Torvalds 		tmp_skb->sk = NULL;
13971da177e4SLinus Torvalds 	}
13981da177e4SLinus Torvalds 
13991da177e4SLinus Torvalds 	/* Unless user demanded real pmtu discovery (IP_PMTUDISC_DO), we allow
14001da177e4SLinus Torvalds 	 * to fragment the frame generated here. No matter, what transforms
14011da177e4SLinus Torvalds 	 * how transforms change size of the packet, it will come out.
14021da177e4SLinus Torvalds 	 */
140360ff7467SWANG Cong 	skb->ignore_df = ip_sk_ignore_df(sk);
14041da177e4SLinus Torvalds 
14051da177e4SLinus Torvalds 	/* DF bit is set when we want to see DF on outgoing frames.
140660ff7467SWANG Cong 	 * If ignore_df is set too, we still allow to fragment this frame
14071da177e4SLinus Torvalds 	 * locally. */
1408482fc609SHannes Frederic Sowa 	if (inet->pmtudisc == IP_PMTUDISC_DO ||
1409482fc609SHannes Frederic Sowa 	    inet->pmtudisc == IP_PMTUDISC_PROBE ||
1410d8d1f30bSChangli Gao 	    (skb->len <= dst_mtu(&rt->dst) &&
1411d8d1f30bSChangli Gao 	     ip_dont_fragment(sk, &rt->dst)))
14121da177e4SLinus Torvalds 		df = htons(IP_DF);
14131da177e4SLinus Torvalds 
14141470ddf7SHerbert Xu 	if (cork->flags & IPCORK_OPT)
14151470ddf7SHerbert Xu 		opt = cork->opt;
14161da177e4SLinus Torvalds 
1417aa661581SFrancesco Fusco 	if (cork->ttl != 0)
1418aa661581SFrancesco Fusco 		ttl = cork->ttl;
1419aa661581SFrancesco Fusco 	else if (rt->rt_type == RTN_MULTICAST)
14201da177e4SLinus Torvalds 		ttl = inet->mc_ttl;
14211da177e4SLinus Torvalds 	else
1422d8d1f30bSChangli Gao 		ttl = ip_select_ttl(inet, &rt->dst);
14231da177e4SLinus Torvalds 
1424749154aaSAnsis Atteka 	iph = ip_hdr(skb);
14251da177e4SLinus Torvalds 	iph->version = 4;
14261da177e4SLinus Torvalds 	iph->ihl = 5;
1427aa661581SFrancesco Fusco 	iph->tos = (cork->tos != -1) ? cork->tos : inet->tos;
14281da177e4SLinus Torvalds 	iph->frag_off = df;
14291da177e4SLinus Torvalds 	iph->ttl = ttl;
14301da177e4SLinus Torvalds 	iph->protocol = sk->sk_protocol;
143184f9307cSEric Dumazet 	ip_copy_addrs(iph, fl4);
1432b6a7719aSHannes Frederic Sowa 	ip_select_ident(net, skb, sk);
14331da177e4SLinus Torvalds 
143422f728f8SDavid S. Miller 	if (opt) {
143522f728f8SDavid S. Miller 		iph->ihl += opt->optlen>>2;
143622f728f8SDavid S. Miller 		ip_options_build(skb, opt, cork->addr, rt, 0);
143722f728f8SDavid S. Miller 	}
143822f728f8SDavid S. Miller 
1439aa661581SFrancesco Fusco 	skb->priority = (cork->tos != -1) ? cork->priority: sk->sk_priority;
14404a19ec58SLaszlo Attila Toth 	skb->mark = sk->sk_mark;
1441a21bba94SEric Dumazet 	/*
1442a21bba94SEric Dumazet 	 * Steal rt from cork.dst to avoid a pair of atomic_inc/atomic_dec
1443a21bba94SEric Dumazet 	 * on dst refcount
1444a21bba94SEric Dumazet 	 */
14451470ddf7SHerbert Xu 	cork->dst = NULL;
1446d8d1f30bSChangli Gao 	skb_dst_set(skb, &rt->dst);
14471da177e4SLinus Torvalds 
144896793b48SDavid L Stevens 	if (iph->protocol == IPPROTO_ICMP)
14490388b004SPavel Emelyanov 		icmp_out_count(net, ((struct icmphdr *)
145096793b48SDavid L Stevens 			skb_transport_header(skb))->type);
145196793b48SDavid L Stevens 
14521c32c5adSHerbert Xu 	ip_cork_release(cork);
14531c32c5adSHerbert Xu out:
14541c32c5adSHerbert Xu 	return skb;
14551c32c5adSHerbert Xu }
14561c32c5adSHerbert Xu 
1457b5ec8eeaSEric Dumazet int ip_send_skb(struct net *net, struct sk_buff *skb)
14581c32c5adSHerbert Xu {
14591c32c5adSHerbert Xu 	int err;
14601c32c5adSHerbert Xu 
146133224b16SEric W. Biederman 	err = ip_local_out(net, skb->sk, skb);
14621da177e4SLinus Torvalds 	if (err) {
14631da177e4SLinus Torvalds 		if (err > 0)
14646ce9e7b5SEric Dumazet 			err = net_xmit_errno(err);
14651da177e4SLinus Torvalds 		if (err)
14661c32c5adSHerbert Xu 			IP_INC_STATS(net, IPSTATS_MIB_OUTDISCARDS);
14671da177e4SLinus Torvalds 	}
14681da177e4SLinus Torvalds 
14691da177e4SLinus Torvalds 	return err;
14701da177e4SLinus Torvalds }
14711da177e4SLinus Torvalds 
147277968b78SDavid S. Miller int ip_push_pending_frames(struct sock *sk, struct flowi4 *fl4)
14731470ddf7SHerbert Xu {
14741c32c5adSHerbert Xu 	struct sk_buff *skb;
14751c32c5adSHerbert Xu 
147677968b78SDavid S. Miller 	skb = ip_finish_skb(sk, fl4);
14771c32c5adSHerbert Xu 	if (!skb)
14781c32c5adSHerbert Xu 		return 0;
14791c32c5adSHerbert Xu 
14801c32c5adSHerbert Xu 	/* Netfilter gets whole the not fragmented skb. */
1481b5ec8eeaSEric Dumazet 	return ip_send_skb(sock_net(sk), skb);
14821470ddf7SHerbert Xu }
14831470ddf7SHerbert Xu 
14841da177e4SLinus Torvalds /*
14851da177e4SLinus Torvalds  *	Throw away all pending data on the socket.
14861da177e4SLinus Torvalds  */
14871470ddf7SHerbert Xu static void __ip_flush_pending_frames(struct sock *sk,
14881470ddf7SHerbert Xu 				      struct sk_buff_head *queue,
14891470ddf7SHerbert Xu 				      struct inet_cork *cork)
14901da177e4SLinus Torvalds {
14911da177e4SLinus Torvalds 	struct sk_buff *skb;
14921da177e4SLinus Torvalds 
14931470ddf7SHerbert Xu 	while ((skb = __skb_dequeue_tail(queue)) != NULL)
14941da177e4SLinus Torvalds 		kfree_skb(skb);
14951da177e4SLinus Torvalds 
14961470ddf7SHerbert Xu 	ip_cork_release(cork);
14971470ddf7SHerbert Xu }
14981470ddf7SHerbert Xu 
14991470ddf7SHerbert Xu void ip_flush_pending_frames(struct sock *sk)
15001470ddf7SHerbert Xu {
1501bdc712b4SDavid S. Miller 	__ip_flush_pending_frames(sk, &sk->sk_write_queue, &inet_sk(sk)->cork.base);
15021da177e4SLinus Torvalds }
15031da177e4SLinus Torvalds 
15041c32c5adSHerbert Xu struct sk_buff *ip_make_skb(struct sock *sk,
150577968b78SDavid S. Miller 			    struct flowi4 *fl4,
15061c32c5adSHerbert Xu 			    int getfrag(void *from, char *to, int offset,
15071c32c5adSHerbert Xu 					int len, int odd, struct sk_buff *skb),
15081c32c5adSHerbert Xu 			    void *from, int length, int transhdrlen,
15091c32c5adSHerbert Xu 			    struct ipcm_cookie *ipc, struct rtable **rtp,
15101c32c5adSHerbert Xu 			    unsigned int flags)
15111c32c5adSHerbert Xu {
1512b80d7226SDavid S. Miller 	struct inet_cork cork;
15131c32c5adSHerbert Xu 	struct sk_buff_head queue;
15141c32c5adSHerbert Xu 	int err;
15151c32c5adSHerbert Xu 
15161c32c5adSHerbert Xu 	if (flags & MSG_PROBE)
15171c32c5adSHerbert Xu 		return NULL;
15181c32c5adSHerbert Xu 
15191c32c5adSHerbert Xu 	__skb_queue_head_init(&queue);
15201c32c5adSHerbert Xu 
1521b80d7226SDavid S. Miller 	cork.flags = 0;
1522b80d7226SDavid S. Miller 	cork.addr = 0;
152370652728SDavid S. Miller 	cork.opt = NULL;
15241c32c5adSHerbert Xu 	err = ip_setup_cork(sk, &cork, ipc, rtp);
15251c32c5adSHerbert Xu 	if (err)
15261c32c5adSHerbert Xu 		return ERR_PTR(err);
15271c32c5adSHerbert Xu 
15285640f768SEric Dumazet 	err = __ip_append_data(sk, fl4, &queue, &cork,
15295640f768SEric Dumazet 			       &current->task_frag, getfrag,
15301c32c5adSHerbert Xu 			       from, length, transhdrlen, flags);
15311c32c5adSHerbert Xu 	if (err) {
15321c32c5adSHerbert Xu 		__ip_flush_pending_frames(sk, &queue, &cork);
15331c32c5adSHerbert Xu 		return ERR_PTR(err);
15341c32c5adSHerbert Xu 	}
15351c32c5adSHerbert Xu 
153677968b78SDavid S. Miller 	return __ip_make_skb(sk, fl4, &queue, &cork);
15371c32c5adSHerbert Xu }
15381da177e4SLinus Torvalds 
15391da177e4SLinus Torvalds /*
15401da177e4SLinus Torvalds  *	Fetch data from kernel space and fill in checksum if needed.
15411da177e4SLinus Torvalds  */
15421da177e4SLinus Torvalds static int ip_reply_glue_bits(void *dptr, char *to, int offset,
15431da177e4SLinus Torvalds 			      int len, int odd, struct sk_buff *skb)
15441da177e4SLinus Torvalds {
15455084205fSAl Viro 	__wsum csum;
15461da177e4SLinus Torvalds 
15471da177e4SLinus Torvalds 	csum = csum_partial_copy_nocheck(dptr+offset, to, len, 0);
15481da177e4SLinus Torvalds 	skb->csum = csum_block_add(skb->csum, csum, odd);
15491da177e4SLinus Torvalds 	return 0;
15501da177e4SLinus Torvalds }
15511da177e4SLinus Torvalds 
15521da177e4SLinus Torvalds /*
15531da177e4SLinus Torvalds  *	Generic function to send a packet as reply to another packet.
1554be9f4a44SEric Dumazet  *	Used to send some TCP resets/acks so far.
15551da177e4SLinus Torvalds  */
1556bdbbb852SEric Dumazet void ip_send_unicast_reply(struct sock *sk, struct sk_buff *skb,
155724a2d43dSEric Dumazet 			   const struct ip_options *sopt,
155824a2d43dSEric Dumazet 			   __be32 daddr, __be32 saddr,
155924a2d43dSEric Dumazet 			   const struct ip_reply_arg *arg,
156070e73416SDavid S. Miller 			   unsigned int len)
15611da177e4SLinus Torvalds {
1562f6d8bd05SEric Dumazet 	struct ip_options_data replyopts;
15631da177e4SLinus Torvalds 	struct ipcm_cookie ipc;
156477968b78SDavid S. Miller 	struct flowi4 fl4;
1565511c3f92SEric Dumazet 	struct rtable *rt = skb_rtable(skb);
1566bdbbb852SEric Dumazet 	struct net *net = sock_net(sk);
1567be9f4a44SEric Dumazet 	struct sk_buff *nskb;
15684062090eSVasily Averin 	int err;
1569f7ba868bSDavid Ahern 	int oif;
15701da177e4SLinus Torvalds 
157124a2d43dSEric Dumazet 	if (__ip_options_echo(&replyopts.opt.opt, skb, sopt))
15721da177e4SLinus Torvalds 		return;
15731da177e4SLinus Torvalds 
15740a5ebb80SDavid S. Miller 	ipc.addr = daddr;
15751da177e4SLinus Torvalds 	ipc.opt = NULL;
15762244d07bSOliver Hartkopp 	ipc.tx_flags = 0;
1577aa661581SFrancesco Fusco 	ipc.ttl = 0;
1578aa661581SFrancesco Fusco 	ipc.tos = -1;
15791da177e4SLinus Torvalds 
1580f6d8bd05SEric Dumazet 	if (replyopts.opt.opt.optlen) {
15811da177e4SLinus Torvalds 		ipc.opt = &replyopts.opt;
15821da177e4SLinus Torvalds 
1583f6d8bd05SEric Dumazet 		if (replyopts.opt.opt.srr)
1584f6d8bd05SEric Dumazet 			daddr = replyopts.opt.opt.faddr;
15851da177e4SLinus Torvalds 	}
15861da177e4SLinus Torvalds 
1587f7ba868bSDavid Ahern 	oif = arg->bound_dev_if;
15889b6c14d5SDavid Ahern 	if (!oif && netif_index_is_l3_master(net, skb->skb_iif))
15899b6c14d5SDavid Ahern 		oif = skb->skb_iif;
1590f7ba868bSDavid Ahern 
1591f7ba868bSDavid Ahern 	flowi4_init_output(&fl4, oif,
1592e110861fSLorenzo Colitti 			   IP4_REPLY_MARK(net, skb->mark),
159366b13d99SEric Dumazet 			   RT_TOS(arg->tos),
1594be9f4a44SEric Dumazet 			   RT_SCOPE_UNIVERSE, ip_hdr(skb)->protocol,
1595538de0e0SDavid S. Miller 			   ip_reply_arg_flowi_flags(arg),
159670e73416SDavid S. Miller 			   daddr, saddr,
1597538de0e0SDavid S. Miller 			   tcp_hdr(skb)->source, tcp_hdr(skb)->dest);
15989d6ec938SDavid S. Miller 	security_skb_classify_flow(skb, flowi4_to_flowi(&fl4));
1599be9f4a44SEric Dumazet 	rt = ip_route_output_key(net, &fl4);
1600b23dd4feSDavid S. Miller 	if (IS_ERR(rt))
16011da177e4SLinus Torvalds 		return;
16021da177e4SLinus Torvalds 
1603bdbbb852SEric Dumazet 	inet_sk(sk)->tos = arg->tos;
16041da177e4SLinus Torvalds 
16051da177e4SLinus Torvalds 	sk->sk_priority = skb->priority;
1606eddc9ec5SArnaldo Carvalho de Melo 	sk->sk_protocol = ip_hdr(skb)->protocol;
1607f0e48dbfSPatrick McHardy 	sk->sk_bound_dev_if = arg->bound_dev_if;
1608be9f4a44SEric Dumazet 	sk->sk_sndbuf = sysctl_wmem_default;
16094062090eSVasily Averin 	err = ip_append_data(sk, &fl4, ip_reply_glue_bits, arg->iov->iov_base,
16104062090eSVasily Averin 			     len, 0, &ipc, &rt, MSG_DONTWAIT);
16114062090eSVasily Averin 	if (unlikely(err)) {
16124062090eSVasily Averin 		ip_flush_pending_frames(sk);
16134062090eSVasily Averin 		goto out;
16144062090eSVasily Averin 	}
16154062090eSVasily Averin 
1616be9f4a44SEric Dumazet 	nskb = skb_peek(&sk->sk_write_queue);
1617be9f4a44SEric Dumazet 	if (nskb) {
16181da177e4SLinus Torvalds 		if (arg->csumoffset >= 0)
1619be9f4a44SEric Dumazet 			*((__sum16 *)skb_transport_header(nskb) +
1620be9f4a44SEric Dumazet 			  arg->csumoffset) = csum_fold(csum_add(nskb->csum,
16219c70220bSArnaldo Carvalho de Melo 								arg->csum));
1622be9f4a44SEric Dumazet 		nskb->ip_summed = CHECKSUM_NONE;
162377968b78SDavid S. Miller 		ip_push_pending_frames(sk, &fl4);
16241da177e4SLinus Torvalds 	}
16254062090eSVasily Averin out:
16261da177e4SLinus Torvalds 	ip_rt_put(rt);
16271da177e4SLinus Torvalds }
16281da177e4SLinus Torvalds 
16291da177e4SLinus Torvalds void __init ip_init(void)
16301da177e4SLinus Torvalds {
16311da177e4SLinus Torvalds 	ip_rt_init();
16321da177e4SLinus Torvalds 	inet_initpeers();
16331da177e4SLinus Torvalds 
163472c1d3bdSWANG Cong #if defined(CONFIG_IP_MULTICAST)
163572c1d3bdSWANG Cong 	igmp_mc_init();
16361da177e4SLinus Torvalds #endif
16371da177e4SLinus Torvalds }
1638