Linux Audio

Check our new training course

Loading...
v3.1
 
  1/*
  2 *	Extension Header handling for IPv6
  3 *	Linux INET6 implementation
  4 *
  5 *	Authors:
  6 *	Pedro Roque		<roque@di.fc.ul.pt>
  7 *	Andi Kleen		<ak@muc.de>
  8 *	Alexey Kuznetsov	<kuznet@ms2.inr.ac.ru>
  9 *
 10 *	This program is free software; you can redistribute it and/or
 11 *      modify it under the terms of the GNU General Public License
 12 *      as published by the Free Software Foundation; either version
 13 *      2 of the License, or (at your option) any later version.
 14 */
 15
 16/* Changes:
 17 *	yoshfuji		: ensure not to overrun while parsing
 18 *				  tlv options.
 19 *	Mitsuru KANDA @USAGI and: Remove ipv6_parse_exthdrs().
 20 *	YOSHIFUJI Hideaki @USAGI  Register inbound extension header
 21 *				  handlers as inet6_protocol{}.
 22 */
 23
 24#include <linux/errno.h>
 25#include <linux/types.h>
 26#include <linux/socket.h>
 27#include <linux/sockios.h>
 28#include <linux/net.h>
 29#include <linux/netdevice.h>
 30#include <linux/in6.h>
 31#include <linux/icmpv6.h>
 32#include <linux/slab.h>
 
 33
 34#include <net/dst.h>
 35#include <net/sock.h>
 36#include <net/snmp.h>
 37
 38#include <net/ipv6.h>
 39#include <net/protocol.h>
 40#include <net/transp_v6.h>
 41#include <net/rawv6.h>
 42#include <net/ndisc.h>
 43#include <net/ip6_route.h>
 44#include <net/addrconf.h>
 45#if defined(CONFIG_IPV6_MIP6) || defined(CONFIG_IPV6_MIP6_MODULE)
 
 46#include <net/xfrm.h>
 47#endif
 
 
 
 
 
 48
 49#include <asm/uaccess.h>
 50
 51int ipv6_find_tlv(struct sk_buff *skb, int offset, int type)
 52{
 53	const unsigned char *nh = skb_network_header(skb);
 54	int packet_len = skb->tail - skb->network_header;
 55	struct ipv6_opt_hdr *hdr;
 56	int len;
 57
 58	if (offset + 2 > packet_len)
 59		goto bad;
 60	hdr = (struct ipv6_opt_hdr *)(nh + offset);
 61	len = ((hdr->hdrlen + 1) << 3);
 62
 63	if (offset + len > packet_len)
 64		goto bad;
 65
 66	offset += 2;
 67	len -= 2;
 68
 69	while (len > 0) {
 70		int opttype = nh[offset];
 71		int optlen;
 72
 73		if (opttype == type)
 74			return offset;
 75
 76		switch (opttype) {
 77		case IPV6_TLV_PAD0:
 78			optlen = 1;
 79			break;
 80		default:
 81			optlen = nh[offset + 1] + 2;
 82			if (optlen > len)
 83				goto bad;
 84			break;
 85		}
 86		offset += optlen;
 87		len -= optlen;
 88	}
 89	/* not_found */
 90 bad:
 91	return -1;
 92}
 93EXPORT_SYMBOL_GPL(ipv6_find_tlv);
 94
 95/*
 96 *	Parsing tlv encoded headers.
 97 *
 98 *	Parsing function "func" returns 1, if parsing succeed
 99 *	and 0, if it failed.
100 *	It MUST NOT touch skb->h.
101 */
102
103struct tlvtype_proc {
104	int	type;
105	int	(*func)(struct sk_buff *skb, int offset);
106};
107
108/*********************
109  Generic functions
110 *********************/
111
112/* An unknown option is detected, decide what to do */
113
114static int ip6_tlvopt_unknown(struct sk_buff *skb, int optoff)
 
