3 * Linux INET6 implementation
6 * Pedro Roque <roque@di.fc.ul.pt>
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License
10 * as published by the Free Software Foundation; either version
11 * 2 of the License, or (at your option) any later version.
14 #include <linux/capability.h>
15 #include <linux/errno.h>
16 #include <linux/types.h>
17 #include <linux/kernel.h>
18 #include <linux/interrupt.h>
19 #include <linux/socket.h>
20 #include <linux/sockios.h>
21 #include <linux/in6.h>
22 #include <linux/ipv6.h>
23 #include <linux/route.h>
26 #include <net/ndisc.h>
27 #include <net/addrconf.h>
28 #include <net/transp_v6.h>
29 #include <net/ip6_route.h>
30 #include <net/tcp_states.h>
32 #include <linux/errqueue.h>
33 #include <asm/uaccess.h>
35 int ip6_datagram_connect(struct sock
*sk
, struct sockaddr
*uaddr
, int addr_len
)
37 struct sockaddr_in6
*usin
= (struct sockaddr_in6
*) uaddr
;
38 struct inet_sock
*inet
= inet_sk(sk
);
39 struct ipv6_pinfo
*np
= inet6_sk(sk
);
40 struct in6_addr
*daddr
, *final_p
= NULL
, final
;
41 struct dst_entry
*dst
;
43 struct ip6_flowlabel
*flowlabel
= NULL
;
47 if (usin
->sin6_family
== AF_INET
) {
48 if (__ipv6_only_sock(sk
))
50 err
= ip4_datagram_connect(sk
, uaddr
, addr_len
);
54 if (addr_len
< SIN6_LEN_RFC2133
)
57 if (usin
->sin6_family
!= AF_INET6
)
60 memset(&fl
, 0, sizeof(fl
));
62 fl
.fl6_flowlabel
= usin
->sin6_flowinfo
&IPV6_FLOWINFO_MASK
;
63 if (fl
.fl6_flowlabel
&IPV6_FLOWLABEL_MASK
) {
64 flowlabel
= fl6_sock_lookup(sk
, fl
.fl6_flowlabel
);
65 if (flowlabel
== NULL
)
67 ipv6_addr_copy(&usin
->sin6_addr
, &flowlabel
->dst
);
71 addr_type
= ipv6_addr_type(&usin
->sin6_addr
);
73 if (addr_type
== IPV6_ADDR_ANY
) {
77 usin
->sin6_addr
.s6_addr
[15] = 0x01;
80 daddr
= &usin
->sin6_addr
;
82 if (addr_type
== IPV6_ADDR_MAPPED
) {
83 struct sockaddr_in sin
;
85 if (__ipv6_only_sock(sk
)) {
89 sin
.sin_family
= AF_INET
;
90 sin
.sin_addr
.s_addr
= daddr
->s6_addr32
[3];
91 sin
.sin_port
= usin
->sin6_port
;
93 err
= ip4_datagram_connect(sk
,
94 (struct sockaddr
*) &sin
,
101 ipv6_addr_set_v4mapped(inet
->daddr
, &np
->daddr
);
103 if (ipv6_addr_any(&np
->saddr
))
104 ipv6_addr_set_v4mapped(inet
->saddr
, &np
->saddr
);
106 if (ipv6_addr_any(&np
->rcv_saddr
))
107 ipv6_addr_set_v4mapped(inet
->rcv_saddr
, &np
->rcv_saddr
);
112 if (addr_type
&IPV6_ADDR_LINKLOCAL
) {
113 if (addr_len
>= sizeof(struct sockaddr_in6
) &&
114 usin
->sin6_scope_id
) {
115 if (sk
->sk_bound_dev_if
&&
116 sk
->sk_bound_dev_if
!= usin
->sin6_scope_id
) {
120 sk
->sk_bound_dev_if
= usin
->sin6_scope_id
;
123 if (!sk
->sk_bound_dev_if
&& (addr_type
& IPV6_ADDR_MULTICAST
))
124 sk
->sk_bound_dev_if
= np
->mcast_oif
;
126 /* Connect to link-local address requires an interface */
127 if (!sk
->sk_bound_dev_if
) {
133 ipv6_addr_copy(&np
->daddr
, daddr
);
134 np
->flow_label
= fl
.fl6_flowlabel
;
136 inet
->dport
= usin
->sin6_port
;
139 * Check for a route to destination an obtain the
140 * destination cache for it.
143 fl
.proto
= sk
->sk_protocol
;
144 ipv6_addr_copy(&fl
.fl6_dst
, &np
->daddr
);
145 ipv6_addr_copy(&fl
.fl6_src
, &np
->saddr
);
146 fl
.oif
= sk
->sk_bound_dev_if
;
147 fl
.mark
= sk
->sk_mark
;
148 fl
.fl_ip_dport
= inet
->dport
;
149 fl
.fl_ip_sport
= inet
->sport
;
151 if (!fl
.oif
&& (addr_type
&IPV6_ADDR_MULTICAST
))
152 fl
.oif
= np
->mcast_oif
;
154 security_sk_classify_flow(sk
, &fl
);
157 if (flowlabel
->opt
&& flowlabel
->opt
->srcrt
) {
158 struct rt0_hdr
*rt0
= (struct rt0_hdr
*) flowlabel
->opt
->srcrt
;
159 ipv6_addr_copy(&final
, &fl
.fl6_dst
);
160 ipv6_addr_copy(&fl
.fl6_dst
, rt0
->addr
);
163 } else if (np
->opt
&& np
->opt
->srcrt
) {
164 struct rt0_hdr
*rt0
= (struct rt0_hdr
*)np
->opt
->srcrt
;
165 ipv6_addr_copy(&final
, &fl
.fl6_dst
);
166 ipv6_addr_copy(&fl
.fl6_dst
, rt0
->addr
);
170 err
= ip6_dst_lookup(sk
, &dst
, &fl
);
174 ipv6_addr_copy(&fl
.fl6_dst
, final_p
);
176 err
= __xfrm_lookup(sock_net(sk
), &dst
, &fl
, sk
, XFRM_LOOKUP_WAIT
);
179 err
= ip6_dst_blackhole(sk
, &dst
, &fl
);
184 /* source address lookup done in ip6_dst_lookup */
186 if (ipv6_addr_any(&np
->saddr
))
187 ipv6_addr_copy(&np
->saddr
, &fl
.fl6_src
);
189 if (ipv6_addr_any(&np
->rcv_saddr
)) {
190 ipv6_addr_copy(&np
->rcv_saddr
, &fl
.fl6_src
);
191 inet
->rcv_saddr
= LOOPBACK4_IPV6
;
194 ip6_dst_store(sk
, dst
,
195 ipv6_addr_equal(&fl
.fl6_dst
, &np
->daddr
) ?
197 #ifdef CONFIG_IPV6_SUBTREES
198 ipv6_addr_equal(&fl
.fl6_src
, &np
->saddr
) ?
203 sk
->sk_state
= TCP_ESTABLISHED
;
205 fl6_sock_release(flowlabel
);
209 void ipv6_icmp_error(struct sock
*sk
, struct sk_buff
*skb
, int err
,
210 __be16 port
, u32 info
, u8
*payload
)
212 struct ipv6_pinfo
*np
= inet6_sk(sk
);
213 struct icmp6hdr
*icmph
= icmp6_hdr(skb
);
214 struct sock_exterr_skb
*serr
;
219 skb
= skb_clone(skb
, GFP_ATOMIC
);
223 serr
= SKB_EXT_ERR(skb
);
224 serr
->ee
.ee_errno
= err
;
225 serr
->ee
.ee_origin
= SO_EE_ORIGIN_ICMP6
;
226 serr
->ee
.ee_type
= icmph
->icmp6_type
;
227 serr
->ee
.ee_code
= icmph
->icmp6_code
;
229 serr
->ee
.ee_info
= info
;
230 serr
->ee
.ee_data
= 0;
231 serr
->addr_offset
= (u8
*)&(((struct ipv6hdr
*)(icmph
+ 1))->daddr
) -
232 skb_network_header(skb
);
235 __skb_pull(skb
, payload
- skb
->data
);
236 skb_reset_transport_header(skb
);
238 if (sock_queue_err_skb(sk
, skb
))
242 void ipv6_local_error(struct sock
*sk
, int err
, struct flowi
*fl
, u32 info
)
244 struct ipv6_pinfo
*np
= inet6_sk(sk
);
245 struct sock_exterr_skb
*serr
;
252 skb
= alloc_skb(sizeof(struct ipv6hdr
), GFP_ATOMIC
);
256 skb_put(skb
, sizeof(struct ipv6hdr
));
257 skb_reset_network_header(skb
);
259 ipv6_addr_copy(&iph
->daddr
, &fl
->fl6_dst
);
261 serr
= SKB_EXT_ERR(skb
);
262 serr
->ee
.ee_errno
= err
;
263 serr
->ee
.ee_origin
= SO_EE_ORIGIN_LOCAL
;
264 serr
->ee
.ee_type
= 0;
265 serr
->ee
.ee_code
= 0;
267 serr
->ee
.ee_info
= info
;
268 serr
->ee
.ee_data
= 0;
269 serr
->addr_offset
= (u8
*)&iph
->daddr
- skb_network_header(skb
);
270 serr
->port
= fl
->fl_ip_dport
;
272 __skb_pull(skb
, skb_tail_pointer(skb
) - skb
->data
);
273 skb_reset_transport_header(skb
);
275 if (sock_queue_err_skb(sk
, skb
))
280 * Handle MSG_ERRQUEUE
282 int ipv6_recv_error(struct sock
*sk
, struct msghdr
*msg
, int len
)
284 struct ipv6_pinfo
*np
= inet6_sk(sk
);
285 struct sock_exterr_skb
*serr
;
286 struct sk_buff
*skb
, *skb2
;
287 struct sockaddr_in6
*sin
;
289 struct sock_extended_err ee
;
290 struct sockaddr_in6 offender
;
296 skb
= skb_dequeue(&sk
->sk_error_queue
);
302 msg
->msg_flags
|= MSG_TRUNC
;
305 err
= skb_copy_datagram_iovec(skb
, 0, msg
->msg_iov
, copied
);
309 sock_recv_timestamp(msg
, sk
, skb
);
311 serr
= SKB_EXT_ERR(skb
);
313 sin
= (struct sockaddr_in6
*)msg
->msg_name
;
315 const unsigned char *nh
= skb_network_header(skb
);
316 sin
->sin6_family
= AF_INET6
;
317 sin
->sin6_flowinfo
= 0;
318 sin
->sin6_port
= serr
->port
;
319 sin
->sin6_scope_id
= 0;
320 if (serr
->ee
.ee_origin
== SO_EE_ORIGIN_ICMP6
) {
321 ipv6_addr_copy(&sin
->sin6_addr
,
322 (struct in6_addr
*)(nh
+ serr
->addr_offset
));
325 (*(__be32
*)(nh
+ serr
->addr_offset
- 24) &
327 if (ipv6_addr_type(&sin
->sin6_addr
) & IPV6_ADDR_LINKLOCAL
)
328 sin
->sin6_scope_id
= IP6CB(skb
)->iif
;
330 ipv6_addr_set_v4mapped(*(__be32
*)(nh
+ serr
->addr_offset
),
335 memcpy(&errhdr
.ee
, &serr
->ee
, sizeof(struct sock_extended_err
));
336 sin
= &errhdr
.offender
;
337 sin
->sin6_family
= AF_UNSPEC
;
338 if (serr
->ee
.ee_origin
!= SO_EE_ORIGIN_LOCAL
) {
339 sin
->sin6_family
= AF_INET6
;
340 sin
->sin6_flowinfo
= 0;
341 sin
->sin6_scope_id
= 0;
342 if (serr
->ee
.ee_origin
== SO_EE_ORIGIN_ICMP6
) {
343 ipv6_addr_copy(&sin
->sin6_addr
, &ipv6_hdr(skb
)->saddr
);
345 datagram_recv_ctl(sk
, msg
, skb
);
346 if (ipv6_addr_type(&sin
->sin6_addr
) & IPV6_ADDR_LINKLOCAL
)
347 sin
->sin6_scope_id
= IP6CB(skb
)->iif
;
349 struct inet_sock
*inet
= inet_sk(sk
);
351 ipv6_addr_set_v4mapped(ip_hdr(skb
)->saddr
,
353 if (inet
->cmsg_flags
)
354 ip_cmsg_recv(msg
, skb
);
358 put_cmsg(msg
, SOL_IPV6
, IPV6_RECVERR
, sizeof(errhdr
), &errhdr
);
360 /* Now we could try to dump offended packet options */
362 msg
->msg_flags
|= MSG_ERRQUEUE
;
365 /* Reset and regenerate socket error */
366 spin_lock_bh(&sk
->sk_error_queue
.lock
);
368 if ((skb2
= skb_peek(&sk
->sk_error_queue
)) != NULL
) {
369 sk
->sk_err
= SKB_EXT_ERR(skb2
)->ee
.ee_errno
;
370 spin_unlock_bh(&sk
->sk_error_queue
.lock
);
371 sk
->sk_error_report(sk
);
373 spin_unlock_bh(&sk
->sk_error_queue
.lock
);
384 int datagram_recv_ctl(struct sock
*sk
, struct msghdr
*msg
, struct sk_buff
*skb
)
386 struct ipv6_pinfo
*np
= inet6_sk(sk
);
387 struct inet6_skb_parm
*opt
= IP6CB(skb
);
388 unsigned char *nh
= skb_network_header(skb
);
390 if (np
->rxopt
.bits
.rxinfo
) {
391 struct in6_pktinfo src_info
;
393 src_info
.ipi6_ifindex
= opt
->iif
;
394 ipv6_addr_copy(&src_info
.ipi6_addr
, &ipv6_hdr(skb
)->daddr
);
395 put_cmsg(msg
, SOL_IPV6
, IPV6_PKTINFO
, sizeof(src_info
), &src_info
);
398 if (np
->rxopt
.bits
.rxhlim
) {
399 int hlim
= ipv6_hdr(skb
)->hop_limit
;
400 put_cmsg(msg
, SOL_IPV6
, IPV6_HOPLIMIT
, sizeof(hlim
), &hlim
);
403 if (np
->rxopt
.bits
.rxtclass
) {
404 int tclass
= (ntohl(*(__be32
*)ipv6_hdr(skb
)) >> 20) & 0xff;
405 put_cmsg(msg
, SOL_IPV6
, IPV6_TCLASS
, sizeof(tclass
), &tclass
);
408 if (np
->rxopt
.bits
.rxflow
&& (*(__be32
*)nh
& IPV6_FLOWINFO_MASK
)) {
409 __be32 flowinfo
= *(__be32
*)nh
& IPV6_FLOWINFO_MASK
;
410 put_cmsg(msg
, SOL_IPV6
, IPV6_FLOWINFO
, sizeof(flowinfo
), &flowinfo
);
413 /* HbH is allowed only once */
414 if (np
->rxopt
.bits
.hopopts
&& opt
->hop
) {
415 u8
*ptr
= nh
+ opt
->hop
;
416 put_cmsg(msg
, SOL_IPV6
, IPV6_HOPOPTS
, (ptr
[1]+1)<<3, ptr
);
420 (np
->rxopt
.bits
.dstopts
|| np
->rxopt
.bits
.srcrt
)) {
422 * Silly enough, but we need to reparse in order to
423 * report extension headers (except for HbH)
426 * Also note that IPV6_RECVRTHDRDSTOPTS is NOT
427 * (and WILL NOT be) defined because
428 * IPV6_RECVDSTOPTS is more generic. --yoshfuji
430 unsigned int off
= sizeof(struct ipv6hdr
);
431 u8 nexthdr
= ipv6_hdr(skb
)->nexthdr
;
433 while (off
<= opt
->lastopt
) {
438 case IPPROTO_DSTOPTS
:
440 len
= (ptr
[1] + 1) << 3;
441 if (np
->rxopt
.bits
.dstopts
)
442 put_cmsg(msg
, SOL_IPV6
, IPV6_DSTOPTS
, len
, ptr
);
444 case IPPROTO_ROUTING
:
446 len
= (ptr
[1] + 1) << 3;
447 if (np
->rxopt
.bits
.srcrt
)
448 put_cmsg(msg
, SOL_IPV6
, IPV6_RTHDR
, len
, ptr
);
452 len
= (ptr
[1] + 2) << 2;
456 len
= (ptr
[1] + 1) << 3;
464 /* socket options in old style */
465 if (np
->rxopt
.bits
.rxoinfo
) {
466 struct in6_pktinfo src_info
;
468 src_info
.ipi6_ifindex
= opt
->iif
;
469 ipv6_addr_copy(&src_info
.ipi6_addr
, &ipv6_hdr(skb
)->daddr
);
470 put_cmsg(msg
, SOL_IPV6
, IPV6_2292PKTINFO
, sizeof(src_info
), &src_info
);
472 if (np
->rxopt
.bits
.rxohlim
) {
473 int hlim
= ipv6_hdr(skb
)->hop_limit
;
474 put_cmsg(msg
, SOL_IPV6
, IPV6_2292HOPLIMIT
, sizeof(hlim
), &hlim
);
476 if (np
->rxopt
.bits
.ohopopts
&& opt
->hop
) {
477 u8
*ptr
= nh
+ opt
->hop
;
478 put_cmsg(msg
, SOL_IPV6
, IPV6_2292HOPOPTS
, (ptr
[1]+1)<<3, ptr
);
480 if (np
->rxopt
.bits
.odstopts
&& opt
->dst0
) {
481 u8
*ptr
= nh
+ opt
->dst0
;
482 put_cmsg(msg
, SOL_IPV6
, IPV6_2292DSTOPTS
, (ptr
[1]+1)<<3, ptr
);
484 if (np
->rxopt
.bits
.osrcrt
&& opt
->srcrt
) {
485 struct ipv6_rt_hdr
*rthdr
= (struct ipv6_rt_hdr
*)(nh
+ opt
->srcrt
);
486 put_cmsg(msg
, SOL_IPV6
, IPV6_2292RTHDR
, (rthdr
->hdrlen
+1) << 3, rthdr
);
488 if (np
->rxopt
.bits
.odstopts
&& opt
->dst1
) {
489 u8
*ptr
= nh
+ opt
->dst1
;
490 put_cmsg(msg
, SOL_IPV6
, IPV6_2292DSTOPTS
, (ptr
[1]+1)<<3, ptr
);
495 int datagram_send_ctl(struct net
*net
,
496 struct msghdr
*msg
, struct flowi
*fl
,
497 struct ipv6_txoptions
*opt
,
498 int *hlimit
, int *tclass
)
500 struct in6_pktinfo
*src_info
;
501 struct cmsghdr
*cmsg
;
502 struct ipv6_rt_hdr
*rthdr
;
503 struct ipv6_opt_hdr
*hdr
;
507 for (cmsg
= CMSG_FIRSTHDR(msg
); cmsg
; cmsg
= CMSG_NXTHDR(msg
, cmsg
)) {
510 if (!CMSG_OK(msg
, cmsg
)) {
515 if (cmsg
->cmsg_level
!= SOL_IPV6
)
518 switch (cmsg
->cmsg_type
) {
520 case IPV6_2292PKTINFO
:
522 struct net_device
*dev
= NULL
;
524 if (cmsg
->cmsg_len
< CMSG_LEN(sizeof(struct in6_pktinfo
))) {
529 src_info
= (struct in6_pktinfo
*)CMSG_DATA(cmsg
);
531 if (src_info
->ipi6_ifindex
) {
532 if (fl
->oif
&& src_info
->ipi6_ifindex
!= fl
->oif
)
534 fl
->oif
= src_info
->ipi6_ifindex
;
537 addr_type
= __ipv6_addr_type(&src_info
->ipi6_addr
);
540 dev
= dev_get_by_index(net
, fl
->oif
);
543 } else if (addr_type
& IPV6_ADDR_LINKLOCAL
)
546 if (addr_type
!= IPV6_ADDR_ANY
) {
547 int strict
= __ipv6_addr_src_scope(addr_type
) <= IPV6_ADDR_SCOPE_LINKLOCAL
;
548 if (!ipv6_chk_addr(net
, &src_info
->ipi6_addr
,
549 strict
? dev
: NULL
, 0))
552 ipv6_addr_copy(&fl
->fl6_src
, &src_info
->ipi6_addr
);
565 if (cmsg
->cmsg_len
< CMSG_LEN(4)) {
570 if (fl
->fl6_flowlabel
&IPV6_FLOWINFO_MASK
) {
571 if ((fl
->fl6_flowlabel
^*(__be32
*)CMSG_DATA(cmsg
))&~IPV6_FLOWINFO_MASK
) {
576 fl
->fl6_flowlabel
= IPV6_FLOWINFO_MASK
& *(__be32
*)CMSG_DATA(cmsg
);
579 case IPV6_2292HOPOPTS
:
581 if (opt
->hopopt
|| cmsg
->cmsg_len
< CMSG_LEN(sizeof(struct ipv6_opt_hdr
))) {
586 hdr
= (struct ipv6_opt_hdr
*)CMSG_DATA(cmsg
);
587 len
= ((hdr
->hdrlen
+ 1) << 3);
588 if (cmsg
->cmsg_len
< CMSG_LEN(len
)) {
592 if (!capable(CAP_NET_RAW
)) {
596 opt
->opt_nflen
+= len
;
600 case IPV6_2292DSTOPTS
:
601 if (cmsg
->cmsg_len
< CMSG_LEN(sizeof(struct ipv6_opt_hdr
))) {
606 hdr
= (struct ipv6_opt_hdr
*)CMSG_DATA(cmsg
);
607 len
= ((hdr
->hdrlen
+ 1) << 3);
608 if (cmsg
->cmsg_len
< CMSG_LEN(len
)) {
612 if (!capable(CAP_NET_RAW
)) {
620 opt
->opt_flen
+= len
;
625 case IPV6_RTHDRDSTOPTS
:
626 if (cmsg
->cmsg_len
< CMSG_LEN(sizeof(struct ipv6_opt_hdr
))) {
631 hdr
= (struct ipv6_opt_hdr
*)CMSG_DATA(cmsg
);
632 len
= ((hdr
->hdrlen
+ 1) << 3);
633 if (cmsg
->cmsg_len
< CMSG_LEN(len
)) {
637 if (!capable(CAP_NET_RAW
)) {
641 if (cmsg
->cmsg_type
== IPV6_DSTOPTS
) {
642 opt
->opt_flen
+= len
;
645 opt
->opt_nflen
+= len
;
652 if (cmsg
->cmsg_len
< CMSG_LEN(sizeof(struct ipv6_rt_hdr
))) {
657 rthdr
= (struct ipv6_rt_hdr
*)CMSG_DATA(cmsg
);
659 switch (rthdr
->type
) {
660 #if defined(CONFIG_IPV6_MIP6) || defined(CONFIG_IPV6_MIP6_MODULE)
661 case IPV6_SRCRT_TYPE_2
:
662 if (rthdr
->hdrlen
!= 2 ||
663 rthdr
->segments_left
!= 1) {
674 len
= ((rthdr
->hdrlen
+ 1) << 3);
676 if (cmsg
->cmsg_len
< CMSG_LEN(len
)) {
681 /* segments left must also match */
682 if ((rthdr
->hdrlen
>> 1) != rthdr
->segments_left
) {
687 opt
->opt_nflen
+= len
;
690 if (cmsg
->cmsg_type
== IPV6_2292RTHDR
&& opt
->dst1opt
) {
691 int dsthdrlen
= ((opt
->dst1opt
->hdrlen
+1)<<3);
693 opt
->opt_nflen
+= dsthdrlen
;
694 opt
->dst0opt
= opt
->dst1opt
;
696 opt
->opt_flen
-= dsthdrlen
;
701 case IPV6_2292HOPLIMIT
:
703 if (cmsg
->cmsg_len
!= CMSG_LEN(sizeof(int))) {
708 *hlimit
= *(int *)CMSG_DATA(cmsg
);
709 if (*hlimit
< -1 || *hlimit
> 0xff) {
721 if (cmsg
->cmsg_len
!= CMSG_LEN(sizeof(int))) {
725 tc
= *(int *)CMSG_DATA(cmsg
);
726 if (tc
< -1 || tc
> 0xff)
735 LIMIT_NETDEBUG(KERN_DEBUG
"invalid cmsg type: %d\n",