1 /* 2 * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project. 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 3. Neither the name of the project nor the names of its contributors 14 * may be used to endorse or promote products derived from this software 15 * without specific prior written permission. 16 * 17 * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND 18 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 20 * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE 21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 23 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 24 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 25 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 26 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 27 * SUCH DAMAGE. 28 * 29 * $FreeBSD$ 30 */ 31 32 #include <sys/param.h> 33 #include <sys/mbuf.h> 34 #include <sys/socket.h> 35 36 #include <net/if.h> 37 38 #include <netinet/in.h> 39 #include <netinet6/in6.h> 40 #include <netinet6/in6_var.h> 41 #include <netinet6/ip6.h> 42 #include <netinet6/ip6_var.h> 43 44 #include <netinet/icmp6.h> 45 46 static int ip6_rthdr0 __P((struct mbuf *, struct ip6_hdr *, struct ip6_rthdr0 *)); 47 48 int 49 route6_input(mp, offp, proto) 50 struct mbuf **mp; 51 int *offp, proto; /* proto is unused */ 52 { 53 register struct ip6_hdr *ip6; 54 register struct mbuf *m = *mp; 55 register struct ip6_rthdr *rh; 56 int off = *offp, rhlen; 57 58 IP6_EXTHDR_CHECK(m, off, sizeof(*rh), IPPROTO_DONE); 59 ip6 = mtod(m, struct ip6_hdr *); 60 rh = (struct ip6_rthdr *)((caddr_t)ip6 + off); 61 62 switch(rh->ip6r_type) { 63 case IPV6_RTHDR_TYPE_0: 64 rhlen = (rh->ip6r_len + 1) << 3; 65 IP6_EXTHDR_CHECK(m, off, rhlen, IPPROTO_DONE); 66 if (ip6_rthdr0(m, ip6, (struct ip6_rthdr0 *)rh)) 67 return(IPPROTO_DONE); 68 break; 69 default: 70 /* unknown routing type */ 71 if (rh->ip6r_segleft == 0) { 72 rhlen = (rh->ip6r_len + 1) << 3; 73 break; /* Final dst. Just ignore the header. */ 74 } 75 ip6stat.ip6s_badoptions++; 76 icmp6_error(m, ICMP6_PARAM_PROB, ICMP6_PARAMPROB_HEADER, 77 (caddr_t)&rh->ip6r_type - (caddr_t)ip6); 78 return(IPPROTO_DONE); 79 } 80 81 *offp += rhlen; 82 return(rh->ip6r_nxt); 83 } 84 85 /* 86 * Type0 routing header processing 87 */ 88 static int 89 ip6_rthdr0(m, ip6, rh0) 90 struct mbuf *m; 91 struct ip6_hdr *ip6; 92 struct ip6_rthdr0 *rh0; 93 { 94 int addrs, index; 95 struct in6_addr *nextaddr, tmpaddr; 96 97 if (rh0->ip6r0_segleft == 0) 98 return(0); 99 100 if (rh0->ip6r0_len % 2 101 #ifdef COMPAT_RFC1883 102 || rh0->ip6r0_len > 46 103 #endif 104 ) { 105 /* 106 * Type 0 routing header can't contain more than 23 addresses. 107 * RFC 2462: this limitation was removed since stict/loose 108 * bitmap field was deleted. 109 */ 110 ip6stat.ip6s_badoptions++; 111 icmp6_error(m, ICMP6_PARAM_PROB, ICMP6_PARAMPROB_HEADER, 112 (caddr_t)&rh0->ip6r0_len - (caddr_t)ip6); 113 return(-1); 114 } 115 116 if ((addrs = rh0->ip6r0_len / 2) < rh0->ip6r0_segleft) { 117 ip6stat.ip6s_badoptions++; 118 icmp6_error(m, ICMP6_PARAM_PROB, ICMP6_PARAMPROB_HEADER, 119 (caddr_t)&rh0->ip6r0_segleft - (caddr_t)ip6); 120 return(-1); 121 } 122 123 index = addrs - rh0->ip6r0_segleft; 124 rh0->ip6r0_segleft--; 125 nextaddr = rh0->ip6r0_addr + index; 126 127 if (IN6_IS_ADDR_MULTICAST(nextaddr) || 128 IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst)) { 129 ip6stat.ip6s_badoptions++; 130 m_freem(m); 131 return(-1); 132 } 133 134 /* 135 * Swap the IPv6 destination address and nextaddr. Forward the packet. 136 */ 137 tmpaddr = *nextaddr; 138 *nextaddr = ip6->ip6_dst; 139 if (IN6_IS_ADDR_LINKLOCAL(nextaddr)) 140 nextaddr->s6_addr16[1] = 0; 141 ip6->ip6_dst = tmpaddr; 142 if (IN6_IS_ADDR_LINKLOCAL(&ip6->ip6_dst)) 143 ip6->ip6_dst.s6_addr16[1] = htons(m->m_pkthdr.rcvif->if_index); 144 145 #ifdef COMPAT_RFC1883 146 if (rh0->ip6r0_slmap[index / 8] & (1 << (7 - (index % 8)))) 147 ip6_forward(m, IPV6_SRCRT_NEIGHBOR); 148 else 149 ip6_forward(m, IPV6_SRCRT_NOTNEIGHBOR); 150 #else 151 ip6_forward(m, 1); 152 #endif 153 154 return(-1); /* m would be freed in ip6_forward() */ 155 } 156