115{
 
 
 
 
 
 
 
 
 
 
 
116	switch ((skb_network_header(skb)[optoff] & 0xC0) >> 6) {
117	case 0: /* ignore */
118		return 1;
119
120	case 1: /* drop packet */
121		break;
122
123	case 3: /* Send ICMP if not a multicast address and drop packet */
124		/* Actually, it is redundant check. icmp_send
125		   will recheck in any case.
126		 */
127		if (ipv6_addr_is_multicast(&ipv6_hdr(skb)->daddr))
128			break;
 
129	case 2: /* send ICMP PARM PROB regardless and drop packet */
130		icmpv6_param_prob(skb, ICMPV6_UNK_OPTION, optoff);
131		return 0;
132	}
133
 
134	kfree_skb(skb);
135	return 0;
136}
137
138/* Parse tlv encoded option header (hop-by-hop or destination) */
139
140static int ip6_parse_tlv(struct tlvtype_proc *procs, struct sk_buff *skb)
 
 
141{
142	struct tlvtype_proc *curr;
143	const unsigned char *nh = skb_network_header(skb);
144	int off = skb_network_header_len(skb);
145	int len = (skb_transport_header(skb)[1] + 1) << 3;
 
 
 
 
 
 
 
 
146
147	if (skb_transport_offset(skb) + len > skb_headlen(skb))
148		goto bad;
149
150	off += 2;
151	len -= 2;
152
153	while (len > 0) {
154		int optlen = nh[off + 1] + 2;
 
155
156		switch (nh[off]) {
157		case IPV6_TLV_PAD0:
158			optlen = 1;
 
 
 
159			break;
160
161		case IPV6_TLV_PADN:
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
162			break;
163
164		default: /* Other TLV code so scan list */
165			if (optlen > len)
166				goto bad;
167			for (curr=procs; curr->type >= 0; curr++) {
 
 
 
 
 
168				if (curr->type == nh[off]) {
169					/* type specific length/alignment
170					   checks will be performed in the
171					   func(). */
172					if (curr->func(skb, off) == 0)
173						return 0;
174					break;
175				}
176			}
177			if (curr->type < 0) {
178				if (ip6_tlvopt_unknown(skb, off) == 0)
179					return 0;
180			}
 
181			break;
182		}
183		off += optlen;
184		len -= optlen;
185	}
 
186	if (len == 0)
187		return 1;
188bad:
189	kfree_skb(skb);
190	return 0;
191}
192
193/*****************************
194  Destination options header.
195 *****************************/
196
197#if defined(CONFIG_IPV6_MIP6) || defined(CONFIG_IPV6_MIP6_MODULE)
198static int ipv6_dest_hao(struct sk_buff *skb, int optoff)
199{
200	struct ipv6_destopt_hao *hao;
201	struct inet6_skb_parm *opt = IP6CB(skb);
202	struct ipv6hdr *ipv6h = ipv6_hdr(skb);
203	struct in6_addr tmp_addr;
204	int ret;
205
206	if (opt->dsthao) {
207		LIMIT_NETDEBUG(KERN_DEBUG "hao duplicated\n");
208		goto discard;
209	}
210	opt->dsthao = opt->dst1;
211	opt->dst1 = 0;
212
213	hao = (struct ipv6_destopt_hao *)(skb_network_header(skb) + optoff);
214
215	if (hao->length != 16) {
216		LIMIT_NETDEBUG(
217			KERN_DEBUG "hao invalid option length = %d\n", hao->length);
218		goto discard;
219	}
220
221	if (!(ipv6_addr_type(&hao->addr) & IPV6_ADDR_UNICAST)) {
222		LIMIT_NETDEBUG(
223			KERN_DEBUG "hao is not an unicast addr: %pI6\n", &hao->addr);
224		goto discard;
225	}
226
227	ret = xfrm6_input_addr(skb, (xfrm_address_t *)&ipv6h->daddr,
228			       (xfrm_address_t *)&hao->addr, IPPROTO_DSTOPTS);
229	if (unlikely(ret < 0))
230		goto discard;
231
232	if (skb_cloned(skb)) {
233		if (pskb_expand_head(skb, 0, 0, GFP_ATOMIC))
234			goto discard;
235
236		/* update all variable using below by copied skbuff */
237		hao = (struct ipv6_destopt_hao *)(skb_network_header(skb) +
238						  optoff);
239		ipv6h = ipv6_hdr(skb);
240	}
241
242	if (skb->ip_summed == CHECKSUM_COMPLETE)
243		skb->ip_summed = CHECKSUM_NONE;
244
245	ipv6_addr_copy(&tmp_addr, &ipv6h->saddr);
246	ipv6_addr_copy(&ipv6h->saddr, &hao->addr);
247	ipv6_addr_copy(&hao->addr, &tmp_addr);
248
249	if (skb->tstamp.tv64 == 0)
250		__net_timestamp(skb);
251
252	return 1;
253
254 discard:
255	kfree_skb(skb);
256	return 0;
257}
258#endif
259
260static struct tlvtype_proc tlvprocdestopt_lst[] = {
261#if defined(CONFIG_IPV6_MIP6) || defined(CONFIG_IPV6_MIP6_MODULE)
262	{
263		.type	= IPV6_TLV_HAO,
264		.func	= ipv6_dest_hao,
265	},
266#endif
267	{-1,			NULL}
268};
269
270static int ipv6_destopt_rcv(struct sk_buff *skb)
271{
 
272	struct inet6_skb_parm *opt = IP6CB(skb);
273#if defined(CONFIG_IPV6_MIP6) || defined(CONFIG_IPV6_MIP6_MODULE)
274	__u16 dstbuf;
275#endif
276	struct dst_entry *dst;
 
 
277
278	if (!pskb_may_pull(skb, skb_transport_offset(skb) + 8) ||
279	    !pskb_may_pull(skb, (skb_transport_offset(skb) +
280				 ((skb_transport_header(skb)[1] + 1) << 3)))) {
281		IP6_INC_STATS_BH(dev_net(skb_dst(skb)->dev), ip6_dst_idev(skb_dst(skb)),
282				 IPSTATS_MIB_INHDRERRORS);
 
283		kfree_skb(skb);
284		return -1;
285	}
286
 
 
 
 
287	opt->lastopt = opt->dst1 = skb_network_header_len(skb);
288#if defined(CONFIG_IPV6_MIP6) || defined(CONFIG_IPV6_MIP6_MODULE)
289	dstbuf = opt->dst1;
290#endif
291
292	dst = dst_clone(skb_dst(skb));
293	if (ip6_parse_tlv(tlvprocdestopt_lst, skb)) {
294		dst_release(dst);
295		skb->transport_header += (skb_transport_header(skb)[1] + 1) << 3;
296		opt = IP6CB(skb);
297#if defined(CONFIG_IPV6_MIP6) || defined(CONFIG_IPV6_MIP6_MODULE)
298		opt->nhoff = dstbuf;
299#else
300		opt->nhoff = opt->dst1;
301#endif
302		return 1;
303	}
304
305	IP6_INC_STATS_BH(dev_net(dst->dev),
306			 ip6_dst_idev(dst), IPSTATS_MIB_INHDRERRORS);
307	dst_release(dst);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
308	return -1;
309}
310
311/********************************
312  Routing header.
313 ********************************/
314
315/* called with rcu_read_lock() */
316static int ipv6_rthdr_rcv(struct sk_buff *skb)
317{
 
318	struct inet6_skb_parm *opt = IP6CB(skb);
319	struct in6_addr *addr = NULL;
320	struct in6_addr daddr;
321	struct inet6_dev *idev;
322	int n, i;
323	struct ipv6_rt_hdr *hdr;
324	struct rt0_hdr *rthdr;
325	struct net *net = dev_net(skb->dev);
326	int accept_source_route = net->ipv6.devconf_all->accept_source_route;
327
328	idev = __in6_dev_get(skb->dev);
329	if (idev && accept_source_route > idev->cnf.accept_source_route)
330		accept_source_route = idev->cnf.accept_source_route;
331
332	if (!pskb_may_pull(skb, skb_transport_offset(skb) + 8) ||
333	    !pskb_may_pull(skb, (skb_transport_offset(skb) +
334				 ((skb_transport_header(skb)[1] + 1) << 3)))) {
335		IP6_INC_STATS_BH(net, ip6_dst_idev(skb_dst(skb)),
336				 IPSTATS_MIB_INHDRERRORS);
337		kfree_skb(skb);
338		return -1;
339	}
340
341	hdr = (struct ipv6_rt_hdr *)skb_transport_header(skb);
342
343	if (ipv6_addr_is_multicast(&ipv6_hdr(skb)->daddr) ||
344	    skb->pkt_type != PACKET_HOST) {
345		IP6_INC_STATS_BH(net, ip6_dst_idev(skb_dst(skb)),
346				 IPSTATS_MIB_INADDRERRORS);
347		kfree_skb(skb);
348		return -1;
349	}
350
 
 
 
 
351looped_back:
352	if (hdr->segments_left == 0) {
353		switch (hdr->type) {
354#if defined(CONFIG_IPV6_MIP6) || defined(CONFIG_IPV6_MIP6_MODULE)
355		case IPV6_SRCRT_TYPE_2:
356			/* Silently discard type 2 header unless it was
357			 * processed by own
358			 */
359			if (!addr) {
360				IP6_INC_STATS_BH(net, ip6_dst_idev(skb_dst(skb)),
361						 IPSTATS_MIB_INADDRERRORS);
362				kfree_skb(skb);
363				return -1;
364			}
365			break;
366#endif
367		default:
368			break;
369		}
370
371		opt->lastopt = opt->srcrt = skb_network_header_len(skb);
372		skb->transport_header += (hdr->hdrlen + 1) << 3;
373		opt->dst0 = opt->dst1;
374		opt->dst1 = 0;
375		opt->nhoff = (&hdr->nexthdr) - skb_network_header(skb);
376		return 1;
377	}
378
379	switch (hdr->type) {
380#if defined(CONFIG_IPV6_MIP6) || defined(CONFIG_IPV6_MIP6_MODULE)
381	case IPV6_SRCRT_TYPE_2:
382		if (accept_source_route < 0)
383			goto unknown_rh;
384		/* Silently discard invalid RTH type 2 */
385		if (hdr->hdrlen != 2 || hdr->segments_left != 1) {
386			IP6_INC_STATS_BH(net, ip6_dst_idev(skb_dst(skb)),
387					 IPSTATS_MIB_INHDRERRORS);
388			kfree_skb(skb);
389			return -1;
390		}
391		break;
392#endif
393	default:
394		goto unknown_rh;
395	}
396
397	/*
398	 *	This is the routing header forwarding algorithm from
399	 *	RFC 2460, page 16.
400	 */
401
402	n = hdr->hdrlen >> 1;
403
404	if (hdr->segments_left > n) {
405		IP6_INC_STATS_BH(net, ip6_dst_idev(skb_dst(skb)),
406				 IPSTATS_MIB_INHDRERRORS);
407		icmpv6_param_prob(skb, ICMPV6_HDR_FIELD,
408				  ((&hdr->segments_left) -
409				   skb_network_header(skb)));
410		return -1;
411	}
412
413	/* We are about to mangle packet header. Be careful!
414	   Do not damage packets queued somewhere.
415	 */
416	if (skb_cloned(skb)) {
417		/* the copy is a forwarded packet */
418		if (pskb_expand_head(skb, 0, 0, GFP_ATOMIC)) {
419			IP6_INC_STATS_BH(net, ip6_dst_idev(skb_dst(skb)),
420					 IPSTATS_MIB_OUTDISCARDS);
421			kfree_skb(skb);
422			return -1;
423		}
424		hdr = (struct ipv6_rt_hdr *)skb_transport_header(skb);
425	}
426
427	if (skb->ip_summed == CHECKSUM_COMPLETE)
428		skb->ip_summed = CHECKSUM_NONE;
429
430	i = n - --hdr->segments_left;
431
432	rthdr = (struct rt0_hdr *) hdr;
433	addr = rthdr->addr;
434	addr += i - 1;
435
436	switch (hdr->type) {
437#if defined(CONFIG_IPV6_MIP6) || defined(CONFIG_IPV6_MIP6_MODULE)
438	case IPV6_SRCRT_TYPE_2:
439		if (xfrm6_input_addr(skb, (xfrm_address_t *)addr,
440				     (xfrm_address_t *)&ipv6_hdr(skb)->saddr,
441				     IPPROTO_ROUTING) < 0) {
442			IP6_INC_STATS_BH(net, ip6_dst_idev(skb_dst(skb)),
443					 IPSTATS_MIB_INADDRERRORS);
444			kfree_skb(skb);
445			return -1;
446		}
447		if (!ipv6_chk_home_addr(dev_net(skb_dst(skb)->dev), addr)) {
448			IP6_INC_STATS_BH(net, ip6_dst_idev(skb_dst(skb)),
449					 IPSTATS_MIB_INADDRERRORS);
450			kfree_skb(skb);
451			return -1;
452		}
453		break;
454#endif
455	default:
456		break;
457	}
458
459	if (ipv6_addr_is_multicast(addr)) {
460		IP6_INC_STATS_BH(net, ip6_dst_idev(skb_dst(skb)),
461				 IPSTATS_MIB_INADDRERRORS);
462		kfree_skb(skb);
463		return -1;
464	}
465
466	ipv6_addr_copy(&daddr, addr);
467	ipv6_addr_copy(addr, &ipv6_hdr(skb)->daddr);
468	ipv6_addr_copy(&ipv6_hdr(skb)->daddr, &daddr);
469
470	skb_dst_drop(skb);
471	ip6_route_input(skb);
472	if (skb_dst(skb)->error) {
473		skb_push(skb, skb->data - skb_network_header(skb));
474		dst_input(skb);
475		return -1;
476	}
477
478	if (skb_dst(skb)->dev->flags&IFF_LOOPBACK) {
479		if (ipv6_hdr(skb)->hop_limit <= 1) {
480			IP6_INC_STATS_BH(net, ip6_dst_idev(skb_dst(skb)),
481					 IPSTATS_MIB_INHDRERRORS);
482			icmpv6_send(skb, ICMPV6_TIME_EXCEED, ICMPV6_EXC_HOPLIMIT,
483				    0);
484			kfree_skb(skb);
485			return -1;
486		}
487		ipv6_hdr(skb)->hop_limit--;
488		goto looped_back;
489	}
490
491	skb_push(skb, skb->data - skb_network_header(skb));
492	dst_input(skb);
493	return -1;
494
495unknown_rh:
496	IP6_INC_STATS_BH(net, ip6_dst_idev(skb_dst(skb)), IPSTATS_MIB_INHDRERRORS);
497	icmpv6_param_prob(skb, ICMPV6_HDR_FIELD,
498			  (&hdr->type) - skb_network_header(skb));
499	return -1;
500}
501
502static const struct inet6_protocol rthdr_protocol = {
503	.handler	=	ipv6_rthdr_rcv,
504	.flags		=	INET6_PROTO_NOPOLICY | INET6_PROTO_GSO_EXTHDR,
505};
506
507static const struct inet6_protocol destopt_protocol = {
508	.handler	=	ipv6_destopt_rcv,
509	.flags		=	INET6_PROTO_NOPOLICY | INET6_PROTO_GSO_EXTHDR,
510};
511
512static const struct inet6_protocol nodata_protocol = {
513	.handler	=	dst_discard,
514	.flags		=	INET6_PROTO_NOPOLICY,
515};
516
517int __init ipv6_exthdrs_init(void)
518{
519	int ret;
520
521	ret = inet6_add_protocol(&rthdr_protocol, IPPROTO_ROUTING);
522	if (ret)
523		goto out;
524
525	ret = inet6_add_protocol(&destopt_protocol, IPPROTO_DSTOPTS);
526	if (ret)
527		goto out_rthdr;
528
529	ret = inet6_add_protocol(&nodata_protocol, IPPROTO_NONE);
530	if (ret)
531		goto out_destopt;
532
533out:
534	return ret;
535out_rthdr:
536	inet6_del_protocol(&rthdr_protocol, IPPROTO_ROUTING);
537out_destopt:
538	inet6_del_protocol(&destopt_protocol, IPPROTO_DSTOPTS);
 
 
539	goto out;
540};
541
542void ipv6_exthdrs_exit(void)
543{
544	inet6_del_protocol(&nodata_protocol, IPPROTO_NONE);
545	inet6_del_protocol(&destopt_protocol, IPPROTO_DSTOPTS);
546	inet6_del_protocol(&rthdr_protocol, IPPROTO_ROUTING);
547}
548
549/**********************************
550  Hop-by-hop options.
551 **********************************/
552
553/*
554 * Note: we cannot rely on skb_dst(skb) before we assign it in ip6_route_input().
555 */
556static inline struct inet6_dev *ipv6_skb_idev(struct sk_buff *skb)
557{
558	return skb_dst(skb) ? ip6_dst_idev(skb_dst(skb)) : __in6_dev_get(skb->dev);
559}
560
561static inline struct net *ipv6_skb_net(struct sk_buff *skb)
562{
563	return skb_dst(skb) ? dev_net(skb_dst(skb)->dev) : dev_net(skb->dev);
564}
565
566/* Router Alert as of RFC 2711 */
567
568static int ipv6_hop_ra(struct sk_buff *skb, int optoff)
569{
570	const unsigned char *nh = skb_network_header(skb);
571
572	if (nh[optoff + 1] == 2) {
573		IP6CB(skb)->ra = optoff;
574		return 1;
 
575	}
576	LIMIT_NETDEBUG(KERN_DEBUG "ipv6_hop_ra: wrong RA length %d\n",
577		       nh[optoff + 1]);
578	kfree_skb(skb);
579	return 0;
580}
581
582/* Jumbo payload */
583
584static int ipv6_hop_jumbo(struct sk_buff *skb, int optoff)
585{
586	const unsigned char *nh = skb_network_header(skb);
 
587	struct net *net = ipv6_skb_net(skb);
588	u32 pkt_len;
589
590	if (nh[optoff + 1] != 4 || (optoff & 3) != 2) {
591		LIMIT_NETDEBUG(KERN_DEBUG "ipv6_hop_jumbo: wrong jumbo opt length/alignment %d\n",
592			       nh[optoff+1]);
593		IP6_INC_STATS_BH(net, ipv6_skb_idev(skb),
594				 IPSTATS_MIB_INHDRERRORS);
595		goto drop;
596	}
597
598	pkt_len = ntohl(*(__be32 *)(nh + optoff + 2));
599	if (pkt_len <= IPV6_MAXPLEN) {
600		IP6_INC_STATS_BH(net, ipv6_skb_idev(skb),
601				 IPSTATS_MIB_INHDRERRORS);
602		icmpv6_param_prob(skb, ICMPV6_HDR_FIELD, optoff+2);
603		return 0;
604	}
605	if (ipv6_hdr(skb)->payload_len) {
606		IP6_INC_STATS_BH(net, ipv6_skb_idev(skb),
607				 IPSTATS_MIB_INHDRERRORS);
608		icmpv6_param_prob(skb, ICMPV6_HDR_FIELD, optoff);
609		return 0;
610	}
611
612	if (pkt_len > skb->len - sizeof(struct ipv6hdr)) {
613		IP6_INC_STATS_BH(net, ipv6_skb_idev(skb),
614				 IPSTATS_MIB_INTRUNCATEDPKTS);
615		goto drop;
616	}
617
618	if (pskb_trim_rcsum(skb, pkt_len + sizeof(struct ipv6hdr)))
619		goto drop;
620
621	return 1;
 
622
623drop:
624	kfree_skb(skb);
625	return 0;
626}
627
628static struct tlvtype_proc tlvprochopopt_lst[] = {
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
629	{
630		.type	= IPV6_TLV_ROUTERALERT,
631		.func	= ipv6_hop_ra,
632	},
633	{
634		.type	= IPV6_TLV_JUMBO,
635		.func	= ipv6_hop_jumbo,
636	},
 
 
 
 
637	{ -1, }
638};
639
640int ipv6_parse_hopopts(struct sk_buff *skb)
641{
642	struct inet6_skb_parm *opt = IP6CB(skb);
 
 
643
644	/*
645	 * skb_network_header(skb) is equal to skb->data, and
646	 * skb_network_header_len(skb) is always equal to
647	 * sizeof(struct ipv6hdr) by definition of
648	 * hop-by-hop options.
649	 */
650	if (!pskb_may_pull(skb, sizeof(struct ipv6hdr) + 8) ||
651	    !pskb_may_pull(skb, (sizeof(struct ipv6hdr) +
652				 ((skb_transport_header(skb)[1] + 1) << 3)))) {
 
653		kfree_skb(skb);
654		return -1;
655	}
656
657	opt->hop = sizeof(struct ipv6hdr);
658	if (ip6_parse_tlv(tlvprochopopt_lst, skb)) {
659		skb->transport_header += (skb_transport_header(skb)[1] + 1) << 3;
 
 
 
 
 
660		opt = IP6CB(skb);
661		opt->nhoff = sizeof(struct ipv6hdr);
662		return 1;
663	}
664	return -1;
665}
666
667/*
668 *	Creating outbound headers.
669 *
670 *	"build" functions work when skb is filled from head to tail (datagram)
671 *	"push"	functions work when headers are added from tail to head (tcp)
672 *
673 *	In both cases we assume, that caller reserved enough room
674 *	for headers.
675 */
676
677static void ipv6_push_rthdr(struct sk_buff *skb, u8 *proto,
678			    struct ipv6_rt_hdr *opt,
679			    struct in6_addr **addr_p)
680{
681	struct rt0_hdr *phdr, *ihdr;
682	int hops;
683
684	ihdr = (struct rt0_hdr *) opt;
685
686	phdr = (struct rt0_hdr *) skb_push(skb, (ihdr->rt_hdr.hdrlen + 1) << 3);
687	memcpy(phdr, ihdr, sizeof(struct rt0_hdr));
688
689	hops = ihdr->rt_hdr.hdrlen >> 1;
690
691	if (hops > 1)
692		memcpy(phdr->addr, ihdr->addr + 1,
693		       (hops - 1) * sizeof(struct in6_addr));
694
695	ipv6_addr_copy(phdr->addr + (hops - 1), *addr_p);
696	*addr_p = ihdr->addr;
697
698	phdr->rt_hdr.nexthdr = *proto;
699	*proto = NEXTHDR_ROUTING;
700}
701
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
702static void ipv6_push_exthdr(struct sk_buff *skb, u8 *proto, u8 type, struct ipv6_opt_hdr *opt)
703{
704	struct ipv6_opt_hdr *h = (struct ipv6_opt_hdr *)skb_push(skb, ipv6_optlen(opt));
705
706	memcpy(h, opt, ipv6_optlen(opt));
707	h->nexthdr = *proto;
708	*proto = type;
709}
710
711void ipv6_push_nfrag_opts(struct sk_buff *skb, struct ipv6_txoptions *opt,
712			  u8 *proto,
713			  struct in6_addr **daddr)
714{
715	if (opt->srcrt) {
716		ipv6_push_rthdr(skb, proto, opt->srcrt, daddr);
717		/*
718		 * IPV6_RTHDRDSTOPTS is ignored
719		 * unless IPV6_RTHDR is set (RFC3542).
720		 */
721		if (opt->dst0opt)
722			ipv6_push_exthdr(skb, proto, NEXTHDR_DEST, opt->dst0opt);
723	}
724	if (opt->hopopt)
725		ipv6_push_exthdr(skb, proto, NEXTHDR_HOP, opt->hopopt);
726}
727
728EXPORT_SYMBOL(ipv6_push_nfrag_opts);
729
730void ipv6_push_frag_opts(struct sk_buff *skb, struct ipv6_txoptions *opt, u8 *proto)
731{
732	if (opt->dst1opt)
733		ipv6_push_exthdr(skb, proto, NEXTHDR_DEST, opt->dst1opt);
734}
 
