xref: /openbmc/linux/net/ipv4/ip_output.c (revision 4ff0620354f2b39b9fe2a91c22c4de9d1fba0c8e)
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 
457c0f6ba6SLinus Torvalds #include <linux/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>
7733b48679SDaniel Mack #include <linux/bpf-cgroup.h>
781da177e4SLinus Torvalds #include <linux/igmp.h>
791da177e4SLinus Torvalds #include <linux/netfilter_ipv4.h>
801da177e4SLinus Torvalds #include <linux/netfilter_bridge.h>
811da177e4SLinus Torvalds #include <linux/netlink.h>
826cbb0df7SArnaldo Carvalho de Melo #include <linux/tcp.h>
831da177e4SLinus Torvalds 
84694869b3SEric W. Biederman static int
85694869b3SEric W. Biederman ip_fragment(struct net *net, struct sock *sk, struct sk_buff *skb,
86c5501eb3SFlorian Westphal 	    unsigned int mtu,
87694869b3SEric W. Biederman 	    int (*output)(struct net *, struct sock *, struct sk_buff *));
8849d16b23SAndy Zhou 
891da177e4SLinus Torvalds /* Generate a checksum for an outgoing IP datagram. */
902fbd9679SDenis Efremov void ip_send_check(struct iphdr *iph)
911da177e4SLinus Torvalds {
921da177e4SLinus Torvalds 	iph->check = 0;
931da177e4SLinus Torvalds 	iph->check = ip_fast_csum((unsigned char *)iph, iph->ihl);
941da177e4SLinus Torvalds }
954bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_send_check);
961da177e4SLinus Torvalds 
97cf91a99dSEric W. Biederman int __ip_local_out(struct net *net, struct sock *sk, struct sk_buff *skb)
98c439cb2eSHerbert Xu {
99c439cb2eSHerbert Xu 	struct iphdr *iph = ip_hdr(skb);
100c439cb2eSHerbert Xu 
101c439cb2eSHerbert Xu 	iph->tot_len = htons(skb->len);
102c439cb2eSHerbert Xu 	ip_send_check(iph);
103a8e3e1a9SDavid Ahern 
104a8e3e1a9SDavid Ahern 	/* if egress device is enslaved to an L3 master device pass the
105a8e3e1a9SDavid Ahern 	 * skb to its handler for processing
106a8e3e1a9SDavid Ahern 	 */
107a8e3e1a9SDavid Ahern 	skb = l3mdev_ip_out(sk, skb);
108a8e3e1a9SDavid Ahern 	if (unlikely(!skb))
109a8e3e1a9SDavid Ahern 		return 0;
110a8e3e1a9SDavid Ahern 
111f4180439SEli Cooper 	skb->protocol = htons(ETH_P_IP);
112f4180439SEli Cooper 
11329a26a56SEric W. Biederman 	return nf_hook(NFPROTO_IPV4, NF_INET_LOCAL_OUT,
11429a26a56SEric W. Biederman 		       net, sk, skb, NULL, skb_dst(skb)->dev,
11513206b6bSEric W. Biederman 		       dst_output);
1167026b1ddSDavid Miller }
1177026b1ddSDavid Miller 
11833224b16SEric W. Biederman int ip_local_out(struct net *net, struct sock *sk, struct sk_buff *skb)
119c439cb2eSHerbert Xu {
120c439cb2eSHerbert Xu 	int err;
121c439cb2eSHerbert Xu 
122cf91a99dSEric W. Biederman 	err = __ip_local_out(net, sk, skb);
123c439cb2eSHerbert Xu 	if (likely(err == 1))
12413206b6bSEric W. Biederman 		err = dst_output(net, sk, skb);
125c439cb2eSHerbert Xu 
126c439cb2eSHerbert Xu 	return err;
127c439cb2eSHerbert Xu }
128e2cb77dbSEric W. Biederman EXPORT_SYMBOL_GPL(ip_local_out);
129c439cb2eSHerbert Xu 
1301da177e4SLinus Torvalds static inline int ip_select_ttl(struct inet_sock *inet, struct dst_entry *dst)
1311da177e4SLinus Torvalds {
1321da177e4SLinus Torvalds 	int ttl = inet->uc_ttl;
1331da177e4SLinus Torvalds 
1341da177e4SLinus Torvalds 	if (ttl < 0)
135323e126fSDavid S. Miller 		ttl = ip4_dst_hoplimit(dst);
1361da177e4SLinus Torvalds 	return ttl;
1371da177e4SLinus Torvalds }
1381da177e4SLinus Torvalds 
1391da177e4SLinus Torvalds /*
1401da177e4SLinus Torvalds  *		Add an ip header to a skbuff and send it out.
1411da177e4SLinus Torvalds  *
1421da177e4SLinus Torvalds  */
143cfe673b0SEric Dumazet int ip_build_and_send_pkt(struct sk_buff *skb, const struct sock *sk,
144f6d8bd05SEric Dumazet 			  __be32 saddr, __be32 daddr, struct ip_options_rcu *opt)
1451da177e4SLinus Torvalds {
1461da177e4SLinus Torvalds 	struct inet_sock *inet = inet_sk(sk);
147511c3f92SEric Dumazet 	struct rtable *rt = skb_rtable(skb);
14877589ce0SEric W. Biederman 	struct net *net = sock_net(sk);
1491da177e4SLinus Torvalds 	struct iphdr *iph;
1501da177e4SLinus Torvalds 
1511da177e4SLinus Torvalds 	/* Build the IP header. */
152f6d8bd05SEric Dumazet 	skb_push(skb, sizeof(struct iphdr) + (opt ? opt->opt.optlen : 0));
1538856dfa3SArnaldo Carvalho de Melo 	skb_reset_network_header(skb);
154eddc9ec5SArnaldo Carvalho de Melo 	iph = ip_hdr(skb);
1551da177e4SLinus Torvalds 	iph->version  = 4;
1561da177e4SLinus Torvalds 	iph->ihl      = 5;
1571da177e4SLinus Torvalds 	iph->tos      = inet->tos;
158d8d1f30bSChangli Gao 	iph->ttl      = ip_select_ttl(inet, &rt->dst);
159dd927a26SDavid S. Miller 	iph->daddr    = (opt && opt->opt.srr ? opt->opt.faddr : daddr);
160dd927a26SDavid S. Miller 	iph->saddr    = saddr;
1611da177e4SLinus Torvalds 	iph->protocol = sk->sk_protocol;
162cfe673b0SEric Dumazet 	if (ip_dont_fragment(sk, &rt->dst)) {
163cfe673b0SEric Dumazet 		iph->frag_off = htons(IP_DF);
164cfe673b0SEric Dumazet 		iph->id = 0;
165cfe673b0SEric Dumazet 	} else {
166cfe673b0SEric Dumazet 		iph->frag_off = 0;
16777589ce0SEric W. Biederman 		__ip_select_ident(net, iph, 1);
168cfe673b0SEric Dumazet 	}
1691da177e4SLinus Torvalds 
170f6d8bd05SEric Dumazet 	if (opt && opt->opt.optlen) {
171f6d8bd05SEric Dumazet 		iph->ihl += opt->opt.optlen>>2;
172f6d8bd05SEric Dumazet 		ip_options_build(skb, &opt->opt, daddr, rt, 0);
1731da177e4SLinus Torvalds 	}
1741da177e4SLinus Torvalds 
1751da177e4SLinus Torvalds 	skb->priority = sk->sk_priority;
1764a19ec58SLaszlo Attila Toth 	skb->mark = sk->sk_mark;
1771da177e4SLinus Torvalds 
1781da177e4SLinus Torvalds 	/* Send it out. */
17933224b16SEric W. Biederman 	return ip_local_out(net, skb->sk, skb);
1801da177e4SLinus Torvalds }
181d8c97a94SArnaldo Carvalho de Melo EXPORT_SYMBOL_GPL(ip_build_and_send_pkt);
182d8c97a94SArnaldo Carvalho de Melo 
183694869b3SEric W. Biederman static int ip_finish_output2(struct net *net, struct sock *sk, struct sk_buff *skb)
1841da177e4SLinus Torvalds {
185adf30907SEric Dumazet 	struct dst_entry *dst = skb_dst(skb);
18680787ebcSMitsuru Chinen 	struct rtable *rt = (struct rtable *)dst;
1871da177e4SLinus Torvalds 	struct net_device *dev = dst->dev;
188c2636b4dSChuck Lever 	unsigned int hh_len = LL_RESERVED_SPACE(dev);
189f6b72b62SDavid S. Miller 	struct neighbour *neigh;
190a263b309SDavid S. Miller 	u32 nexthop;
1911da177e4SLinus Torvalds 
192edf391ffSNeil Horman 	if (rt->rt_type == RTN_MULTICAST) {
1934ba1bf42SEric W. Biederman 		IP_UPD_PO_STATS(net, IPSTATS_MIB_OUTMCAST, skb->len);
194edf391ffSNeil Horman 	} else if (rt->rt_type == RTN_BROADCAST)
1954ba1bf42SEric W. Biederman 		IP_UPD_PO_STATS(net, IPSTATS_MIB_OUTBCAST, skb->len);
19680787ebcSMitsuru Chinen 
1971da177e4SLinus Torvalds 	/* Be paranoid, rather than too clever. */
1983b04dddeSStephen Hemminger 	if (unlikely(skb_headroom(skb) < hh_len && dev->header_ops)) {
1991da177e4SLinus Torvalds 		struct sk_buff *skb2;
2001da177e4SLinus Torvalds 
2011da177e4SLinus Torvalds 		skb2 = skb_realloc_headroom(skb, LL_RESERVED_SPACE(dev));
20251456b29SIan Morris 		if (!skb2) {
2031da177e4SLinus Torvalds 			kfree_skb(skb);
2041da177e4SLinus Torvalds 			return -ENOMEM;
2051da177e4SLinus Torvalds 		}
2061da177e4SLinus Torvalds 		if (skb->sk)
2071da177e4SLinus Torvalds 			skb_set_owner_w(skb2, skb->sk);
2085d0ba55bSEric Dumazet 		consume_skb(skb);
2091da177e4SLinus Torvalds 		skb = skb2;
2101da177e4SLinus Torvalds 	}
2111da177e4SLinus Torvalds 
21214972cbdSRoopa Prabhu 	if (lwtunnel_xmit_redirect(dst->lwtstate)) {
21314972cbdSRoopa Prabhu 		int res = lwtunnel_xmit(skb);
21414972cbdSRoopa Prabhu 
21514972cbdSRoopa Prabhu 		if (res < 0 || res == LWTUNNEL_XMIT_DONE)
21614972cbdSRoopa Prabhu 			return res;
21714972cbdSRoopa Prabhu 	}
21814972cbdSRoopa Prabhu 
219a263b309SDavid S. Miller 	rcu_read_lock_bh();
220155e8336SJulian Anastasov 	nexthop = (__force u32) rt_nexthop(rt, ip_hdr(skb)->daddr);
221a263b309SDavid S. Miller 	neigh = __ipv4_neigh_lookup_noref(dev, nexthop);
222a263b309SDavid S. Miller 	if (unlikely(!neigh))
223a263b309SDavid S. Miller 		neigh = __neigh_create(&arp_tbl, &nexthop, dev, false);
2249871f1adSVasiliy Kulikov 	if (!IS_ERR(neigh)) {
225*4ff06203SJulian Anastasov 		int res;
226*4ff06203SJulian Anastasov 
227*4ff06203SJulian Anastasov 		sock_confirm_neigh(skb, neigh);
228*4ff06203SJulian Anastasov 		res = dst_neigh_output(dst, neigh, skb);
229f2c31e32SEric Dumazet 
230a263b309SDavid S. Miller 		rcu_read_unlock_bh();
231f2c31e32SEric Dumazet 		return res;
232f2c31e32SEric Dumazet 	}
233a263b309SDavid S. Miller 	rcu_read_unlock_bh();
23405e3aa09SDavid S. Miller 
235e87cc472SJoe Perches 	net_dbg_ratelimited("%s: No header cache and no neighbour!\n",
236e87cc472SJoe Perches 			    __func__);
2371da177e4SLinus Torvalds 	kfree_skb(skb);
2381da177e4SLinus Torvalds 	return -EINVAL;
2391da177e4SLinus Torvalds }
2401da177e4SLinus Torvalds 
241694869b3SEric W. Biederman static int ip_finish_output_gso(struct net *net, struct sock *sk,
242694869b3SEric W. Biederman 				struct sk_buff *skb, unsigned int mtu)
243c7ba65d7SFlorian Westphal {
244c7ba65d7SFlorian Westphal 	netdev_features_t features;
245c7ba65d7SFlorian Westphal 	struct sk_buff *segs;
246c7ba65d7SFlorian Westphal 	int ret = 0;
247c7ba65d7SFlorian Westphal 
2489ee6c5dcSLance Richardson 	/* common case: seglen is <= mtu
249359ebda2SShmulik Ladkani 	 */
2509ee6c5dcSLance Richardson 	if (skb_gso_validate_mtu(skb, mtu))
251694869b3SEric W. Biederman 		return ip_finish_output2(net, sk, skb);
252c7ba65d7SFlorian Westphal 
2530ace81ecSLance Richardson 	/* Slowpath -  GSO segment length exceeds the egress MTU.
254c7ba65d7SFlorian Westphal 	 *
2550ace81ecSLance Richardson 	 * This can happen in several cases:
2560ace81ecSLance Richardson 	 *  - Forwarding of a TCP GRO skb, when DF flag is not set.
2570ace81ecSLance Richardson 	 *  - Forwarding of an skb that arrived on a virtualization interface
2580ace81ecSLance Richardson 	 *    (virtio-net/vhost/tap) with TSO/GSO size set by other network
2590ace81ecSLance Richardson 	 *    stack.
2600ace81ecSLance Richardson 	 *  - Local GSO skb transmitted on an NETIF_F_TSO tunnel stacked over an
2610ace81ecSLance Richardson 	 *    interface with a smaller MTU.
2620ace81ecSLance Richardson 	 *  - Arriving GRO skb (or GSO skb in a virtualized environment) that is
2630ace81ecSLance Richardson 	 *    bridged to a NETIF_F_TSO tunnel stacked over an interface with an
2640ace81ecSLance Richardson 	 *    insufficent MTU.
265c7ba65d7SFlorian Westphal 	 */
266c7ba65d7SFlorian Westphal 	features = netif_skb_features(skb);
2679207f9d4SKonstantin Khlebnikov 	BUILD_BUG_ON(sizeof(*IPCB(skb)) > SKB_SGO_CB_OFFSET);
268c7ba65d7SFlorian Westphal 	segs = skb_gso_segment(skb, features & ~NETIF_F_GSO_MASK);
269330966e5SFlorian Westphal 	if (IS_ERR_OR_NULL(segs)) {
270c7ba65d7SFlorian Westphal 		kfree_skb(skb);
271c7ba65d7SFlorian Westphal 		return -ENOMEM;
272c7ba65d7SFlorian Westphal 	}
273c7ba65d7SFlorian Westphal 
274c7ba65d7SFlorian Westphal 	consume_skb(skb);
275c7ba65d7SFlorian Westphal 
276c7ba65d7SFlorian Westphal 	do {
277c7ba65d7SFlorian Westphal 		struct sk_buff *nskb = segs->next;
278c7ba65d7SFlorian Westphal 		int err;
279c7ba65d7SFlorian Westphal 
280c7ba65d7SFlorian Westphal 		segs->next = NULL;
281694869b3SEric W. Biederman 		err = ip_fragment(net, sk, segs, mtu, ip_finish_output2);
282c7ba65d7SFlorian Westphal 
283c7ba65d7SFlorian Westphal 		if (err && ret == 0)
284c7ba65d7SFlorian Westphal 			ret = err;
285c7ba65d7SFlorian Westphal 		segs = nskb;
286c7ba65d7SFlorian Westphal 	} while (segs);
287c7ba65d7SFlorian Westphal 
288c7ba65d7SFlorian Westphal 	return ret;
289c7ba65d7SFlorian Westphal }
290c7ba65d7SFlorian Westphal 
2910c4b51f0SEric W. Biederman static int ip_finish_output(struct net *net, struct sock *sk, struct sk_buff *skb)
2921da177e4SLinus Torvalds {
293c5501eb3SFlorian Westphal 	unsigned int mtu;
29433b48679SDaniel Mack 	int ret;
29533b48679SDaniel Mack 
29633b48679SDaniel Mack 	ret = BPF_CGROUP_RUN_PROG_INET_EGRESS(sk, skb);
29733b48679SDaniel Mack 	if (ret) {
29833b48679SDaniel Mack 		kfree_skb(skb);
29933b48679SDaniel Mack 		return ret;
30033b48679SDaniel Mack 	}
301c5501eb3SFlorian Westphal 
3025c901daaSPatrick McHardy #if defined(CONFIG_NETFILTER) && defined(CONFIG_XFRM)
3035c901daaSPatrick McHardy 	/* Policy lookup after SNAT yielded a new policy */
30400db4124SIan Morris 	if (skb_dst(skb)->xfrm) {
30548d5cad8SPatrick McHardy 		IPCB(skb)->flags |= IPSKB_REROUTED;
30613206b6bSEric W. Biederman 		return dst_output(net, sk, skb);
30748d5cad8SPatrick McHardy 	}
3085c901daaSPatrick McHardy #endif
309fedbb6b4SShmulik Ladkani 	mtu = ip_skb_dst_mtu(sk, skb);
310c7ba65d7SFlorian Westphal 	if (skb_is_gso(skb))
311694869b3SEric W. Biederman 		return ip_finish_output_gso(net, sk, skb, mtu);
312c7ba65d7SFlorian Westphal 
313d6b915e2SFlorian Westphal 	if (skb->len > mtu || (IPCB(skb)->flags & IPSKB_FRAG_PMTU))
314694869b3SEric W. Biederman 		return ip_fragment(net, sk, skb, mtu, ip_finish_output2);
315c7ba65d7SFlorian Westphal 
316694869b3SEric W. Biederman 	return ip_finish_output2(net, sk, skb);
3171da177e4SLinus Torvalds }
3181da177e4SLinus Torvalds 
31933b48679SDaniel Mack static int ip_mc_finish_output(struct net *net, struct sock *sk,
32033b48679SDaniel Mack 			       struct sk_buff *skb)
32133b48679SDaniel Mack {
32233b48679SDaniel Mack 	int ret;
32333b48679SDaniel Mack 
32433b48679SDaniel Mack 	ret = BPF_CGROUP_RUN_PROG_INET_EGRESS(sk, skb);
32533b48679SDaniel Mack 	if (ret) {
32633b48679SDaniel Mack 		kfree_skb(skb);
32733b48679SDaniel Mack 		return ret;
32833b48679SDaniel Mack 	}
32933b48679SDaniel Mack 
33033b48679SDaniel Mack 	return dev_loopback_xmit(net, sk, skb);
33133b48679SDaniel Mack }
33233b48679SDaniel Mack 
333ede2059dSEric W. Biederman int ip_mc_output(struct net *net, struct sock *sk, struct sk_buff *skb)
3341da177e4SLinus Torvalds {
335511c3f92SEric Dumazet 	struct rtable *rt = skb_rtable(skb);
336d8d1f30bSChangli Gao 	struct net_device *dev = rt->dst.dev;
3371da177e4SLinus Torvalds 
3381da177e4SLinus Torvalds 	/*
3391da177e4SLinus Torvalds 	 *	If the indicated interface is up and running, send the packet.
3401da177e4SLinus Torvalds 	 */
34188f5cc24SEric W. Biederman 	IP_UPD_PO_STATS(net, IPSTATS_MIB_OUT, skb->len);
3421da177e4SLinus Torvalds 
3431da177e4SLinus Torvalds 	skb->dev = dev;
3441da177e4SLinus Torvalds 	skb->protocol = htons(ETH_P_IP);
3451da177e4SLinus Torvalds 
3461da177e4SLinus Torvalds 	/*
3471da177e4SLinus Torvalds 	 *	Multicasts are looped back for other local users
3481da177e4SLinus Torvalds 	 */
3491da177e4SLinus Torvalds 
3501da177e4SLinus Torvalds 	if (rt->rt_flags&RTCF_MULTICAST) {
3517ad6848cSOctavian Purdila 		if (sk_mc_loop(sk)
3521da177e4SLinus Torvalds #ifdef CONFIG_IP_MROUTE
3531da177e4SLinus Torvalds 		/* Small optimization: do not loopback not local frames,
3541da177e4SLinus Torvalds 		   which returned after forwarding; they will be  dropped
3551da177e4SLinus Torvalds 		   by ip_mr_input in any case.
3561da177e4SLinus Torvalds 		   Note, that local frames are looped back to be delivered
3571da177e4SLinus Torvalds 		   to local recipients.
3581da177e4SLinus Torvalds 
3591da177e4SLinus Torvalds 		   This check is duplicated in ip_mr_input at the moment.
3601da177e4SLinus Torvalds 		 */
3619d4fb27dSJoe Perches 		    &&
3629d4fb27dSJoe Perches 		    ((rt->rt_flags & RTCF_LOCAL) ||
3639d4fb27dSJoe Perches 		     !(IPCB(skb)->flags & IPSKB_FORWARDED))
3641da177e4SLinus Torvalds #endif
3651da177e4SLinus Torvalds 		   ) {
3661da177e4SLinus Torvalds 			struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC);
3671da177e4SLinus Torvalds 			if (newskb)
3689bbc768aSJan Engelhardt 				NF_HOOK(NFPROTO_IPV4, NF_INET_POST_ROUTING,
36929a26a56SEric W. Biederman 					net, sk, newskb, NULL, newskb->dev,
37033b48679SDaniel Mack 					ip_mc_finish_output);
3711da177e4SLinus Torvalds 		}
3721da177e4SLinus Torvalds 
3731da177e4SLinus Torvalds 		/* Multicasts with ttl 0 must not go beyond the host */
3741da177e4SLinus Torvalds 
375eddc9ec5SArnaldo Carvalho de Melo 		if (ip_hdr(skb)->ttl == 0) {
3761da177e4SLinus Torvalds 			kfree_skb(skb);
3771da177e4SLinus Torvalds 			return 0;
3781da177e4SLinus Torvalds 		}
3791da177e4SLinus Torvalds 	}
3801da177e4SLinus Torvalds 
3811da177e4SLinus Torvalds 	if (rt->rt_flags&RTCF_BROADCAST) {
3821da177e4SLinus Torvalds 		struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC);
3831da177e4SLinus Torvalds 		if (newskb)
38429a26a56SEric W. Biederman 			NF_HOOK(NFPROTO_IPV4, NF_INET_POST_ROUTING,
38529a26a56SEric W. Biederman 				net, sk, newskb, NULL, newskb->dev,
38633b48679SDaniel Mack 				ip_mc_finish_output);
3871da177e4SLinus Torvalds 	}
3881da177e4SLinus Torvalds 
38929a26a56SEric W. Biederman 	return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING,
39029a26a56SEric W. Biederman 			    net, sk, skb, NULL, skb->dev,
39129a26a56SEric W. Biederman 			    ip_finish_output,
39248d5cad8SPatrick McHardy 			    !(IPCB(skb)->flags & IPSKB_REROUTED));
3931da177e4SLinus Torvalds }
3941da177e4SLinus Torvalds 
395ede2059dSEric W. Biederman int ip_output(struct net *net, struct sock *sk, struct sk_buff *skb)
3961da177e4SLinus Torvalds {
397adf30907SEric Dumazet 	struct net_device *dev = skb_dst(skb)->dev;
3981bd9bef6SPatrick McHardy 
39988f5cc24SEric W. Biederman 	IP_UPD_PO_STATS(net, IPSTATS_MIB_OUT, skb->len);
4001da177e4SLinus Torvalds 
4011bd9bef6SPatrick McHardy 	skb->dev = dev;
4021bd9bef6SPatrick McHardy 	skb->protocol = htons(ETH_P_IP);
4031bd9bef6SPatrick McHardy 
40429a26a56SEric W. Biederman 	return NF_HOOK_COND(NFPROTO_IPV4, NF_INET_POST_ROUTING,
40529a26a56SEric W. Biederman 			    net, sk, skb, NULL, dev,
40648d5cad8SPatrick McHardy 			    ip_finish_output,
40748d5cad8SPatrick McHardy 			    !(IPCB(skb)->flags & IPSKB_REROUTED));
4081da177e4SLinus Torvalds }
4091da177e4SLinus Torvalds 
41084f9307cSEric Dumazet /*
41184f9307cSEric Dumazet  * copy saddr and daddr, possibly using 64bit load/stores
41284f9307cSEric Dumazet  * Equivalent to :
41384f9307cSEric Dumazet  *   iph->saddr = fl4->saddr;
41484f9307cSEric Dumazet  *   iph->daddr = fl4->daddr;
41584f9307cSEric Dumazet  */
41684f9307cSEric Dumazet static void ip_copy_addrs(struct iphdr *iph, const struct flowi4 *fl4)
41784f9307cSEric Dumazet {
41884f9307cSEric Dumazet 	BUILD_BUG_ON(offsetof(typeof(*fl4), daddr) !=
41984f9307cSEric Dumazet 		     offsetof(typeof(*fl4), saddr) + sizeof(fl4->saddr));
42084f9307cSEric Dumazet 	memcpy(&iph->saddr, &fl4->saddr,
42184f9307cSEric Dumazet 	       sizeof(fl4->saddr) + sizeof(fl4->daddr));
42284f9307cSEric Dumazet }
42384f9307cSEric Dumazet 
424b0270e91SEric Dumazet /* Note: skb->sk can be different from sk, in case of tunnels */
425b0270e91SEric Dumazet int ip_queue_xmit(struct sock *sk, struct sk_buff *skb, struct flowi *fl)
4261da177e4SLinus Torvalds {
4271da177e4SLinus Torvalds 	struct inet_sock *inet = inet_sk(sk);
42877589ce0SEric W. Biederman 	struct net *net = sock_net(sk);
429f6d8bd05SEric Dumazet 	struct ip_options_rcu *inet_opt;
430b57ae01aSDavid S. Miller 	struct flowi4 *fl4;
4311da177e4SLinus Torvalds 	struct rtable *rt;
4321da177e4SLinus Torvalds 	struct iphdr *iph;
433ab6e3febSEric Dumazet 	int res;
4341da177e4SLinus Torvalds 
4351da177e4SLinus Torvalds 	/* Skip all of this if the packet is already routed,
4361da177e4SLinus Torvalds 	 * f.e. by something like SCTP.
4371da177e4SLinus Torvalds 	 */
438ab6e3febSEric Dumazet 	rcu_read_lock();
439f6d8bd05SEric Dumazet 	inet_opt = rcu_dereference(inet->inet_opt);
440ea4fc0d6SDavid S. Miller 	fl4 = &fl->u.ip4;
441511c3f92SEric Dumazet 	rt = skb_rtable(skb);
44200db4124SIan Morris 	if (rt)
4431da177e4SLinus Torvalds 		goto packet_routed;
4441da177e4SLinus Torvalds 
4451da177e4SLinus Torvalds 	/* Make sure we can route this packet. */
4461da177e4SLinus Torvalds 	rt = (struct rtable *)__sk_dst_check(sk, 0);
44751456b29SIan Morris 	if (!rt) {
4483ca3c68eSAl Viro 		__be32 daddr;
4491da177e4SLinus Torvalds 
4501da177e4SLinus Torvalds 		/* Use correct destination address if we have options. */
451c720c7e8SEric Dumazet 		daddr = inet->inet_daddr;
452f6d8bd05SEric Dumazet 		if (inet_opt && inet_opt->opt.srr)
453f6d8bd05SEric Dumazet 			daddr = inet_opt->opt.faddr;
4541da177e4SLinus Torvalds 
4551da177e4SLinus Torvalds 		/* If this fails, retransmit mechanism of transport layer will
4561da177e4SLinus Torvalds 		 * keep trying until route appears or the connection times
4571da177e4SLinus Torvalds 		 * itself out.
4581da177e4SLinus Torvalds 		 */
45977589ce0SEric W. Biederman 		rt = ip_route_output_ports(net, fl4, sk,
46078fbfd8aSDavid S. Miller 					   daddr, inet->inet_saddr,
46178fbfd8aSDavid S. Miller 					   inet->inet_dport,
46278fbfd8aSDavid S. Miller 					   inet->inet_sport,
46378fbfd8aSDavid S. Miller 					   sk->sk_protocol,
46478fbfd8aSDavid S. Miller 					   RT_CONN_FLAGS(sk),
46578fbfd8aSDavid S. Miller 					   sk->sk_bound_dev_if);
466b23dd4feSDavid S. Miller 		if (IS_ERR(rt))
4671da177e4SLinus Torvalds 			goto no_route;
468d8d1f30bSChangli Gao 		sk_setup_caps(sk, &rt->dst);
4691da177e4SLinus Torvalds 	}
470d8d1f30bSChangli Gao 	skb_dst_set_noref(skb, &rt->dst);
4711da177e4SLinus Torvalds 
4721da177e4SLinus Torvalds packet_routed:
473155e8336SJulian Anastasov 	if (inet_opt && inet_opt->opt.is_strictroute && rt->rt_uses_gateway)
4741da177e4SLinus Torvalds 		goto no_route;
4751da177e4SLinus Torvalds 
4761da177e4SLinus Torvalds 	/* OK, we know where to send it, allocate and build IP header. */
477f6d8bd05SEric Dumazet 	skb_push(skb, sizeof(struct iphdr) + (inet_opt ? inet_opt->opt.optlen : 0));
4788856dfa3SArnaldo Carvalho de Melo 	skb_reset_network_header(skb);
479eddc9ec5SArnaldo Carvalho de Melo 	iph = ip_hdr(skb);
480714e85beSAl Viro 	*((__be16 *)iph) = htons((4 << 12) | (5 << 8) | (inet->tos & 0xff));
48160ff7467SWANG Cong 	if (ip_dont_fragment(sk, &rt->dst) && !skb->ignore_df)
4821da177e4SLinus Torvalds 		iph->frag_off = htons(IP_DF);
4831da177e4SLinus Torvalds 	else
4841da177e4SLinus Torvalds 		iph->frag_off = 0;
485d8d1f30bSChangli Gao 	iph->ttl      = ip_select_ttl(inet, &rt->dst);
4861da177e4SLinus Torvalds 	iph->protocol = sk->sk_protocol;
48784f9307cSEric Dumazet 	ip_copy_addrs(iph, fl4);
48884f9307cSEric Dumazet 
4891da177e4SLinus Torvalds 	/* Transport layer set skb->h.foo itself. */
4901da177e4SLinus Torvalds 
491f6d8bd05SEric Dumazet 	if (inet_opt && inet_opt->opt.optlen) {
492f6d8bd05SEric Dumazet 		iph->ihl += inet_opt->opt.optlen >> 2;
493f6d8bd05SEric Dumazet 		ip_options_build(skb, &inet_opt->opt, inet->inet_daddr, rt, 0);
4941da177e4SLinus Torvalds 	}
4951da177e4SLinus Torvalds 
49677589ce0SEric W. Biederman 	ip_select_ident_segs(net, skb, sk,
497b6a7719aSHannes Frederic Sowa 			     skb_shinfo(skb)->gso_segs ?: 1);
4981da177e4SLinus Torvalds 
499b0270e91SEric Dumazet 	/* TODO : should we use skb->sk here instead of sk ? */
5001da177e4SLinus Torvalds 	skb->priority = sk->sk_priority;
5014a19ec58SLaszlo Attila Toth 	skb->mark = sk->sk_mark;
5021da177e4SLinus Torvalds 
50333224b16SEric W. Biederman 	res = ip_local_out(net, sk, skb);
504ab6e3febSEric Dumazet 	rcu_read_unlock();
505ab6e3febSEric Dumazet 	return res;
5061da177e4SLinus Torvalds 
5071da177e4SLinus Torvalds no_route:
508ab6e3febSEric Dumazet 	rcu_read_unlock();
50977589ce0SEric W. Biederman 	IP_INC_STATS(net, IPSTATS_MIB_OUTNOROUTES);
5101da177e4SLinus Torvalds 	kfree_skb(skb);
5111da177e4SLinus Torvalds 	return -EHOSTUNREACH;
5121da177e4SLinus Torvalds }
5134bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_queue_xmit);
5141da177e4SLinus Torvalds 
5151da177e4SLinus Torvalds static void ip_copy_metadata(struct sk_buff *to, struct sk_buff *from)
5161da177e4SLinus Torvalds {
5171da177e4SLinus Torvalds 	to->pkt_type = from->pkt_type;
5181da177e4SLinus Torvalds 	to->priority = from->priority;
5191da177e4SLinus Torvalds 	to->protocol = from->protocol;
520adf30907SEric Dumazet 	skb_dst_drop(to);
521fe76cda3SEric Dumazet 	skb_dst_copy(to, from);
5221da177e4SLinus Torvalds 	to->dev = from->dev;
52382e91ffeSThomas Graf 	to->mark = from->mark;
5241da177e4SLinus Torvalds 
5251da177e4SLinus Torvalds 	/* Copy the flags to each fragment. */
5261da177e4SLinus Torvalds 	IPCB(to)->flags = IPCB(from)->flags;
5271da177e4SLinus Torvalds 
5281da177e4SLinus Torvalds #ifdef CONFIG_NET_SCHED
5291da177e4SLinus Torvalds 	to->tc_index = from->tc_index;
5301da177e4SLinus Torvalds #endif
531e7ac05f3SYasuyuki Kozakai 	nf_copy(to, from);
5326ca40d4eSJavier Martinez Canillas #if IS_ENABLED(CONFIG_IP_VS)
533c98d80edSJulian Anastasov 	to->ipvs_property = from->ipvs_property;
534c98d80edSJulian Anastasov #endif
535984bc16cSJames Morris 	skb_copy_secmark(to, from);
5361da177e4SLinus Torvalds }
5371da177e4SLinus Torvalds 
538694869b3SEric W. Biederman static int ip_fragment(struct net *net, struct sock *sk, struct sk_buff *skb,
539c5501eb3SFlorian Westphal 		       unsigned int mtu,
540694869b3SEric W. Biederman 		       int (*output)(struct net *, struct sock *, struct sk_buff *))
54149d16b23SAndy Zhou {
54249d16b23SAndy Zhou 	struct iphdr *iph = ip_hdr(skb);
54349d16b23SAndy Zhou 
544d6b915e2SFlorian Westphal 	if ((iph->frag_off & htons(IP_DF)) == 0)
545694869b3SEric W. Biederman 		return ip_do_fragment(net, sk, skb, output);
546d6b915e2SFlorian Westphal 
547d6b915e2SFlorian Westphal 	if (unlikely(!skb->ignore_df ||
54849d16b23SAndy Zhou 		     (IPCB(skb)->frag_max_size &&
54949d16b23SAndy Zhou 		      IPCB(skb)->frag_max_size > mtu))) {
5509479b0afSEric W. Biederman 		IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS);
55149d16b23SAndy Zhou 		icmp_send(skb, ICMP_DEST_UNREACH, ICMP_FRAG_NEEDED,
55249d16b23SAndy Zhou 			  htonl(mtu));
55349d16b23SAndy Zhou 		kfree_skb(skb);
55449d16b23SAndy Zhou 		return -EMSGSIZE;
55549d16b23SAndy Zhou 	}
55649d16b23SAndy Zhou 
557694869b3SEric W. Biederman 	return ip_do_fragment(net, sk, skb, output);
55849d16b23SAndy Zhou }
55949d16b23SAndy Zhou 
5601da177e4SLinus Torvalds /*
5611da177e4SLinus Torvalds  *	This IP datagram is too large to be sent in one piece.  Break it up into
5621da177e4SLinus Torvalds  *	smaller pieces (each of size equal to IP header plus
5631da177e4SLinus Torvalds  *	a block of the data of the original IP data part) that will yet fit in a
5641da177e4SLinus Torvalds  *	single device frame, and queue such a frame for sending.
5651da177e4SLinus Torvalds  */
5661da177e4SLinus Torvalds 
567694869b3SEric W. Biederman int ip_do_fragment(struct net *net, struct sock *sk, struct sk_buff *skb,
568694869b3SEric W. Biederman 		   int (*output)(struct net *, struct sock *, struct sk_buff *))
5691da177e4SLinus Torvalds {
5701da177e4SLinus Torvalds 	struct iphdr *iph;
5711da177e4SLinus Torvalds 	int ptr;
5721da177e4SLinus Torvalds 	struct sk_buff *skb2;
573c893b806SChangli Gao 	unsigned int mtu, hlen, left, len, ll_rs;
5741da177e4SLinus Torvalds 	int offset;
57576ab608dSAlexey Dobriyan 	__be16 not_last_frag;
576511c3f92SEric Dumazet 	struct rtable *rt = skb_rtable(skb);
5771da177e4SLinus Torvalds 	int err = 0;
5781da177e4SLinus Torvalds 
579dbd3393cSHannes Frederic Sowa 	/* for offloaded checksums cleanup checksum before fragmentation */
580dbd3393cSHannes Frederic Sowa 	if (skb->ip_summed == CHECKSUM_PARTIAL &&
581dbd3393cSHannes Frederic Sowa 	    (err = skb_checksum_help(skb)))
582dbd3393cSHannes Frederic Sowa 		goto fail;
583dbd3393cSHannes Frederic Sowa 
5841da177e4SLinus Torvalds 	/*
5851da177e4SLinus Torvalds 	 *	Point into the IP datagram header.
5861da177e4SLinus Torvalds 	 */
5871da177e4SLinus Torvalds 
588eddc9ec5SArnaldo Carvalho de Melo 	iph = ip_hdr(skb);
5891da177e4SLinus Torvalds 
590fedbb6b4SShmulik Ladkani 	mtu = ip_skb_dst_mtu(sk, skb);
591d6b915e2SFlorian Westphal 	if (IPCB(skb)->frag_max_size && IPCB(skb)->frag_max_size < mtu)
592d6b915e2SFlorian Westphal 		mtu = IPCB(skb)->frag_max_size;
5931da177e4SLinus Torvalds 
5941da177e4SLinus Torvalds 	/*
5951da177e4SLinus Torvalds 	 *	Setup starting values.
5961da177e4SLinus Torvalds 	 */
5971da177e4SLinus Torvalds 
5981da177e4SLinus Torvalds 	hlen = iph->ihl * 4;
599f87c10a8SHannes Frederic Sowa 	mtu = mtu - hlen;	/* Size of data space */
60089cee8b1SHerbert Xu 	IPCB(skb)->flags |= IPSKB_FRAG_COMPLETE;
6011da177e4SLinus Torvalds 
6021da177e4SLinus Torvalds 	/* When frag_list is given, use it. First, check its validity:
6031da177e4SLinus Torvalds 	 * some transformers could create wrong frag_list or break existing
6041da177e4SLinus Torvalds 	 * one, it is not prohibited. In this case fall back to copying.
6051da177e4SLinus Torvalds 	 *
6061da177e4SLinus Torvalds 	 * LATER: this step can be merged to real generation of fragments,
6071da177e4SLinus Torvalds 	 * we can switch to copy when see the first bad fragment.
6081da177e4SLinus Torvalds 	 */
60921dc3301SDavid S. Miller 	if (skb_has_frag_list(skb)) {
6103d13008eSEric Dumazet 		struct sk_buff *frag, *frag2;
611c72d8cdaSAlexey Dobriyan 		unsigned int first_len = skb_pagelen(skb);
6121da177e4SLinus Torvalds 
6131da177e4SLinus Torvalds 		if (first_len - hlen > mtu ||
6141da177e4SLinus Torvalds 		    ((first_len - hlen) & 7) ||
61556f8a75cSPaul Gortmaker 		    ip_is_fragment(iph) ||
6161da177e4SLinus Torvalds 		    skb_cloned(skb))
6171da177e4SLinus Torvalds 			goto slow_path;
6181da177e4SLinus Torvalds 
619d7fcf1a5SDavid S. Miller 		skb_walk_frags(skb, frag) {
6201da177e4SLinus Torvalds 			/* Correct geometry. */
6211da177e4SLinus Torvalds 			if (frag->len > mtu ||
6221da177e4SLinus Torvalds 			    ((frag->len & 7) && frag->next) ||
6231da177e4SLinus Torvalds 			    skb_headroom(frag) < hlen)
6243d13008eSEric Dumazet 				goto slow_path_clean;
6251da177e4SLinus Torvalds 
6261da177e4SLinus Torvalds 			/* Partially cloned skb? */
6271da177e4SLinus Torvalds 			if (skb_shared(frag))
6283d13008eSEric Dumazet 				goto slow_path_clean;
6292fdba6b0SHerbert Xu 
6302fdba6b0SHerbert Xu 			BUG_ON(frag->sk);
6312fdba6b0SHerbert Xu 			if (skb->sk) {
6322fdba6b0SHerbert Xu 				frag->sk = skb->sk;
6332fdba6b0SHerbert Xu 				frag->destructor = sock_wfree;
6342fdba6b0SHerbert Xu 			}
6353d13008eSEric Dumazet 			skb->truesize -= frag->truesize;
6361da177e4SLinus Torvalds 		}
6371da177e4SLinus Torvalds 
6381da177e4SLinus Torvalds 		/* Everything is OK. Generate! */
6391da177e4SLinus Torvalds 
6401da177e4SLinus Torvalds 		err = 0;
6411da177e4SLinus Torvalds 		offset = 0;
6421da177e4SLinus Torvalds 		frag = skb_shinfo(skb)->frag_list;
643d7fcf1a5SDavid S. Miller 		skb_frag_list_init(skb);
6441da177e4SLinus Torvalds 		skb->data_len = first_len - skb_headlen(skb);
6451da177e4SLinus Torvalds 		skb->len = first_len;
6461da177e4SLinus Torvalds 		iph->tot_len = htons(first_len);
6471da177e4SLinus Torvalds 		iph->frag_off = htons(IP_MF);
6481da177e4SLinus Torvalds 		ip_send_check(iph);
6491da177e4SLinus Torvalds 
6501da177e4SLinus Torvalds 		for (;;) {
6511da177e4SLinus Torvalds 			/* Prepare header of the next frame,
6521da177e4SLinus Torvalds 			 * before previous one went down. */
6531da177e4SLinus Torvalds 			if (frag) {
6541da177e4SLinus Torvalds 				frag->ip_summed = CHECKSUM_NONE;
655badff6d0SArnaldo Carvalho de Melo 				skb_reset_transport_header(frag);
656e2d1bca7SArnaldo Carvalho de Melo 				__skb_push(frag, hlen);
657e2d1bca7SArnaldo Carvalho de Melo 				skb_reset_network_header(frag);
658d56f90a7SArnaldo Carvalho de Melo 				memcpy(skb_network_header(frag), iph, hlen);
659eddc9ec5SArnaldo Carvalho de Melo 				iph = ip_hdr(frag);
6601da177e4SLinus Torvalds 				iph->tot_len = htons(frag->len);
6611da177e4SLinus Torvalds 				ip_copy_metadata(frag, skb);
6621da177e4SLinus Torvalds 				if (offset == 0)
6631da177e4SLinus Torvalds 					ip_options_fragment(frag);
6641da177e4SLinus Torvalds 				offset += skb->len - hlen;
6651da177e4SLinus Torvalds 				iph->frag_off = htons(offset>>3);
66600db4124SIan Morris 				if (frag->next)
6671da177e4SLinus Torvalds 					iph->frag_off |= htons(IP_MF);
6681da177e4SLinus Torvalds 				/* Ready, complete checksum */
6691da177e4SLinus Torvalds 				ip_send_check(iph);
6701da177e4SLinus Torvalds 			}
6711da177e4SLinus Torvalds 
672694869b3SEric W. Biederman 			err = output(net, sk, skb);
6731da177e4SLinus Torvalds 
674dafee490SWei Dong 			if (!err)
67526a949dbSEric W. Biederman 				IP_INC_STATS(net, IPSTATS_MIB_FRAGCREATES);
6761da177e4SLinus Torvalds 			if (err || !frag)
6771da177e4SLinus Torvalds 				break;
6781da177e4SLinus Torvalds 
6791da177e4SLinus Torvalds 			skb = frag;
6801da177e4SLinus Torvalds 			frag = skb->next;
6811da177e4SLinus Torvalds 			skb->next = NULL;
6821da177e4SLinus Torvalds 		}
6831da177e4SLinus Torvalds 
6841da177e4SLinus Torvalds 		if (err == 0) {
68526a949dbSEric W. Biederman 			IP_INC_STATS(net, IPSTATS_MIB_FRAGOKS);
6861da177e4SLinus Torvalds 			return 0;
6871da177e4SLinus Torvalds 		}
6881da177e4SLinus Torvalds 
6891da177e4SLinus Torvalds 		while (frag) {
6901da177e4SLinus Torvalds 			skb = frag->next;
6911da177e4SLinus Torvalds 			kfree_skb(frag);
6921da177e4SLinus Torvalds 			frag = skb;
6931da177e4SLinus Torvalds 		}
69426a949dbSEric W. Biederman 		IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS);
6951da177e4SLinus Torvalds 		return err;
6963d13008eSEric Dumazet 
6973d13008eSEric Dumazet slow_path_clean:
6983d13008eSEric Dumazet 		skb_walk_frags(skb, frag2) {
6993d13008eSEric Dumazet 			if (frag2 == frag)
7003d13008eSEric Dumazet 				break;
7013d13008eSEric Dumazet 			frag2->sk = NULL;
7023d13008eSEric Dumazet 			frag2->destructor = NULL;
7033d13008eSEric Dumazet 			skb->truesize += frag2->truesize;
7043d13008eSEric Dumazet 		}
7051da177e4SLinus Torvalds 	}
7061da177e4SLinus Torvalds 
7071da177e4SLinus Torvalds slow_path:
708c9af6db4SPravin B Shelar 	iph = ip_hdr(skb);
709fc70fb64SAlexander Duyck 
7101da177e4SLinus Torvalds 	left = skb->len - hlen;		/* Space per frame */
71149085bd7SGeorge Kadianakis 	ptr = hlen;		/* Where to start from */
7121da177e4SLinus Torvalds 
7138d045163SFlorian Westphal 	ll_rs = LL_RESERVED_SPACE(rt->dst.dev);
7149bcfcaf5SStephen Hemminger 
7151da177e4SLinus Torvalds 	/*
7161da177e4SLinus Torvalds 	 *	Fragment the datagram.
7171da177e4SLinus Torvalds 	 */
7181da177e4SLinus Torvalds 
7191da177e4SLinus Torvalds 	offset = (ntohs(iph->frag_off) & IP_OFFSET) << 3;
7201da177e4SLinus Torvalds 	not_last_frag = iph->frag_off & htons(IP_MF);
7211da177e4SLinus Torvalds 
7221da177e4SLinus Torvalds 	/*
7231da177e4SLinus Torvalds 	 *	Keep copying data until we run out.
7241da177e4SLinus Torvalds 	 */
7251da177e4SLinus Torvalds 
7261da177e4SLinus Torvalds 	while (left > 0) {
7271da177e4SLinus Torvalds 		len = left;
7281da177e4SLinus Torvalds 		/* IF: it doesn't fit, use 'mtu' - the data space left */
7291da177e4SLinus Torvalds 		if (len > mtu)
7301da177e4SLinus Torvalds 			len = mtu;
7311da177e4SLinus Torvalds 		/* IF: we are not sending up to and including the packet end
7321da177e4SLinus Torvalds 		   then align the next start on an eight byte boundary */
7331da177e4SLinus Torvalds 		if (len < left)	{
7341da177e4SLinus Torvalds 			len &= ~7;
7351da177e4SLinus Torvalds 		}
7361da177e4SLinus Torvalds 
737cbffccc9SJoe Perches 		/* Allocate buffer */
738cbffccc9SJoe Perches 		skb2 = alloc_skb(len + hlen + ll_rs, GFP_ATOMIC);
739cbffccc9SJoe Perches 		if (!skb2) {
7401da177e4SLinus Torvalds 			err = -ENOMEM;
7411da177e4SLinus Torvalds 			goto fail;
7421da177e4SLinus Torvalds 		}
7431da177e4SLinus Torvalds 
7441da177e4SLinus Torvalds 		/*
7451da177e4SLinus Torvalds 		 *	Set up data on packet
7461da177e4SLinus Torvalds 		 */
7471da177e4SLinus Torvalds 
7481da177e4SLinus Torvalds 		ip_copy_metadata(skb2, skb);
7491da177e4SLinus Torvalds 		skb_reserve(skb2, ll_rs);
7501da177e4SLinus Torvalds 		skb_put(skb2, len + hlen);
751c1d2bbe1SArnaldo Carvalho de Melo 		skb_reset_network_header(skb2);
752b0e380b1SArnaldo Carvalho de Melo 		skb2->transport_header = skb2->network_header + hlen;
7531da177e4SLinus Torvalds 
7541da177e4SLinus Torvalds 		/*
7551da177e4SLinus Torvalds 		 *	Charge the memory for the fragment to any owner
7561da177e4SLinus Torvalds 		 *	it might possess
7571da177e4SLinus Torvalds 		 */
7581da177e4SLinus Torvalds 
7591da177e4SLinus Torvalds 		if (skb->sk)
7601da177e4SLinus Torvalds 			skb_set_owner_w(skb2, skb->sk);
7611da177e4SLinus Torvalds 
7621da177e4SLinus Torvalds 		/*
7631da177e4SLinus Torvalds 		 *	Copy the packet header into the new buffer.
7641da177e4SLinus Torvalds 		 */
7651da177e4SLinus Torvalds 
766d626f62bSArnaldo Carvalho de Melo 		skb_copy_from_linear_data(skb, skb_network_header(skb2), hlen);
7671da177e4SLinus Torvalds 
7681da177e4SLinus Torvalds 		/*
7691da177e4SLinus Torvalds 		 *	Copy a block of the IP datagram.
7701da177e4SLinus Torvalds 		 */
771bff9b61cSArnaldo Carvalho de Melo 		if (skb_copy_bits(skb, ptr, skb_transport_header(skb2), len))
7721da177e4SLinus Torvalds 			BUG();
7731da177e4SLinus Torvalds 		left -= len;
7741da177e4SLinus Torvalds 
7751da177e4SLinus Torvalds 		/*
7761da177e4SLinus Torvalds 		 *	Fill in the new header fields.
7771da177e4SLinus Torvalds 		 */
778eddc9ec5SArnaldo Carvalho de Melo 		iph = ip_hdr(skb2);
7791da177e4SLinus Torvalds 		iph->frag_off = htons((offset >> 3));
7801da177e4SLinus Torvalds 
781d6b915e2SFlorian Westphal 		if (IPCB(skb)->flags & IPSKB_FRAG_PMTU)
782d6b915e2SFlorian Westphal 			iph->frag_off |= htons(IP_DF);
783d6b915e2SFlorian Westphal 
7841da177e4SLinus Torvalds 		/* ANK: dirty, but effective trick. Upgrade options only if
7851da177e4SLinus Torvalds 		 * the segment to be fragmented was THE FIRST (otherwise,
7861da177e4SLinus Torvalds 		 * options are already fixed) and make it ONCE
7871da177e4SLinus Torvalds 		 * on the initial skb, so that all the following fragments
7881da177e4SLinus Torvalds 		 * will inherit fixed options.
7891da177e4SLinus Torvalds 		 */
7901da177e4SLinus Torvalds 		if (offset == 0)
7911da177e4SLinus Torvalds 			ip_options_fragment(skb);
7921da177e4SLinus Torvalds 
7931da177e4SLinus Torvalds 		/*
7941da177e4SLinus Torvalds 		 *	Added AC : If we are fragmenting a fragment that's not the
7951da177e4SLinus Torvalds 		 *		   last fragment then keep MF on each bit
7961da177e4SLinus Torvalds 		 */
7971da177e4SLinus Torvalds 		if (left > 0 || not_last_frag)
7981da177e4SLinus Torvalds 			iph->frag_off |= htons(IP_MF);
7991da177e4SLinus Torvalds 		ptr += len;
8001da177e4SLinus Torvalds 		offset += len;
8011da177e4SLinus Torvalds 
8021da177e4SLinus Torvalds 		/*
8031da177e4SLinus Torvalds 		 *	Put this fragment into the sending queue.
8041da177e4SLinus Torvalds 		 */
8051da177e4SLinus Torvalds 		iph->tot_len = htons(len + hlen);
8061da177e4SLinus Torvalds 
8071da177e4SLinus Torvalds 		ip_send_check(iph);
8081da177e4SLinus Torvalds 
809694869b3SEric W. Biederman 		err = output(net, sk, skb2);
8101da177e4SLinus Torvalds 		if (err)
8111da177e4SLinus Torvalds 			goto fail;
812dafee490SWei Dong 
81326a949dbSEric W. Biederman 		IP_INC_STATS(net, IPSTATS_MIB_FRAGCREATES);
8141da177e4SLinus Torvalds 	}
8155d0ba55bSEric Dumazet 	consume_skb(skb);
81626a949dbSEric W. Biederman 	IP_INC_STATS(net, IPSTATS_MIB_FRAGOKS);
8171da177e4SLinus Torvalds 	return err;
8181da177e4SLinus Torvalds 
8191da177e4SLinus Torvalds fail:
8201da177e4SLinus Torvalds 	kfree_skb(skb);
82126a949dbSEric W. Biederman 	IP_INC_STATS(net, IPSTATS_MIB_FRAGFAILS);
8221da177e4SLinus Torvalds 	return err;
8231da177e4SLinus Torvalds }
82449d16b23SAndy Zhou EXPORT_SYMBOL(ip_do_fragment);
8252e2f7aefSPatrick McHardy 
8261da177e4SLinus Torvalds int
8271da177e4SLinus Torvalds ip_generic_getfrag(void *from, char *to, int offset, int len, int odd, struct sk_buff *skb)
8281da177e4SLinus Torvalds {
829f69e6d13SAl Viro 	struct msghdr *msg = from;
8301da177e4SLinus Torvalds 
83184fa7933SPatrick McHardy 	if (skb->ip_summed == CHECKSUM_PARTIAL) {
8320b62fca2SAl Viro 		if (!copy_from_iter_full(to, len, &msg->msg_iter))
8331da177e4SLinus Torvalds 			return -EFAULT;
8341da177e4SLinus Torvalds 	} else {
83544bb9363SAl Viro 		__wsum csum = 0;
8360b62fca2SAl Viro 		if (!csum_and_copy_from_iter_full(to, len, &csum, &msg->msg_iter))
8371da177e4SLinus Torvalds 			return -EFAULT;
8381da177e4SLinus Torvalds 		skb->csum = csum_block_add(skb->csum, csum, odd);
8391da177e4SLinus Torvalds 	}
8401da177e4SLinus Torvalds 	return 0;
8411da177e4SLinus Torvalds }
8424bc2f18bSEric Dumazet EXPORT_SYMBOL(ip_generic_getfrag);
8431da177e4SLinus Torvalds 
84444bb9363SAl Viro static inline __wsum
8451da177e4SLinus Torvalds csum_page(struct page *page, int offset, int copy)
8461da177e4SLinus Torvalds {
8471da177e4SLinus Torvalds 	char *kaddr;
84844bb9363SAl Viro 	__wsum csum;
8491da177e4SLinus Torvalds 	kaddr = kmap(page);
8501da177e4SLinus Torvalds 	csum = csum_partial(kaddr + offset, copy, 0);
8511da177e4SLinus Torvalds 	kunmap(page);
8521da177e4SLinus Torvalds 	return csum;
8531da177e4SLinus Torvalds }
8541da177e4SLinus Torvalds 
8554b30b1c6SAdrian Bunk static inline int ip_ufo_append_data(struct sock *sk,
8561470ddf7SHerbert Xu 			struct sk_buff_head *queue,
857e89e9cf5SAnanda Raju 			int getfrag(void *from, char *to, int offset, int len,
858e89e9cf5SAnanda Raju 			       int odd, struct sk_buff *skb),
859e89e9cf5SAnanda Raju 			void *from, int length, int hh_len, int fragheaderlen,
860d9be4f7aSBill Sommerfeld 			int transhdrlen, int maxfraglen, unsigned int flags)
861e89e9cf5SAnanda Raju {
862e89e9cf5SAnanda Raju 	struct sk_buff *skb;
863e89e9cf5SAnanda Raju 	int err;
864e89e9cf5SAnanda Raju 
865e89e9cf5SAnanda Raju 	/* There is support for UDP fragmentation offload by network
866e89e9cf5SAnanda Raju 	 * device, so create one single skb packet containing complete
867e89e9cf5SAnanda Raju 	 * udp datagram
868e89e9cf5SAnanda Raju 	 */
86951456b29SIan Morris 	skb = skb_peek_tail(queue);
87051456b29SIan Morris 	if (!skb) {
871e89e9cf5SAnanda Raju 		skb = sock_alloc_send_skb(sk,
872e89e9cf5SAnanda Raju 			hh_len + fragheaderlen + transhdrlen + 20,
873e89e9cf5SAnanda Raju 			(flags & MSG_DONTWAIT), &err);
874e89e9cf5SAnanda Raju 
87551456b29SIan Morris 		if (!skb)
876e89e9cf5SAnanda Raju 			return err;
877e89e9cf5SAnanda Raju 
878e89e9cf5SAnanda Raju 		/* reserve space for Hardware header */
879e89e9cf5SAnanda Raju 		skb_reserve(skb, hh_len);
880e89e9cf5SAnanda Raju 
881e89e9cf5SAnanda Raju 		/* create space for UDP/IP header */
882e89e9cf5SAnanda Raju 		skb_put(skb, fragheaderlen + transhdrlen);
883e89e9cf5SAnanda Raju 
884e89e9cf5SAnanda Raju 		/* initialize network header pointer */
885c1d2bbe1SArnaldo Carvalho de Melo 		skb_reset_network_header(skb);
886e89e9cf5SAnanda Raju 
887e89e9cf5SAnanda Raju 		/* initialize protocol header pointer */
888b0e380b1SArnaldo Carvalho de Melo 		skb->transport_header = skb->network_header + fragheaderlen;
889e89e9cf5SAnanda Raju 
890e89e9cf5SAnanda Raju 		skb->csum = 0;
891e89e9cf5SAnanda Raju 
892e93b7d74SJiri Pirko 		__skb_queue_tail(queue, skb);
893e93b7d74SJiri Pirko 	} else if (skb_is_gso(skb)) {
894e93b7d74SJiri Pirko 		goto append;
895e93b7d74SJiri Pirko 	}
896e93b7d74SJiri Pirko 
897e93b7d74SJiri Pirko 	skb->ip_summed = CHECKSUM_PARTIAL;
898e89e9cf5SAnanda Raju 	/* specify the length of each IP datagram fragment */
899d9be4f7aSBill Sommerfeld 	skb_shinfo(skb)->gso_size = maxfraglen - fragheaderlen;
900f83ef8c0SHerbert Xu 	skb_shinfo(skb)->gso_type = SKB_GSO_UDP;
901be9164e7SKostya B 
902e93b7d74SJiri Pirko append:
903be9164e7SKostya B 	return skb_append_datato_frags(sk, skb, getfrag, from,
904be9164e7SKostya B 				       (length - transhdrlen));
905e89e9cf5SAnanda Raju }
906e89e9cf5SAnanda Raju 
907f5fca608SDavid S. Miller static int __ip_append_data(struct sock *sk,
908f5fca608SDavid S. Miller 			    struct flowi4 *fl4,
909f5fca608SDavid S. Miller 			    struct sk_buff_head *queue,
9101470ddf7SHerbert Xu 			    struct inet_cork *cork,
9115640f768SEric Dumazet 			    struct page_frag *pfrag,
9121470ddf7SHerbert Xu 			    int getfrag(void *from, char *to, int offset,
9131470ddf7SHerbert Xu 					int len, int odd, struct sk_buff *skb),
9141da177e4SLinus Torvalds 			    void *from, int length, int transhdrlen,
9151da177e4SLinus Torvalds 			    unsigned int flags)
9161da177e4SLinus Torvalds {
9171da177e4SLinus Torvalds 	struct inet_sock *inet = inet_sk(sk);
9181da177e4SLinus Torvalds 	struct sk_buff *skb;
9191da177e4SLinus Torvalds 
92007df5294SHerbert Xu 	struct ip_options *opt = cork->opt;
9211da177e4SLinus Torvalds 	int hh_len;
9221da177e4SLinus Torvalds 	int exthdrlen;
9231da177e4SLinus Torvalds 	int mtu;
9241da177e4SLinus Torvalds 	int copy;
9251da177e4SLinus Torvalds 	int err;
9261da177e4SLinus Torvalds 	int offset = 0;
927daba287bSHannes Frederic Sowa 	unsigned int maxfraglen, fragheaderlen, maxnonfragsize;
9281da177e4SLinus Torvalds 	int csummode = CHECKSUM_NONE;
9291470ddf7SHerbert Xu 	struct rtable *rt = (struct rtable *)cork->dst;
93009c2d251SWillem de Bruijn 	u32 tskey = 0;
9311da177e4SLinus Torvalds 
93296d7303eSSteffen Klassert 	skb = skb_peek_tail(queue);
93396d7303eSSteffen Klassert 
93496d7303eSSteffen Klassert 	exthdrlen = !skb ? rt->dst.header_len : 0;
93507df5294SHerbert Xu 	mtu = cork->fragsize;
93609c2d251SWillem de Bruijn 	if (cork->tx_flags & SKBTX_ANY_SW_TSTAMP &&
93709c2d251SWillem de Bruijn 	    sk->sk_tsflags & SOF_TIMESTAMPING_OPT_ID)
93809c2d251SWillem de Bruijn 		tskey = sk->sk_tskey++;
9391470ddf7SHerbert Xu 
940d8d1f30bSChangli Gao 	hh_len = LL_RESERVED_SPACE(rt->dst.dev);
9411da177e4SLinus Torvalds 
9421da177e4SLinus Torvalds 	fragheaderlen = sizeof(struct iphdr) + (opt ? opt->optlen : 0);
9431da177e4SLinus Torvalds 	maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen;
94460ff7467SWANG Cong 	maxnonfragsize = ip_sk_ignore_df(sk) ? 0xFFFF : mtu;
9451da177e4SLinus Torvalds 
946daba287bSHannes Frederic Sowa 	if (cork->length + length > maxnonfragsize - fragheaderlen) {
947f5fca608SDavid S. Miller 		ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport,
94861e7f09dSHannes Frederic Sowa 			       mtu - (opt ? opt->optlen : 0));
9491da177e4SLinus Torvalds 		return -EMSGSIZE;
9501da177e4SLinus Torvalds 	}
9511da177e4SLinus Torvalds 
9521da177e4SLinus Torvalds 	/*
9531da177e4SLinus Torvalds 	 * transhdrlen > 0 means that this is the first fragment and we wish
9541da177e4SLinus Torvalds 	 * it won't be fragmented in the future.
9551da177e4SLinus Torvalds 	 */
9561da177e4SLinus Torvalds 	if (transhdrlen &&
9571da177e4SLinus Torvalds 	    length + fragheaderlen <= mtu &&
958c8cd0989STom Herbert 	    rt->dst.dev->features & (NETIF_F_HW_CSUM | NETIF_F_IP_CSUM) &&
959d749c9cbSHannes Frederic Sowa 	    !(flags & MSG_MORE) &&
9601da177e4SLinus Torvalds 	    !exthdrlen)
96184fa7933SPatrick McHardy 		csummode = CHECKSUM_PARTIAL;
9621da177e4SLinus Torvalds 
9631470ddf7SHerbert Xu 	cork->length += length;
9640a28cfd5Szheng li 	if ((((length + fragheaderlen) > mtu) || (skb && skb_is_gso(skb))) &&
965be9164e7SKostya B 	    (sk->sk_protocol == IPPROTO_UDP) &&
966acf8dd0aSMichal Kubeček 	    (rt->dst.dev->features & NETIF_F_UFO) && !rt->dst.header_len &&
96740ba3302SMichal Kubeček 	    (sk->sk_type == SOCK_DGRAM) && !sk->sk_no_check_tx) {
9681470ddf7SHerbert Xu 		err = ip_ufo_append_data(sk, queue, getfrag, from, length,
9691470ddf7SHerbert Xu 					 hh_len, fragheaderlen, transhdrlen,
970d9be4f7aSBill Sommerfeld 					 maxfraglen, flags);
971baa829d8SPatrick McHardy 		if (err)
972e89e9cf5SAnanda Raju 			goto error;
973e89e9cf5SAnanda Raju 		return 0;
974e89e9cf5SAnanda Raju 	}
9751da177e4SLinus Torvalds 
9761da177e4SLinus Torvalds 	/* So, what's going on in the loop below?
9771da177e4SLinus Torvalds 	 *
9781da177e4SLinus Torvalds 	 * We use calculated fragment length to generate chained skb,
9791da177e4SLinus Torvalds 	 * each of segments is IP fragment ready for sending to network after
9801da177e4SLinus Torvalds 	 * adding appropriate IP header.
9811da177e4SLinus Torvalds 	 */
9821da177e4SLinus Torvalds 
98326cde9f7SHerbert Xu 	if (!skb)
9841da177e4SLinus Torvalds 		goto alloc_new_skb;
9851da177e4SLinus Torvalds 
9861da177e4SLinus Torvalds 	while (length > 0) {
9871da177e4SLinus Torvalds 		/* Check if the remaining data fits into current packet. */
9881da177e4SLinus Torvalds 		copy = mtu - skb->len;
9891da177e4SLinus Torvalds 		if (copy < length)
9901da177e4SLinus Torvalds 			copy = maxfraglen - skb->len;
9911da177e4SLinus Torvalds 		if (copy <= 0) {
9921da177e4SLinus Torvalds 			char *data;
9931da177e4SLinus Torvalds 			unsigned int datalen;
9941da177e4SLinus Torvalds 			unsigned int fraglen;
9951da177e4SLinus Torvalds 			unsigned int fraggap;
9961da177e4SLinus Torvalds 			unsigned int alloclen;
9971da177e4SLinus Torvalds 			struct sk_buff *skb_prev;
9981da177e4SLinus Torvalds alloc_new_skb:
9991da177e4SLinus Torvalds 			skb_prev = skb;
10001da177e4SLinus Torvalds 			if (skb_prev)
10011da177e4SLinus Torvalds 				fraggap = skb_prev->len - maxfraglen;
10021da177e4SLinus Torvalds 			else
10031da177e4SLinus Torvalds 				fraggap = 0;
10041da177e4SLinus Torvalds 
10051da177e4SLinus Torvalds 			/*
10061da177e4SLinus Torvalds 			 * If remaining data exceeds the mtu,
10071da177e4SLinus Torvalds 			 * we know we need more fragment(s).
10081da177e4SLinus Torvalds 			 */
10091da177e4SLinus Torvalds 			datalen = length + fraggap;
10101da177e4SLinus Torvalds 			if (datalen > mtu - fragheaderlen)
10111da177e4SLinus Torvalds 				datalen = maxfraglen - fragheaderlen;
10121da177e4SLinus Torvalds 			fraglen = datalen + fragheaderlen;
10131da177e4SLinus Torvalds 
10141da177e4SLinus Torvalds 			if ((flags & MSG_MORE) &&
1015d8d1f30bSChangli Gao 			    !(rt->dst.dev->features&NETIF_F_SG))
10161da177e4SLinus Torvalds 				alloclen = mtu;
10171da177e4SLinus Torvalds 			else
101859104f06SEric Dumazet 				alloclen = fraglen;
10191da177e4SLinus Torvalds 
1020353e5c9aSSteffen Klassert 			alloclen += exthdrlen;
1021353e5c9aSSteffen Klassert 
10221da177e4SLinus Torvalds 			/* The last fragment gets additional space at tail.
10231da177e4SLinus Torvalds 			 * Note, with MSG_MORE we overallocate on fragments,
10241da177e4SLinus Torvalds 			 * because we have no idea what fragment will be
10251da177e4SLinus Torvalds 			 * the last.
10261da177e4SLinus Torvalds 			 */
102733f99dc7SSteffen Klassert 			if (datalen == length + fraggap)
1028d8d1f30bSChangli Gao 				alloclen += rt->dst.trailer_len;
102933f99dc7SSteffen Klassert 
10301da177e4SLinus Torvalds 			if (transhdrlen) {
10311da177e4SLinus Torvalds 				skb = sock_alloc_send_skb(sk,
10321da177e4SLinus Torvalds 						alloclen + hh_len + 15,
10331da177e4SLinus Torvalds 						(flags & MSG_DONTWAIT), &err);
10341da177e4SLinus Torvalds 			} else {
10351da177e4SLinus Torvalds 				skb = NULL;
10361da177e4SLinus Torvalds 				if (atomic_read(&sk->sk_wmem_alloc) <=
10371da177e4SLinus Torvalds 				    2 * sk->sk_sndbuf)
10381da177e4SLinus Torvalds 					skb = sock_wmalloc(sk,
10391da177e4SLinus Torvalds 							   alloclen + hh_len + 15, 1,
10401da177e4SLinus Torvalds 							   sk->sk_allocation);
104151456b29SIan Morris 				if (unlikely(!skb))
10421da177e4SLinus Torvalds 					err = -ENOBUFS;
10431da177e4SLinus Torvalds 			}
104451456b29SIan Morris 			if (!skb)
10451da177e4SLinus Torvalds 				goto error;
10461da177e4SLinus Torvalds 
10471da177e4SLinus Torvalds 			/*
10481da177e4SLinus Torvalds 			 *	Fill in the control structures
10491da177e4SLinus Torvalds 			 */
10501da177e4SLinus Torvalds 			skb->ip_summed = csummode;
10511da177e4SLinus Torvalds 			skb->csum = 0;
10521da177e4SLinus Torvalds 			skb_reserve(skb, hh_len);
105311878b40SWillem de Bruijn 
105411878b40SWillem de Bruijn 			/* only the initial fragment is time stamped */
10551470ddf7SHerbert Xu 			skb_shinfo(skb)->tx_flags = cork->tx_flags;
105611878b40SWillem de Bruijn 			cork->tx_flags = 0;
105709c2d251SWillem de Bruijn 			skb_shinfo(skb)->tskey = tskey;
105809c2d251SWillem de Bruijn 			tskey = 0;
10591da177e4SLinus Torvalds 
10601da177e4SLinus Torvalds 			/*
10611da177e4SLinus Torvalds 			 *	Find where to start putting bytes.
10621da177e4SLinus Torvalds 			 */
1063353e5c9aSSteffen Klassert 			data = skb_put(skb, fraglen + exthdrlen);
1064c14d2450SArnaldo Carvalho de Melo 			skb_set_network_header(skb, exthdrlen);
1065b0e380b1SArnaldo Carvalho de Melo 			skb->transport_header = (skb->network_header +
1066b0e380b1SArnaldo Carvalho de Melo 						 fragheaderlen);
1067353e5c9aSSteffen Klassert 			data += fragheaderlen + exthdrlen;
10681da177e4SLinus Torvalds 
10691da177e4SLinus Torvalds 			if (fraggap) {
10701da177e4SLinus Torvalds 				skb->csum = skb_copy_and_csum_bits(
10711da177e4SLinus Torvalds 					skb_prev, maxfraglen,
10721da177e4SLinus Torvalds 					data + transhdrlen, fraggap, 0);
10731da177e4SLinus Torvalds 				skb_prev->csum = csum_sub(skb_prev->csum,
10741da177e4SLinus Torvalds 							  skb->csum);
10751da177e4SLinus Torvalds 				data += fraggap;
1076e9fa4f7bSHerbert Xu 				pskb_trim_unique(skb_prev, maxfraglen);
10771da177e4SLinus Torvalds 			}
10781da177e4SLinus Torvalds 
10791da177e4SLinus Torvalds 			copy = datalen - transhdrlen - fraggap;
10801da177e4SLinus Torvalds 			if (copy > 0 && getfrag(from, data + transhdrlen, offset, copy, fraggap, skb) < 0) {
10811da177e4SLinus Torvalds 				err = -EFAULT;
10821da177e4SLinus Torvalds 				kfree_skb(skb);
10831da177e4SLinus Torvalds 				goto error;
10841da177e4SLinus Torvalds 			}
10851da177e4SLinus Torvalds 
10861da177e4SLinus Torvalds 			offset += copy;
10871da177e4SLinus Torvalds 			length -= datalen - fraggap;
10881da177e4SLinus Torvalds 			transhdrlen = 0;
10891da177e4SLinus Torvalds 			exthdrlen = 0;
10901da177e4SLinus Torvalds 			csummode = CHECKSUM_NONE;
10911da177e4SLinus Torvalds 
10921da177e4SLinus Torvalds 			/*
10931da177e4SLinus Torvalds 			 * Put the packet on the pending queue.
10941da177e4SLinus Torvalds 			 */
10951470ddf7SHerbert Xu 			__skb_queue_tail(queue, skb);
10961da177e4SLinus Torvalds 			continue;
10971da177e4SLinus Torvalds 		}
10981da177e4SLinus Torvalds 
10991da177e4SLinus Torvalds 		if (copy > length)
11001da177e4SLinus Torvalds 			copy = length;
11011da177e4SLinus Torvalds 
1102d8d1f30bSChangli Gao 		if (!(rt->dst.dev->features&NETIF_F_SG)) {
11031da177e4SLinus Torvalds 			unsigned int off;
11041da177e4SLinus Torvalds 
11051da177e4SLinus Torvalds 			off = skb->len;
11061da177e4SLinus Torvalds 			if (getfrag(from, skb_put(skb, copy),
11071da177e4SLinus Torvalds 					offset, copy, off, skb) < 0) {
11081da177e4SLinus Torvalds 				__skb_trim(skb, off);
11091da177e4SLinus Torvalds 				err = -EFAULT;
11101da177e4SLinus Torvalds 				goto error;
11111da177e4SLinus Torvalds 			}
11121da177e4SLinus Torvalds 		} else {
11131da177e4SLinus Torvalds 			int i = skb_shinfo(skb)->nr_frags;
11141da177e4SLinus Torvalds 
11151da177e4SLinus Torvalds 			err = -ENOMEM;
11165640f768SEric Dumazet 			if (!sk_page_frag_refill(sk, pfrag))
11171da177e4SLinus Torvalds 				goto error;
11181da177e4SLinus Torvalds 
11195640f768SEric Dumazet 			if (!skb_can_coalesce(skb, i, pfrag->page,
11205640f768SEric Dumazet 					      pfrag->offset)) {
11211da177e4SLinus Torvalds 				err = -EMSGSIZE;
11225640f768SEric Dumazet 				if (i == MAX_SKB_FRAGS)
11231da177e4SLinus Torvalds 					goto error;
11245640f768SEric Dumazet 
11255640f768SEric Dumazet 				__skb_fill_page_desc(skb, i, pfrag->page,
11265640f768SEric Dumazet 						     pfrag->offset, 0);
11275640f768SEric Dumazet 				skb_shinfo(skb)->nr_frags = ++i;
11285640f768SEric Dumazet 				get_page(pfrag->page);
11291da177e4SLinus Torvalds 			}
11305640f768SEric Dumazet 			copy = min_t(int, copy, pfrag->size - pfrag->offset);
11315640f768SEric Dumazet 			if (getfrag(from,
11325640f768SEric Dumazet 				    page_address(pfrag->page) + pfrag->offset,
11335640f768SEric Dumazet 				    offset, copy, skb->len, skb) < 0)
11345640f768SEric Dumazet 				goto error_efault;
11355640f768SEric Dumazet 
11365640f768SEric Dumazet 			pfrag->offset += copy;
11375640f768SEric Dumazet 			skb_frag_size_add(&skb_shinfo(skb)->frags[i - 1], copy);
11381da177e4SLinus Torvalds 			skb->len += copy;
11391da177e4SLinus Torvalds 			skb->data_len += copy;
1140f945fa7aSHerbert Xu 			skb->truesize += copy;
1141f945fa7aSHerbert Xu 			atomic_add(copy, &sk->sk_wmem_alloc);
11421da177e4SLinus Torvalds 		}
11431da177e4SLinus Torvalds 		offset += copy;
11441da177e4SLinus Torvalds 		length -= copy;
11451da177e4SLinus Torvalds 	}
11461da177e4SLinus Torvalds 
11471da177e4SLinus Torvalds 	return 0;
11481da177e4SLinus Torvalds 
11495640f768SEric Dumazet error_efault:
11505640f768SEric Dumazet 	err = -EFAULT;
11511da177e4SLinus Torvalds error:
11521470ddf7SHerbert Xu 	cork->length -= length;
11535e38e270SPavel Emelyanov 	IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTDISCARDS);
11541da177e4SLinus Torvalds 	return err;
11551da177e4SLinus Torvalds }
11561da177e4SLinus Torvalds 
11571470ddf7SHerbert Xu static int ip_setup_cork(struct sock *sk, struct inet_cork *cork,
11581470ddf7SHerbert Xu 			 struct ipcm_cookie *ipc, struct rtable **rtp)
11591470ddf7SHerbert Xu {
1160f6d8bd05SEric Dumazet 	struct ip_options_rcu *opt;
11611470ddf7SHerbert Xu 	struct rtable *rt;
11621470ddf7SHerbert Xu 
11631470ddf7SHerbert Xu 	/*
11641470ddf7SHerbert Xu 	 * setup for corking.
11651470ddf7SHerbert Xu 	 */
11661470ddf7SHerbert Xu 	opt = ipc->opt;
11671470ddf7SHerbert Xu 	if (opt) {
116851456b29SIan Morris 		if (!cork->opt) {
11691470ddf7SHerbert Xu 			cork->opt = kmalloc(sizeof(struct ip_options) + 40,
11701470ddf7SHerbert Xu 					    sk->sk_allocation);
117151456b29SIan Morris 			if (unlikely(!cork->opt))
11721470ddf7SHerbert Xu 				return -ENOBUFS;
11731470ddf7SHerbert Xu 		}
1174f6d8bd05SEric Dumazet 		memcpy(cork->opt, &opt->opt, sizeof(struct ip_options) + opt->opt.optlen);
11751470ddf7SHerbert Xu 		cork->flags |= IPCORK_OPT;
11761470ddf7SHerbert Xu 		cork->addr = ipc->addr;
11771470ddf7SHerbert Xu 	}
11781470ddf7SHerbert Xu 	rt = *rtp;
11791470ddf7SHerbert Xu 	if (unlikely(!rt))
11801470ddf7SHerbert Xu 		return -EFAULT;
11811470ddf7SHerbert Xu 	/*
11821470ddf7SHerbert Xu 	 * We steal reference to this route, caller should not release it
11831470ddf7SHerbert Xu 	 */
11841470ddf7SHerbert Xu 	*rtp = NULL;
1185482fc609SHannes Frederic Sowa 	cork->fragsize = ip_sk_use_pmtu(sk) ?
1186482fc609SHannes Frederic Sowa 			 dst_mtu(&rt->dst) : rt->dst.dev->mtu;
11871470ddf7SHerbert Xu 	cork->dst = &rt->dst;
11881470ddf7SHerbert Xu 	cork->length = 0;
1189aa661581SFrancesco Fusco 	cork->ttl = ipc->ttl;
1190aa661581SFrancesco Fusco 	cork->tos = ipc->tos;
1191aa661581SFrancesco Fusco 	cork->priority = ipc->priority;
11921470ddf7SHerbert Xu 	cork->tx_flags = ipc->tx_flags;
11931470ddf7SHerbert Xu 
11941470ddf7SHerbert Xu 	return 0;
11951470ddf7SHerbert Xu }
11961470ddf7SHerbert Xu 
11971470ddf7SHerbert Xu /*
11981470ddf7SHerbert Xu  *	ip_append_data() and ip_append_page() can make one large IP datagram
11991470ddf7SHerbert Xu  *	from many pieces of data. Each pieces will be holded on the socket
12001470ddf7SHerbert Xu  *	until ip_push_pending_frames() is called. Each piece can be a page
12011470ddf7SHerbert Xu  *	or non-page data.
12021470ddf7SHerbert Xu  *
12031470ddf7SHerbert Xu  *	Not only UDP, other transport protocols - e.g. raw sockets - can use
12041470ddf7SHerbert Xu  *	this interface potentially.
12051470ddf7SHerbert Xu  *
12061470ddf7SHerbert Xu  *	LATER: length must be adjusted by pad at tail, when it is required.
12071470ddf7SHerbert Xu  */
1208f5fca608SDavid S. Miller int ip_append_data(struct sock *sk, struct flowi4 *fl4,
12091470ddf7SHerbert Xu 		   int getfrag(void *from, char *to, int offset, int len,
12101470ddf7SHerbert Xu 			       int odd, struct sk_buff *skb),
12111470ddf7SHerbert Xu 		   void *from, int length, int transhdrlen,
12121470ddf7SHerbert Xu 		   struct ipcm_cookie *ipc, struct rtable **rtp,
12131470ddf7SHerbert Xu 		   unsigned int flags)
12141470ddf7SHerbert Xu {
12151470ddf7SHerbert Xu 	struct inet_sock *inet = inet_sk(sk);
12161470ddf7SHerbert Xu 	int err;
12171470ddf7SHerbert Xu 
12181470ddf7SHerbert Xu 	if (flags&MSG_PROBE)
12191470ddf7SHerbert Xu 		return 0;
12201470ddf7SHerbert Xu 
12211470ddf7SHerbert Xu 	if (skb_queue_empty(&sk->sk_write_queue)) {
1222bdc712b4SDavid S. Miller 		err = ip_setup_cork(sk, &inet->cork.base, ipc, rtp);
12231470ddf7SHerbert Xu 		if (err)
12241470ddf7SHerbert Xu 			return err;
12251470ddf7SHerbert Xu 	} else {
12261470ddf7SHerbert Xu 		transhdrlen = 0;
12271470ddf7SHerbert Xu 	}
12281470ddf7SHerbert Xu 
12295640f768SEric Dumazet 	return __ip_append_data(sk, fl4, &sk->sk_write_queue, &inet->cork.base,
12305640f768SEric Dumazet 				sk_page_frag(sk), getfrag,
12311470ddf7SHerbert Xu 				from, length, transhdrlen, flags);
12321470ddf7SHerbert Xu }
12331470ddf7SHerbert Xu 
1234f5fca608SDavid S. Miller ssize_t	ip_append_page(struct sock *sk, struct flowi4 *fl4, struct page *page,
12351da177e4SLinus Torvalds 		       int offset, size_t size, int flags)
12361da177e4SLinus Torvalds {
12371da177e4SLinus Torvalds 	struct inet_sock *inet = inet_sk(sk);
12381da177e4SLinus Torvalds 	struct sk_buff *skb;
12391da177e4SLinus Torvalds 	struct rtable *rt;
12401da177e4SLinus Torvalds 	struct ip_options *opt = NULL;
1241bdc712b4SDavid S. Miller 	struct inet_cork *cork;
12421da177e4SLinus Torvalds 	int hh_len;
12431da177e4SLinus Torvalds 	int mtu;
12441da177e4SLinus Torvalds 	int len;
12451da177e4SLinus Torvalds 	int err;
1246daba287bSHannes Frederic Sowa 	unsigned int maxfraglen, fragheaderlen, fraggap, maxnonfragsize;
12471da177e4SLinus Torvalds 
12481da177e4SLinus Torvalds 	if (inet->hdrincl)
12491da177e4SLinus Torvalds 		return -EPERM;
12501da177e4SLinus Torvalds 
12511da177e4SLinus Torvalds 	if (flags&MSG_PROBE)
12521da177e4SLinus Torvalds 		return 0;
12531da177e4SLinus Torvalds 
12541da177e4SLinus Torvalds 	if (skb_queue_empty(&sk->sk_write_queue))
12551da177e4SLinus Torvalds 		return -EINVAL;
12561da177e4SLinus Torvalds 
1257bdc712b4SDavid S. Miller 	cork = &inet->cork.base;
1258bdc712b4SDavid S. Miller 	rt = (struct rtable *)cork->dst;
1259bdc712b4SDavid S. Miller 	if (cork->flags & IPCORK_OPT)
1260bdc712b4SDavid S. Miller 		opt = cork->opt;
12611da177e4SLinus Torvalds 
1262d8d1f30bSChangli Gao 	if (!(rt->dst.dev->features&NETIF_F_SG))
12631da177e4SLinus Torvalds 		return -EOPNOTSUPP;
12641da177e4SLinus Torvalds 
1265d8d1f30bSChangli Gao 	hh_len = LL_RESERVED_SPACE(rt->dst.dev);
1266bdc712b4SDavid S. Miller 	mtu = cork->fragsize;
12671da177e4SLinus Torvalds 
12681da177e4SLinus Torvalds 	fragheaderlen = sizeof(struct iphdr) + (opt ? opt->optlen : 0);
12691da177e4SLinus Torvalds 	maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen;
127060ff7467SWANG Cong 	maxnonfragsize = ip_sk_ignore_df(sk) ? 0xFFFF : mtu;
12711da177e4SLinus Torvalds 
1272daba287bSHannes Frederic Sowa 	if (cork->length + size > maxnonfragsize - fragheaderlen) {
127361e7f09dSHannes Frederic Sowa 		ip_local_error(sk, EMSGSIZE, fl4->daddr, inet->inet_dport,
127461e7f09dSHannes Frederic Sowa 			       mtu - (opt ? opt->optlen : 0));
12751da177e4SLinus Torvalds 		return -EMSGSIZE;
12761da177e4SLinus Torvalds 	}
12771da177e4SLinus Torvalds 
127851456b29SIan Morris 	skb = skb_peek_tail(&sk->sk_write_queue);
127951456b29SIan Morris 	if (!skb)
12801da177e4SLinus Torvalds 		return -EINVAL;
12811da177e4SLinus Torvalds 
128226cde9f7SHerbert Xu 	if ((size + skb->len > mtu) &&
128326cde9f7SHerbert Xu 	    (sk->sk_protocol == IPPROTO_UDP) &&
1284d8d1f30bSChangli Gao 	    (rt->dst.dev->features & NETIF_F_UFO)) {
1285a8c4a252SHannes Frederic Sowa 		if (skb->ip_summed != CHECKSUM_PARTIAL)
1286a8c4a252SHannes Frederic Sowa 			return -EOPNOTSUPP;
1287a8c4a252SHannes Frederic Sowa 
12887967168cSHerbert Xu 		skb_shinfo(skb)->gso_size = mtu - fragheaderlen;
1289f83ef8c0SHerbert Xu 		skb_shinfo(skb)->gso_type = SKB_GSO_UDP;
12907967168cSHerbert Xu 	}
1291a8c4a252SHannes Frederic Sowa 	cork->length += size;
1292e89e9cf5SAnanda Raju 
12931da177e4SLinus Torvalds 	while (size > 0) {
1294be12a1feSHannes Frederic Sowa 		if (skb_is_gso(skb)) {
1295e89e9cf5SAnanda Raju 			len = size;
1296be12a1feSHannes Frederic Sowa 		} else {
1297e89e9cf5SAnanda Raju 
12981da177e4SLinus Torvalds 			/* Check if the remaining data fits into current packet. */
12991da177e4SLinus Torvalds 			len = mtu - skb->len;
13001da177e4SLinus Torvalds 			if (len < size)
13011da177e4SLinus Torvalds 				len = maxfraglen - skb->len;
1302e89e9cf5SAnanda Raju 		}
13031da177e4SLinus Torvalds 		if (len <= 0) {
13041da177e4SLinus Torvalds 			struct sk_buff *skb_prev;
13051da177e4SLinus Torvalds 			int alloclen;
13061da177e4SLinus Torvalds 
13071da177e4SLinus Torvalds 			skb_prev = skb;
13081da177e4SLinus Torvalds 			fraggap = skb_prev->len - maxfraglen;
13091da177e4SLinus Torvalds 
13101da177e4SLinus Torvalds 			alloclen = fragheaderlen + hh_len + fraggap + 15;
13111da177e4SLinus Torvalds 			skb = sock_wmalloc(sk, alloclen, 1, sk->sk_allocation);
13121da177e4SLinus Torvalds 			if (unlikely(!skb)) {
13131da177e4SLinus Torvalds 				err = -ENOBUFS;
13141da177e4SLinus Torvalds 				goto error;
13151da177e4SLinus Torvalds 			}
13161da177e4SLinus Torvalds 
13171da177e4SLinus Torvalds 			/*
13181da177e4SLinus Torvalds 			 *	Fill in the control structures
13191da177e4SLinus Torvalds 			 */
13201da177e4SLinus Torvalds 			skb->ip_summed = CHECKSUM_NONE;
13211da177e4SLinus Torvalds 			skb->csum = 0;
13221da177e4SLinus Torvalds 			skb_reserve(skb, hh_len);
13231da177e4SLinus Torvalds 
13241da177e4SLinus Torvalds 			/*
13251da177e4SLinus Torvalds 			 *	Find where to start putting bytes.
13261da177e4SLinus Torvalds 			 */
1327967b05f6SArnaldo Carvalho de Melo 			skb_put(skb, fragheaderlen + fraggap);
13282ca9e6f2SArnaldo Carvalho de Melo 			skb_reset_network_header(skb);
1329b0e380b1SArnaldo Carvalho de Melo 			skb->transport_header = (skb->network_header +
1330b0e380b1SArnaldo Carvalho de Melo 						 fragheaderlen);
13311da177e4SLinus Torvalds 			if (fraggap) {
1332967b05f6SArnaldo Carvalho de Melo 				skb->csum = skb_copy_and_csum_bits(skb_prev,
1333967b05f6SArnaldo Carvalho de Melo 								   maxfraglen,
13349c70220bSArnaldo Carvalho de Melo 						    skb_transport_header(skb),
1335967b05f6SArnaldo Carvalho de Melo 								   fraggap, 0);
13361da177e4SLinus Torvalds 				skb_prev->csum = csum_sub(skb_prev->csum,
13371da177e4SLinus Torvalds 							  skb->csum);
1338e9fa4f7bSHerbert Xu 				pskb_trim_unique(skb_prev, maxfraglen);
13391da177e4SLinus Torvalds 			}
13401da177e4SLinus Torvalds 
13411da177e4SLinus Torvalds 			/*
13421da177e4SLinus Torvalds 			 * Put the packet on the pending queue.
13431da177e4SLinus Torvalds 			 */
13441da177e4SLinus Torvalds 			__skb_queue_tail(&sk->sk_write_queue, skb);
13451da177e4SLinus Torvalds 			continue;
13461da177e4SLinus Torvalds 		}
13471da177e4SLinus Torvalds 
13481da177e4SLinus Torvalds 		if (len > size)
13491da177e4SLinus Torvalds 			len = size;
1350be12a1feSHannes Frederic Sowa 
1351be12a1feSHannes Frederic Sowa 		if (skb_append_pagefrags(skb, page, offset, len)) {
13521da177e4SLinus Torvalds 			err = -EMSGSIZE;
13531da177e4SLinus Torvalds 			goto error;
13541da177e4SLinus Torvalds 		}
13551da177e4SLinus Torvalds 
13561da177e4SLinus Torvalds 		if (skb->ip_summed == CHECKSUM_NONE) {
135744bb9363SAl Viro 			__wsum csum;
13581da177e4SLinus Torvalds 			csum = csum_page(page, offset, len);
13591da177e4SLinus Torvalds 			skb->csum = csum_block_add(skb->csum, csum, skb->len);
13601da177e4SLinus Torvalds 		}
13611da177e4SLinus Torvalds 
13621da177e4SLinus Torvalds 		skb->len += len;
13631da177e4SLinus Torvalds 		skb->data_len += len;
13641e34a11dSDavid S. Miller 		skb->truesize += len;
13651e34a11dSDavid S. Miller 		atomic_add(len, &sk->sk_wmem_alloc);
13661da177e4SLinus Torvalds 		offset += len;
13671da177e4SLinus Torvalds 		size -= len;
13681da177e4SLinus Torvalds 	}
13691da177e4SLinus Torvalds 	return 0;
13701da177e4SLinus Torvalds 
13711da177e4SLinus Torvalds error:
1372bdc712b4SDavid S. Miller 	cork->length -= size;
13735e38e270SPavel Emelyanov 	IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTDISCARDS);
13741da177e4SLinus Torvalds 	return err;
13751da177e4SLinus Torvalds }
13761da177e4SLinus Torvalds 
13771470ddf7SHerbert Xu static void ip_cork_release(struct inet_cork *cork)
1378429f08e9SPavel Emelyanov {
13791470ddf7SHerbert Xu 	cork->flags &= ~IPCORK_OPT;
13801470ddf7SHerbert Xu 	kfree(cork->opt);
13811470ddf7SHerbert Xu 	cork->opt = NULL;
13821470ddf7SHerbert Xu 	dst_release(cork->dst);
13831470ddf7SHerbert Xu 	cork->dst = NULL;
1384429f08e9SPavel Emelyanov }
1385429f08e9SPavel Emelyanov 
13861da177e4SLinus Torvalds /*
13871da177e4SLinus Torvalds  *	Combined all pending IP fragments on the socket as one IP datagram
13881da177e4SLinus Torvalds  *	and push them out.
13891da177e4SLinus Torvalds  */
13901c32c5adSHerbert Xu struct sk_buff *__ip_make_skb(struct sock *sk,
139177968b78SDavid S. Miller 			      struct flowi4 *fl4,
13921470ddf7SHerbert Xu 			      struct sk_buff_head *queue,
13931470ddf7SHerbert Xu 			      struct inet_cork *cork)
13941da177e4SLinus Torvalds {
13951da177e4SLinus Torvalds 	struct sk_buff *skb, *tmp_skb;
13961da177e4SLinus Torvalds 	struct sk_buff **tail_skb;
13971da177e4SLinus Torvalds 	struct inet_sock *inet = inet_sk(sk);
13980388b004SPavel Emelyanov 	struct net *net = sock_net(sk);
13991da177e4SLinus Torvalds 	struct ip_options *opt = NULL;
14001470ddf7SHerbert Xu 	struct rtable *rt = (struct rtable *)cork->dst;
14011da177e4SLinus Torvalds 	struct iphdr *iph;
140276ab608dSAlexey Dobriyan 	__be16 df = 0;
14031da177e4SLinus Torvalds 	__u8 ttl;
14041da177e4SLinus Torvalds 
140551456b29SIan Morris 	skb = __skb_dequeue(queue);
140651456b29SIan Morris 	if (!skb)
14071da177e4SLinus Torvalds 		goto out;
14081da177e4SLinus Torvalds 	tail_skb = &(skb_shinfo(skb)->frag_list);
14091da177e4SLinus Torvalds 
14101da177e4SLinus Torvalds 	/* move skb->data to ip header from ext header */
1411d56f90a7SArnaldo Carvalho de Melo 	if (skb->data < skb_network_header(skb))
1412bbe735e4SArnaldo Carvalho de Melo 		__skb_pull(skb, skb_network_offset(skb));
14131470ddf7SHerbert Xu 	while ((tmp_skb = __skb_dequeue(queue)) != NULL) {
1414cfe1fc77SArnaldo Carvalho de Melo 		__skb_pull(tmp_skb, skb_network_header_len(skb));
14151da177e4SLinus Torvalds 		*tail_skb = tmp_skb;
14161da177e4SLinus Torvalds 		tail_skb = &(tmp_skb->next);
14171da177e4SLinus Torvalds 		skb->len += tmp_skb->len;
14181da177e4SLinus Torvalds 		skb->data_len += tmp_skb->len;
14191da177e4SLinus Torvalds 		skb->truesize += tmp_skb->truesize;
14201da177e4SLinus Torvalds 		tmp_skb->destructor = NULL;
14211da177e4SLinus Torvalds 		tmp_skb->sk = NULL;
14221da177e4SLinus Torvalds 	}
14231da177e4SLinus Torvalds 
14241da177e4SLinus Torvalds 	/* Unless user demanded real pmtu discovery (IP_PMTUDISC_DO), we allow
14251da177e4SLinus Torvalds 	 * to fragment the frame generated here. No matter, what transforms
14261da177e4SLinus Torvalds 	 * how transforms change size of the packet, it will come out.
14271da177e4SLinus Torvalds 	 */
142860ff7467SWANG Cong 	skb->ignore_df = ip_sk_ignore_df(sk);
14291da177e4SLinus Torvalds 
14301da177e4SLinus Torvalds 	/* DF bit is set when we want to see DF on outgoing frames.
143160ff7467SWANG Cong 	 * If ignore_df is set too, we still allow to fragment this frame
14321da177e4SLinus Torvalds 	 * locally. */
1433482fc609SHannes Frederic Sowa 	if (inet->pmtudisc == IP_PMTUDISC_DO ||
1434482fc609SHannes Frederic Sowa 	    inet->pmtudisc == IP_PMTUDISC_PROBE ||
1435d8d1f30bSChangli Gao 	    (skb->len <= dst_mtu(&rt->dst) &&
1436d8d1f30bSChangli Gao 	     ip_dont_fragment(sk, &rt->dst)))
14371da177e4SLinus Torvalds 		df = htons(IP_DF);
14381da177e4SLinus Torvalds 
14391470ddf7SHerbert Xu 	if (cork->flags & IPCORK_OPT)
14401470ddf7SHerbert Xu 		opt = cork->opt;
14411da177e4SLinus Torvalds 
1442aa661581SFrancesco Fusco 	if (cork->ttl != 0)
1443aa661581SFrancesco Fusco 		ttl = cork->ttl;
1444aa661581SFrancesco Fusco 	else if (rt->rt_type == RTN_MULTICAST)
14451da177e4SLinus Torvalds 		ttl = inet->mc_ttl;
14461da177e4SLinus Torvalds 	else
1447d8d1f30bSChangli Gao 		ttl = ip_select_ttl(inet, &rt->dst);
14481da177e4SLinus Torvalds 
1449749154aaSAnsis Atteka 	iph = ip_hdr(skb);
14501da177e4SLinus Torvalds 	iph->version = 4;
14511da177e4SLinus Torvalds 	iph->ihl = 5;
1452aa661581SFrancesco Fusco 	iph->tos = (cork->tos != -1) ? cork->tos : inet->tos;
14531da177e4SLinus Torvalds 	iph->frag_off = df;
14541da177e4SLinus Torvalds 	iph->ttl = ttl;
14551da177e4SLinus Torvalds 	iph->protocol = sk->sk_protocol;
145684f9307cSEric Dumazet 	ip_copy_addrs(iph, fl4);
1457b6a7719aSHannes Frederic Sowa 	ip_select_ident(net, skb, sk);
14581da177e4SLinus Torvalds 
145922f728f8SDavid S. Miller 	if (opt) {
146022f728f8SDavid S. Miller 		iph->ihl += opt->optlen>>2;
146122f728f8SDavid S. Miller 		ip_options_build(skb, opt, cork->addr, rt, 0);
146222f728f8SDavid S. Miller 	}
146322f728f8SDavid S. Miller 
1464aa661581SFrancesco Fusco 	skb->priority = (cork->tos != -1) ? cork->priority: sk->sk_priority;
14654a19ec58SLaszlo Attila Toth 	skb->mark = sk->sk_mark;
1466a21bba94SEric Dumazet 	/*
1467a21bba94SEric Dumazet 	 * Steal rt from cork.dst to avoid a pair of atomic_inc/atomic_dec
1468a21bba94SEric Dumazet 	 * on dst refcount
1469a21bba94SEric Dumazet 	 */
14701470ddf7SHerbert Xu 	cork->dst = NULL;
1471d8d1f30bSChangli Gao 	skb_dst_set(skb, &rt->dst);
14721da177e4SLinus Torvalds 
147396793b48SDavid L Stevens 	if (iph->protocol == IPPROTO_ICMP)
14740388b004SPavel Emelyanov 		icmp_out_count(net, ((struct icmphdr *)
147596793b48SDavid L Stevens 			skb_transport_header(skb))->type);
147696793b48SDavid L Stevens 
14771c32c5adSHerbert Xu 	ip_cork_release(cork);
14781c32c5adSHerbert Xu out:
14791c32c5adSHerbert Xu 	return skb;
14801c32c5adSHerbert Xu }
14811c32c5adSHerbert Xu 
1482b5ec8eeaSEric Dumazet int ip_send_skb(struct net *net, struct sk_buff *skb)
14831c32c5adSHerbert Xu {
14841c32c5adSHerbert Xu 	int err;
14851c32c5adSHerbert Xu 
148633224b16SEric W. Biederman 	err = ip_local_out(net, skb->sk, skb);
14871da177e4SLinus Torvalds 	if (err) {
14881da177e4SLinus Torvalds 		if (err > 0)
14896ce9e7b5SEric Dumazet 			err = net_xmit_errno(err);
14901da177e4SLinus Torvalds 		if (err)
14911c32c5adSHerbert Xu 			IP_INC_STATS(net, IPSTATS_MIB_OUTDISCARDS);
14921da177e4SLinus Torvalds 	}
14931da177e4SLinus Torvalds 
14941da177e4SLinus Torvalds 	return err;
14951da177e4SLinus Torvalds }
14961da177e4SLinus Torvalds 
149777968b78SDavid S. Miller int ip_push_pending_frames(struct sock *sk, struct flowi4 *fl4)
14981470ddf7SHerbert Xu {
14991c32c5adSHerbert Xu 	struct sk_buff *skb;
15001c32c5adSHerbert Xu 
150177968b78SDavid S. Miller 	skb = ip_finish_skb(sk, fl4);
15021c32c5adSHerbert Xu 	if (!skb)
15031c32c5adSHerbert Xu 		return 0;
15041c32c5adSHerbert Xu 
15051c32c5adSHerbert Xu 	/* Netfilter gets whole the not fragmented skb. */
1506b5ec8eeaSEric Dumazet 	return ip_send_skb(sock_net(sk), skb);
15071470ddf7SHerbert Xu }
15081470ddf7SHerbert Xu 
15091da177e4SLinus Torvalds /*
15101da177e4SLinus Torvalds  *	Throw away all pending data on the socket.
15111da177e4SLinus Torvalds  */
15121470ddf7SHerbert Xu static void __ip_flush_pending_frames(struct sock *sk,
15131470ddf7SHerbert Xu 				      struct sk_buff_head *queue,
15141470ddf7SHerbert Xu 				      struct inet_cork *cork)
15151da177e4SLinus Torvalds {
15161da177e4SLinus Torvalds 	struct sk_buff *skb;
15171da177e4SLinus Torvalds 
15181470ddf7SHerbert Xu 	while ((skb = __skb_dequeue_tail(queue)) != NULL)
15191da177e4SLinus Torvalds 		kfree_skb(skb);
15201da177e4SLinus Torvalds 
15211470ddf7SHerbert Xu 	ip_cork_release(cork);
15221470ddf7SHerbert Xu }
15231470ddf7SHerbert Xu 
15241470ddf7SHerbert Xu void ip_flush_pending_frames(struct sock *sk)
15251470ddf7SHerbert Xu {
1526bdc712b4SDavid S. Miller 	__ip_flush_pending_frames(sk, &sk->sk_write_queue, &inet_sk(sk)->cork.base);
15271da177e4SLinus Torvalds }
15281da177e4SLinus Torvalds 
15291c32c5adSHerbert Xu struct sk_buff *ip_make_skb(struct sock *sk,
153077968b78SDavid S. Miller 			    struct flowi4 *fl4,
15311c32c5adSHerbert Xu 			    int getfrag(void *from, char *to, int offset,
15321c32c5adSHerbert Xu 					int len, int odd, struct sk_buff *skb),
15331c32c5adSHerbert Xu 			    void *from, int length, int transhdrlen,
15341c32c5adSHerbert Xu 			    struct ipcm_cookie *ipc, struct rtable **rtp,
15351c32c5adSHerbert Xu 			    unsigned int flags)
15361c32c5adSHerbert Xu {
1537b80d7226SDavid S. Miller 	struct inet_cork cork;
15381c32c5adSHerbert Xu 	struct sk_buff_head queue;
15391c32c5adSHerbert Xu 	int err;
15401c32c5adSHerbert Xu 
15411c32c5adSHerbert Xu 	if (flags & MSG_PROBE)
15421c32c5adSHerbert Xu 		return NULL;
15431c32c5adSHerbert Xu 
15441c32c5adSHerbert Xu 	__skb_queue_head_init(&queue);
15451c32c5adSHerbert Xu 
1546b80d7226SDavid S. Miller 	cork.flags = 0;
1547b80d7226SDavid S. Miller 	cork.addr = 0;
154870652728SDavid S. Miller 	cork.opt = NULL;
15491c32c5adSHerbert Xu 	err = ip_setup_cork(sk, &cork, ipc, rtp);
15501c32c5adSHerbert Xu 	if (err)
15511c32c5adSHerbert Xu 		return ERR_PTR(err);
15521c32c5adSHerbert Xu 
15535640f768SEric Dumazet 	err = __ip_append_data(sk, fl4, &queue, &cork,
15545640f768SEric Dumazet 			       &current->task_frag, getfrag,
15551c32c5adSHerbert Xu 			       from, length, transhdrlen, flags);
15561c32c5adSHerbert Xu 	if (err) {
15571c32c5adSHerbert Xu 		__ip_flush_pending_frames(sk, &queue, &cork);
15581c32c5adSHerbert Xu 		return ERR_PTR(err);
15591c32c5adSHerbert Xu 	}
15601c32c5adSHerbert Xu 
156177968b78SDavid S. Miller 	return __ip_make_skb(sk, fl4, &queue, &cork);
15621c32c5adSHerbert Xu }
15631da177e4SLinus Torvalds 
15641da177e4SLinus Torvalds /*
15651da177e4SLinus Torvalds  *	Fetch data from kernel space and fill in checksum if needed.
15661da177e4SLinus Torvalds  */
15671da177e4SLinus Torvalds static int ip_reply_glue_bits(void *dptr, char *to, int offset,
15681da177e4SLinus Torvalds 			      int len, int odd, struct sk_buff *skb)
15691da177e4SLinus Torvalds {
15705084205fSAl Viro 	__wsum csum;
15711da177e4SLinus Torvalds 
15721da177e4SLinus Torvalds 	csum = csum_partial_copy_nocheck(dptr+offset, to, len, 0);
15731da177e4SLinus Torvalds 	skb->csum = csum_block_add(skb->csum, csum, odd);
15741da177e4SLinus Torvalds 	return 0;
15751da177e4SLinus Torvalds }
15761da177e4SLinus Torvalds 
15771da177e4SLinus Torvalds /*
15781da177e4SLinus Torvalds  *	Generic function to send a packet as reply to another packet.
1579be9f4a44SEric Dumazet  *	Used to send some TCP resets/acks so far.
15801da177e4SLinus Torvalds  */
1581bdbbb852SEric Dumazet void ip_send_unicast_reply(struct sock *sk, struct sk_buff *skb,
158224a2d43dSEric Dumazet 			   const struct ip_options *sopt,
158324a2d43dSEric Dumazet 			   __be32 daddr, __be32 saddr,
158424a2d43dSEric Dumazet 			   const struct ip_reply_arg *arg,
158570e73416SDavid S. Miller 			   unsigned int len)
15861da177e4SLinus Torvalds {
1587f6d8bd05SEric Dumazet 	struct ip_options_data replyopts;
15881da177e4SLinus Torvalds 	struct ipcm_cookie ipc;
158977968b78SDavid S. Miller 	struct flowi4 fl4;
1590511c3f92SEric Dumazet 	struct rtable *rt = skb_rtable(skb);
1591bdbbb852SEric Dumazet 	struct net *net = sock_net(sk);
1592be9f4a44SEric Dumazet 	struct sk_buff *nskb;
15934062090eSVasily Averin 	int err;
1594f7ba868bSDavid Ahern 	int oif;
15951da177e4SLinus Torvalds 
159624a2d43dSEric Dumazet 	if (__ip_options_echo(&replyopts.opt.opt, skb, sopt))
15971da177e4SLinus Torvalds 		return;
15981da177e4SLinus Torvalds 
15990a5ebb80SDavid S. Miller 	ipc.addr = daddr;
16001da177e4SLinus Torvalds 	ipc.opt = NULL;
16012244d07bSOliver Hartkopp 	ipc.tx_flags = 0;
1602aa661581SFrancesco Fusco 	ipc.ttl = 0;
1603aa661581SFrancesco Fusco 	ipc.tos = -1;
16041da177e4SLinus Torvalds 
1605f6d8bd05SEric Dumazet 	if (replyopts.opt.opt.optlen) {
16061da177e4SLinus Torvalds 		ipc.opt = &replyopts.opt;
16071da177e4SLinus Torvalds 
1608f6d8bd05SEric Dumazet 		if (replyopts.opt.opt.srr)
1609f6d8bd05SEric Dumazet 			daddr = replyopts.opt.opt.faddr;
16101da177e4SLinus Torvalds 	}
16111da177e4SLinus Torvalds 
1612f7ba868bSDavid Ahern 	oif = arg->bound_dev_if;
16139b6c14d5SDavid Ahern 	if (!oif && netif_index_is_l3_master(net, skb->skb_iif))
16149b6c14d5SDavid Ahern 		oif = skb->skb_iif;
1615f7ba868bSDavid Ahern 
1616f7ba868bSDavid Ahern 	flowi4_init_output(&fl4, oif,
1617e110861fSLorenzo Colitti 			   IP4_REPLY_MARK(net, skb->mark),
161866b13d99SEric Dumazet 			   RT_TOS(arg->tos),
1619be9f4a44SEric Dumazet 			   RT_SCOPE_UNIVERSE, ip_hdr(skb)->protocol,
1620538de0e0SDavid S. Miller 			   ip_reply_arg_flowi_flags(arg),
162170e73416SDavid S. Miller 			   daddr, saddr,
1622e2d118a1SLorenzo Colitti 			   tcp_hdr(skb)->source, tcp_hdr(skb)->dest,
1623e2d118a1SLorenzo Colitti 			   arg->uid);
16249d6ec938SDavid S. Miller 	security_skb_classify_flow(skb, flowi4_to_flowi(&fl4));
1625be9f4a44SEric Dumazet 	rt = ip_route_output_key(net, &fl4);
1626b23dd4feSDavid S. Miller 	if (IS_ERR(rt))
16271da177e4SLinus Torvalds 		return;
16281da177e4SLinus Torvalds 
1629bdbbb852SEric Dumazet 	inet_sk(sk)->tos = arg->tos;
16301da177e4SLinus Torvalds 
16311da177e4SLinus Torvalds 	sk->sk_priority = skb->priority;
1632eddc9ec5SArnaldo Carvalho de Melo 	sk->sk_protocol = ip_hdr(skb)->protocol;
1633f0e48dbfSPatrick McHardy 	sk->sk_bound_dev_if = arg->bound_dev_if;
1634be9f4a44SEric Dumazet 	sk->sk_sndbuf = sysctl_wmem_default;
1635bf99b4deSPau Espin Pedrol 	sk->sk_mark = fl4.flowi4_mark;
16364062090eSVasily Averin 	err = ip_append_data(sk, &fl4, ip_reply_glue_bits, arg->iov->iov_base,
16374062090eSVasily Averin 			     len, 0, &ipc, &rt, MSG_DONTWAIT);
16384062090eSVasily Averin 	if (unlikely(err)) {
16394062090eSVasily Averin 		ip_flush_pending_frames(sk);
16404062090eSVasily Averin 		goto out;
16414062090eSVasily Averin 	}
16424062090eSVasily Averin 
1643be9f4a44SEric Dumazet 	nskb = skb_peek(&sk->sk_write_queue);
1644be9f4a44SEric Dumazet 	if (nskb) {
16451da177e4SLinus Torvalds 		if (arg->csumoffset >= 0)
1646be9f4a44SEric Dumazet 			*((__sum16 *)skb_transport_header(nskb) +
1647be9f4a44SEric Dumazet 			  arg->csumoffset) = csum_fold(csum_add(nskb->csum,
16489c70220bSArnaldo Carvalho de Melo 								arg->csum));
1649be9f4a44SEric Dumazet 		nskb->ip_summed = CHECKSUM_NONE;
165077968b78SDavid S. Miller 		ip_push_pending_frames(sk, &fl4);
16511da177e4SLinus Torvalds 	}
16524062090eSVasily Averin out:
16531da177e4SLinus Torvalds 	ip_rt_put(rt);
16541da177e4SLinus Torvalds }
16551da177e4SLinus Torvalds 
16561da177e4SLinus Torvalds void __init ip_init(void)
16571da177e4SLinus Torvalds {
16581da177e4SLinus Torvalds 	ip_rt_init();
16591da177e4SLinus Torvalds 	inet_initpeers();
16601da177e4SLinus Torvalds 
166172c1d3bdSWANG Cong #if defined(CONFIG_IP_MULTICAST)
166272c1d3bdSWANG Cong 	igmp_mc_init();
16631da177e4SLinus Torvalds #endif
16641da177e4SLinus Torvalds }
1665