xref: /openbmc/linux/net/ipv6/ip6_output.c (revision cbffccc970394f82e397fccbeb136eeaffb3c552)
11da177e4SLinus Torvalds /*
21da177e4SLinus Torvalds  *	IPv6 output functions
31da177e4SLinus Torvalds  *	Linux INET6 implementation
41da177e4SLinus Torvalds  *
51da177e4SLinus Torvalds  *	Authors:
61da177e4SLinus Torvalds  *	Pedro Roque		<roque@di.fc.ul.pt>
71da177e4SLinus Torvalds  *
81da177e4SLinus Torvalds  *	Based on linux/net/ipv4/ip_output.c
91da177e4SLinus Torvalds  *
101da177e4SLinus Torvalds  *	This program is free software; you can redistribute it and/or
111da177e4SLinus Torvalds  *      modify it under the terms of the GNU General Public License
121da177e4SLinus Torvalds  *      as published by the Free Software Foundation; either version
131da177e4SLinus Torvalds  *      2 of the License, or (at your option) any later version.
141da177e4SLinus Torvalds  *
151da177e4SLinus Torvalds  *	Changes:
161da177e4SLinus Torvalds  *	A.N.Kuznetsov	:	airthmetics in fragmentation.
171da177e4SLinus Torvalds  *				extension headers are implemented.
181da177e4SLinus Torvalds  *				route changes now work.
191da177e4SLinus Torvalds  *				ip6_forward does not confuse sniffers.
201da177e4SLinus Torvalds  *				etc.
211da177e4SLinus Torvalds  *
221da177e4SLinus Torvalds  *      H. von Brand    :       Added missing #include <linux/string.h>
231da177e4SLinus Torvalds  *	Imran Patel	:	frag id should be in NBO
241da177e4SLinus Torvalds  *      Kazunori MIYAZAWA @USAGI
251da177e4SLinus Torvalds  *			:       add ip6_append_data and related functions
261da177e4SLinus Torvalds  *				for datagram xmit
271da177e4SLinus Torvalds  */
281da177e4SLinus Torvalds 
291da177e4SLinus Torvalds #include <linux/errno.h>
30ef76bc23SHerbert Xu #include <linux/kernel.h>
311da177e4SLinus Torvalds #include <linux/string.h>
321da177e4SLinus Torvalds #include <linux/socket.h>
331da177e4SLinus Torvalds #include <linux/net.h>
341da177e4SLinus Torvalds #include <linux/netdevice.h>
351da177e4SLinus Torvalds #include <linux/if_arp.h>
361da177e4SLinus Torvalds #include <linux/in6.h>
371da177e4SLinus Torvalds #include <linux/tcp.h>
381da177e4SLinus Torvalds #include <linux/route.h>
39b59f45d0SHerbert Xu #include <linux/module.h>
405a0e3ad6STejun Heo #include <linux/slab.h>
411da177e4SLinus Torvalds 
421da177e4SLinus Torvalds #include <linux/netfilter.h>
431da177e4SLinus Torvalds #include <linux/netfilter_ipv6.h>
441da177e4SLinus Torvalds 
451da177e4SLinus Torvalds #include <net/sock.h>
461da177e4SLinus Torvalds #include <net/snmp.h>
471da177e4SLinus Torvalds 
481da177e4SLinus Torvalds #include <net/ipv6.h>
491da177e4SLinus Torvalds #include <net/ndisc.h>
501da177e4SLinus Torvalds #include <net/protocol.h>
511da177e4SLinus Torvalds #include <net/ip6_route.h>
521da177e4SLinus Torvalds #include <net/addrconf.h>
531da177e4SLinus Torvalds #include <net/rawv6.h>
541da177e4SLinus Torvalds #include <net/icmp.h>
551da177e4SLinus Torvalds #include <net/xfrm.h>
561da177e4SLinus Torvalds #include <net/checksum.h>
577bc570c8SYOSHIFUJI Hideaki #include <linux/mroute6.h>
581da177e4SLinus Torvalds 
599e508490SJan Engelhardt static int ip6_finish_output2(struct sk_buff *skb)
601da177e4SLinus Torvalds {
61adf30907SEric Dumazet 	struct dst_entry *dst = skb_dst(skb);
621da177e4SLinus Torvalds 	struct net_device *dev = dst->dev;
63f6b72b62SDavid S. Miller 	struct neighbour *neigh;
646fd6ce20SYOSHIFUJI Hideaki / 吉藤英明 	struct in6_addr *nexthop;
656fd6ce20SYOSHIFUJI Hideaki / 吉藤英明 	int ret;
661da177e4SLinus Torvalds 
671da177e4SLinus Torvalds 	skb->protocol = htons(ETH_P_IPV6);
681da177e4SLinus Torvalds 	skb->dev = dev;
691da177e4SLinus Torvalds 
700660e03fSArnaldo Carvalho de Melo 	if (ipv6_addr_is_multicast(&ipv6_hdr(skb)->daddr)) {
71adf30907SEric Dumazet 		struct inet6_dev *idev = ip6_dst_idev(skb_dst(skb));
721da177e4SLinus Torvalds 
737ad6848cSOctavian Purdila 		if (!(dev->flags & IFF_LOOPBACK) && sk_mc_loop(skb->sk) &&
74d1db275dSPatrick McHardy 		    ((mroute6_socket(dev_net(dev), skb) &&
75bd91b8bfSBenjamin Thery 		     !(IP6CB(skb)->flags & IP6SKB_FORWARDED)) ||
760660e03fSArnaldo Carvalho de Melo 		     ipv6_chk_mcast_addr(dev, &ipv6_hdr(skb)->daddr,
777bc570c8SYOSHIFUJI Hideaki 					 &ipv6_hdr(skb)->saddr))) {
781da177e4SLinus Torvalds 			struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC);
791da177e4SLinus Torvalds 
801da177e4SLinus Torvalds 			/* Do not check for IFF_ALLMULTI; multicast routing
811da177e4SLinus Torvalds 			   is not supported in any case.
821da177e4SLinus Torvalds 			 */
831da177e4SLinus Torvalds 			if (newskb)
84b2e0b385SJan Engelhardt 				NF_HOOK(NFPROTO_IPV6, NF_INET_POST_ROUTING,
85b2e0b385SJan Engelhardt 					newskb, NULL, newskb->dev,
8695603e22SMichel Machado 					dev_loopback_xmit);
871da177e4SLinus Torvalds 
880660e03fSArnaldo Carvalho de Melo 			if (ipv6_hdr(skb)->hop_limit == 0) {
893bd653c8SDenis V. Lunev 				IP6_INC_STATS(dev_net(dev), idev,
903bd653c8SDenis V. Lunev 					      IPSTATS_MIB_OUTDISCARDS);
911da177e4SLinus Torvalds 				kfree_skb(skb);
921da177e4SLinus Torvalds 				return 0;
931da177e4SLinus Torvalds 			}
941da177e4SLinus Torvalds 		}
951da177e4SLinus Torvalds 
96edf391ffSNeil Horman 		IP6_UPD_PO_STATS(dev_net(dev), idev, IPSTATS_MIB_OUTMCAST,
97edf391ffSNeil Horman 				skb->len);
98dd408515SHannes Frederic Sowa 
99dd408515SHannes Frederic Sowa 		if (IPV6_ADDR_MC_SCOPE(&ipv6_hdr(skb)->daddr) <=
100dd408515SHannes Frederic Sowa 		    IPV6_ADDR_SCOPE_NODELOCAL &&
101dd408515SHannes Frederic Sowa 		    !(dev->flags & IFF_LOOPBACK)) {
102dd408515SHannes Frederic Sowa 			kfree_skb(skb);
103dd408515SHannes Frederic Sowa 			return 0;
104dd408515SHannes Frederic Sowa 		}
1051da177e4SLinus Torvalds 	}
1061da177e4SLinus Torvalds 
1076fd6ce20SYOSHIFUJI Hideaki / 吉藤英明 	rcu_read_lock_bh();
108550bab42SJulian Anastasov 	nexthop = rt6_nexthop((struct rt6_info *)dst);
1096fd6ce20SYOSHIFUJI Hideaki / 吉藤英明 	neigh = __ipv6_neigh_lookup_noref(dst->dev, nexthop);
1106fd6ce20SYOSHIFUJI Hideaki / 吉藤英明 	if (unlikely(!neigh))
1116fd6ce20SYOSHIFUJI Hideaki / 吉藤英明 		neigh = __neigh_create(&nd_tbl, nexthop, dst->dev, false);
1126fd6ce20SYOSHIFUJI Hideaki / 吉藤英明 	if (!IS_ERR(neigh)) {
1136fd6ce20SYOSHIFUJI Hideaki / 吉藤英明 		ret = dst_neigh_output(dst, neigh, skb);
1146fd6ce20SYOSHIFUJI Hideaki / 吉藤英明 		rcu_read_unlock_bh();
1156fd6ce20SYOSHIFUJI Hideaki / 吉藤英明 		return ret;
1166fd6ce20SYOSHIFUJI Hideaki / 吉藤英明 	}
1176fd6ce20SYOSHIFUJI Hideaki / 吉藤英明 	rcu_read_unlock_bh();
11805e3aa09SDavid S. Miller 
1197f88c6b2SHannes Frederic Sowa 	IP6_INC_STATS(dev_net(dst->dev),
1209e508490SJan Engelhardt 		      ip6_dst_idev(dst), IPSTATS_MIB_OUTNOROUTES);
1219e508490SJan Engelhardt 	kfree_skb(skb);
1229e508490SJan Engelhardt 	return -EINVAL;
1231da177e4SLinus Torvalds }
1241da177e4SLinus Torvalds 
1259e508490SJan Engelhardt static int ip6_finish_output(struct sk_buff *skb)
1269e508490SJan Engelhardt {
1279e508490SJan Engelhardt 	if ((skb->len > ip6_skb_dst_mtu(skb) && !skb_is_gso(skb)) ||
1289037c357SJiri Pirko 	    dst_allfrag(skb_dst(skb)) ||
1299037c357SJiri Pirko 	    (IP6CB(skb)->frag_max_size && skb->len > IP6CB(skb)->frag_max_size))
1309e508490SJan Engelhardt 		return ip6_fragment(skb, ip6_finish_output2);
1319e508490SJan Engelhardt 	else
1329e508490SJan Engelhardt 		return ip6_finish_output2(skb);
1339e508490SJan Engelhardt }
1349e508490SJan Engelhardt 
135aad88724SEric Dumazet int ip6_output(struct sock *sk, struct sk_buff *skb)
1361da177e4SLinus Torvalds {
1379e508490SJan Engelhardt 	struct net_device *dev = skb_dst(skb)->dev;
138adf30907SEric Dumazet 	struct inet6_dev *idev = ip6_dst_idev(skb_dst(skb));
139778d80beSYOSHIFUJI Hideaki 	if (unlikely(idev->cnf.disable_ipv6)) {
1409e508490SJan Engelhardt 		IP6_INC_STATS(dev_net(dev), idev,
1413bd653c8SDenis V. Lunev 			      IPSTATS_MIB_OUTDISCARDS);
142778d80beSYOSHIFUJI Hideaki 		kfree_skb(skb);
143778d80beSYOSHIFUJI Hideaki 		return 0;
144778d80beSYOSHIFUJI Hideaki 	}
145778d80beSYOSHIFUJI Hideaki 
1469c6eb28aSJan Engelhardt 	return NF_HOOK_COND(NFPROTO_IPV6, NF_INET_POST_ROUTING, skb, NULL, dev,
1479c6eb28aSJan Engelhardt 			    ip6_finish_output,
1489c6eb28aSJan Engelhardt 			    !(IP6CB(skb)->flags & IP6SKB_REROUTED));
1491da177e4SLinus Torvalds }
1501da177e4SLinus Torvalds 
1511da177e4SLinus Torvalds /*
152b5d43998SShan Wei  *	xmit an sk_buff (used by TCP, SCTP and DCCP)
1531da177e4SLinus Torvalds  */
1541da177e4SLinus Torvalds 
1554c9483b2SDavid S. Miller int ip6_xmit(struct sock *sk, struct sk_buff *skb, struct flowi6 *fl6,
156b903d324SEric Dumazet 	     struct ipv6_txoptions *opt, int tclass)
1571da177e4SLinus Torvalds {
1583bd653c8SDenis V. Lunev 	struct net *net = sock_net(sk);
159b30bd282SPatrick McHardy 	struct ipv6_pinfo *np = inet6_sk(sk);
1604c9483b2SDavid S. Miller 	struct in6_addr *first_hop = &fl6->daddr;
161adf30907SEric Dumazet 	struct dst_entry *dst = skb_dst(skb);
1621da177e4SLinus Torvalds 	struct ipv6hdr *hdr;
1634c9483b2SDavid S. Miller 	u8  proto = fl6->flowi6_proto;
1641da177e4SLinus Torvalds 	int seg_len = skb->len;
165e651f03aSGerrit Renker 	int hlimit = -1;
1661da177e4SLinus Torvalds 	u32 mtu;
1671da177e4SLinus Torvalds 
1681da177e4SLinus Torvalds 	if (opt) {
169c2636b4dSChuck Lever 		unsigned int head_room;
1701da177e4SLinus Torvalds 
1711da177e4SLinus Torvalds 		/* First: exthdrs may take lots of space (~8K for now)
1721da177e4SLinus Torvalds 		   MAX_HEADER is not enough.
1731da177e4SLinus Torvalds 		 */
1741da177e4SLinus Torvalds 		head_room = opt->opt_nflen + opt->opt_flen;
1751da177e4SLinus Torvalds 		seg_len += head_room;
1761da177e4SLinus Torvalds 		head_room += sizeof(struct ipv6hdr) + LL_RESERVED_SPACE(dst->dev);
1771da177e4SLinus Torvalds 
1781da177e4SLinus Torvalds 		if (skb_headroom(skb) < head_room) {
1791da177e4SLinus Torvalds 			struct sk_buff *skb2 = skb_realloc_headroom(skb, head_room);
180a11d206dSYOSHIFUJI Hideaki 			if (skb2 == NULL) {
181adf30907SEric Dumazet 				IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)),
182a11d206dSYOSHIFUJI Hideaki 					      IPSTATS_MIB_OUTDISCARDS);
1831da177e4SLinus Torvalds 				kfree_skb(skb);
1841da177e4SLinus Torvalds 				return -ENOBUFS;
1851da177e4SLinus Torvalds 			}
186808db80aSEric Dumazet 			consume_skb(skb);
187a11d206dSYOSHIFUJI Hideaki 			skb = skb2;
1881da177e4SLinus Torvalds 			skb_set_owner_w(skb, sk);
1891da177e4SLinus Torvalds 		}
1901da177e4SLinus Torvalds 		if (opt->opt_flen)
1911da177e4SLinus Torvalds 			ipv6_push_frag_opts(skb, opt, &proto);
1921da177e4SLinus Torvalds 		if (opt->opt_nflen)
1931da177e4SLinus Torvalds 			ipv6_push_nfrag_opts(skb, opt, &proto, &first_hop);
1941da177e4SLinus Torvalds 	}
1951da177e4SLinus Torvalds 
196e2d1bca7SArnaldo Carvalho de Melo 	skb_push(skb, sizeof(struct ipv6hdr));
197e2d1bca7SArnaldo Carvalho de Melo 	skb_reset_network_header(skb);
1980660e03fSArnaldo Carvalho de Melo 	hdr = ipv6_hdr(skb);
1991da177e4SLinus Torvalds 
2001da177e4SLinus Torvalds 	/*
2011da177e4SLinus Torvalds 	 *	Fill in the IPv6 header
2021da177e4SLinus Torvalds 	 */
203b903d324SEric Dumazet 	if (np)
2041da177e4SLinus Torvalds 		hlimit = np->hop_limit;
2051da177e4SLinus Torvalds 	if (hlimit < 0)
2066b75d090SYOSHIFUJI Hideaki 		hlimit = ip6_dst_hoplimit(dst);
2071da177e4SLinus Torvalds 
208cb1ce2efSTom Herbert 	ip6_flow_hdr(hdr, tclass, ip6_make_flowlabel(net, skb, fl6->flowlabel,
209cb1ce2efSTom Herbert 						     np->autoflowlabel));
21041a1f8eaSYOSHIFUJI Hideaki 
2111da177e4SLinus Torvalds 	hdr->payload_len = htons(seg_len);
2121da177e4SLinus Torvalds 	hdr->nexthdr = proto;
2131da177e4SLinus Torvalds 	hdr->hop_limit = hlimit;
2141da177e4SLinus Torvalds 
2154e3fd7a0SAlexey Dobriyan 	hdr->saddr = fl6->saddr;
2164e3fd7a0SAlexey Dobriyan 	hdr->daddr = *first_hop;
2171da177e4SLinus Torvalds 
2189c9c9ad5SHannes Frederic Sowa 	skb->protocol = htons(ETH_P_IPV6);
219a2c2064fSPatrick McHardy 	skb->priority = sk->sk_priority;
2204a19ec58SLaszlo Attila Toth 	skb->mark = sk->sk_mark;
221a2c2064fSPatrick McHardy 
2221da177e4SLinus Torvalds 	mtu = dst_mtu(dst);
22360ff7467SWANG Cong 	if ((skb->len <= mtu) || skb->ignore_df || skb_is_gso(skb)) {
224adf30907SEric Dumazet 		IP6_UPD_PO_STATS(net, ip6_dst_idev(skb_dst(skb)),
225edf391ffSNeil Horman 			      IPSTATS_MIB_OUT, skb->len);
226b2e0b385SJan Engelhardt 		return NF_HOOK(NFPROTO_IPV6, NF_INET_LOCAL_OUT, skb, NULL,
227b2e0b385SJan Engelhardt 			       dst->dev, dst_output);
2281da177e4SLinus Torvalds 	}
2291da177e4SLinus Torvalds 
2301da177e4SLinus Torvalds 	skb->dev = dst->dev;
231f4e53e29SSteffen Klassert 	ipv6_local_error(sk, EMSGSIZE, fl6, mtu);
232adf30907SEric Dumazet 	IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)), IPSTATS_MIB_FRAGFAILS);
2331da177e4SLinus Torvalds 	kfree_skb(skb);
2341da177e4SLinus Torvalds 	return -EMSGSIZE;
2351da177e4SLinus Torvalds }
2367159039aSYOSHIFUJI Hideaki EXPORT_SYMBOL(ip6_xmit);
2377159039aSYOSHIFUJI Hideaki 
2381da177e4SLinus Torvalds static int ip6_call_ra_chain(struct sk_buff *skb, int sel)
2391da177e4SLinus Torvalds {
2401da177e4SLinus Torvalds 	struct ip6_ra_chain *ra;
2411da177e4SLinus Torvalds 	struct sock *last = NULL;
2421da177e4SLinus Torvalds 
2431da177e4SLinus Torvalds 	read_lock(&ip6_ra_lock);
2441da177e4SLinus Torvalds 	for (ra = ip6_ra_chain; ra; ra = ra->next) {
2451da177e4SLinus Torvalds 		struct sock *sk = ra->sk;
2460bd1b59bSAndrew McDonald 		if (sk && ra->sel == sel &&
2470bd1b59bSAndrew McDonald 		    (!sk->sk_bound_dev_if ||
2480bd1b59bSAndrew McDonald 		     sk->sk_bound_dev_if == skb->dev->ifindex)) {
2491da177e4SLinus Torvalds 			if (last) {
2501da177e4SLinus Torvalds 				struct sk_buff *skb2 = skb_clone(skb, GFP_ATOMIC);
2511da177e4SLinus Torvalds 				if (skb2)
2521da177e4SLinus Torvalds 					rawv6_rcv(last, skb2);
2531da177e4SLinus Torvalds 			}
2541da177e4SLinus Torvalds 			last = sk;
2551da177e4SLinus Torvalds 		}
2561da177e4SLinus Torvalds 	}
2571da177e4SLinus Torvalds 
2581da177e4SLinus Torvalds 	if (last) {
2591da177e4SLinus Torvalds 		rawv6_rcv(last, skb);
2601da177e4SLinus Torvalds 		read_unlock(&ip6_ra_lock);
2611da177e4SLinus Torvalds 		return 1;
2621da177e4SLinus Torvalds 	}
2631da177e4SLinus Torvalds 	read_unlock(&ip6_ra_lock);
2641da177e4SLinus Torvalds 	return 0;
2651da177e4SLinus Torvalds }
2661da177e4SLinus Torvalds 
267e21e0b5fSVille Nuorvala static int ip6_forward_proxy_check(struct sk_buff *skb)
268e21e0b5fSVille Nuorvala {
2690660e03fSArnaldo Carvalho de Melo 	struct ipv6hdr *hdr = ipv6_hdr(skb);
270e21e0b5fSVille Nuorvala 	u8 nexthdr = hdr->nexthdr;
27175f2811cSJesse Gross 	__be16 frag_off;
272e21e0b5fSVille Nuorvala 	int offset;
273e21e0b5fSVille Nuorvala 
274e21e0b5fSVille Nuorvala 	if (ipv6_ext_hdr(nexthdr)) {
27575f2811cSJesse Gross 		offset = ipv6_skip_exthdr(skb, sizeof(*hdr), &nexthdr, &frag_off);
276e21e0b5fSVille Nuorvala 		if (offset < 0)
277e21e0b5fSVille Nuorvala 			return 0;
278e21e0b5fSVille Nuorvala 	} else
279e21e0b5fSVille Nuorvala 		offset = sizeof(struct ipv6hdr);
280e21e0b5fSVille Nuorvala 
281e21e0b5fSVille Nuorvala 	if (nexthdr == IPPROTO_ICMPV6) {
282e21e0b5fSVille Nuorvala 		struct icmp6hdr *icmp6;
283e21e0b5fSVille Nuorvala 
284d56f90a7SArnaldo Carvalho de Melo 		if (!pskb_may_pull(skb, (skb_network_header(skb) +
285d56f90a7SArnaldo Carvalho de Melo 					 offset + 1 - skb->data)))
286e21e0b5fSVille Nuorvala 			return 0;
287e21e0b5fSVille Nuorvala 
288d56f90a7SArnaldo Carvalho de Melo 		icmp6 = (struct icmp6hdr *)(skb_network_header(skb) + offset);
289e21e0b5fSVille Nuorvala 
290e21e0b5fSVille Nuorvala 		switch (icmp6->icmp6_type) {
291e21e0b5fSVille Nuorvala 		case NDISC_ROUTER_SOLICITATION:
292e21e0b5fSVille Nuorvala 		case NDISC_ROUTER_ADVERTISEMENT:
293e21e0b5fSVille Nuorvala 		case NDISC_NEIGHBOUR_SOLICITATION:
294e21e0b5fSVille Nuorvala 		case NDISC_NEIGHBOUR_ADVERTISEMENT:
295e21e0b5fSVille Nuorvala 		case NDISC_REDIRECT:
296e21e0b5fSVille Nuorvala 			/* For reaction involving unicast neighbor discovery
297e21e0b5fSVille Nuorvala 			 * message destined to the proxied address, pass it to
298e21e0b5fSVille Nuorvala 			 * input function.
299e21e0b5fSVille Nuorvala 			 */
300e21e0b5fSVille Nuorvala 			return 1;
301e21e0b5fSVille Nuorvala 		default:
302e21e0b5fSVille Nuorvala 			break;
303e21e0b5fSVille Nuorvala 		}
304e21e0b5fSVille Nuorvala 	}
305e21e0b5fSVille Nuorvala 
30674553b09SVille Nuorvala 	/*
30774553b09SVille Nuorvala 	 * The proxying router can't forward traffic sent to a link-local
30874553b09SVille Nuorvala 	 * address, so signal the sender and discard the packet. This
30974553b09SVille Nuorvala 	 * behavior is clarified by the MIPv6 specification.
31074553b09SVille Nuorvala 	 */
31174553b09SVille Nuorvala 	if (ipv6_addr_type(&hdr->daddr) & IPV6_ADDR_LINKLOCAL) {
31274553b09SVille Nuorvala 		dst_link_failure(skb);
31374553b09SVille Nuorvala 		return -1;
31474553b09SVille Nuorvala 	}
31574553b09SVille Nuorvala 
316e21e0b5fSVille Nuorvala 	return 0;
317e21e0b5fSVille Nuorvala }
318e21e0b5fSVille Nuorvala 
3191da177e4SLinus Torvalds static inline int ip6_forward_finish(struct sk_buff *skb)
3201da177e4SLinus Torvalds {
3211da177e4SLinus Torvalds 	return dst_output(skb);
3221da177e4SLinus Torvalds }
3231da177e4SLinus Torvalds 
3240954cf9cSHannes Frederic Sowa static unsigned int ip6_dst_mtu_forward(const struct dst_entry *dst)
3250954cf9cSHannes Frederic Sowa {
3260954cf9cSHannes Frederic Sowa 	unsigned int mtu;
3270954cf9cSHannes Frederic Sowa 	struct inet6_dev *idev;
3280954cf9cSHannes Frederic Sowa 
3290954cf9cSHannes Frederic Sowa 	if (dst_metric_locked(dst, RTAX_MTU)) {
3300954cf9cSHannes Frederic Sowa 		mtu = dst_metric_raw(dst, RTAX_MTU);
3310954cf9cSHannes Frederic Sowa 		if (mtu)
3320954cf9cSHannes Frederic Sowa 			return mtu;
3330954cf9cSHannes Frederic Sowa 	}
3340954cf9cSHannes Frederic Sowa 
3350954cf9cSHannes Frederic Sowa 	mtu = IPV6_MIN_MTU;
3360954cf9cSHannes Frederic Sowa 	rcu_read_lock();
3370954cf9cSHannes Frederic Sowa 	idev = __in6_dev_get(dst->dev);
3380954cf9cSHannes Frederic Sowa 	if (idev)
3390954cf9cSHannes Frederic Sowa 		mtu = idev->cnf.mtu6;
3400954cf9cSHannes Frederic Sowa 	rcu_read_unlock();
3410954cf9cSHannes Frederic Sowa 
3420954cf9cSHannes Frederic Sowa 	return mtu;
3430954cf9cSHannes Frederic Sowa }
3440954cf9cSHannes Frederic Sowa 
345fe6cc55fSFlorian Westphal static bool ip6_pkt_too_big(const struct sk_buff *skb, unsigned int mtu)
346fe6cc55fSFlorian Westphal {
347418a3156SFlorian Westphal 	if (skb->len <= mtu)
348fe6cc55fSFlorian Westphal 		return false;
349fe6cc55fSFlorian Westphal 
35060ff7467SWANG Cong 	/* ipv6 conntrack defrag sets max_frag_size + ignore_df */
351fe6cc55fSFlorian Westphal 	if (IP6CB(skb)->frag_max_size && IP6CB(skb)->frag_max_size > mtu)
352fe6cc55fSFlorian Westphal 		return true;
353fe6cc55fSFlorian Westphal 
35460ff7467SWANG Cong 	if (skb->ignore_df)
355418a3156SFlorian Westphal 		return false;
356418a3156SFlorian Westphal 
357fe6cc55fSFlorian Westphal 	if (skb_is_gso(skb) && skb_gso_network_seglen(skb) <= mtu)
358fe6cc55fSFlorian Westphal 		return false;
359fe6cc55fSFlorian Westphal 
360fe6cc55fSFlorian Westphal 	return true;
361fe6cc55fSFlorian Westphal }
362fe6cc55fSFlorian Westphal 
3631da177e4SLinus Torvalds int ip6_forward(struct sk_buff *skb)
3641da177e4SLinus Torvalds {
365adf30907SEric Dumazet 	struct dst_entry *dst = skb_dst(skb);
3660660e03fSArnaldo Carvalho de Melo 	struct ipv6hdr *hdr = ipv6_hdr(skb);
3671da177e4SLinus Torvalds 	struct inet6_skb_parm *opt = IP6CB(skb);
368c346dca1SYOSHIFUJI Hideaki 	struct net *net = dev_net(dst->dev);
36914f3ad6fSUlrich Weber 	u32 mtu;
3701da177e4SLinus Torvalds 
37153b7997fSYOSHIFUJI Hideaki 	if (net->ipv6.devconf_all->forwarding == 0)
3721da177e4SLinus Torvalds 		goto error;
3731da177e4SLinus Torvalds 
374090f1166SLi RongQing 	if (skb->pkt_type != PACKET_HOST)
375090f1166SLi RongQing 		goto drop;
376090f1166SLi RongQing 
3774497b076SBen Hutchings 	if (skb_warn_if_lro(skb))
3784497b076SBen Hutchings 		goto drop;
3794497b076SBen Hutchings 
3801da177e4SLinus Torvalds 	if (!xfrm6_policy_check(NULL, XFRM_POLICY_FWD, skb)) {
38115c77d8bSEric Dumazet 		IP6_INC_STATS_BH(net, ip6_dst_idev(dst),
38215c77d8bSEric Dumazet 				 IPSTATS_MIB_INDISCARDS);
3831da177e4SLinus Torvalds 		goto drop;
3841da177e4SLinus Torvalds 	}
3851da177e4SLinus Torvalds 
38635fc92a9SHerbert Xu 	skb_forward_csum(skb);
3871da177e4SLinus Torvalds 
3881da177e4SLinus Torvalds 	/*
3891da177e4SLinus Torvalds 	 *	We DO NOT make any processing on
3901da177e4SLinus Torvalds 	 *	RA packets, pushing them to user level AS IS
3911da177e4SLinus Torvalds 	 *	without ane WARRANTY that application will be able
3921da177e4SLinus Torvalds 	 *	to interpret them. The reason is that we
3931da177e4SLinus Torvalds 	 *	cannot make anything clever here.
3941da177e4SLinus Torvalds 	 *
3951da177e4SLinus Torvalds 	 *	We are not end-node, so that if packet contains
3961da177e4SLinus Torvalds 	 *	AH/ESP, we cannot make anything.
3971da177e4SLinus Torvalds 	 *	Defragmentation also would be mistake, RA packets
3981da177e4SLinus Torvalds 	 *	cannot be fragmented, because there is no warranty
3991da177e4SLinus Torvalds 	 *	that different fragments will go along one path. --ANK
4001da177e4SLinus Torvalds 	 */
401ab4eb353SYOSHIFUJI Hideaki / 吉藤英明 	if (unlikely(opt->flags & IP6SKB_ROUTERALERT)) {
402ab4eb353SYOSHIFUJI Hideaki / 吉藤英明 		if (ip6_call_ra_chain(skb, ntohs(opt->ra)))
4031da177e4SLinus Torvalds 			return 0;
4041da177e4SLinus Torvalds 	}
4051da177e4SLinus Torvalds 
4061da177e4SLinus Torvalds 	/*
4071da177e4SLinus Torvalds 	 *	check and decrement ttl
4081da177e4SLinus Torvalds 	 */
4091da177e4SLinus Torvalds 	if (hdr->hop_limit <= 1) {
4101da177e4SLinus Torvalds 		/* Force OUTPUT device used as source address */
4111da177e4SLinus Torvalds 		skb->dev = dst->dev;
4123ffe533cSAlexey Dobriyan 		icmpv6_send(skb, ICMPV6_TIME_EXCEED, ICMPV6_EXC_HOPLIMIT, 0);
41315c77d8bSEric Dumazet 		IP6_INC_STATS_BH(net, ip6_dst_idev(dst),
41415c77d8bSEric Dumazet 				 IPSTATS_MIB_INHDRERRORS);
4151da177e4SLinus Torvalds 
4161da177e4SLinus Torvalds 		kfree_skb(skb);
4171da177e4SLinus Torvalds 		return -ETIMEDOUT;
4181da177e4SLinus Torvalds 	}
4191da177e4SLinus Torvalds 
420fbea49e1SYOSHIFUJI Hideaki 	/* XXX: idev->cnf.proxy_ndp? */
42153b7997fSYOSHIFUJI Hideaki 	if (net->ipv6.devconf_all->proxy_ndp &&
4228a3edd80SDaniel Lezcano 	    pneigh_lookup(&nd_tbl, net, &hdr->daddr, skb->dev, 0)) {
42374553b09SVille Nuorvala 		int proxied = ip6_forward_proxy_check(skb);
42474553b09SVille Nuorvala 		if (proxied > 0)
425e21e0b5fSVille Nuorvala 			return ip6_input(skb);
42674553b09SVille Nuorvala 		else if (proxied < 0) {
42715c77d8bSEric Dumazet 			IP6_INC_STATS_BH(net, ip6_dst_idev(dst),
4283bd653c8SDenis V. Lunev 					 IPSTATS_MIB_INDISCARDS);
42974553b09SVille Nuorvala 			goto drop;
43074553b09SVille Nuorvala 		}
431e21e0b5fSVille Nuorvala 	}
432e21e0b5fSVille Nuorvala 
4331da177e4SLinus Torvalds 	if (!xfrm6_route_forward(skb)) {
43415c77d8bSEric Dumazet 		IP6_INC_STATS_BH(net, ip6_dst_idev(dst),
43515c77d8bSEric Dumazet 				 IPSTATS_MIB_INDISCARDS);
4361da177e4SLinus Torvalds 		goto drop;
4371da177e4SLinus Torvalds 	}
438adf30907SEric Dumazet 	dst = skb_dst(skb);
4391da177e4SLinus Torvalds 
4401da177e4SLinus Torvalds 	/* IPv6 specs say nothing about it, but it is clear that we cannot
4411da177e4SLinus Torvalds 	   send redirects to source routed frames.
4421e5dc146SMasahide NAKAMURA 	   We don't send redirects to frames decapsulated from IPsec.
4431da177e4SLinus Torvalds 	 */
444c45a3dfbSDavid S. Miller 	if (skb->dev == dst->dev && opt->srcrt == 0 && !skb_sec_path(skb)) {
4451da177e4SLinus Torvalds 		struct in6_addr *target = NULL;
446fbfe95a4SDavid S. Miller 		struct inet_peer *peer;
4471da177e4SLinus Torvalds 		struct rt6_info *rt;
4481da177e4SLinus Torvalds 
4491da177e4SLinus Torvalds 		/*
4501da177e4SLinus Torvalds 		 *	incoming and outgoing devices are the same
4511da177e4SLinus Torvalds 		 *	send a redirect.
4521da177e4SLinus Torvalds 		 */
4531da177e4SLinus Torvalds 
4541da177e4SLinus Torvalds 		rt = (struct rt6_info *) dst;
455c45a3dfbSDavid S. Miller 		if (rt->rt6i_flags & RTF_GATEWAY)
456c45a3dfbSDavid S. Miller 			target = &rt->rt6i_gateway;
4571da177e4SLinus Torvalds 		else
4581da177e4SLinus Torvalds 			target = &hdr->daddr;
4591da177e4SLinus Torvalds 
4601d861aa4SDavid S. Miller 		peer = inet_getpeer_v6(net->ipv6.peers, &rt->rt6i_dst.addr, 1);
46192d86829SDavid S. Miller 
4621da177e4SLinus Torvalds 		/* Limit redirects both by destination (here)
4631da177e4SLinus Torvalds 		   and by source (inside ndisc_send_redirect)
4641da177e4SLinus Torvalds 		 */
465fbfe95a4SDavid S. Miller 		if (inet_peer_xrlim_allow(peer, 1*HZ))
4664991969aSDavid S. Miller 			ndisc_send_redirect(skb, target);
4671d861aa4SDavid S. Miller 		if (peer)
4681d861aa4SDavid S. Miller 			inet_putpeer(peer);
4695bb1ab09SDavid L Stevens 	} else {
4705bb1ab09SDavid L Stevens 		int addrtype = ipv6_addr_type(&hdr->saddr);
4715bb1ab09SDavid L Stevens 
4721da177e4SLinus Torvalds 		/* This check is security critical. */
473f81b2e7dSYOSHIFUJI Hideaki 		if (addrtype == IPV6_ADDR_ANY ||
474f81b2e7dSYOSHIFUJI Hideaki 		    addrtype & (IPV6_ADDR_MULTICAST | IPV6_ADDR_LOOPBACK))
4751da177e4SLinus Torvalds 			goto error;
4765bb1ab09SDavid L Stevens 		if (addrtype & IPV6_ADDR_LINKLOCAL) {
4775bb1ab09SDavid L Stevens 			icmpv6_send(skb, ICMPV6_DEST_UNREACH,
4783ffe533cSAlexey Dobriyan 				    ICMPV6_NOT_NEIGHBOUR, 0);
4795bb1ab09SDavid L Stevens 			goto error;
4805bb1ab09SDavid L Stevens 		}
4811da177e4SLinus Torvalds 	}
4821da177e4SLinus Torvalds 
4830954cf9cSHannes Frederic Sowa 	mtu = ip6_dst_mtu_forward(dst);
48414f3ad6fSUlrich Weber 	if (mtu < IPV6_MIN_MTU)
48514f3ad6fSUlrich Weber 		mtu = IPV6_MIN_MTU;
48614f3ad6fSUlrich Weber 
487fe6cc55fSFlorian Westphal 	if (ip6_pkt_too_big(skb, mtu)) {
4881da177e4SLinus Torvalds 		/* Again, force OUTPUT device used as source address */
4891da177e4SLinus Torvalds 		skb->dev = dst->dev;
49014f3ad6fSUlrich Weber 		icmpv6_send(skb, ICMPV6_PKT_TOOBIG, 0, mtu);
49115c77d8bSEric Dumazet 		IP6_INC_STATS_BH(net, ip6_dst_idev(dst),
49215c77d8bSEric Dumazet 				 IPSTATS_MIB_INTOOBIGERRORS);
49315c77d8bSEric Dumazet 		IP6_INC_STATS_BH(net, ip6_dst_idev(dst),
49415c77d8bSEric Dumazet 				 IPSTATS_MIB_FRAGFAILS);
4951da177e4SLinus Torvalds 		kfree_skb(skb);
4961da177e4SLinus Torvalds 		return -EMSGSIZE;
4971da177e4SLinus Torvalds 	}
4981da177e4SLinus Torvalds 
4991da177e4SLinus Torvalds 	if (skb_cow(skb, dst->dev->hard_header_len)) {
50015c77d8bSEric Dumazet 		IP6_INC_STATS_BH(net, ip6_dst_idev(dst),
50115c77d8bSEric Dumazet 				 IPSTATS_MIB_OUTDISCARDS);
5021da177e4SLinus Torvalds 		goto drop;
5031da177e4SLinus Torvalds 	}
5041da177e4SLinus Torvalds 
5050660e03fSArnaldo Carvalho de Melo 	hdr = ipv6_hdr(skb);
5061da177e4SLinus Torvalds 
5071da177e4SLinus Torvalds 	/* Mangling hops number delayed to point after skb COW */
5081da177e4SLinus Torvalds 
5091da177e4SLinus Torvalds 	hdr->hop_limit--;
5101da177e4SLinus Torvalds 
511483a47d2SDenis V. Lunev 	IP6_INC_STATS_BH(net, ip6_dst_idev(dst), IPSTATS_MIB_OUTFORWDATAGRAMS);
5122d8dbb04SVincent Bernat 	IP6_ADD_STATS_BH(net, ip6_dst_idev(dst), IPSTATS_MIB_OUTOCTETS, skb->len);
513b2e0b385SJan Engelhardt 	return NF_HOOK(NFPROTO_IPV6, NF_INET_FORWARD, skb, skb->dev, dst->dev,
5146e23ae2aSPatrick McHardy 		       ip6_forward_finish);
5151da177e4SLinus Torvalds 
5161da177e4SLinus Torvalds error:
517483a47d2SDenis V. Lunev 	IP6_INC_STATS_BH(net, ip6_dst_idev(dst), IPSTATS_MIB_INADDRERRORS);
5181da177e4SLinus Torvalds drop:
5191da177e4SLinus Torvalds 	kfree_skb(skb);
5201da177e4SLinus Torvalds 	return -EINVAL;
5211da177e4SLinus Torvalds }
5221da177e4SLinus Torvalds 
5231da177e4SLinus Torvalds static void ip6_copy_metadata(struct sk_buff *to, struct sk_buff *from)
5241da177e4SLinus Torvalds {
5251da177e4SLinus Torvalds 	to->pkt_type = from->pkt_type;
5261da177e4SLinus Torvalds 	to->priority = from->priority;
5271da177e4SLinus Torvalds 	to->protocol = from->protocol;
528adf30907SEric Dumazet 	skb_dst_drop(to);
529adf30907SEric Dumazet 	skb_dst_set(to, dst_clone(skb_dst(from)));
5301da177e4SLinus Torvalds 	to->dev = from->dev;
53182e91ffeSThomas Graf 	to->mark = from->mark;
5321da177e4SLinus Torvalds 
5331da177e4SLinus Torvalds #ifdef CONFIG_NET_SCHED
5341da177e4SLinus Torvalds 	to->tc_index = from->tc_index;
5351da177e4SLinus Torvalds #endif
536e7ac05f3SYasuyuki Kozakai 	nf_copy(to, from);
537984bc16cSJames Morris 	skb_copy_secmark(to, from);
5381da177e4SLinus Torvalds }
5391da177e4SLinus Torvalds 
54073f156a6SEric Dumazet static void ipv6_select_ident(struct frag_hdr *fhdr, struct rt6_info *rt)
54173f156a6SEric Dumazet {
54273f156a6SEric Dumazet 	static u32 ip6_idents_hashrnd __read_mostly;
54373f156a6SEric Dumazet 	u32 hash, id;
54473f156a6SEric Dumazet 
54573f156a6SEric Dumazet 	net_get_random_once(&ip6_idents_hashrnd, sizeof(ip6_idents_hashrnd));
54673f156a6SEric Dumazet 
54773f156a6SEric Dumazet 	hash = __ipv6_addr_jhash(&rt->rt6i_dst.addr, ip6_idents_hashrnd);
54804ca6973SEric Dumazet 	hash = __ipv6_addr_jhash(&rt->rt6i_src.addr, hash);
54904ca6973SEric Dumazet 
55073f156a6SEric Dumazet 	id = ip_idents_reserve(hash, 1);
55173f156a6SEric Dumazet 	fhdr->identification = htonl(id);
55273f156a6SEric Dumazet }
55373f156a6SEric Dumazet 
554ad0081e4SDavid Stevens int ip6_fragment(struct sk_buff *skb, int (*output)(struct sk_buff *))
5551da177e4SLinus Torvalds {
5561da177e4SLinus Torvalds 	struct sk_buff *frag;
557adf30907SEric Dumazet 	struct rt6_info *rt = (struct rt6_info *)skb_dst(skb);
558d91675f9SYOSHIFUJI Hideaki 	struct ipv6_pinfo *np = skb->sk ? inet6_sk(skb->sk) : NULL;
5591da177e4SLinus Torvalds 	struct ipv6hdr *tmp_hdr;
5601da177e4SLinus Torvalds 	struct frag_hdr *fh;
5611da177e4SLinus Torvalds 	unsigned int mtu, hlen, left, len;
562a7ae1992SHerbert Xu 	int hroom, troom;
563ae08e1f0SAl Viro 	__be32 frag_id = 0;
5641da177e4SLinus Torvalds 	int ptr, offset = 0, err = 0;
5651da177e4SLinus Torvalds 	u8 *prevhdr, nexthdr = 0;
566adf30907SEric Dumazet 	struct net *net = dev_net(skb_dst(skb)->dev);
5671da177e4SLinus Torvalds 
5681da177e4SLinus Torvalds 	hlen = ip6_find_1stfragopt(skb, &prevhdr);
5691da177e4SLinus Torvalds 	nexthdr = *prevhdr;
5701da177e4SLinus Torvalds 
571628a5c56SJohn Heffner 	mtu = ip6_skb_dst_mtu(skb);
572b881ef76SJohn Heffner 
573b881ef76SJohn Heffner 	/* We must not fragment if the socket is set to force MTU discovery
57414f3ad6fSUlrich Weber 	 * or if the skb it not generated by a local socket.
575b881ef76SJohn Heffner 	 */
57660ff7467SWANG Cong 	if (unlikely(!skb->ignore_df && skb->len > mtu) ||
5774cdd3408SPatrick McHardy 		     (IP6CB(skb)->frag_max_size &&
5784cdd3408SPatrick McHardy 		      IP6CB(skb)->frag_max_size > mtu)) {
579a34a101eSEric Dumazet 		if (skb->sk && dst_allfrag(skb_dst(skb)))
580a34a101eSEric Dumazet 			sk_nocaps_add(skb->sk, NETIF_F_GSO_MASK);
581a34a101eSEric Dumazet 
582adf30907SEric Dumazet 		skb->dev = skb_dst(skb)->dev;
5833ffe533cSAlexey Dobriyan 		icmpv6_send(skb, ICMPV6_PKT_TOOBIG, 0, mtu);
584adf30907SEric Dumazet 		IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)),
5853bd653c8SDenis V. Lunev 			      IPSTATS_MIB_FRAGFAILS);
586b881ef76SJohn Heffner 		kfree_skb(skb);
587b881ef76SJohn Heffner 		return -EMSGSIZE;
588b881ef76SJohn Heffner 	}
589b881ef76SJohn Heffner 
590d91675f9SYOSHIFUJI Hideaki 	if (np && np->frag_size < mtu) {
591d91675f9SYOSHIFUJI Hideaki 		if (np->frag_size)
592d91675f9SYOSHIFUJI Hideaki 			mtu = np->frag_size;
593d91675f9SYOSHIFUJI Hideaki 	}
594d91675f9SYOSHIFUJI Hideaki 	mtu -= hlen + sizeof(struct frag_hdr);
5951da177e4SLinus Torvalds 
59621dc3301SDavid S. Miller 	if (skb_has_frag_list(skb)) {
5971da177e4SLinus Torvalds 		int first_len = skb_pagelen(skb);
5983d13008eSEric Dumazet 		struct sk_buff *frag2;
5991da177e4SLinus Torvalds 
6001da177e4SLinus Torvalds 		if (first_len - hlen > mtu ||
6011da177e4SLinus Torvalds 		    ((first_len - hlen) & 7) ||
6021da177e4SLinus Torvalds 		    skb_cloned(skb))
6031da177e4SLinus Torvalds 			goto slow_path;
6041da177e4SLinus Torvalds 
6054d9092bbSDavid S. Miller 		skb_walk_frags(skb, frag) {
6061da177e4SLinus Torvalds 			/* Correct geometry. */
6071da177e4SLinus Torvalds 			if (frag->len > mtu ||
6081da177e4SLinus Torvalds 			    ((frag->len & 7) && frag->next) ||
6091da177e4SLinus Torvalds 			    skb_headroom(frag) < hlen)
6103d13008eSEric Dumazet 				goto slow_path_clean;
6111da177e4SLinus Torvalds 
6121da177e4SLinus Torvalds 			/* Partially cloned skb? */
6131da177e4SLinus Torvalds 			if (skb_shared(frag))
6143d13008eSEric Dumazet 				goto slow_path_clean;
6152fdba6b0SHerbert Xu 
6162fdba6b0SHerbert Xu 			BUG_ON(frag->sk);
6172fdba6b0SHerbert Xu 			if (skb->sk) {
6182fdba6b0SHerbert Xu 				frag->sk = skb->sk;
6192fdba6b0SHerbert Xu 				frag->destructor = sock_wfree;
6202fdba6b0SHerbert Xu 			}
6213d13008eSEric Dumazet 			skb->truesize -= frag->truesize;
6221da177e4SLinus Torvalds 		}
6231da177e4SLinus Torvalds 
6241da177e4SLinus Torvalds 		err = 0;
6251da177e4SLinus Torvalds 		offset = 0;
6261da177e4SLinus Torvalds 		frag = skb_shinfo(skb)->frag_list;
6274d9092bbSDavid S. Miller 		skb_frag_list_init(skb);
6281da177e4SLinus Torvalds 		/* BUILD HEADER */
6291da177e4SLinus Torvalds 
6309a217a1cSYOSHIFUJI Hideaki 		*prevhdr = NEXTHDR_FRAGMENT;
631d56f90a7SArnaldo Carvalho de Melo 		tmp_hdr = kmemdup(skb_network_header(skb), hlen, GFP_ATOMIC);
6321da177e4SLinus Torvalds 		if (!tmp_hdr) {
633adf30907SEric Dumazet 			IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)),
6343bd653c8SDenis V. Lunev 				      IPSTATS_MIB_FRAGFAILS);
6351da177e4SLinus Torvalds 			return -ENOMEM;
6361da177e4SLinus Torvalds 		}
6371da177e4SLinus Torvalds 
6381da177e4SLinus Torvalds 		__skb_pull(skb, hlen);
6391da177e4SLinus Torvalds 		fh = (struct frag_hdr *)__skb_push(skb, sizeof(struct frag_hdr));
640e2d1bca7SArnaldo Carvalho de Melo 		__skb_push(skb, hlen);
641e2d1bca7SArnaldo Carvalho de Melo 		skb_reset_network_header(skb);
642d56f90a7SArnaldo Carvalho de Melo 		memcpy(skb_network_header(skb), tmp_hdr, hlen);
6431da177e4SLinus Torvalds 
64487c48fa3SEric Dumazet 		ipv6_select_ident(fh, rt);
6451da177e4SLinus Torvalds 		fh->nexthdr = nexthdr;
6461da177e4SLinus Torvalds 		fh->reserved = 0;
6471da177e4SLinus Torvalds 		fh->frag_off = htons(IP6_MF);
6481da177e4SLinus Torvalds 		frag_id = fh->identification;
6491da177e4SLinus Torvalds 
6501da177e4SLinus Torvalds 		first_len = skb_pagelen(skb);
6511da177e4SLinus Torvalds 		skb->data_len = first_len - skb_headlen(skb);
6521da177e4SLinus Torvalds 		skb->len = first_len;
6530660e03fSArnaldo Carvalho de Melo 		ipv6_hdr(skb)->payload_len = htons(first_len -
6540660e03fSArnaldo Carvalho de Melo 						   sizeof(struct ipv6hdr));
6551da177e4SLinus Torvalds 
656d8d1f30bSChangli Gao 		dst_hold(&rt->dst);
6571da177e4SLinus Torvalds 
6581da177e4SLinus Torvalds 		for (;;) {
6591da177e4SLinus Torvalds 			/* Prepare header of the next frame,
6601da177e4SLinus Torvalds 			 * before previous one went down. */
6611da177e4SLinus Torvalds 			if (frag) {
6621da177e4SLinus Torvalds 				frag->ip_summed = CHECKSUM_NONE;
663badff6d0SArnaldo Carvalho de Melo 				skb_reset_transport_header(frag);
6641da177e4SLinus Torvalds 				fh = (struct frag_hdr *)__skb_push(frag, sizeof(struct frag_hdr));
665e2d1bca7SArnaldo Carvalho de Melo 				__skb_push(frag, hlen);
666e2d1bca7SArnaldo Carvalho de Melo 				skb_reset_network_header(frag);
667d56f90a7SArnaldo Carvalho de Melo 				memcpy(skb_network_header(frag), tmp_hdr,
668d56f90a7SArnaldo Carvalho de Melo 				       hlen);
6691da177e4SLinus Torvalds 				offset += skb->len - hlen - sizeof(struct frag_hdr);
6701da177e4SLinus Torvalds 				fh->nexthdr = nexthdr;
6711da177e4SLinus Torvalds 				fh->reserved = 0;
6721da177e4SLinus Torvalds 				fh->frag_off = htons(offset);
6731da177e4SLinus Torvalds 				if (frag->next != NULL)
6741da177e4SLinus Torvalds 					fh->frag_off |= htons(IP6_MF);
6751da177e4SLinus Torvalds 				fh->identification = frag_id;
6760660e03fSArnaldo Carvalho de Melo 				ipv6_hdr(frag)->payload_len =
6770660e03fSArnaldo Carvalho de Melo 						htons(frag->len -
6780660e03fSArnaldo Carvalho de Melo 						      sizeof(struct ipv6hdr));
6791da177e4SLinus Torvalds 				ip6_copy_metadata(frag, skb);
6801da177e4SLinus Torvalds 			}
6811da177e4SLinus Torvalds 
6821da177e4SLinus Torvalds 			err = output(skb);
683dafee490SWei Dong 			if (!err)
684d8d1f30bSChangli Gao 				IP6_INC_STATS(net, ip6_dst_idev(&rt->dst),
6853bd653c8SDenis V. Lunev 					      IPSTATS_MIB_FRAGCREATES);
686dafee490SWei Dong 
6871da177e4SLinus Torvalds 			if (err || !frag)
6881da177e4SLinus Torvalds 				break;
6891da177e4SLinus Torvalds 
6901da177e4SLinus Torvalds 			skb = frag;
6911da177e4SLinus Torvalds 			frag = skb->next;
6921da177e4SLinus Torvalds 			skb->next = NULL;
6931da177e4SLinus Torvalds 		}
6941da177e4SLinus Torvalds 
6951da177e4SLinus Torvalds 		kfree(tmp_hdr);
6961da177e4SLinus Torvalds 
6971da177e4SLinus Torvalds 		if (err == 0) {
698d8d1f30bSChangli Gao 			IP6_INC_STATS(net, ip6_dst_idev(&rt->dst),
6993bd653c8SDenis V. Lunev 				      IPSTATS_MIB_FRAGOKS);
70094e187c0SAmerigo Wang 			ip6_rt_put(rt);
7011da177e4SLinus Torvalds 			return 0;
7021da177e4SLinus Torvalds 		}
7031da177e4SLinus Torvalds 
70446cfd725SFlorian Westphal 		kfree_skb_list(frag);
7051da177e4SLinus Torvalds 
706d8d1f30bSChangli Gao 		IP6_INC_STATS(net, ip6_dst_idev(&rt->dst),
7073bd653c8SDenis V. Lunev 			      IPSTATS_MIB_FRAGFAILS);
70894e187c0SAmerigo Wang 		ip6_rt_put(rt);
7091da177e4SLinus Torvalds 		return err;
7103d13008eSEric Dumazet 
7113d13008eSEric Dumazet slow_path_clean:
7123d13008eSEric Dumazet 		skb_walk_frags(skb, frag2) {
7133d13008eSEric Dumazet 			if (frag2 == frag)
7143d13008eSEric Dumazet 				break;
7153d13008eSEric Dumazet 			frag2->sk = NULL;
7163d13008eSEric Dumazet 			frag2->destructor = NULL;
7173d13008eSEric Dumazet 			skb->truesize += frag2->truesize;
7183d13008eSEric Dumazet 		}
7191da177e4SLinus Torvalds 	}
7201da177e4SLinus Torvalds 
7211da177e4SLinus Torvalds slow_path:
72272e843bbSEric Dumazet 	if ((skb->ip_summed == CHECKSUM_PARTIAL) &&
72372e843bbSEric Dumazet 	    skb_checksum_help(skb))
72472e843bbSEric Dumazet 		goto fail;
72572e843bbSEric Dumazet 
7261da177e4SLinus Torvalds 	left = skb->len - hlen;		/* Space per frame */
7271da177e4SLinus Torvalds 	ptr = hlen;			/* Where to start from */
7281da177e4SLinus Torvalds 
7291da177e4SLinus Torvalds 	/*
7301da177e4SLinus Torvalds 	 *	Fragment the datagram.
7311da177e4SLinus Torvalds 	 */
7321da177e4SLinus Torvalds 
7331da177e4SLinus Torvalds 	*prevhdr = NEXTHDR_FRAGMENT;
734a7ae1992SHerbert Xu 	hroom = LL_RESERVED_SPACE(rt->dst.dev);
735a7ae1992SHerbert Xu 	troom = rt->dst.dev->needed_tailroom;
7361da177e4SLinus Torvalds 
7371da177e4SLinus Torvalds 	/*
7381da177e4SLinus Torvalds 	 *	Keep copying data until we run out.
7391da177e4SLinus Torvalds 	 */
7401da177e4SLinus Torvalds 	while (left > 0)	{
7411da177e4SLinus Torvalds 		len = left;
7421da177e4SLinus Torvalds 		/* IF: it doesn't fit, use 'mtu' - the data space left */
7431da177e4SLinus Torvalds 		if (len > mtu)
7441da177e4SLinus Torvalds 			len = mtu;
7451da177e4SLinus Torvalds 		/* IF: we are not sending up to and including the packet end
7461da177e4SLinus Torvalds 		   then align the next start on an eight byte boundary */
7471da177e4SLinus Torvalds 		if (len < left)	{
7481da177e4SLinus Torvalds 			len &= ~7;
7491da177e4SLinus Torvalds 		}
7501da177e4SLinus Torvalds 
751*cbffccc9SJoe Perches 		/* Allocate buffer */
752*cbffccc9SJoe Perches 		frag = alloc_skb(len + hlen + sizeof(struct frag_hdr) +
753*cbffccc9SJoe Perches 				 hroom + troom, GFP_ATOMIC);
754*cbffccc9SJoe Perches 		if (!frag) {
755adf30907SEric Dumazet 			IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)),
756a11d206dSYOSHIFUJI Hideaki 				      IPSTATS_MIB_FRAGFAILS);
7571da177e4SLinus Torvalds 			err = -ENOMEM;
7581da177e4SLinus Torvalds 			goto fail;
7591da177e4SLinus Torvalds 		}
7601da177e4SLinus Torvalds 
7611da177e4SLinus Torvalds 		/*
7621da177e4SLinus Torvalds 		 *	Set up data on packet
7631da177e4SLinus Torvalds 		 */
7641da177e4SLinus Torvalds 
7651da177e4SLinus Torvalds 		ip6_copy_metadata(frag, skb);
766a7ae1992SHerbert Xu 		skb_reserve(frag, hroom);
7671da177e4SLinus Torvalds 		skb_put(frag, len + hlen + sizeof(struct frag_hdr));
768c1d2bbe1SArnaldo Carvalho de Melo 		skb_reset_network_header(frag);
769badff6d0SArnaldo Carvalho de Melo 		fh = (struct frag_hdr *)(skb_network_header(frag) + hlen);
770b0e380b1SArnaldo Carvalho de Melo 		frag->transport_header = (frag->network_header + hlen +
771b0e380b1SArnaldo Carvalho de Melo 					  sizeof(struct frag_hdr));
7721da177e4SLinus Torvalds 
7731da177e4SLinus Torvalds 		/*
7741da177e4SLinus Torvalds 		 *	Charge the memory for the fragment to any owner
7751da177e4SLinus Torvalds 		 *	it might possess
7761da177e4SLinus Torvalds 		 */
7771da177e4SLinus Torvalds 		if (skb->sk)
7781da177e4SLinus Torvalds 			skb_set_owner_w(frag, skb->sk);
7791da177e4SLinus Torvalds 
7801da177e4SLinus Torvalds 		/*
7811da177e4SLinus Torvalds 		 *	Copy the packet header into the new buffer.
7821da177e4SLinus Torvalds 		 */
783d626f62bSArnaldo Carvalho de Melo 		skb_copy_from_linear_data(skb, skb_network_header(frag), hlen);
7841da177e4SLinus Torvalds 
7851da177e4SLinus Torvalds 		/*
7861da177e4SLinus Torvalds 		 *	Build fragment header.
7871da177e4SLinus Torvalds 		 */
7881da177e4SLinus Torvalds 		fh->nexthdr = nexthdr;
7891da177e4SLinus Torvalds 		fh->reserved = 0;
790f36d6ab1SYan Zheng 		if (!frag_id) {
79187c48fa3SEric Dumazet 			ipv6_select_ident(fh, rt);
7921da177e4SLinus Torvalds 			frag_id = fh->identification;
7931da177e4SLinus Torvalds 		} else
7941da177e4SLinus Torvalds 			fh->identification = frag_id;
7951da177e4SLinus Torvalds 
7961da177e4SLinus Torvalds 		/*
7971da177e4SLinus Torvalds 		 *	Copy a block of the IP datagram.
7981da177e4SLinus Torvalds 		 */
799e3f0b86bSHimangi Saraogi 		BUG_ON(skb_copy_bits(skb, ptr, skb_transport_header(frag),
800e3f0b86bSHimangi Saraogi 				     len));
8011da177e4SLinus Torvalds 		left -= len;
8021da177e4SLinus Torvalds 
8031da177e4SLinus Torvalds 		fh->frag_off = htons(offset);
8041da177e4SLinus Torvalds 		if (left > 0)
8051da177e4SLinus Torvalds 			fh->frag_off |= htons(IP6_MF);
8060660e03fSArnaldo Carvalho de Melo 		ipv6_hdr(frag)->payload_len = htons(frag->len -
8070660e03fSArnaldo Carvalho de Melo 						    sizeof(struct ipv6hdr));
8081da177e4SLinus Torvalds 
8091da177e4SLinus Torvalds 		ptr += len;
8101da177e4SLinus Torvalds 		offset += len;
8111da177e4SLinus Torvalds 
8121da177e4SLinus Torvalds 		/*
8131da177e4SLinus Torvalds 		 *	Put this fragment into the sending queue.
8141da177e4SLinus Torvalds 		 */
8151da177e4SLinus Torvalds 		err = output(frag);
8161da177e4SLinus Torvalds 		if (err)
8171da177e4SLinus Torvalds 			goto fail;
818dafee490SWei Dong 
819adf30907SEric Dumazet 		IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)),
8203bd653c8SDenis V. Lunev 			      IPSTATS_MIB_FRAGCREATES);
8211da177e4SLinus Torvalds 	}
822adf30907SEric Dumazet 	IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)),
823a11d206dSYOSHIFUJI Hideaki 		      IPSTATS_MIB_FRAGOKS);
824808db80aSEric Dumazet 	consume_skb(skb);
8251da177e4SLinus Torvalds 	return err;
8261da177e4SLinus Torvalds 
8271da177e4SLinus Torvalds fail:
828adf30907SEric Dumazet 	IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)),
829a11d206dSYOSHIFUJI Hideaki 		      IPSTATS_MIB_FRAGFAILS);
8301da177e4SLinus Torvalds 	kfree_skb(skb);
8311da177e4SLinus Torvalds 	return err;
8321da177e4SLinus Torvalds }
8331da177e4SLinus Torvalds 
834b71d1d42SEric Dumazet static inline int ip6_rt_check(const struct rt6key *rt_key,
835b71d1d42SEric Dumazet 			       const struct in6_addr *fl_addr,
836b71d1d42SEric Dumazet 			       const struct in6_addr *addr_cache)
837cf6b1982SYOSHIFUJI Hideaki {
838a02cec21SEric Dumazet 	return (rt_key->plen != 128 || !ipv6_addr_equal(fl_addr, &rt_key->addr)) &&
839a02cec21SEric Dumazet 		(addr_cache == NULL || !ipv6_addr_equal(fl_addr, addr_cache));
840cf6b1982SYOSHIFUJI Hideaki }
841cf6b1982SYOSHIFUJI Hideaki 
842497c615aSHerbert Xu static struct dst_entry *ip6_sk_dst_check(struct sock *sk,
843497c615aSHerbert Xu 					  struct dst_entry *dst,
844b71d1d42SEric Dumazet 					  const struct flowi6 *fl6)
8451da177e4SLinus Torvalds {
8461da177e4SLinus Torvalds 	struct ipv6_pinfo *np = inet6_sk(sk);
847a963a37dSEric Dumazet 	struct rt6_info *rt;
8481da177e4SLinus Torvalds 
849497c615aSHerbert Xu 	if (!dst)
850497c615aSHerbert Xu 		goto out;
8511da177e4SLinus Torvalds 
852a963a37dSEric Dumazet 	if (dst->ops->family != AF_INET6) {
853a963a37dSEric Dumazet 		dst_release(dst);
854a963a37dSEric Dumazet 		return NULL;
855a963a37dSEric Dumazet 	}
856a963a37dSEric Dumazet 
857a963a37dSEric Dumazet 	rt = (struct rt6_info *)dst;
8581da177e4SLinus Torvalds 	/* Yes, checking route validity in not connected
859d76e60a5SDavid S. Miller 	 * case is not very simple. Take into account,
860d76e60a5SDavid S. Miller 	 * that we do not support routing by source, TOS,
861d76e60a5SDavid S. Miller 	 * and MSG_DONTROUTE		--ANK (980726)
862d76e60a5SDavid S. Miller 	 *
863cf6b1982SYOSHIFUJI Hideaki 	 * 1. ip6_rt_check(): If route was host route,
864cf6b1982SYOSHIFUJI Hideaki 	 *    check that cached destination is current.
865d76e60a5SDavid S. Miller 	 *    If it is network route, we still may
866d76e60a5SDavid S. Miller 	 *    check its validity using saved pointer
867d76e60a5SDavid S. Miller 	 *    to the last used address: daddr_cache.
868d76e60a5SDavid S. Miller 	 *    We do not want to save whole address now,
869d76e60a5SDavid S. Miller 	 *    (because main consumer of this service
870d76e60a5SDavid S. Miller 	 *    is tcp, which has not this problem),
871d76e60a5SDavid S. Miller 	 *    so that the last trick works only on connected
872d76e60a5SDavid S. Miller 	 *    sockets.
873d76e60a5SDavid S. Miller 	 * 2. oif also should be the same.
8741da177e4SLinus Torvalds 	 */
8754c9483b2SDavid S. Miller 	if (ip6_rt_check(&rt->rt6i_dst, &fl6->daddr, np->daddr_cache) ||
8768e1ef0a9SYOSHIFUJI Hideaki #ifdef CONFIG_IPV6_SUBTREES
8774c9483b2SDavid S. Miller 	    ip6_rt_check(&rt->rt6i_src, &fl6->saddr, np->saddr_cache) ||
8788e1ef0a9SYOSHIFUJI Hideaki #endif
8794c9483b2SDavid S. Miller 	    (fl6->flowi6_oif && fl6->flowi6_oif != dst->dev->ifindex)) {
880497c615aSHerbert Xu 		dst_release(dst);
881497c615aSHerbert Xu 		dst = NULL;
8821da177e4SLinus Torvalds 	}
883497c615aSHerbert Xu 
884497c615aSHerbert Xu out:
885497c615aSHerbert Xu 	return dst;
8861da177e4SLinus Torvalds }
887497c615aSHerbert Xu 
888497c615aSHerbert Xu static int ip6_dst_lookup_tail(struct sock *sk,
8894c9483b2SDavid S. Miller 			       struct dst_entry **dst, struct flowi6 *fl6)
890497c615aSHerbert Xu {
8913b1e0a65SYOSHIFUJI Hideaki 	struct net *net = sock_net(sk);
89269cce1d1SDavid S. Miller #ifdef CONFIG_IPV6_OPTIMISTIC_DAD
89369cce1d1SDavid S. Miller 	struct neighbour *n;
89497cac082SDavid S. Miller 	struct rt6_info *rt;
89569cce1d1SDavid S. Miller #endif
89669cce1d1SDavid S. Miller 	int err;
8971da177e4SLinus Torvalds 
8981da177e4SLinus Torvalds 	if (*dst == NULL)
8994c9483b2SDavid S. Miller 		*dst = ip6_route_output(net, sk, fl6);
9001da177e4SLinus Torvalds 
9011da177e4SLinus Torvalds 	if ((err = (*dst)->error))
9021da177e4SLinus Torvalds 		goto out_err_release;
9031da177e4SLinus Torvalds 
9044c9483b2SDavid S. Miller 	if (ipv6_addr_any(&fl6->saddr)) {
905c3968a85SDaniel Walter 		struct rt6_info *rt = (struct rt6_info *) *dst;
906c3968a85SDaniel Walter 		err = ip6_route_get_saddr(net, rt, &fl6->daddr,
9077cbca67cSYOSHIFUJI Hideaki 					  sk ? inet6_sk(sk)->srcprefs : 0,
9084c9483b2SDavid S. Miller 					  &fl6->saddr);
90944456d37SOlaf Hering 		if (err)
9101da177e4SLinus Torvalds 			goto out_err_release;
9111da177e4SLinus Torvalds 	}
9121da177e4SLinus Torvalds 
91395c385b4SNeil Horman #ifdef CONFIG_IPV6_OPTIMISTIC_DAD
91495c385b4SNeil Horman 	/*
91595c385b4SNeil Horman 	 * Here if the dst entry we've looked up
91695c385b4SNeil Horman 	 * has a neighbour entry that is in the INCOMPLETE
91795c385b4SNeil Horman 	 * state and the src address from the flow is
91895c385b4SNeil Horman 	 * marked as OPTIMISTIC, we release the found
91995c385b4SNeil Horman 	 * dst entry and replace it instead with the
92095c385b4SNeil Horman 	 * dst entry of the nexthop router
92195c385b4SNeil Horman 	 */
922c56bf6feSEric Dumazet 	rt = (struct rt6_info *) *dst;
923707be1ffSYOSHIFUJI Hideaki / 吉藤英明 	rcu_read_lock_bh();
924550bab42SJulian Anastasov 	n = __ipv6_neigh_lookup_noref(rt->dst.dev, rt6_nexthop(rt));
925707be1ffSYOSHIFUJI Hideaki / 吉藤英明 	err = n && !(n->nud_state & NUD_VALID) ? -EINVAL : 0;
926707be1ffSYOSHIFUJI Hideaki / 吉藤英明 	rcu_read_unlock_bh();
927707be1ffSYOSHIFUJI Hideaki / 吉藤英明 
928707be1ffSYOSHIFUJI Hideaki / 吉藤英明 	if (err) {
92995c385b4SNeil Horman 		struct inet6_ifaddr *ifp;
9304c9483b2SDavid S. Miller 		struct flowi6 fl_gw6;
93195c385b4SNeil Horman 		int redirect;
93295c385b4SNeil Horman 
9334c9483b2SDavid S. Miller 		ifp = ipv6_get_ifaddr(net, &fl6->saddr,
9341cab3da6SDaniel Lezcano 				      (*dst)->dev, 1);
93595c385b4SNeil Horman 
93695c385b4SNeil Horman 		redirect = (ifp && ifp->flags & IFA_F_OPTIMISTIC);
93795c385b4SNeil Horman 		if (ifp)
93895c385b4SNeil Horman 			in6_ifa_put(ifp);
93995c385b4SNeil Horman 
94095c385b4SNeil Horman 		if (redirect) {
94195c385b4SNeil Horman 			/*
94295c385b4SNeil Horman 			 * We need to get the dst entry for the
94395c385b4SNeil Horman 			 * default router instead
94495c385b4SNeil Horman 			 */
94595c385b4SNeil Horman 			dst_release(*dst);
9464c9483b2SDavid S. Miller 			memcpy(&fl_gw6, fl6, sizeof(struct flowi6));
9474c9483b2SDavid S. Miller 			memset(&fl_gw6.daddr, 0, sizeof(struct in6_addr));
9484c9483b2SDavid S. Miller 			*dst = ip6_route_output(net, sk, &fl_gw6);
94995c385b4SNeil Horman 			if ((err = (*dst)->error))
95095c385b4SNeil Horman 				goto out_err_release;
95195c385b4SNeil Horman 		}
95295c385b4SNeil Horman 	}
95395c385b4SNeil Horman #endif
95495c385b4SNeil Horman 
9551da177e4SLinus Torvalds 	return 0;
9561da177e4SLinus Torvalds 
9571da177e4SLinus Torvalds out_err_release:
958ca46f9c8SMitsuru Chinen 	if (err == -ENETUNREACH)
9595ac68e7cSJohn Stultz 		IP6_INC_STATS(net, NULL, IPSTATS_MIB_OUTNOROUTES);
9601da177e4SLinus Torvalds 	dst_release(*dst);
9611da177e4SLinus Torvalds 	*dst = NULL;
9621da177e4SLinus Torvalds 	return err;
9631da177e4SLinus Torvalds }
96434a0b3cdSAdrian Bunk 
965497c615aSHerbert Xu /**
966497c615aSHerbert Xu  *	ip6_dst_lookup - perform route lookup on flow
967497c615aSHerbert Xu  *	@sk: socket which provides route info
968497c615aSHerbert Xu  *	@dst: pointer to dst_entry * for result
9694c9483b2SDavid S. Miller  *	@fl6: flow to lookup
970497c615aSHerbert Xu  *
971497c615aSHerbert Xu  *	This function performs a route lookup on the given flow.
972497c615aSHerbert Xu  *
973497c615aSHerbert Xu  *	It returns zero on success, or a standard errno code on error.
974497c615aSHerbert Xu  */
9754c9483b2SDavid S. Miller int ip6_dst_lookup(struct sock *sk, struct dst_entry **dst, struct flowi6 *fl6)
976497c615aSHerbert Xu {
977497c615aSHerbert Xu 	*dst = NULL;
9784c9483b2SDavid S. Miller 	return ip6_dst_lookup_tail(sk, dst, fl6);
979497c615aSHerbert Xu }
9803cf3dc6cSArnaldo Carvalho de Melo EXPORT_SYMBOL_GPL(ip6_dst_lookup);
9813cf3dc6cSArnaldo Carvalho de Melo 
982497c615aSHerbert Xu /**
98368d0c6d3SDavid S. Miller  *	ip6_dst_lookup_flow - perform route lookup on flow with ipsec
98468d0c6d3SDavid S. Miller  *	@sk: socket which provides route info
9854c9483b2SDavid S. Miller  *	@fl6: flow to lookup
98668d0c6d3SDavid S. Miller  *	@final_dst: final destination address for ipsec lookup
98768d0c6d3SDavid S. Miller  *
98868d0c6d3SDavid S. Miller  *	This function performs a route lookup on the given flow.
98968d0c6d3SDavid S. Miller  *
99068d0c6d3SDavid S. Miller  *	It returns a valid dst pointer on success, or a pointer encoded
99168d0c6d3SDavid S. Miller  *	error code.
99268d0c6d3SDavid S. Miller  */
9934c9483b2SDavid S. Miller struct dst_entry *ip6_dst_lookup_flow(struct sock *sk, struct flowi6 *fl6,
9940e0d44abSSteffen Klassert 				      const struct in6_addr *final_dst)
99568d0c6d3SDavid S. Miller {
99668d0c6d3SDavid S. Miller 	struct dst_entry *dst = NULL;
99768d0c6d3SDavid S. Miller 	int err;
99868d0c6d3SDavid S. Miller 
9994c9483b2SDavid S. Miller 	err = ip6_dst_lookup_tail(sk, &dst, fl6);
100068d0c6d3SDavid S. Miller 	if (err)
100168d0c6d3SDavid S. Miller 		return ERR_PTR(err);
100268d0c6d3SDavid S. Miller 	if (final_dst)
10034e3fd7a0SAlexey Dobriyan 		fl6->daddr = *final_dst;
10042774c131SDavid S. Miller 
1005f92ee619SSteffen Klassert 	return xfrm_lookup_route(sock_net(sk), dst, flowi6_to_flowi(fl6), sk, 0);
100668d0c6d3SDavid S. Miller }
100768d0c6d3SDavid S. Miller EXPORT_SYMBOL_GPL(ip6_dst_lookup_flow);
100868d0c6d3SDavid S. Miller 
100968d0c6d3SDavid S. Miller /**
101068d0c6d3SDavid S. Miller  *	ip6_sk_dst_lookup_flow - perform socket cached route lookup on flow
101168d0c6d3SDavid S. Miller  *	@sk: socket which provides the dst cache and route info
10124c9483b2SDavid S. Miller  *	@fl6: flow to lookup
101368d0c6d3SDavid S. Miller  *	@final_dst: final destination address for ipsec lookup
1014497c615aSHerbert Xu  *
1015497c615aSHerbert Xu  *	This function performs a route lookup on the given flow with the
1016497c615aSHerbert Xu  *	possibility of using the cached route in the socket if it is valid.
1017497c615aSHerbert Xu  *	It will take the socket dst lock when operating on the dst cache.
1018497c615aSHerbert Xu  *	As a result, this function can only be used in process context.
1019497c615aSHerbert Xu  *
102068d0c6d3SDavid S. Miller  *	It returns a valid dst pointer on success, or a pointer encoded
102168d0c6d3SDavid S. Miller  *	error code.
1022497c615aSHerbert Xu  */
10234c9483b2SDavid S. Miller struct dst_entry *ip6_sk_dst_lookup_flow(struct sock *sk, struct flowi6 *fl6,
10240e0d44abSSteffen Klassert 					 const struct in6_addr *final_dst)
1025497c615aSHerbert Xu {
102668d0c6d3SDavid S. Miller 	struct dst_entry *dst = sk_dst_check(sk, inet6_sk(sk)->dst_cookie);
102768d0c6d3SDavid S. Miller 	int err;
1028497c615aSHerbert Xu 
10294c9483b2SDavid S. Miller 	dst = ip6_sk_dst_check(sk, dst, fl6);
103068d0c6d3SDavid S. Miller 
10314c9483b2SDavid S. Miller 	err = ip6_dst_lookup_tail(sk, &dst, fl6);
103268d0c6d3SDavid S. Miller 	if (err)
103368d0c6d3SDavid S. Miller 		return ERR_PTR(err);
103468d0c6d3SDavid S. Miller 	if (final_dst)
10354e3fd7a0SAlexey Dobriyan 		fl6->daddr = *final_dst;
10362774c131SDavid S. Miller 
1037f92ee619SSteffen Klassert 	return xfrm_lookup_route(sock_net(sk), dst, flowi6_to_flowi(fl6), sk, 0);
103868d0c6d3SDavid S. Miller }
103968d0c6d3SDavid S. Miller EXPORT_SYMBOL_GPL(ip6_sk_dst_lookup_flow);
1040497c615aSHerbert Xu 
104134a0b3cdSAdrian Bunk static inline int ip6_ufo_append_data(struct sock *sk,
1042e89e9cf5SAnanda Raju 			int getfrag(void *from, char *to, int offset, int len,
1043e89e9cf5SAnanda Raju 			int odd, struct sk_buff *skb),
1044e89e9cf5SAnanda Raju 			void *from, int length, int hh_len, int fragheaderlen,
104587c48fa3SEric Dumazet 			int transhdrlen, int mtu, unsigned int flags,
104687c48fa3SEric Dumazet 			struct rt6_info *rt)
1047e89e9cf5SAnanda Raju 
1048e89e9cf5SAnanda Raju {
1049e89e9cf5SAnanda Raju 	struct sk_buff *skb;
1050c547dbf5SJiri Pirko 	struct frag_hdr fhdr;
1051e89e9cf5SAnanda Raju 	int err;
1052e89e9cf5SAnanda Raju 
1053e89e9cf5SAnanda Raju 	/* There is support for UDP large send offload by network
1054e89e9cf5SAnanda Raju 	 * device, so create one single skb packet containing complete
1055e89e9cf5SAnanda Raju 	 * udp datagram
1056e89e9cf5SAnanda Raju 	 */
1057e89e9cf5SAnanda Raju 	if ((skb = skb_peek_tail(&sk->sk_write_queue)) == NULL) {
1058e89e9cf5SAnanda Raju 		skb = sock_alloc_send_skb(sk,
1059e89e9cf5SAnanda Raju 			hh_len + fragheaderlen + transhdrlen + 20,
1060e89e9cf5SAnanda Raju 			(flags & MSG_DONTWAIT), &err);
1061e89e9cf5SAnanda Raju 		if (skb == NULL)
1062504744e4SZheng Yan 			return err;
1063e89e9cf5SAnanda Raju 
1064e89e9cf5SAnanda Raju 		/* reserve space for Hardware header */
1065e89e9cf5SAnanda Raju 		skb_reserve(skb, hh_len);
1066e89e9cf5SAnanda Raju 
1067e89e9cf5SAnanda Raju 		/* create space for UDP/IP header */
1068e89e9cf5SAnanda Raju 		skb_put(skb, fragheaderlen + transhdrlen);
1069e89e9cf5SAnanda Raju 
1070e89e9cf5SAnanda Raju 		/* initialize network header pointer */
1071c1d2bbe1SArnaldo Carvalho de Melo 		skb_reset_network_header(skb);
1072e89e9cf5SAnanda Raju 
1073e89e9cf5SAnanda Raju 		/* initialize protocol header pointer */
1074b0e380b1SArnaldo Carvalho de Melo 		skb->transport_header = skb->network_header + fragheaderlen;
1075e89e9cf5SAnanda Raju 
10769c9c9ad5SHannes Frederic Sowa 		skb->protocol = htons(ETH_P_IPV6);
1077e89e9cf5SAnanda Raju 		skb->csum = 0;
1078e89e9cf5SAnanda Raju 
1079c547dbf5SJiri Pirko 		__skb_queue_tail(&sk->sk_write_queue, skb);
1080c547dbf5SJiri Pirko 	} else if (skb_is_gso(skb)) {
1081c547dbf5SJiri Pirko 		goto append;
1082c547dbf5SJiri Pirko 	}
1083c547dbf5SJiri Pirko 
1084c547dbf5SJiri Pirko 	skb->ip_summed = CHECKSUM_PARTIAL;
1085c31d5326SSridhar Samudrala 	/* Specify the length of each IPv6 datagram fragment.
1086c31d5326SSridhar Samudrala 	 * It has to be a multiple of 8.
1087c31d5326SSridhar Samudrala 	 */
1088c31d5326SSridhar Samudrala 	skb_shinfo(skb)->gso_size = (mtu - fragheaderlen -
1089c31d5326SSridhar Samudrala 				     sizeof(struct frag_hdr)) & ~7;
1090f83ef8c0SHerbert Xu 	skb_shinfo(skb)->gso_type = SKB_GSO_UDP;
109187c48fa3SEric Dumazet 	ipv6_select_ident(&fhdr, rt);
1092e89e9cf5SAnanda Raju 	skb_shinfo(skb)->ip6_frag_id = fhdr.identification;
1093e89e9cf5SAnanda Raju 
1094c547dbf5SJiri Pirko append:
10952811ebacSHannes Frederic Sowa 	return skb_append_datato_frags(sk, skb, getfrag, from,
10962811ebacSHannes Frederic Sowa 				       (length - transhdrlen));
1097e89e9cf5SAnanda Raju }
10981da177e4SLinus Torvalds 
10990178b695SHerbert Xu static inline struct ipv6_opt_hdr *ip6_opt_dup(struct ipv6_opt_hdr *src,
11000178b695SHerbert Xu 					       gfp_t gfp)
11010178b695SHerbert Xu {
11020178b695SHerbert Xu 	return src ? kmemdup(src, (src->hdrlen + 1) * 8, gfp) : NULL;
11030178b695SHerbert Xu }
11040178b695SHerbert Xu 
11050178b695SHerbert Xu static inline struct ipv6_rt_hdr *ip6_rthdr_dup(struct ipv6_rt_hdr *src,
11060178b695SHerbert Xu 						gfp_t gfp)
11070178b695SHerbert Xu {
11080178b695SHerbert Xu 	return src ? kmemdup(src, (src->hdrlen + 1) * 8, gfp) : NULL;
11090178b695SHerbert Xu }
11100178b695SHerbert Xu 
111175a493e6SHannes Frederic Sowa static void ip6_append_data_mtu(unsigned int *mtu,
11120c183379SGao feng 				int *maxfraglen,
11130c183379SGao feng 				unsigned int fragheaderlen,
11140c183379SGao feng 				struct sk_buff *skb,
111575a493e6SHannes Frederic Sowa 				struct rt6_info *rt,
1116e367c2d0Slucien 				unsigned int orig_mtu)
11170c183379SGao feng {
11180c183379SGao feng 	if (!(rt->dst.flags & DST_XFRM_TUNNEL)) {
11190c183379SGao feng 		if (skb == NULL) {
11200c183379SGao feng 			/* first fragment, reserve header_len */
1121e367c2d0Slucien 			*mtu = orig_mtu - rt->dst.header_len;
11220c183379SGao feng 
11230c183379SGao feng 		} else {
11240c183379SGao feng 			/*
11250c183379SGao feng 			 * this fragment is not first, the headers
11260c183379SGao feng 			 * space is regarded as data space.
11270c183379SGao feng 			 */
1128e367c2d0Slucien 			*mtu = orig_mtu;
11290c183379SGao feng 		}
11300c183379SGao feng 		*maxfraglen = ((*mtu - fragheaderlen) & ~7)
11310c183379SGao feng 			      + fragheaderlen - sizeof(struct frag_hdr);
11320c183379SGao feng 	}
11330c183379SGao feng }
11340c183379SGao feng 
113541a1f8eaSYOSHIFUJI Hideaki int ip6_append_data(struct sock *sk, int getfrag(void *from, char *to,
113641a1f8eaSYOSHIFUJI Hideaki 	int offset, int len, int odd, struct sk_buff *skb),
11371da177e4SLinus Torvalds 	void *from, int length, int transhdrlen,
11384c9483b2SDavid S. Miller 	int hlimit, int tclass, struct ipv6_txoptions *opt, struct flowi6 *fl6,
113913b52cd4SBrian Haley 	struct rt6_info *rt, unsigned int flags, int dontfrag)
11401da177e4SLinus Torvalds {
11411da177e4SLinus Torvalds 	struct inet_sock *inet = inet_sk(sk);
11421da177e4SLinus Torvalds 	struct ipv6_pinfo *np = inet6_sk(sk);
1143bdc712b4SDavid S. Miller 	struct inet_cork *cork;
11440c183379SGao feng 	struct sk_buff *skb, *skb_prev = NULL;
1145e367c2d0Slucien 	unsigned int maxfraglen, fragheaderlen, mtu, orig_mtu;
11461da177e4SLinus Torvalds 	int exthdrlen;
1147299b0767SSteffen Klassert 	int dst_exthdrlen;
11481da177e4SLinus Torvalds 	int hh_len;
11491da177e4SLinus Torvalds 	int copy;
11501da177e4SLinus Torvalds 	int err;
11511da177e4SLinus Torvalds 	int offset = 0;
1152a693e698SAnders Berggren 	__u8 tx_flags = 0;
115309c2d251SWillem de Bruijn 	u32 tskey = 0;
11541da177e4SLinus Torvalds 
11551da177e4SLinus Torvalds 	if (flags&MSG_PROBE)
11561da177e4SLinus Torvalds 		return 0;
1157bdc712b4SDavid S. Miller 	cork = &inet->cork.base;
11581da177e4SLinus Torvalds 	if (skb_queue_empty(&sk->sk_write_queue)) {
11591da177e4SLinus Torvalds 		/*
11601da177e4SLinus Torvalds 		 * setup for corking
11611da177e4SLinus Torvalds 		 */
11621da177e4SLinus Torvalds 		if (opt) {
11630178b695SHerbert Xu 			if (WARN_ON(np->cork.opt))
11640178b695SHerbert Xu 				return -EINVAL;
11650178b695SHerbert Xu 
1166284041efSEric Dumazet 			np->cork.opt = kzalloc(opt->tot_len, sk->sk_allocation);
11671da177e4SLinus Torvalds 			if (unlikely(np->cork.opt == NULL))
11681da177e4SLinus Torvalds 				return -ENOBUFS;
11690178b695SHerbert Xu 
11700178b695SHerbert Xu 			np->cork.opt->tot_len = opt->tot_len;
11710178b695SHerbert Xu 			np->cork.opt->opt_flen = opt->opt_flen;
11720178b695SHerbert Xu 			np->cork.opt->opt_nflen = opt->opt_nflen;
11730178b695SHerbert Xu 
11740178b695SHerbert Xu 			np->cork.opt->dst0opt = ip6_opt_dup(opt->dst0opt,
11750178b695SHerbert Xu 							    sk->sk_allocation);
11760178b695SHerbert Xu 			if (opt->dst0opt && !np->cork.opt->dst0opt)
11770178b695SHerbert Xu 				return -ENOBUFS;
11780178b695SHerbert Xu 
11790178b695SHerbert Xu 			np->cork.opt->dst1opt = ip6_opt_dup(opt->dst1opt,
11800178b695SHerbert Xu 							    sk->sk_allocation);
11810178b695SHerbert Xu 			if (opt->dst1opt && !np->cork.opt->dst1opt)
11820178b695SHerbert Xu 				return -ENOBUFS;
11830178b695SHerbert Xu 
11840178b695SHerbert Xu 			np->cork.opt->hopopt = ip6_opt_dup(opt->hopopt,
11850178b695SHerbert Xu 							   sk->sk_allocation);
11860178b695SHerbert Xu 			if (opt->hopopt && !np->cork.opt->hopopt)
11870178b695SHerbert Xu 				return -ENOBUFS;
11880178b695SHerbert Xu 
11890178b695SHerbert Xu 			np->cork.opt->srcrt = ip6_rthdr_dup(opt->srcrt,
11900178b695SHerbert Xu 							    sk->sk_allocation);
11910178b695SHerbert Xu 			if (opt->srcrt && !np->cork.opt->srcrt)
11920178b695SHerbert Xu 				return -ENOBUFS;
11930178b695SHerbert Xu 
11941da177e4SLinus Torvalds 			/* need source address above miyazawa*/
11951da177e4SLinus Torvalds 		}
1196d8d1f30bSChangli Gao 		dst_hold(&rt->dst);
1197bdc712b4SDavid S. Miller 		cork->dst = &rt->dst;
11984c9483b2SDavid S. Miller 		inet->cork.fl.u.ip6 = *fl6;
11991da177e4SLinus Torvalds 		np->cork.hop_limit = hlimit;
120041a1f8eaSYOSHIFUJI Hideaki 		np->cork.tclass = tclass;
12010c183379SGao feng 		if (rt->dst.flags & DST_XFRM_TUNNEL)
120293b36cf3SHannes Frederic Sowa 			mtu = np->pmtudisc >= IPV6_PMTUDISC_PROBE ?
1203299b0767SSteffen Klassert 			      rt->dst.dev->mtu : dst_mtu(&rt->dst);
12040c183379SGao feng 		else
120593b36cf3SHannes Frederic Sowa 			mtu = np->pmtudisc >= IPV6_PMTUDISC_PROBE ?
12060c183379SGao feng 			      rt->dst.dev->mtu : dst_mtu(rt->dst.path);
1207c7503609SDave Jones 		if (np->frag_size < mtu) {
1208d91675f9SYOSHIFUJI Hideaki 			if (np->frag_size)
1209d91675f9SYOSHIFUJI Hideaki 				mtu = np->frag_size;
1210d91675f9SYOSHIFUJI Hideaki 		}
1211bdc712b4SDavid S. Miller 		cork->fragsize = mtu;
1212d8d1f30bSChangli Gao 		if (dst_allfrag(rt->dst.path))
1213bdc712b4SDavid S. Miller 			cork->flags |= IPCORK_ALLFRAG;
1214bdc712b4SDavid S. Miller 		cork->length = 0;
12157efdba5bSRomain KUNTZ 		exthdrlen = (opt ? opt->opt_flen : 0);
12161da177e4SLinus Torvalds 		length += exthdrlen;
12171da177e4SLinus Torvalds 		transhdrlen += exthdrlen;
12187efdba5bSRomain KUNTZ 		dst_exthdrlen = rt->dst.header_len - rt->rt6i_nfheader_len;
12191da177e4SLinus Torvalds 	} else {
1220bdc712b4SDavid S. Miller 		rt = (struct rt6_info *)cork->dst;
12214c9483b2SDavid S. Miller 		fl6 = &inet->cork.fl.u.ip6;
12221da177e4SLinus Torvalds 		opt = np->cork.opt;
12231da177e4SLinus Torvalds 		transhdrlen = 0;
12241da177e4SLinus Torvalds 		exthdrlen = 0;
1225299b0767SSteffen Klassert 		dst_exthdrlen = 0;
1226bdc712b4SDavid S. Miller 		mtu = cork->fragsize;
12271da177e4SLinus Torvalds 	}
1228e367c2d0Slucien 	orig_mtu = mtu;
12291da177e4SLinus Torvalds 
1230d8d1f30bSChangli Gao 	hh_len = LL_RESERVED_SPACE(rt->dst.dev);
12311da177e4SLinus Torvalds 
1232a1b05140SMasahide NAKAMURA 	fragheaderlen = sizeof(struct ipv6hdr) + rt->rt6i_nfheader_len +
1233b4ce9277SHerbert Xu 			(opt ? opt->opt_nflen : 0);
12344df98e76SHannes Frederic Sowa 	maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen -
12354df98e76SHannes Frederic Sowa 		     sizeof(struct frag_hdr);
12361da177e4SLinus Torvalds 
12371da177e4SLinus Torvalds 	if (mtu <= sizeof(struct ipv6hdr) + IPV6_MAXPLEN) {
12384df98e76SHannes Frederic Sowa 		unsigned int maxnonfragsize, headersize;
12394df98e76SHannes Frederic Sowa 
12404df98e76SHannes Frederic Sowa 		headersize = sizeof(struct ipv6hdr) +
12413a1cebe7SHannes Frederic Sowa 			     (opt ? opt->opt_flen + opt->opt_nflen : 0) +
12424df98e76SHannes Frederic Sowa 			     (dst_allfrag(&rt->dst) ?
12434df98e76SHannes Frederic Sowa 			      sizeof(struct frag_hdr) : 0) +
12444df98e76SHannes Frederic Sowa 			     rt->rt6i_nfheader_len;
12454df98e76SHannes Frederic Sowa 
124660ff7467SWANG Cong 		if (ip6_sk_ignore_df(sk))
12470b95227aSHannes Frederic Sowa 			maxnonfragsize = sizeof(struct ipv6hdr) + IPV6_MAXPLEN;
12480b95227aSHannes Frederic Sowa 		else
12490b95227aSHannes Frederic Sowa 			maxnonfragsize = mtu;
12504df98e76SHannes Frederic Sowa 
12514df98e76SHannes Frederic Sowa 		/* dontfrag active */
12524df98e76SHannes Frederic Sowa 		if ((cork->length + length > mtu - headersize) && dontfrag &&
12534df98e76SHannes Frederic Sowa 		    (sk->sk_protocol == IPPROTO_UDP ||
12544df98e76SHannes Frederic Sowa 		     sk->sk_protocol == IPPROTO_RAW)) {
12554df98e76SHannes Frederic Sowa 			ipv6_local_rxpmtu(sk, fl6, mtu - headersize +
12564df98e76SHannes Frederic Sowa 						   sizeof(struct ipv6hdr));
12574df98e76SHannes Frederic Sowa 			goto emsgsize;
12584df98e76SHannes Frederic Sowa 		}
12594df98e76SHannes Frederic Sowa 
12604df98e76SHannes Frederic Sowa 		if (cork->length + length > maxnonfragsize - headersize) {
12614df98e76SHannes Frederic Sowa emsgsize:
12624df98e76SHannes Frederic Sowa 			ipv6_local_error(sk, EMSGSIZE, fl6,
12634df98e76SHannes Frederic Sowa 					 mtu - headersize +
12644df98e76SHannes Frederic Sowa 					 sizeof(struct ipv6hdr));
12651da177e4SLinus Torvalds 			return -EMSGSIZE;
12661da177e4SLinus Torvalds 		}
12671da177e4SLinus Torvalds 	}
12681da177e4SLinus Torvalds 
126909c2d251SWillem de Bruijn 	if (sk->sk_type == SOCK_DGRAM || sk->sk_type == SOCK_RAW) {
1270bf84a010SDaniel Borkmann 		sock_tx_timestamp(sk, &tx_flags);
127109c2d251SWillem de Bruijn 		if (tx_flags & SKBTX_ANY_SW_TSTAMP &&
127209c2d251SWillem de Bruijn 		    sk->sk_tsflags & SOF_TIMESTAMPING_OPT_ID)
127309c2d251SWillem de Bruijn 			tskey = sk->sk_tskey++;
127409c2d251SWillem de Bruijn 	}
1275a693e698SAnders Berggren 
12761da177e4SLinus Torvalds 	/*
12771da177e4SLinus Torvalds 	 * Let's try using as much space as possible.
12781da177e4SLinus Torvalds 	 * Use MTU if total length of the message fits into the MTU.
12791da177e4SLinus Torvalds 	 * Otherwise, we need to reserve fragment header and
12801da177e4SLinus Torvalds 	 * fragment alignment (= 8-15 octects, in total).
12811da177e4SLinus Torvalds 	 *
12821da177e4SLinus Torvalds 	 * Note that we may need to "move" the data from the tail of
12831da177e4SLinus Torvalds 	 * of the buffer to the new fragment when we split
12841da177e4SLinus Torvalds 	 * the message.
12851da177e4SLinus Torvalds 	 *
12861da177e4SLinus Torvalds 	 * FIXME: It may be fragmented into multiple chunks
12871da177e4SLinus Torvalds 	 *        at once if non-fragmentable extension headers
12881da177e4SLinus Torvalds 	 *        are too large.
12891da177e4SLinus Torvalds 	 * --yoshfuji
12901da177e4SLinus Torvalds 	 */
12911da177e4SLinus Torvalds 
12922811ebacSHannes Frederic Sowa 	skb = skb_peek_tail(&sk->sk_write_queue);
12932811ebacSHannes Frederic Sowa 	cork->length += length;
12942811ebacSHannes Frederic Sowa 	if (((length > mtu) ||
12952811ebacSHannes Frederic Sowa 	     (skb && skb_is_gso(skb))) &&
12962811ebacSHannes Frederic Sowa 	    (sk->sk_protocol == IPPROTO_UDP) &&
1297d8d1f30bSChangli Gao 	    (rt->dst.dev->features & NETIF_F_UFO)) {
12984b340ae2SBrian Haley 		err = ip6_ufo_append_data(sk, getfrag, from, length,
12994b340ae2SBrian Haley 					  hh_len, fragheaderlen,
130087c48fa3SEric Dumazet 					  transhdrlen, mtu, flags, rt);
1301baa829d8SPatrick McHardy 		if (err)
1302e89e9cf5SAnanda Raju 			goto error;
1303e89e9cf5SAnanda Raju 		return 0;
1304e89e9cf5SAnanda Raju 	}
13051da177e4SLinus Torvalds 
13062811ebacSHannes Frederic Sowa 	if (!skb)
13071da177e4SLinus Torvalds 		goto alloc_new_skb;
13081da177e4SLinus Torvalds 
13091da177e4SLinus Torvalds 	while (length > 0) {
13101da177e4SLinus Torvalds 		/* Check if the remaining data fits into current packet. */
1311bdc712b4SDavid S. Miller 		copy = (cork->length <= mtu && !(cork->flags & IPCORK_ALLFRAG) ? mtu : maxfraglen) - skb->len;
13121da177e4SLinus Torvalds 		if (copy < length)
13131da177e4SLinus Torvalds 			copy = maxfraglen - skb->len;
13141da177e4SLinus Torvalds 
13151da177e4SLinus Torvalds 		if (copy <= 0) {
13161da177e4SLinus Torvalds 			char *data;
13171da177e4SLinus Torvalds 			unsigned int datalen;
13181da177e4SLinus Torvalds 			unsigned int fraglen;
13191da177e4SLinus Torvalds 			unsigned int fraggap;
13201da177e4SLinus Torvalds 			unsigned int alloclen;
13211da177e4SLinus Torvalds alloc_new_skb:
13221da177e4SLinus Torvalds 			/* There's no room in the current skb */
13230c183379SGao feng 			if (skb)
13240c183379SGao feng 				fraggap = skb->len - maxfraglen;
13251da177e4SLinus Torvalds 			else
13261da177e4SLinus Torvalds 				fraggap = 0;
13270c183379SGao feng 			/* update mtu and maxfraglen if necessary */
13280c183379SGao feng 			if (skb == NULL || skb_prev == NULL)
13290c183379SGao feng 				ip6_append_data_mtu(&mtu, &maxfraglen,
133075a493e6SHannes Frederic Sowa 						    fragheaderlen, skb, rt,
1331e367c2d0Slucien 						    orig_mtu);
13320c183379SGao feng 
13330c183379SGao feng 			skb_prev = skb;
13341da177e4SLinus Torvalds 
13351da177e4SLinus Torvalds 			/*
13361da177e4SLinus Torvalds 			 * If remaining data exceeds the mtu,
13371da177e4SLinus Torvalds 			 * we know we need more fragment(s).
13381da177e4SLinus Torvalds 			 */
13391da177e4SLinus Torvalds 			datalen = length + fraggap;
13401da177e4SLinus Torvalds 
13410c183379SGao feng 			if (datalen > (cork->length <= mtu && !(cork->flags & IPCORK_ALLFRAG) ? mtu : maxfraglen) - fragheaderlen)
13420c183379SGao feng 				datalen = maxfraglen - fragheaderlen - rt->dst.trailer_len;
13431da177e4SLinus Torvalds 			if ((flags & MSG_MORE) &&
1344d8d1f30bSChangli Gao 			    !(rt->dst.dev->features&NETIF_F_SG))
13451da177e4SLinus Torvalds 				alloclen = mtu;
13461da177e4SLinus Torvalds 			else
13471da177e4SLinus Torvalds 				alloclen = datalen + fragheaderlen;
13481da177e4SLinus Torvalds 
1349299b0767SSteffen Klassert 			alloclen += dst_exthdrlen;
1350299b0767SSteffen Klassert 
13510c183379SGao feng 			if (datalen != length + fraggap) {
13521da177e4SLinus Torvalds 				/*
13530c183379SGao feng 				 * this is not the last fragment, the trailer
13540c183379SGao feng 				 * space is regarded as data space.
13551da177e4SLinus Torvalds 				 */
13560c183379SGao feng 				datalen += rt->dst.trailer_len;
13570c183379SGao feng 			}
13580c183379SGao feng 
1359d8d1f30bSChangli Gao 			alloclen += rt->dst.trailer_len;
13600c183379SGao feng 			fraglen = datalen + fragheaderlen;
13611da177e4SLinus Torvalds 
13621da177e4SLinus Torvalds 			/*
13631da177e4SLinus Torvalds 			 * We just reserve space for fragment header.
13641da177e4SLinus Torvalds 			 * Note: this may be overallocation if the message
13651da177e4SLinus Torvalds 			 * (without MSG_MORE) fits into the MTU.
13661da177e4SLinus Torvalds 			 */
13671da177e4SLinus Torvalds 			alloclen += sizeof(struct frag_hdr);
13681da177e4SLinus Torvalds 
13691da177e4SLinus Torvalds 			if (transhdrlen) {
13701da177e4SLinus Torvalds 				skb = sock_alloc_send_skb(sk,
13711da177e4SLinus Torvalds 						alloclen + hh_len,
13721da177e4SLinus Torvalds 						(flags & MSG_DONTWAIT), &err);
13731da177e4SLinus Torvalds 			} else {
13741da177e4SLinus Torvalds 				skb = NULL;
13751da177e4SLinus Torvalds 				if (atomic_read(&sk->sk_wmem_alloc) <=
13761da177e4SLinus Torvalds 				    2 * sk->sk_sndbuf)
13771da177e4SLinus Torvalds 					skb = sock_wmalloc(sk,
13781da177e4SLinus Torvalds 							   alloclen + hh_len, 1,
13791da177e4SLinus Torvalds 							   sk->sk_allocation);
13801da177e4SLinus Torvalds 				if (unlikely(skb == NULL))
13811da177e4SLinus Torvalds 					err = -ENOBUFS;
13821da177e4SLinus Torvalds 			}
13831da177e4SLinus Torvalds 			if (skb == NULL)
13841da177e4SLinus Torvalds 				goto error;
13851da177e4SLinus Torvalds 			/*
13861da177e4SLinus Torvalds 			 *	Fill in the control structures
13871da177e4SLinus Torvalds 			 */
13889c9c9ad5SHannes Frederic Sowa 			skb->protocol = htons(ETH_P_IPV6);
1389d7f7c0acSEric Dumazet 			skb->ip_summed = CHECKSUM_NONE;
13901da177e4SLinus Torvalds 			skb->csum = 0;
13911f85851eSGao feng 			/* reserve for fragmentation and ipsec header */
13921f85851eSGao feng 			skb_reserve(skb, hh_len + sizeof(struct frag_hdr) +
13931f85851eSGao feng 				    dst_exthdrlen);
13941da177e4SLinus Torvalds 
139511878b40SWillem de Bruijn 			/* Only the initial fragment is time stamped */
1396a693e698SAnders Berggren 			skb_shinfo(skb)->tx_flags = tx_flags;
139711878b40SWillem de Bruijn 			tx_flags = 0;
139809c2d251SWillem de Bruijn 			skb_shinfo(skb)->tskey = tskey;
139909c2d251SWillem de Bruijn 			tskey = 0;
1400a693e698SAnders Berggren 
14011da177e4SLinus Torvalds 			/*
14021da177e4SLinus Torvalds 			 *	Find where to start putting bytes
14031da177e4SLinus Torvalds 			 */
14041f85851eSGao feng 			data = skb_put(skb, fraglen);
14051f85851eSGao feng 			skb_set_network_header(skb, exthdrlen);
14061f85851eSGao feng 			data += fragheaderlen;
1407b0e380b1SArnaldo Carvalho de Melo 			skb->transport_header = (skb->network_header +
1408b0e380b1SArnaldo Carvalho de Melo 						 fragheaderlen);
14091da177e4SLinus Torvalds 			if (fraggap) {
14101da177e4SLinus Torvalds 				skb->csum = skb_copy_and_csum_bits(
14111da177e4SLinus Torvalds 					skb_prev, maxfraglen,
14121da177e4SLinus Torvalds 					data + transhdrlen, fraggap, 0);
14131da177e4SLinus Torvalds 				skb_prev->csum = csum_sub(skb_prev->csum,
14141da177e4SLinus Torvalds 							  skb->csum);
14151da177e4SLinus Torvalds 				data += fraggap;
1416e9fa4f7bSHerbert Xu 				pskb_trim_unique(skb_prev, maxfraglen);
14171da177e4SLinus Torvalds 			}
14181da177e4SLinus Torvalds 			copy = datalen - transhdrlen - fraggap;
1419299b0767SSteffen Klassert 
14201da177e4SLinus Torvalds 			if (copy < 0) {
14211da177e4SLinus Torvalds 				err = -EINVAL;
14221da177e4SLinus Torvalds 				kfree_skb(skb);
14231da177e4SLinus Torvalds 				goto error;
14241da177e4SLinus Torvalds 			} else if (copy > 0 && getfrag(from, data + transhdrlen, offset, copy, fraggap, skb) < 0) {
14251da177e4SLinus Torvalds 				err = -EFAULT;
14261da177e4SLinus Torvalds 				kfree_skb(skb);
14271da177e4SLinus Torvalds 				goto error;
14281da177e4SLinus Torvalds 			}
14291da177e4SLinus Torvalds 
14301da177e4SLinus Torvalds 			offset += copy;
14311da177e4SLinus Torvalds 			length -= datalen - fraggap;
14321da177e4SLinus Torvalds 			transhdrlen = 0;
14331da177e4SLinus Torvalds 			exthdrlen = 0;
1434299b0767SSteffen Klassert 			dst_exthdrlen = 0;
14351da177e4SLinus Torvalds 
14361da177e4SLinus Torvalds 			/*
14371da177e4SLinus Torvalds 			 * Put the packet on the pending queue
14381da177e4SLinus Torvalds 			 */
14391da177e4SLinus Torvalds 			__skb_queue_tail(&sk->sk_write_queue, skb);
14401da177e4SLinus Torvalds 			continue;
14411da177e4SLinus Torvalds 		}
14421da177e4SLinus Torvalds 
14431da177e4SLinus Torvalds 		if (copy > length)
14441da177e4SLinus Torvalds 			copy = length;
14451da177e4SLinus Torvalds 
1446d8d1f30bSChangli Gao 		if (!(rt->dst.dev->features&NETIF_F_SG)) {
14471da177e4SLinus Torvalds 			unsigned int off;
14481da177e4SLinus Torvalds 
14491da177e4SLinus Torvalds 			off = skb->len;
14501da177e4SLinus Torvalds 			if (getfrag(from, skb_put(skb, copy),
14511da177e4SLinus Torvalds 						offset, copy, off, skb) < 0) {
14521da177e4SLinus Torvalds 				__skb_trim(skb, off);
14531da177e4SLinus Torvalds 				err = -EFAULT;
14541da177e4SLinus Torvalds 				goto error;
14551da177e4SLinus Torvalds 			}
14561da177e4SLinus Torvalds 		} else {
14571da177e4SLinus Torvalds 			int i = skb_shinfo(skb)->nr_frags;
14585640f768SEric Dumazet 			struct page_frag *pfrag = sk_page_frag(sk);
14591da177e4SLinus Torvalds 
14601da177e4SLinus Torvalds 			err = -ENOMEM;
14615640f768SEric Dumazet 			if (!sk_page_frag_refill(sk, pfrag))
14621da177e4SLinus Torvalds 				goto error;
14631da177e4SLinus Torvalds 
14645640f768SEric Dumazet 			if (!skb_can_coalesce(skb, i, pfrag->page,
14655640f768SEric Dumazet 					      pfrag->offset)) {
14661da177e4SLinus Torvalds 				err = -EMSGSIZE;
14675640f768SEric Dumazet 				if (i == MAX_SKB_FRAGS)
14681da177e4SLinus Torvalds 					goto error;
14695640f768SEric Dumazet 
14705640f768SEric Dumazet 				__skb_fill_page_desc(skb, i, pfrag->page,
14715640f768SEric Dumazet 						     pfrag->offset, 0);
14725640f768SEric Dumazet 				skb_shinfo(skb)->nr_frags = ++i;
14735640f768SEric Dumazet 				get_page(pfrag->page);
14741da177e4SLinus Torvalds 			}
14755640f768SEric Dumazet 			copy = min_t(int, copy, pfrag->size - pfrag->offset);
14769e903e08SEric Dumazet 			if (getfrag(from,
14775640f768SEric Dumazet 				    page_address(pfrag->page) + pfrag->offset,
14785640f768SEric Dumazet 				    offset, copy, skb->len, skb) < 0)
14795640f768SEric Dumazet 				goto error_efault;
14805640f768SEric Dumazet 
14815640f768SEric Dumazet 			pfrag->offset += copy;
14825640f768SEric Dumazet 			skb_frag_size_add(&skb_shinfo(skb)->frags[i - 1], copy);
14831da177e4SLinus Torvalds 			skb->len += copy;
14841da177e4SLinus Torvalds 			skb->data_len += copy;
1485f945fa7aSHerbert Xu 			skb->truesize += copy;
1486f945fa7aSHerbert Xu 			atomic_add(copy, &sk->sk_wmem_alloc);
14871da177e4SLinus Torvalds 		}
14881da177e4SLinus Torvalds 		offset += copy;
14891da177e4SLinus Torvalds 		length -= copy;
14901da177e4SLinus Torvalds 	}
14915640f768SEric Dumazet 
14921da177e4SLinus Torvalds 	return 0;
14935640f768SEric Dumazet 
14945640f768SEric Dumazet error_efault:
14955640f768SEric Dumazet 	err = -EFAULT;
14961da177e4SLinus Torvalds error:
1497bdc712b4SDavid S. Miller 	cork->length -= length;
14983bd653c8SDenis V. Lunev 	IP6_INC_STATS(sock_net(sk), rt->rt6i_idev, IPSTATS_MIB_OUTDISCARDS);
14991da177e4SLinus Torvalds 	return err;
15001da177e4SLinus Torvalds }
1501a495f836SChris Elston EXPORT_SYMBOL_GPL(ip6_append_data);
15021da177e4SLinus Torvalds 
1503bf138862SPavel Emelyanov static void ip6_cork_release(struct inet_sock *inet, struct ipv6_pinfo *np)
1504bf138862SPavel Emelyanov {
15050178b695SHerbert Xu 	if (np->cork.opt) {
15060178b695SHerbert Xu 		kfree(np->cork.opt->dst0opt);
15070178b695SHerbert Xu 		kfree(np->cork.opt->dst1opt);
15080178b695SHerbert Xu 		kfree(np->cork.opt->hopopt);
15090178b695SHerbert Xu 		kfree(np->cork.opt->srcrt);
1510bf138862SPavel Emelyanov 		kfree(np->cork.opt);
1511bf138862SPavel Emelyanov 		np->cork.opt = NULL;
15120178b695SHerbert Xu 	}
15130178b695SHerbert Xu 
1514bdc712b4SDavid S. Miller 	if (inet->cork.base.dst) {
1515bdc712b4SDavid S. Miller 		dst_release(inet->cork.base.dst);
1516bdc712b4SDavid S. Miller 		inet->cork.base.dst = NULL;
1517bdc712b4SDavid S. Miller 		inet->cork.base.flags &= ~IPCORK_ALLFRAG;
1518bf138862SPavel Emelyanov 	}
1519bf138862SPavel Emelyanov 	memset(&inet->cork.fl, 0, sizeof(inet->cork.fl));
1520bf138862SPavel Emelyanov }
1521bf138862SPavel Emelyanov 
15221da177e4SLinus Torvalds int ip6_push_pending_frames(struct sock *sk)
15231da177e4SLinus Torvalds {
15241da177e4SLinus Torvalds 	struct sk_buff *skb, *tmp_skb;
15251da177e4SLinus Torvalds 	struct sk_buff **tail_skb;
15261da177e4SLinus Torvalds 	struct in6_addr final_dst_buf, *final_dst = &final_dst_buf;
15271da177e4SLinus Torvalds 	struct inet_sock *inet = inet_sk(sk);
15281da177e4SLinus Torvalds 	struct ipv6_pinfo *np = inet6_sk(sk);
15293bd653c8SDenis V. Lunev 	struct net *net = sock_net(sk);
15301da177e4SLinus Torvalds 	struct ipv6hdr *hdr;
15311da177e4SLinus Torvalds 	struct ipv6_txoptions *opt = np->cork.opt;
1532bdc712b4SDavid S. Miller 	struct rt6_info *rt = (struct rt6_info *)inet->cork.base.dst;
15334c9483b2SDavid S. Miller 	struct flowi6 *fl6 = &inet->cork.fl.u.ip6;
15344c9483b2SDavid S. Miller 	unsigned char proto = fl6->flowi6_proto;
15351da177e4SLinus Torvalds 	int err = 0;
15361da177e4SLinus Torvalds 
15371da177e4SLinus Torvalds 	if ((skb = __skb_dequeue(&sk->sk_write_queue)) == NULL)
15381da177e4SLinus Torvalds 		goto out;
15391da177e4SLinus Torvalds 	tail_skb = &(skb_shinfo(skb)->frag_list);
15401da177e4SLinus Torvalds 
15411da177e4SLinus Torvalds 	/* move skb->data to ip header from ext header */
1542d56f90a7SArnaldo Carvalho de Melo 	if (skb->data < skb_network_header(skb))
1543bbe735e4SArnaldo Carvalho de Melo 		__skb_pull(skb, skb_network_offset(skb));
15441da177e4SLinus Torvalds 	while ((tmp_skb = __skb_dequeue(&sk->sk_write_queue)) != NULL) {
1545cfe1fc77SArnaldo Carvalho de Melo 		__skb_pull(tmp_skb, skb_network_header_len(skb));
15461da177e4SLinus Torvalds 		*tail_skb = tmp_skb;
15471da177e4SLinus Torvalds 		tail_skb = &(tmp_skb->next);
15481da177e4SLinus Torvalds 		skb->len += tmp_skb->len;
15491da177e4SLinus Torvalds 		skb->data_len += tmp_skb->len;
15501da177e4SLinus Torvalds 		skb->truesize += tmp_skb->truesize;
15511da177e4SLinus Torvalds 		tmp_skb->destructor = NULL;
15521da177e4SLinus Torvalds 		tmp_skb->sk = NULL;
15531da177e4SLinus Torvalds 	}
15541da177e4SLinus Torvalds 
155528a89453SHerbert Xu 	/* Allow local fragmentation. */
155660ff7467SWANG Cong 	skb->ignore_df = ip6_sk_ignore_df(sk);
155728a89453SHerbert Xu 
15584e3fd7a0SAlexey Dobriyan 	*final_dst = fl6->daddr;
1559cfe1fc77SArnaldo Carvalho de Melo 	__skb_pull(skb, skb_network_header_len(skb));
15601da177e4SLinus Torvalds 	if (opt && opt->opt_flen)
15611da177e4SLinus Torvalds 		ipv6_push_frag_opts(skb, opt, &proto);
15621da177e4SLinus Torvalds 	if (opt && opt->opt_nflen)
15631da177e4SLinus Torvalds 		ipv6_push_nfrag_opts(skb, opt, &proto, &final_dst);
15641da177e4SLinus Torvalds 
1565e2d1bca7SArnaldo Carvalho de Melo 	skb_push(skb, sizeof(struct ipv6hdr));
1566e2d1bca7SArnaldo Carvalho de Melo 	skb_reset_network_header(skb);
15670660e03fSArnaldo Carvalho de Melo 	hdr = ipv6_hdr(skb);
15681da177e4SLinus Torvalds 
1569cb1ce2efSTom Herbert 	ip6_flow_hdr(hdr, np->cork.tclass,
1570cb1ce2efSTom Herbert 		     ip6_make_flowlabel(net, skb, fl6->flowlabel,
1571cb1ce2efSTom Herbert 					np->autoflowlabel));
15721da177e4SLinus Torvalds 	hdr->hop_limit = np->cork.hop_limit;
15731da177e4SLinus Torvalds 	hdr->nexthdr = proto;
15744e3fd7a0SAlexey Dobriyan 	hdr->saddr = fl6->saddr;
15754e3fd7a0SAlexey Dobriyan 	hdr->daddr = *final_dst;
15761da177e4SLinus Torvalds 
1577a2c2064fSPatrick McHardy 	skb->priority = sk->sk_priority;
15784a19ec58SLaszlo Attila Toth 	skb->mark = sk->sk_mark;
1579a2c2064fSPatrick McHardy 
1580d8d1f30bSChangli Gao 	skb_dst_set(skb, dst_clone(&rt->dst));
1581edf391ffSNeil Horman 	IP6_UPD_PO_STATS(net, rt->rt6i_idev, IPSTATS_MIB_OUT, skb->len);
158214878f75SDavid L Stevens 	if (proto == IPPROTO_ICMPV6) {
1583adf30907SEric Dumazet 		struct inet6_dev *idev = ip6_dst_idev(skb_dst(skb));
158414878f75SDavid L Stevens 
158543a43b60SHannes Frederic Sowa 		ICMP6MSGOUT_INC_STATS(net, idev, icmp6_hdr(skb)->icmp6_type);
158643a43b60SHannes Frederic Sowa 		ICMP6_INC_STATS(net, idev, ICMP6_MIB_OUTMSGS);
158714878f75SDavid L Stevens 	}
158814878f75SDavid L Stevens 
1589ef76bc23SHerbert Xu 	err = ip6_local_out(skb);
15901da177e4SLinus Torvalds 	if (err) {
15911da177e4SLinus Torvalds 		if (err > 0)
15926ce9e7b5SEric Dumazet 			err = net_xmit_errno(err);
15931da177e4SLinus Torvalds 		if (err)
15941da177e4SLinus Torvalds 			goto error;
15951da177e4SLinus Torvalds 	}
15961da177e4SLinus Torvalds 
15971da177e4SLinus Torvalds out:
1598bf138862SPavel Emelyanov 	ip6_cork_release(inet, np);
15991da177e4SLinus Torvalds 	return err;
16001da177e4SLinus Torvalds error:
160106254914SEric Dumazet 	IP6_INC_STATS(net, rt->rt6i_idev, IPSTATS_MIB_OUTDISCARDS);
16021da177e4SLinus Torvalds 	goto out;
16031da177e4SLinus Torvalds }
1604a495f836SChris Elston EXPORT_SYMBOL_GPL(ip6_push_pending_frames);
16051da177e4SLinus Torvalds 
16061da177e4SLinus Torvalds void ip6_flush_pending_frames(struct sock *sk)
16071da177e4SLinus Torvalds {
16081da177e4SLinus Torvalds 	struct sk_buff *skb;
16091da177e4SLinus Torvalds 
16101da177e4SLinus Torvalds 	while ((skb = __skb_dequeue_tail(&sk->sk_write_queue)) != NULL) {
1611adf30907SEric Dumazet 		if (skb_dst(skb))
1612adf30907SEric Dumazet 			IP6_INC_STATS(sock_net(sk), ip6_dst_idev(skb_dst(skb)),
1613a11d206dSYOSHIFUJI Hideaki 				      IPSTATS_MIB_OUTDISCARDS);
16141da177e4SLinus Torvalds 		kfree_skb(skb);
16151da177e4SLinus Torvalds 	}
16161da177e4SLinus Torvalds 
1617bf138862SPavel Emelyanov 	ip6_cork_release(inet_sk(sk), inet6_sk(sk));
16181da177e4SLinus Torvalds }
1619a495f836SChris Elston EXPORT_SYMBOL_GPL(ip6_flush_pending_frames);
1620