735
736struct ipv6_txoptions *
737ipv6_dup_options(struct sock *sk, struct ipv6_txoptions *opt)
738{
739	struct ipv6_txoptions *opt2;
740
741	opt2 = sock_kmalloc(sk, opt->tot_len, GFP_ATOMIC);
742	if (opt2) {
743		long dif = (char*)opt2 - (char*)opt;
744		memcpy(opt2, opt, opt->tot_len);
745		if (opt2->hopopt)
746			*((char**)&opt2->hopopt) += dif;
747		if (opt2->dst0opt)
748			*((char**)&opt2->dst0opt) += dif;
749		if (opt2->dst1opt)
750			*((char**)&opt2->dst1opt) += dif;
751		if (opt2->srcrt)
752			*((char**)&opt2->srcrt) += dif;
 
753	}
754	return opt2;
755}
756
757EXPORT_SYMBOL_GPL(ipv6_dup_options);
758
759static int ipv6_renew_option(void *ohdr,
760			     struct ipv6_opt_hdr __user *newopt, int newoptlen,
761			     int inherit,
762			     struct ipv6_opt_hdr **hdr,
763			     char **p)
764{
765	if (inherit) {
766		if (ohdr) {
767			memcpy(*p, ohdr, ipv6_optlen((struct ipv6_opt_hdr *)ohdr));
768			*hdr = (struct ipv6_opt_hdr *)*p;
769			*p += CMSG_ALIGN(ipv6_optlen(*(struct ipv6_opt_hdr **)hdr));
770		}
771	} else {
772		if (newopt) {
773			if (copy_from_user(*p, newopt, newoptlen))
774				return -EFAULT;
775			*hdr = (struct ipv6_opt_hdr *)*p;
776			if (ipv6_optlen(*(struct ipv6_opt_hdr **)hdr) > newoptlen)
777				return -EINVAL;
778			*p += CMSG_ALIGN(newoptlen);
779		}
780	}
781	return 0;
782}
783
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
784struct ipv6_txoptions *
785ipv6_renew_options(struct sock *sk, struct ipv6_txoptions *opt,
786		   int newtype,
787		   struct ipv6_opt_hdr __user *newopt, int newoptlen)
788{
789	int tot_len = 0;
790	char *p;
791	struct ipv6_txoptions *opt2;
792	int err;
793
794	if (opt) {
795		if (newtype != IPV6_HOPOPTS && opt->hopopt)
796			tot_len += CMSG_ALIGN(ipv6_optlen(opt->hopopt));
797		if (newtype != IPV6_RTHDRDSTOPTS && opt->dst0opt)
798			tot_len += CMSG_ALIGN(ipv6_optlen(opt->dst0opt));
799		if (newtype != IPV6_RTHDR && opt->srcrt)
800			tot_len += CMSG_ALIGN(ipv6_optlen(opt->srcrt));
801		if (newtype != IPV6_DSTOPTS && opt->dst1opt)
802			tot_len += CMSG_ALIGN(ipv6_optlen(opt->dst1opt));
803	}
804
805	if (newopt && newoptlen)
806		tot_len += CMSG_ALIGN(newoptlen);
807
808	if (!tot_len)
809		return NULL;
810
811	tot_len += sizeof(*opt2);
812	opt2 = sock_kmalloc(sk, tot_len, GFP_ATOMIC);
813	if (!opt2)
814		return ERR_PTR(-ENOBUFS);
815
816	memset(opt2, 0, tot_len);
817
818	opt2->tot_len = tot_len;
819	p = (char *)(opt2 + 1);
820
821	err = ipv6_renew_option(opt ? opt->hopopt : NULL, newopt, newoptlen,
822				newtype != IPV6_HOPOPTS,
823				&opt2->hopopt, &p);
824	if (err)
825		goto out;
826
827	err = ipv6_renew_option(opt ? opt->dst0opt : NULL, newopt, newoptlen,
828				newtype != IPV6_RTHDRDSTOPTS,
829				&opt2->dst0opt, &p);
830	if (err)
831		goto out;
832
833	err = ipv6_renew_option(opt ? opt->srcrt : NULL, newopt, newoptlen,
834				newtype != IPV6_RTHDR,
835				(struct ipv6_opt_hdr **)&opt2->srcrt, &p);
836	if (err)
837		goto out;
838
839	err = ipv6_renew_option(opt ? opt->dst1opt : NULL, newopt, newoptlen,
840				newtype != IPV6_DSTOPTS,
841				&opt2->dst1opt, &p);
842	if (err)
843		goto out;
844
845	opt2->opt_nflen = (opt2->hopopt ? ipv6_optlen(opt2->hopopt) : 0) +
846			  (opt2->dst0opt ? ipv6_optlen(opt2->dst0opt) : 0) +
847			  (opt2->srcrt ? ipv6_optlen(opt2->srcrt) : 0);
848	opt2->opt_flen = (opt2->dst1opt ? ipv6_optlen(opt2->dst1opt) : 0);
849
850	return opt2;
851out:
852	sock_kfree_s(sk, opt2, opt2->tot_len);
853	return ERR_PTR(err);
854}
855
856struct ipv6_txoptions *ipv6_fixup_options(struct ipv6_txoptions *opt_space,
857					  struct ipv6_txoptions *opt)
858{
859	/*
860	 * ignore the dest before srcrt unless srcrt is being included.
861	 * --yoshfuji
862	 */
863	if (opt && opt->dst0opt && !opt->srcrt) {
864		if (opt_space != opt) {
865			memcpy(opt_space, opt, sizeof(*opt_space));
866			opt = opt_space;
867		}
868		opt->opt_nflen -= ipv6_optlen(opt->dst0opt);
869		opt->dst0opt = NULL;
870	}
871
872	return opt;
873}
 
