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> 245a0e3ad6STejun Heo #include <linux/slab.h> 251da177e4SLinus Torvalds 261da177e4SLinus Torvalds #include <net/ipv6.h> 271da177e4SLinus Torvalds #include <net/ndisc.h> 281da177e4SLinus Torvalds #include <net/addrconf.h> 291da177e4SLinus Torvalds #include <net/transp_v6.h> 301da177e4SLinus Torvalds #include <net/ip6_route.h> 31c752f073SArnaldo Carvalho de Melo #include <net/tcp_states.h> 321da177e4SLinus Torvalds 331da177e4SLinus Torvalds #include <linux/errqueue.h> 341da177e4SLinus Torvalds #include <asm/uaccess.h> 351da177e4SLinus Torvalds 361da177e4SLinus Torvalds int ip6_datagram_connect(struct sock *sk, struct sockaddr *uaddr, int addr_len) 371da177e4SLinus Torvalds { 381da177e4SLinus Torvalds struct sockaddr_in6 *usin = (struct sockaddr_in6 *) uaddr; 391da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 401da177e4SLinus Torvalds struct ipv6_pinfo *np = inet6_sk(sk); 4120c59de2SArnaud Ebalard struct in6_addr *daddr, *final_p, final; 421da177e4SLinus Torvalds struct dst_entry *dst; 431da177e4SLinus Torvalds struct flowi fl; 441da177e4SLinus Torvalds struct ip6_flowlabel *flowlabel = NULL; 4520c59de2SArnaud Ebalard struct ipv6_txoptions *opt; 461da177e4SLinus Torvalds int addr_type; 471da177e4SLinus Torvalds int err; 481da177e4SLinus Torvalds 491da177e4SLinus Torvalds if (usin->sin6_family == AF_INET) { 501da177e4SLinus Torvalds if (__ipv6_only_sock(sk)) 511da177e4SLinus Torvalds return -EAFNOSUPPORT; 521da177e4SLinus Torvalds err = ip4_datagram_connect(sk, uaddr, addr_len); 531da177e4SLinus Torvalds goto ipv4_connected; 541da177e4SLinus Torvalds } 551da177e4SLinus Torvalds 561da177e4SLinus Torvalds if (addr_len < SIN6_LEN_RFC2133) 571da177e4SLinus Torvalds return -EINVAL; 581da177e4SLinus Torvalds 591da177e4SLinus Torvalds if (usin->sin6_family != AF_INET6) 601da177e4SLinus Torvalds return -EAFNOSUPPORT; 611da177e4SLinus Torvalds 621da177e4SLinus Torvalds memset(&fl, 0, sizeof(fl)); 631da177e4SLinus Torvalds if (np->sndflow) { 641da177e4SLinus Torvalds fl.fl6_flowlabel = usin->sin6_flowinfo&IPV6_FLOWINFO_MASK; 651da177e4SLinus Torvalds if (fl.fl6_flowlabel&IPV6_FLOWLABEL_MASK) { 661da177e4SLinus Torvalds flowlabel = fl6_sock_lookup(sk, fl.fl6_flowlabel); 671da177e4SLinus Torvalds if (flowlabel == NULL) 681da177e4SLinus Torvalds return -EINVAL; 691da177e4SLinus Torvalds ipv6_addr_copy(&usin->sin6_addr, &flowlabel->dst); 701da177e4SLinus Torvalds } 711da177e4SLinus Torvalds } 721da177e4SLinus Torvalds 731da177e4SLinus Torvalds addr_type = ipv6_addr_type(&usin->sin6_addr); 741da177e4SLinus Torvalds 751da177e4SLinus Torvalds if (addr_type == IPV6_ADDR_ANY) { 761da177e4SLinus Torvalds /* 771da177e4SLinus Torvalds * connect to self 781da177e4SLinus Torvalds */ 791da177e4SLinus Torvalds usin->sin6_addr.s6_addr[15] = 0x01; 801da177e4SLinus Torvalds } 811da177e4SLinus Torvalds 821da177e4SLinus Torvalds daddr = &usin->sin6_addr; 831da177e4SLinus Torvalds 841da177e4SLinus Torvalds if (addr_type == IPV6_ADDR_MAPPED) { 851da177e4SLinus Torvalds struct sockaddr_in sin; 861da177e4SLinus Torvalds 871da177e4SLinus Torvalds if (__ipv6_only_sock(sk)) { 881da177e4SLinus Torvalds err = -ENETUNREACH; 891da177e4SLinus Torvalds goto out; 901da177e4SLinus Torvalds } 911da177e4SLinus Torvalds sin.sin_family = AF_INET; 921da177e4SLinus Torvalds sin.sin_addr.s_addr = daddr->s6_addr32[3]; 931da177e4SLinus Torvalds sin.sin_port = usin->sin6_port; 941da177e4SLinus Torvalds 951da177e4SLinus Torvalds err = ip4_datagram_connect(sk, 961da177e4SLinus Torvalds (struct sockaddr*) &sin, 971da177e4SLinus Torvalds sizeof(sin)); 981da177e4SLinus Torvalds 991da177e4SLinus Torvalds ipv4_connected: 1001da177e4SLinus Torvalds if (err) 1011da177e4SLinus Torvalds goto out; 1021da177e4SLinus Torvalds 103c720c7e8SEric Dumazet ipv6_addr_set_v4mapped(inet->inet_daddr, &np->daddr); 1041da177e4SLinus Torvalds 105b301e82cSBrian Haley if (ipv6_addr_any(&np->saddr)) 106c720c7e8SEric Dumazet ipv6_addr_set_v4mapped(inet->inet_saddr, &np->saddr); 1071da177e4SLinus Torvalds 108719f8358SEric Dumazet if (ipv6_addr_any(&np->rcv_saddr)) { 109c720c7e8SEric Dumazet ipv6_addr_set_v4mapped(inet->inet_rcv_saddr, 110c720c7e8SEric Dumazet &np->rcv_saddr); 111719f8358SEric Dumazet if (sk->sk_prot->rehash) 112719f8358SEric Dumazet sk->sk_prot->rehash(sk); 113719f8358SEric Dumazet } 114b301e82cSBrian Haley 1151da177e4SLinus Torvalds goto out; 1161da177e4SLinus Torvalds } 1171da177e4SLinus Torvalds 1181da177e4SLinus Torvalds if (addr_type&IPV6_ADDR_LINKLOCAL) { 1191da177e4SLinus Torvalds if (addr_len >= sizeof(struct sockaddr_in6) && 1201da177e4SLinus Torvalds usin->sin6_scope_id) { 1211da177e4SLinus Torvalds if (sk->sk_bound_dev_if && 1221da177e4SLinus Torvalds sk->sk_bound_dev_if != usin->sin6_scope_id) { 1231da177e4SLinus Torvalds err = -EINVAL; 1241da177e4SLinus Torvalds goto out; 1251da177e4SLinus Torvalds } 1261da177e4SLinus Torvalds sk->sk_bound_dev_if = usin->sin6_scope_id; 1271da177e4SLinus Torvalds } 1281da177e4SLinus Torvalds 1291ac4f008SBrian Haley if (!sk->sk_bound_dev_if && (addr_type & IPV6_ADDR_MULTICAST)) 1301ac4f008SBrian Haley sk->sk_bound_dev_if = np->mcast_oif; 1311ac4f008SBrian Haley 1321da177e4SLinus Torvalds /* Connect to link-local address requires an interface */ 1331da177e4SLinus Torvalds if (!sk->sk_bound_dev_if) { 1341da177e4SLinus Torvalds err = -EINVAL; 1351da177e4SLinus Torvalds goto out; 1361da177e4SLinus Torvalds } 1371da177e4SLinus Torvalds } 1381da177e4SLinus Torvalds 1391da177e4SLinus Torvalds ipv6_addr_copy(&np->daddr, daddr); 1401da177e4SLinus Torvalds np->flow_label = fl.fl6_flowlabel; 1411da177e4SLinus Torvalds 142c720c7e8SEric Dumazet inet->inet_dport = usin->sin6_port; 1431da177e4SLinus Torvalds 1441da177e4SLinus Torvalds /* 1451da177e4SLinus Torvalds * Check for a route to destination an obtain the 1461da177e4SLinus Torvalds * destination cache for it. 1471da177e4SLinus Torvalds */ 1481da177e4SLinus Torvalds 1491da177e4SLinus Torvalds fl.proto = sk->sk_protocol; 1501da177e4SLinus Torvalds ipv6_addr_copy(&fl.fl6_dst, &np->daddr); 1511da177e4SLinus Torvalds ipv6_addr_copy(&fl.fl6_src, &np->saddr); 1521da177e4SLinus Torvalds fl.oif = sk->sk_bound_dev_if; 15351953d5bSBrian Haley fl.mark = sk->sk_mark; 154c720c7e8SEric Dumazet fl.fl_ip_dport = inet->inet_dport; 155c720c7e8SEric Dumazet fl.fl_ip_sport = inet->inet_sport; 1561da177e4SLinus Torvalds 1571da177e4SLinus Torvalds if (!fl.oif && (addr_type&IPV6_ADDR_MULTICAST)) 1581da177e4SLinus Torvalds fl.oif = np->mcast_oif; 1591da177e4SLinus Torvalds 160beb8d13bSVenkat Yekkirala security_sk_classify_flow(sk, &fl); 161beb8d13bSVenkat Yekkirala 16220c59de2SArnaud Ebalard opt = flowlabel ? flowlabel->opt : np->opt; 16320c59de2SArnaud Ebalard final_p = fl6_update_dst(&fl, opt, &final); 1641da177e4SLinus Torvalds 16568d0c6d3SDavid S. Miller dst = ip6_dst_lookup_flow(sk, &fl, final_p, true); 16668d0c6d3SDavid S. Miller err = 0; 16768d0c6d3SDavid S. Miller if (IS_ERR(dst)) { 16868d0c6d3SDavid S. Miller err = PTR_ERR(dst); 1691da177e4SLinus Torvalds goto out; 17014e50e57SDavid S. Miller } 1711da177e4SLinus Torvalds 1721da177e4SLinus Torvalds /* source address lookup done in ip6_dst_lookup */ 1731da177e4SLinus Torvalds 1741da177e4SLinus Torvalds if (ipv6_addr_any(&np->saddr)) 1751da177e4SLinus Torvalds ipv6_addr_copy(&np->saddr, &fl.fl6_src); 1761da177e4SLinus Torvalds 1771da177e4SLinus Torvalds if (ipv6_addr_any(&np->rcv_saddr)) { 1781da177e4SLinus Torvalds ipv6_addr_copy(&np->rcv_saddr, &fl.fl6_src); 179c720c7e8SEric Dumazet inet->inet_rcv_saddr = LOOPBACK4_IPV6; 180719f8358SEric Dumazet if (sk->sk_prot->rehash) 181719f8358SEric Dumazet sk->sk_prot->rehash(sk); 1821da177e4SLinus Torvalds } 1831da177e4SLinus Torvalds 1841da177e4SLinus Torvalds ip6_dst_store(sk, dst, 1851da177e4SLinus Torvalds ipv6_addr_equal(&fl.fl6_dst, &np->daddr) ? 1868e1ef0a9SYOSHIFUJI Hideaki &np->daddr : NULL, 1878e1ef0a9SYOSHIFUJI Hideaki #ifdef CONFIG_IPV6_SUBTREES 1888e1ef0a9SYOSHIFUJI Hideaki ipv6_addr_equal(&fl.fl6_src, &np->saddr) ? 1898e1ef0a9SYOSHIFUJI Hideaki &np->saddr : 1908e1ef0a9SYOSHIFUJI Hideaki #endif 1918e1ef0a9SYOSHIFUJI Hideaki NULL); 1921da177e4SLinus Torvalds 1931da177e4SLinus Torvalds sk->sk_state = TCP_ESTABLISHED; 1941da177e4SLinus Torvalds out: 1951da177e4SLinus Torvalds fl6_sock_release(flowlabel); 1961da177e4SLinus Torvalds return err; 1971da177e4SLinus Torvalds } 1981da177e4SLinus Torvalds 1991da177e4SLinus Torvalds void ipv6_icmp_error(struct sock *sk, struct sk_buff *skb, int err, 200e69a4adcSAl Viro __be16 port, u32 info, u8 *payload) 2011da177e4SLinus Torvalds { 2021da177e4SLinus Torvalds struct ipv6_pinfo *np = inet6_sk(sk); 203cc70ab26SArnaldo Carvalho de Melo struct icmp6hdr *icmph = icmp6_hdr(skb); 2041da177e4SLinus Torvalds struct sock_exterr_skb *serr; 2051da177e4SLinus Torvalds 2061da177e4SLinus Torvalds if (!np->recverr) 2071da177e4SLinus Torvalds return; 2081da177e4SLinus Torvalds 2091da177e4SLinus Torvalds skb = skb_clone(skb, GFP_ATOMIC); 2101da177e4SLinus Torvalds if (!skb) 2111da177e4SLinus Torvalds return; 2121da177e4SLinus Torvalds 213d40a4de0SBrian Haley skb->protocol = htons(ETH_P_IPV6); 214d40a4de0SBrian Haley 2151da177e4SLinus Torvalds serr = SKB_EXT_ERR(skb); 2161da177e4SLinus Torvalds serr->ee.ee_errno = err; 2171da177e4SLinus Torvalds serr->ee.ee_origin = SO_EE_ORIGIN_ICMP6; 2181da177e4SLinus Torvalds serr->ee.ee_type = icmph->icmp6_type; 2191da177e4SLinus Torvalds serr->ee.ee_code = icmph->icmp6_code; 2201da177e4SLinus Torvalds serr->ee.ee_pad = 0; 2211da177e4SLinus Torvalds serr->ee.ee_info = info; 2221da177e4SLinus Torvalds serr->ee.ee_data = 0; 223d56f90a7SArnaldo Carvalho de Melo serr->addr_offset = (u8 *)&(((struct ipv6hdr *)(icmph + 1))->daddr) - 224d56f90a7SArnaldo Carvalho de Melo skb_network_header(skb); 2251da177e4SLinus Torvalds serr->port = port; 2261da177e4SLinus Torvalds 2271da177e4SLinus Torvalds __skb_pull(skb, payload - skb->data); 228bd82393cSArnaldo Carvalho de Melo skb_reset_transport_header(skb); 2291da177e4SLinus Torvalds 2301da177e4SLinus Torvalds if (sock_queue_err_skb(sk, skb)) 2311da177e4SLinus Torvalds kfree_skb(skb); 2321da177e4SLinus Torvalds } 2331da177e4SLinus Torvalds 2341da177e4SLinus Torvalds void ipv6_local_error(struct sock *sk, int err, struct flowi *fl, u32 info) 2351da177e4SLinus Torvalds { 2361da177e4SLinus Torvalds struct ipv6_pinfo *np = inet6_sk(sk); 2371da177e4SLinus Torvalds struct sock_exterr_skb *serr; 2381da177e4SLinus Torvalds struct ipv6hdr *iph; 2391da177e4SLinus Torvalds struct sk_buff *skb; 2401da177e4SLinus Torvalds 2411da177e4SLinus Torvalds if (!np->recverr) 2421da177e4SLinus Torvalds return; 2431da177e4SLinus Torvalds 2441da177e4SLinus Torvalds skb = alloc_skb(sizeof(struct ipv6hdr), GFP_ATOMIC); 2451da177e4SLinus Torvalds if (!skb) 2461da177e4SLinus Torvalds return; 2471da177e4SLinus Torvalds 248d40a4de0SBrian Haley skb->protocol = htons(ETH_P_IPV6); 249d40a4de0SBrian Haley 2501ced98e8SArnaldo Carvalho de Melo skb_put(skb, sizeof(struct ipv6hdr)); 2511ced98e8SArnaldo Carvalho de Melo skb_reset_network_header(skb); 2520660e03fSArnaldo Carvalho de Melo iph = ipv6_hdr(skb); 2531da177e4SLinus Torvalds ipv6_addr_copy(&iph->daddr, &fl->fl6_dst); 2541da177e4SLinus Torvalds 2551da177e4SLinus Torvalds serr = SKB_EXT_ERR(skb); 2561da177e4SLinus Torvalds serr->ee.ee_errno = err; 2571da177e4SLinus Torvalds serr->ee.ee_origin = SO_EE_ORIGIN_LOCAL; 2581da177e4SLinus Torvalds serr->ee.ee_type = 0; 2591da177e4SLinus Torvalds serr->ee.ee_code = 0; 2601da177e4SLinus Torvalds serr->ee.ee_pad = 0; 2611da177e4SLinus Torvalds serr->ee.ee_info = info; 2621da177e4SLinus Torvalds serr->ee.ee_data = 0; 263d56f90a7SArnaldo Carvalho de Melo serr->addr_offset = (u8 *)&iph->daddr - skb_network_header(skb); 2641da177e4SLinus Torvalds serr->port = fl->fl_ip_dport; 2651da177e4SLinus Torvalds 26627a884dcSArnaldo Carvalho de Melo __skb_pull(skb, skb_tail_pointer(skb) - skb->data); 267bd82393cSArnaldo Carvalho de Melo skb_reset_transport_header(skb); 2681da177e4SLinus Torvalds 2691da177e4SLinus Torvalds if (sock_queue_err_skb(sk, skb)) 2701da177e4SLinus Torvalds kfree_skb(skb); 2711da177e4SLinus Torvalds } 2721da177e4SLinus Torvalds 2734b340ae2SBrian Haley void ipv6_local_rxpmtu(struct sock *sk, struct flowi *fl, u32 mtu) 2744b340ae2SBrian Haley { 2754b340ae2SBrian Haley struct ipv6_pinfo *np = inet6_sk(sk); 2764b340ae2SBrian Haley struct ipv6hdr *iph; 2774b340ae2SBrian Haley struct sk_buff *skb; 2784b340ae2SBrian Haley struct ip6_mtuinfo *mtu_info; 2794b340ae2SBrian Haley 2804b340ae2SBrian Haley if (!np->rxopt.bits.rxpmtu) 2814b340ae2SBrian Haley return; 2824b340ae2SBrian Haley 2834b340ae2SBrian Haley skb = alloc_skb(sizeof(struct ipv6hdr), GFP_ATOMIC); 2844b340ae2SBrian Haley if (!skb) 2854b340ae2SBrian Haley return; 2864b340ae2SBrian Haley 2874b340ae2SBrian Haley skb_put(skb, sizeof(struct ipv6hdr)); 2884b340ae2SBrian Haley skb_reset_network_header(skb); 2894b340ae2SBrian Haley iph = ipv6_hdr(skb); 2904b340ae2SBrian Haley ipv6_addr_copy(&iph->daddr, &fl->fl6_dst); 2914b340ae2SBrian Haley 2924b340ae2SBrian Haley mtu_info = IP6CBMTU(skb); 2934b340ae2SBrian Haley if (!mtu_info) { 2944b340ae2SBrian Haley kfree_skb(skb); 2954b340ae2SBrian Haley return; 2964b340ae2SBrian Haley } 2974b340ae2SBrian Haley 2984b340ae2SBrian Haley mtu_info->ip6m_mtu = mtu; 2994b340ae2SBrian Haley mtu_info->ip6m_addr.sin6_family = AF_INET6; 3004b340ae2SBrian Haley mtu_info->ip6m_addr.sin6_port = 0; 3014b340ae2SBrian Haley mtu_info->ip6m_addr.sin6_flowinfo = 0; 3024b340ae2SBrian Haley mtu_info->ip6m_addr.sin6_scope_id = fl->oif; 3034b340ae2SBrian Haley ipv6_addr_copy(&mtu_info->ip6m_addr.sin6_addr, &ipv6_hdr(skb)->daddr); 3044b340ae2SBrian Haley 3054b340ae2SBrian Haley __skb_pull(skb, skb_tail_pointer(skb) - skb->data); 3064b340ae2SBrian Haley skb_reset_transport_header(skb); 3074b340ae2SBrian Haley 3084b340ae2SBrian Haley skb = xchg(&np->rxpmtu, skb); 3094b340ae2SBrian Haley kfree_skb(skb); 3104b340ae2SBrian Haley } 3114b340ae2SBrian Haley 3121da177e4SLinus Torvalds /* 3131da177e4SLinus Torvalds * Handle MSG_ERRQUEUE 3141da177e4SLinus Torvalds */ 3151da177e4SLinus Torvalds int ipv6_recv_error(struct sock *sk, struct msghdr *msg, int len) 3161da177e4SLinus Torvalds { 3171da177e4SLinus Torvalds struct ipv6_pinfo *np = inet6_sk(sk); 3181da177e4SLinus Torvalds struct sock_exterr_skb *serr; 3191da177e4SLinus Torvalds struct sk_buff *skb, *skb2; 3201da177e4SLinus Torvalds struct sockaddr_in6 *sin; 3211da177e4SLinus Torvalds struct { 3221da177e4SLinus Torvalds struct sock_extended_err ee; 3231da177e4SLinus Torvalds struct sockaddr_in6 offender; 3241da177e4SLinus Torvalds } errhdr; 3251da177e4SLinus Torvalds int err; 3261da177e4SLinus Torvalds int copied; 3271da177e4SLinus Torvalds 3281da177e4SLinus Torvalds err = -EAGAIN; 3291da177e4SLinus Torvalds skb = skb_dequeue(&sk->sk_error_queue); 3301da177e4SLinus Torvalds if (skb == NULL) 3311da177e4SLinus Torvalds goto out; 3321da177e4SLinus Torvalds 3331da177e4SLinus Torvalds copied = skb->len; 3341da177e4SLinus Torvalds if (copied > len) { 3351da177e4SLinus Torvalds msg->msg_flags |= MSG_TRUNC; 3361da177e4SLinus Torvalds copied = len; 3371da177e4SLinus Torvalds } 3381da177e4SLinus Torvalds err = skb_copy_datagram_iovec(skb, 0, msg->msg_iov, copied); 3391da177e4SLinus Torvalds if (err) 3401da177e4SLinus Torvalds goto out_free_skb; 3411da177e4SLinus Torvalds 3421da177e4SLinus Torvalds sock_recv_timestamp(msg, sk, skb); 3431da177e4SLinus Torvalds 3441da177e4SLinus Torvalds serr = SKB_EXT_ERR(skb); 3451da177e4SLinus Torvalds 3461da177e4SLinus Torvalds sin = (struct sockaddr_in6 *)msg->msg_name; 3471da177e4SLinus Torvalds if (sin) { 348d56f90a7SArnaldo Carvalho de Melo const unsigned char *nh = skb_network_header(skb); 3491da177e4SLinus Torvalds sin->sin6_family = AF_INET6; 3501da177e4SLinus Torvalds sin->sin6_flowinfo = 0; 3511da177e4SLinus Torvalds sin->sin6_port = serr->port; 3521da177e4SLinus Torvalds sin->sin6_scope_id = 0; 353d40a4de0SBrian Haley if (skb->protocol == htons(ETH_P_IPV6)) { 3541da177e4SLinus Torvalds ipv6_addr_copy(&sin->sin6_addr, 355d56f90a7SArnaldo Carvalho de Melo (struct in6_addr *)(nh + serr->addr_offset)); 3561da177e4SLinus Torvalds if (np->sndflow) 357d56f90a7SArnaldo Carvalho de Melo sin->sin6_flowinfo = 358d56f90a7SArnaldo Carvalho de Melo (*(__be32 *)(nh + serr->addr_offset - 24) & 359d56f90a7SArnaldo Carvalho de Melo IPV6_FLOWINFO_MASK); 3601da177e4SLinus Torvalds if (ipv6_addr_type(&sin->sin6_addr) & IPV6_ADDR_LINKLOCAL) 3611da177e4SLinus Torvalds sin->sin6_scope_id = IP6CB(skb)->iif; 3621da177e4SLinus Torvalds } else { 363b301e82cSBrian Haley ipv6_addr_set_v4mapped(*(__be32 *)(nh + serr->addr_offset), 364b301e82cSBrian Haley &sin->sin6_addr); 3651da177e4SLinus Torvalds } 3661da177e4SLinus Torvalds } 3671da177e4SLinus Torvalds 3681da177e4SLinus Torvalds memcpy(&errhdr.ee, &serr->ee, sizeof(struct sock_extended_err)); 3691da177e4SLinus Torvalds sin = &errhdr.offender; 3701da177e4SLinus Torvalds sin->sin6_family = AF_UNSPEC; 3711da177e4SLinus Torvalds if (serr->ee.ee_origin != SO_EE_ORIGIN_LOCAL) { 3721da177e4SLinus Torvalds sin->sin6_family = AF_INET6; 3731da177e4SLinus Torvalds sin->sin6_flowinfo = 0; 3741da177e4SLinus Torvalds sin->sin6_scope_id = 0; 375d40a4de0SBrian Haley if (skb->protocol == htons(ETH_P_IPV6)) { 3760660e03fSArnaldo Carvalho de Melo ipv6_addr_copy(&sin->sin6_addr, &ipv6_hdr(skb)->saddr); 3771da177e4SLinus Torvalds if (np->rxopt.all) 3781da177e4SLinus Torvalds datagram_recv_ctl(sk, msg, skb); 3791da177e4SLinus Torvalds if (ipv6_addr_type(&sin->sin6_addr) & IPV6_ADDR_LINKLOCAL) 3801da177e4SLinus Torvalds sin->sin6_scope_id = IP6CB(skb)->iif; 3811da177e4SLinus Torvalds } else { 3821da177e4SLinus Torvalds struct inet_sock *inet = inet_sk(sk); 3831da177e4SLinus Torvalds 384b301e82cSBrian Haley ipv6_addr_set_v4mapped(ip_hdr(skb)->saddr, 385b301e82cSBrian Haley &sin->sin6_addr); 3861da177e4SLinus Torvalds if (inet->cmsg_flags) 3871da177e4SLinus Torvalds ip_cmsg_recv(msg, skb); 3881da177e4SLinus Torvalds } 3891da177e4SLinus Torvalds } 3901da177e4SLinus Torvalds 3911da177e4SLinus Torvalds put_cmsg(msg, SOL_IPV6, IPV6_RECVERR, sizeof(errhdr), &errhdr); 3921da177e4SLinus Torvalds 3931da177e4SLinus Torvalds /* Now we could try to dump offended packet options */ 3941da177e4SLinus Torvalds 3951da177e4SLinus Torvalds msg->msg_flags |= MSG_ERRQUEUE; 3961da177e4SLinus Torvalds err = copied; 3971da177e4SLinus Torvalds 3981da177e4SLinus Torvalds /* Reset and regenerate socket error */ 399e0f9f858SHerbert Xu spin_lock_bh(&sk->sk_error_queue.lock); 4001da177e4SLinus Torvalds sk->sk_err = 0; 4011da177e4SLinus Torvalds if ((skb2 = skb_peek(&sk->sk_error_queue)) != NULL) { 4021da177e4SLinus Torvalds sk->sk_err = SKB_EXT_ERR(skb2)->ee.ee_errno; 403e0f9f858SHerbert Xu spin_unlock_bh(&sk->sk_error_queue.lock); 4041da177e4SLinus Torvalds sk->sk_error_report(sk); 4051da177e4SLinus Torvalds } else { 406e0f9f858SHerbert Xu spin_unlock_bh(&sk->sk_error_queue.lock); 4071da177e4SLinus Torvalds } 4081da177e4SLinus Torvalds 4091da177e4SLinus Torvalds out_free_skb: 4101da177e4SLinus Torvalds kfree_skb(skb); 4111da177e4SLinus Torvalds out: 4121da177e4SLinus Torvalds return err; 4131da177e4SLinus Torvalds } 4141da177e4SLinus Torvalds 4154b340ae2SBrian Haley /* 4164b340ae2SBrian Haley * Handle IPV6_RECVPATHMTU 4174b340ae2SBrian Haley */ 4184b340ae2SBrian Haley int ipv6_recv_rxpmtu(struct sock *sk, struct msghdr *msg, int len) 4194b340ae2SBrian Haley { 4204b340ae2SBrian Haley struct ipv6_pinfo *np = inet6_sk(sk); 4214b340ae2SBrian Haley struct sk_buff *skb; 4224b340ae2SBrian Haley struct sockaddr_in6 *sin; 4234b340ae2SBrian Haley struct ip6_mtuinfo mtu_info; 4244b340ae2SBrian Haley int err; 4254b340ae2SBrian Haley int copied; 4264b340ae2SBrian Haley 4274b340ae2SBrian Haley err = -EAGAIN; 4284b340ae2SBrian Haley skb = xchg(&np->rxpmtu, NULL); 4294b340ae2SBrian Haley if (skb == NULL) 4304b340ae2SBrian Haley goto out; 4314b340ae2SBrian Haley 4324b340ae2SBrian Haley copied = skb->len; 4334b340ae2SBrian Haley if (copied > len) { 4344b340ae2SBrian Haley msg->msg_flags |= MSG_TRUNC; 4354b340ae2SBrian Haley copied = len; 4364b340ae2SBrian Haley } 4374b340ae2SBrian Haley err = skb_copy_datagram_iovec(skb, 0, msg->msg_iov, copied); 4384b340ae2SBrian Haley if (err) 4394b340ae2SBrian Haley goto out_free_skb; 4404b340ae2SBrian Haley 4414b340ae2SBrian Haley sock_recv_timestamp(msg, sk, skb); 4424b340ae2SBrian Haley 4434b340ae2SBrian Haley memcpy(&mtu_info, IP6CBMTU(skb), sizeof(mtu_info)); 4444b340ae2SBrian Haley 4454b340ae2SBrian Haley sin = (struct sockaddr_in6 *)msg->msg_name; 4464b340ae2SBrian Haley if (sin) { 4474b340ae2SBrian Haley sin->sin6_family = AF_INET6; 4484b340ae2SBrian Haley sin->sin6_flowinfo = 0; 4494b340ae2SBrian Haley sin->sin6_port = 0; 4504b340ae2SBrian Haley sin->sin6_scope_id = mtu_info.ip6m_addr.sin6_scope_id; 4514b340ae2SBrian Haley ipv6_addr_copy(&sin->sin6_addr, &mtu_info.ip6m_addr.sin6_addr); 4524b340ae2SBrian Haley } 4534b340ae2SBrian Haley 4544b340ae2SBrian Haley put_cmsg(msg, SOL_IPV6, IPV6_PATHMTU, sizeof(mtu_info), &mtu_info); 4554b340ae2SBrian Haley 4564b340ae2SBrian Haley err = copied; 4574b340ae2SBrian Haley 4584b340ae2SBrian Haley out_free_skb: 4594b340ae2SBrian Haley kfree_skb(skb); 4604b340ae2SBrian Haley out: 4614b340ae2SBrian Haley return err; 4624b340ae2SBrian Haley } 4631da177e4SLinus Torvalds 4641da177e4SLinus Torvalds 4651da177e4SLinus Torvalds int datagram_recv_ctl(struct sock *sk, struct msghdr *msg, struct sk_buff *skb) 4661da177e4SLinus Torvalds { 4671da177e4SLinus Torvalds struct ipv6_pinfo *np = inet6_sk(sk); 4681da177e4SLinus Torvalds struct inet6_skb_parm *opt = IP6CB(skb); 469d56f90a7SArnaldo Carvalho de Melo unsigned char *nh = skb_network_header(skb); 4701da177e4SLinus Torvalds 4711da177e4SLinus Torvalds if (np->rxopt.bits.rxinfo) { 4721da177e4SLinus Torvalds struct in6_pktinfo src_info; 4731da177e4SLinus Torvalds 4741da177e4SLinus Torvalds src_info.ipi6_ifindex = opt->iif; 4750660e03fSArnaldo Carvalho de Melo ipv6_addr_copy(&src_info.ipi6_addr, &ipv6_hdr(skb)->daddr); 4761da177e4SLinus Torvalds put_cmsg(msg, SOL_IPV6, IPV6_PKTINFO, sizeof(src_info), &src_info); 4771da177e4SLinus Torvalds } 4781da177e4SLinus Torvalds 4791da177e4SLinus Torvalds if (np->rxopt.bits.rxhlim) { 4800660e03fSArnaldo Carvalho de Melo int hlim = ipv6_hdr(skb)->hop_limit; 4811da177e4SLinus Torvalds put_cmsg(msg, SOL_IPV6, IPV6_HOPLIMIT, sizeof(hlim), &hlim); 4821da177e4SLinus Torvalds } 4831da177e4SLinus Torvalds 48441a1f8eaSYOSHIFUJI Hideaki if (np->rxopt.bits.rxtclass) { 4850660e03fSArnaldo Carvalho de Melo int tclass = (ntohl(*(__be32 *)ipv6_hdr(skb)) >> 20) & 0xff; 48641a1f8eaSYOSHIFUJI Hideaki put_cmsg(msg, SOL_IPV6, IPV6_TCLASS, sizeof(tclass), &tclass); 48741a1f8eaSYOSHIFUJI Hideaki } 48841a1f8eaSYOSHIFUJI Hideaki 489d56f90a7SArnaldo Carvalho de Melo if (np->rxopt.bits.rxflow && (*(__be32 *)nh & IPV6_FLOWINFO_MASK)) { 490d56f90a7SArnaldo Carvalho de Melo __be32 flowinfo = *(__be32 *)nh & IPV6_FLOWINFO_MASK; 4911da177e4SLinus Torvalds put_cmsg(msg, SOL_IPV6, IPV6_FLOWINFO, sizeof(flowinfo), &flowinfo); 4921da177e4SLinus Torvalds } 493333fad53SYOSHIFUJI Hideaki 494333fad53SYOSHIFUJI Hideaki /* HbH is allowed only once */ 4951da177e4SLinus Torvalds if (np->rxopt.bits.hopopts && opt->hop) { 496d56f90a7SArnaldo Carvalho de Melo u8 *ptr = nh + opt->hop; 4971da177e4SLinus Torvalds put_cmsg(msg, SOL_IPV6, IPV6_HOPOPTS, (ptr[1]+1)<<3, ptr); 4981da177e4SLinus Torvalds } 499333fad53SYOSHIFUJI Hideaki 500333fad53SYOSHIFUJI Hideaki if (opt->lastopt && 501333fad53SYOSHIFUJI Hideaki (np->rxopt.bits.dstopts || np->rxopt.bits.srcrt)) { 502333fad53SYOSHIFUJI Hideaki /* 503333fad53SYOSHIFUJI Hideaki * Silly enough, but we need to reparse in order to 504333fad53SYOSHIFUJI Hideaki * report extension headers (except for HbH) 505333fad53SYOSHIFUJI Hideaki * in order. 506333fad53SYOSHIFUJI Hideaki * 507333fad53SYOSHIFUJI Hideaki * Also note that IPV6_RECVRTHDRDSTOPTS is NOT 508333fad53SYOSHIFUJI Hideaki * (and WILL NOT be) defined because 509333fad53SYOSHIFUJI Hideaki * IPV6_RECVDSTOPTS is more generic. --yoshfuji 510333fad53SYOSHIFUJI Hideaki */ 511333fad53SYOSHIFUJI Hideaki unsigned int off = sizeof(struct ipv6hdr); 5120660e03fSArnaldo Carvalho de Melo u8 nexthdr = ipv6_hdr(skb)->nexthdr; 513333fad53SYOSHIFUJI Hideaki 514333fad53SYOSHIFUJI Hideaki while (off <= opt->lastopt) { 515333fad53SYOSHIFUJI Hideaki unsigned len; 516d56f90a7SArnaldo Carvalho de Melo u8 *ptr = nh + off; 517333fad53SYOSHIFUJI Hideaki 518333fad53SYOSHIFUJI Hideaki switch(nexthdr) { 519333fad53SYOSHIFUJI Hideaki case IPPROTO_DSTOPTS: 520333fad53SYOSHIFUJI Hideaki nexthdr = ptr[0]; 521333fad53SYOSHIFUJI Hideaki len = (ptr[1] + 1) << 3; 522333fad53SYOSHIFUJI Hideaki if (np->rxopt.bits.dstopts) 523333fad53SYOSHIFUJI Hideaki put_cmsg(msg, SOL_IPV6, IPV6_DSTOPTS, len, ptr); 524333fad53SYOSHIFUJI Hideaki break; 525333fad53SYOSHIFUJI Hideaki case IPPROTO_ROUTING: 526333fad53SYOSHIFUJI Hideaki nexthdr = ptr[0]; 527333fad53SYOSHIFUJI Hideaki len = (ptr[1] + 1) << 3; 528333fad53SYOSHIFUJI Hideaki if (np->rxopt.bits.srcrt) 529333fad53SYOSHIFUJI Hideaki put_cmsg(msg, SOL_IPV6, IPV6_RTHDR, len, ptr); 530333fad53SYOSHIFUJI Hideaki break; 531333fad53SYOSHIFUJI Hideaki case IPPROTO_AH: 532333fad53SYOSHIFUJI Hideaki nexthdr = ptr[0]; 533a3059893SVille Nuorvala len = (ptr[1] + 2) << 2; 534333fad53SYOSHIFUJI Hideaki break; 535333fad53SYOSHIFUJI Hideaki default: 536333fad53SYOSHIFUJI Hideaki nexthdr = ptr[0]; 537333fad53SYOSHIFUJI Hideaki len = (ptr[1] + 1) << 3; 538333fad53SYOSHIFUJI Hideaki break; 539333fad53SYOSHIFUJI Hideaki } 540333fad53SYOSHIFUJI Hideaki 541333fad53SYOSHIFUJI Hideaki off += len; 542333fad53SYOSHIFUJI Hideaki } 543333fad53SYOSHIFUJI Hideaki } 544333fad53SYOSHIFUJI Hideaki 545333fad53SYOSHIFUJI Hideaki /* socket options in old style */ 546333fad53SYOSHIFUJI Hideaki if (np->rxopt.bits.rxoinfo) { 547333fad53SYOSHIFUJI Hideaki struct in6_pktinfo src_info; 548333fad53SYOSHIFUJI Hideaki 549333fad53SYOSHIFUJI Hideaki src_info.ipi6_ifindex = opt->iif; 5500660e03fSArnaldo Carvalho de Melo ipv6_addr_copy(&src_info.ipi6_addr, &ipv6_hdr(skb)->daddr); 551333fad53SYOSHIFUJI Hideaki put_cmsg(msg, SOL_IPV6, IPV6_2292PKTINFO, sizeof(src_info), &src_info); 552333fad53SYOSHIFUJI Hideaki } 553333fad53SYOSHIFUJI Hideaki if (np->rxopt.bits.rxohlim) { 5540660e03fSArnaldo Carvalho de Melo int hlim = ipv6_hdr(skb)->hop_limit; 555333fad53SYOSHIFUJI Hideaki put_cmsg(msg, SOL_IPV6, IPV6_2292HOPLIMIT, sizeof(hlim), &hlim); 556333fad53SYOSHIFUJI Hideaki } 557333fad53SYOSHIFUJI Hideaki if (np->rxopt.bits.ohopopts && opt->hop) { 558d56f90a7SArnaldo Carvalho de Melo u8 *ptr = nh + opt->hop; 559333fad53SYOSHIFUJI Hideaki put_cmsg(msg, SOL_IPV6, IPV6_2292HOPOPTS, (ptr[1]+1)<<3, ptr); 560333fad53SYOSHIFUJI Hideaki } 561333fad53SYOSHIFUJI Hideaki if (np->rxopt.bits.odstopts && opt->dst0) { 562d56f90a7SArnaldo Carvalho de Melo u8 *ptr = nh + opt->dst0; 563333fad53SYOSHIFUJI Hideaki put_cmsg(msg, SOL_IPV6, IPV6_2292DSTOPTS, (ptr[1]+1)<<3, ptr); 5641da177e4SLinus Torvalds } 565333fad53SYOSHIFUJI Hideaki if (np->rxopt.bits.osrcrt && opt->srcrt) { 566d56f90a7SArnaldo Carvalho de Melo struct ipv6_rt_hdr *rthdr = (struct ipv6_rt_hdr *)(nh + opt->srcrt); 567333fad53SYOSHIFUJI Hideaki put_cmsg(msg, SOL_IPV6, IPV6_2292RTHDR, (rthdr->hdrlen+1) << 3, rthdr); 5681da177e4SLinus Torvalds } 569333fad53SYOSHIFUJI Hideaki if (np->rxopt.bits.odstopts && opt->dst1) { 570d56f90a7SArnaldo Carvalho de Melo u8 *ptr = nh + opt->dst1; 571333fad53SYOSHIFUJI Hideaki put_cmsg(msg, SOL_IPV6, IPV6_2292DSTOPTS, (ptr[1]+1)<<3, ptr); 5721da177e4SLinus Torvalds } 5736c468622SBalazs Scheidler if (np->rxopt.bits.rxorigdstaddr) { 5746c468622SBalazs Scheidler struct sockaddr_in6 sin6; 5756c468622SBalazs Scheidler u16 *ports = (u16 *) skb_transport_header(skb); 5766c468622SBalazs Scheidler 5776c468622SBalazs Scheidler if (skb_transport_offset(skb) + 4 <= skb->len) { 5786c468622SBalazs Scheidler /* All current transport protocols have the port numbers in the 5796c468622SBalazs Scheidler * first four bytes of the transport header and this function is 5806c468622SBalazs Scheidler * written with this assumption in mind. 5816c468622SBalazs Scheidler */ 5826c468622SBalazs Scheidler 5836c468622SBalazs Scheidler sin6.sin6_family = AF_INET6; 5846c468622SBalazs Scheidler ipv6_addr_copy(&sin6.sin6_addr, &ipv6_hdr(skb)->daddr); 5856c468622SBalazs Scheidler sin6.sin6_port = ports[1]; 5866c468622SBalazs Scheidler sin6.sin6_flowinfo = 0; 5876c468622SBalazs Scheidler sin6.sin6_scope_id = 0; 5886c468622SBalazs Scheidler 5896c468622SBalazs Scheidler put_cmsg(msg, SOL_IPV6, IPV6_ORIGDSTADDR, sizeof(sin6), &sin6); 5906c468622SBalazs Scheidler } 5916c468622SBalazs Scheidler } 5921da177e4SLinus Torvalds return 0; 5931da177e4SLinus Torvalds } 5941da177e4SLinus Torvalds 59591e1908fSYOSHIFUJI Hideaki int datagram_send_ctl(struct net *net, 59691e1908fSYOSHIFUJI Hideaki struct msghdr *msg, struct flowi *fl, 5971da177e4SLinus Torvalds struct ipv6_txoptions *opt, 59813b52cd4SBrian Haley int *hlimit, int *tclass, int *dontfrag) 5991da177e4SLinus Torvalds { 6001da177e4SLinus Torvalds struct in6_pktinfo *src_info; 6011da177e4SLinus Torvalds struct cmsghdr *cmsg; 6021da177e4SLinus Torvalds struct ipv6_rt_hdr *rthdr; 6031da177e4SLinus Torvalds struct ipv6_opt_hdr *hdr; 6041da177e4SLinus Torvalds int len; 6051da177e4SLinus Torvalds int err = 0; 6061da177e4SLinus Torvalds 6071da177e4SLinus Torvalds for (cmsg = CMSG_FIRSTHDR(msg); cmsg; cmsg = CMSG_NXTHDR(msg, cmsg)) { 6081da177e4SLinus Torvalds int addr_type; 6091da177e4SLinus Torvalds 6101da177e4SLinus Torvalds if (!CMSG_OK(msg, cmsg)) { 6111da177e4SLinus Torvalds err = -EINVAL; 6121da177e4SLinus Torvalds goto exit_f; 6131da177e4SLinus Torvalds } 6141da177e4SLinus Torvalds 6151da177e4SLinus Torvalds if (cmsg->cmsg_level != SOL_IPV6) 6161da177e4SLinus Torvalds continue; 6171da177e4SLinus Torvalds 6181da177e4SLinus Torvalds switch (cmsg->cmsg_type) { 6191da177e4SLinus Torvalds case IPV6_PKTINFO: 620333fad53SYOSHIFUJI Hideaki case IPV6_2292PKTINFO: 621187e3838SYOSHIFUJI Hideaki { 622187e3838SYOSHIFUJI Hideaki struct net_device *dev = NULL; 623187e3838SYOSHIFUJI Hideaki 6241da177e4SLinus Torvalds if (cmsg->cmsg_len < CMSG_LEN(sizeof(struct in6_pktinfo))) { 6251da177e4SLinus Torvalds err = -EINVAL; 6261da177e4SLinus Torvalds goto exit_f; 6271da177e4SLinus Torvalds } 6281da177e4SLinus Torvalds 6291da177e4SLinus Torvalds src_info = (struct in6_pktinfo *)CMSG_DATA(cmsg); 6301da177e4SLinus Torvalds 6311da177e4SLinus Torvalds if (src_info->ipi6_ifindex) { 6321da177e4SLinus Torvalds if (fl->oif && src_info->ipi6_ifindex != fl->oif) 6331da177e4SLinus Torvalds return -EINVAL; 6341da177e4SLinus Torvalds fl->oif = src_info->ipi6_ifindex; 6351da177e4SLinus Torvalds } 6361da177e4SLinus Torvalds 637187e3838SYOSHIFUJI Hideaki addr_type = __ipv6_addr_type(&src_info->ipi6_addr); 6381da177e4SLinus Torvalds 639536b2e92SEric Dumazet rcu_read_lock(); 640187e3838SYOSHIFUJI Hideaki if (fl->oif) { 641536b2e92SEric Dumazet dev = dev_get_by_index_rcu(net, fl->oif); 642536b2e92SEric Dumazet if (!dev) { 643536b2e92SEric Dumazet rcu_read_unlock(); 6441da177e4SLinus Torvalds return -ENODEV; 645536b2e92SEric Dumazet } 646536b2e92SEric Dumazet } else if (addr_type & IPV6_ADDR_LINKLOCAL) { 647536b2e92SEric Dumazet rcu_read_unlock(); 648187e3838SYOSHIFUJI Hideaki return -EINVAL; 649536b2e92SEric Dumazet } 650187e3838SYOSHIFUJI Hideaki 651187e3838SYOSHIFUJI Hideaki if (addr_type != IPV6_ADDR_ANY) { 652187e3838SYOSHIFUJI Hideaki int strict = __ipv6_addr_src_scope(addr_type) <= IPV6_ADDR_SCOPE_LINKLOCAL; 65391e1908fSYOSHIFUJI Hideaki if (!ipv6_chk_addr(net, &src_info->ipi6_addr, 654187e3838SYOSHIFUJI Hideaki strict ? dev : NULL, 0)) 6551da177e4SLinus Torvalds err = -EINVAL; 656187e3838SYOSHIFUJI Hideaki else 657187e3838SYOSHIFUJI Hideaki ipv6_addr_copy(&fl->fl6_src, &src_info->ipi6_addr); 6581da177e4SLinus Torvalds } 659187e3838SYOSHIFUJI Hideaki 660536b2e92SEric Dumazet rcu_read_unlock(); 6611da177e4SLinus Torvalds 662187e3838SYOSHIFUJI Hideaki if (err) 663187e3838SYOSHIFUJI Hideaki goto exit_f; 664187e3838SYOSHIFUJI Hideaki 6651da177e4SLinus Torvalds break; 666187e3838SYOSHIFUJI Hideaki } 6671da177e4SLinus Torvalds 6681da177e4SLinus Torvalds case IPV6_FLOWINFO: 6691da177e4SLinus Torvalds if (cmsg->cmsg_len < CMSG_LEN(4)) { 6701da177e4SLinus Torvalds err = -EINVAL; 6711da177e4SLinus Torvalds goto exit_f; 6721da177e4SLinus Torvalds } 6731da177e4SLinus Torvalds 6741da177e4SLinus Torvalds if (fl->fl6_flowlabel&IPV6_FLOWINFO_MASK) { 67590bcaf7bSAl Viro if ((fl->fl6_flowlabel^*(__be32 *)CMSG_DATA(cmsg))&~IPV6_FLOWINFO_MASK) { 6761da177e4SLinus Torvalds err = -EINVAL; 6771da177e4SLinus Torvalds goto exit_f; 6781da177e4SLinus Torvalds } 6791da177e4SLinus Torvalds } 68090bcaf7bSAl Viro fl->fl6_flowlabel = IPV6_FLOWINFO_MASK & *(__be32 *)CMSG_DATA(cmsg); 6811da177e4SLinus Torvalds break; 6821da177e4SLinus Torvalds 683333fad53SYOSHIFUJI Hideaki case IPV6_2292HOPOPTS: 6841da177e4SLinus Torvalds case IPV6_HOPOPTS: 6851da177e4SLinus Torvalds if (opt->hopopt || cmsg->cmsg_len < CMSG_LEN(sizeof(struct ipv6_opt_hdr))) { 6861da177e4SLinus Torvalds err = -EINVAL; 6871da177e4SLinus Torvalds goto exit_f; 6881da177e4SLinus Torvalds } 6891da177e4SLinus Torvalds 6901da177e4SLinus Torvalds hdr = (struct ipv6_opt_hdr *)CMSG_DATA(cmsg); 6911da177e4SLinus Torvalds len = ((hdr->hdrlen + 1) << 3); 6921da177e4SLinus Torvalds if (cmsg->cmsg_len < CMSG_LEN(len)) { 6931da177e4SLinus Torvalds err = -EINVAL; 6941da177e4SLinus Torvalds goto exit_f; 6951da177e4SLinus Torvalds } 6961da177e4SLinus Torvalds if (!capable(CAP_NET_RAW)) { 6971da177e4SLinus Torvalds err = -EPERM; 6981da177e4SLinus Torvalds goto exit_f; 6991da177e4SLinus Torvalds } 7001da177e4SLinus Torvalds opt->opt_nflen += len; 7011da177e4SLinus Torvalds opt->hopopt = hdr; 7021da177e4SLinus Torvalds break; 7031da177e4SLinus Torvalds 704333fad53SYOSHIFUJI Hideaki case IPV6_2292DSTOPTS: 7051da177e4SLinus Torvalds if (cmsg->cmsg_len < CMSG_LEN(sizeof(struct ipv6_opt_hdr))) { 7061da177e4SLinus Torvalds err = -EINVAL; 7071da177e4SLinus Torvalds goto exit_f; 7081da177e4SLinus Torvalds } 7091da177e4SLinus Torvalds 7101da177e4SLinus Torvalds hdr = (struct ipv6_opt_hdr *)CMSG_DATA(cmsg); 7111da177e4SLinus Torvalds len = ((hdr->hdrlen + 1) << 3); 7121da177e4SLinus Torvalds if (cmsg->cmsg_len < CMSG_LEN(len)) { 7131da177e4SLinus Torvalds err = -EINVAL; 7141da177e4SLinus Torvalds goto exit_f; 7151da177e4SLinus Torvalds } 7161da177e4SLinus Torvalds if (!capable(CAP_NET_RAW)) { 7171da177e4SLinus Torvalds err = -EPERM; 7181da177e4SLinus Torvalds goto exit_f; 7191da177e4SLinus Torvalds } 7201da177e4SLinus Torvalds if (opt->dst1opt) { 7211da177e4SLinus Torvalds err = -EINVAL; 7221da177e4SLinus Torvalds goto exit_f; 7231da177e4SLinus Torvalds } 7241da177e4SLinus Torvalds opt->opt_flen += len; 7251da177e4SLinus Torvalds opt->dst1opt = hdr; 7261da177e4SLinus Torvalds break; 7271da177e4SLinus Torvalds 728333fad53SYOSHIFUJI Hideaki case IPV6_DSTOPTS: 729333fad53SYOSHIFUJI Hideaki case IPV6_RTHDRDSTOPTS: 730333fad53SYOSHIFUJI Hideaki if (cmsg->cmsg_len < CMSG_LEN(sizeof(struct ipv6_opt_hdr))) { 731333fad53SYOSHIFUJI Hideaki err = -EINVAL; 732333fad53SYOSHIFUJI Hideaki goto exit_f; 733333fad53SYOSHIFUJI Hideaki } 734333fad53SYOSHIFUJI Hideaki 735333fad53SYOSHIFUJI Hideaki hdr = (struct ipv6_opt_hdr *)CMSG_DATA(cmsg); 736333fad53SYOSHIFUJI Hideaki len = ((hdr->hdrlen + 1) << 3); 737333fad53SYOSHIFUJI Hideaki if (cmsg->cmsg_len < CMSG_LEN(len)) { 738333fad53SYOSHIFUJI Hideaki err = -EINVAL; 739333fad53SYOSHIFUJI Hideaki goto exit_f; 740333fad53SYOSHIFUJI Hideaki } 741333fad53SYOSHIFUJI Hideaki if (!capable(CAP_NET_RAW)) { 742333fad53SYOSHIFUJI Hideaki err = -EPERM; 743333fad53SYOSHIFUJI Hideaki goto exit_f; 744333fad53SYOSHIFUJI Hideaki } 745333fad53SYOSHIFUJI Hideaki if (cmsg->cmsg_type == IPV6_DSTOPTS) { 746333fad53SYOSHIFUJI Hideaki opt->opt_flen += len; 747333fad53SYOSHIFUJI Hideaki opt->dst1opt = hdr; 748333fad53SYOSHIFUJI Hideaki } else { 749333fad53SYOSHIFUJI Hideaki opt->opt_nflen += len; 750333fad53SYOSHIFUJI Hideaki opt->dst0opt = hdr; 751333fad53SYOSHIFUJI Hideaki } 752333fad53SYOSHIFUJI Hideaki break; 753333fad53SYOSHIFUJI Hideaki 754333fad53SYOSHIFUJI Hideaki case IPV6_2292RTHDR: 7551da177e4SLinus Torvalds case IPV6_RTHDR: 7561da177e4SLinus Torvalds if (cmsg->cmsg_len < CMSG_LEN(sizeof(struct ipv6_rt_hdr))) { 7571da177e4SLinus Torvalds err = -EINVAL; 7581da177e4SLinus Torvalds goto exit_f; 7591da177e4SLinus Torvalds } 7601da177e4SLinus Torvalds 7611da177e4SLinus Torvalds rthdr = (struct ipv6_rt_hdr *)CMSG_DATA(cmsg); 7621da177e4SLinus Torvalds 763280a9d34SMasahide NAKAMURA switch (rthdr->type) { 76459fbb3a6SMasahide NAKAMURA #if defined(CONFIG_IPV6_MIP6) || defined(CONFIG_IPV6_MIP6_MODULE) 765280a9d34SMasahide NAKAMURA case IPV6_SRCRT_TYPE_2: 7666e093d9dSBrian Haley if (rthdr->hdrlen != 2 || 7676e093d9dSBrian Haley rthdr->segments_left != 1) { 7686e093d9dSBrian Haley err = -EINVAL; 7696e093d9dSBrian Haley goto exit_f; 7706e093d9dSBrian Haley } 771280a9d34SMasahide NAKAMURA break; 772bb4dbf9eSYOSHIFUJI Hideaki #endif 773280a9d34SMasahide NAKAMURA default: 7741da177e4SLinus Torvalds err = -EINVAL; 7751da177e4SLinus Torvalds goto exit_f; 7761da177e4SLinus Torvalds } 7771da177e4SLinus Torvalds 7781da177e4SLinus Torvalds len = ((rthdr->hdrlen + 1) << 3); 7791da177e4SLinus Torvalds 7801da177e4SLinus Torvalds if (cmsg->cmsg_len < CMSG_LEN(len)) { 7811da177e4SLinus Torvalds err = -EINVAL; 7821da177e4SLinus Torvalds goto exit_f; 7831da177e4SLinus Torvalds } 7841da177e4SLinus Torvalds 7851da177e4SLinus Torvalds /* segments left must also match */ 7861da177e4SLinus Torvalds if ((rthdr->hdrlen >> 1) != rthdr->segments_left) { 7871da177e4SLinus Torvalds err = -EINVAL; 7881da177e4SLinus Torvalds goto exit_f; 7891da177e4SLinus Torvalds } 7901da177e4SLinus Torvalds 7911da177e4SLinus Torvalds opt->opt_nflen += len; 7921da177e4SLinus Torvalds opt->srcrt = rthdr; 7931da177e4SLinus Torvalds 794333fad53SYOSHIFUJI Hideaki if (cmsg->cmsg_type == IPV6_2292RTHDR && opt->dst1opt) { 7951da177e4SLinus Torvalds int dsthdrlen = ((opt->dst1opt->hdrlen+1)<<3); 7961da177e4SLinus Torvalds 7971da177e4SLinus Torvalds opt->opt_nflen += dsthdrlen; 7981da177e4SLinus Torvalds opt->dst0opt = opt->dst1opt; 7991da177e4SLinus Torvalds opt->dst1opt = NULL; 8001da177e4SLinus Torvalds opt->opt_flen -= dsthdrlen; 8011da177e4SLinus Torvalds } 8021da177e4SLinus Torvalds 8031da177e4SLinus Torvalds break; 8041da177e4SLinus Torvalds 805333fad53SYOSHIFUJI Hideaki case IPV6_2292HOPLIMIT: 8061da177e4SLinus Torvalds case IPV6_HOPLIMIT: 8071da177e4SLinus Torvalds if (cmsg->cmsg_len != CMSG_LEN(sizeof(int))) { 8081da177e4SLinus Torvalds err = -EINVAL; 8091da177e4SLinus Torvalds goto exit_f; 8101da177e4SLinus Torvalds } 8111da177e4SLinus Torvalds 8121da177e4SLinus Torvalds *hlimit = *(int *)CMSG_DATA(cmsg); 813e8766fc8SShan Wei if (*hlimit < -1 || *hlimit > 0xff) { 814e8766fc8SShan Wei err = -EINVAL; 815e8766fc8SShan Wei goto exit_f; 816e8766fc8SShan Wei } 817e8766fc8SShan Wei 8181da177e4SLinus Torvalds break; 8191da177e4SLinus Torvalds 82041a1f8eaSYOSHIFUJI Hideaki case IPV6_TCLASS: 82141a1f8eaSYOSHIFUJI Hideaki { 82241a1f8eaSYOSHIFUJI Hideaki int tc; 82341a1f8eaSYOSHIFUJI Hideaki 82441a1f8eaSYOSHIFUJI Hideaki err = -EINVAL; 82541a1f8eaSYOSHIFUJI Hideaki if (cmsg->cmsg_len != CMSG_LEN(sizeof(int))) { 82641a1f8eaSYOSHIFUJI Hideaki goto exit_f; 82741a1f8eaSYOSHIFUJI Hideaki } 82841a1f8eaSYOSHIFUJI Hideaki 82941a1f8eaSYOSHIFUJI Hideaki tc = *(int *)CMSG_DATA(cmsg); 830d0ee011fSRemi Denis-Courmont if (tc < -1 || tc > 0xff) 83141a1f8eaSYOSHIFUJI Hideaki goto exit_f; 83241a1f8eaSYOSHIFUJI Hideaki 83341a1f8eaSYOSHIFUJI Hideaki err = 0; 83441a1f8eaSYOSHIFUJI Hideaki *tclass = tc; 83541a1f8eaSYOSHIFUJI Hideaki 83641a1f8eaSYOSHIFUJI Hideaki break; 83741a1f8eaSYOSHIFUJI Hideaki } 83813b52cd4SBrian Haley 83913b52cd4SBrian Haley case IPV6_DONTFRAG: 84013b52cd4SBrian Haley { 84113b52cd4SBrian Haley int df; 84213b52cd4SBrian Haley 84313b52cd4SBrian Haley err = -EINVAL; 84413b52cd4SBrian Haley if (cmsg->cmsg_len != CMSG_LEN(sizeof(int))) { 84513b52cd4SBrian Haley goto exit_f; 84613b52cd4SBrian Haley } 84713b52cd4SBrian Haley 84813b52cd4SBrian Haley df = *(int *)CMSG_DATA(cmsg); 84913b52cd4SBrian Haley if (df < 0 || df > 1) 85013b52cd4SBrian Haley goto exit_f; 85113b52cd4SBrian Haley 85213b52cd4SBrian Haley err = 0; 85313b52cd4SBrian Haley *dontfrag = df; 85413b52cd4SBrian Haley 85513b52cd4SBrian Haley break; 85613b52cd4SBrian Haley } 8571da177e4SLinus Torvalds default: 85864ce2073SPatrick McHardy LIMIT_NETDEBUG(KERN_DEBUG "invalid cmsg type: %d\n", 85964ce2073SPatrick McHardy cmsg->cmsg_type); 8601da177e4SLinus Torvalds err = -EINVAL; 8614a36702eSMiao Xie goto exit_f; 8623ff50b79SStephen Hemminger } 8631da177e4SLinus Torvalds } 8641da177e4SLinus Torvalds 8651da177e4SLinus Torvalds exit_f: 8661da177e4SLinus Torvalds return err; 8671da177e4SLinus Torvalds } 868