11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds * common UDP/RAW code 31da177e4SLinus Torvalds * Linux INET6 implementation 41da177e4SLinus Torvalds * 51da177e4SLinus Torvalds * Authors: 61da177e4SLinus Torvalds * Pedro Roque <roque@di.fc.ul.pt> 71da177e4SLinus Torvalds * 81da177e4SLinus Torvalds * This program is free software; you can redistribute it and/or 91da177e4SLinus Torvalds * modify it under the terms of the GNU General Public License 101da177e4SLinus Torvalds * as published by the Free Software Foundation; either version 111da177e4SLinus Torvalds * 2 of the License, or (at your option) any later version. 121da177e4SLinus Torvalds */ 131da177e4SLinus Torvalds 144fc268d2SRandy Dunlap #include <linux/capability.h> 151da177e4SLinus Torvalds #include <linux/errno.h> 161da177e4SLinus Torvalds #include <linux/types.h> 171da177e4SLinus Torvalds #include <linux/kernel.h> 181da177e4SLinus Torvalds #include <linux/interrupt.h> 191da177e4SLinus Torvalds #include <linux/socket.h> 201da177e4SLinus Torvalds #include <linux/sockios.h> 211da177e4SLinus Torvalds #include <linux/in6.h> 221da177e4SLinus Torvalds #include <linux/ipv6.h> 231da177e4SLinus Torvalds #include <linux/route.h> 241da177e4SLinus Torvalds 251da177e4SLinus Torvalds #include <net/ipv6.h> 261da177e4SLinus Torvalds #include <net/ndisc.h> 271da177e4SLinus Torvalds #include <net/addrconf.h> 281da177e4SLinus Torvalds #include <net/transp_v6.h> 291da177e4SLinus Torvalds #include <net/ip6_route.h> 30c752f073SArnaldo Carvalho de Melo #include <net/tcp_states.h> 311da177e4SLinus Torvalds 321da177e4SLinus Torvalds #include <linux/errqueue.h> 331da177e4SLinus Torvalds #include <asm/uaccess.h> 341da177e4SLinus Torvalds 351da177e4SLinus Torvalds int ip6_datagram_connect(struct sock *sk, struct sockaddr *uaddr, int addr_len) 361da177e4SLinus Torvalds { 371da177e4SLinus Torvalds struct sockaddr_in6 *usin = (struct sockaddr_in6 *) uaddr; 381da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 391da177e4SLinus Torvalds struct ipv6_pinfo *np = inet6_sk(sk); 401da177e4SLinus Torvalds struct in6_addr *daddr, *final_p = NULL, final; 411da177e4SLinus Torvalds struct dst_entry *dst; 421da177e4SLinus Torvalds struct flowi fl; 431da177e4SLinus Torvalds struct ip6_flowlabel *flowlabel = NULL; 441da177e4SLinus Torvalds int addr_type; 451da177e4SLinus Torvalds int err; 461da177e4SLinus Torvalds 471da177e4SLinus Torvalds if (usin->sin6_family == AF_INET) { 481da177e4SLinus Torvalds if (__ipv6_only_sock(sk)) 491da177e4SLinus Torvalds return -EAFNOSUPPORT; 501da177e4SLinus Torvalds err = ip4_datagram_connect(sk, uaddr, addr_len); 511da177e4SLinus Torvalds goto ipv4_connected; 521da177e4SLinus Torvalds } 531da177e4SLinus Torvalds 541da177e4SLinus Torvalds if (addr_len < SIN6_LEN_RFC2133) 551da177e4SLinus Torvalds return -EINVAL; 561da177e4SLinus Torvalds 571da177e4SLinus Torvalds if (usin->sin6_family != AF_INET6) 581da177e4SLinus Torvalds return -EAFNOSUPPORT; 591da177e4SLinus Torvalds 601da177e4SLinus Torvalds memset(&fl, 0, sizeof(fl)); 611da177e4SLinus Torvalds if (np->sndflow) { 621da177e4SLinus Torvalds fl.fl6_flowlabel = usin->sin6_flowinfo&IPV6_FLOWINFO_MASK; 631da177e4SLinus Torvalds if (fl.fl6_flowlabel&IPV6_FLOWLABEL_MASK) { 641da177e4SLinus Torvalds flowlabel = fl6_sock_lookup(sk, fl.fl6_flowlabel); 651da177e4SLinus Torvalds if (flowlabel == NULL) 661da177e4SLinus Torvalds return -EINVAL; 671da177e4SLinus Torvalds ipv6_addr_copy(&usin->sin6_addr, &flowlabel->dst); 681da177e4SLinus Torvalds } 691da177e4SLinus Torvalds } 701da177e4SLinus Torvalds 711da177e4SLinus Torvalds addr_type = ipv6_addr_type(&usin->sin6_addr); 721da177e4SLinus Torvalds 731da177e4SLinus Torvalds if (addr_type == IPV6_ADDR_ANY) { 741da177e4SLinus Torvalds /* 751da177e4SLinus Torvalds * connect to self 761da177e4SLinus Torvalds */ 771da177e4SLinus Torvalds usin->sin6_addr.s6_addr[15] = 0x01; 781da177e4SLinus Torvalds } 791da177e4SLinus Torvalds 801da177e4SLinus Torvalds daddr = &usin->sin6_addr; 811da177e4SLinus Torvalds 821da177e4SLinus Torvalds if (addr_type == IPV6_ADDR_MAPPED) { 831da177e4SLinus Torvalds struct sockaddr_in sin; 841da177e4SLinus Torvalds 851da177e4SLinus Torvalds if (__ipv6_only_sock(sk)) { 861da177e4SLinus Torvalds err = -ENETUNREACH; 871da177e4SLinus Torvalds goto out; 881da177e4SLinus Torvalds } 891da177e4SLinus Torvalds sin.sin_family = AF_INET; 901da177e4SLinus Torvalds sin.sin_addr.s_addr = daddr->s6_addr32[3]; 911da177e4SLinus Torvalds sin.sin_port = usin->sin6_port; 921da177e4SLinus Torvalds 931da177e4SLinus Torvalds err = ip4_datagram_connect(sk, 941da177e4SLinus Torvalds (struct sockaddr*) &sin, 951da177e4SLinus Torvalds sizeof(sin)); 961da177e4SLinus Torvalds 971da177e4SLinus Torvalds ipv4_connected: 981da177e4SLinus Torvalds if (err) 991da177e4SLinus Torvalds goto out; 1001da177e4SLinus Torvalds 101b301e82cSBrian Haley ipv6_addr_set_v4mapped(inet->daddr, &np->daddr); 1021da177e4SLinus Torvalds 103b301e82cSBrian Haley if (ipv6_addr_any(&np->saddr)) 104b301e82cSBrian Haley ipv6_addr_set_v4mapped(inet->saddr, &np->saddr); 1051da177e4SLinus Torvalds 106b301e82cSBrian Haley if (ipv6_addr_any(&np->rcv_saddr)) 107b301e82cSBrian Haley ipv6_addr_set_v4mapped(inet->rcv_saddr, &np->rcv_saddr); 108b301e82cSBrian Haley 1091da177e4SLinus Torvalds goto out; 1101da177e4SLinus Torvalds } 1111da177e4SLinus Torvalds 1121da177e4SLinus Torvalds if (addr_type&IPV6_ADDR_LINKLOCAL) { 1131da177e4SLinus Torvalds if (addr_len >= sizeof(struct sockaddr_in6) && 1141da177e4SLinus Torvalds usin->sin6_scope_id) { 1151da177e4SLinus Torvalds if (sk->sk_bound_dev_if && 1161da177e4SLinus Torvalds sk->sk_bound_dev_if != usin->sin6_scope_id) { 1171da177e4SLinus Torvalds err = -EINVAL; 1181da177e4SLinus Torvalds goto out; 1191da177e4SLinus Torvalds } 1201da177e4SLinus Torvalds sk->sk_bound_dev_if = usin->sin6_scope_id; 1211da177e4SLinus Torvalds } 1221da177e4SLinus Torvalds 1231ac4f008SBrian Haley if (!sk->sk_bound_dev_if && (addr_type & IPV6_ADDR_MULTICAST)) 1241ac4f008SBrian Haley sk->sk_bound_dev_if = np->mcast_oif; 1251ac4f008SBrian Haley 1261da177e4SLinus Torvalds /* Connect to link-local address requires an interface */ 1271da177e4SLinus Torvalds if (!sk->sk_bound_dev_if) { 1281da177e4SLinus Torvalds err = -EINVAL; 1291da177e4SLinus Torvalds goto out; 1301da177e4SLinus Torvalds } 1311da177e4SLinus Torvalds } 1321da177e4SLinus Torvalds 1331da177e4SLinus Torvalds ipv6_addr_copy(&np->daddr, daddr); 1341da177e4SLinus Torvalds np->flow_label = fl.fl6_flowlabel; 1351da177e4SLinus Torvalds 1361da177e4SLinus Torvalds inet->dport = usin->sin6_port; 1371da177e4SLinus Torvalds 1381da177e4SLinus Torvalds /* 1391da177e4SLinus Torvalds * Check for a route to destination an obtain the 1401da177e4SLinus Torvalds * destination cache for it. 1411da177e4SLinus Torvalds */ 1421da177e4SLinus Torvalds 1431da177e4SLinus Torvalds fl.proto = sk->sk_protocol; 1441da177e4SLinus Torvalds ipv6_addr_copy(&fl.fl6_dst, &np->daddr); 1451da177e4SLinus Torvalds ipv6_addr_copy(&fl.fl6_src, &np->saddr); 1461da177e4SLinus Torvalds fl.oif = sk->sk_bound_dev_if; 14751953d5bSBrian Haley fl.mark = sk->sk_mark; 1481da177e4SLinus Torvalds fl.fl_ip_dport = inet->dport; 1491da177e4SLinus Torvalds fl.fl_ip_sport = inet->sport; 1501da177e4SLinus Torvalds 1511da177e4SLinus Torvalds if (!fl.oif && (addr_type&IPV6_ADDR_MULTICAST)) 1521da177e4SLinus Torvalds fl.oif = np->mcast_oif; 1531da177e4SLinus Torvalds 154beb8d13bSVenkat Yekkirala security_sk_classify_flow(sk, &fl); 155beb8d13bSVenkat Yekkirala 1561da177e4SLinus Torvalds if (flowlabel) { 1571da177e4SLinus Torvalds if (flowlabel->opt && flowlabel->opt->srcrt) { 1581da177e4SLinus Torvalds struct rt0_hdr *rt0 = (struct rt0_hdr *) flowlabel->opt->srcrt; 1591da177e4SLinus Torvalds ipv6_addr_copy(&final, &fl.fl6_dst); 1601da177e4SLinus Torvalds ipv6_addr_copy(&fl.fl6_dst, rt0->addr); 1611da177e4SLinus Torvalds final_p = &final; 1621da177e4SLinus Torvalds } 1631da177e4SLinus Torvalds } else if (np->opt && np->opt->srcrt) { 1641da177e4SLinus Torvalds struct rt0_hdr *rt0 = (struct rt0_hdr *)np->opt->srcrt; 1651da177e4SLinus Torvalds ipv6_addr_copy(&final, &fl.fl6_dst); 1661da177e4SLinus Torvalds ipv6_addr_copy(&fl.fl6_dst, rt0->addr); 1671da177e4SLinus Torvalds final_p = &final; 1681da177e4SLinus Torvalds } 1691da177e4SLinus Torvalds 1701da177e4SLinus Torvalds err = ip6_dst_lookup(sk, &dst, &fl); 1711da177e4SLinus Torvalds if (err) 1721da177e4SLinus Torvalds goto out; 1731da177e4SLinus Torvalds if (final_p) 1741da177e4SLinus Torvalds ipv6_addr_copy(&fl.fl6_dst, final_p); 1751da177e4SLinus Torvalds 17652479b62SAlexey Dobriyan err = __xfrm_lookup(sock_net(sk), &dst, &fl, sk, XFRM_LOOKUP_WAIT); 17752479b62SAlexey Dobriyan if (err < 0) { 17814e50e57SDavid S. Miller if (err == -EREMOTE) 17914e50e57SDavid S. Miller err = ip6_dst_blackhole(sk, &dst, &fl); 18014e50e57SDavid S. Miller if (err < 0) 1811da177e4SLinus Torvalds goto out; 18214e50e57SDavid S. Miller } 1831da177e4SLinus Torvalds 1841da177e4SLinus Torvalds /* source address lookup done in ip6_dst_lookup */ 1851da177e4SLinus Torvalds 1861da177e4SLinus Torvalds if (ipv6_addr_any(&np->saddr)) 1871da177e4SLinus Torvalds ipv6_addr_copy(&np->saddr, &fl.fl6_src); 1881da177e4SLinus Torvalds 1891da177e4SLinus Torvalds if (ipv6_addr_any(&np->rcv_saddr)) { 1901da177e4SLinus Torvalds ipv6_addr_copy(&np->rcv_saddr, &fl.fl6_src); 1911da177e4SLinus Torvalds inet->rcv_saddr = LOOPBACK4_IPV6; 1921da177e4SLinus Torvalds } 1931da177e4SLinus Torvalds 1941da177e4SLinus Torvalds ip6_dst_store(sk, dst, 1951da177e4SLinus Torvalds ipv6_addr_equal(&fl.fl6_dst, &np->daddr) ? 1968e1ef0a9SYOSHIFUJI Hideaki &np->daddr : NULL, 1978e1ef0a9SYOSHIFUJI Hideaki #ifdef CONFIG_IPV6_SUBTREES 1988e1ef0a9SYOSHIFUJI Hideaki ipv6_addr_equal(&fl.fl6_src, &np->saddr) ? 1998e1ef0a9SYOSHIFUJI Hideaki &np->saddr : 2008e1ef0a9SYOSHIFUJI Hideaki #endif 2018e1ef0a9SYOSHIFUJI Hideaki NULL); 2021da177e4SLinus Torvalds 2031da177e4SLinus Torvalds sk->sk_state = TCP_ESTABLISHED; 2041da177e4SLinus Torvalds out: 2051da177e4SLinus Torvalds fl6_sock_release(flowlabel); 2061da177e4SLinus Torvalds return err; 2071da177e4SLinus Torvalds } 2081da177e4SLinus Torvalds 2091da177e4SLinus Torvalds void ipv6_icmp_error(struct sock *sk, struct sk_buff *skb, int err, 210e69a4adcSAl Viro __be16 port, u32 info, u8 *payload) 2111da177e4SLinus Torvalds { 2121da177e4SLinus Torvalds struct ipv6_pinfo *np = inet6_sk(sk); 213cc70ab26SArnaldo Carvalho de Melo struct icmp6hdr *icmph = icmp6_hdr(skb); 2141da177e4SLinus Torvalds struct sock_exterr_skb *serr; 2151da177e4SLinus Torvalds 2161da177e4SLinus Torvalds if (!np->recverr) 2171da177e4SLinus Torvalds return; 2181da177e4SLinus Torvalds 2191da177e4SLinus Torvalds skb = skb_clone(skb, GFP_ATOMIC); 2201da177e4SLinus Torvalds if (!skb) 2211da177e4SLinus Torvalds return; 2221da177e4SLinus Torvalds 2231da177e4SLinus Torvalds serr = SKB_EXT_ERR(skb); 2241da177e4SLinus Torvalds serr->ee.ee_errno = err; 2251da177e4SLinus Torvalds serr->ee.ee_origin = SO_EE_ORIGIN_ICMP6; 2261da177e4SLinus Torvalds serr->ee.ee_type = icmph->icmp6_type; 2271da177e4SLinus Torvalds serr->ee.ee_code = icmph->icmp6_code; 2281da177e4SLinus Torvalds serr->ee.ee_pad = 0; 2291da177e4SLinus Torvalds serr->ee.ee_info = info; 2301da177e4SLinus Torvalds serr->ee.ee_data = 0; 231d56f90a7SArnaldo Carvalho de Melo serr->addr_offset = (u8 *)&(((struct ipv6hdr *)(icmph + 1))->daddr) - 232d56f90a7SArnaldo Carvalho de Melo skb_network_header(skb); 2331da177e4SLinus Torvalds serr->port = port; 2341da177e4SLinus Torvalds 2351da177e4SLinus Torvalds __skb_pull(skb, payload - skb->data); 236bd82393cSArnaldo Carvalho de Melo skb_reset_transport_header(skb); 2371da177e4SLinus Torvalds 2381da177e4SLinus Torvalds if (sock_queue_err_skb(sk, skb)) 2391da177e4SLinus Torvalds kfree_skb(skb); 2401da177e4SLinus Torvalds } 2411da177e4SLinus Torvalds 2421da177e4SLinus Torvalds void ipv6_local_error(struct sock *sk, int err, struct flowi *fl, u32 info) 2431da177e4SLinus Torvalds { 2441da177e4SLinus Torvalds struct ipv6_pinfo *np = inet6_sk(sk); 2451da177e4SLinus Torvalds struct sock_exterr_skb *serr; 2461da177e4SLinus Torvalds struct ipv6hdr *iph; 2471da177e4SLinus Torvalds struct sk_buff *skb; 2481da177e4SLinus Torvalds 2491da177e4SLinus Torvalds if (!np->recverr) 2501da177e4SLinus Torvalds return; 2511da177e4SLinus Torvalds 2521da177e4SLinus Torvalds skb = alloc_skb(sizeof(struct ipv6hdr), GFP_ATOMIC); 2531da177e4SLinus Torvalds if (!skb) 2541da177e4SLinus Torvalds return; 2551da177e4SLinus Torvalds 2561ced98e8SArnaldo Carvalho de Melo skb_put(skb, sizeof(struct ipv6hdr)); 2571ced98e8SArnaldo Carvalho de Melo skb_reset_network_header(skb); 2580660e03fSArnaldo Carvalho de Melo iph = ipv6_hdr(skb); 2591da177e4SLinus Torvalds ipv6_addr_copy(&iph->daddr, &fl->fl6_dst); 2601da177e4SLinus Torvalds 2611da177e4SLinus Torvalds serr = SKB_EXT_ERR(skb); 2621da177e4SLinus Torvalds serr->ee.ee_errno = err; 2631da177e4SLinus Torvalds serr->ee.ee_origin = SO_EE_ORIGIN_LOCAL; 2641da177e4SLinus Torvalds serr->ee.ee_type = 0; 2651da177e4SLinus Torvalds serr->ee.ee_code = 0; 2661da177e4SLinus Torvalds serr->ee.ee_pad = 0; 2671da177e4SLinus Torvalds serr->ee.ee_info = info; 2681da177e4SLinus Torvalds serr->ee.ee_data = 0; 269d56f90a7SArnaldo Carvalho de Melo serr->addr_offset = (u8 *)&iph->daddr - skb_network_header(skb); 2701da177e4SLinus Torvalds serr->port = fl->fl_ip_dport; 2711da177e4SLinus Torvalds 27227a884dcSArnaldo Carvalho de Melo __skb_pull(skb, skb_tail_pointer(skb) - skb->data); 273bd82393cSArnaldo Carvalho de Melo skb_reset_transport_header(skb); 2741da177e4SLinus Torvalds 2751da177e4SLinus Torvalds if (sock_queue_err_skb(sk, skb)) 2761da177e4SLinus Torvalds kfree_skb(skb); 2771da177e4SLinus Torvalds } 2781da177e4SLinus Torvalds 2791da177e4SLinus Torvalds /* 2801da177e4SLinus Torvalds * Handle MSG_ERRQUEUE 2811da177e4SLinus Torvalds */ 2821da177e4SLinus Torvalds int ipv6_recv_error(struct sock *sk, struct msghdr *msg, int len) 2831da177e4SLinus Torvalds { 2841da177e4SLinus Torvalds struct ipv6_pinfo *np = inet6_sk(sk); 2851da177e4SLinus Torvalds struct sock_exterr_skb *serr; 2861da177e4SLinus Torvalds struct sk_buff *skb, *skb2; 2871da177e4SLinus Torvalds struct sockaddr_in6 *sin; 2881da177e4SLinus Torvalds struct { 2891da177e4SLinus Torvalds struct sock_extended_err ee; 2901da177e4SLinus Torvalds struct sockaddr_in6 offender; 2911da177e4SLinus Torvalds } errhdr; 2921da177e4SLinus Torvalds int err; 2931da177e4SLinus Torvalds int copied; 2941da177e4SLinus Torvalds 2951da177e4SLinus Torvalds err = -EAGAIN; 2961da177e4SLinus Torvalds skb = skb_dequeue(&sk->sk_error_queue); 2971da177e4SLinus Torvalds if (skb == NULL) 2981da177e4SLinus Torvalds goto out; 2991da177e4SLinus Torvalds 3001da177e4SLinus Torvalds copied = skb->len; 3011da177e4SLinus Torvalds if (copied > len) { 3021da177e4SLinus Torvalds msg->msg_flags |= MSG_TRUNC; 3031da177e4SLinus Torvalds copied = len; 3041da177e4SLinus Torvalds } 3051da177e4SLinus Torvalds err = skb_copy_datagram_iovec(skb, 0, msg->msg_iov, copied); 3061da177e4SLinus Torvalds if (err) 3071da177e4SLinus Torvalds goto out_free_skb; 3081da177e4SLinus Torvalds 3091da177e4SLinus Torvalds sock_recv_timestamp(msg, sk, skb); 3101da177e4SLinus Torvalds 3111da177e4SLinus Torvalds serr = SKB_EXT_ERR(skb); 3121da177e4SLinus Torvalds 3131da177e4SLinus Torvalds sin = (struct sockaddr_in6 *)msg->msg_name; 3141da177e4SLinus Torvalds if (sin) { 315d56f90a7SArnaldo Carvalho de Melo const unsigned char *nh = skb_network_header(skb); 3161da177e4SLinus Torvalds sin->sin6_family = AF_INET6; 3171da177e4SLinus Torvalds sin->sin6_flowinfo = 0; 3181da177e4SLinus Torvalds sin->sin6_port = serr->port; 3191da177e4SLinus Torvalds sin->sin6_scope_id = 0; 3201da177e4SLinus Torvalds if (serr->ee.ee_origin == SO_EE_ORIGIN_ICMP6) { 3211da177e4SLinus Torvalds ipv6_addr_copy(&sin->sin6_addr, 322d56f90a7SArnaldo Carvalho de Melo (struct in6_addr *)(nh + serr->addr_offset)); 3231da177e4SLinus Torvalds if (np->sndflow) 324d56f90a7SArnaldo Carvalho de Melo sin->sin6_flowinfo = 325d56f90a7SArnaldo Carvalho de Melo (*(__be32 *)(nh + serr->addr_offset - 24) & 326d56f90a7SArnaldo Carvalho de Melo IPV6_FLOWINFO_MASK); 3271da177e4SLinus Torvalds if (ipv6_addr_type(&sin->sin6_addr) & IPV6_ADDR_LINKLOCAL) 3281da177e4SLinus Torvalds sin->sin6_scope_id = IP6CB(skb)->iif; 3291da177e4SLinus Torvalds } else { 330b301e82cSBrian Haley ipv6_addr_set_v4mapped(*(__be32 *)(nh + serr->addr_offset), 331b301e82cSBrian Haley &sin->sin6_addr); 3321da177e4SLinus Torvalds } 3331da177e4SLinus Torvalds } 3341da177e4SLinus Torvalds 3351da177e4SLinus Torvalds memcpy(&errhdr.ee, &serr->ee, sizeof(struct sock_extended_err)); 3361da177e4SLinus Torvalds sin = &errhdr.offender; 3371da177e4SLinus Torvalds sin->sin6_family = AF_UNSPEC; 3381da177e4SLinus Torvalds if (serr->ee.ee_origin != SO_EE_ORIGIN_LOCAL) { 3391da177e4SLinus Torvalds sin->sin6_family = AF_INET6; 3401da177e4SLinus Torvalds sin->sin6_flowinfo = 0; 3411da177e4SLinus Torvalds sin->sin6_scope_id = 0; 3421da177e4SLinus Torvalds if (serr->ee.ee_origin == SO_EE_ORIGIN_ICMP6) { 3430660e03fSArnaldo Carvalho de Melo ipv6_addr_copy(&sin->sin6_addr, &ipv6_hdr(skb)->saddr); 3441da177e4SLinus Torvalds if (np->rxopt.all) 3451da177e4SLinus Torvalds datagram_recv_ctl(sk, msg, skb); 3461da177e4SLinus Torvalds if (ipv6_addr_type(&sin->sin6_addr) & IPV6_ADDR_LINKLOCAL) 3471da177e4SLinus Torvalds sin->sin6_scope_id = IP6CB(skb)->iif; 3481da177e4SLinus Torvalds } else { 3491da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 3501da177e4SLinus Torvalds 351b301e82cSBrian Haley ipv6_addr_set_v4mapped(ip_hdr(skb)->saddr, 352b301e82cSBrian Haley &sin->sin6_addr); 3531da177e4SLinus Torvalds if (inet->cmsg_flags) 3541da177e4SLinus Torvalds ip_cmsg_recv(msg, skb); 3551da177e4SLinus Torvalds } 3561da177e4SLinus Torvalds } 3571da177e4SLinus Torvalds 3581da177e4SLinus Torvalds put_cmsg(msg, SOL_IPV6, IPV6_RECVERR, sizeof(errhdr), &errhdr); 3591da177e4SLinus Torvalds 3601da177e4SLinus Torvalds /* Now we could try to dump offended packet options */ 3611da177e4SLinus Torvalds 3621da177e4SLinus Torvalds msg->msg_flags |= MSG_ERRQUEUE; 3631da177e4SLinus Torvalds err = copied; 3641da177e4SLinus Torvalds 3651da177e4SLinus Torvalds /* Reset and regenerate socket error */ 366e0f9f858SHerbert Xu spin_lock_bh(&sk->sk_error_queue.lock); 3671da177e4SLinus Torvalds sk->sk_err = 0; 3681da177e4SLinus Torvalds if ((skb2 = skb_peek(&sk->sk_error_queue)) != NULL) { 3691da177e4SLinus Torvalds sk->sk_err = SKB_EXT_ERR(skb2)->ee.ee_errno; 370e0f9f858SHerbert Xu spin_unlock_bh(&sk->sk_error_queue.lock); 3711da177e4SLinus Torvalds sk->sk_error_report(sk); 3721da177e4SLinus Torvalds } else { 373e0f9f858SHerbert Xu spin_unlock_bh(&sk->sk_error_queue.lock); 3741da177e4SLinus Torvalds } 3751da177e4SLinus Torvalds 3761da177e4SLinus Torvalds out_free_skb: 3771da177e4SLinus Torvalds kfree_skb(skb); 3781da177e4SLinus Torvalds out: 3791da177e4SLinus Torvalds return err; 3801da177e4SLinus Torvalds } 3811da177e4SLinus Torvalds 3821da177e4SLinus Torvalds 3831da177e4SLinus Torvalds 3841da177e4SLinus Torvalds int datagram_recv_ctl(struct sock *sk, struct msghdr *msg, struct sk_buff *skb) 3851da177e4SLinus Torvalds { 3861da177e4SLinus Torvalds struct ipv6_pinfo *np = inet6_sk(sk); 3871da177e4SLinus Torvalds struct inet6_skb_parm *opt = IP6CB(skb); 388d56f90a7SArnaldo Carvalho de Melo unsigned char *nh = skb_network_header(skb); 3891da177e4SLinus Torvalds 3901da177e4SLinus Torvalds if (np->rxopt.bits.rxinfo) { 3911da177e4SLinus Torvalds struct in6_pktinfo src_info; 3921da177e4SLinus Torvalds 3931da177e4SLinus Torvalds src_info.ipi6_ifindex = opt->iif; 3940660e03fSArnaldo Carvalho de Melo ipv6_addr_copy(&src_info.ipi6_addr, &ipv6_hdr(skb)->daddr); 3951da177e4SLinus Torvalds put_cmsg(msg, SOL_IPV6, IPV6_PKTINFO, sizeof(src_info), &src_info); 3961da177e4SLinus Torvalds } 3971da177e4SLinus Torvalds 3981da177e4SLinus Torvalds if (np->rxopt.bits.rxhlim) { 3990660e03fSArnaldo Carvalho de Melo int hlim = ipv6_hdr(skb)->hop_limit; 4001da177e4SLinus Torvalds put_cmsg(msg, SOL_IPV6, IPV6_HOPLIMIT, sizeof(hlim), &hlim); 4011da177e4SLinus Torvalds } 4021da177e4SLinus Torvalds 40341a1f8eaSYOSHIFUJI Hideaki if (np->rxopt.bits.rxtclass) { 4040660e03fSArnaldo Carvalho de Melo int tclass = (ntohl(*(__be32 *)ipv6_hdr(skb)) >> 20) & 0xff; 40541a1f8eaSYOSHIFUJI Hideaki put_cmsg(msg, SOL_IPV6, IPV6_TCLASS, sizeof(tclass), &tclass); 40641a1f8eaSYOSHIFUJI Hideaki } 40741a1f8eaSYOSHIFUJI Hideaki 408d56f90a7SArnaldo Carvalho de Melo if (np->rxopt.bits.rxflow && (*(__be32 *)nh & IPV6_FLOWINFO_MASK)) { 409d56f90a7SArnaldo Carvalho de Melo __be32 flowinfo = *(__be32 *)nh & IPV6_FLOWINFO_MASK; 4101da177e4SLinus Torvalds put_cmsg(msg, SOL_IPV6, IPV6_FLOWINFO, sizeof(flowinfo), &flowinfo); 4111da177e4SLinus Torvalds } 412333fad53SYOSHIFUJI Hideaki 413333fad53SYOSHIFUJI Hideaki /* HbH is allowed only once */ 4141da177e4SLinus Torvalds if (np->rxopt.bits.hopopts && opt->hop) { 415d56f90a7SArnaldo Carvalho de Melo u8 *ptr = nh + opt->hop; 4161da177e4SLinus Torvalds put_cmsg(msg, SOL_IPV6, IPV6_HOPOPTS, (ptr[1]+1)<<3, ptr); 4171da177e4SLinus Torvalds } 418333fad53SYOSHIFUJI Hideaki 419333fad53SYOSHIFUJI Hideaki if (opt->lastopt && 420333fad53SYOSHIFUJI Hideaki (np->rxopt.bits.dstopts || np->rxopt.bits.srcrt)) { 421333fad53SYOSHIFUJI Hideaki /* 422333fad53SYOSHIFUJI Hideaki * Silly enough, but we need to reparse in order to 423333fad53SYOSHIFUJI Hideaki * report extension headers (except for HbH) 424333fad53SYOSHIFUJI Hideaki * in order. 425333fad53SYOSHIFUJI Hideaki * 426333fad53SYOSHIFUJI Hideaki * Also note that IPV6_RECVRTHDRDSTOPTS is NOT 427333fad53SYOSHIFUJI Hideaki * (and WILL NOT be) defined because 428333fad53SYOSHIFUJI Hideaki * IPV6_RECVDSTOPTS is more generic. --yoshfuji 429333fad53SYOSHIFUJI Hideaki */ 430333fad53SYOSHIFUJI Hideaki unsigned int off = sizeof(struct ipv6hdr); 4310660e03fSArnaldo Carvalho de Melo u8 nexthdr = ipv6_hdr(skb)->nexthdr; 432333fad53SYOSHIFUJI Hideaki 433333fad53SYOSHIFUJI Hideaki while (off <= opt->lastopt) { 434333fad53SYOSHIFUJI Hideaki unsigned len; 435d56f90a7SArnaldo Carvalho de Melo u8 *ptr = nh + off; 436333fad53SYOSHIFUJI Hideaki 437333fad53SYOSHIFUJI Hideaki switch(nexthdr) { 438333fad53SYOSHIFUJI Hideaki case IPPROTO_DSTOPTS: 439333fad53SYOSHIFUJI Hideaki nexthdr = ptr[0]; 440333fad53SYOSHIFUJI Hideaki len = (ptr[1] + 1) << 3; 441333fad53SYOSHIFUJI Hideaki if (np->rxopt.bits.dstopts) 442333fad53SYOSHIFUJI Hideaki put_cmsg(msg, SOL_IPV6, IPV6_DSTOPTS, len, ptr); 443333fad53SYOSHIFUJI Hideaki break; 444333fad53SYOSHIFUJI Hideaki case IPPROTO_ROUTING: 445333fad53SYOSHIFUJI Hideaki nexthdr = ptr[0]; 446333fad53SYOSHIFUJI Hideaki len = (ptr[1] + 1) << 3; 447333fad53SYOSHIFUJI Hideaki if (np->rxopt.bits.srcrt) 448333fad53SYOSHIFUJI Hideaki put_cmsg(msg, SOL_IPV6, IPV6_RTHDR, len, ptr); 449333fad53SYOSHIFUJI Hideaki break; 450333fad53SYOSHIFUJI Hideaki case IPPROTO_AH: 451333fad53SYOSHIFUJI Hideaki nexthdr = ptr[0]; 452a3059893SVille Nuorvala len = (ptr[1] + 2) << 2; 453333fad53SYOSHIFUJI Hideaki break; 454333fad53SYOSHIFUJI Hideaki default: 455333fad53SYOSHIFUJI Hideaki nexthdr = ptr[0]; 456333fad53SYOSHIFUJI Hideaki len = (ptr[1] + 1) << 3; 457333fad53SYOSHIFUJI Hideaki break; 458333fad53SYOSHIFUJI Hideaki } 459333fad53SYOSHIFUJI Hideaki 460333fad53SYOSHIFUJI Hideaki off += len; 461333fad53SYOSHIFUJI Hideaki } 462333fad53SYOSHIFUJI Hideaki } 463333fad53SYOSHIFUJI Hideaki 464333fad53SYOSHIFUJI Hideaki /* socket options in old style */ 465333fad53SYOSHIFUJI Hideaki if (np->rxopt.bits.rxoinfo) { 466333fad53SYOSHIFUJI Hideaki struct in6_pktinfo src_info; 467333fad53SYOSHIFUJI Hideaki 468333fad53SYOSHIFUJI Hideaki src_info.ipi6_ifindex = opt->iif; 4690660e03fSArnaldo Carvalho de Melo ipv6_addr_copy(&src_info.ipi6_addr, &ipv6_hdr(skb)->daddr); 470333fad53SYOSHIFUJI Hideaki put_cmsg(msg, SOL_IPV6, IPV6_2292PKTINFO, sizeof(src_info), &src_info); 471333fad53SYOSHIFUJI Hideaki } 472333fad53SYOSHIFUJI Hideaki if (np->rxopt.bits.rxohlim) { 4730660e03fSArnaldo Carvalho de Melo int hlim = ipv6_hdr(skb)->hop_limit; 474333fad53SYOSHIFUJI Hideaki put_cmsg(msg, SOL_IPV6, IPV6_2292HOPLIMIT, sizeof(hlim), &hlim); 475333fad53SYOSHIFUJI Hideaki } 476333fad53SYOSHIFUJI Hideaki if (np->rxopt.bits.ohopopts && opt->hop) { 477d56f90a7SArnaldo Carvalho de Melo u8 *ptr = nh + opt->hop; 478333fad53SYOSHIFUJI Hideaki put_cmsg(msg, SOL_IPV6, IPV6_2292HOPOPTS, (ptr[1]+1)<<3, ptr); 479333fad53SYOSHIFUJI Hideaki } 480333fad53SYOSHIFUJI Hideaki if (np->rxopt.bits.odstopts && opt->dst0) { 481d56f90a7SArnaldo Carvalho de Melo u8 *ptr = nh + opt->dst0; 482333fad53SYOSHIFUJI Hideaki put_cmsg(msg, SOL_IPV6, IPV6_2292DSTOPTS, (ptr[1]+1)<<3, ptr); 4831da177e4SLinus Torvalds } 484333fad53SYOSHIFUJI Hideaki if (np->rxopt.bits.osrcrt && opt->srcrt) { 485d56f90a7SArnaldo Carvalho de Melo struct ipv6_rt_hdr *rthdr = (struct ipv6_rt_hdr *)(nh + opt->srcrt); 486333fad53SYOSHIFUJI Hideaki put_cmsg(msg, SOL_IPV6, IPV6_2292RTHDR, (rthdr->hdrlen+1) << 3, rthdr); 4871da177e4SLinus Torvalds } 488333fad53SYOSHIFUJI Hideaki if (np->rxopt.bits.odstopts && opt->dst1) { 489d56f90a7SArnaldo Carvalho de Melo u8 *ptr = nh + opt->dst1; 490333fad53SYOSHIFUJI Hideaki put_cmsg(msg, SOL_IPV6, IPV6_2292DSTOPTS, (ptr[1]+1)<<3, ptr); 4911da177e4SLinus Torvalds } 4921da177e4SLinus Torvalds return 0; 4931da177e4SLinus Torvalds } 4941da177e4SLinus Torvalds 49591e1908fSYOSHIFUJI Hideaki int datagram_send_ctl(struct net *net, 49691e1908fSYOSHIFUJI Hideaki struct msghdr *msg, struct flowi *fl, 4971da177e4SLinus Torvalds struct ipv6_txoptions *opt, 49841a1f8eaSYOSHIFUJI Hideaki int *hlimit, int *tclass) 4991da177e4SLinus Torvalds { 5001da177e4SLinus Torvalds struct in6_pktinfo *src_info; 5011da177e4SLinus Torvalds struct cmsghdr *cmsg; 5021da177e4SLinus Torvalds struct ipv6_rt_hdr *rthdr; 5031da177e4SLinus Torvalds struct ipv6_opt_hdr *hdr; 5041da177e4SLinus Torvalds int len; 5051da177e4SLinus Torvalds int err = 0; 5061da177e4SLinus Torvalds 5071da177e4SLinus Torvalds for (cmsg = CMSG_FIRSTHDR(msg); cmsg; cmsg = CMSG_NXTHDR(msg, cmsg)) { 5081da177e4SLinus Torvalds int addr_type; 5091da177e4SLinus Torvalds 5101da177e4SLinus Torvalds if (!CMSG_OK(msg, cmsg)) { 5111da177e4SLinus Torvalds err = -EINVAL; 5121da177e4SLinus Torvalds goto exit_f; 5131da177e4SLinus Torvalds } 5141da177e4SLinus Torvalds 5151da177e4SLinus Torvalds if (cmsg->cmsg_level != SOL_IPV6) 5161da177e4SLinus Torvalds continue; 5171da177e4SLinus Torvalds 5181da177e4SLinus Torvalds switch (cmsg->cmsg_type) { 5191da177e4SLinus Torvalds case IPV6_PKTINFO: 520333fad53SYOSHIFUJI Hideaki case IPV6_2292PKTINFO: 521187e3838SYOSHIFUJI Hideaki { 522187e3838SYOSHIFUJI Hideaki struct net_device *dev = NULL; 523187e3838SYOSHIFUJI Hideaki 5241da177e4SLinus Torvalds if (cmsg->cmsg_len < CMSG_LEN(sizeof(struct in6_pktinfo))) { 5251da177e4SLinus Torvalds err = -EINVAL; 5261da177e4SLinus Torvalds goto exit_f; 5271da177e4SLinus Torvalds } 5281da177e4SLinus Torvalds 5291da177e4SLinus Torvalds src_info = (struct in6_pktinfo *)CMSG_DATA(cmsg); 5301da177e4SLinus Torvalds 5311da177e4SLinus Torvalds if (src_info->ipi6_ifindex) { 5321da177e4SLinus Torvalds if (fl->oif && src_info->ipi6_ifindex != fl->oif) 5331da177e4SLinus Torvalds return -EINVAL; 5341da177e4SLinus Torvalds fl->oif = src_info->ipi6_ifindex; 5351da177e4SLinus Torvalds } 5361da177e4SLinus Torvalds 537187e3838SYOSHIFUJI Hideaki addr_type = __ipv6_addr_type(&src_info->ipi6_addr); 5381da177e4SLinus Torvalds 539187e3838SYOSHIFUJI Hideaki if (fl->oif) { 54091e1908fSYOSHIFUJI Hideaki dev = dev_get_by_index(net, fl->oif); 5411da177e4SLinus Torvalds if (!dev) 5421da177e4SLinus Torvalds return -ENODEV; 543187e3838SYOSHIFUJI Hideaki } else if (addr_type & IPV6_ADDR_LINKLOCAL) 544187e3838SYOSHIFUJI Hideaki return -EINVAL; 545187e3838SYOSHIFUJI Hideaki 546187e3838SYOSHIFUJI Hideaki if (addr_type != IPV6_ADDR_ANY) { 547187e3838SYOSHIFUJI Hideaki int strict = __ipv6_addr_src_scope(addr_type) <= IPV6_ADDR_SCOPE_LINKLOCAL; 54891e1908fSYOSHIFUJI Hideaki if (!ipv6_chk_addr(net, &src_info->ipi6_addr, 549187e3838SYOSHIFUJI Hideaki strict ? dev : NULL, 0)) 5501da177e4SLinus Torvalds err = -EINVAL; 551187e3838SYOSHIFUJI Hideaki else 552187e3838SYOSHIFUJI Hideaki ipv6_addr_copy(&fl->fl6_src, &src_info->ipi6_addr); 5531da177e4SLinus Torvalds } 554187e3838SYOSHIFUJI Hideaki 5551da177e4SLinus Torvalds if (dev) 5561da177e4SLinus Torvalds dev_put(dev); 5571da177e4SLinus Torvalds 558187e3838SYOSHIFUJI Hideaki if (err) 559187e3838SYOSHIFUJI Hideaki goto exit_f; 560187e3838SYOSHIFUJI Hideaki 5611da177e4SLinus Torvalds break; 562187e3838SYOSHIFUJI Hideaki } 5631da177e4SLinus Torvalds 5641da177e4SLinus Torvalds case IPV6_FLOWINFO: 5651da177e4SLinus Torvalds if (cmsg->cmsg_len < CMSG_LEN(4)) { 5661da177e4SLinus Torvalds err = -EINVAL; 5671da177e4SLinus Torvalds goto exit_f; 5681da177e4SLinus Torvalds } 5691da177e4SLinus Torvalds 5701da177e4SLinus Torvalds if (fl->fl6_flowlabel&IPV6_FLOWINFO_MASK) { 57190bcaf7bSAl Viro if ((fl->fl6_flowlabel^*(__be32 *)CMSG_DATA(cmsg))&~IPV6_FLOWINFO_MASK) { 5721da177e4SLinus Torvalds err = -EINVAL; 5731da177e4SLinus Torvalds goto exit_f; 5741da177e4SLinus Torvalds } 5751da177e4SLinus Torvalds } 57690bcaf7bSAl Viro fl->fl6_flowlabel = IPV6_FLOWINFO_MASK & *(__be32 *)CMSG_DATA(cmsg); 5771da177e4SLinus Torvalds break; 5781da177e4SLinus Torvalds 579333fad53SYOSHIFUJI Hideaki case IPV6_2292HOPOPTS: 5801da177e4SLinus Torvalds case IPV6_HOPOPTS: 5811da177e4SLinus Torvalds if (opt->hopopt || cmsg->cmsg_len < CMSG_LEN(sizeof(struct ipv6_opt_hdr))) { 5821da177e4SLinus Torvalds err = -EINVAL; 5831da177e4SLinus Torvalds goto exit_f; 5841da177e4SLinus Torvalds } 5851da177e4SLinus Torvalds 5861da177e4SLinus Torvalds hdr = (struct ipv6_opt_hdr *)CMSG_DATA(cmsg); 5871da177e4SLinus Torvalds len = ((hdr->hdrlen + 1) << 3); 5881da177e4SLinus Torvalds if (cmsg->cmsg_len < CMSG_LEN(len)) { 5891da177e4SLinus Torvalds err = -EINVAL; 5901da177e4SLinus Torvalds goto exit_f; 5911da177e4SLinus Torvalds } 5921da177e4SLinus Torvalds if (!capable(CAP_NET_RAW)) { 5931da177e4SLinus Torvalds err = -EPERM; 5941da177e4SLinus Torvalds goto exit_f; 5951da177e4SLinus Torvalds } 5961da177e4SLinus Torvalds opt->opt_nflen += len; 5971da177e4SLinus Torvalds opt->hopopt = hdr; 5981da177e4SLinus Torvalds break; 5991da177e4SLinus Torvalds 600333fad53SYOSHIFUJI Hideaki case IPV6_2292DSTOPTS: 6011da177e4SLinus Torvalds if (cmsg->cmsg_len < CMSG_LEN(sizeof(struct ipv6_opt_hdr))) { 6021da177e4SLinus Torvalds err = -EINVAL; 6031da177e4SLinus Torvalds goto exit_f; 6041da177e4SLinus Torvalds } 6051da177e4SLinus Torvalds 6061da177e4SLinus Torvalds hdr = (struct ipv6_opt_hdr *)CMSG_DATA(cmsg); 6071da177e4SLinus Torvalds len = ((hdr->hdrlen + 1) << 3); 6081da177e4SLinus Torvalds if (cmsg->cmsg_len < CMSG_LEN(len)) { 6091da177e4SLinus Torvalds err = -EINVAL; 6101da177e4SLinus Torvalds goto exit_f; 6111da177e4SLinus Torvalds } 6121da177e4SLinus Torvalds if (!capable(CAP_NET_RAW)) { 6131da177e4SLinus Torvalds err = -EPERM; 6141da177e4SLinus Torvalds goto exit_f; 6151da177e4SLinus Torvalds } 6161da177e4SLinus Torvalds if (opt->dst1opt) { 6171da177e4SLinus Torvalds err = -EINVAL; 6181da177e4SLinus Torvalds goto exit_f; 6191da177e4SLinus Torvalds } 6201da177e4SLinus Torvalds opt->opt_flen += len; 6211da177e4SLinus Torvalds opt->dst1opt = hdr; 6221da177e4SLinus Torvalds break; 6231da177e4SLinus Torvalds 624333fad53SYOSHIFUJI Hideaki case IPV6_DSTOPTS: 625333fad53SYOSHIFUJI Hideaki case IPV6_RTHDRDSTOPTS: 626333fad53SYOSHIFUJI Hideaki if (cmsg->cmsg_len < CMSG_LEN(sizeof(struct ipv6_opt_hdr))) { 627333fad53SYOSHIFUJI Hideaki err = -EINVAL; 628333fad53SYOSHIFUJI Hideaki goto exit_f; 629333fad53SYOSHIFUJI Hideaki } 630333fad53SYOSHIFUJI Hideaki 631333fad53SYOSHIFUJI Hideaki hdr = (struct ipv6_opt_hdr *)CMSG_DATA(cmsg); 632333fad53SYOSHIFUJI Hideaki len = ((hdr->hdrlen + 1) << 3); 633333fad53SYOSHIFUJI Hideaki if (cmsg->cmsg_len < CMSG_LEN(len)) { 634333fad53SYOSHIFUJI Hideaki err = -EINVAL; 635333fad53SYOSHIFUJI Hideaki goto exit_f; 636333fad53SYOSHIFUJI Hideaki } 637333fad53SYOSHIFUJI Hideaki if (!capable(CAP_NET_RAW)) { 638333fad53SYOSHIFUJI Hideaki err = -EPERM; 639333fad53SYOSHIFUJI Hideaki goto exit_f; 640333fad53SYOSHIFUJI Hideaki } 641333fad53SYOSHIFUJI Hideaki if (cmsg->cmsg_type == IPV6_DSTOPTS) { 642333fad53SYOSHIFUJI Hideaki opt->opt_flen += len; 643333fad53SYOSHIFUJI Hideaki opt->dst1opt = hdr; 644333fad53SYOSHIFUJI Hideaki } else { 645333fad53SYOSHIFUJI Hideaki opt->opt_nflen += len; 646333fad53SYOSHIFUJI Hideaki opt->dst0opt = hdr; 647333fad53SYOSHIFUJI Hideaki } 648333fad53SYOSHIFUJI Hideaki break; 649333fad53SYOSHIFUJI Hideaki 650333fad53SYOSHIFUJI Hideaki case IPV6_2292RTHDR: 6511da177e4SLinus Torvalds case IPV6_RTHDR: 6521da177e4SLinus Torvalds if (cmsg->cmsg_len < CMSG_LEN(sizeof(struct ipv6_rt_hdr))) { 6531da177e4SLinus Torvalds err = -EINVAL; 6541da177e4SLinus Torvalds goto exit_f; 6551da177e4SLinus Torvalds } 6561da177e4SLinus Torvalds 6571da177e4SLinus Torvalds rthdr = (struct ipv6_rt_hdr *)CMSG_DATA(cmsg); 6581da177e4SLinus Torvalds 659280a9d34SMasahide NAKAMURA switch (rthdr->type) { 66059fbb3a6SMasahide NAKAMURA #if defined(CONFIG_IPV6_MIP6) || defined(CONFIG_IPV6_MIP6_MODULE) 661280a9d34SMasahide NAKAMURA case IPV6_SRCRT_TYPE_2: 6626e093d9dSBrian Haley if (rthdr->hdrlen != 2 || 6636e093d9dSBrian Haley rthdr->segments_left != 1) { 6646e093d9dSBrian Haley err = -EINVAL; 6656e093d9dSBrian Haley goto exit_f; 6666e093d9dSBrian Haley } 667280a9d34SMasahide NAKAMURA break; 668bb4dbf9eSYOSHIFUJI Hideaki #endif 669280a9d34SMasahide NAKAMURA default: 6701da177e4SLinus Torvalds err = -EINVAL; 6711da177e4SLinus Torvalds goto exit_f; 6721da177e4SLinus Torvalds } 6731da177e4SLinus Torvalds 6741da177e4SLinus Torvalds len = ((rthdr->hdrlen + 1) << 3); 6751da177e4SLinus Torvalds 6761da177e4SLinus Torvalds if (cmsg->cmsg_len < CMSG_LEN(len)) { 6771da177e4SLinus Torvalds err = -EINVAL; 6781da177e4SLinus Torvalds goto exit_f; 6791da177e4SLinus Torvalds } 6801da177e4SLinus Torvalds 6811da177e4SLinus Torvalds /* segments left must also match */ 6821da177e4SLinus Torvalds if ((rthdr->hdrlen >> 1) != rthdr->segments_left) { 6831da177e4SLinus Torvalds err = -EINVAL; 6841da177e4SLinus Torvalds goto exit_f; 6851da177e4SLinus Torvalds } 6861da177e4SLinus Torvalds 6871da177e4SLinus Torvalds opt->opt_nflen += len; 6881da177e4SLinus Torvalds opt->srcrt = rthdr; 6891da177e4SLinus Torvalds 690333fad53SYOSHIFUJI Hideaki if (cmsg->cmsg_type == IPV6_2292RTHDR && opt->dst1opt) { 6911da177e4SLinus Torvalds int dsthdrlen = ((opt->dst1opt->hdrlen+1)<<3); 6921da177e4SLinus Torvalds 6931da177e4SLinus Torvalds opt->opt_nflen += dsthdrlen; 6941da177e4SLinus Torvalds opt->dst0opt = opt->dst1opt; 6951da177e4SLinus Torvalds opt->dst1opt = NULL; 6961da177e4SLinus Torvalds opt->opt_flen -= dsthdrlen; 6971da177e4SLinus Torvalds } 6981da177e4SLinus Torvalds 6991da177e4SLinus Torvalds break; 7001da177e4SLinus Torvalds 701333fad53SYOSHIFUJI Hideaki case IPV6_2292HOPLIMIT: 7021da177e4SLinus Torvalds case IPV6_HOPLIMIT: 7031da177e4SLinus Torvalds if (cmsg->cmsg_len != CMSG_LEN(sizeof(int))) { 7041da177e4SLinus Torvalds err = -EINVAL; 7051da177e4SLinus Torvalds goto exit_f; 7061da177e4SLinus Torvalds } 7071da177e4SLinus Torvalds 7081da177e4SLinus Torvalds *hlimit = *(int *)CMSG_DATA(cmsg); 709e8766fc8SShan Wei if (*hlimit < -1 || *hlimit > 0xff) { 710e8766fc8SShan Wei err = -EINVAL; 711e8766fc8SShan Wei goto exit_f; 712e8766fc8SShan Wei } 713e8766fc8SShan Wei 7141da177e4SLinus Torvalds break; 7151da177e4SLinus Torvalds 71641a1f8eaSYOSHIFUJI Hideaki case IPV6_TCLASS: 71741a1f8eaSYOSHIFUJI Hideaki { 71841a1f8eaSYOSHIFUJI Hideaki int tc; 71941a1f8eaSYOSHIFUJI Hideaki 72041a1f8eaSYOSHIFUJI Hideaki err = -EINVAL; 72141a1f8eaSYOSHIFUJI Hideaki if (cmsg->cmsg_len != CMSG_LEN(sizeof(int))) { 72241a1f8eaSYOSHIFUJI Hideaki goto exit_f; 72341a1f8eaSYOSHIFUJI Hideaki } 72441a1f8eaSYOSHIFUJI Hideaki 72541a1f8eaSYOSHIFUJI Hideaki tc = *(int *)CMSG_DATA(cmsg); 726d0ee011fSRemi Denis-Courmont if (tc < -1 || tc > 0xff) 72741a1f8eaSYOSHIFUJI Hideaki goto exit_f; 72841a1f8eaSYOSHIFUJI Hideaki 72941a1f8eaSYOSHIFUJI Hideaki err = 0; 73041a1f8eaSYOSHIFUJI Hideaki *tclass = tc; 73141a1f8eaSYOSHIFUJI Hideaki 73241a1f8eaSYOSHIFUJI Hideaki break; 73341a1f8eaSYOSHIFUJI Hideaki } 7341da177e4SLinus Torvalds default: 73564ce2073SPatrick McHardy LIMIT_NETDEBUG(KERN_DEBUG "invalid cmsg type: %d\n", 73664ce2073SPatrick McHardy cmsg->cmsg_type); 7371da177e4SLinus Torvalds err = -EINVAL; 7384a36702eSMiao Xie goto exit_f; 7393ff50b79SStephen Hemminger } 7401da177e4SLinus Torvalds } 7411da177e4SLinus Torvalds 7421da177e4SLinus Torvalds exit_f: 7431da177e4SLinus Torvalds return err; 7441da177e4SLinus Torvalds } 745