874
875/**
876 * fl6_update_dst - update flowi destination address with info given
877 *                  by srcrt option, if any.
878 *
879 * @fl6: flowi6 for which daddr is to be updated
880 * @opt: struct ipv6_txoptions in which to look for srcrt opt
881 * @orig: copy of original daddr address if modified
882 *
883 * Returns NULL if no txoptions or no srcrt, otherwise returns orig
884 * and initial value of fl6->daddr set in orig
885 */
886struct in6_addr *fl6_update_dst(struct flowi6 *fl6,
887				const struct ipv6_txoptions *opt,
888				struct in6_addr *orig)
889{
890	if (!opt || !opt->srcrt)
891		return NULL;
892
893	ipv6_addr_copy(orig, &fl6->daddr);
894	ipv6_addr_copy(&fl6->daddr, ((struct rt0_hdr *)opt->srcrt)->addr);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
895	return orig;
896}
897
898EXPORT_SYMBOL_GPL(fl6_update_dst);
v5.4
   1// SPDX-License-Identifier: GPL-2.0-or-later
   2/*
   3 *	Extension Header handling for IPv6
   4 *	Linux INET6 implementation
   5 *
   6 *	Authors:
   7 *	Pedro Roque		<roque@di.fc.ul.pt>
   8 *	Andi Kleen		<ak@muc.de>
   9 *	Alexey Kuznetsov	<kuznet@ms2.inr.ac.ru>
 
 
 
 
 
  10 */
  11
  12/* Changes:
  13 *	yoshfuji		: ensure not to overrun while parsing
  14 *				  tlv options.
  15 *	Mitsuru KANDA @USAGI and: Remove ipv6_parse_exthdrs().
  16 *	YOSHIFUJI Hideaki @USAGI  Register inbound extension header
  17 *				  handlers as inet6_protocol{}.
  18 */
  19
  20#include <linux/errno.h>
  21#include <linux/types.h>
  22#include <linux/socket.h>
  23#include <linux/sockios.h>
  24#include <linux/net.h>
  25#include <linux/netdevice.h>
  26#include <linux/in6.h>
  27#include <linux/icmpv6.h>
  28#include <linux/slab.h>
  29#include <linux/export.h>
  30
  31#include <net/dst.h>
  32#include <net/sock.h>
  33#include <net/snmp.h>
  34
  35#include <net/ipv6.h>
  36#include <net/protocol.h>
  37#include <net/transp_v6.h>
  38#include <net/rawv6.h>
  39#include <net/ndisc.h>
  40#include <net/ip6_route.h>
  41#include <net/addrconf.h>
  42#include <net/calipso.h>
  43#if IS_ENABLED(CONFIG_IPV6_MIP6)
  44#include <net/xfrm.h>
  45#endif
  46#include <linux/seg6.h>
  47#include <net/seg6.h>
  48#ifdef CONFIG_IPV6_SEG6_HMAC
  49#include <net/seg6_hmac.h>
  50#endif
  51
  52#include <linux/uaccess.h>
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  53
  54/*
  55 *	Parsing tlv encoded headers.
  56 *
  57 *	Parsing function "func" returns true, if parsing succeed
  58 *	and false, if it failed.
  59 *	It MUST NOT touch skb->h.
  60 */
  61
  62struct tlvtype_proc {
  63	int	type;
  64	bool	(*func)(struct sk_buff *skb, int offset);
  65};
  66
  67/*********************
  68  Generic functions
  69 *********************/
  70
  71/* An unknown option is detected, decide what to do */
  72
  73static bool ip6_tlvopt_unknown(struct sk_buff *skb, int optoff,
  74			       bool disallow_unknowns)
  75{
  76	if (disallow_unknowns) {
  77		/* If unknown TLVs are disallowed by configuration
  78		 * then always silently drop packet. Note this also
  79		 * means no ICMP parameter problem is sent which
  80		 * could be a good property to mitigate a reflection DOS
  81		 * attack.
  82		 */
  83
  84		goto drop;
  85	}
  86
  87	switch ((skb_network_header(skb)[optoff] & 0xC0) >> 6) {
  88	case 0: /* ignore */
  89		return true;
  90
  91	case 1: /* drop packet */
  92		break;
  93
  94	case 3: /* Send ICMP if not a multicast address and drop packet */
  95		/* Actually, it is redundant check. icmp_send
  96		   will recheck in any case.
  97		 */
  98		if (ipv6_addr_is_multicast(&ipv6_hdr(skb)->daddr))
  99			break;
 100		/* fall through */
 101	case 2: /* send ICMP PARM PROB regardless and drop packet */
 102		icmpv6_param_prob(skb, ICMPV6_UNK_OPTION, optoff);
 103		return false;
 104	}
 105
 106drop:
 107	kfree_skb(skb);
 108	return false;
 109}
 110
 111/* Parse tlv encoded option header (hop-by-hop or destination) */
 112
 113static bool ip6_parse_tlv(const struct tlvtype_proc *procs,
 114			  struct sk_buff *skb,
 115			  int max_count)
 116{
 117	int len = (skb_transport_header(skb)[1] + 1) << 3;
 118	const unsigned char *nh = skb_network_header(skb);
 119	int off = skb_network_header_len(skb);
 120	const struct tlvtype_proc *curr;
 121	bool disallow_unknowns = false;
 122	int tlv_count = 0;
 123	int padlen = 0;
 124
 125	if (unlikely(max_count < 0)) {
 126		disallow_unknowns = true;
 127		max_count = -max_count;
 128	}
 129
 130	if (skb_transport_offset(skb) + len > skb_headlen(skb))
 131		goto bad;
 132
 133	off += 2;
 134	len -= 2;
 135
 136	while (len > 0) {
 137		int optlen = nh[off + 1] + 2;
 138		int i;
 139
 140		switch (nh[off]) {
 141		case IPV6_TLV_PAD1:
 142			optlen = 1;
 143			padlen++;
 144			if (padlen > 7)
 145				goto bad;
 146			break;
 147
 148		case IPV6_TLV_PADN:
 149			/* RFC 2460 states that the purpose of PadN is
 150			 * to align the containing header to multiples
 151			 * of 8. 7 is therefore the highest valid value.
 152			 * See also RFC 4942, Section 2.1.9.5.
 153			 */
 154			padlen += optlen;
 155			if (padlen > 7)
 156				goto bad;
 157			/* RFC 4942 recommends receiving hosts to
 158			 * actively check PadN payload to contain
 159			 * only zeroes.
 160			 */
 161			for (i = 2; i < optlen; i++) {
 162				if (nh[off + i] != 0)
 163					goto bad;
 164			}
 165			break;
 166
 167		default: /* Other TLV code so scan list */
 168			if (optlen > len)
 169				goto bad;
 170
 171			tlv_count++;
 172			if (tlv_count > max_count)
 173				goto bad;
 174
 175			for (curr = procs; curr->type >= 0; curr++) {
 176				if (curr->type == nh[off]) {
 177					/* type specific length/alignment
 178					   checks will be performed in the
 179					   func(). */
 180					if (curr->func(skb, off) == false)
 181						return false;
 182					break;
 183				}
 184			}
 185			if (curr->type < 0 &&
 186			    !ip6_tlvopt_unknown(skb, off, disallow_unknowns))
 187				return false;
 188
 189			padlen = 0;
 190			break;
 191		}
 192		off += optlen;
 193		len -= optlen;
 194	}
 195
 196	if (len == 0)
 197		return true;
 198bad:
 199	kfree_skb(skb);
 200	return false;
 201}
 202
 203/*****************************
 204  Destination options header.
 205 *****************************/
 206
 207#if IS_ENABLED(CONFIG_IPV6_MIP6)
 208static bool ipv6_dest_hao(struct sk_buff *skb, int optoff)
 209{
 210	struct ipv6_destopt_hao *hao;
 211	struct inet6_skb_parm *opt = IP6CB(skb);
 212	struct ipv6hdr *ipv6h = ipv6_hdr(skb);
 
 213	int ret;
 214
 215	if (opt->dsthao) {
 216		net_dbg_ratelimited("hao duplicated\n");
 217		goto discard;
 218	}
 219	opt->dsthao = opt->dst1;
 220	opt->dst1 = 0;
 221
 222	hao = (struct ipv6_destopt_hao *)(skb_network_header(skb) + optoff);
 223
 224	if (hao->length != 16) {
 225		net_dbg_ratelimited("hao invalid option length = %d\n",
 226				    hao->length);
 227		goto discard;
 228	}
 229
 230	if (!(ipv6_addr_type(&hao->addr) & IPV6_ADDR_UNICAST)) {
 231		net_dbg_ratelimited("hao is not an unicast addr: %pI6\n",
 232				    &hao->addr);
 233		goto discard;
 234	}
 235
 236	ret = xfrm6_input_addr(skb, (xfrm_address_t *)&ipv6h->daddr,
 237			       (xfrm_address_t *)&hao->addr, IPPROTO_DSTOPTS);
 238	if (unlikely(ret < 0))
 239		goto discard;
 240
 241	if (skb_cloned(skb)) {
 242		if (pskb_expand_head(skb, 0, 0, GFP_ATOMIC))
 243			goto discard;
 244
 245		/* update all variable using below by copied skbuff */
 246		hao = (struct ipv6_destopt_hao *)(skb_network_header(skb) +
 247						  optoff);
 248		ipv6h = ipv6_hdr(skb);
 249	}
 250
 251	if (skb->ip_summed == CHECKSUM_COMPLETE)
 252		skb->ip_summed = CHECKSUM_NONE;
 253
 254	swap(ipv6h->saddr, hao->addr);
 
 
 255
 256	if (skb->tstamp == 0)
 257		__net_timestamp(skb);
 258
 259	return true;
 260
 261 discard:
 262	kfree_skb(skb);
 263	return false;
 264}
 265#endif
 266
 267static const struct tlvtype_proc tlvprocdestopt_lst[] = {
 268#if IS_ENABLED(CONFIG_IPV6_MIP6)
 269	{
 270		.type	= IPV6_TLV_HAO,
 271		.func	= ipv6_dest_hao,
 272	},
 273#endif
 274	{-1,			NULL}
 275};
 276
 277static int ipv6_destopt_rcv(struct sk_buff *skb)
 278{
 279	struct inet6_dev *idev = __in6_dev_get(skb->dev);
 280	struct inet6_skb_parm *opt = IP6CB(skb);
 281#if IS_ENABLED(CONFIG_IPV6_MIP6)
 282	__u16 dstbuf;
 283#endif
 284	struct dst_entry *dst = skb_dst(skb);
 285	struct net *net = dev_net(skb->dev);
 286	int extlen;
 287
 288	if (!pskb_may_pull(skb, skb_transport_offset(skb) + 8) ||
 289	    !pskb_may_pull(skb, (skb_transport_offset(skb) +
 290				 ((skb_transport_header(skb)[1] + 1) << 3)))) {
 291		__IP6_INC_STATS(dev_net(dst->dev), idev,
 292				IPSTATS_MIB_INHDRERRORS);
 293fail_and_free:
 294		kfree_skb(skb);
 295		return -1;
 296	}
 297
 298	extlen = (skb_transport_header(skb)[1] + 1) << 3;
 299	if (extlen > net->ipv6.sysctl.max_dst_opts_len)
 300		goto fail_and_free;
 301
 302	opt->lastopt = opt->dst1 = skb_network_header_len(skb);
 303#if IS_ENABLED(CONFIG_IPV6_MIP6)
 304	dstbuf = opt->dst1;
 305#endif
 306
 307	if (ip6_parse_tlv(tlvprocdestopt_lst, skb,
 308			  init_net.ipv6.sysctl.max_dst_opts_cnt)) {
 309		skb->transport_header += extlen;
 
 310		opt = IP6CB(skb);
 311#if IS_ENABLED(CONFIG_IPV6_MIP6)
 312		opt->nhoff = dstbuf;
 313#else
 314		opt->nhoff = opt->dst1;
 315#endif
 316		return 1;
 317	}
 318
 319	__IP6_INC_STATS(net, idev, IPSTATS_MIB_INHDRERRORS);
 320	return -1;
 321}
 322
 323static void seg6_update_csum(struct sk_buff *skb)
 324{
 325	struct ipv6_sr_hdr *hdr;
 326	struct in6_addr *addr;
 327	__be32 from, to;
 328
 329	/* srh is at transport offset and seg_left is already decremented
 330	 * but daddr is not yet updated with next segment
 331	 */
 332
 333	hdr = (struct ipv6_sr_hdr *)skb_transport_header(skb);
 334	addr = hdr->segments + hdr->segments_left;
 335
 336	hdr->segments_left++;
 337	from = *(__be32 *)hdr;
 338
 339	hdr->segments_left--;
 340	to = *(__be32 *)hdr;
 341
 342	/* update skb csum with diff resulting from seg_left decrement */
 343
 344	update_csum_diff4(skb, from, to);
 345
 346	/* compute csum diff between current and next segment and update */
 347
 348	update_csum_diff16(skb, (__be32 *)(&ipv6_hdr(skb)->daddr),
 349			   (__be32 *)addr);
 350}
 351
 352static int ipv6_srh_rcv(struct sk_buff *skb)
 353{
 354	struct inet6_skb_parm *opt = IP6CB(skb);
 355	struct net *net = dev_net(skb->dev);
 356	struct ipv6_sr_hdr *hdr;
 357	struct inet6_dev *idev;
 358	struct in6_addr *addr;
 359	int accept_seg6;
 360
 361	hdr = (struct ipv6_sr_hdr *)skb_transport_header(skb);
 362
 363	idev = __in6_dev_get(skb->dev);
 364
 365	accept_seg6 = net->ipv6.devconf_all->seg6_enabled;
 366	if (accept_seg6 > idev->cnf.seg6_enabled)
 367		accept_seg6 = idev->cnf.seg6_enabled;
 368
 369	if (!accept_seg6) {
 370		kfree_skb(skb);
 371		return -1;
 372	}
 373
 374#ifdef CONFIG_IPV6_SEG6_HMAC
 375	if (!seg6_hmac_validate_skb(skb)) {
 376		kfree_skb(skb);
 377		return -1;
 378	}
 379#endif
 380
 381looped_back:
 382	if (hdr->segments_left == 0) {
 383		if (hdr->nexthdr == NEXTHDR_IPV6) {
 384			int offset = (hdr->hdrlen + 1) << 3;
 385
 386			skb_postpull_rcsum(skb, skb_network_header(skb),
 387					   skb_network_header_len(skb));
 388
 389			if (!pskb_pull(skb, offset)) {
 390				kfree_skb(skb);
 391				return -1;
 392			}
 393			skb_postpull_rcsum(skb, skb_transport_header(skb),
 394					   offset);
 395
 396			skb_reset_network_header(skb);
 397			skb_reset_transport_header(skb);
 398			skb->encapsulation = 0;
 399
 400			__skb_tunnel_rx(skb, skb->dev, net);
 401
 402			netif_rx(skb);
 403			return -1;
 404		}
 405
 406		opt->srcrt = skb_network_header_len(skb);
 407		opt->lastopt = opt->srcrt;
 408		skb->transport_header += (hdr->hdrlen + 1) << 3;
 409		opt->nhoff = (&hdr->nexthdr) - skb_network_header(skb);
 410
 411		return 1;
 412	}
 413
 414	if (hdr->segments_left >= (hdr->hdrlen >> 1)) {
 415		__IP6_INC_STATS(net, idev, IPSTATS_MIB_INHDRERRORS);
 416		icmpv6_param_prob(skb, ICMPV6_HDR_FIELD,
 417				  ((&hdr->segments_left) -
 418				   skb_network_header(skb)));
 419		return -1;
 420	}
 421
 422	if (skb_cloned(skb)) {
 423		if (pskb_expand_head(skb, 0, 0, GFP_ATOMIC)) {
 424			__IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)),
 425					IPSTATS_MIB_OUTDISCARDS);
 426			kfree_skb(skb);
 427			return -1;
 428		}
 429	}
 430
 431	hdr = (struct ipv6_sr_hdr *)skb_transport_header(skb);
 432
 433	hdr->segments_left--;
 434	addr = hdr->segments + hdr->segments_left;
 435
 436	skb_push(skb, sizeof(struct ipv6hdr));
 437
 438	if (skb->ip_summed == CHECKSUM_COMPLETE)
 439		seg6_update_csum(skb);
 440
 441	ipv6_hdr(skb)->daddr = *addr;
 442
 443	skb_dst_drop(skb);
 444
 445	ip6_route_input(skb);
 446
 447	if (skb_dst(skb)->error) {
 448		dst_input(skb);
 449		return -1;
 450	}
 451
 452	if (skb_dst(skb)->dev->flags & IFF_LOOPBACK) {
 453		if (ipv6_hdr(skb)->hop_limit <= 1) {
 454			__IP6_INC_STATS(net, idev, IPSTATS_MIB_INHDRERRORS);
 455			icmpv6_send(skb, ICMPV6_TIME_EXCEED,
 456				    ICMPV6_EXC_HOPLIMIT, 0);
 457			kfree_skb(skb);
 458			return -1;
 459		}
 460		ipv6_hdr(skb)->hop_limit--;
 461
 462		skb_pull(skb, sizeof(struct ipv6hdr));
 463		goto looped_back;
 464	}
 465
 466	dst_input(skb);
 467
 468	return -1;
 469}
 470
 471/********************************
 472  Routing header.
 473 ********************************/
 474
 475/* called with rcu_read_lock() */
 476static int ipv6_rthdr_rcv(struct sk_buff *skb)
 477{
 478	struct inet6_dev *idev = __in6_dev_get(skb->dev);
 479	struct inet6_skb_parm *opt = IP6CB(skb);
 480	struct in6_addr *addr = NULL;
 481	struct in6_addr daddr;
 
 482	int n, i;
 483	struct ipv6_rt_hdr *hdr;
 484	struct rt0_hdr *rthdr;
 485	struct net *net = dev_net(skb->dev);
 486	int accept_source_route = net->ipv6.devconf_all->accept_source_route;
 487
 488	idev = __in6_dev_get(skb->dev);
 489	if (idev && accept_source_route > idev->cnf.accept_source_route)
 490		accept_source_route = idev->cnf.accept_source_route;
 491
 492	if (!pskb_may_pull(skb, skb_transport_offset(skb) + 8) ||
 493	    !pskb_may_pull(skb, (skb_transport_offset(skb) +
 494				 ((skb_transport_header(skb)[1] + 1) << 3)))) {
 495		__IP6_INC_STATS(net, idev, IPSTATS_MIB_INHDRERRORS);
 
 496		kfree_skb(skb);
 497		return -1;
 498	}
 499
 500	hdr = (struct ipv6_rt_hdr *)skb_transport_header(skb);
 501
 502	if (ipv6_addr_is_multicast(&ipv6_hdr(skb)->daddr) ||
 503	    skb->pkt_type != PACKET_HOST) {
 504		__IP6_INC_STATS(net, idev, IPSTATS_MIB_INADDRERRORS);
 
 505		kfree_skb(skb);
 506		return -1;
 507	}
 508
 509	/* segment routing */
 510	if (hdr->type == IPV6_SRCRT_TYPE_4)
 511		return ipv6_srh_rcv(skb);
 512
 513looped_back:
 514	if (hdr->segments_left == 0) {
 515		switch (hdr->type) {
 516#if IS_ENABLED(CONFIG_IPV6_MIP6)
 517		case IPV6_SRCRT_TYPE_2:
 518			/* Silently discard type 2 header unless it was
 519			 * processed by own
 520			 */
 521			if (!addr) {
 522				__IP6_INC_STATS(net, idev,
 523						IPSTATS_MIB_INADDRERRORS);
 524				kfree_skb(skb);
 525				return -1;
 526			}
 527			break;
 528#endif
 529		default:
 530			break;
 531		}
 532
 533		opt->lastopt = opt->srcrt = skb_network_header_len(skb);
 534		skb->transport_header += (hdr->hdrlen + 1) << 3;
 535		opt->dst0 = opt->dst1;
 536		opt->dst1 = 0;
 537		opt->nhoff = (&hdr->nexthdr) - skb_network_header(skb);
 538		return 1;
 539	}
 540
 541	switch (hdr->type) {
 542#if IS_ENABLED(CONFIG_IPV6_MIP6)
 543	case IPV6_SRCRT_TYPE_2:
 544		if (accept_source_route < 0)
 545			goto unknown_rh;
 546		/* Silently discard invalid RTH type 2 */
 547		if (hdr->hdrlen != 2 || hdr->segments_left != 1) {
 548			__IP6_INC_STATS(net, idev, IPSTATS_MIB_INHDRERRORS);
 
 549			kfree_skb(skb);
 550			return -1;
 551		}
 552		break;
 553#endif
 554	default:
 555		goto unknown_rh;
 556	}
 557
 558	/*
 559	 *	This is the routing header forwarding algorithm from
 560	 *	RFC 2460, page 16.
 561	 */
 562
 563	n = hdr->hdrlen >> 1;
 564
 565	if (hdr->segments_left > n) {
 566		__IP6_INC_STATS(net, idev, IPSTATS_MIB_INHDRERRORS);
 
 567		icmpv6_param_prob(skb, ICMPV6_HDR_FIELD,
 568				  ((&hdr->segments_left) -
 569				   skb_network_header(skb)));
 570		return -1;
 571	}
 572
 573	/* We are about to mangle packet header. Be careful!
 574	   Do not damage packets queued somewhere.
 575	 */
 576	if (skb_cloned(skb)) {
 577		/* the copy is a forwarded packet */
 578		if (pskb_expand_head(skb, 0, 0, GFP_ATOMIC)) {
 579			__IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)),
 580					IPSTATS_MIB_OUTDISCARDS);
 581			kfree_skb(skb);
 582			return -1;
 583		}
 584		hdr = (struct ipv6_rt_hdr *)skb_transport_header(skb);
 585	}
 586
 587	if (skb->ip_summed == CHECKSUM_COMPLETE)
 588		skb->ip_summed = CHECKSUM_NONE;
 589
 590	i = n - --hdr->segments_left;
 591
 592	rthdr = (struct rt0_hdr *) hdr;
 593	addr = rthdr->addr;
 594	addr += i - 1;
 595
 596	switch (hdr->type) {
 597#if IS_ENABLED(CONFIG_IPV6_MIP6)
 598	case IPV6_SRCRT_TYPE_2:
 599		if (xfrm6_input_addr(skb, (xfrm_address_t *)addr,
 600				     (xfrm_address_t *)&ipv6_hdr(skb)->saddr,
 601				     IPPROTO_ROUTING) < 0) {
 602			__IP6_INC_STATS(net, idev, IPSTATS_MIB_INADDRERRORS);
 
 603			kfree_skb(skb);
 604			return -1;
 605		}
 606		if (!ipv6_chk_home_addr(dev_net(skb_dst(skb)->dev), addr)) {
 607			__IP6_INC_STATS(net, idev, IPSTATS_MIB_INADDRERRORS);
 
 608			kfree_skb(skb);
 609			return -1;
 610		}
 611		break;
 612#endif
 613	default:
 614		break;
 615	}
 616
 617	if (ipv6_addr_is_multicast(addr)) {
 618		__IP6_INC_STATS(net, idev, IPSTATS_MIB_INADDRERRORS);
 
 619		kfree_skb(skb);
 620		return -1;
 621	}
 622
 623	daddr = *addr;
 624	*addr = ipv6_hdr(skb)->daddr;
 625	ipv6_hdr(skb)->daddr = daddr;
 626
 627	skb_dst_drop(skb);
 628	ip6_route_input(skb);
 629	if (skb_dst(skb)->error) {
 630		skb_push(skb, skb->data - skb_network_header(skb));
 631		dst_input(skb);
 632		return -1;
 633	}
 634
 635	if (skb_dst(skb)->dev->flags&IFF_LOOPBACK) {
 636		if (ipv6_hdr(skb)->hop_limit <= 1) {
 637			__IP6_INC_STATS(net, idev, IPSTATS_MIB_INHDRERRORS);
 
 638			icmpv6_send(skb, ICMPV6_TIME_EXCEED, ICMPV6_EXC_HOPLIMIT,
 639				    0);
 640			kfree_skb(skb);
 641			return -1;
 642		}
 643		ipv6_hdr(skb)->hop_limit--;
 644		goto looped_back;
 645	}
 646
 647	skb_push(skb, skb->data - skb_network_header(skb));
 648	dst_input(skb);
 649	return -1;
 650
 651unknown_rh:
 652	__IP6_INC_STATS(net, idev, IPSTATS_MIB_INHDRERRORS);
 653	icmpv6_param_prob(skb, ICMPV6_HDR_FIELD,
 654			  (&hdr->type) - skb_network_header(skb));
 655	return -1;
 656}
 657
 658static const struct inet6_protocol rthdr_protocol = {
 659	.handler	=	ipv6_rthdr_rcv,
 660	.flags		=	INET6_PROTO_NOPOLICY,
 661};
 662
 663static const struct inet6_protocol destopt_protocol = {
 664	.handler	=	ipv6_destopt_rcv,
 665	.flags		=	INET6_PROTO_NOPOLICY,
 666};
 667
 668static const struct inet6_protocol nodata_protocol = {
 669	.handler	=	dst_discard,
 670	.flags		=	INET6_PROTO_NOPOLICY,
 671};
 672
 673int __init ipv6_exthdrs_init(void)
 674{
 675	int ret;
 676
 677	ret = inet6_add_protocol(&rthdr_protocol, IPPROTO_ROUTING);
 678	if (ret)
 679		goto out;
 680
 681	ret = inet6_add_protocol(&destopt_protocol, IPPROTO_DSTOPTS);
 682	if (ret)
 683		goto out_rthdr;
 684
 685	ret = inet6_add_protocol(&nodata_protocol, IPPROTO_NONE);
 686	if (ret)
 687		goto out_destopt;
 688
 689out:
 690	return ret;
 
 
 691out_destopt:
 692	inet6_del_protocol(&destopt_protocol, IPPROTO_DSTOPTS);
 693out_rthdr:
 694	inet6_del_protocol(&rthdr_protocol, IPPROTO_ROUTING);
 695	goto out;
 696};
 697
 698void ipv6_exthdrs_exit(void)
 699{
 700	inet6_del_protocol(&nodata_protocol, IPPROTO_NONE);
 701	inet6_del_protocol(&destopt_protocol, IPPROTO_DSTOPTS);
 702	inet6_del_protocol(&rthdr_protocol, IPPROTO_ROUTING);
 703}
 704
 705/**********************************
 706  Hop-by-hop options.
 707 **********************************/
 708
 709/*
 710 * Note: we cannot rely on skb_dst(skb) before we assign it in ip6_route_input().
 711 */
 712static inline struct inet6_dev *ipv6_skb_idev(struct sk_buff *skb)
 713{
 714	return skb_dst(skb) ? ip6_dst_idev(skb_dst(skb)) : __in6_dev_get(skb->dev);
 715}
 716
 717static inline struct net *ipv6_skb_net(struct sk_buff *skb)
 718{
 719	return skb_dst(skb) ? dev_net(skb_dst(skb)->dev) : dev_net(skb->dev);
 720}
 721
 722/* Router Alert as of RFC 2711 */
 723
 724static bool ipv6_hop_ra(struct sk_buff *skb, int optoff)
 725{
 726	const unsigned char *nh = skb_network_header(skb);
 727
 728	if (nh[optoff + 1] == 2) {
 729		IP6CB(skb)->flags |= IP6SKB_ROUTERALERT;
 730		memcpy(&IP6CB(skb)->ra, nh + optoff + 2, sizeof(IP6CB(skb)->ra));
 731		return true;
 732	}
 733	net_dbg_ratelimited("ipv6_hop_ra: wrong RA length %d\n",
 734			    nh[optoff + 1]);
 735	kfree_skb(skb);
 736	return false;
 737}
 738
 739/* Jumbo payload */
 740
 741static bool ipv6_hop_jumbo(struct sk_buff *skb, int optoff)
 742{
 743	const unsigned char *nh = skb_network_header(skb);
 744	struct inet6_dev *idev = __in6_dev_get_safely(skb->dev);
 745	struct net *net = ipv6_skb_net(skb);
 746	u32 pkt_len;
 747
 748	if (nh[optoff + 1] != 4 || (optoff & 3) != 2) {
 749		net_dbg_ratelimited("ipv6_hop_jumbo: wrong jumbo opt length/alignment %d\n",
 750				    nh[optoff+1]);
 751		__IP6_INC_STATS(net, idev, IPSTATS_MIB_INHDRERRORS);
 
 752		goto drop;
 753	}
 754
 755	pkt_len = ntohl(*(__be32 *)(nh + optoff + 2));
 756	if (pkt_len <= IPV6_MAXPLEN) {
 757		__IP6_INC_STATS(net, idev, IPSTATS_MIB_INHDRERRORS);
 
 758		icmpv6_param_prob(skb, ICMPV6_HDR_FIELD, optoff+2);
 759		return false;
 760	}
 761	if (ipv6_hdr(skb)->payload_len) {
 762		__IP6_INC_STATS(net, idev, IPSTATS_MIB_INHDRERRORS);
 
 763		icmpv6_param_prob(skb, ICMPV6_HDR_FIELD, optoff);
 764		return false;
 765	}
 766
 767	if (pkt_len > skb->len - sizeof(struct ipv6hdr)) {
 768		__IP6_INC_STATS(net, idev, IPSTATS_MIB_INTRUNCATEDPKTS);
 
 769		goto drop;
 770	}
 771
 772	if (pskb_trim_rcsum(skb, pkt_len + sizeof(struct ipv6hdr)))
 773		goto drop;
 774
 775	IP6CB(skb)->flags |= IP6SKB_JUMBOGRAM;
 776	return true;
 777
 778drop:
 779	kfree_skb(skb);
 780	return false;
 781}
 782
 783/* CALIPSO RFC 5570 */
 784
 785static bool ipv6_hop_calipso(struct sk_buff *skb, int optoff)
 786{
 787	const unsigned char *nh = skb_network_header(skb);
 788
 789	if (nh[optoff + 1] < 8)
 790		goto drop;
 791
 792	if (nh[optoff + 6] * 4 + 8 > nh[optoff + 1])
 793		goto drop;
 794
 795	if (!calipso_validate(skb, nh + optoff))
 796		goto drop;
 797
 798	return true;
 799
 800drop:
 801	kfree_skb(skb);
 802	return false;
 803}
 804
 805static const struct tlvtype_proc tlvprochopopt_lst[] = {
 806	{
 807		.type	= IPV6_TLV_ROUTERALERT,
 808		.func	= ipv6_hop_ra,
 809	},
 810	{
 811		.type	= IPV6_TLV_JUMBO,
 812		.func	= ipv6_hop_jumbo,
 813	},
 814	{
 815		.type	= IPV6_TLV_CALIPSO,
 816		.func	= ipv6_hop_calipso,
 817	},
 818	{ -1, }
 819};
 820
 821int ipv6_parse_hopopts(struct sk_buff *skb)
 822{
 823	struct inet6_skb_parm *opt = IP6CB(skb);
 824	struct net *net = dev_net(skb->dev);
 825	int extlen;
 826
 827	/*
 828	 * skb_network_header(skb) is equal to skb->data, and
 829	 * skb_network_header_len(skb) is always equal to
 830	 * sizeof(struct ipv6hdr) by definition of
 831	 * hop-by-hop options.
 832	 */
 833	if (!pskb_may_pull(skb, sizeof(struct ipv6hdr) + 8) ||
 834	    !pskb_may_pull(skb, (sizeof(struct ipv6hdr) +
 835				 ((skb_transport_header(skb)[1] + 1) << 3)))) {
 836fail_and_free:
 837		kfree_skb(skb);
 838		return -1;
 839	}
 840
 841	extlen = (skb_transport_header(skb)[1] + 1) << 3;
 842	if (extlen > net->ipv6.sysctl.max_hbh_opts_len)
 843		goto fail_and_free;
 844
 845	opt->flags |= IP6SKB_HOPBYHOP;
 846	if (ip6_parse_tlv(tlvprochopopt_lst, skb,
 847			  init_net.ipv6.sysctl.max_hbh_opts_cnt)) {
 848		skb->transport_header += extlen;
 849		opt = IP6CB(skb);
 850		opt->nhoff = sizeof(struct ipv6hdr);
 851		return 1;
 852	}
 853	return -1;
 854}
 855
 856/*
 857 *	Creating outbound headers.
 858 *
 859 *	"build" functions work when skb is filled from head to tail (datagram)
 860 *	"push"	functions work when headers are added from tail to head (tcp)
 861 *
 862 *	In both cases we assume, that caller reserved enough room
 863 *	for headers.
 864 */
 865
 866static void ipv6_push_rthdr0(struct sk_buff *skb, u8 *proto,
 867			     struct ipv6_rt_hdr *opt,
 868			     struct in6_addr **addr_p, struct in6_addr *saddr)
 869{
 870	struct rt0_hdr *phdr, *ihdr;
 871	int hops;
 872
 873	ihdr = (struct rt0_hdr *) opt;
 874
 875	phdr = skb_push(skb, (ihdr->rt_hdr.hdrlen + 1) << 3);
 876	memcpy(phdr, ihdr, sizeof(struct rt0_hdr));
 877
 878	hops = ihdr->rt_hdr.hdrlen >> 1;
 879
 880	if (hops > 1)
 881		memcpy(phdr->addr, ihdr->addr + 1,
 882		       (hops - 1) * sizeof(struct in6_addr));
 883
 884	phdr->addr[hops - 1] = **addr_p;
 885	*addr_p = ihdr->addr;
 886
 887	phdr->rt_hdr.nexthdr = *proto;
 888	*proto = NEXTHDR_ROUTING;
 889}
 890
 891static void ipv6_push_rthdr4(struct sk_buff *skb, u8 *proto,
 892			     struct ipv6_rt_hdr *opt,
 893			     struct in6_addr **addr_p, struct in6_addr *saddr)
 894{
 895	struct ipv6_sr_hdr *sr_phdr, *sr_ihdr;
 896	int plen, hops;
 897
 898	sr_ihdr = (struct ipv6_sr_hdr *)opt;
 899	plen = (sr_ihdr->hdrlen + 1) << 3;
 900
 901	sr_phdr = skb_push(skb, plen);
 902	memcpy(sr_phdr, sr_ihdr, sizeof(struct ipv6_sr_hdr));
 903
 904	hops = sr_ihdr->first_segment + 1;
 905	memcpy(sr_phdr->segments + 1, sr_ihdr->segments + 1,
 906	       (hops - 1) * sizeof(struct in6_addr));
 907
 908	sr_phdr->segments[0] = **addr_p;
 909	*addr_p = &sr_ihdr->segments[sr_ihdr->segments_left];
 910
 911	if (sr_ihdr->hdrlen > hops * 2) {
 912		int tlvs_offset, tlvs_length;
 913
 914		tlvs_offset = (1 + hops * 2) << 3;
 915		tlvs_length = (sr_ihdr->hdrlen - hops * 2) << 3;
 916		memcpy((char *)sr_phdr + tlvs_offset,
 917		       (char *)sr_ihdr + tlvs_offset, tlvs_length);
 918	}
 919
 920#ifdef CONFIG_IPV6_SEG6_HMAC
 921	if (sr_has_hmac(sr_phdr)) {
 922		struct net *net = NULL;
 923
 924		if (skb->dev)
 925			net = dev_net(skb->dev);
 926		else if (skb->sk)
 927			net = sock_net(skb->sk);
 928
 929		WARN_ON(!net);
 930
 931		if (net)
 932			seg6_push_hmac(net, saddr, sr_phdr);
 933	}
 934#endif
 935
 936	sr_phdr->nexthdr = *proto;
 937	*proto = NEXTHDR_ROUTING;
 938}
 939
 940static void ipv6_push_rthdr(struct sk_buff *skb, u8 *proto,
 941			    struct ipv6_rt_hdr *opt,
 942			    struct in6_addr **addr_p, struct in6_addr *saddr)
 943{
 944	switch (opt->type) {
 945	case IPV6_SRCRT_TYPE_0:
 946	case IPV6_SRCRT_STRICT:
 947	case IPV6_SRCRT_TYPE_2:
 948		ipv6_push_rthdr0(skb, proto, opt, addr_p, saddr);
 949		break;
 950	case IPV6_SRCRT_TYPE_4:
 951		ipv6_push_rthdr4(skb, proto, opt, addr_p, saddr);
 952		break;
 953	default:
 954		break;
 955	}
 956}
 957
 958static void ipv6_push_exthdr(struct sk_buff *skb, u8 *proto, u8 type, struct ipv6_opt_hdr *opt)
 959{
 960	struct ipv6_opt_hdr *h = skb_push(skb, ipv6_optlen(opt));
 961
 962	memcpy(h, opt, ipv6_optlen(opt));
 963	h->nexthdr = *proto;
 964	*proto = type;
 965}
 966
 967void ipv6_push_nfrag_opts(struct sk_buff *skb, struct ipv6_txoptions *opt,
 968			  u8 *proto,
 969			  struct in6_addr **daddr, struct in6_addr *saddr)
 970{
 971	if (opt->srcrt) {
 972		ipv6_push_rthdr(skb, proto, opt->srcrt, daddr, saddr);
 973		/*
 974		 * IPV6_RTHDRDSTOPTS is ignored
 975		 * unless IPV6_RTHDR is set (RFC3542).
 976		 */
 977		if (opt->dst0opt)
 978			ipv6_push_exthdr(skb, proto, NEXTHDR_DEST, opt->dst0opt);
 979	}
 980	if (opt->hopopt)
 981		ipv6_push_exthdr(skb, proto, NEXTHDR_HOP, opt->hopopt);
 982}
 983
 
 
 984void ipv6_push_frag_opts(struct sk_buff *skb, struct ipv6_txoptions *opt, u8 *proto)
 985{
 986	if (opt->dst1opt)
 987		ipv6_push_exthdr(skb, proto, NEXTHDR_DEST, opt->dst1opt);
 988}
 989EXPORT_SYMBOL(ipv6_push_frag_opts);
 990
 991struct ipv6_txoptions *
 992ipv6_dup_options(struct sock *sk, struct ipv6_txoptions *opt)
 993{
 994	struct ipv6_txoptions *opt2;
 995
 996	opt2 = sock_kmalloc(sk, opt->tot_len, GFP_ATOMIC);
 997	if (opt2) {
 998		long dif = (char *)opt2 - (char *)opt;
 999		memcpy(opt2, opt, opt->tot_len);
1000		if (opt2->hopopt)
1001			*((char **)&opt2->hopopt) += dif;
1002		if (opt2->dst0opt)
1003			*((char **)&opt2->dst0opt) += dif;
1004		if (opt2->dst1opt)
1005			*((char **)&opt2->dst1opt) += dif;
1006		if (opt2->srcrt)
1007			*((char **)&opt2->srcrt) += dif;
1008		refcount_set(&opt2->refcnt, 1);
1009	}
1010	return opt2;
1011}
 
