xref: /openbmc/linux/net/ipv6/ip6_output.c (revision 1e5dc146173251e7baad9a1f7586d5a009b6d9f9)
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  *	$Id: ip6_output.c,v 1.34 2002/02/01 22:01:04 davem Exp $
91da177e4SLinus Torvalds  *
101da177e4SLinus Torvalds  *	Based on linux/net/ipv4/ip_output.c
111da177e4SLinus Torvalds  *
121da177e4SLinus Torvalds  *	This program is free software; you can redistribute it and/or
131da177e4SLinus Torvalds  *      modify it under the terms of the GNU General Public License
141da177e4SLinus Torvalds  *      as published by the Free Software Foundation; either version
151da177e4SLinus Torvalds  *      2 of the License, or (at your option) any later version.
161da177e4SLinus Torvalds  *
171da177e4SLinus Torvalds  *	Changes:
181da177e4SLinus Torvalds  *	A.N.Kuznetsov	:	airthmetics in fragmentation.
191da177e4SLinus Torvalds  *				extension headers are implemented.
201da177e4SLinus Torvalds  *				route changes now work.
211da177e4SLinus Torvalds  *				ip6_forward does not confuse sniffers.
221da177e4SLinus Torvalds  *				etc.
231da177e4SLinus Torvalds  *
241da177e4SLinus Torvalds  *      H. von Brand    :       Added missing #include <linux/string.h>
251da177e4SLinus Torvalds  *	Imran Patel	: 	frag id should be in NBO
261da177e4SLinus Torvalds  *      Kazunori MIYAZAWA @USAGI
271da177e4SLinus Torvalds  *			:       add ip6_append_data and related functions
281da177e4SLinus Torvalds  *				for datagram xmit
291da177e4SLinus Torvalds  */
301da177e4SLinus Torvalds 
311da177e4SLinus Torvalds #include <linux/errno.h>
321da177e4SLinus Torvalds #include <linux/types.h>
331da177e4SLinus Torvalds #include <linux/string.h>
341da177e4SLinus Torvalds #include <linux/socket.h>
351da177e4SLinus Torvalds #include <linux/net.h>
361da177e4SLinus Torvalds #include <linux/netdevice.h>
371da177e4SLinus Torvalds #include <linux/if_arp.h>
381da177e4SLinus Torvalds #include <linux/in6.h>
391da177e4SLinus Torvalds #include <linux/tcp.h>
401da177e4SLinus Torvalds #include <linux/route.h>
41b59f45d0SHerbert Xu #include <linux/module.h>
421da177e4SLinus Torvalds 
431da177e4SLinus Torvalds #include <linux/netfilter.h>
441da177e4SLinus Torvalds #include <linux/netfilter_ipv6.h>
451da177e4SLinus Torvalds 
461da177e4SLinus Torvalds #include <net/sock.h>
471da177e4SLinus Torvalds #include <net/snmp.h>
481da177e4SLinus Torvalds 
491da177e4SLinus Torvalds #include <net/ipv6.h>
501da177e4SLinus Torvalds #include <net/ndisc.h>
511da177e4SLinus Torvalds #include <net/protocol.h>
521da177e4SLinus Torvalds #include <net/ip6_route.h>
531da177e4SLinus Torvalds #include <net/addrconf.h>
541da177e4SLinus Torvalds #include <net/rawv6.h>
551da177e4SLinus Torvalds #include <net/icmp.h>
561da177e4SLinus Torvalds #include <net/xfrm.h>
571da177e4SLinus Torvalds #include <net/checksum.h>
581da177e4SLinus Torvalds 
591da177e4SLinus Torvalds static int ip6_fragment(struct sk_buff *skb, int (*output)(struct sk_buff *));
601da177e4SLinus Torvalds 
611da177e4SLinus Torvalds static __inline__ void ipv6_select_ident(struct sk_buff *skb, struct frag_hdr *fhdr)
621da177e4SLinus Torvalds {
631da177e4SLinus Torvalds 	static u32 ipv6_fragmentation_id = 1;
641da177e4SLinus Torvalds 	static DEFINE_SPINLOCK(ip6_id_lock);
651da177e4SLinus Torvalds 
661da177e4SLinus Torvalds 	spin_lock_bh(&ip6_id_lock);
671da177e4SLinus Torvalds 	fhdr->identification = htonl(ipv6_fragmentation_id);
681da177e4SLinus Torvalds 	if (++ipv6_fragmentation_id == 0)
691da177e4SLinus Torvalds 		ipv6_fragmentation_id = 1;
701da177e4SLinus Torvalds 	spin_unlock_bh(&ip6_id_lock);
711da177e4SLinus Torvalds }
721da177e4SLinus Torvalds 
731da177e4SLinus Torvalds static inline int ip6_output_finish(struct sk_buff *skb)
741da177e4SLinus Torvalds {
751da177e4SLinus Torvalds 	struct dst_entry *dst = skb->dst;
761da177e4SLinus Torvalds 
773644f0ceSStephen Hemminger 	if (dst->hh)
783644f0ceSStephen Hemminger 		return neigh_hh_output(dst->hh, skb);
793644f0ceSStephen Hemminger 	else if (dst->neighbour)
801da177e4SLinus Torvalds 		return dst->neighbour->output(skb);
811da177e4SLinus Torvalds 
82a11d206dSYOSHIFUJI Hideaki 	IP6_INC_STATS_BH(ip6_dst_idev(dst), IPSTATS_MIB_OUTNOROUTES);
831da177e4SLinus Torvalds 	kfree_skb(skb);
841da177e4SLinus Torvalds 	return -EINVAL;
851da177e4SLinus Torvalds 
861da177e4SLinus Torvalds }
871da177e4SLinus Torvalds 
881da177e4SLinus Torvalds /* dev_loopback_xmit for use with netfilter. */
891da177e4SLinus Torvalds static int ip6_dev_loopback_xmit(struct sk_buff *newskb)
901da177e4SLinus Torvalds {
91459a98edSArnaldo Carvalho de Melo 	skb_reset_mac_header(newskb);
92bbe735e4SArnaldo Carvalho de Melo 	__skb_pull(newskb, skb_network_offset(newskb));
931da177e4SLinus Torvalds 	newskb->pkt_type = PACKET_LOOPBACK;
941da177e4SLinus Torvalds 	newskb->ip_summed = CHECKSUM_UNNECESSARY;
951da177e4SLinus Torvalds 	BUG_TRAP(newskb->dst);
961da177e4SLinus Torvalds 
971da177e4SLinus Torvalds 	netif_rx(newskb);
981da177e4SLinus Torvalds 	return 0;
991da177e4SLinus Torvalds }
1001da177e4SLinus Torvalds 
1011da177e4SLinus Torvalds 
1021da177e4SLinus Torvalds static int ip6_output2(struct sk_buff *skb)
1031da177e4SLinus Torvalds {
1041da177e4SLinus Torvalds 	struct dst_entry *dst = skb->dst;
1051da177e4SLinus Torvalds 	struct net_device *dev = dst->dev;
1061da177e4SLinus Torvalds 
1071da177e4SLinus Torvalds 	skb->protocol = htons(ETH_P_IPV6);
1081da177e4SLinus Torvalds 	skb->dev = dev;
1091da177e4SLinus Torvalds 
1100660e03fSArnaldo Carvalho de Melo 	if (ipv6_addr_is_multicast(&ipv6_hdr(skb)->daddr)) {
1111da177e4SLinus Torvalds 		struct ipv6_pinfo* np = skb->sk ? inet6_sk(skb->sk) : NULL;
112a11d206dSYOSHIFUJI Hideaki 		struct inet6_dev *idev = ip6_dst_idev(skb->dst);
1131da177e4SLinus Torvalds 
1141da177e4SLinus Torvalds 		if (!(dev->flags & IFF_LOOPBACK) && (!np || np->mc_loop) &&
1150660e03fSArnaldo Carvalho de Melo 		    ipv6_chk_mcast_addr(dev, &ipv6_hdr(skb)->daddr,
1160660e03fSArnaldo Carvalho de Melo 					&ipv6_hdr(skb)->saddr)) {
1171da177e4SLinus Torvalds 			struct sk_buff *newskb = skb_clone(skb, GFP_ATOMIC);
1181da177e4SLinus Torvalds 
1191da177e4SLinus Torvalds 			/* Do not check for IFF_ALLMULTI; multicast routing
1201da177e4SLinus Torvalds 			   is not supported in any case.
1211da177e4SLinus Torvalds 			 */
1221da177e4SLinus Torvalds 			if (newskb)
1231da177e4SLinus Torvalds 				NF_HOOK(PF_INET6, NF_IP6_POST_ROUTING, newskb, NULL,
1241da177e4SLinus Torvalds 					newskb->dev,
1251da177e4SLinus Torvalds 					ip6_dev_loopback_xmit);
1261da177e4SLinus Torvalds 
1270660e03fSArnaldo Carvalho de Melo 			if (ipv6_hdr(skb)->hop_limit == 0) {
128a11d206dSYOSHIFUJI Hideaki 				IP6_INC_STATS(idev, IPSTATS_MIB_OUTDISCARDS);
1291da177e4SLinus Torvalds 				kfree_skb(skb);
1301da177e4SLinus Torvalds 				return 0;
1311da177e4SLinus Torvalds 			}
1321da177e4SLinus Torvalds 		}
1331da177e4SLinus Torvalds 
134a11d206dSYOSHIFUJI Hideaki 		IP6_INC_STATS(idev, IPSTATS_MIB_OUTMCASTPKTS);
1351da177e4SLinus Torvalds 	}
1361da177e4SLinus Torvalds 
1371da177e4SLinus Torvalds 	return NF_HOOK(PF_INET6, NF_IP6_POST_ROUTING, skb,NULL, skb->dev,ip6_output_finish);
1381da177e4SLinus Torvalds }
1391da177e4SLinus Torvalds 
140628a5c56SJohn Heffner static inline int ip6_skb_dst_mtu(struct sk_buff *skb)
141628a5c56SJohn Heffner {
142628a5c56SJohn Heffner 	struct ipv6_pinfo *np = skb->sk ? inet6_sk(skb->sk) : NULL;
143628a5c56SJohn Heffner 
144628a5c56SJohn Heffner 	return (np && np->pmtudisc == IPV6_PMTUDISC_PROBE) ?
145628a5c56SJohn Heffner 	       skb->dst->dev->mtu : dst_mtu(skb->dst);
146628a5c56SJohn Heffner }
147628a5c56SJohn Heffner 
1481da177e4SLinus Torvalds int ip6_output(struct sk_buff *skb)
1491da177e4SLinus Torvalds {
150628a5c56SJohn Heffner 	if ((skb->len > ip6_skb_dst_mtu(skb) && !skb_is_gso(skb)) ||
151e89e9cf5SAnanda Raju 				dst_allfrag(skb->dst))
1521da177e4SLinus Torvalds 		return ip6_fragment(skb, ip6_output2);
1531da177e4SLinus Torvalds 	else
1541da177e4SLinus Torvalds 		return ip6_output2(skb);
1551da177e4SLinus Torvalds }
1561da177e4SLinus Torvalds 
1571da177e4SLinus Torvalds /*
1581da177e4SLinus Torvalds  *	xmit an sk_buff (used by TCP)
1591da177e4SLinus Torvalds  */
1601da177e4SLinus Torvalds 
1611da177e4SLinus Torvalds int ip6_xmit(struct sock *sk, struct sk_buff *skb, struct flowi *fl,
1621da177e4SLinus Torvalds 	     struct ipv6_txoptions *opt, int ipfragok)
1631da177e4SLinus Torvalds {
164b30bd282SPatrick McHardy 	struct ipv6_pinfo *np = inet6_sk(sk);
1651da177e4SLinus Torvalds 	struct in6_addr *first_hop = &fl->fl6_dst;
1661da177e4SLinus Torvalds 	struct dst_entry *dst = skb->dst;
1671da177e4SLinus Torvalds 	struct ipv6hdr *hdr;
1681da177e4SLinus Torvalds 	u8  proto = fl->proto;
1691da177e4SLinus Torvalds 	int seg_len = skb->len;
17041a1f8eaSYOSHIFUJI Hideaki 	int hlimit, tclass;
1711da177e4SLinus Torvalds 	u32 mtu;
1721da177e4SLinus Torvalds 
1731da177e4SLinus Torvalds 	if (opt) {
1741da177e4SLinus Torvalds 		int head_room;
1751da177e4SLinus Torvalds 
1761da177e4SLinus Torvalds 		/* First: exthdrs may take lots of space (~8K for now)
1771da177e4SLinus Torvalds 		   MAX_HEADER is not enough.
1781da177e4SLinus Torvalds 		 */
1791da177e4SLinus Torvalds 		head_room = opt->opt_nflen + opt->opt_flen;
1801da177e4SLinus Torvalds 		seg_len += head_room;
1811da177e4SLinus Torvalds 		head_room += sizeof(struct ipv6hdr) + LL_RESERVED_SPACE(dst->dev);
1821da177e4SLinus Torvalds 
1831da177e4SLinus Torvalds 		if (skb_headroom(skb) < head_room) {
1841da177e4SLinus Torvalds 			struct sk_buff *skb2 = skb_realloc_headroom(skb, head_room);
185a11d206dSYOSHIFUJI Hideaki 			if (skb2 == NULL) {
186a11d206dSYOSHIFUJI Hideaki 				IP6_INC_STATS(ip6_dst_idev(skb->dst),
187a11d206dSYOSHIFUJI Hideaki 					      IPSTATS_MIB_OUTDISCARDS);
1881da177e4SLinus Torvalds 				kfree_skb(skb);
1891da177e4SLinus Torvalds 				return -ENOBUFS;
1901da177e4SLinus Torvalds 			}
191a11d206dSYOSHIFUJI Hideaki 			kfree_skb(skb);
192a11d206dSYOSHIFUJI Hideaki 			skb = skb2;
1931da177e4SLinus Torvalds 			if (sk)
1941da177e4SLinus Torvalds 				skb_set_owner_w(skb, sk);
1951da177e4SLinus Torvalds 		}
1961da177e4SLinus Torvalds 		if (opt->opt_flen)
1971da177e4SLinus Torvalds 			ipv6_push_frag_opts(skb, opt, &proto);
1981da177e4SLinus Torvalds 		if (opt->opt_nflen)
1991da177e4SLinus Torvalds 			ipv6_push_nfrag_opts(skb, opt, &proto, &first_hop);
2001da177e4SLinus Torvalds 	}
2011da177e4SLinus Torvalds 
202e2d1bca7SArnaldo Carvalho de Melo 	skb_push(skb, sizeof(struct ipv6hdr));
203e2d1bca7SArnaldo Carvalho de Melo 	skb_reset_network_header(skb);
2040660e03fSArnaldo Carvalho de Melo 	hdr = ipv6_hdr(skb);
2051da177e4SLinus Torvalds 
2061da177e4SLinus Torvalds 	/*
2071da177e4SLinus Torvalds 	 *	Fill in the IPv6 header
2081da177e4SLinus Torvalds 	 */
2091da177e4SLinus Torvalds 
2101da177e4SLinus Torvalds 	hlimit = -1;
2111da177e4SLinus Torvalds 	if (np)
2121da177e4SLinus Torvalds 		hlimit = np->hop_limit;
2131da177e4SLinus Torvalds 	if (hlimit < 0)
2141da177e4SLinus Torvalds 		hlimit = dst_metric(dst, RTAX_HOPLIMIT);
2151da177e4SLinus Torvalds 	if (hlimit < 0)
2161da177e4SLinus Torvalds 		hlimit = ipv6_get_hoplimit(dst->dev);
2171da177e4SLinus Torvalds 
21841a1f8eaSYOSHIFUJI Hideaki 	tclass = -1;
21941a1f8eaSYOSHIFUJI Hideaki 	if (np)
22041a1f8eaSYOSHIFUJI Hideaki 		tclass = np->tclass;
22141a1f8eaSYOSHIFUJI Hideaki 	if (tclass < 0)
22241a1f8eaSYOSHIFUJI Hideaki 		tclass = 0;
22341a1f8eaSYOSHIFUJI Hideaki 
22490bcaf7bSAl Viro 	*(__be32 *)hdr = htonl(0x60000000 | (tclass << 20)) | fl->fl6_flowlabel;
22541a1f8eaSYOSHIFUJI Hideaki 
2261da177e4SLinus Torvalds 	hdr->payload_len = htons(seg_len);
2271da177e4SLinus Torvalds 	hdr->nexthdr = proto;
2281da177e4SLinus Torvalds 	hdr->hop_limit = hlimit;
2291da177e4SLinus Torvalds 
2301da177e4SLinus Torvalds 	ipv6_addr_copy(&hdr->saddr, &fl->fl6_src);
2311da177e4SLinus Torvalds 	ipv6_addr_copy(&hdr->daddr, first_hop);
2321da177e4SLinus Torvalds 
233a2c2064fSPatrick McHardy 	skb->priority = sk->sk_priority;
234a2c2064fSPatrick McHardy 
2351da177e4SLinus Torvalds 	mtu = dst_mtu(dst);
23689114afdSHerbert Xu 	if ((skb->len <= mtu) || ipfragok || skb_is_gso(skb)) {
237a11d206dSYOSHIFUJI Hideaki 		IP6_INC_STATS(ip6_dst_idev(skb->dst),
238a11d206dSYOSHIFUJI Hideaki 			      IPSTATS_MIB_OUTREQUESTS);
2396869c4d8SHarald Welte 		return NF_HOOK(PF_INET6, NF_IP6_LOCAL_OUT, skb, NULL, dst->dev,
2406869c4d8SHarald Welte 				dst_output);
2411da177e4SLinus Torvalds 	}
2421da177e4SLinus Torvalds 
2431da177e4SLinus Torvalds 	if (net_ratelimit())
2441da177e4SLinus Torvalds 		printk(KERN_DEBUG "IPv6: sending pkt_too_big to self\n");
2451da177e4SLinus Torvalds 	skb->dev = dst->dev;
2461da177e4SLinus Torvalds 	icmpv6_send(skb, ICMPV6_PKT_TOOBIG, 0, mtu, skb->dev);
247a11d206dSYOSHIFUJI Hideaki 	IP6_INC_STATS(ip6_dst_idev(skb->dst), IPSTATS_MIB_FRAGFAILS);
2481da177e4SLinus Torvalds 	kfree_skb(skb);
2491da177e4SLinus Torvalds 	return -EMSGSIZE;
2501da177e4SLinus Torvalds }
2511da177e4SLinus Torvalds 
2527159039aSYOSHIFUJI Hideaki EXPORT_SYMBOL(ip6_xmit);
2537159039aSYOSHIFUJI Hideaki 
2541da177e4SLinus Torvalds /*
2551da177e4SLinus Torvalds  *	To avoid extra problems ND packets are send through this
2561da177e4SLinus Torvalds  *	routine. It's code duplication but I really want to avoid
2571da177e4SLinus Torvalds  *	extra checks since ipv6_build_header is used by TCP (which
2581da177e4SLinus Torvalds  *	is for us performance critical)
2591da177e4SLinus Torvalds  */
2601da177e4SLinus Torvalds 
2611da177e4SLinus Torvalds int ip6_nd_hdr(struct sock *sk, struct sk_buff *skb, struct net_device *dev,
2621da177e4SLinus Torvalds 	       struct in6_addr *saddr, struct in6_addr *daddr,
2631da177e4SLinus Torvalds 	       int proto, int len)
2641da177e4SLinus Torvalds {
2651da177e4SLinus Torvalds 	struct ipv6_pinfo *np = inet6_sk(sk);
2661da177e4SLinus Torvalds 	struct ipv6hdr *hdr;
2671da177e4SLinus Torvalds 	int totlen;
2681da177e4SLinus Torvalds 
2691da177e4SLinus Torvalds 	skb->protocol = htons(ETH_P_IPV6);
2701da177e4SLinus Torvalds 	skb->dev = dev;
2711da177e4SLinus Torvalds 
2721da177e4SLinus Torvalds 	totlen = len + sizeof(struct ipv6hdr);
2731da177e4SLinus Torvalds 
27455f79cc0SArnaldo Carvalho de Melo 	skb_reset_network_header(skb);
27555f79cc0SArnaldo Carvalho de Melo 	skb_put(skb, sizeof(struct ipv6hdr));
2760660e03fSArnaldo Carvalho de Melo 	hdr = ipv6_hdr(skb);
2771da177e4SLinus Torvalds 
278ae08e1f0SAl Viro 	*(__be32*)hdr = htonl(0x60000000);
2791da177e4SLinus Torvalds 
2801da177e4SLinus Torvalds 	hdr->payload_len = htons(len);
2811da177e4SLinus Torvalds 	hdr->nexthdr = proto;
2821da177e4SLinus Torvalds 	hdr->hop_limit = np->hop_limit;
2831da177e4SLinus Torvalds 
2841da177e4SLinus Torvalds 	ipv6_addr_copy(&hdr->saddr, saddr);
2851da177e4SLinus Torvalds 	ipv6_addr_copy(&hdr->daddr, daddr);
2861da177e4SLinus Torvalds 
2871da177e4SLinus Torvalds 	return 0;
2881da177e4SLinus Torvalds }
2891da177e4SLinus Torvalds 
2901da177e4SLinus Torvalds static int ip6_call_ra_chain(struct sk_buff *skb, int sel)
2911da177e4SLinus Torvalds {
2921da177e4SLinus Torvalds 	struct ip6_ra_chain *ra;
2931da177e4SLinus Torvalds 	struct sock *last = NULL;
2941da177e4SLinus Torvalds 
2951da177e4SLinus Torvalds 	read_lock(&ip6_ra_lock);
2961da177e4SLinus Torvalds 	for (ra = ip6_ra_chain; ra; ra = ra->next) {
2971da177e4SLinus Torvalds 		struct sock *sk = ra->sk;
2980bd1b59bSAndrew McDonald 		if (sk && ra->sel == sel &&
2990bd1b59bSAndrew McDonald 		    (!sk->sk_bound_dev_if ||
3000bd1b59bSAndrew McDonald 		     sk->sk_bound_dev_if == skb->dev->ifindex)) {
3011da177e4SLinus Torvalds 			if (last) {
3021da177e4SLinus Torvalds 				struct sk_buff *skb2 = skb_clone(skb, GFP_ATOMIC);
3031da177e4SLinus Torvalds 				if (skb2)
3041da177e4SLinus Torvalds 					rawv6_rcv(last, skb2);
3051da177e4SLinus Torvalds 			}
3061da177e4SLinus Torvalds 			last = sk;
3071da177e4SLinus Torvalds 		}
3081da177e4SLinus Torvalds 	}
3091da177e4SLinus Torvalds 
3101da177e4SLinus Torvalds 	if (last) {
3111da177e4SLinus Torvalds 		rawv6_rcv(last, skb);
3121da177e4SLinus Torvalds 		read_unlock(&ip6_ra_lock);
3131da177e4SLinus Torvalds 		return 1;
3141da177e4SLinus Torvalds 	}
3151da177e4SLinus Torvalds 	read_unlock(&ip6_ra_lock);
3161da177e4SLinus Torvalds 	return 0;
3171da177e4SLinus Torvalds }
3181da177e4SLinus Torvalds 
319e21e0b5fSVille Nuorvala static int ip6_forward_proxy_check(struct sk_buff *skb)
320e21e0b5fSVille Nuorvala {
3210660e03fSArnaldo Carvalho de Melo 	struct ipv6hdr *hdr = ipv6_hdr(skb);
322e21e0b5fSVille Nuorvala 	u8 nexthdr = hdr->nexthdr;
323e21e0b5fSVille Nuorvala 	int offset;
324e21e0b5fSVille Nuorvala 
325e21e0b5fSVille Nuorvala 	if (ipv6_ext_hdr(nexthdr)) {
326e21e0b5fSVille Nuorvala 		offset = ipv6_skip_exthdr(skb, sizeof(*hdr), &nexthdr);
327e21e0b5fSVille Nuorvala 		if (offset < 0)
328e21e0b5fSVille Nuorvala 			return 0;
329e21e0b5fSVille Nuorvala 	} else
330e21e0b5fSVille Nuorvala 		offset = sizeof(struct ipv6hdr);
331e21e0b5fSVille Nuorvala 
332e21e0b5fSVille Nuorvala 	if (nexthdr == IPPROTO_ICMPV6) {
333e21e0b5fSVille Nuorvala 		struct icmp6hdr *icmp6;
334e21e0b5fSVille Nuorvala 
335d56f90a7SArnaldo Carvalho de Melo 		if (!pskb_may_pull(skb, (skb_network_header(skb) +
336d56f90a7SArnaldo Carvalho de Melo 					 offset + 1 - skb->data)))
337e21e0b5fSVille Nuorvala 			return 0;
338e21e0b5fSVille Nuorvala 
339d56f90a7SArnaldo Carvalho de Melo 		icmp6 = (struct icmp6hdr *)(skb_network_header(skb) + offset);
340e21e0b5fSVille Nuorvala 
341e21e0b5fSVille Nuorvala 		switch (icmp6->icmp6_type) {
342e21e0b5fSVille Nuorvala 		case NDISC_ROUTER_SOLICITATION:
343e21e0b5fSVille Nuorvala 		case NDISC_ROUTER_ADVERTISEMENT:
344e21e0b5fSVille Nuorvala 		case NDISC_NEIGHBOUR_SOLICITATION:
345e21e0b5fSVille Nuorvala 		case NDISC_NEIGHBOUR_ADVERTISEMENT:
346e21e0b5fSVille Nuorvala 		case NDISC_REDIRECT:
347e21e0b5fSVille Nuorvala 			/* For reaction involving unicast neighbor discovery
348e21e0b5fSVille Nuorvala 			 * message destined to the proxied address, pass it to
349e21e0b5fSVille Nuorvala 			 * input function.
350e21e0b5fSVille Nuorvala 			 */
351e21e0b5fSVille Nuorvala 			return 1;
352e21e0b5fSVille Nuorvala 		default:
353e21e0b5fSVille Nuorvala 			break;
354e21e0b5fSVille Nuorvala 		}
355e21e0b5fSVille Nuorvala 	}
356e21e0b5fSVille Nuorvala 
35774553b09SVille Nuorvala 	/*
35874553b09SVille Nuorvala 	 * The proxying router can't forward traffic sent to a link-local
35974553b09SVille Nuorvala 	 * address, so signal the sender and discard the packet. This
36074553b09SVille Nuorvala 	 * behavior is clarified by the MIPv6 specification.
36174553b09SVille Nuorvala 	 */
36274553b09SVille Nuorvala 	if (ipv6_addr_type(&hdr->daddr) & IPV6_ADDR_LINKLOCAL) {
36374553b09SVille Nuorvala 		dst_link_failure(skb);
36474553b09SVille Nuorvala 		return -1;
36574553b09SVille Nuorvala 	}
36674553b09SVille Nuorvala 
367e21e0b5fSVille Nuorvala 	return 0;
368e21e0b5fSVille Nuorvala }
369e21e0b5fSVille Nuorvala 
3701da177e4SLinus Torvalds static inline int ip6_forward_finish(struct sk_buff *skb)
3711da177e4SLinus Torvalds {
3721da177e4SLinus Torvalds 	return dst_output(skb);
3731da177e4SLinus Torvalds }
3741da177e4SLinus Torvalds 
3751da177e4SLinus Torvalds int ip6_forward(struct sk_buff *skb)
3761da177e4SLinus Torvalds {
3771da177e4SLinus Torvalds 	struct dst_entry *dst = skb->dst;
3780660e03fSArnaldo Carvalho de Melo 	struct ipv6hdr *hdr = ipv6_hdr(skb);
3791da177e4SLinus Torvalds 	struct inet6_skb_parm *opt = IP6CB(skb);
3801da177e4SLinus Torvalds 
3811da177e4SLinus Torvalds 	if (ipv6_devconf.forwarding == 0)
3821da177e4SLinus Torvalds 		goto error;
3831da177e4SLinus Torvalds 
3841da177e4SLinus Torvalds 	if (!xfrm6_policy_check(NULL, XFRM_POLICY_FWD, skb)) {
385a11d206dSYOSHIFUJI Hideaki 		IP6_INC_STATS(ip6_dst_idev(dst), IPSTATS_MIB_INDISCARDS);
3861da177e4SLinus Torvalds 		goto drop;
3871da177e4SLinus Torvalds 	}
3881da177e4SLinus Torvalds 
38935fc92a9SHerbert Xu 	skb_forward_csum(skb);
3901da177e4SLinus Torvalds 
3911da177e4SLinus Torvalds 	/*
3921da177e4SLinus Torvalds 	 *	We DO NOT make any processing on
3931da177e4SLinus Torvalds 	 *	RA packets, pushing them to user level AS IS
3941da177e4SLinus Torvalds 	 *	without ane WARRANTY that application will be able
3951da177e4SLinus Torvalds 	 *	to interpret them. The reason is that we
3961da177e4SLinus Torvalds 	 *	cannot make anything clever here.
3971da177e4SLinus Torvalds 	 *
3981da177e4SLinus Torvalds 	 *	We are not end-node, so that if packet contains
3991da177e4SLinus Torvalds 	 *	AH/ESP, we cannot make anything.
4001da177e4SLinus Torvalds 	 *	Defragmentation also would be mistake, RA packets
4011da177e4SLinus Torvalds 	 *	cannot be fragmented, because there is no warranty
4021da177e4SLinus Torvalds 	 *	that different fragments will go along one path. --ANK
4031da177e4SLinus Torvalds 	 */
4041da177e4SLinus Torvalds 	if (opt->ra) {
405d56f90a7SArnaldo Carvalho de Melo 		u8 *ptr = skb_network_header(skb) + opt->ra;
4061da177e4SLinus Torvalds 		if (ip6_call_ra_chain(skb, (ptr[2]<<8) + ptr[3]))
4071da177e4SLinus Torvalds 			return 0;
4081da177e4SLinus Torvalds 	}
4091da177e4SLinus Torvalds 
4101da177e4SLinus Torvalds 	/*
4111da177e4SLinus Torvalds 	 *	check and decrement ttl
4121da177e4SLinus Torvalds 	 */
4131da177e4SLinus Torvalds 	if (hdr->hop_limit <= 1) {
4141da177e4SLinus Torvalds 		/* Force OUTPUT device used as source address */
4151da177e4SLinus Torvalds 		skb->dev = dst->dev;
4161da177e4SLinus Torvalds 		icmpv6_send(skb, ICMPV6_TIME_EXCEED, ICMPV6_EXC_HOPLIMIT,
4171da177e4SLinus Torvalds 			    0, skb->dev);
418a11d206dSYOSHIFUJI Hideaki 		IP6_INC_STATS_BH(ip6_dst_idev(dst), IPSTATS_MIB_INHDRERRORS);
4191da177e4SLinus Torvalds 
4201da177e4SLinus Torvalds 		kfree_skb(skb);
4211da177e4SLinus Torvalds 		return -ETIMEDOUT;
4221da177e4SLinus Torvalds 	}
4231da177e4SLinus Torvalds 
424fbea49e1SYOSHIFUJI Hideaki 	/* XXX: idev->cnf.proxy_ndp? */
425fbea49e1SYOSHIFUJI Hideaki 	if (ipv6_devconf.proxy_ndp &&
426fbea49e1SYOSHIFUJI Hideaki 	    pneigh_lookup(&nd_tbl, &hdr->daddr, skb->dev, 0)) {
42774553b09SVille Nuorvala 		int proxied = ip6_forward_proxy_check(skb);
42874553b09SVille Nuorvala 		if (proxied > 0)
429e21e0b5fSVille Nuorvala 			return ip6_input(skb);
43074553b09SVille Nuorvala 		else if (proxied < 0) {
431a11d206dSYOSHIFUJI Hideaki 			IP6_INC_STATS(ip6_dst_idev(dst), IPSTATS_MIB_INDISCARDS);
43274553b09SVille Nuorvala 			goto drop;
43374553b09SVille Nuorvala 		}
434e21e0b5fSVille Nuorvala 	}
435e21e0b5fSVille Nuorvala 
4361da177e4SLinus Torvalds 	if (!xfrm6_route_forward(skb)) {
437a11d206dSYOSHIFUJI Hideaki 		IP6_INC_STATS(ip6_dst_idev(dst), IPSTATS_MIB_INDISCARDS);
4381da177e4SLinus Torvalds 		goto drop;
4391da177e4SLinus Torvalds 	}
4401da177e4SLinus Torvalds 	dst = skb->dst;
4411da177e4SLinus Torvalds 
4421da177e4SLinus Torvalds 	/* IPv6 specs say nothing about it, but it is clear that we cannot
4431da177e4SLinus Torvalds 	   send redirects to source routed frames.
444*1e5dc146SMasahide NAKAMURA 	   We don't send redirects to frames decapsulated from IPsec.
4451da177e4SLinus Torvalds 	 */
446*1e5dc146SMasahide NAKAMURA 	if (skb->dev == dst->dev && dst->neighbour && opt->srcrt == 0 &&
447*1e5dc146SMasahide NAKAMURA 	    !skb->sp) {
4481da177e4SLinus Torvalds 		struct in6_addr *target = NULL;
4491da177e4SLinus Torvalds 		struct rt6_info *rt;
4501da177e4SLinus Torvalds 		struct neighbour *n = dst->neighbour;
4511da177e4SLinus Torvalds 
4521da177e4SLinus Torvalds 		/*
4531da177e4SLinus Torvalds 		 *	incoming and outgoing devices are the same
4541da177e4SLinus Torvalds 		 *	send a redirect.
4551da177e4SLinus Torvalds 		 */
4561da177e4SLinus Torvalds 
4571da177e4SLinus Torvalds 		rt = (struct rt6_info *) dst;
4581da177e4SLinus Torvalds 		if ((rt->rt6i_flags & RTF_GATEWAY))
4591da177e4SLinus Torvalds 			target = (struct in6_addr*)&n->primary_key;
4601da177e4SLinus Torvalds 		else
4611da177e4SLinus Torvalds 			target = &hdr->daddr;
4621da177e4SLinus Torvalds 
4631da177e4SLinus Torvalds 		/* Limit redirects both by destination (here)
4641da177e4SLinus Torvalds 		   and by source (inside ndisc_send_redirect)
4651da177e4SLinus Torvalds 		 */
4661da177e4SLinus Torvalds 		if (xrlim_allow(dst, 1*HZ))
4671da177e4SLinus Torvalds 			ndisc_send_redirect(skb, n, target);
4685bb1ab09SDavid L Stevens 	} else {
4695bb1ab09SDavid L Stevens 		int addrtype = ipv6_addr_type(&hdr->saddr);
4705bb1ab09SDavid L Stevens 
4711da177e4SLinus Torvalds 		/* This check is security critical. */
4725bb1ab09SDavid L Stevens 		if (addrtype & (IPV6_ADDR_MULTICAST|IPV6_ADDR_LOOPBACK))
4731da177e4SLinus Torvalds 			goto error;
4745bb1ab09SDavid L Stevens 		if (addrtype & IPV6_ADDR_LINKLOCAL) {
4755bb1ab09SDavid L Stevens 			icmpv6_send(skb, ICMPV6_DEST_UNREACH,
4765bb1ab09SDavid L Stevens 				ICMPV6_NOT_NEIGHBOUR, 0, skb->dev);
4775bb1ab09SDavid L Stevens 			goto error;
4785bb1ab09SDavid L Stevens 		}
4791da177e4SLinus Torvalds 	}
4801da177e4SLinus Torvalds 
4811da177e4SLinus Torvalds 	if (skb->len > dst_mtu(dst)) {
4821da177e4SLinus Torvalds 		/* Again, force OUTPUT device used as source address */
4831da177e4SLinus Torvalds 		skb->dev = dst->dev;
4841da177e4SLinus Torvalds 		icmpv6_send(skb, ICMPV6_PKT_TOOBIG, 0, dst_mtu(dst), skb->dev);
485a11d206dSYOSHIFUJI Hideaki 		IP6_INC_STATS_BH(ip6_dst_idev(dst), IPSTATS_MIB_INTOOBIGERRORS);
486a11d206dSYOSHIFUJI Hideaki 		IP6_INC_STATS_BH(ip6_dst_idev(dst), IPSTATS_MIB_FRAGFAILS);
4871da177e4SLinus Torvalds 		kfree_skb(skb);
4881da177e4SLinus Torvalds 		return -EMSGSIZE;
4891da177e4SLinus Torvalds 	}
4901da177e4SLinus Torvalds 
4911da177e4SLinus Torvalds 	if (skb_cow(skb, dst->dev->hard_header_len)) {
492a11d206dSYOSHIFUJI Hideaki 		IP6_INC_STATS(ip6_dst_idev(dst), IPSTATS_MIB_OUTDISCARDS);
4931da177e4SLinus Torvalds 		goto drop;
4941da177e4SLinus Torvalds 	}
4951da177e4SLinus Torvalds 
4960660e03fSArnaldo Carvalho de Melo 	hdr = ipv6_hdr(skb);
4971da177e4SLinus Torvalds 
4981da177e4SLinus Torvalds 	/* Mangling hops number delayed to point after skb COW */
4991da177e4SLinus Torvalds 
5001da177e4SLinus Torvalds 	hdr->hop_limit--;
5011da177e4SLinus Torvalds 
502a11d206dSYOSHIFUJI Hideaki 	IP6_INC_STATS_BH(ip6_dst_idev(dst), IPSTATS_MIB_OUTFORWDATAGRAMS);
5031da177e4SLinus Torvalds 	return NF_HOOK(PF_INET6,NF_IP6_FORWARD, skb, skb->dev, dst->dev, ip6_forward_finish);
5041da177e4SLinus Torvalds 
5051da177e4SLinus Torvalds error:
506a11d206dSYOSHIFUJI Hideaki 	IP6_INC_STATS_BH(ip6_dst_idev(dst), IPSTATS_MIB_INADDRERRORS);
5071da177e4SLinus Torvalds drop:
5081da177e4SLinus Torvalds 	kfree_skb(skb);
5091da177e4SLinus Torvalds 	return -EINVAL;
5101da177e4SLinus Torvalds }
5111da177e4SLinus Torvalds 
5121da177e4SLinus Torvalds static void ip6_copy_metadata(struct sk_buff *to, struct sk_buff *from)
5131da177e4SLinus Torvalds {
5141da177e4SLinus Torvalds 	to->pkt_type = from->pkt_type;
5151da177e4SLinus Torvalds 	to->priority = from->priority;
5161da177e4SLinus Torvalds 	to->protocol = from->protocol;
5171da177e4SLinus Torvalds 	dst_release(to->dst);
5181da177e4SLinus Torvalds 	to->dst = dst_clone(from->dst);
5191da177e4SLinus Torvalds 	to->dev = from->dev;
52082e91ffeSThomas Graf 	to->mark = from->mark;
5211da177e4SLinus Torvalds 
5221da177e4SLinus Torvalds #ifdef CONFIG_NET_SCHED
5231da177e4SLinus Torvalds 	to->tc_index = from->tc_index;
5241da177e4SLinus Torvalds #endif
525e7ac05f3SYasuyuki Kozakai 	nf_copy(to, from);
526ba9dda3aSJozsef Kadlecsik #if defined(CONFIG_NETFILTER_XT_TARGET_TRACE) || \
527ba9dda3aSJozsef Kadlecsik     defined(CONFIG_NETFILTER_XT_TARGET_TRACE_MODULE)
528ba9dda3aSJozsef Kadlecsik 	to->nf_trace = from->nf_trace;
529ba9dda3aSJozsef Kadlecsik #endif
530984bc16cSJames Morris 	skb_copy_secmark(to, from);
5311da177e4SLinus Torvalds }
5321da177e4SLinus Torvalds 
5331da177e4SLinus Torvalds int ip6_find_1stfragopt(struct sk_buff *skb, u8 **nexthdr)
5341da177e4SLinus Torvalds {
5351da177e4SLinus Torvalds 	u16 offset = sizeof(struct ipv6hdr);
5360660e03fSArnaldo Carvalho de Melo 	struct ipv6_opt_hdr *exthdr =
5370660e03fSArnaldo Carvalho de Melo 				(struct ipv6_opt_hdr *)(ipv6_hdr(skb) + 1);
53827a884dcSArnaldo Carvalho de Melo 	unsigned int packet_len = skb->tail - skb->network_header;
5391da177e4SLinus Torvalds 	int found_rhdr = 0;
5400660e03fSArnaldo Carvalho de Melo 	*nexthdr = &ipv6_hdr(skb)->nexthdr;
5411da177e4SLinus Torvalds 
5421da177e4SLinus Torvalds 	while (offset + 1 <= packet_len) {
5431da177e4SLinus Torvalds 
5441da177e4SLinus Torvalds 		switch (**nexthdr) {
5451da177e4SLinus Torvalds 
5461da177e4SLinus Torvalds 		case NEXTHDR_HOP:
54727637df9SMasahide NAKAMURA 			break;
5481da177e4SLinus Torvalds 		case NEXTHDR_ROUTING:
54927637df9SMasahide NAKAMURA 			found_rhdr = 1;
55027637df9SMasahide NAKAMURA 			break;
5511da177e4SLinus Torvalds 		case NEXTHDR_DEST:
55259fbb3a6SMasahide NAKAMURA #if defined(CONFIG_IPV6_MIP6) || defined(CONFIG_IPV6_MIP6_MODULE)
55327637df9SMasahide NAKAMURA 			if (ipv6_find_tlv(skb, offset, IPV6_TLV_HAO) >= 0)
55427637df9SMasahide NAKAMURA 				break;
55527637df9SMasahide NAKAMURA #endif
55627637df9SMasahide NAKAMURA 			if (found_rhdr)
55727637df9SMasahide NAKAMURA 				return offset;
5581da177e4SLinus Torvalds 			break;
5591da177e4SLinus Torvalds 		default :
5601da177e4SLinus Torvalds 			return offset;
5611da177e4SLinus Torvalds 		}
56227637df9SMasahide NAKAMURA 
56327637df9SMasahide NAKAMURA 		offset += ipv6_optlen(exthdr);
56427637df9SMasahide NAKAMURA 		*nexthdr = &exthdr->nexthdr;
565d56f90a7SArnaldo Carvalho de Melo 		exthdr = (struct ipv6_opt_hdr *)(skb_network_header(skb) +
566d56f90a7SArnaldo Carvalho de Melo 						 offset);
5671da177e4SLinus Torvalds 	}
5681da177e4SLinus Torvalds 
5691da177e4SLinus Torvalds 	return offset;
5701da177e4SLinus Torvalds }
571b59f45d0SHerbert Xu EXPORT_SYMBOL_GPL(ip6_find_1stfragopt);
5721da177e4SLinus Torvalds 
5731da177e4SLinus Torvalds static int ip6_fragment(struct sk_buff *skb, int (*output)(struct sk_buff *))
5741da177e4SLinus Torvalds {
5751da177e4SLinus Torvalds 	struct net_device *dev;
5761da177e4SLinus Torvalds 	struct sk_buff *frag;
5771da177e4SLinus Torvalds 	struct rt6_info *rt = (struct rt6_info*)skb->dst;
578d91675f9SYOSHIFUJI Hideaki 	struct ipv6_pinfo *np = skb->sk ? inet6_sk(skb->sk) : NULL;
5791da177e4SLinus Torvalds 	struct ipv6hdr *tmp_hdr;
5801da177e4SLinus Torvalds 	struct frag_hdr *fh;
5811da177e4SLinus Torvalds 	unsigned int mtu, hlen, left, len;
582ae08e1f0SAl Viro 	__be32 frag_id = 0;
5831da177e4SLinus Torvalds 	int ptr, offset = 0, err=0;
5841da177e4SLinus Torvalds 	u8 *prevhdr, nexthdr = 0;
5851da177e4SLinus Torvalds 
5861da177e4SLinus Torvalds 	dev = rt->u.dst.dev;
5871da177e4SLinus Torvalds 	hlen = ip6_find_1stfragopt(skb, &prevhdr);
5881da177e4SLinus Torvalds 	nexthdr = *prevhdr;
5891da177e4SLinus Torvalds 
590628a5c56SJohn Heffner 	mtu = ip6_skb_dst_mtu(skb);
591b881ef76SJohn Heffner 
592b881ef76SJohn Heffner 	/* We must not fragment if the socket is set to force MTU discovery
593b881ef76SJohn Heffner 	 * or if the skb it not generated by a local socket.  (This last
594b881ef76SJohn Heffner 	 * check should be redundant, but it's free.)
595b881ef76SJohn Heffner 	 */
596b881ef76SJohn Heffner 	if (!np || np->pmtudisc >= IPV6_PMTUDISC_DO) {
597b881ef76SJohn Heffner 		skb->dev = skb->dst->dev;
598b881ef76SJohn Heffner 		icmpv6_send(skb, ICMPV6_PKT_TOOBIG, 0, mtu, skb->dev);
599b881ef76SJohn Heffner 		IP6_INC_STATS(ip6_dst_idev(skb->dst), IPSTATS_MIB_FRAGFAILS);
600b881ef76SJohn Heffner 		kfree_skb(skb);
601b881ef76SJohn Heffner 		return -EMSGSIZE;
602b881ef76SJohn Heffner 	}
603b881ef76SJohn Heffner 
604d91675f9SYOSHIFUJI Hideaki 	if (np && np->frag_size < mtu) {
605d91675f9SYOSHIFUJI Hideaki 		if (np->frag_size)
606d91675f9SYOSHIFUJI Hideaki 			mtu = np->frag_size;
607d91675f9SYOSHIFUJI Hideaki 	}
608d91675f9SYOSHIFUJI Hideaki 	mtu -= hlen + sizeof(struct frag_hdr);
6091da177e4SLinus Torvalds 
6101da177e4SLinus Torvalds 	if (skb_shinfo(skb)->frag_list) {
6111da177e4SLinus Torvalds 		int first_len = skb_pagelen(skb);
6121da177e4SLinus Torvalds 
6131da177e4SLinus Torvalds 		if (first_len - hlen > mtu ||
6141da177e4SLinus Torvalds 		    ((first_len - hlen) & 7) ||
6151da177e4SLinus Torvalds 		    skb_cloned(skb))
6161da177e4SLinus Torvalds 			goto slow_path;
6171da177e4SLinus Torvalds 
6181da177e4SLinus Torvalds 		for (frag = skb_shinfo(skb)->frag_list; frag; frag = frag->next) {
6191da177e4SLinus Torvalds 			/* Correct geometry. */
6201da177e4SLinus Torvalds 			if (frag->len > mtu ||
6211da177e4SLinus Torvalds 			    ((frag->len & 7) && frag->next) ||
6221da177e4SLinus Torvalds 			    skb_headroom(frag) < hlen)
6231da177e4SLinus Torvalds 			    goto slow_path;
6241da177e4SLinus Torvalds 
6251da177e4SLinus Torvalds 			/* Partially cloned skb? */
6261da177e4SLinus Torvalds 			if (skb_shared(frag))
6271da177e4SLinus Torvalds 				goto slow_path;
6282fdba6b0SHerbert Xu 
6292fdba6b0SHerbert Xu 			BUG_ON(frag->sk);
6302fdba6b0SHerbert Xu 			if (skb->sk) {
6312fdba6b0SHerbert Xu 				sock_hold(skb->sk);
6322fdba6b0SHerbert Xu 				frag->sk = skb->sk;
6332fdba6b0SHerbert Xu 				frag->destructor = sock_wfree;
6342fdba6b0SHerbert Xu 				skb->truesize -= frag->truesize;
6352fdba6b0SHerbert Xu 			}
6361da177e4SLinus Torvalds 		}
6371da177e4SLinus Torvalds 
6381da177e4SLinus Torvalds 		err = 0;
6391da177e4SLinus Torvalds 		offset = 0;
6401da177e4SLinus Torvalds 		frag = skb_shinfo(skb)->frag_list;
6411da177e4SLinus Torvalds 		skb_shinfo(skb)->frag_list = NULL;
6421da177e4SLinus Torvalds 		/* BUILD HEADER */
6431da177e4SLinus Torvalds 
6449a217a1cSYOSHIFUJI Hideaki 		*prevhdr = NEXTHDR_FRAGMENT;
645d56f90a7SArnaldo Carvalho de Melo 		tmp_hdr = kmemdup(skb_network_header(skb), hlen, GFP_ATOMIC);
6461da177e4SLinus Torvalds 		if (!tmp_hdr) {
647a11d206dSYOSHIFUJI Hideaki 			IP6_INC_STATS(ip6_dst_idev(skb->dst), IPSTATS_MIB_FRAGFAILS);
6481da177e4SLinus Torvalds 			return -ENOMEM;
6491da177e4SLinus Torvalds 		}
6501da177e4SLinus Torvalds 
6511da177e4SLinus Torvalds 		__skb_pull(skb, hlen);
6521da177e4SLinus Torvalds 		fh = (struct frag_hdr*)__skb_push(skb, sizeof(struct frag_hdr));
653e2d1bca7SArnaldo Carvalho de Melo 		__skb_push(skb, hlen);
654e2d1bca7SArnaldo Carvalho de Melo 		skb_reset_network_header(skb);
655d56f90a7SArnaldo Carvalho de Melo 		memcpy(skb_network_header(skb), tmp_hdr, hlen);
6561da177e4SLinus Torvalds 
6571da177e4SLinus Torvalds 		ipv6_select_ident(skb, fh);
6581da177e4SLinus Torvalds 		fh->nexthdr = nexthdr;
6591da177e4SLinus Torvalds 		fh->reserved = 0;
6601da177e4SLinus Torvalds 		fh->frag_off = htons(IP6_MF);
6611da177e4SLinus Torvalds 		frag_id = fh->identification;
6621da177e4SLinus Torvalds 
6631da177e4SLinus Torvalds 		first_len = skb_pagelen(skb);
6641da177e4SLinus Torvalds 		skb->data_len = first_len - skb_headlen(skb);
6651da177e4SLinus Torvalds 		skb->len = first_len;
6660660e03fSArnaldo Carvalho de Melo 		ipv6_hdr(skb)->payload_len = htons(first_len -
6670660e03fSArnaldo Carvalho de Melo 						   sizeof(struct ipv6hdr));
6681da177e4SLinus Torvalds 
669a11d206dSYOSHIFUJI Hideaki 		dst_hold(&rt->u.dst);
6701da177e4SLinus Torvalds 
6711da177e4SLinus Torvalds 		for (;;) {
6721da177e4SLinus Torvalds 			/* Prepare header of the next frame,
6731da177e4SLinus Torvalds 			 * before previous one went down. */
6741da177e4SLinus Torvalds 			if (frag) {
6751da177e4SLinus Torvalds 				frag->ip_summed = CHECKSUM_NONE;
676badff6d0SArnaldo Carvalho de Melo 				skb_reset_transport_header(frag);
6771da177e4SLinus Torvalds 				fh = (struct frag_hdr*)__skb_push(frag, sizeof(struct frag_hdr));
678e2d1bca7SArnaldo Carvalho de Melo 				__skb_push(frag, hlen);
679e2d1bca7SArnaldo Carvalho de Melo 				skb_reset_network_header(frag);
680d56f90a7SArnaldo Carvalho de Melo 				memcpy(skb_network_header(frag), tmp_hdr,
681d56f90a7SArnaldo Carvalho de Melo 				       hlen);
6821da177e4SLinus Torvalds 				offset += skb->len - hlen - sizeof(struct frag_hdr);
6831da177e4SLinus Torvalds 				fh->nexthdr = nexthdr;
6841da177e4SLinus Torvalds 				fh->reserved = 0;
6851da177e4SLinus Torvalds 				fh->frag_off = htons(offset);
6861da177e4SLinus Torvalds 				if (frag->next != NULL)
6871da177e4SLinus Torvalds 					fh->frag_off |= htons(IP6_MF);
6881da177e4SLinus Torvalds 				fh->identification = frag_id;
6890660e03fSArnaldo Carvalho de Melo 				ipv6_hdr(frag)->payload_len =
6900660e03fSArnaldo Carvalho de Melo 						htons(frag->len -
6910660e03fSArnaldo Carvalho de Melo 						      sizeof(struct ipv6hdr));
6921da177e4SLinus Torvalds 				ip6_copy_metadata(frag, skb);
6931da177e4SLinus Torvalds 			}
6941da177e4SLinus Torvalds 
6951da177e4SLinus Torvalds 			err = output(skb);
696dafee490SWei Dong 			if(!err)
697a11d206dSYOSHIFUJI Hideaki 				IP6_INC_STATS(ip6_dst_idev(&rt->u.dst), IPSTATS_MIB_FRAGCREATES);
698dafee490SWei Dong 
6991da177e4SLinus Torvalds 			if (err || !frag)
7001da177e4SLinus Torvalds 				break;
7011da177e4SLinus Torvalds 
7021da177e4SLinus Torvalds 			skb = frag;
7031da177e4SLinus Torvalds 			frag = skb->next;
7041da177e4SLinus Torvalds 			skb->next = NULL;
7051da177e4SLinus Torvalds 		}
7061da177e4SLinus Torvalds 
7071da177e4SLinus Torvalds 		kfree(tmp_hdr);
7081da177e4SLinus Torvalds 
7091da177e4SLinus Torvalds 		if (err == 0) {
710a11d206dSYOSHIFUJI Hideaki 			IP6_INC_STATS(ip6_dst_idev(&rt->u.dst), IPSTATS_MIB_FRAGOKS);
711a11d206dSYOSHIFUJI Hideaki 			dst_release(&rt->u.dst);
7121da177e4SLinus Torvalds 			return 0;
7131da177e4SLinus Torvalds 		}
7141da177e4SLinus Torvalds 
7151da177e4SLinus Torvalds 		while (frag) {
7161da177e4SLinus Torvalds 			skb = frag->next;
7171da177e4SLinus Torvalds 			kfree_skb(frag);
7181da177e4SLinus Torvalds 			frag = skb;
7191da177e4SLinus Torvalds 		}
7201da177e4SLinus Torvalds 
721a11d206dSYOSHIFUJI Hideaki 		IP6_INC_STATS(ip6_dst_idev(&rt->u.dst), IPSTATS_MIB_FRAGFAILS);
722a11d206dSYOSHIFUJI Hideaki 		dst_release(&rt->u.dst);
7231da177e4SLinus Torvalds 		return err;
7241da177e4SLinus Torvalds 	}
7251da177e4SLinus Torvalds 
7261da177e4SLinus Torvalds slow_path:
7271da177e4SLinus Torvalds 	left = skb->len - hlen;		/* Space per frame */
7281da177e4SLinus Torvalds 	ptr = hlen;			/* Where to start from */
7291da177e4SLinus Torvalds 
7301da177e4SLinus Torvalds 	/*
7311da177e4SLinus Torvalds 	 *	Fragment the datagram.
7321da177e4SLinus Torvalds 	 */
7331da177e4SLinus Torvalds 
7341da177e4SLinus Torvalds 	*prevhdr = NEXTHDR_FRAGMENT;
7351da177e4SLinus Torvalds 
7361da177e4SLinus Torvalds 	/*
7371da177e4SLinus Torvalds 	 *	Keep copying data until we run out.
7381da177e4SLinus Torvalds 	 */
7391da177e4SLinus Torvalds 	while(left > 0)	{
7401da177e4SLinus Torvalds 		len = left;
7411da177e4SLinus Torvalds 		/* IF: it doesn't fit, use 'mtu' - the data space left */
7421da177e4SLinus Torvalds 		if (len > mtu)
7431da177e4SLinus Torvalds 			len = mtu;
7441da177e4SLinus Torvalds 		/* IF: we are not sending upto and including the packet end
7451da177e4SLinus Torvalds 		   then align the next start on an eight byte boundary */
7461da177e4SLinus Torvalds 		if (len < left)	{
7471da177e4SLinus Torvalds 			len &= ~7;
7481da177e4SLinus Torvalds 		}
7491da177e4SLinus Torvalds 		/*
7501da177e4SLinus Torvalds 		 *	Allocate buffer.
7511da177e4SLinus Torvalds 		 */
7521da177e4SLinus Torvalds 
7531da177e4SLinus Torvalds 		if ((frag = alloc_skb(len+hlen+sizeof(struct frag_hdr)+LL_RESERVED_SPACE(rt->u.dst.dev), GFP_ATOMIC)) == NULL) {
75464ce2073SPatrick McHardy 			NETDEBUG(KERN_INFO "IPv6: frag: no memory for new fragment!\n");
755a11d206dSYOSHIFUJI Hideaki 			IP6_INC_STATS(ip6_dst_idev(skb->dst),
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);
7661da177e4SLinus Torvalds 		skb_reserve(frag, LL_RESERVED_SPACE(rt->u.dst.dev));
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) {
7911da177e4SLinus Torvalds 			ipv6_select_ident(skb, fh);
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 		 */
7998984e41dSWei Yongjun 		if (skb_copy_bits(skb, ptr, skb_transport_header(frag), len))
8001da177e4SLinus Torvalds 			BUG();
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 
819a11d206dSYOSHIFUJI Hideaki 		IP6_INC_STATS(ip6_dst_idev(skb->dst), IPSTATS_MIB_FRAGCREATES);
8201da177e4SLinus Torvalds 	}
821a11d206dSYOSHIFUJI Hideaki 	IP6_INC_STATS(ip6_dst_idev(skb->dst),
822a11d206dSYOSHIFUJI Hideaki 		      IPSTATS_MIB_FRAGOKS);
8231da177e4SLinus Torvalds 	kfree_skb(skb);
8241da177e4SLinus Torvalds 	return err;
8251da177e4SLinus Torvalds 
8261da177e4SLinus Torvalds fail:
827a11d206dSYOSHIFUJI Hideaki 	IP6_INC_STATS(ip6_dst_idev(skb->dst),
828a11d206dSYOSHIFUJI Hideaki 		      IPSTATS_MIB_FRAGFAILS);
8291da177e4SLinus Torvalds 	kfree_skb(skb);
8301da177e4SLinus Torvalds 	return err;
8311da177e4SLinus Torvalds }
8321da177e4SLinus Torvalds 
833cf6b1982SYOSHIFUJI Hideaki static inline int ip6_rt_check(struct rt6key *rt_key,
834cf6b1982SYOSHIFUJI Hideaki 			       struct in6_addr *fl_addr,
835cf6b1982SYOSHIFUJI Hideaki 			       struct in6_addr *addr_cache)
836cf6b1982SYOSHIFUJI Hideaki {
837cf6b1982SYOSHIFUJI Hideaki 	return ((rt_key->plen != 128 || !ipv6_addr_equal(fl_addr, &rt_key->addr)) &&
838cf6b1982SYOSHIFUJI Hideaki 		(addr_cache == NULL || !ipv6_addr_equal(fl_addr, addr_cache)));
839cf6b1982SYOSHIFUJI Hideaki }
840cf6b1982SYOSHIFUJI Hideaki 
841497c615aSHerbert Xu static struct dst_entry *ip6_sk_dst_check(struct sock *sk,
842497c615aSHerbert Xu 					  struct dst_entry *dst,
843497c615aSHerbert Xu 					  struct flowi *fl)
8441da177e4SLinus Torvalds {
8451da177e4SLinus Torvalds 	struct ipv6_pinfo *np = inet6_sk(sk);
846497c615aSHerbert Xu 	struct rt6_info *rt = (struct rt6_info *)dst;
8471da177e4SLinus Torvalds 
848497c615aSHerbert Xu 	if (!dst)
849497c615aSHerbert Xu 		goto out;
8501da177e4SLinus Torvalds 
8511da177e4SLinus Torvalds 	/* Yes, checking route validity in not connected
852d76e60a5SDavid S. Miller 	 * case is not very simple. Take into account,
853d76e60a5SDavid S. Miller 	 * that we do not support routing by source, TOS,
854d76e60a5SDavid S. Miller 	 * and MSG_DONTROUTE 		--ANK (980726)
855d76e60a5SDavid S. Miller 	 *
856cf6b1982SYOSHIFUJI Hideaki 	 * 1. ip6_rt_check(): If route was host route,
857cf6b1982SYOSHIFUJI Hideaki 	 *    check that cached destination is current.
858d76e60a5SDavid S. Miller 	 *    If it is network route, we still may
859d76e60a5SDavid S. Miller 	 *    check its validity using saved pointer
860d76e60a5SDavid S. Miller 	 *    to the last used address: daddr_cache.
861d76e60a5SDavid S. Miller 	 *    We do not want to save whole address now,
862d76e60a5SDavid S. Miller 	 *    (because main consumer of this service
863d76e60a5SDavid S. Miller 	 *    is tcp, which has not this problem),
864d76e60a5SDavid S. Miller 	 *    so that the last trick works only on connected
865d76e60a5SDavid S. Miller 	 *    sockets.
866d76e60a5SDavid S. Miller 	 * 2. oif also should be the same.
8671da177e4SLinus Torvalds 	 */
868cf6b1982SYOSHIFUJI Hideaki 	if (ip6_rt_check(&rt->rt6i_dst, &fl->fl6_dst, np->daddr_cache) ||
8698e1ef0a9SYOSHIFUJI Hideaki #ifdef CONFIG_IPV6_SUBTREES
8708e1ef0a9SYOSHIFUJI Hideaki 	    ip6_rt_check(&rt->rt6i_src, &fl->fl6_src, np->saddr_cache) ||
8718e1ef0a9SYOSHIFUJI Hideaki #endif
872cf6b1982SYOSHIFUJI Hideaki 	    (fl->oif && fl->oif != dst->dev->ifindex)) {
873497c615aSHerbert Xu 		dst_release(dst);
874497c615aSHerbert Xu 		dst = NULL;
8751da177e4SLinus Torvalds 	}
876497c615aSHerbert Xu 
877497c615aSHerbert Xu out:
878497c615aSHerbert Xu 	return dst;
8791da177e4SLinus Torvalds }
880497c615aSHerbert Xu 
881497c615aSHerbert Xu static int ip6_dst_lookup_tail(struct sock *sk,
882497c615aSHerbert Xu 			       struct dst_entry **dst, struct flowi *fl)
883497c615aSHerbert Xu {
884497c615aSHerbert Xu 	int err;
8851da177e4SLinus Torvalds 
8861da177e4SLinus Torvalds 	if (*dst == NULL)
8871da177e4SLinus Torvalds 		*dst = ip6_route_output(sk, fl);
8881da177e4SLinus Torvalds 
8891da177e4SLinus Torvalds 	if ((err = (*dst)->error))
8901da177e4SLinus Torvalds 		goto out_err_release;
8911da177e4SLinus Torvalds 
8921da177e4SLinus Torvalds 	if (ipv6_addr_any(&fl->fl6_src)) {
8931da177e4SLinus Torvalds 		err = ipv6_get_saddr(*dst, &fl->fl6_dst, &fl->fl6_src);
89444456d37SOlaf Hering 		if (err)
8951da177e4SLinus Torvalds 			goto out_err_release;
8961da177e4SLinus Torvalds 	}
8971da177e4SLinus Torvalds 
89895c385b4SNeil Horman #ifdef CONFIG_IPV6_OPTIMISTIC_DAD
89995c385b4SNeil Horman 		/*
90095c385b4SNeil Horman 		 * Here if the dst entry we've looked up
90195c385b4SNeil Horman 		 * has a neighbour entry that is in the INCOMPLETE
90295c385b4SNeil Horman 		 * state and the src address from the flow is
90395c385b4SNeil Horman 		 * marked as OPTIMISTIC, we release the found
90495c385b4SNeil Horman 		 * dst entry and replace it instead with the
90595c385b4SNeil Horman 		 * dst entry of the nexthop router
90695c385b4SNeil Horman 		 */
90795c385b4SNeil Horman 		if (!((*dst)->neighbour->nud_state & NUD_VALID)) {
90895c385b4SNeil Horman 			struct inet6_ifaddr *ifp;
90995c385b4SNeil Horman 			struct flowi fl_gw;
91095c385b4SNeil Horman 			int redirect;
91195c385b4SNeil Horman 
91295c385b4SNeil Horman 			ifp = ipv6_get_ifaddr(&fl->fl6_src, (*dst)->dev, 1);
91395c385b4SNeil Horman 
91495c385b4SNeil Horman 			redirect = (ifp && ifp->flags & IFA_F_OPTIMISTIC);
91595c385b4SNeil Horman 			if (ifp)
91695c385b4SNeil Horman 				in6_ifa_put(ifp);
91795c385b4SNeil Horman 
91895c385b4SNeil Horman 			if (redirect) {
91995c385b4SNeil Horman 				/*
92095c385b4SNeil Horman 				 * We need to get the dst entry for the
92195c385b4SNeil Horman 				 * default router instead
92295c385b4SNeil Horman 				 */
92395c385b4SNeil Horman 				dst_release(*dst);
92495c385b4SNeil Horman 				memcpy(&fl_gw, fl, sizeof(struct flowi));
92595c385b4SNeil Horman 				memset(&fl_gw.fl6_dst, 0, sizeof(struct in6_addr));
92695c385b4SNeil Horman 				*dst = ip6_route_output(sk, &fl_gw);
92795c385b4SNeil Horman 				if ((err = (*dst)->error))
92895c385b4SNeil Horman 					goto out_err_release;
92995c385b4SNeil Horman 			}
93095c385b4SNeil Horman 		}
93195c385b4SNeil Horman #endif
93295c385b4SNeil Horman 
9331da177e4SLinus Torvalds 	return 0;
9341da177e4SLinus Torvalds 
9351da177e4SLinus Torvalds out_err_release:
9361da177e4SLinus Torvalds 	dst_release(*dst);
9371da177e4SLinus Torvalds 	*dst = NULL;
9381da177e4SLinus Torvalds 	return err;
9391da177e4SLinus Torvalds }
94034a0b3cdSAdrian Bunk 
941497c615aSHerbert Xu /**
942497c615aSHerbert Xu  *	ip6_dst_lookup - perform route lookup on flow
943497c615aSHerbert Xu  *	@sk: socket which provides route info
944497c615aSHerbert Xu  *	@dst: pointer to dst_entry * for result
945497c615aSHerbert Xu  *	@fl: flow to lookup
946497c615aSHerbert Xu  *
947497c615aSHerbert Xu  *	This function performs a route lookup on the given flow.
948497c615aSHerbert Xu  *
949497c615aSHerbert Xu  *	It returns zero on success, or a standard errno code on error.
950497c615aSHerbert Xu  */
951497c615aSHerbert Xu int ip6_dst_lookup(struct sock *sk, struct dst_entry **dst, struct flowi *fl)
952497c615aSHerbert Xu {
953497c615aSHerbert Xu 	*dst = NULL;
954497c615aSHerbert Xu 	return ip6_dst_lookup_tail(sk, dst, fl);
955497c615aSHerbert Xu }
9563cf3dc6cSArnaldo Carvalho de Melo EXPORT_SYMBOL_GPL(ip6_dst_lookup);
9573cf3dc6cSArnaldo Carvalho de Melo 
958497c615aSHerbert Xu /**
959497c615aSHerbert Xu  *	ip6_sk_dst_lookup - perform socket cached route lookup on flow
960497c615aSHerbert Xu  *	@sk: socket which provides the dst cache and route info
961497c615aSHerbert Xu  *	@dst: pointer to dst_entry * for result
962497c615aSHerbert Xu  *	@fl: flow to lookup
963497c615aSHerbert Xu  *
964497c615aSHerbert Xu  *	This function performs a route lookup on the given flow with the
965497c615aSHerbert Xu  *	possibility of using the cached route in the socket if it is valid.
966497c615aSHerbert Xu  *	It will take the socket dst lock when operating on the dst cache.
967497c615aSHerbert Xu  *	As a result, this function can only be used in process context.
968497c615aSHerbert Xu  *
969497c615aSHerbert Xu  *	It returns zero on success, or a standard errno code on error.
970497c615aSHerbert Xu  */
971497c615aSHerbert Xu int ip6_sk_dst_lookup(struct sock *sk, struct dst_entry **dst, struct flowi *fl)
972497c615aSHerbert Xu {
973497c615aSHerbert Xu 	*dst = NULL;
974497c615aSHerbert Xu 	if (sk) {
975497c615aSHerbert Xu 		*dst = sk_dst_check(sk, inet6_sk(sk)->dst_cookie);
976497c615aSHerbert Xu 		*dst = ip6_sk_dst_check(sk, *dst, fl);
977497c615aSHerbert Xu 	}
978497c615aSHerbert Xu 
979497c615aSHerbert Xu 	return ip6_dst_lookup_tail(sk, dst, fl);
980497c615aSHerbert Xu }
981497c615aSHerbert Xu EXPORT_SYMBOL_GPL(ip6_sk_dst_lookup);
982497c615aSHerbert Xu 
98334a0b3cdSAdrian Bunk static inline int ip6_ufo_append_data(struct sock *sk,
984e89e9cf5SAnanda Raju 			int getfrag(void *from, char *to, int offset, int len,
985e89e9cf5SAnanda Raju 			int odd, struct sk_buff *skb),
986e89e9cf5SAnanda Raju 			void *from, int length, int hh_len, int fragheaderlen,
987e89e9cf5SAnanda Raju 			int transhdrlen, int mtu,unsigned int flags)
988e89e9cf5SAnanda Raju 
989e89e9cf5SAnanda Raju {
990e89e9cf5SAnanda Raju 	struct sk_buff *skb;
991e89e9cf5SAnanda Raju 	int err;
992e89e9cf5SAnanda Raju 
993e89e9cf5SAnanda Raju 	/* There is support for UDP large send offload by network
994e89e9cf5SAnanda Raju 	 * device, so create one single skb packet containing complete
995e89e9cf5SAnanda Raju 	 * udp datagram
996e89e9cf5SAnanda Raju 	 */
997e89e9cf5SAnanda Raju 	if ((skb = skb_peek_tail(&sk->sk_write_queue)) == NULL) {
998e89e9cf5SAnanda Raju 		skb = sock_alloc_send_skb(sk,
999e89e9cf5SAnanda Raju 			hh_len + fragheaderlen + transhdrlen + 20,
1000e89e9cf5SAnanda Raju 			(flags & MSG_DONTWAIT), &err);
1001e89e9cf5SAnanda Raju 		if (skb == NULL)
1002e89e9cf5SAnanda Raju 			return -ENOMEM;
1003e89e9cf5SAnanda Raju 
1004e89e9cf5SAnanda Raju 		/* reserve space for Hardware header */
1005e89e9cf5SAnanda Raju 		skb_reserve(skb, hh_len);
1006e89e9cf5SAnanda Raju 
1007e89e9cf5SAnanda Raju 		/* create space for UDP/IP header */
1008e89e9cf5SAnanda Raju 		skb_put(skb,fragheaderlen + transhdrlen);
1009e89e9cf5SAnanda Raju 
1010e89e9cf5SAnanda Raju 		/* initialize network header pointer */
1011c1d2bbe1SArnaldo Carvalho de Melo 		skb_reset_network_header(skb);
1012e89e9cf5SAnanda Raju 
1013e89e9cf5SAnanda Raju 		/* initialize protocol header pointer */
1014b0e380b1SArnaldo Carvalho de Melo 		skb->transport_header = skb->network_header + fragheaderlen;
1015e89e9cf5SAnanda Raju 
101684fa7933SPatrick McHardy 		skb->ip_summed = CHECKSUM_PARTIAL;
1017e89e9cf5SAnanda Raju 		skb->csum = 0;
1018e89e9cf5SAnanda Raju 		sk->sk_sndmsg_off = 0;
1019e89e9cf5SAnanda Raju 	}
1020e89e9cf5SAnanda Raju 
1021e89e9cf5SAnanda Raju 	err = skb_append_datato_frags(sk,skb, getfrag, from,
1022e89e9cf5SAnanda Raju 				      (length - transhdrlen));
1023e89e9cf5SAnanda Raju 	if (!err) {
1024e89e9cf5SAnanda Raju 		struct frag_hdr fhdr;
1025e89e9cf5SAnanda Raju 
1026e89e9cf5SAnanda Raju 		/* specify the length of each IP datagram fragment*/
10277967168cSHerbert Xu 		skb_shinfo(skb)->gso_size = mtu - fragheaderlen -
1028e89e9cf5SAnanda Raju 					    sizeof(struct frag_hdr);
1029f83ef8c0SHerbert Xu 		skb_shinfo(skb)->gso_type = SKB_GSO_UDP;
1030e89e9cf5SAnanda Raju 		ipv6_select_ident(skb, &fhdr);
1031e89e9cf5SAnanda Raju 		skb_shinfo(skb)->ip6_frag_id = fhdr.identification;
1032e89e9cf5SAnanda Raju 		__skb_queue_tail(&sk->sk_write_queue, skb);
1033e89e9cf5SAnanda Raju 
1034e89e9cf5SAnanda Raju 		return 0;
1035e89e9cf5SAnanda Raju 	}
1036e89e9cf5SAnanda Raju 	/* There is not enough support do UPD LSO,
1037e89e9cf5SAnanda Raju 	 * so follow normal path
1038e89e9cf5SAnanda Raju 	 */
1039e89e9cf5SAnanda Raju 	kfree_skb(skb);
1040e89e9cf5SAnanda Raju 
1041e89e9cf5SAnanda Raju 	return err;
1042e89e9cf5SAnanda Raju }
10431da177e4SLinus Torvalds 
104441a1f8eaSYOSHIFUJI Hideaki int ip6_append_data(struct sock *sk, int getfrag(void *from, char *to,
104541a1f8eaSYOSHIFUJI Hideaki 	int offset, int len, int odd, struct sk_buff *skb),
10461da177e4SLinus Torvalds 	void *from, int length, int transhdrlen,
104741a1f8eaSYOSHIFUJI Hideaki 	int hlimit, int tclass, struct ipv6_txoptions *opt, struct flowi *fl,
104841a1f8eaSYOSHIFUJI Hideaki 	struct rt6_info *rt, unsigned int flags)
10491da177e4SLinus Torvalds {
10501da177e4SLinus Torvalds 	struct inet_sock *inet = inet_sk(sk);
10511da177e4SLinus Torvalds 	struct ipv6_pinfo *np = inet6_sk(sk);
10521da177e4SLinus Torvalds 	struct sk_buff *skb;
10531da177e4SLinus Torvalds 	unsigned int maxfraglen, fragheaderlen;
10541da177e4SLinus Torvalds 	int exthdrlen;
10551da177e4SLinus Torvalds 	int hh_len;
10561da177e4SLinus Torvalds 	int mtu;
10571da177e4SLinus Torvalds 	int copy;
10581da177e4SLinus Torvalds 	int err;
10591da177e4SLinus Torvalds 	int offset = 0;
10601da177e4SLinus Torvalds 	int csummode = CHECKSUM_NONE;
10611da177e4SLinus Torvalds 
10621da177e4SLinus Torvalds 	if (flags&MSG_PROBE)
10631da177e4SLinus Torvalds 		return 0;
10641da177e4SLinus Torvalds 	if (skb_queue_empty(&sk->sk_write_queue)) {
10651da177e4SLinus Torvalds 		/*
10661da177e4SLinus Torvalds 		 * setup for corking
10671da177e4SLinus Torvalds 		 */
10681da177e4SLinus Torvalds 		if (opt) {
10691da177e4SLinus Torvalds 			if (np->cork.opt == NULL) {
10701da177e4SLinus Torvalds 				np->cork.opt = kmalloc(opt->tot_len,
10711da177e4SLinus Torvalds 						       sk->sk_allocation);
10721da177e4SLinus Torvalds 				if (unlikely(np->cork.opt == NULL))
10731da177e4SLinus Torvalds 					return -ENOBUFS;
10741da177e4SLinus Torvalds 			} else if (np->cork.opt->tot_len < opt->tot_len) {
10751da177e4SLinus Torvalds 				printk(KERN_DEBUG "ip6_append_data: invalid option length\n");
10761da177e4SLinus Torvalds 				return -EINVAL;
10771da177e4SLinus Torvalds 			}
10781da177e4SLinus Torvalds 			memcpy(np->cork.opt, opt, opt->tot_len);
10791da177e4SLinus Torvalds 			inet->cork.flags |= IPCORK_OPT;
10801da177e4SLinus Torvalds 			/* need source address above miyazawa*/
10811da177e4SLinus Torvalds 		}
10821da177e4SLinus Torvalds 		dst_hold(&rt->u.dst);
10831da177e4SLinus Torvalds 		np->cork.rt = rt;
10841da177e4SLinus Torvalds 		inet->cork.fl = *fl;
10851da177e4SLinus Torvalds 		np->cork.hop_limit = hlimit;
108641a1f8eaSYOSHIFUJI Hideaki 		np->cork.tclass = tclass;
1087628a5c56SJohn Heffner 		mtu = np->pmtudisc == IPV6_PMTUDISC_PROBE ?
1088628a5c56SJohn Heffner 		      rt->u.dst.dev->mtu : dst_mtu(rt->u.dst.path);
1089c7503609SDave Jones 		if (np->frag_size < mtu) {
1090d91675f9SYOSHIFUJI Hideaki 			if (np->frag_size)
1091d91675f9SYOSHIFUJI Hideaki 				mtu = np->frag_size;
1092d91675f9SYOSHIFUJI Hideaki 		}
1093d91675f9SYOSHIFUJI Hideaki 		inet->cork.fragsize = mtu;
10941da177e4SLinus Torvalds 		if (dst_allfrag(rt->u.dst.path))
10951da177e4SLinus Torvalds 			inet->cork.flags |= IPCORK_ALLFRAG;
10961da177e4SLinus Torvalds 		inet->cork.length = 0;
10971da177e4SLinus Torvalds 		sk->sk_sndmsg_page = NULL;
10981da177e4SLinus Torvalds 		sk->sk_sndmsg_off = 0;
10991da177e4SLinus Torvalds 		exthdrlen = rt->u.dst.header_len + (opt ? opt->opt_flen : 0);
11001da177e4SLinus Torvalds 		length += exthdrlen;
11011da177e4SLinus Torvalds 		transhdrlen += exthdrlen;
11021da177e4SLinus Torvalds 	} else {
11031da177e4SLinus Torvalds 		rt = np->cork.rt;
11041da177e4SLinus Torvalds 		fl = &inet->cork.fl;
11051da177e4SLinus Torvalds 		if (inet->cork.flags & IPCORK_OPT)
11061da177e4SLinus Torvalds 			opt = np->cork.opt;
11071da177e4SLinus Torvalds 		transhdrlen = 0;
11081da177e4SLinus Torvalds 		exthdrlen = 0;
11091da177e4SLinus Torvalds 		mtu = inet->cork.fragsize;
11101da177e4SLinus Torvalds 	}
11111da177e4SLinus Torvalds 
11121da177e4SLinus Torvalds 	hh_len = LL_RESERVED_SPACE(rt->u.dst.dev);
11131da177e4SLinus Torvalds 
11141b5c2299SMasahide NAKAMURA 	fragheaderlen = sizeof(struct ipv6hdr) + rt->u.dst.nfheader_len + (opt ? opt->opt_nflen : 0);
11151da177e4SLinus Torvalds 	maxfraglen = ((mtu - fragheaderlen) & ~7) + fragheaderlen - sizeof(struct frag_hdr);
11161da177e4SLinus Torvalds 
11171da177e4SLinus Torvalds 	if (mtu <= sizeof(struct ipv6hdr) + IPV6_MAXPLEN) {
11181da177e4SLinus Torvalds 		if (inet->cork.length + length > sizeof(struct ipv6hdr) + IPV6_MAXPLEN - fragheaderlen) {
11191da177e4SLinus Torvalds 			ipv6_local_error(sk, EMSGSIZE, fl, mtu-exthdrlen);
11201da177e4SLinus Torvalds 			return -EMSGSIZE;
11211da177e4SLinus Torvalds 		}
11221da177e4SLinus Torvalds 	}
11231da177e4SLinus Torvalds 
11241da177e4SLinus Torvalds 	/*
11251da177e4SLinus Torvalds 	 * Let's try using as much space as possible.
11261da177e4SLinus Torvalds 	 * Use MTU if total length of the message fits into the MTU.
11271da177e4SLinus Torvalds 	 * Otherwise, we need to reserve fragment header and
11281da177e4SLinus Torvalds 	 * fragment alignment (= 8-15 octects, in total).
11291da177e4SLinus Torvalds 	 *
11301da177e4SLinus Torvalds 	 * Note that we may need to "move" the data from the tail of
11311da177e4SLinus Torvalds 	 * of the buffer to the new fragment when we split
11321da177e4SLinus Torvalds 	 * the message.
11331da177e4SLinus Torvalds 	 *
11341da177e4SLinus Torvalds 	 * FIXME: It may be fragmented into multiple chunks
11351da177e4SLinus Torvalds 	 *        at once if non-fragmentable extension headers
11361da177e4SLinus Torvalds 	 *        are too large.
11371da177e4SLinus Torvalds 	 * --yoshfuji
11381da177e4SLinus Torvalds 	 */
11391da177e4SLinus Torvalds 
11401da177e4SLinus Torvalds 	inet->cork.length += length;
1141e89e9cf5SAnanda Raju 	if (((length > mtu) && (sk->sk_protocol == IPPROTO_UDP)) &&
1142e89e9cf5SAnanda Raju 	    (rt->u.dst.dev->features & NETIF_F_UFO)) {
1143e89e9cf5SAnanda Raju 
1144baa829d8SPatrick McHardy 		err = ip6_ufo_append_data(sk, getfrag, from, length, hh_len,
1145baa829d8SPatrick McHardy 					  fragheaderlen, transhdrlen, mtu,
1146baa829d8SPatrick McHardy 					  flags);
1147baa829d8SPatrick McHardy 		if (err)
1148e89e9cf5SAnanda Raju 			goto error;
1149e89e9cf5SAnanda Raju 		return 0;
1150e89e9cf5SAnanda Raju 	}
11511da177e4SLinus Torvalds 
11521da177e4SLinus Torvalds 	if ((skb = skb_peek_tail(&sk->sk_write_queue)) == NULL)
11531da177e4SLinus Torvalds 		goto alloc_new_skb;
11541da177e4SLinus Torvalds 
11551da177e4SLinus Torvalds 	while (length > 0) {
11561da177e4SLinus Torvalds 		/* Check if the remaining data fits into current packet. */
11571da177e4SLinus Torvalds 		copy = (inet->cork.length <= mtu && !(inet->cork.flags & IPCORK_ALLFRAG) ? mtu : maxfraglen) - skb->len;
11581da177e4SLinus Torvalds 		if (copy < length)
11591da177e4SLinus Torvalds 			copy = maxfraglen - skb->len;
11601da177e4SLinus Torvalds 
11611da177e4SLinus Torvalds 		if (copy <= 0) {
11621da177e4SLinus Torvalds 			char *data;
11631da177e4SLinus Torvalds 			unsigned int datalen;
11641da177e4SLinus Torvalds 			unsigned int fraglen;
11651da177e4SLinus Torvalds 			unsigned int fraggap;
11661da177e4SLinus Torvalds 			unsigned int alloclen;
11671da177e4SLinus Torvalds 			struct sk_buff *skb_prev;
11681da177e4SLinus Torvalds alloc_new_skb:
11691da177e4SLinus Torvalds 			skb_prev = skb;
11701da177e4SLinus Torvalds 
11711da177e4SLinus Torvalds 			/* There's no room in the current skb */
11721da177e4SLinus Torvalds 			if (skb_prev)
11731da177e4SLinus Torvalds 				fraggap = skb_prev->len - maxfraglen;
11741da177e4SLinus Torvalds 			else
11751da177e4SLinus Torvalds 				fraggap = 0;
11761da177e4SLinus Torvalds 
11771da177e4SLinus Torvalds 			/*
11781da177e4SLinus Torvalds 			 * If remaining data exceeds the mtu,
11791da177e4SLinus Torvalds 			 * we know we need more fragment(s).
11801da177e4SLinus Torvalds 			 */
11811da177e4SLinus Torvalds 			datalen = length + fraggap;
11821da177e4SLinus Torvalds 			if (datalen > (inet->cork.length <= mtu && !(inet->cork.flags & IPCORK_ALLFRAG) ? mtu : maxfraglen) - fragheaderlen)
11831da177e4SLinus Torvalds 				datalen = maxfraglen - fragheaderlen;
11841da177e4SLinus Torvalds 
11851da177e4SLinus Torvalds 			fraglen = datalen + fragheaderlen;
11861da177e4SLinus Torvalds 			if ((flags & MSG_MORE) &&
11871da177e4SLinus Torvalds 			    !(rt->u.dst.dev->features&NETIF_F_SG))
11881da177e4SLinus Torvalds 				alloclen = mtu;
11891da177e4SLinus Torvalds 			else
11901da177e4SLinus Torvalds 				alloclen = datalen + fragheaderlen;
11911da177e4SLinus Torvalds 
11921da177e4SLinus Torvalds 			/*
11931da177e4SLinus Torvalds 			 * The last fragment gets additional space at tail.
11941da177e4SLinus Torvalds 			 * Note: we overallocate on fragments with MSG_MODE
11951da177e4SLinus Torvalds 			 * because we have no idea if we're the last one.
11961da177e4SLinus Torvalds 			 */
11971da177e4SLinus Torvalds 			if (datalen == length + fraggap)
11981da177e4SLinus Torvalds 				alloclen += rt->u.dst.trailer_len;
11991da177e4SLinus Torvalds 
12001da177e4SLinus Torvalds 			/*
12011da177e4SLinus Torvalds 			 * We just reserve space for fragment header.
12021da177e4SLinus Torvalds 			 * Note: this may be overallocation if the message
12031da177e4SLinus Torvalds 			 * (without MSG_MORE) fits into the MTU.
12041da177e4SLinus Torvalds 			 */
12051da177e4SLinus Torvalds 			alloclen += sizeof(struct frag_hdr);
12061da177e4SLinus Torvalds 
12071da177e4SLinus Torvalds 			if (transhdrlen) {
12081da177e4SLinus Torvalds 				skb = sock_alloc_send_skb(sk,
12091da177e4SLinus Torvalds 						alloclen + hh_len,
12101da177e4SLinus Torvalds 						(flags & MSG_DONTWAIT), &err);
12111da177e4SLinus Torvalds 			} else {
12121da177e4SLinus Torvalds 				skb = NULL;
12131da177e4SLinus Torvalds 				if (atomic_read(&sk->sk_wmem_alloc) <=
12141da177e4SLinus Torvalds 				    2 * sk->sk_sndbuf)
12151da177e4SLinus Torvalds 					skb = sock_wmalloc(sk,
12161da177e4SLinus Torvalds 							   alloclen + hh_len, 1,
12171da177e4SLinus Torvalds 							   sk->sk_allocation);
12181da177e4SLinus Torvalds 				if (unlikely(skb == NULL))
12191da177e4SLinus Torvalds 					err = -ENOBUFS;
12201da177e4SLinus Torvalds 			}
12211da177e4SLinus Torvalds 			if (skb == NULL)
12221da177e4SLinus Torvalds 				goto error;
12231da177e4SLinus Torvalds 			/*
12241da177e4SLinus Torvalds 			 *	Fill in the control structures
12251da177e4SLinus Torvalds 			 */
12261da177e4SLinus Torvalds 			skb->ip_summed = csummode;
12271da177e4SLinus Torvalds 			skb->csum = 0;
12281da177e4SLinus Torvalds 			/* reserve for fragmentation */
12291da177e4SLinus Torvalds 			skb_reserve(skb, hh_len+sizeof(struct frag_hdr));
12301da177e4SLinus Torvalds 
12311da177e4SLinus Torvalds 			/*
12321da177e4SLinus Torvalds 			 *	Find where to start putting bytes
12331da177e4SLinus Torvalds 			 */
12341da177e4SLinus Torvalds 			data = skb_put(skb, fraglen);
1235c14d2450SArnaldo Carvalho de Melo 			skb_set_network_header(skb, exthdrlen);
12361da177e4SLinus Torvalds 			data += fragheaderlen;
1237b0e380b1SArnaldo Carvalho de Melo 			skb->transport_header = (skb->network_header +
1238b0e380b1SArnaldo Carvalho de Melo 						 fragheaderlen);
12391da177e4SLinus Torvalds 			if (fraggap) {
12401da177e4SLinus Torvalds 				skb->csum = skb_copy_and_csum_bits(
12411da177e4SLinus Torvalds 					skb_prev, maxfraglen,
12421da177e4SLinus Torvalds 					data + transhdrlen, fraggap, 0);
12431da177e4SLinus Torvalds 				skb_prev->csum = csum_sub(skb_prev->csum,
12441da177e4SLinus Torvalds 							  skb->csum);
12451da177e4SLinus Torvalds 				data += fraggap;
1246e9fa4f7bSHerbert Xu 				pskb_trim_unique(skb_prev, maxfraglen);
12471da177e4SLinus Torvalds 			}
12481da177e4SLinus Torvalds 			copy = datalen - transhdrlen - fraggap;
12491da177e4SLinus Torvalds 			if (copy < 0) {
12501da177e4SLinus Torvalds 				err = -EINVAL;
12511da177e4SLinus Torvalds 				kfree_skb(skb);
12521da177e4SLinus Torvalds 				goto error;
12531da177e4SLinus Torvalds 			} else if (copy > 0 && getfrag(from, data + transhdrlen, offset, copy, fraggap, skb) < 0) {
12541da177e4SLinus Torvalds 				err = -EFAULT;
12551da177e4SLinus Torvalds 				kfree_skb(skb);
12561da177e4SLinus Torvalds 				goto error;
12571da177e4SLinus Torvalds 			}
12581da177e4SLinus Torvalds 
12591da177e4SLinus Torvalds 			offset += copy;
12601da177e4SLinus Torvalds 			length -= datalen - fraggap;
12611da177e4SLinus Torvalds 			transhdrlen = 0;
12621da177e4SLinus Torvalds 			exthdrlen = 0;
12631da177e4SLinus Torvalds 			csummode = CHECKSUM_NONE;
12641da177e4SLinus Torvalds 
12651da177e4SLinus Torvalds 			/*
12661da177e4SLinus Torvalds 			 * Put the packet on the pending queue
12671da177e4SLinus Torvalds 			 */
12681da177e4SLinus Torvalds 			__skb_queue_tail(&sk->sk_write_queue, skb);
12691da177e4SLinus Torvalds 			continue;
12701da177e4SLinus Torvalds 		}
12711da177e4SLinus Torvalds 
12721da177e4SLinus Torvalds 		if (copy > length)
12731da177e4SLinus Torvalds 			copy = length;
12741da177e4SLinus Torvalds 
12751da177e4SLinus Torvalds 		if (!(rt->u.dst.dev->features&NETIF_F_SG)) {
12761da177e4SLinus Torvalds 			unsigned int off;
12771da177e4SLinus Torvalds 
12781da177e4SLinus Torvalds 			off = skb->len;
12791da177e4SLinus Torvalds 			if (getfrag(from, skb_put(skb, copy),
12801da177e4SLinus Torvalds 						offset, copy, off, skb) < 0) {
12811da177e4SLinus Torvalds 				__skb_trim(skb, off);
12821da177e4SLinus Torvalds 				err = -EFAULT;
12831da177e4SLinus Torvalds 				goto error;
12841da177e4SLinus Torvalds 			}
12851da177e4SLinus Torvalds 		} else {
12861da177e4SLinus Torvalds 			int i = skb_shinfo(skb)->nr_frags;
12871da177e4SLinus Torvalds 			skb_frag_t *frag = &skb_shinfo(skb)->frags[i-1];
12881da177e4SLinus Torvalds 			struct page *page = sk->sk_sndmsg_page;
12891da177e4SLinus Torvalds 			int off = sk->sk_sndmsg_off;
12901da177e4SLinus Torvalds 			unsigned int left;
12911da177e4SLinus Torvalds 
12921da177e4SLinus Torvalds 			if (page && (left = PAGE_SIZE - off) > 0) {
12931da177e4SLinus Torvalds 				if (copy >= left)
12941da177e4SLinus Torvalds 					copy = left;
12951da177e4SLinus Torvalds 				if (page != frag->page) {
12961da177e4SLinus Torvalds 					if (i == MAX_SKB_FRAGS) {
12971da177e4SLinus Torvalds 						err = -EMSGSIZE;
12981da177e4SLinus Torvalds 						goto error;
12991da177e4SLinus Torvalds 					}
13001da177e4SLinus Torvalds 					get_page(page);
13011da177e4SLinus Torvalds 					skb_fill_page_desc(skb, i, page, sk->sk_sndmsg_off, 0);
13021da177e4SLinus Torvalds 					frag = &skb_shinfo(skb)->frags[i];
13031da177e4SLinus Torvalds 				}
13041da177e4SLinus Torvalds 			} else if(i < MAX_SKB_FRAGS) {
13051da177e4SLinus Torvalds 				if (copy > PAGE_SIZE)
13061da177e4SLinus Torvalds 					copy = PAGE_SIZE;
13071da177e4SLinus Torvalds 				page = alloc_pages(sk->sk_allocation, 0);
13081da177e4SLinus Torvalds 				if (page == NULL) {
13091da177e4SLinus Torvalds 					err = -ENOMEM;
13101da177e4SLinus Torvalds 					goto error;
13111da177e4SLinus Torvalds 				}
13121da177e4SLinus Torvalds 				sk->sk_sndmsg_page = page;
13131da177e4SLinus Torvalds 				sk->sk_sndmsg_off = 0;
13141da177e4SLinus Torvalds 
13151da177e4SLinus Torvalds 				skb_fill_page_desc(skb, i, page, 0, 0);
13161da177e4SLinus Torvalds 				frag = &skb_shinfo(skb)->frags[i];
13171da177e4SLinus Torvalds 				skb->truesize += PAGE_SIZE;
13181da177e4SLinus Torvalds 				atomic_add(PAGE_SIZE, &sk->sk_wmem_alloc);
13191da177e4SLinus Torvalds 			} else {
13201da177e4SLinus Torvalds 				err = -EMSGSIZE;
13211da177e4SLinus Torvalds 				goto error;
13221da177e4SLinus Torvalds 			}
13231da177e4SLinus Torvalds 			if (getfrag(from, page_address(frag->page)+frag->page_offset+frag->size, offset, copy, skb->len, skb) < 0) {
13241da177e4SLinus Torvalds 				err = -EFAULT;
13251da177e4SLinus Torvalds 				goto error;
13261da177e4SLinus Torvalds 			}
13271da177e4SLinus Torvalds 			sk->sk_sndmsg_off += copy;
13281da177e4SLinus Torvalds 			frag->size += copy;
13291da177e4SLinus Torvalds 			skb->len += copy;
13301da177e4SLinus Torvalds 			skb->data_len += copy;
13311da177e4SLinus Torvalds 		}
13321da177e4SLinus Torvalds 		offset += copy;
13331da177e4SLinus Torvalds 		length -= copy;
13341da177e4SLinus Torvalds 	}
13351da177e4SLinus Torvalds 	return 0;
13361da177e4SLinus Torvalds error:
13371da177e4SLinus Torvalds 	inet->cork.length -= length;
1338a11d206dSYOSHIFUJI Hideaki 	IP6_INC_STATS(rt->rt6i_idev, IPSTATS_MIB_OUTDISCARDS);
13391da177e4SLinus Torvalds 	return err;
13401da177e4SLinus Torvalds }
13411da177e4SLinus Torvalds 
13421da177e4SLinus Torvalds int ip6_push_pending_frames(struct sock *sk)
13431da177e4SLinus Torvalds {
13441da177e4SLinus Torvalds 	struct sk_buff *skb, *tmp_skb;
13451da177e4SLinus Torvalds 	struct sk_buff **tail_skb;
13461da177e4SLinus Torvalds 	struct in6_addr final_dst_buf, *final_dst = &final_dst_buf;
13471da177e4SLinus Torvalds 	struct inet_sock *inet = inet_sk(sk);
13481da177e4SLinus Torvalds 	struct ipv6_pinfo *np = inet6_sk(sk);
13491da177e4SLinus Torvalds 	struct ipv6hdr *hdr;
13501da177e4SLinus Torvalds 	struct ipv6_txoptions *opt = np->cork.opt;
13511da177e4SLinus Torvalds 	struct rt6_info *rt = np->cork.rt;
13521da177e4SLinus Torvalds 	struct flowi *fl = &inet->cork.fl;
13531da177e4SLinus Torvalds 	unsigned char proto = fl->proto;
13541da177e4SLinus Torvalds 	int err = 0;
13551da177e4SLinus Torvalds 
13561da177e4SLinus Torvalds 	if ((skb = __skb_dequeue(&sk->sk_write_queue)) == NULL)
13571da177e4SLinus Torvalds 		goto out;
13581da177e4SLinus Torvalds 	tail_skb = &(skb_shinfo(skb)->frag_list);
13591da177e4SLinus Torvalds 
13601da177e4SLinus Torvalds 	/* move skb->data to ip header from ext header */
1361d56f90a7SArnaldo Carvalho de Melo 	if (skb->data < skb_network_header(skb))
1362bbe735e4SArnaldo Carvalho de Melo 		__skb_pull(skb, skb_network_offset(skb));
13631da177e4SLinus Torvalds 	while ((tmp_skb = __skb_dequeue(&sk->sk_write_queue)) != NULL) {
1364cfe1fc77SArnaldo Carvalho de Melo 		__skb_pull(tmp_skb, skb_network_header_len(skb));
13651da177e4SLinus Torvalds 		*tail_skb = tmp_skb;
13661da177e4SLinus Torvalds 		tail_skb = &(tmp_skb->next);
13671da177e4SLinus Torvalds 		skb->len += tmp_skb->len;
13681da177e4SLinus Torvalds 		skb->data_len += tmp_skb->len;
13691da177e4SLinus Torvalds 		skb->truesize += tmp_skb->truesize;
13701da177e4SLinus Torvalds 		__sock_put(tmp_skb->sk);
13711da177e4SLinus Torvalds 		tmp_skb->destructor = NULL;
13721da177e4SLinus Torvalds 		tmp_skb->sk = NULL;
13731da177e4SLinus Torvalds 	}
13741da177e4SLinus Torvalds 
13751da177e4SLinus Torvalds 	ipv6_addr_copy(final_dst, &fl->fl6_dst);
1376cfe1fc77SArnaldo Carvalho de Melo 	__skb_pull(skb, skb_network_header_len(skb));
13771da177e4SLinus Torvalds 	if (opt && opt->opt_flen)
13781da177e4SLinus Torvalds 		ipv6_push_frag_opts(skb, opt, &proto);
13791da177e4SLinus Torvalds 	if (opt && opt->opt_nflen)
13801da177e4SLinus Torvalds 		ipv6_push_nfrag_opts(skb, opt, &proto, &final_dst);
13811da177e4SLinus Torvalds 
1382e2d1bca7SArnaldo Carvalho de Melo 	skb_push(skb, sizeof(struct ipv6hdr));
1383e2d1bca7SArnaldo Carvalho de Melo 	skb_reset_network_header(skb);
13840660e03fSArnaldo Carvalho de Melo 	hdr = ipv6_hdr(skb);
13851da177e4SLinus Torvalds 
138690bcaf7bSAl Viro 	*(__be32*)hdr = fl->fl6_flowlabel |
138741a1f8eaSYOSHIFUJI Hideaki 		     htonl(0x60000000 | ((int)np->cork.tclass << 20));
13881da177e4SLinus Torvalds 
13891da177e4SLinus Torvalds 	if (skb->len <= sizeof(struct ipv6hdr) + IPV6_MAXPLEN)
13901da177e4SLinus Torvalds 		hdr->payload_len = htons(skb->len - sizeof(struct ipv6hdr));
13911da177e4SLinus Torvalds 	else
13921da177e4SLinus Torvalds 		hdr->payload_len = 0;
13931da177e4SLinus Torvalds 	hdr->hop_limit = np->cork.hop_limit;
13941da177e4SLinus Torvalds 	hdr->nexthdr = proto;
13951da177e4SLinus Torvalds 	ipv6_addr_copy(&hdr->saddr, &fl->fl6_src);
13961da177e4SLinus Torvalds 	ipv6_addr_copy(&hdr->daddr, final_dst);
13971da177e4SLinus Torvalds 
1398a2c2064fSPatrick McHardy 	skb->priority = sk->sk_priority;
1399a2c2064fSPatrick McHardy 
14001da177e4SLinus Torvalds 	skb->dst = dst_clone(&rt->u.dst);
1401a11d206dSYOSHIFUJI Hideaki 	IP6_INC_STATS(rt->rt6i_idev, IPSTATS_MIB_OUTREQUESTS);
14021da177e4SLinus Torvalds 	err = NF_HOOK(PF_INET6, NF_IP6_LOCAL_OUT, skb, NULL, skb->dst->dev, dst_output);
14031da177e4SLinus Torvalds 	if (err) {
14041da177e4SLinus Torvalds 		if (err > 0)
14053320da89SHerbert Xu 			err = np->recverr ? net_xmit_errno(err) : 0;
14061da177e4SLinus Torvalds 		if (err)
14071da177e4SLinus Torvalds 			goto error;
14081da177e4SLinus Torvalds 	}
14091da177e4SLinus Torvalds 
14101da177e4SLinus Torvalds out:
14111da177e4SLinus Torvalds 	inet->cork.flags &= ~IPCORK_OPT;
14121da177e4SLinus Torvalds 	kfree(np->cork.opt);
14131da177e4SLinus Torvalds 	np->cork.opt = NULL;
14141da177e4SLinus Torvalds 	if (np->cork.rt) {
14151da177e4SLinus Torvalds 		dst_release(&np->cork.rt->u.dst);
14161da177e4SLinus Torvalds 		np->cork.rt = NULL;
14171da177e4SLinus Torvalds 		inet->cork.flags &= ~IPCORK_ALLFRAG;
14181da177e4SLinus Torvalds 	}
14191da177e4SLinus Torvalds 	memset(&inet->cork.fl, 0, sizeof(inet->cork.fl));
14201da177e4SLinus Torvalds 	return err;
14211da177e4SLinus Torvalds error:
14221da177e4SLinus Torvalds 	goto out;
14231da177e4SLinus Torvalds }
14241da177e4SLinus Torvalds 
14251da177e4SLinus Torvalds void ip6_flush_pending_frames(struct sock *sk)
14261da177e4SLinus Torvalds {
14271da177e4SLinus Torvalds 	struct inet_sock *inet = inet_sk(sk);
14281da177e4SLinus Torvalds 	struct ipv6_pinfo *np = inet6_sk(sk);
14291da177e4SLinus Torvalds 	struct sk_buff *skb;
14301da177e4SLinus Torvalds 
14311da177e4SLinus Torvalds 	while ((skb = __skb_dequeue_tail(&sk->sk_write_queue)) != NULL) {
1432e1f52208SYOSHIFUJI Hideaki 		if (skb->dst)
1433a11d206dSYOSHIFUJI Hideaki 			IP6_INC_STATS(ip6_dst_idev(skb->dst),
1434a11d206dSYOSHIFUJI Hideaki 				      IPSTATS_MIB_OUTDISCARDS);
14351da177e4SLinus Torvalds 		kfree_skb(skb);
14361da177e4SLinus Torvalds 	}
14371da177e4SLinus Torvalds 
14381da177e4SLinus Torvalds 	inet->cork.flags &= ~IPCORK_OPT;
14391da177e4SLinus Torvalds 
14401da177e4SLinus Torvalds 	kfree(np->cork.opt);
14411da177e4SLinus Torvalds 	np->cork.opt = NULL;
14421da177e4SLinus Torvalds 	if (np->cork.rt) {
14431da177e4SLinus Torvalds 		dst_release(&np->cork.rt->u.dst);
14441da177e4SLinus Torvalds 		np->cork.rt = NULL;
14451da177e4SLinus Torvalds 		inet->cork.flags &= ~IPCORK_ALLFRAG;
14461da177e4SLinus Torvalds 	}
14471da177e4SLinus Torvalds 	memset(&inet->cork.fl, 0, sizeof(inet->cork.fl));
14481da177e4SLinus Torvalds }
1449