xref: /openbmc/linux/net/ipv6/ip6_output.c (revision f81b2e7d8cf8c6a52b7a5224c3b89cee5aeb6811)
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>
401da177e4SLinus Torvalds 
411da177e4SLinus Torvalds #include <linux/netfilter.h>
421da177e4SLinus Torvalds #include <linux/netfilter_ipv6.h>
431da177e4SLinus Torvalds 
441da177e4SLinus Torvalds #include <net/sock.h>
451da177e4SLinus Torvalds #include <net/snmp.h>
461da177e4SLinus Torvalds 
471da177e4SLinus Torvalds #include <net/ipv6.h>
481da177e4SLinus Torvalds #include <net/ndisc.h>
491da177e4SLinus Torvalds #include <net/protocol.h>
501da177e4SLinus Torvalds #include <net/ip6_route.h>
511da177e4SLinus Torvalds #include <net/addrconf.h>
521da177e4SLinus Torvalds #include <net/rawv6.h>
531da177e4SLinus Torvalds #include <net/icmp.h>
541da177e4SLinus Torvalds #include <net/xfrm.h>
551da177e4SLinus Torvalds #include <net/checksum.h>
567bc570c8SYOSHIFUJI Hideaki #include <linux/mroute6.h>
571da177e4SLinus Torvalds 
581da177e4SLinus Torvalds static int ip6_fragment(struct sk_buff *skb, int (*output)(struct sk_buff *));
591da177e4SLinus Torvalds 
601da177e4SLinus Torvalds static __inline__ void ipv6_select_ident(struct sk_buff *skb, struct frag_hdr *fhdr)
611da177e4SLinus Torvalds {
621da177e4SLinus Torvalds 	static u32 ipv6_fragmentation_id = 1;
631da177e4SLinus Torvalds 	static DEFINE_SPINLOCK(ip6_id_lock);
641da177e4SLinus Torvalds 
651da177e4SLinus Torvalds 	spin_lock_bh(&ip6_id_lock);
661da177e4SLinus Torvalds 	fhdr->identification = htonl(ipv6_fragmentation_id);
671da177e4SLinus Torvalds 	if (++ipv6_fragmentation_id == 0)
681da177e4SLinus Torvalds 		ipv6_fragmentation_id = 1;
691da177e4SLinus Torvalds 	spin_unlock_bh(&ip6_id_lock);
701da177e4SLinus Torvalds }
711da177e4SLinus Torvalds 
72ef76bc23SHerbert Xu int __ip6_local_out(struct sk_buff *skb)
73ef76bc23SHerbert Xu {
74ef76bc23SHerbert Xu 	int len;
75ef76bc23SHerbert Xu 
76ef76bc23SHerbert Xu 	len = skb->len - sizeof(struct ipv6hdr);
77ef76bc23SHerbert Xu 	if (len > IPV6_MAXPLEN)
78ef76bc23SHerbert Xu 		len = 0;
79ef76bc23SHerbert Xu 	ipv6_hdr(skb)->payload_len = htons(len);
80ef76bc23SHerbert Xu 
816e23ae2aSPatrick McHardy 	return nf_hook(PF_INET6, NF_INET_LOCAL_OUT, skb, NULL, skb->dst->dev,
82ef76bc23SHerbert Xu 		       dst_output);
83ef76bc23SHerbert Xu }
84ef76bc23SHerbert Xu 
85ef76bc23SHerbert Xu int ip6_local_out(struct sk_buff *skb)
86ef76bc23SHerbert Xu {
87ef76bc23SHerbert Xu 	int err;
88ef76bc23SHerbert Xu 
89ef76bc23SHerbert Xu 	err = __ip6_local_out(skb);
90ef76bc23SHerbert Xu 	if (likely(err == 1))
91ef76bc23SHerbert Xu 		err = dst_output(skb);
92ef76bc23SHerbert Xu 
93ef76bc23SHerbert Xu 	return err;
94ef76bc23SHerbert Xu }
95ef76bc23SHerbert Xu EXPORT_SYMBOL_GPL(ip6_local_out);
96ef76bc23SHerbert Xu 
97ad643a79SPatrick McHardy static int ip6_output_finish(struct sk_buff *skb)
981da177e4SLinus Torvalds {
991da177e4SLinus Torvalds 	struct dst_entry *dst = skb->dst;
1001da177e4SLinus Torvalds 
1013644f0ceSStephen Hemminger 	if (dst->hh)
1023644f0ceSStephen Hemminger 		return neigh_hh_output(dst->hh, skb);
1033644f0ceSStephen Hemminger 	else if (dst->neighbour)
1041da177e4SLinus Torvalds 		return dst->neighbour->output(skb);
1051da177e4SLinus Torvalds 
106a11d206dSYOSHIFUJI Hideaki 	IP6_INC_STATS_BH(ip6_dst_idev(dst), IPSTATS_MIB_OUTNOROUTES);
1071da177e4SLinus Torvalds 	kfree_skb(skb);
1081da177e4SLinus Torvalds 	return -EINVAL;
1091da177e4SLinus Torvalds 
1101da177e4SLinus Torvalds }
1111da177e4SLinus Torvalds 
1121da177e4SLinus Torvalds /* dev_loopback_xmit for use with netfilter. */
1131da177e4SLinus Torvalds static int ip6_dev_loopback_xmit(struct sk_buff *newskb)
1141da177e4SLinus Torvalds {
115459a98edSArnaldo Carvalho de Melo 	skb_reset_mac_header(newskb);
116bbe735e4SArnaldo Carvalho de Melo 	__skb_pull(newskb, skb_network_offset(newskb));
1171da177e4SLinus Torvalds 	newskb->pkt_type = PACKET_LOOPBACK;
1181da177e4SLinus Torvalds 	newskb->ip_summed = CHECKSUM_UNNECESSARY;
1191da177e4SLinus Torvalds 	BUG_TRAP(newskb->dst);
1201da177e4SLinus Torvalds 
1211da177e4SLinus Torvalds 	netif_rx(newskb);
1221da177e4SLinus Torvalds 	return 0;
1231da177e4SLinus Torvalds }
1241da177e4SLinus Torvalds 
1251da177e4SLinus Torvalds 
1261da177e4SLinus Torvalds static int ip6_output2(struct sk_buff *skb)
1271da177e4SLinus Torvalds {
1281da177e4SLinus Torvalds 	struct dst_entry *dst = skb->dst;
1291da177e4SLinus Torvalds 	struct net_device *dev = dst->dev;
1301da177e4SLinus Torvalds 
1311da177e4SLinus Torvalds 	skb->protocol = htons(ETH_P_IPV6);
1321da177e4SLinus Torvalds 	skb->dev = dev;
1331da177e4SLinus Torvalds 
1340660e03fSArnaldo Carvalho de Melo 	if (ipv6_addr_is_multicast(&ipv6_hdr(skb)->daddr)) {
1351da177e4SLinus Torvalds 		struct ipv6_pinfo* np = skb->sk ? inet6_sk(skb->sk) : NULL;
136a11d206dSYOSHIFUJI Hideaki 		struct inet6_dev *idev = ip6_dst_idev(skb->dst);
1371da177e4SLinus Torvalds 
1381da177e4SLinus Torvalds 		if (!(dev->flags & IFF_LOOPBACK) && (!np || np->mc_loop) &&
1397bc570c8SYOSHIFUJI Hideaki 		    ((mroute6_socket && !(IP6CB(skb)->flags & IP6SKB_FORWARDED)) ||
1400660e03fSArnaldo Carvalho de Melo 		     ipv6_chk_mcast_addr(dev, &ipv6_hdr(skb)->daddr,
1417bc570c8SYOSHIFUJI Hideaki 					 &ipv6_hdr(skb)->saddr))) {
1421da177e4SLinus Torvalds 			struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC);
1431da177e4SLinus Torvalds 
1441da177e4SLinus Torvalds 			/* Do not check for IFF_ALLMULTI; multicast routing
1451da177e4SLinus Torvalds 			   is not supported in any case.
1461da177e4SLinus Torvalds 			 */
1471da177e4SLinus Torvalds 			if (newskb)
1486e23ae2aSPatrick McHardy 				NF_HOOK(PF_INET6, NF_INET_POST_ROUTING, newskb,
1496e23ae2aSPatrick McHardy 					NULL, newskb->dev,
1501da177e4SLinus Torvalds 					ip6_dev_loopback_xmit);
1511da177e4SLinus Torvalds 
1520660e03fSArnaldo Carvalho de Melo 			if (ipv6_hdr(skb)->hop_limit == 0) {
153a11d206dSYOSHIFUJI Hideaki 				IP6_INC_STATS(idev, IPSTATS_MIB_OUTDISCARDS);
1541da177e4SLinus Torvalds 				kfree_skb(skb);
1551da177e4SLinus Torvalds 				return 0;
1561da177e4SLinus Torvalds 			}
1571da177e4SLinus Torvalds 		}
1581da177e4SLinus Torvalds 
159a11d206dSYOSHIFUJI Hideaki 		IP6_INC_STATS(idev, IPSTATS_MIB_OUTMCASTPKTS);
1601da177e4SLinus Torvalds 	}
1611da177e4SLinus Torvalds 
1626e23ae2aSPatrick McHardy 	return NF_HOOK(PF_INET6, NF_INET_POST_ROUTING, skb, NULL, skb->dev,
1636e23ae2aSPatrick McHardy 		       ip6_output_finish);
1641da177e4SLinus Torvalds }
1651da177e4SLinus Torvalds 
166628a5c56SJohn Heffner static inline int ip6_skb_dst_mtu(struct sk_buff *skb)
167628a5c56SJohn Heffner {
168628a5c56SJohn Heffner 	struct ipv6_pinfo *np = skb->sk ? inet6_sk(skb->sk) : NULL;
169628a5c56SJohn Heffner 
170628a5c56SJohn Heffner 	return (np && np->pmtudisc == IPV6_PMTUDISC_PROBE) ?
171628a5c56SJohn Heffner 	       skb->dst->dev->mtu : dst_mtu(skb->dst);
172628a5c56SJohn Heffner }
173628a5c56SJohn Heffner 
1741da177e4SLinus Torvalds int ip6_output(struct sk_buff *skb)
1751da177e4SLinus Torvalds {
176628a5c56SJohn Heffner 	if ((skb->len > ip6_skb_dst_mtu(skb) && !skb_is_gso(skb)) ||
177e89e9cf5SAnanda Raju 				dst_allfrag(skb->dst))
1781da177e4SLinus Torvalds 		return ip6_fragment(skb, ip6_output2);
1791da177e4SLinus Torvalds 	else
1801da177e4SLinus Torvalds 		return ip6_output2(skb);
1811da177e4SLinus Torvalds }
1821da177e4SLinus Torvalds 
1831da177e4SLinus Torvalds /*
1841da177e4SLinus Torvalds  *	xmit an sk_buff (used by TCP)
1851da177e4SLinus Torvalds  */
1861da177e4SLinus Torvalds 
1871da177e4SLinus Torvalds int ip6_xmit(struct sock *sk, struct sk_buff *skb, struct flowi *fl,
1881da177e4SLinus Torvalds 	     struct ipv6_txoptions *opt, int ipfragok)
1891da177e4SLinus Torvalds {
190b30bd282SPatrick McHardy 	struct ipv6_pinfo *np = inet6_sk(sk);
1911da177e4SLinus Torvalds 	struct in6_addr *first_hop = &fl->fl6_dst;
1921da177e4SLinus Torvalds 	struct dst_entry *dst = skb->dst;
1931da177e4SLinus Torvalds 	struct ipv6hdr *hdr;
1941da177e4SLinus Torvalds 	u8  proto = fl->proto;
1951da177e4SLinus Torvalds 	int seg_len = skb->len;
19641a1f8eaSYOSHIFUJI Hideaki 	int hlimit, tclass;
1971da177e4SLinus Torvalds 	u32 mtu;
1981da177e4SLinus Torvalds 
1991da177e4SLinus Torvalds 	if (opt) {
200c2636b4dSChuck Lever 		unsigned int head_room;
2011da177e4SLinus Torvalds 
2021da177e4SLinus Torvalds 		/* First: exthdrs may take lots of space (~8K for now)
2031da177e4SLinus Torvalds 		   MAX_HEADER is not enough.
2041da177e4SLinus Torvalds 		 */
2051da177e4SLinus Torvalds 		head_room = opt->opt_nflen + opt->opt_flen;
2061da177e4SLinus Torvalds 		seg_len += head_room;
2071da177e4SLinus Torvalds 		head_room += sizeof(struct ipv6hdr) + LL_RESERVED_SPACE(dst->dev);
2081da177e4SLinus Torvalds 
2091da177e4SLinus Torvalds 		if (skb_headroom(skb) < head_room) {
2101da177e4SLinus Torvalds 			struct sk_buff *skb2 = skb_realloc_headroom(skb, head_room);
211a11d206dSYOSHIFUJI Hideaki 			if (skb2 == NULL) {
212a11d206dSYOSHIFUJI Hideaki 				IP6_INC_STATS(ip6_dst_idev(skb->dst),
213a11d206dSYOSHIFUJI Hideaki 					      IPSTATS_MIB_OUTDISCARDS);
2141da177e4SLinus Torvalds 				kfree_skb(skb);
2151da177e4SLinus Torvalds 				return -ENOBUFS;
2161da177e4SLinus Torvalds 			}
217a11d206dSYOSHIFUJI Hideaki 			kfree_skb(skb);
218a11d206dSYOSHIFUJI Hideaki 			skb = skb2;
2191da177e4SLinus Torvalds 			if (sk)
2201da177e4SLinus Torvalds 				skb_set_owner_w(skb, sk);
2211da177e4SLinus Torvalds 		}
2221da177e4SLinus Torvalds 		if (opt->opt_flen)
2231da177e4SLinus Torvalds 			ipv6_push_frag_opts(skb, opt, &proto);
2241da177e4SLinus Torvalds 		if (opt->opt_nflen)
2251da177e4SLinus Torvalds 			ipv6_push_nfrag_opts(skb, opt, &proto, &first_hop);
2261da177e4SLinus Torvalds 	}
2271da177e4SLinus Torvalds 
228e2d1bca7SArnaldo Carvalho de Melo 	skb_push(skb, sizeof(struct ipv6hdr));
229e2d1bca7SArnaldo Carvalho de Melo 	skb_reset_network_header(skb);
2300660e03fSArnaldo Carvalho de Melo 	hdr = ipv6_hdr(skb);
2311da177e4SLinus Torvalds 
2321da177e4SLinus Torvalds 	/*
2331da177e4SLinus Torvalds 	 *	Fill in the IPv6 header
2341da177e4SLinus Torvalds 	 */
2351da177e4SLinus Torvalds 
2361da177e4SLinus Torvalds 	hlimit = -1;
2371da177e4SLinus Torvalds 	if (np)
2381da177e4SLinus Torvalds 		hlimit = np->hop_limit;
2391da177e4SLinus Torvalds 	if (hlimit < 0)
2406b75d090SYOSHIFUJI Hideaki 		hlimit = ip6_dst_hoplimit(dst);
2411da177e4SLinus Torvalds 
24241a1f8eaSYOSHIFUJI Hideaki 	tclass = -1;
24341a1f8eaSYOSHIFUJI Hideaki 	if (np)
24441a1f8eaSYOSHIFUJI Hideaki 		tclass = np->tclass;
24541a1f8eaSYOSHIFUJI Hideaki 	if (tclass < 0)
24641a1f8eaSYOSHIFUJI Hideaki 		tclass = 0;
24741a1f8eaSYOSHIFUJI Hideaki 
24890bcaf7bSAl Viro 	*(__be32 *)hdr = htonl(0x60000000 | (tclass << 20)) | fl->fl6_flowlabel;
24941a1f8eaSYOSHIFUJI Hideaki 
2501da177e4SLinus Torvalds 	hdr->payload_len = htons(seg_len);
2511da177e4SLinus Torvalds 	hdr->nexthdr = proto;
2521da177e4SLinus Torvalds 	hdr->hop_limit = hlimit;
2531da177e4SLinus Torvalds 
2541da177e4SLinus Torvalds 	ipv6_addr_copy(&hdr->saddr, &fl->fl6_src);
2551da177e4SLinus Torvalds 	ipv6_addr_copy(&hdr->daddr, first_hop);
2561da177e4SLinus Torvalds 
257a2c2064fSPatrick McHardy 	skb->priority = sk->sk_priority;
2584a19ec58SLaszlo Attila Toth 	skb->mark = sk->sk_mark;
259a2c2064fSPatrick McHardy 
2601da177e4SLinus Torvalds 	mtu = dst_mtu(dst);
26189114afdSHerbert Xu 	if ((skb->len <= mtu) || ipfragok || skb_is_gso(skb)) {
262a11d206dSYOSHIFUJI Hideaki 		IP6_INC_STATS(ip6_dst_idev(skb->dst),
263a11d206dSYOSHIFUJI Hideaki 			      IPSTATS_MIB_OUTREQUESTS);
2646e23ae2aSPatrick McHardy 		return NF_HOOK(PF_INET6, NF_INET_LOCAL_OUT, skb, NULL, dst->dev,
2656869c4d8SHarald Welte 				dst_output);
2661da177e4SLinus Torvalds 	}
2671da177e4SLinus Torvalds 
2681da177e4SLinus Torvalds 	if (net_ratelimit())
2691da177e4SLinus Torvalds 		printk(KERN_DEBUG "IPv6: sending pkt_too_big to self\n");
2701da177e4SLinus Torvalds 	skb->dev = dst->dev;
2711da177e4SLinus Torvalds 	icmpv6_send(skb, ICMPV6_PKT_TOOBIG, 0, mtu, skb->dev);
272a11d206dSYOSHIFUJI Hideaki 	IP6_INC_STATS(ip6_dst_idev(skb->dst), IPSTATS_MIB_FRAGFAILS);
2731da177e4SLinus Torvalds 	kfree_skb(skb);
2741da177e4SLinus Torvalds 	return -EMSGSIZE;
2751da177e4SLinus Torvalds }
2761da177e4SLinus Torvalds 
2777159039aSYOSHIFUJI Hideaki EXPORT_SYMBOL(ip6_xmit);
2787159039aSYOSHIFUJI Hideaki 
2791da177e4SLinus Torvalds /*
2801da177e4SLinus Torvalds  *	To avoid extra problems ND packets are send through this
2811da177e4SLinus Torvalds  *	routine. It's code duplication but I really want to avoid
2821da177e4SLinus Torvalds  *	extra checks since ipv6_build_header is used by TCP (which
2831da177e4SLinus Torvalds  *	is for us performance critical)
2841da177e4SLinus Torvalds  */
2851da177e4SLinus Torvalds 
2861da177e4SLinus Torvalds int ip6_nd_hdr(struct sock *sk, struct sk_buff *skb, struct net_device *dev,
2879acd9f3aSYOSHIFUJI Hideaki 	       const struct in6_addr *saddr, const struct in6_addr *daddr,
2881da177e4SLinus Torvalds 	       int proto, int len)
2891da177e4SLinus Torvalds {
2901da177e4SLinus Torvalds 	struct ipv6_pinfo *np = inet6_sk(sk);
2911da177e4SLinus Torvalds 	struct ipv6hdr *hdr;
2921da177e4SLinus Torvalds 	int totlen;
2931da177e4SLinus Torvalds 
2941da177e4SLinus Torvalds 	skb->protocol = htons(ETH_P_IPV6);
2951da177e4SLinus Torvalds 	skb->dev = dev;
2961da177e4SLinus Torvalds 
2971da177e4SLinus Torvalds 	totlen = len + sizeof(struct ipv6hdr);
2981da177e4SLinus Torvalds 
29955f79cc0SArnaldo Carvalho de Melo 	skb_reset_network_header(skb);
30055f79cc0SArnaldo Carvalho de Melo 	skb_put(skb, sizeof(struct ipv6hdr));
3010660e03fSArnaldo Carvalho de Melo 	hdr = ipv6_hdr(skb);
3021da177e4SLinus Torvalds 
303ae08e1f0SAl Viro 	*(__be32*)hdr = htonl(0x60000000);
3041da177e4SLinus Torvalds 
3051da177e4SLinus Torvalds 	hdr->payload_len = htons(len);
3061da177e4SLinus Torvalds 	hdr->nexthdr = proto;
3071da177e4SLinus Torvalds 	hdr->hop_limit = np->hop_limit;
3081da177e4SLinus Torvalds 
3091da177e4SLinus Torvalds 	ipv6_addr_copy(&hdr->saddr, saddr);
3101da177e4SLinus Torvalds 	ipv6_addr_copy(&hdr->daddr, daddr);
3111da177e4SLinus Torvalds 
3121da177e4SLinus Torvalds 	return 0;
3131da177e4SLinus Torvalds }
3141da177e4SLinus Torvalds 
3151da177e4SLinus Torvalds static int ip6_call_ra_chain(struct sk_buff *skb, int sel)
3161da177e4SLinus Torvalds {
3171da177e4SLinus Torvalds 	struct ip6_ra_chain *ra;
3181da177e4SLinus Torvalds 	struct sock *last = NULL;
3191da177e4SLinus Torvalds 
3201da177e4SLinus Torvalds 	read_lock(&ip6_ra_lock);
3211da177e4SLinus Torvalds 	for (ra = ip6_ra_chain; ra; ra = ra->next) {
3221da177e4SLinus Torvalds 		struct sock *sk = ra->sk;
3230bd1b59bSAndrew McDonald 		if (sk && ra->sel == sel &&
3240bd1b59bSAndrew McDonald 		    (!sk->sk_bound_dev_if ||
3250bd1b59bSAndrew McDonald 		     sk->sk_bound_dev_if == skb->dev->ifindex)) {
3261da177e4SLinus Torvalds 			if (last) {
3271da177e4SLinus Torvalds 				struct sk_buff *skb2 = skb_clone(skb, GFP_ATOMIC);
3281da177e4SLinus Torvalds 				if (skb2)
3291da177e4SLinus Torvalds 					rawv6_rcv(last, skb2);
3301da177e4SLinus Torvalds 			}
3311da177e4SLinus Torvalds 			last = sk;
3321da177e4SLinus Torvalds 		}
3331da177e4SLinus Torvalds 	}
3341da177e4SLinus Torvalds 
3351da177e4SLinus Torvalds 	if (last) {
3361da177e4SLinus Torvalds 		rawv6_rcv(last, skb);
3371da177e4SLinus Torvalds 		read_unlock(&ip6_ra_lock);
3381da177e4SLinus Torvalds 		return 1;
3391da177e4SLinus Torvalds 	}
3401da177e4SLinus Torvalds 	read_unlock(&ip6_ra_lock);
3411da177e4SLinus Torvalds 	return 0;
3421da177e4SLinus Torvalds }
3431da177e4SLinus Torvalds 
344e21e0b5fSVille Nuorvala static int ip6_forward_proxy_check(struct sk_buff *skb)
345e21e0b5fSVille Nuorvala {
3460660e03fSArnaldo Carvalho de Melo 	struct ipv6hdr *hdr = ipv6_hdr(skb);
347e21e0b5fSVille Nuorvala 	u8 nexthdr = hdr->nexthdr;
348e21e0b5fSVille Nuorvala 	int offset;
349e21e0b5fSVille Nuorvala 
350e21e0b5fSVille Nuorvala 	if (ipv6_ext_hdr(nexthdr)) {
351e21e0b5fSVille Nuorvala 		offset = ipv6_skip_exthdr(skb, sizeof(*hdr), &nexthdr);
352e21e0b5fSVille Nuorvala 		if (offset < 0)
353e21e0b5fSVille Nuorvala 			return 0;
354e21e0b5fSVille Nuorvala 	} else
355e21e0b5fSVille Nuorvala 		offset = sizeof(struct ipv6hdr);
356e21e0b5fSVille Nuorvala 
357e21e0b5fSVille Nuorvala 	if (nexthdr == IPPROTO_ICMPV6) {
358e21e0b5fSVille Nuorvala 		struct icmp6hdr *icmp6;
359e21e0b5fSVille Nuorvala 
360d56f90a7SArnaldo Carvalho de Melo 		if (!pskb_may_pull(skb, (skb_network_header(skb) +
361d56f90a7SArnaldo Carvalho de Melo 					 offset + 1 - skb->data)))
362e21e0b5fSVille Nuorvala 			return 0;
363e21e0b5fSVille Nuorvala 
364d56f90a7SArnaldo Carvalho de Melo 		icmp6 = (struct icmp6hdr *)(skb_network_header(skb) + offset);
365e21e0b5fSVille Nuorvala 
366e21e0b5fSVille Nuorvala 		switch (icmp6->icmp6_type) {
367e21e0b5fSVille Nuorvala 		case NDISC_ROUTER_SOLICITATION:
368e21e0b5fSVille Nuorvala 		case NDISC_ROUTER_ADVERTISEMENT:
369e21e0b5fSVille Nuorvala 		case NDISC_NEIGHBOUR_SOLICITATION:
370e21e0b5fSVille Nuorvala 		case NDISC_NEIGHBOUR_ADVERTISEMENT:
371e21e0b5fSVille Nuorvala 		case NDISC_REDIRECT:
372e21e0b5fSVille Nuorvala 			/* For reaction involving unicast neighbor discovery
373e21e0b5fSVille Nuorvala 			 * message destined to the proxied address, pass it to
374e21e0b5fSVille Nuorvala 			 * input function.
375e21e0b5fSVille Nuorvala 			 */
376e21e0b5fSVille Nuorvala 			return 1;
377e21e0b5fSVille Nuorvala 		default:
378e21e0b5fSVille Nuorvala 			break;
379e21e0b5fSVille Nuorvala 		}
380e21e0b5fSVille Nuorvala 	}
381e21e0b5fSVille Nuorvala 
38274553b09SVille Nuorvala 	/*
38374553b09SVille Nuorvala 	 * The proxying router can't forward traffic sent to a link-local
38474553b09SVille Nuorvala 	 * address, so signal the sender and discard the packet. This
38574553b09SVille Nuorvala 	 * behavior is clarified by the MIPv6 specification.
38674553b09SVille Nuorvala 	 */
38774553b09SVille Nuorvala 	if (ipv6_addr_type(&hdr->daddr) & IPV6_ADDR_LINKLOCAL) {
38874553b09SVille Nuorvala 		dst_link_failure(skb);
38974553b09SVille Nuorvala 		return -1;
39074553b09SVille Nuorvala 	}
39174553b09SVille Nuorvala 
392e21e0b5fSVille Nuorvala 	return 0;
393e21e0b5fSVille Nuorvala }
394e21e0b5fSVille Nuorvala 
3951da177e4SLinus Torvalds static inline int ip6_forward_finish(struct sk_buff *skb)
3961da177e4SLinus Torvalds {
3971da177e4SLinus Torvalds 	return dst_output(skb);
3981da177e4SLinus Torvalds }
3991da177e4SLinus Torvalds 
4001da177e4SLinus Torvalds int ip6_forward(struct sk_buff *skb)
4011da177e4SLinus Torvalds {
4021da177e4SLinus Torvalds 	struct dst_entry *dst = skb->dst;
4030660e03fSArnaldo Carvalho de Melo 	struct ipv6hdr *hdr = ipv6_hdr(skb);
4041da177e4SLinus Torvalds 	struct inet6_skb_parm *opt = IP6CB(skb);
405c346dca1SYOSHIFUJI Hideaki 	struct net *net = dev_net(dst->dev);
4061da177e4SLinus Torvalds 
4071da177e4SLinus Torvalds 	if (ipv6_devconf.forwarding == 0)
4081da177e4SLinus Torvalds 		goto error;
4091da177e4SLinus Torvalds 
4104497b076SBen Hutchings 	if (skb_warn_if_lro(skb))
4114497b076SBen Hutchings 		goto drop;
4124497b076SBen Hutchings 
4131da177e4SLinus Torvalds 	if (!xfrm6_policy_check(NULL, XFRM_POLICY_FWD, skb)) {
414a11d206dSYOSHIFUJI Hideaki 		IP6_INC_STATS(ip6_dst_idev(dst), IPSTATS_MIB_INDISCARDS);
4151da177e4SLinus Torvalds 		goto drop;
4161da177e4SLinus Torvalds 	}
4171da177e4SLinus Torvalds 
41835fc92a9SHerbert Xu 	skb_forward_csum(skb);
4191da177e4SLinus Torvalds 
4201da177e4SLinus Torvalds 	/*
4211da177e4SLinus Torvalds 	 *	We DO NOT make any processing on
4221da177e4SLinus Torvalds 	 *	RA packets, pushing them to user level AS IS
4231da177e4SLinus Torvalds 	 *	without ane WARRANTY that application will be able
4241da177e4SLinus Torvalds 	 *	to interpret them. The reason is that we
4251da177e4SLinus Torvalds 	 *	cannot make anything clever here.
4261da177e4SLinus Torvalds 	 *
4271da177e4SLinus Torvalds 	 *	We are not end-node, so that if packet contains
4281da177e4SLinus Torvalds 	 *	AH/ESP, we cannot make anything.
4291da177e4SLinus Torvalds 	 *	Defragmentation also would be mistake, RA packets
4301da177e4SLinus Torvalds 	 *	cannot be fragmented, because there is no warranty
4311da177e4SLinus Torvalds 	 *	that different fragments will go along one path. --ANK
4321da177e4SLinus Torvalds 	 */
4331da177e4SLinus Torvalds 	if (opt->ra) {
434d56f90a7SArnaldo Carvalho de Melo 		u8 *ptr = skb_network_header(skb) + opt->ra;
4351da177e4SLinus Torvalds 		if (ip6_call_ra_chain(skb, (ptr[2]<<8) + ptr[3]))
4361da177e4SLinus Torvalds 			return 0;
4371da177e4SLinus Torvalds 	}
4381da177e4SLinus Torvalds 
4391da177e4SLinus Torvalds 	/*
4401da177e4SLinus Torvalds 	 *	check and decrement ttl
4411da177e4SLinus Torvalds 	 */
4421da177e4SLinus Torvalds 	if (hdr->hop_limit <= 1) {
4431da177e4SLinus Torvalds 		/* Force OUTPUT device used as source address */
4441da177e4SLinus Torvalds 		skb->dev = dst->dev;
4451da177e4SLinus Torvalds 		icmpv6_send(skb, ICMPV6_TIME_EXCEED, ICMPV6_EXC_HOPLIMIT,
4461da177e4SLinus Torvalds 			    0, skb->dev);
447a11d206dSYOSHIFUJI Hideaki 		IP6_INC_STATS_BH(ip6_dst_idev(dst), IPSTATS_MIB_INHDRERRORS);
4481da177e4SLinus Torvalds 
4491da177e4SLinus Torvalds 		kfree_skb(skb);
4501da177e4SLinus Torvalds 		return -ETIMEDOUT;
4511da177e4SLinus Torvalds 	}
4521da177e4SLinus Torvalds 
453fbea49e1SYOSHIFUJI Hideaki 	/* XXX: idev->cnf.proxy_ndp? */
454fbea49e1SYOSHIFUJI Hideaki 	if (ipv6_devconf.proxy_ndp &&
4558a3edd80SDaniel Lezcano 	    pneigh_lookup(&nd_tbl, net, &hdr->daddr, skb->dev, 0)) {
45674553b09SVille Nuorvala 		int proxied = ip6_forward_proxy_check(skb);
45774553b09SVille Nuorvala 		if (proxied > 0)
458e21e0b5fSVille Nuorvala 			return ip6_input(skb);
45974553b09SVille Nuorvala 		else if (proxied < 0) {
460a11d206dSYOSHIFUJI Hideaki 			IP6_INC_STATS(ip6_dst_idev(dst), IPSTATS_MIB_INDISCARDS);
46174553b09SVille Nuorvala 			goto drop;
46274553b09SVille Nuorvala 		}
463e21e0b5fSVille Nuorvala 	}
464e21e0b5fSVille Nuorvala 
4651da177e4SLinus Torvalds 	if (!xfrm6_route_forward(skb)) {
466a11d206dSYOSHIFUJI Hideaki 		IP6_INC_STATS(ip6_dst_idev(dst), IPSTATS_MIB_INDISCARDS);
4671da177e4SLinus Torvalds 		goto drop;
4681da177e4SLinus Torvalds 	}
4691da177e4SLinus Torvalds 	dst = skb->dst;
4701da177e4SLinus Torvalds 
4711da177e4SLinus Torvalds 	/* IPv6 specs say nothing about it, but it is clear that we cannot
4721da177e4SLinus Torvalds 	   send redirects to source routed frames.
4731e5dc146SMasahide NAKAMURA 	   We don't send redirects to frames decapsulated from IPsec.
4741da177e4SLinus Torvalds 	 */
4751e5dc146SMasahide NAKAMURA 	if (skb->dev == dst->dev && dst->neighbour && opt->srcrt == 0 &&
4761e5dc146SMasahide NAKAMURA 	    !skb->sp) {
4771da177e4SLinus Torvalds 		struct in6_addr *target = NULL;
4781da177e4SLinus Torvalds 		struct rt6_info *rt;
4791da177e4SLinus Torvalds 		struct neighbour *n = dst->neighbour;
4801da177e4SLinus Torvalds 
4811da177e4SLinus Torvalds 		/*
4821da177e4SLinus Torvalds 		 *	incoming and outgoing devices are the same
4831da177e4SLinus Torvalds 		 *	send a redirect.
4841da177e4SLinus Torvalds 		 */
4851da177e4SLinus Torvalds 
4861da177e4SLinus Torvalds 		rt = (struct rt6_info *) dst;
4871da177e4SLinus Torvalds 		if ((rt->rt6i_flags & RTF_GATEWAY))
4881da177e4SLinus Torvalds 			target = (struct in6_addr*)&n->primary_key;
4891da177e4SLinus Torvalds 		else
4901da177e4SLinus Torvalds 			target = &hdr->daddr;
4911da177e4SLinus Torvalds 
4921da177e4SLinus Torvalds 		/* Limit redirects both by destination (here)
4931da177e4SLinus Torvalds 		   and by source (inside ndisc_send_redirect)
4941da177e4SLinus Torvalds 		 */
4951da177e4SLinus Torvalds 		if (xrlim_allow(dst, 1*HZ))
4961da177e4SLinus Torvalds 			ndisc_send_redirect(skb, n, target);
4975bb1ab09SDavid L Stevens 	} else {
4985bb1ab09SDavid L Stevens 		int addrtype = ipv6_addr_type(&hdr->saddr);
4995bb1ab09SDavid L Stevens 
5001da177e4SLinus Torvalds 		/* This check is security critical. */
501*f81b2e7dSYOSHIFUJI Hideaki 		if (addrtype == IPV6_ADDR_ANY ||
502*f81b2e7dSYOSHIFUJI Hideaki 		    addrtype & (IPV6_ADDR_MULTICAST | IPV6_ADDR_LOOPBACK))
5031da177e4SLinus Torvalds 			goto error;
5045bb1ab09SDavid L Stevens 		if (addrtype & IPV6_ADDR_LINKLOCAL) {
5055bb1ab09SDavid L Stevens 			icmpv6_send(skb, ICMPV6_DEST_UNREACH,
5065bb1ab09SDavid L Stevens 				ICMPV6_NOT_NEIGHBOUR, 0, skb->dev);
5075bb1ab09SDavid L Stevens 			goto error;
5085bb1ab09SDavid L Stevens 		}
5091da177e4SLinus Torvalds 	}
5101da177e4SLinus Torvalds 
5111da177e4SLinus Torvalds 	if (skb->len > dst_mtu(dst)) {
5121da177e4SLinus Torvalds 		/* Again, force OUTPUT device used as source address */
5131da177e4SLinus Torvalds 		skb->dev = dst->dev;
5141da177e4SLinus Torvalds 		icmpv6_send(skb, ICMPV6_PKT_TOOBIG, 0, dst_mtu(dst), skb->dev);
515a11d206dSYOSHIFUJI Hideaki 		IP6_INC_STATS_BH(ip6_dst_idev(dst), IPSTATS_MIB_INTOOBIGERRORS);
516a11d206dSYOSHIFUJI Hideaki 		IP6_INC_STATS_BH(ip6_dst_idev(dst), IPSTATS_MIB_FRAGFAILS);
5171da177e4SLinus Torvalds 		kfree_skb(skb);
5181da177e4SLinus Torvalds 		return -EMSGSIZE;
5191da177e4SLinus Torvalds 	}
5201da177e4SLinus Torvalds 
5211da177e4SLinus Torvalds 	if (skb_cow(skb, dst->dev->hard_header_len)) {
522a11d206dSYOSHIFUJI Hideaki 		IP6_INC_STATS(ip6_dst_idev(dst), IPSTATS_MIB_OUTDISCARDS);
5231da177e4SLinus Torvalds 		goto drop;
5241da177e4SLinus Torvalds 	}
5251da177e4SLinus Torvalds 
5260660e03fSArnaldo Carvalho de Melo 	hdr = ipv6_hdr(skb);
5271da177e4SLinus Torvalds 
5281da177e4SLinus Torvalds 	/* Mangling hops number delayed to point after skb COW */
5291da177e4SLinus Torvalds 
5301da177e4SLinus Torvalds 	hdr->hop_limit--;
5311da177e4SLinus Torvalds 
532a11d206dSYOSHIFUJI Hideaki 	IP6_INC_STATS_BH(ip6_dst_idev(dst), IPSTATS_MIB_OUTFORWDATAGRAMS);
5336e23ae2aSPatrick McHardy 	return NF_HOOK(PF_INET6, NF_INET_FORWARD, skb, skb->dev, dst->dev,
5346e23ae2aSPatrick McHardy 		       ip6_forward_finish);
5351da177e4SLinus Torvalds 
5361da177e4SLinus Torvalds error:
537a11d206dSYOSHIFUJI Hideaki 	IP6_INC_STATS_BH(ip6_dst_idev(dst), IPSTATS_MIB_INADDRERRORS);
5381da177e4SLinus Torvalds drop:
5391da177e4SLinus Torvalds 	kfree_skb(skb);
5401da177e4SLinus Torvalds 	return -EINVAL;
5411da177e4SLinus Torvalds }
5421da177e4SLinus Torvalds 
5431da177e4SLinus Torvalds static void ip6_copy_metadata(struct sk_buff *to, struct sk_buff *from)
5441da177e4SLinus Torvalds {
5451da177e4SLinus Torvalds 	to->pkt_type = from->pkt_type;
5461da177e4SLinus Torvalds 	to->priority = from->priority;
5471da177e4SLinus Torvalds 	to->protocol = from->protocol;
5481da177e4SLinus Torvalds 	dst_release(to->dst);
5491da177e4SLinus Torvalds 	to->dst = dst_clone(from->dst);
5501da177e4SLinus Torvalds 	to->dev = from->dev;
55182e91ffeSThomas Graf 	to->mark = from->mark;
5521da177e4SLinus Torvalds 
5531da177e4SLinus Torvalds #ifdef CONFIG_NET_SCHED
5541da177e4SLinus Torvalds 	to->tc_index = from->tc_index;
5551da177e4SLinus Torvalds #endif
556e7ac05f3SYasuyuki Kozakai 	nf_copy(to, from);
557ba9dda3aSJozsef Kadlecsik #if defined(CONFIG_NETFILTER_XT_TARGET_TRACE) || \
558ba9dda3aSJozsef Kadlecsik     defined(CONFIG_NETFILTER_XT_TARGET_TRACE_MODULE)
559ba9dda3aSJozsef Kadlecsik 	to->nf_trace = from->nf_trace;
560ba9dda3aSJozsef Kadlecsik #endif
561984bc16cSJames Morris 	skb_copy_secmark(to, from);
5621da177e4SLinus Torvalds }
5631da177e4SLinus Torvalds 
5641da177e4SLinus Torvalds int ip6_find_1stfragopt(struct sk_buff *skb, u8 **nexthdr)
5651da177e4SLinus Torvalds {
5661da177e4SLinus Torvalds 	u16 offset = sizeof(struct ipv6hdr);
5670660e03fSArnaldo Carvalho de Melo 	struct ipv6_opt_hdr *exthdr =
5680660e03fSArnaldo Carvalho de Melo 				(struct ipv6_opt_hdr *)(ipv6_hdr(skb) + 1);
56927a884dcSArnaldo Carvalho de Melo 	unsigned int packet_len = skb->tail - skb->network_header;
5701da177e4SLinus Torvalds 	int found_rhdr = 0;
5710660e03fSArnaldo Carvalho de Melo 	*nexthdr = &ipv6_hdr(skb)->nexthdr;
5721da177e4SLinus Torvalds 
5731da177e4SLinus Torvalds 	while (offset + 1 <= packet_len) {
5741da177e4SLinus Torvalds 
5751da177e4SLinus Torvalds 		switch (**nexthdr) {
5761da177e4SLinus Torvalds 
5771da177e4SLinus Torvalds 		case NEXTHDR_HOP:
57827637df9SMasahide NAKAMURA 			break;
5791da177e4SLinus Torvalds 		case NEXTHDR_ROUTING:
58027637df9SMasahide NAKAMURA 			found_rhdr = 1;
58127637df9SMasahide NAKAMURA 			break;
5821da177e4SLinus Torvalds 		case NEXTHDR_DEST:
58359fbb3a6SMasahide NAKAMURA #if defined(CONFIG_IPV6_MIP6) || defined(CONFIG_IPV6_MIP6_MODULE)
58427637df9SMasahide NAKAMURA 			if (ipv6_find_tlv(skb, offset, IPV6_TLV_HAO) >= 0)
58527637df9SMasahide NAKAMURA 				break;
58627637df9SMasahide NAKAMURA #endif
58727637df9SMasahide NAKAMURA 			if (found_rhdr)
58827637df9SMasahide NAKAMURA 				return offset;
5891da177e4SLinus Torvalds 			break;
5901da177e4SLinus Torvalds 		default :
5911da177e4SLinus Torvalds 			return offset;
5921da177e4SLinus Torvalds 		}
59327637df9SMasahide NAKAMURA 
59427637df9SMasahide NAKAMURA 		offset += ipv6_optlen(exthdr);
59527637df9SMasahide NAKAMURA 		*nexthdr = &exthdr->nexthdr;
596d56f90a7SArnaldo Carvalho de Melo 		exthdr = (struct ipv6_opt_hdr *)(skb_network_header(skb) +
597d56f90a7SArnaldo Carvalho de Melo 						 offset);
5981da177e4SLinus Torvalds 	}
5991da177e4SLinus Torvalds 
6001da177e4SLinus Torvalds 	return offset;
6011da177e4SLinus Torvalds }
6021da177e4SLinus Torvalds 
6031da177e4SLinus Torvalds static int ip6_fragment(struct sk_buff *skb, int (*output)(struct sk_buff *))
6041da177e4SLinus Torvalds {
6051da177e4SLinus Torvalds 	struct net_device *dev;
6061da177e4SLinus Torvalds 	struct sk_buff *frag;
6071da177e4SLinus Torvalds 	struct rt6_info *rt = (struct rt6_info*)skb->dst;
608d91675f9SYOSHIFUJI Hideaki 	struct ipv6_pinfo *np = skb->sk ? inet6_sk(skb->sk) : NULL;
6091da177e4SLinus Torvalds 	struct ipv6hdr *tmp_hdr;
6101da177e4SLinus Torvalds 	struct frag_hdr *fh;
6111da177e4SLinus Torvalds 	unsigned int mtu, hlen, left, len;
612ae08e1f0SAl Viro 	__be32 frag_id = 0;
6131da177e4SLinus Torvalds 	int ptr, offset = 0, err=0;
6141da177e4SLinus Torvalds 	u8 *prevhdr, nexthdr = 0;
6151da177e4SLinus Torvalds 
6161da177e4SLinus Torvalds 	dev = rt->u.dst.dev;
6171da177e4SLinus Torvalds 	hlen = ip6_find_1stfragopt(skb, &prevhdr);
6181da177e4SLinus Torvalds 	nexthdr = *prevhdr;
6191da177e4SLinus Torvalds 
620628a5c56SJohn Heffner 	mtu = ip6_skb_dst_mtu(skb);
621b881ef76SJohn Heffner 
622b881ef76SJohn Heffner 	/* We must not fragment if the socket is set to force MTU discovery
623b881ef76SJohn Heffner 	 * or if the skb it not generated by a local socket.  (This last
624b881ef76SJohn Heffner 	 * check should be redundant, but it's free.)
625b881ef76SJohn Heffner 	 */
626b5c15fc0SHerbert Xu 	if (!skb->local_df) {
627b881ef76SJohn Heffner 		skb->dev = skb->dst->dev;
628b881ef76SJohn Heffner 		icmpv6_send(skb, ICMPV6_PKT_TOOBIG, 0, mtu, skb->dev);
629b881ef76SJohn Heffner 		IP6_INC_STATS(ip6_dst_idev(skb->dst), IPSTATS_MIB_FRAGFAILS);
630b881ef76SJohn Heffner 		kfree_skb(skb);
631b881ef76SJohn Heffner 		return -EMSGSIZE;
632b881ef76SJohn Heffner 	}
633b881ef76SJohn Heffner 
634d91675f9SYOSHIFUJI Hideaki 	if (np && np->frag_size < mtu) {
635d91675f9SYOSHIFUJI Hideaki 		if (np->frag_size)
636d91675f9SYOSHIFUJI Hideaki 			mtu = np->frag_size;
637d91675f9SYOSHIFUJI Hideaki 	}
638d91675f9SYOSHIFUJI Hideaki 	mtu -= hlen + sizeof(struct frag_hdr);
6391da177e4SLinus Torvalds 
6401da177e4SLinus Torvalds 	if (skb_shinfo(skb)->frag_list) {
6411da177e4SLinus Torvalds 		int first_len = skb_pagelen(skb);
64229ffe1a5SHerbert Xu 		int truesizes = 0;
6431da177e4SLinus Torvalds 
6441da177e4SLinus Torvalds 		if (first_len - hlen > mtu ||
6451da177e4SLinus Torvalds 		    ((first_len - hlen) & 7) ||
6461da177e4SLinus Torvalds 		    skb_cloned(skb))
6471da177e4SLinus Torvalds 			goto slow_path;
6481da177e4SLinus Torvalds 
6491da177e4SLinus Torvalds 		for (frag = skb_shinfo(skb)->frag_list; frag; frag = frag->next) {
6501da177e4SLinus Torvalds 			/* Correct geometry. */
6511da177e4SLinus Torvalds 			if (frag->len > mtu ||
6521da177e4SLinus Torvalds 			    ((frag->len & 7) && frag->next) ||
6531da177e4SLinus Torvalds 			    skb_headroom(frag) < hlen)
6541da177e4SLinus Torvalds 			    goto slow_path;
6551da177e4SLinus Torvalds 
6561da177e4SLinus Torvalds 			/* Partially cloned skb? */
6571da177e4SLinus Torvalds 			if (skb_shared(frag))
6581da177e4SLinus Torvalds 				goto slow_path;
6592fdba6b0SHerbert Xu 
6602fdba6b0SHerbert Xu 			BUG_ON(frag->sk);
6612fdba6b0SHerbert Xu 			if (skb->sk) {
6622fdba6b0SHerbert Xu 				sock_hold(skb->sk);
6632fdba6b0SHerbert Xu 				frag->sk = skb->sk;
6642fdba6b0SHerbert Xu 				frag->destructor = sock_wfree;
66529ffe1a5SHerbert Xu 				truesizes += frag->truesize;
6662fdba6b0SHerbert Xu 			}
6671da177e4SLinus Torvalds 		}
6681da177e4SLinus Torvalds 
6691da177e4SLinus Torvalds 		err = 0;
6701da177e4SLinus Torvalds 		offset = 0;
6711da177e4SLinus Torvalds 		frag = skb_shinfo(skb)->frag_list;
6721da177e4SLinus Torvalds 		skb_shinfo(skb)->frag_list = NULL;
6731da177e4SLinus Torvalds 		/* BUILD HEADER */
6741da177e4SLinus Torvalds 
6759a217a1cSYOSHIFUJI Hideaki 		*prevhdr = NEXTHDR_FRAGMENT;
676d56f90a7SArnaldo Carvalho de Melo 		tmp_hdr = kmemdup(skb_network_header(skb), hlen, GFP_ATOMIC);
6771da177e4SLinus Torvalds 		if (!tmp_hdr) {
678a11d206dSYOSHIFUJI Hideaki 			IP6_INC_STATS(ip6_dst_idev(skb->dst), IPSTATS_MIB_FRAGFAILS);
6791da177e4SLinus Torvalds 			return -ENOMEM;
6801da177e4SLinus Torvalds 		}
6811da177e4SLinus Torvalds 
6821da177e4SLinus Torvalds 		__skb_pull(skb, hlen);
6831da177e4SLinus Torvalds 		fh = (struct frag_hdr*)__skb_push(skb, sizeof(struct frag_hdr));
684e2d1bca7SArnaldo Carvalho de Melo 		__skb_push(skb, hlen);
685e2d1bca7SArnaldo Carvalho de Melo 		skb_reset_network_header(skb);
686d56f90a7SArnaldo Carvalho de Melo 		memcpy(skb_network_header(skb), tmp_hdr, hlen);
6871da177e4SLinus Torvalds 
6881da177e4SLinus Torvalds 		ipv6_select_ident(skb, fh);
6891da177e4SLinus Torvalds 		fh->nexthdr = nexthdr;
6901da177e4SLinus Torvalds 		fh->reserved = 0;
6911da177e4SLinus Torvalds 		fh->frag_off = htons(IP6_MF);
6921da177e4SLinus Torvalds 		frag_id = fh->identification;
6931da177e4SLinus Torvalds 
6941da177e4SLinus Torvalds 		first_len = skb_pagelen(skb);
6951da177e4SLinus Torvalds 		skb->data_len = first_len - skb_headlen(skb);
69629ffe1a5SHerbert Xu 		skb->truesize -= truesizes;
6971da177e4SLinus Torvalds 		skb->len = first_len;
6980660e03fSArnaldo Carvalho de Melo 		ipv6_hdr(skb)->payload_len = htons(first_len -
6990660e03fSArnaldo Carvalho de Melo 						   sizeof(struct ipv6hdr));
7001da177e4SLinus Torvalds 
701a11d206dSYOSHIFUJI Hideaki 		dst_hold(&rt->u.dst);
7021da177e4SLinus Torvalds 
7031da177e4SLinus Torvalds 		for (;;) {
7041da177e4SLinus Torvalds 			/* Prepare header of the next frame,
7051da177e4SLinus Torvalds 			 * before previous one went down. */
7061da177e4SLinus Torvalds 			if (frag) {
7071da177e4SLinus Torvalds 				frag->ip_summed = CHECKSUM_NONE;
708badff6d0SArnaldo Carvalho de Melo 				skb_reset_transport_header(frag);
7091da177e4SLinus Torvalds 				fh = (struct frag_hdr*)__skb_push(frag, sizeof(struct frag_hdr));
710e2d1bca7SArnaldo Carvalho de Melo 				__skb_push(frag, hlen);
711e2d1bca7SArnaldo Carvalho de Melo 				skb_reset_network_header(frag);
712d56f90a7SArnaldo Carvalho de Melo 				memcpy(skb_network_header(frag), tmp_hdr,
713d56f90a7SArnaldo Carvalho de Melo 				       hlen);
7141da177e4SLinus Torvalds 				offset += skb->len - hlen - sizeof(struct frag_hdr);
7151da177e4SLinus Torvalds 				fh->nexthdr = nexthdr;
7161da177e4SLinus Torvalds 				fh->reserved = 0;
7171da177e4SLinus Torvalds 				fh->frag_off = htons(offset);
7181da177e4SLinus Torvalds 				if (frag->next != NULL)
7191da177e4SLinus Torvalds 					fh->frag_off |= htons(IP6_MF);
7201da177e4SLinus Torvalds 				fh->identification = frag_id;
7210660e03fSArnaldo Carvalho de Melo 				ipv6_hdr(frag)->payload_len =
7220660e03fSArnaldo Carvalho de Melo 						htons(frag->len -
7230660e03fSArnaldo Carvalho de Melo 						      sizeof(struct ipv6hdr));
7241da177e4SLinus Torvalds 				ip6_copy_metadata(frag, skb);
7251da177e4SLinus Torvalds 			}
7261da177e4SLinus Torvalds 
7271da177e4SLinus Torvalds 			err = output(skb);
728dafee490SWei Dong 			if(!err)
729a11d206dSYOSHIFUJI Hideaki 				IP6_INC_STATS(ip6_dst_idev(&rt->u.dst), IPSTATS_MIB_FRAGCREATES);
730dafee490SWei Dong 
7311da177e4SLinus Torvalds 			if (err || !frag)
7321da177e4SLinus Torvalds 				break;
7331da177e4SLinus Torvalds 
7341da177e4SLinus Torvalds 			skb = frag;
7351da177e4SLinus Torvalds 			frag = skb->next;
7361da177e4SLinus Torvalds 			skb->next = NULL;
7371da177e4SLinus Torvalds 		}
7381da177e4SLinus Torvalds 
7391da177e4SLinus Torvalds 		kfree(tmp_hdr);
7401da177e4SLinus Torvalds 
7411da177e4SLinus Torvalds 		if (err == 0) {
742a11d206dSYOSHIFUJI Hideaki 			IP6_INC_STATS(ip6_dst_idev(&rt->u.dst), IPSTATS_MIB_FRAGOKS);
743a11d206dSYOSHIFUJI Hideaki 			dst_release(&rt->u.dst);
7441da177e4SLinus Torvalds 			return 0;
7451da177e4SLinus Torvalds 		}
7461da177e4SLinus Torvalds 
7471da177e4SLinus Torvalds 		while (frag) {
7481da177e4SLinus Torvalds 			skb = frag->next;
7491da177e4SLinus Torvalds 			kfree_skb(frag);
7501da177e4SLinus Torvalds 			frag = skb;
7511da177e4SLinus Torvalds 		}
7521da177e4SLinus Torvalds 
753a11d206dSYOSHIFUJI Hideaki 		IP6_INC_STATS(ip6_dst_idev(&rt->u.dst), IPSTATS_MIB_FRAGFAILS);
754a11d206dSYOSHIFUJI Hideaki 		dst_release(&rt->u.dst);
7551da177e4SLinus Torvalds 		return err;
7561da177e4SLinus Torvalds 	}
7571da177e4SLinus Torvalds 
7581da177e4SLinus Torvalds slow_path:
7591da177e4SLinus Torvalds 	left = skb->len - hlen;		/* Space per frame */
7601da177e4SLinus Torvalds 	ptr = hlen;			/* Where to start from */
7611da177e4SLinus Torvalds 
7621da177e4SLinus Torvalds 	/*
7631da177e4SLinus Torvalds 	 *	Fragment the datagram.
7641da177e4SLinus Torvalds 	 */
7651da177e4SLinus Torvalds 
7661da177e4SLinus Torvalds 	*prevhdr = NEXTHDR_FRAGMENT;
7671da177e4SLinus Torvalds 
7681da177e4SLinus Torvalds 	/*
7691da177e4SLinus Torvalds 	 *	Keep copying data until we run out.
7701da177e4SLinus Torvalds 	 */
7711da177e4SLinus Torvalds 	while(left > 0)	{
7721da177e4SLinus Torvalds 		len = left;
7731da177e4SLinus Torvalds 		/* IF: it doesn't fit, use 'mtu' - the data space left */
7741da177e4SLinus Torvalds 		if (len > mtu)
7751da177e4SLinus Torvalds 			len = mtu;
7761da177e4SLinus Torvalds 		/* IF: we are not sending upto and including the packet end
7771da177e4SLinus Torvalds 		   then align the next start on an eight byte boundary */
7781da177e4SLinus Torvalds 		if (len < left)	{
7791da177e4SLinus Torvalds 			len &= ~7;
7801da177e4SLinus Torvalds 		}
7811da177e4SLinus Torvalds 		/*
7821da177e4SLinus Torvalds 		 *	Allocate buffer.
7831da177e4SLinus Torvalds 		 */
7841da177e4SLinus Torvalds 
785f5184d26SJohannes Berg 		if ((frag = alloc_skb(len+hlen+sizeof(struct frag_hdr)+LL_ALLOCATED_SPACE(rt->u.dst.dev), GFP_ATOMIC)) == NULL) {
78664ce2073SPatrick McHardy 			NETDEBUG(KERN_INFO "IPv6: frag: no memory for new fragment!\n");
787a11d206dSYOSHIFUJI Hideaki 			IP6_INC_STATS(ip6_dst_idev(skb->dst),
788a11d206dSYOSHIFUJI Hideaki 				      IPSTATS_MIB_FRAGFAILS);
7891da177e4SLinus Torvalds 			err = -ENOMEM;
7901da177e4SLinus Torvalds 			goto fail;
7911da177e4SLinus Torvalds 		}
7921da177e4SLinus Torvalds 
7931da177e4SLinus Torvalds 		/*
7941da177e4SLinus Torvalds 		 *	Set up data on packet
7951da177e4SLinus Torvalds 		 */
7961da177e4SLinus Torvalds 
7971da177e4SLinus Torvalds 		ip6_copy_metadata(frag, skb);
7981da177e4SLinus Torvalds 		skb_reserve(frag, LL_RESERVED_SPACE(rt->u.dst.dev));
7991da177e4SLinus Torvalds 		skb_put(frag, len + hlen + sizeof(struct frag_hdr));
800c1d2bbe1SArnaldo Carvalho de Melo 		skb_reset_network_header(frag);
801badff6d0SArnaldo Carvalho de Melo 		fh = (struct frag_hdr *)(skb_network_header(frag) + hlen);
802b0e380b1SArnaldo Carvalho de Melo 		frag->transport_header = (frag->network_header + hlen +
803b0e380b1SArnaldo Carvalho de Melo 					  sizeof(struct frag_hdr));
8041da177e4SLinus Torvalds 
8051da177e4SLinus Torvalds 		/*
8061da177e4SLinus Torvalds 		 *	Charge the memory for the fragment to any owner
8071da177e4SLinus Torvalds 		 *	it might possess
8081da177e4SLinus Torvalds 		 */
8091da177e4SLinus Torvalds 		if (skb->sk)
8101da177e4SLinus Torvalds 			skb_set_owner_w(frag, skb->sk);
8111da177e4SLinus Torvalds 
8121da177e4SLinus Torvalds 		/*
8131da177e4SLinus Torvalds 		 *	Copy the packet header into the new buffer.
8141da177e4SLinus Torvalds 		 */
815d626f62bSArnaldo Carvalho de Melo 		skb_copy_from_linear_data(skb, skb_network_header(frag), hlen);
8161da177e4SLinus Torvalds 
8171da177e4SLinus Torvalds 		/*
8181da177e4SLinus Torvalds 		 *	Build fragment header.
8191da177e4SLinus Torvalds 		 */
8201da177e4SLinus Torvalds 		fh->nexthdr = nexthdr;
8211da177e4SLinus Torvalds 		fh->reserved = 0;
822f36d6ab1SYan Zheng 		if (!frag_id) {
8231da177e4SLinus Torvalds 			ipv6_select_ident(skb, fh);
8241da177e4SLinus Torvalds 			frag_id = fh->identification;
8251da177e4SLinus Torvalds 		} else
8261da177e4SLinus Torvalds 			fh->identification = frag_id;
8271da177e4SLinus Torvalds 
8281da177e4SLinus Torvalds 		/*
8291da177e4SLinus Torvalds 		 *	Copy a block of the IP datagram.
8301da177e4SLinus Torvalds 		 */
8318984e41dSWei Yongjun 		if (skb_copy_bits(skb, ptr, skb_transport_header(frag), len))
8321da177e4SLinus Torvalds 			BUG();
8331da177e4SLinus Torvalds 		left -= len;
8341da177e4SLinus Torvalds 
8351da177e4SLinus Torvalds 		fh->frag_off = htons(offset);
8361da177e4SLinus Torvalds 		if (left > 0)
8371da177e4SLinus Torvalds 			fh->frag_off |= htons(IP6_MF);
8380660e03fSArnaldo Carvalho de Melo 		ipv6_hdr(frag)->payload_len = htons(frag->len -
8390660e03fSArnaldo Carvalho de Melo 						    sizeof(struct ipv6hdr));
8401da177e4SLinus Torvalds 
8411da177e4SLinus Torvalds 		ptr += len;
8421da177e4SLinus Torvalds 		offset += len;
8431da177e4SLinus Torvalds 
8441da177e4SLinus Torvalds 		/*
8451da177e4SLinus Torvalds 		 *	Put this fragment into the sending queue.
8461da177e4SLinus Torvalds 		 */
8471da177e4SLinus Torvalds 		err = output(frag);
8481da177e4SLinus Torvalds 		if (err)
8491da177e4SLinus Torvalds 			goto fail;
850dafee490SWei Dong 
851a11d206dSYOSHIFUJI Hideaki 		IP6_INC_STATS(ip6_dst_idev(skb->dst), IPSTATS_MIB_FRAGCREATES);
8521da177e4SLinus Torvalds 	}
853a11d206dSYOSHIFUJI Hideaki 	IP6_INC_STATS(ip6_dst_idev(skb->dst),
854a11d206dSYOSHIFUJI Hideaki 		      IPSTATS_MIB_FRAGOKS);
8551da177e4SLinus Torvalds 	kfree_skb(skb);
8561da177e4SLinus Torvalds 	return err;
8571da177e4SLinus Torvalds 
8581da177e4SLinus Torvalds fail:
859a11d206dSYOSHIFUJI Hideaki 	IP6_INC_STATS(ip6_dst_idev(skb->dst),
860a11d206dSYOSHIFUJI Hideaki 		      IPSTATS_MIB_FRAGFAILS);
8611da177e4SLinus Torvalds 	kfree_skb(skb);
8621da177e4SLinus Torvalds 	return err;
8631da177e4SLinus Torvalds }
8641da177e4SLinus Torvalds 
865cf6b1982SYOSHIFUJI Hideaki static inline int ip6_rt_check(struct rt6key *rt_key,
866cf6b1982SYOSHIFUJI Hideaki 			       struct in6_addr *fl_addr,
867cf6b1982SYOSHIFUJI Hideaki 			       struct in6_addr *addr_cache)
868cf6b1982SYOSHIFUJI Hideaki {
869cf6b1982SYOSHIFUJI Hideaki 	return ((rt_key->plen != 128 || !ipv6_addr_equal(fl_addr, &rt_key->addr)) &&
870cf6b1982SYOSHIFUJI Hideaki 		(addr_cache == NULL || !ipv6_addr_equal(fl_addr, addr_cache)));
871cf6b1982SYOSHIFUJI Hideaki }
872cf6b1982SYOSHIFUJI Hideaki 
873497c615aSHerbert Xu static struct dst_entry *ip6_sk_dst_check(struct sock *sk,
874497c615aSHerbert Xu 					  struct dst_entry *dst,
875497c615aSHerbert Xu 					  struct flowi *fl)
8761da177e4SLinus Torvalds {
8771da177e4SLinus Torvalds 	struct ipv6_pinfo *np = inet6_sk(sk);
878497c615aSHerbert Xu 	struct rt6_info *rt = (struct rt6_info *)dst;
8791da177e4SLinus Torvalds 
880497c615aSHerbert Xu 	if (!dst)
881497c615aSHerbert Xu 		goto out;
8821da177e4SLinus Torvalds 
8831da177e4SLinus Torvalds 	/* Yes, checking route validity in not connected
884d76e60a5SDavid S. Miller 	 * case is not very simple. Take into account,
885d76e60a5SDavid S. Miller 	 * that we do not support routing by source, TOS,
886d76e60a5SDavid S. Miller 	 * and MSG_DONTROUTE 		--ANK (980726)
887d76e60a5SDavid S. Miller 	 *
888cf6b1982SYOSHIFUJI Hideaki 	 * 1. ip6_rt_check(): If route was host route,
889cf6b1982SYOSHIFUJI Hideaki 	 *    check that cached destination is current.
890d76e60a5SDavid S. Miller 	 *    If it is network route, we still may
891d76e60a5SDavid S. Miller 	 *    check its validity using saved pointer
892d76e60a5SDavid S. Miller 	 *    to the last used address: daddr_cache.
893d76e60a5SDavid S. Miller 	 *    We do not want to save whole address now,
894d76e60a5SDavid S. Miller 	 *    (because main consumer of this service
895d76e60a5SDavid S. Miller 	 *    is tcp, which has not this problem),
896d76e60a5SDavid S. Miller 	 *    so that the last trick works only on connected
897d76e60a5SDavid S. Miller 	 *    sockets.
898d76e60a5SDavid S. Miller 	 * 2. oif also should be the same.
8991da177e4SLinus Torvalds 	 */
900cf6b1982SYOSHIFUJI Hideaki 	if (ip6_rt_check(&rt->rt6i_dst, &fl->fl6_dst, np->daddr_cache) ||
9018e1ef0a9SYOSHIFUJI Hideaki #ifdef CONFIG_IPV6_SUBTREES
9028e1ef0a9SYOSHIFUJI Hideaki 	    ip6_rt_check(&rt->rt6i_src, &fl->fl6_src, np->saddr_cache) ||
9038e1ef0a9SYOSHIFUJI Hideaki #endif
904cf6b1982SYOSHIFUJI Hideaki 	    (fl->oif && fl->oif != dst->dev->ifindex)) {
905497c615aSHerbert Xu 		dst_release(dst);
906497c615aSHerbert Xu 		dst = NULL;
9071da177e4SLinus Torvalds 	}
908497c615aSHerbert Xu 
909497c615aSHerbert Xu out:
910497c615aSHerbert Xu 	return dst;
9111da177e4SLinus Torvalds }
912497c615aSHerbert Xu 
913497c615aSHerbert Xu static int ip6_dst_lookup_tail(struct sock *sk,
914497c615aSHerbert Xu 			       struct dst_entry **dst, struct flowi *fl)
915497c615aSHerbert Xu {
916497c615aSHerbert Xu 	int err;
9173b1e0a65SYOSHIFUJI Hideaki 	struct net *net = sock_net(sk);
9181da177e4SLinus Torvalds 
9191da177e4SLinus Torvalds 	if (*dst == NULL)
9208a3edd80SDaniel Lezcano 		*dst = ip6_route_output(net, sk, fl);
9211da177e4SLinus Torvalds 
9221da177e4SLinus Torvalds 	if ((err = (*dst)->error))
9231da177e4SLinus Torvalds 		goto out_err_release;
9241da177e4SLinus Torvalds 
9251da177e4SLinus Torvalds 	if (ipv6_addr_any(&fl->fl6_src)) {
9265e5f3f0fSYOSHIFUJI Hideaki 		err = ipv6_dev_get_saddr(ip6_dst_idev(*dst)->dev,
9277cbca67cSYOSHIFUJI Hideaki 					 &fl->fl6_dst,
9287cbca67cSYOSHIFUJI Hideaki 					 sk ? inet6_sk(sk)->srcprefs : 0,
9297cbca67cSYOSHIFUJI Hideaki 					 &fl->fl6_src);
93044456d37SOlaf Hering 		if (err)
9311da177e4SLinus Torvalds 			goto out_err_release;
9321da177e4SLinus Torvalds 	}
9331da177e4SLinus Torvalds 
93495c385b4SNeil Horman #ifdef CONFIG_IPV6_OPTIMISTIC_DAD
93595c385b4SNeil Horman 		/*
93695c385b4SNeil Horman 		 * Here if the dst entry we've looked up
93795c385b4SNeil Horman 		 * has a neighbour entry that is in the INCOMPLETE
93895c385b4SNeil Horman 		 * state and the src address from the flow is
93995c385b4SNeil Horman 		 * marked as OPTIMISTIC, we release the found
94095c385b4SNeil Horman 		 * dst entry and replace it instead with the
94195c385b4SNeil Horman 		 * dst entry of the nexthop router
94295c385b4SNeil Horman 		 */
94395c385b4SNeil Horman 		if (!((*dst)->neighbour->nud_state & NUD_VALID)) {
94495c385b4SNeil Horman 			struct inet6_ifaddr *ifp;
94595c385b4SNeil Horman 			struct flowi fl_gw;
94695c385b4SNeil Horman 			int redirect;
94795c385b4SNeil Horman 
9488a3edd80SDaniel Lezcano 			ifp = ipv6_get_ifaddr(net, &fl->fl6_src,
9491cab3da6SDaniel Lezcano 					      (*dst)->dev, 1);
95095c385b4SNeil Horman 
95195c385b4SNeil Horman 			redirect = (ifp && ifp->flags & IFA_F_OPTIMISTIC);
95295c385b4SNeil Horman 			if (ifp)
95395c385b4SNeil Horman 				in6_ifa_put(ifp);
95495c385b4SNeil Horman 
95595c385b4SNeil Horman 			if (redirect) {
95695c385b4SNeil Horman 				/*
95795c385b4SNeil Horman 				 * We need to get the dst entry for the
95895c385b4SNeil Horman 				 * default router instead
95995c385b4SNeil Horman 				 */
96095c385b4SNeil Horman 				dst_release(*dst);
96195c385b4SNeil Horman 				memcpy(&fl_gw, fl, sizeof(struct flowi));
96295c385b4SNeil Horman 				memset(&fl_gw.fl6_dst, 0, sizeof(struct in6_addr));
9638a3edd80SDaniel Lezcano 				*dst = ip6_route_output(net, sk, &fl_gw);
96495c385b4SNeil Horman 				if ((err = (*dst)->error))
96595c385b4SNeil Horman 					goto out_err_release;
96695c385b4SNeil Horman 			}
96795c385b4SNeil Horman 		}
96895c385b4SNeil Horman #endif
96995c385b4SNeil Horman 
9701da177e4SLinus Torvalds 	return 0;
9711da177e4SLinus Torvalds 
9721da177e4SLinus Torvalds out_err_release:
973ca46f9c8SMitsuru Chinen 	if (err == -ENETUNREACH)
974ca46f9c8SMitsuru Chinen 		IP6_INC_STATS_BH(NULL, IPSTATS_MIB_OUTNOROUTES);
9751da177e4SLinus Torvalds 	dst_release(*dst);
9761da177e4SLinus Torvalds 	*dst = NULL;
9771da177e4SLinus Torvalds 	return err;
9781da177e4SLinus Torvalds }
97934a0b3cdSAdrian Bunk 
980497c615aSHerbert Xu /**
981497c615aSHerbert Xu  *	ip6_dst_lookup - perform route lookup on flow
982497c615aSHerbert Xu  *	@sk: socket which provides route info
983497c615aSHerbert Xu  *	@dst: pointer to dst_entry * for result
984497c615aSHerbert Xu  *	@fl: flow to lookup
985497c615aSHerbert Xu  *
986497c615aSHerbert Xu  *	This function performs a route lookup on the given flow.
987497c615aSHerbert Xu  *
988497c615aSHerbert Xu  *	It returns zero on success, or a standard errno code on error.
989497c615aSHerbert Xu  */
990497c615aSHerbert Xu int ip6_dst_lookup(struct sock *sk, struct dst_entry **dst, struct flowi *fl)
991497c615aSHerbert Xu {
992497c615aSHerbert Xu 	*dst = NULL;
993497c615aSHerbert Xu 	return ip6_dst_lookup_tail(sk, dst, fl);
994497c615aSHerbert Xu }
9953cf3dc6cSArnaldo Carvalho de Melo EXPORT_SYMBOL_GPL(ip6_dst_lookup);
9963cf3dc6cSArnaldo Carvalho de Melo 
997497c615aSHerbert Xu /**
998497c615aSHerbert Xu  *	ip6_sk_dst_lookup - perform socket cached route lookup on flow
999497c615aSHerbert Xu  *	@sk: socket which provides the dst cache and route info
1000497c615aSHerbert Xu  *	@dst: pointer to dst_entry * for result
1001497c615aSHerbert Xu  *	@fl: flow to lookup
1002497c615aSHerbert Xu  *
1003497c615aSHerbert Xu  *	This function performs a route lookup on the given flow with the
1004497c615aSHerbert Xu  *	possibility of using the cached route in the socket if it is valid.
1005497c615aSHerbert Xu  *	It will take the socket dst lock when operating on the dst cache.
1006497c615aSHerbert Xu  *	As a result, this function can only be used in process context.
1007497c615aSHerbert Xu  *
1008497c615aSHerbert Xu  *	It returns zero on success, or a standard errno code on error.
1009497c615aSHerbert Xu  */
1010497c615aSHerbert Xu int ip6_sk_dst_lookup(struct sock *sk, struct dst_entry **dst, struct flowi *fl)
1011497c615aSHerbert Xu {
1012497c615aSHerbert Xu 	*dst = NULL;
1013497c615aSHerbert Xu 	if (sk) {
1014497c615aSHerbert Xu 		*dst = sk_dst_check(sk, inet6_sk(sk)->dst_cookie);
1015497c615aSHerbert Xu 		*dst = ip6_sk_dst_check(sk, *dst, fl);
1016497c615aSHerbert Xu 	}
1017497c615aSHerbert Xu 
1018497c615aSHerbert Xu 	return ip6_dst_lookup_tail(sk, dst, fl);
1019497c615aSHerbert Xu }
1020497c615aSHerbert Xu EXPORT_SYMBOL_GPL(ip6_sk_dst_lookup);
1021497c615aSHerbert Xu 
102234a0b3cdSAdrian Bunk static inline int ip6_ufo_append_data(struct sock *sk,
1023e89e9cf5SAnanda Raju 			int getfrag(void *from, char *to, int offset, int len,
1024e89e9cf5SAnanda Raju 			int odd, struct sk_buff *skb),
1025e89e9cf5SAnanda Raju 			void *from, int length, int hh_len, int fragheaderlen,
1026e89e9cf5SAnanda Raju 			int transhdrlen, int mtu,unsigned int flags)
1027e89e9cf5SAnanda Raju 
1028e89e9cf5SAnanda Raju {
1029e89e9cf5SAnanda Raju 	struct sk_buff *skb;
1030e89e9cf5SAnanda Raju 	int err;
1031e89e9cf5SAnanda Raju 
1032e89e9cf5SAnanda Raju 	/* There is support for UDP large send offload by network
1033e89e9cf5SAnanda Raju 	 * device, so create one single skb packet containing complete
1034e89e9cf5SAnanda Raju 	 * udp datagram
1035e89e9cf5SAnanda Raju 	 */
1036e89e9cf5SAnanda Raju 	if ((skb = skb_peek_tail(&sk->sk_write_queue)) == NULL) {
1037e89e9cf5SAnanda Raju 		skb = sock_alloc_send_skb(sk,
1038e89e9cf5SAnanda Raju 			hh_len + fragheaderlen + transhdrlen + 20,
1039e89e9cf5SAnanda Raju 			(flags & MSG_DONTWAIT), &err);
1040e89e9cf5SAnanda Raju 		if (skb == NULL)
1041e89e9cf5SAnanda Raju 			return -ENOMEM;
1042e89e9cf5SAnanda Raju 
1043e89e9cf5SAnanda Raju 		/* reserve space for Hardware header */
1044e89e9cf5SAnanda Raju 		skb_reserve(skb, hh_len);
1045e89e9cf5SAnanda Raju 
1046e89e9cf5SAnanda Raju 		/* create space for UDP/IP header */
1047e89e9cf5SAnanda Raju 		skb_put(skb,fragheaderlen + transhdrlen);
1048e89e9cf5SAnanda Raju 
1049e89e9cf5SAnanda Raju 		/* initialize network header pointer */
1050c1d2bbe1SArnaldo Carvalho de Melo 		skb_reset_network_header(skb);
1051e89e9cf5SAnanda Raju 
1052e89e9cf5SAnanda Raju 		/* initialize protocol header pointer */
1053b0e380b1SArnaldo Carvalho de Melo 		skb->transport_header = skb->network_header + fragheaderlen;
1054e89e9cf5SAnanda Raju 
105584fa7933SPatrick McHardy 		skb->ip_summed = CHECKSUM_PARTIAL;
1056e89e9cf5SAnanda Raju 		skb->csum = 0;
1057e89e9cf5SAnanda Raju 		sk->sk_sndmsg_off = 0;
1058e89e9cf5SAnanda Raju 	}
1059e89e9cf5SAnanda Raju 
1060e89e9cf5SAnanda Raju 	err = skb_append_datato_frags(sk,skb, getfrag, from,
1061e89e9cf5SAnanda Raju 				      (length - transhdrlen));
1062e89e9cf5SAnanda Raju 	if (!err) {
1063e89e9cf5SAnanda Raju 		struct frag_hdr fhdr;
1064e89e9cf5SAnanda Raju 
1065e89e9cf5SAnanda Raju 		/* specify the length of each IP datagram fragment*/
10667967168cSHerbert Xu 		skb_shinfo(skb)->gso_size = mtu - fragheaderlen -
1067e89e9cf5SAnanda Raju 					    sizeof(struct frag_hdr);
1068f83ef8c0SHerbert Xu 		skb_shinfo(skb)->gso_type = SKB_GSO_UDP;
1069e89e9cf5SAnanda Raju 		ipv6_select_ident(skb, &fhdr);
1070e89e9cf5SAnanda Raju 		skb_shinfo(skb)->ip6_frag_id = fhdr.identification;
1071e89e9cf5SAnanda Raju 		__skb_queue_tail(&sk->sk_write_queue, skb);
1072e89e9cf5SAnanda Raju 
1073e89e9cf5SAnanda Raju 		return 0;
1074e89e9cf5SAnanda Raju 	}
1075e89e9cf5SAnanda Raju 	/* There is not enough support do UPD LSO,
1076e89e9cf5SAnanda Raju 	 * so follow normal path
1077e89e9cf5SAnanda Raju 	 */
1078e89e9cf5SAnanda Raju 	kfree_skb(skb);
1079e89e9cf5SAnanda Raju 
1080e89e9cf5SAnanda Raju 	return err;
1081e89e9cf5SAnanda Raju }
10821da177e4SLinus Torvalds 
108341a1f8eaSYOSHIFUJI Hideaki int ip6_append_data(struct sock *sk, int getfrag(void *from, char *to,
108441a1f8eaSYOSHIFUJI Hideaki 	int offset, int len, int odd, struct sk_buff *skb),
10851da177e4SLinus Torvalds 	void *from, int length, int transhdrlen,
108641a1f8eaSYOSHIFUJI Hideaki 	int hlimit, int tclass, struct ipv6_txoptions *opt, struct flowi *fl,
108741a1f8eaSYOSHIFUJI Hideaki 	struct rt6_info *rt, unsigned int flags)
10881da177e4SLinus Torvalds {
10891da177e4SLinus Torvalds 	struct inet_sock *inet = inet_sk(sk);
10901da177e4SLinus Torvalds 	struct ipv6_pinfo *np = inet6_sk(sk);
10911da177e4SLinus Torvalds 	struct sk_buff *skb;
10921da177e4SLinus Torvalds 	unsigned int maxfraglen, fragheaderlen;
10931da177e4SLinus Torvalds 	int exthdrlen;
10941da177e4SLinus Torvalds 	int hh_len;
10951da177e4SLinus Torvalds 	int mtu;
10961da177e4SLinus Torvalds 	int copy;
10971da177e4SLinus Torvalds 	int err;
10981da177e4SLinus Torvalds 	int offset = 0;
10991da177e4SLinus Torvalds 	int csummode = CHECKSUM_NONE;
11001da177e4SLinus Torvalds 
11011da177e4SLinus Torvalds 	if (flags&MSG_PROBE)
11021da177e4SLinus Torvalds 		return 0;
11031da177e4SLinus Torvalds 	if (skb_queue_empty(&sk->sk_write_queue)) {
11041da177e4SLinus Torvalds 		/*
11051da177e4SLinus Torvalds 		 * setup for corking
11061da177e4SLinus Torvalds 		 */
11071da177e4SLinus Torvalds 		if (opt) {
11081da177e4SLinus Torvalds 			if (np->cork.opt == NULL) {
11091da177e4SLinus Torvalds 				np->cork.opt = kmalloc(opt->tot_len,
11101da177e4SLinus Torvalds 						       sk->sk_allocation);
11111da177e4SLinus Torvalds 				if (unlikely(np->cork.opt == NULL))
11121da177e4SLinus Torvalds 					return -ENOBUFS;
11131da177e4SLinus Torvalds 			} else if (np->cork.opt->tot_len < opt->tot_len) {
11141da177e4SLinus Torvalds 				printk(KERN_DEBUG "ip6_append_data: invalid option length\n");
11151da177e4SLinus Torvalds 				return -EINVAL;
11161da177e4SLinus Torvalds 			}
11171da177e4SLinus Torvalds 			memcpy(np->cork.opt, opt, opt->tot_len);
11181da177e4SLinus Torvalds 			inet->cork.flags |= IPCORK_OPT;
11191da177e4SLinus Torvalds 			/* need source address above miyazawa*/
11201da177e4SLinus Torvalds 		}
11211da177e4SLinus Torvalds 		dst_hold(&rt->u.dst);
1122c8cdaf99SYOSHIFUJI Hideaki 		inet->cork.dst = &rt->u.dst;
11231da177e4SLinus Torvalds 		inet->cork.fl = *fl;
11241da177e4SLinus Torvalds 		np->cork.hop_limit = hlimit;
112541a1f8eaSYOSHIFUJI Hideaki 		np->cork.tclass = tclass;
1126628a5c56SJohn Heffner 		mtu = np->pmtudisc == IPV6_PMTUDISC_PROBE ?
1127628a5c56SJohn Heffner 		      rt->u.dst.dev->mtu : dst_mtu(rt->u.dst.path);
1128c7503609SDave Jones 		if (np->frag_size < mtu) {
1129d91675f9SYOSHIFUJI Hideaki 			if (np->frag_size)
1130d91675f9SYOSHIFUJI Hideaki 				mtu = np->frag_size;
1131d91675f9SYOSHIFUJI Hideaki 		}
1132d91675f9SYOSHIFUJI Hideaki 		inet->cork.fragsize = mtu;
11331da177e4SLinus Torvalds 		if (dst_allfrag(rt->u.dst.path))
11341da177e4SLinus Torvalds 			inet->cork.flags |= IPCORK_ALLFRAG;
11351da177e4SLinus Torvalds 		inet->cork.length = 0;
11361da177e4SLinus Torvalds 		sk->sk_sndmsg_page = NULL;
11371da177e4SLinus Torvalds 		sk->sk_sndmsg_off = 0;
113801488942SHerbert Xu 		exthdrlen = rt->u.dst.header_len + (opt ? opt->opt_flen : 0) -
1139a1b05140SMasahide NAKAMURA 			    rt->rt6i_nfheader_len;
11401da177e4SLinus Torvalds 		length += exthdrlen;
11411da177e4SLinus Torvalds 		transhdrlen += exthdrlen;
11421da177e4SLinus Torvalds 	} else {
1143c8cdaf99SYOSHIFUJI Hideaki 		rt = (struct rt6_info *)inet->cork.dst;
11441da177e4SLinus Torvalds 		fl = &inet->cork.fl;
11451da177e4SLinus Torvalds 		if (inet->cork.flags & IPCORK_OPT)
11461da177e4SLinus Torvalds 			opt = np->cork.opt;
11471da177e4SLinus Torvalds 		transhdrlen = 0;
11481da177e4SLinus Torvalds 		exthdrlen = 0;
11491da177e4SLinus Torvalds 		mtu = inet->cork.fragsize;
11501da177e4SLinus Torvalds 	}
11511da177e4SLinus Torvalds 
11521da177e4SLinus Torvalds 	hh_len = LL_RESERVED_SPACE(rt->u.dst.dev);
11531da177e4SLinus Torvalds 
1154a1b05140SMasahide NAKAMURA 	fragheaderlen = sizeof(struct ipv6hdr) + rt->rt6i_nfheader_len +
1155b4ce9277SHerbert Xu 			(opt ? opt->opt_nflen : 0);
11561da177e4SLinus Torvalds 	maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen - sizeof(struct frag_hdr);
11571da177e4SLinus Torvalds 
11581da177e4SLinus Torvalds 	if (mtu <= sizeof(struct ipv6hdr) + IPV6_MAXPLEN) {
11591da177e4SLinus Torvalds 		if (inet->cork.length + length > sizeof(struct ipv6hdr) + IPV6_MAXPLEN - fragheaderlen) {
11601da177e4SLinus Torvalds 			ipv6_local_error(sk, EMSGSIZE, fl, mtu-exthdrlen);
11611da177e4SLinus Torvalds 			return -EMSGSIZE;
11621da177e4SLinus Torvalds 		}
11631da177e4SLinus Torvalds 	}
11641da177e4SLinus Torvalds 
11651da177e4SLinus Torvalds 	/*
11661da177e4SLinus Torvalds 	 * Let's try using as much space as possible.
11671da177e4SLinus Torvalds 	 * Use MTU if total length of the message fits into the MTU.
11681da177e4SLinus Torvalds 	 * Otherwise, we need to reserve fragment header and
11691da177e4SLinus Torvalds 	 * fragment alignment (= 8-15 octects, in total).
11701da177e4SLinus Torvalds 	 *
11711da177e4SLinus Torvalds 	 * Note that we may need to "move" the data from the tail of
11721da177e4SLinus Torvalds 	 * of the buffer to the new fragment when we split
11731da177e4SLinus Torvalds 	 * the message.
11741da177e4SLinus Torvalds 	 *
11751da177e4SLinus Torvalds 	 * FIXME: It may be fragmented into multiple chunks
11761da177e4SLinus Torvalds 	 *        at once if non-fragmentable extension headers
11771da177e4SLinus Torvalds 	 *        are too large.
11781da177e4SLinus Torvalds 	 * --yoshfuji
11791da177e4SLinus Torvalds 	 */
11801da177e4SLinus Torvalds 
11811da177e4SLinus Torvalds 	inet->cork.length += length;
1182e89e9cf5SAnanda Raju 	if (((length > mtu) && (sk->sk_protocol == IPPROTO_UDP)) &&
1183e89e9cf5SAnanda Raju 	    (rt->u.dst.dev->features & NETIF_F_UFO)) {
1184e89e9cf5SAnanda Raju 
1185baa829d8SPatrick McHardy 		err = ip6_ufo_append_data(sk, getfrag, from, length, hh_len,
1186baa829d8SPatrick McHardy 					  fragheaderlen, transhdrlen, mtu,
1187baa829d8SPatrick McHardy 					  flags);
1188baa829d8SPatrick McHardy 		if (err)
1189e89e9cf5SAnanda Raju 			goto error;
1190e89e9cf5SAnanda Raju 		return 0;
1191e89e9cf5SAnanda Raju 	}
11921da177e4SLinus Torvalds 
11931da177e4SLinus Torvalds 	if ((skb = skb_peek_tail(&sk->sk_write_queue)) == NULL)
11941da177e4SLinus Torvalds 		goto alloc_new_skb;
11951da177e4SLinus Torvalds 
11961da177e4SLinus Torvalds 	while (length > 0) {
11971da177e4SLinus Torvalds 		/* Check if the remaining data fits into current packet. */
11981da177e4SLinus Torvalds 		copy = (inet->cork.length <= mtu && !(inet->cork.flags & IPCORK_ALLFRAG) ? mtu : maxfraglen) - skb->len;
11991da177e4SLinus Torvalds 		if (copy < length)
12001da177e4SLinus Torvalds 			copy = maxfraglen - skb->len;
12011da177e4SLinus Torvalds 
12021da177e4SLinus Torvalds 		if (copy <= 0) {
12031da177e4SLinus Torvalds 			char *data;
12041da177e4SLinus Torvalds 			unsigned int datalen;
12051da177e4SLinus Torvalds 			unsigned int fraglen;
12061da177e4SLinus Torvalds 			unsigned int fraggap;
12071da177e4SLinus Torvalds 			unsigned int alloclen;
12081da177e4SLinus Torvalds 			struct sk_buff *skb_prev;
12091da177e4SLinus Torvalds alloc_new_skb:
12101da177e4SLinus Torvalds 			skb_prev = skb;
12111da177e4SLinus Torvalds 
12121da177e4SLinus Torvalds 			/* There's no room in the current skb */
12131da177e4SLinus Torvalds 			if (skb_prev)
12141da177e4SLinus Torvalds 				fraggap = skb_prev->len - maxfraglen;
12151da177e4SLinus Torvalds 			else
12161da177e4SLinus Torvalds 				fraggap = 0;
12171da177e4SLinus Torvalds 
12181da177e4SLinus Torvalds 			/*
12191da177e4SLinus Torvalds 			 * If remaining data exceeds the mtu,
12201da177e4SLinus Torvalds 			 * we know we need more fragment(s).
12211da177e4SLinus Torvalds 			 */
12221da177e4SLinus Torvalds 			datalen = length + fraggap;
12231da177e4SLinus Torvalds 			if (datalen > (inet->cork.length <= mtu && !(inet->cork.flags & IPCORK_ALLFRAG) ? mtu : maxfraglen) - fragheaderlen)
12241da177e4SLinus Torvalds 				datalen = maxfraglen - fragheaderlen;
12251da177e4SLinus Torvalds 
12261da177e4SLinus Torvalds 			fraglen = datalen + fragheaderlen;
12271da177e4SLinus Torvalds 			if ((flags & MSG_MORE) &&
12281da177e4SLinus Torvalds 			    !(rt->u.dst.dev->features&NETIF_F_SG))
12291da177e4SLinus Torvalds 				alloclen = mtu;
12301da177e4SLinus Torvalds 			else
12311da177e4SLinus Torvalds 				alloclen = datalen + fragheaderlen;
12321da177e4SLinus Torvalds 
12331da177e4SLinus Torvalds 			/*
12341da177e4SLinus Torvalds 			 * The last fragment gets additional space at tail.
12351da177e4SLinus Torvalds 			 * Note: we overallocate on fragments with MSG_MODE
12361da177e4SLinus Torvalds 			 * because we have no idea if we're the last one.
12371da177e4SLinus Torvalds 			 */
12381da177e4SLinus Torvalds 			if (datalen == length + fraggap)
12391da177e4SLinus Torvalds 				alloclen += rt->u.dst.trailer_len;
12401da177e4SLinus Torvalds 
12411da177e4SLinus Torvalds 			/*
12421da177e4SLinus Torvalds 			 * We just reserve space for fragment header.
12431da177e4SLinus Torvalds 			 * Note: this may be overallocation if the message
12441da177e4SLinus Torvalds 			 * (without MSG_MORE) fits into the MTU.
12451da177e4SLinus Torvalds 			 */
12461da177e4SLinus Torvalds 			alloclen += sizeof(struct frag_hdr);
12471da177e4SLinus Torvalds 
12481da177e4SLinus Torvalds 			if (transhdrlen) {
12491da177e4SLinus Torvalds 				skb = sock_alloc_send_skb(sk,
12501da177e4SLinus Torvalds 						alloclen + hh_len,
12511da177e4SLinus Torvalds 						(flags & MSG_DONTWAIT), &err);
12521da177e4SLinus Torvalds 			} else {
12531da177e4SLinus Torvalds 				skb = NULL;
12541da177e4SLinus Torvalds 				if (atomic_read(&sk->sk_wmem_alloc) <=
12551da177e4SLinus Torvalds 				    2 * sk->sk_sndbuf)
12561da177e4SLinus Torvalds 					skb = sock_wmalloc(sk,
12571da177e4SLinus Torvalds 							   alloclen + hh_len, 1,
12581da177e4SLinus Torvalds 							   sk->sk_allocation);
12591da177e4SLinus Torvalds 				if (unlikely(skb == NULL))
12601da177e4SLinus Torvalds 					err = -ENOBUFS;
12611da177e4SLinus Torvalds 			}
12621da177e4SLinus Torvalds 			if (skb == NULL)
12631da177e4SLinus Torvalds 				goto error;
12641da177e4SLinus Torvalds 			/*
12651da177e4SLinus Torvalds 			 *	Fill in the control structures
12661da177e4SLinus Torvalds 			 */
12671da177e4SLinus Torvalds 			skb->ip_summed = csummode;
12681da177e4SLinus Torvalds 			skb->csum = 0;
12691da177e4SLinus Torvalds 			/* reserve for fragmentation */
12701da177e4SLinus Torvalds 			skb_reserve(skb, hh_len+sizeof(struct frag_hdr));
12711da177e4SLinus Torvalds 
12721da177e4SLinus Torvalds 			/*
12731da177e4SLinus Torvalds 			 *	Find where to start putting bytes
12741da177e4SLinus Torvalds 			 */
12751da177e4SLinus Torvalds 			data = skb_put(skb, fraglen);
1276c14d2450SArnaldo Carvalho de Melo 			skb_set_network_header(skb, exthdrlen);
12771da177e4SLinus Torvalds 			data += fragheaderlen;
1278b0e380b1SArnaldo Carvalho de Melo 			skb->transport_header = (skb->network_header +
1279b0e380b1SArnaldo Carvalho de Melo 						 fragheaderlen);
12801da177e4SLinus Torvalds 			if (fraggap) {
12811da177e4SLinus Torvalds 				skb->csum = skb_copy_and_csum_bits(
12821da177e4SLinus Torvalds 					skb_prev, maxfraglen,
12831da177e4SLinus Torvalds 					data + transhdrlen, fraggap, 0);
12841da177e4SLinus Torvalds 				skb_prev->csum = csum_sub(skb_prev->csum,
12851da177e4SLinus Torvalds 							  skb->csum);
12861da177e4SLinus Torvalds 				data += fraggap;
1287e9fa4f7bSHerbert Xu 				pskb_trim_unique(skb_prev, maxfraglen);
12881da177e4SLinus Torvalds 			}
12891da177e4SLinus Torvalds 			copy = datalen - transhdrlen - fraggap;
12901da177e4SLinus Torvalds 			if (copy < 0) {
12911da177e4SLinus Torvalds 				err = -EINVAL;
12921da177e4SLinus Torvalds 				kfree_skb(skb);
12931da177e4SLinus Torvalds 				goto error;
12941da177e4SLinus Torvalds 			} else if (copy > 0 && getfrag(from, data + transhdrlen, offset, copy, fraggap, skb) < 0) {
12951da177e4SLinus Torvalds 				err = -EFAULT;
12961da177e4SLinus Torvalds 				kfree_skb(skb);
12971da177e4SLinus Torvalds 				goto error;
12981da177e4SLinus Torvalds 			}
12991da177e4SLinus Torvalds 
13001da177e4SLinus Torvalds 			offset += copy;
13011da177e4SLinus Torvalds 			length -= datalen - fraggap;
13021da177e4SLinus Torvalds 			transhdrlen = 0;
13031da177e4SLinus Torvalds 			exthdrlen = 0;
13041da177e4SLinus Torvalds 			csummode = CHECKSUM_NONE;
13051da177e4SLinus Torvalds 
13061da177e4SLinus Torvalds 			/*
13071da177e4SLinus Torvalds 			 * Put the packet on the pending queue
13081da177e4SLinus Torvalds 			 */
13091da177e4SLinus Torvalds 			__skb_queue_tail(&sk->sk_write_queue, skb);
13101da177e4SLinus Torvalds 			continue;
13111da177e4SLinus Torvalds 		}
13121da177e4SLinus Torvalds 
13131da177e4SLinus Torvalds 		if (copy > length)
13141da177e4SLinus Torvalds 			copy = length;
13151da177e4SLinus Torvalds 
13161da177e4SLinus Torvalds 		if (!(rt->u.dst.dev->features&NETIF_F_SG)) {
13171da177e4SLinus Torvalds 			unsigned int off;
13181da177e4SLinus Torvalds 
13191da177e4SLinus Torvalds 			off = skb->len;
13201da177e4SLinus Torvalds 			if (getfrag(from, skb_put(skb, copy),
13211da177e4SLinus Torvalds 						offset, copy, off, skb) < 0) {
13221da177e4SLinus Torvalds 				__skb_trim(skb, off);
13231da177e4SLinus Torvalds 				err = -EFAULT;
13241da177e4SLinus Torvalds 				goto error;
13251da177e4SLinus Torvalds 			}
13261da177e4SLinus Torvalds 		} else {
13271da177e4SLinus Torvalds 			int i = skb_shinfo(skb)->nr_frags;
13281da177e4SLinus Torvalds 			skb_frag_t *frag = &skb_shinfo(skb)->frags[i-1];
13291da177e4SLinus Torvalds 			struct page *page = sk->sk_sndmsg_page;
13301da177e4SLinus Torvalds 			int off = sk->sk_sndmsg_off;
13311da177e4SLinus Torvalds 			unsigned int left;
13321da177e4SLinus Torvalds 
13331da177e4SLinus Torvalds 			if (page && (left = PAGE_SIZE - off) > 0) {
13341da177e4SLinus Torvalds 				if (copy >= left)
13351da177e4SLinus Torvalds 					copy = left;
13361da177e4SLinus Torvalds 				if (page != frag->page) {
13371da177e4SLinus Torvalds 					if (i == MAX_SKB_FRAGS) {
13381da177e4SLinus Torvalds 						err = -EMSGSIZE;
13391da177e4SLinus Torvalds 						goto error;
13401da177e4SLinus Torvalds 					}
13411da177e4SLinus Torvalds 					get_page(page);
13421da177e4SLinus Torvalds 					skb_fill_page_desc(skb, i, page, sk->sk_sndmsg_off, 0);
13431da177e4SLinus Torvalds 					frag = &skb_shinfo(skb)->frags[i];
13441da177e4SLinus Torvalds 				}
13451da177e4SLinus Torvalds 			} else if(i < MAX_SKB_FRAGS) {
13461da177e4SLinus Torvalds 				if (copy > PAGE_SIZE)
13471da177e4SLinus Torvalds 					copy = PAGE_SIZE;
13481da177e4SLinus Torvalds 				page = alloc_pages(sk->sk_allocation, 0);
13491da177e4SLinus Torvalds 				if (page == NULL) {
13501da177e4SLinus Torvalds 					err = -ENOMEM;
13511da177e4SLinus Torvalds 					goto error;
13521da177e4SLinus Torvalds 				}
13531da177e4SLinus Torvalds 				sk->sk_sndmsg_page = page;
13541da177e4SLinus Torvalds 				sk->sk_sndmsg_off = 0;
13551da177e4SLinus Torvalds 
13561da177e4SLinus Torvalds 				skb_fill_page_desc(skb, i, page, 0, 0);
13571da177e4SLinus Torvalds 				frag = &skb_shinfo(skb)->frags[i];
13581da177e4SLinus Torvalds 			} else {
13591da177e4SLinus Torvalds 				err = -EMSGSIZE;
13601da177e4SLinus Torvalds 				goto error;
13611da177e4SLinus Torvalds 			}
13621da177e4SLinus Torvalds 			if (getfrag(from, page_address(frag->page)+frag->page_offset+frag->size, offset, copy, skb->len, skb) < 0) {
13631da177e4SLinus Torvalds 				err = -EFAULT;
13641da177e4SLinus Torvalds 				goto error;
13651da177e4SLinus Torvalds 			}
13661da177e4SLinus Torvalds 			sk->sk_sndmsg_off += copy;
13671da177e4SLinus Torvalds 			frag->size += copy;
13681da177e4SLinus Torvalds 			skb->len += copy;
13691da177e4SLinus Torvalds 			skb->data_len += copy;
1370f945fa7aSHerbert Xu 			skb->truesize += copy;
1371f945fa7aSHerbert Xu 			atomic_add(copy, &sk->sk_wmem_alloc);
13721da177e4SLinus Torvalds 		}
13731da177e4SLinus Torvalds 		offset += copy;
13741da177e4SLinus Torvalds 		length -= copy;
13751da177e4SLinus Torvalds 	}
13761da177e4SLinus Torvalds 	return 0;
13771da177e4SLinus Torvalds error:
13781da177e4SLinus Torvalds 	inet->cork.length -= length;
1379a11d206dSYOSHIFUJI Hideaki 	IP6_INC_STATS(rt->rt6i_idev, IPSTATS_MIB_OUTDISCARDS);
13801da177e4SLinus Torvalds 	return err;
13811da177e4SLinus Torvalds }
13821da177e4SLinus Torvalds 
1383bf138862SPavel Emelyanov static void ip6_cork_release(struct inet_sock *inet, struct ipv6_pinfo *np)
1384bf138862SPavel Emelyanov {
1385bf138862SPavel Emelyanov 	inet->cork.flags &= ~IPCORK_OPT;
1386bf138862SPavel Emelyanov 	kfree(np->cork.opt);
1387bf138862SPavel Emelyanov 	np->cork.opt = NULL;
1388c8cdaf99SYOSHIFUJI Hideaki 	if (inet->cork.dst) {
1389c8cdaf99SYOSHIFUJI Hideaki 		dst_release(inet->cork.dst);
1390c8cdaf99SYOSHIFUJI Hideaki 		inet->cork.dst = NULL;
1391bf138862SPavel Emelyanov 		inet->cork.flags &= ~IPCORK_ALLFRAG;
1392bf138862SPavel Emelyanov 	}
1393bf138862SPavel Emelyanov 	memset(&inet->cork.fl, 0, sizeof(inet->cork.fl));
1394bf138862SPavel Emelyanov }
1395bf138862SPavel Emelyanov 
13961da177e4SLinus Torvalds int ip6_push_pending_frames(struct sock *sk)
13971da177e4SLinus Torvalds {
13981da177e4SLinus Torvalds 	struct sk_buff *skb, *tmp_skb;
13991da177e4SLinus Torvalds 	struct sk_buff **tail_skb;
14001da177e4SLinus Torvalds 	struct in6_addr final_dst_buf, *final_dst = &final_dst_buf;
14011da177e4SLinus Torvalds 	struct inet_sock *inet = inet_sk(sk);
14021da177e4SLinus Torvalds 	struct ipv6_pinfo *np = inet6_sk(sk);
14031da177e4SLinus Torvalds 	struct ipv6hdr *hdr;
14041da177e4SLinus Torvalds 	struct ipv6_txoptions *opt = np->cork.opt;
1405c8cdaf99SYOSHIFUJI Hideaki 	struct rt6_info *rt = (struct rt6_info *)inet->cork.dst;
14061da177e4SLinus Torvalds 	struct flowi *fl = &inet->cork.fl;
14071da177e4SLinus Torvalds 	unsigned char proto = fl->proto;
14081da177e4SLinus Torvalds 	int err = 0;
14091da177e4SLinus Torvalds 
14101da177e4SLinus Torvalds 	if ((skb = __skb_dequeue(&sk->sk_write_queue)) == NULL)
14111da177e4SLinus Torvalds 		goto out;
14121da177e4SLinus Torvalds 	tail_skb = &(skb_shinfo(skb)->frag_list);
14131da177e4SLinus Torvalds 
14141da177e4SLinus Torvalds 	/* move skb->data to ip header from ext header */
1415d56f90a7SArnaldo Carvalho de Melo 	if (skb->data < skb_network_header(skb))
1416bbe735e4SArnaldo Carvalho de Melo 		__skb_pull(skb, skb_network_offset(skb));
14171da177e4SLinus Torvalds 	while ((tmp_skb = __skb_dequeue(&sk->sk_write_queue)) != NULL) {
1418cfe1fc77SArnaldo Carvalho de Melo 		__skb_pull(tmp_skb, skb_network_header_len(skb));
14191da177e4SLinus Torvalds 		*tail_skb = tmp_skb;
14201da177e4SLinus Torvalds 		tail_skb = &(tmp_skb->next);
14211da177e4SLinus Torvalds 		skb->len += tmp_skb->len;
14221da177e4SLinus Torvalds 		skb->data_len += tmp_skb->len;
14231da177e4SLinus Torvalds 		skb->truesize += tmp_skb->truesize;
14241da177e4SLinus Torvalds 		__sock_put(tmp_skb->sk);
14251da177e4SLinus Torvalds 		tmp_skb->destructor = NULL;
14261da177e4SLinus Torvalds 		tmp_skb->sk = NULL;
14271da177e4SLinus Torvalds 	}
14281da177e4SLinus Torvalds 
142928a89453SHerbert Xu 	/* Allow local fragmentation. */
1430b5c15fc0SHerbert Xu 	if (np->pmtudisc < IPV6_PMTUDISC_DO)
143128a89453SHerbert Xu 		skb->local_df = 1;
143228a89453SHerbert Xu 
14331da177e4SLinus Torvalds 	ipv6_addr_copy(final_dst, &fl->fl6_dst);
1434cfe1fc77SArnaldo Carvalho de Melo 	__skb_pull(skb, skb_network_header_len(skb));
14351da177e4SLinus Torvalds 	if (opt && opt->opt_flen)
14361da177e4SLinus Torvalds 		ipv6_push_frag_opts(skb, opt, &proto);
14371da177e4SLinus Torvalds 	if (opt && opt->opt_nflen)
14381da177e4SLinus Torvalds 		ipv6_push_nfrag_opts(skb, opt, &proto, &final_dst);
14391da177e4SLinus Torvalds 
1440e2d1bca7SArnaldo Carvalho de Melo 	skb_push(skb, sizeof(struct ipv6hdr));
1441e2d1bca7SArnaldo Carvalho de Melo 	skb_reset_network_header(skb);
14420660e03fSArnaldo Carvalho de Melo 	hdr = ipv6_hdr(skb);
14431da177e4SLinus Torvalds 
144490bcaf7bSAl Viro 	*(__be32*)hdr = fl->fl6_flowlabel |
144541a1f8eaSYOSHIFUJI Hideaki 		     htonl(0x60000000 | ((int)np->cork.tclass << 20));
14461da177e4SLinus Torvalds 
14471da177e4SLinus Torvalds 	hdr->hop_limit = np->cork.hop_limit;
14481da177e4SLinus Torvalds 	hdr->nexthdr = proto;
14491da177e4SLinus Torvalds 	ipv6_addr_copy(&hdr->saddr, &fl->fl6_src);
14501da177e4SLinus Torvalds 	ipv6_addr_copy(&hdr->daddr, final_dst);
14511da177e4SLinus Torvalds 
1452a2c2064fSPatrick McHardy 	skb->priority = sk->sk_priority;
14534a19ec58SLaszlo Attila Toth 	skb->mark = sk->sk_mark;
1454a2c2064fSPatrick McHardy 
14551da177e4SLinus Torvalds 	skb->dst = dst_clone(&rt->u.dst);
1456a11d206dSYOSHIFUJI Hideaki 	IP6_INC_STATS(rt->rt6i_idev, IPSTATS_MIB_OUTREQUESTS);
145714878f75SDavid L Stevens 	if (proto == IPPROTO_ICMPV6) {
145814878f75SDavid L Stevens 		struct inet6_dev *idev = ip6_dst_idev(skb->dst);
145914878f75SDavid L Stevens 
146014878f75SDavid L Stevens 		ICMP6MSGOUT_INC_STATS_BH(idev, icmp6_hdr(skb)->icmp6_type);
146114878f75SDavid L Stevens 		ICMP6_INC_STATS_BH(idev, ICMP6_MIB_OUTMSGS);
146214878f75SDavid L Stevens 	}
146314878f75SDavid L Stevens 
1464ef76bc23SHerbert Xu 	err = ip6_local_out(skb);
14651da177e4SLinus Torvalds 	if (err) {
14661da177e4SLinus Torvalds 		if (err > 0)
14673320da89SHerbert Xu 			err = np->recverr ? net_xmit_errno(err) : 0;
14681da177e4SLinus Torvalds 		if (err)
14691da177e4SLinus Torvalds 			goto error;
14701da177e4SLinus Torvalds 	}
14711da177e4SLinus Torvalds 
14721da177e4SLinus Torvalds out:
1473bf138862SPavel Emelyanov 	ip6_cork_release(inet, np);
14741da177e4SLinus Torvalds 	return err;
14751da177e4SLinus Torvalds error:
14761da177e4SLinus Torvalds 	goto out;
14771da177e4SLinus Torvalds }
14781da177e4SLinus Torvalds 
14791da177e4SLinus Torvalds void ip6_flush_pending_frames(struct sock *sk)
14801da177e4SLinus Torvalds {
14811da177e4SLinus Torvalds 	struct sk_buff *skb;
14821da177e4SLinus Torvalds 
14831da177e4SLinus Torvalds 	while ((skb = __skb_dequeue_tail(&sk->sk_write_queue)) != NULL) {
1484e1f52208SYOSHIFUJI Hideaki 		if (skb->dst)
1485a11d206dSYOSHIFUJI Hideaki 			IP6_INC_STATS(ip6_dst_idev(skb->dst),
1486a11d206dSYOSHIFUJI Hideaki 				      IPSTATS_MIB_OUTDISCARDS);
14871da177e4SLinus Torvalds 		kfree_skb(skb);
14881da177e4SLinus Torvalds 	}
14891da177e4SLinus Torvalds 
1490bf138862SPavel Emelyanov 	ip6_cork_release(inet_sk(sk), inet6_sk(sk));
14911da177e4SLinus Torvalds }
1492