1012EXPORT_SYMBOL_GPL(ipv6_dup_options);
1013
1014static void ipv6_renew_option(int renewtype,
1015			      struct ipv6_opt_hdr **dest,
1016			      struct ipv6_opt_hdr *old,
1017			      struct ipv6_opt_hdr *new,
1018			      int newtype, char **p)
1019{
1020	struct ipv6_opt_hdr *src;
1021
1022	src = (renewtype == newtype ? new : old);
1023	if (!src)
1024		return;
1025
1026	memcpy(*p, src, ipv6_optlen(src));
1027	*dest = (struct ipv6_opt_hdr *)*p;
1028	*p += CMSG_ALIGN(ipv6_optlen(*dest));
 
 
 
 
 
 
 
 
1029}
1030
1031/**
1032 * ipv6_renew_options - replace a specific ext hdr with a new one.
1033 *
1034 * @sk: sock from which to allocate memory
1035 * @opt: original options
1036 * @newtype: option type to replace in @opt
1037 * @newopt: new option of type @newtype to replace (user-mem)
1038 * @newoptlen: length of @newopt
1039 *
1040 * Returns a new set of options which is a copy of @opt with the
1041 * option type @newtype replaced with @newopt.
1042 *
1043 * @opt may be NULL, in which case a new set of options is returned
1044 * containing just @newopt.
1045 *
1046 * @newopt may be NULL, in which case the specified option type is
1047 * not copied into the new set of options.
1048 *
1049 * The new set of options is allocated from the socket option memory
1050 * buffer of @sk.
1051 */
1052struct ipv6_txoptions *
1053ipv6_renew_options(struct sock *sk, struct ipv6_txoptions *opt,
1054		   int newtype, struct ipv6_opt_hdr *newopt)
 
1055{
1056	int tot_len = 0;
1057	char *p;
1058	struct ipv6_txoptions *opt2;
 
1059
1060	if (opt) {
1061		if (newtype != IPV6_HOPOPTS && opt->hopopt)
1062			tot_len += CMSG_ALIGN(ipv6_optlen(opt->hopopt));
1063		if (newtype != IPV6_RTHDRDSTOPTS && opt->dst0opt)
1064			tot_len += CMSG_ALIGN(ipv6_optlen(opt->dst0opt));
1065		if (newtype != IPV6_RTHDR && opt->srcrt)
1066			tot_len += CMSG_ALIGN(ipv6_optlen(opt->srcrt));
1067		if (newtype != IPV6_DSTOPTS && opt->dst1opt)
1068			tot_len += CMSG_ALIGN(ipv6_optlen(opt->dst1opt));
1069	}
1070
1071	if (newopt)
1072		tot_len += CMSG_ALIGN(ipv6_optlen(newopt));
1073
1074	if (!tot_len)
1075		return NULL;
1076
1077	tot_len += sizeof(*opt2);
1078	opt2 = sock_kmalloc(sk, tot_len, GFP_ATOMIC);
1079	if (!opt2)
1080		return ERR_PTR(-ENOBUFS);
1081
1082	memset(opt2, 0, tot_len);
1083	refcount_set(&opt2->refcnt, 1);
1084	opt2->tot_len = tot_len;
1085	p = (char *)(opt2 + 1);
1086
1087	ipv6_renew_option(IPV6_HOPOPTS, &opt2->hopopt,
1088			  (opt ? opt->hopopt : NULL),
1089			  newopt, newtype, &p);
1090	ipv6_renew_option(IPV6_RTHDRDSTOPTS, &opt2->dst0opt,
1091			  (opt ? opt->dst0opt : NULL),
1092			  newopt, newtype, &p);
1093	ipv6_renew_option(IPV6_RTHDR,
1094			  (struct ipv6_opt_hdr **)&opt2->srcrt,
1095			  (opt ? (struct ipv6_opt_hdr *)opt->srcrt : NULL),
1096			  newopt, newtype, &p);
1097	ipv6_renew_option(IPV6_DSTOPTS, &opt2->dst1opt,
1098			  (opt ? opt->dst1opt : NULL),
1099			  newopt, newtype, &p);
 
 
 
 
 
 
 
 
 
 
1100
1101	opt2->opt_nflen = (opt2->hopopt ? ipv6_optlen(opt2->hopopt) : 0) +
1102			  (opt2->dst0opt ? ipv6_optlen(opt2->dst0opt) : 0) +
1103			  (opt2->srcrt ? ipv6_optlen(opt2->srcrt) : 0);
1104	opt2->opt_flen = (opt2->dst1opt ? ipv6_optlen(opt2->dst1opt) : 0);
1105
1106	return opt2;
 
 
 
1107}
1108
1109struct ipv6_txoptions *ipv6_fixup_options(struct ipv6_txoptions *opt_space,
1110					  struct ipv6_txoptions *opt)
1111{
1112	/*
1113	 * ignore the dest before srcrt unless srcrt is being included.
1114	 * --yoshfuji
1115	 */
1116	if (opt && opt->dst0opt && !opt->srcrt) {
1117		if (opt_space != opt) {
1118			memcpy(opt_space, opt, sizeof(*opt_space));
1119			opt = opt_space;
1120		}
1121		opt->opt_nflen -= ipv6_optlen(opt->dst0opt);
1122		opt->dst0opt = NULL;
1123	}
1124
1125	return opt;
1126}
1127EXPORT_SYMBOL_GPL(ipv6_fixup_options);
1128
1129/**
1130 * fl6_update_dst - update flowi destination address with info given
1131 *                  by srcrt option, if any.
1132 *
1133 * @fl6: flowi6 for which daddr is to be updated
1134 * @opt: struct ipv6_txoptions in which to look for srcrt opt
1135 * @orig: copy of original daddr address if modified
1136 *
1137 * Returns NULL if no txoptions or no srcrt, otherwise returns orig
1138 * and initial value of fl6->daddr set in orig
1139 */
1140struct in6_addr *fl6_update_dst(struct flowi6 *fl6,
1141				const struct ipv6_txoptions *opt,
1142				struct in6_addr *orig)
1143{
1144	if (!opt || !opt->srcrt)
1145		return NULL;
1146
1147	*orig = fl6->daddr;
1148
1149	switch (opt->srcrt->type) {
1150	case IPV6_SRCRT_TYPE_0:
1151	case IPV6_SRCRT_STRICT:
1152	case IPV6_SRCRT_TYPE_2:
1153		fl6->daddr = *((struct rt0_hdr *)opt->srcrt)->addr;
1154		break;
1155	case IPV6_SRCRT_TYPE_4:
1156	{
1157		struct ipv6_sr_hdr *srh = (struct ipv6_sr_hdr *)opt->srcrt;
1158
1159		fl6->daddr = srh->segments[srh->segments_left];
1160		break;
1161	}
1162	default:
1163		return NULL;
1164	}
1165
1166	return orig;
1167}
 
1168EXPORT_SYMBOL_GPL(fl6_update_dst);