1686cdd19SJun-ichiro itojun Hagino /* $FreeBSD$ */ 233841545SHajimu UMEMOTO /* $KAME: if_stf.c,v 1.60 2001/05/03 14:51:47 itojun Exp $ */ 3686cdd19SJun-ichiro itojun Hagino 4686cdd19SJun-ichiro itojun Hagino /* 5686cdd19SJun-ichiro itojun Hagino * Copyright (C) 2000 WIDE Project. 6686cdd19SJun-ichiro itojun Hagino * All rights reserved. 7686cdd19SJun-ichiro itojun Hagino * 8686cdd19SJun-ichiro itojun Hagino * Redistribution and use in source and binary forms, with or without 9686cdd19SJun-ichiro itojun Hagino * modification, are permitted provided that the following conditions 10686cdd19SJun-ichiro itojun Hagino * are met: 11686cdd19SJun-ichiro itojun Hagino * 1. Redistributions of source code must retain the above copyright 12686cdd19SJun-ichiro itojun Hagino * notice, this list of conditions and the following disclaimer. 13686cdd19SJun-ichiro itojun Hagino * 2. Redistributions in binary form must reproduce the above copyright 14686cdd19SJun-ichiro itojun Hagino * notice, this list of conditions and the following disclaimer in the 15686cdd19SJun-ichiro itojun Hagino * documentation and/or other materials provided with the distribution. 16686cdd19SJun-ichiro itojun Hagino * 3. Neither the name of the project nor the names of its contributors 17686cdd19SJun-ichiro itojun Hagino * may be used to endorse or promote products derived from this software 18686cdd19SJun-ichiro itojun Hagino * without specific prior written permission. 19686cdd19SJun-ichiro itojun Hagino * 20686cdd19SJun-ichiro itojun Hagino * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND 21686cdd19SJun-ichiro itojun Hagino * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 22686cdd19SJun-ichiro itojun Hagino * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 23686cdd19SJun-ichiro itojun Hagino * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE 24686cdd19SJun-ichiro itojun Hagino * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 25686cdd19SJun-ichiro itojun Hagino * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 26686cdd19SJun-ichiro itojun Hagino * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 27686cdd19SJun-ichiro itojun Hagino * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 28686cdd19SJun-ichiro itojun Hagino * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 29686cdd19SJun-ichiro itojun Hagino * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 30686cdd19SJun-ichiro itojun Hagino * SUCH DAMAGE. 31686cdd19SJun-ichiro itojun Hagino */ 32686cdd19SJun-ichiro itojun Hagino 33686cdd19SJun-ichiro itojun Hagino /* 3433841545SHajimu UMEMOTO * 6to4 interface, based on RFC3056. 35686cdd19SJun-ichiro itojun Hagino * 36686cdd19SJun-ichiro itojun Hagino * 6to4 interface is NOT capable of link-layer (I mean, IPv4) multicasting. 37686cdd19SJun-ichiro itojun Hagino * There is no address mapping defined from IPv6 multicast address to IPv4 38686cdd19SJun-ichiro itojun Hagino * address. Therefore, we do not have IFF_MULTICAST on the interface. 39686cdd19SJun-ichiro itojun Hagino * 40686cdd19SJun-ichiro itojun Hagino * Due to the lack of address mapping for link-local addresses, we cannot 41686cdd19SJun-ichiro itojun Hagino * throw packets toward link-local addresses (fe80::x). Also, we cannot throw 42686cdd19SJun-ichiro itojun Hagino * packets to link-local multicast addresses (ff02::x). 43686cdd19SJun-ichiro itojun Hagino * 44686cdd19SJun-ichiro itojun Hagino * Here are interesting symptoms due to the lack of link-local address: 45686cdd19SJun-ichiro itojun Hagino * 46686cdd19SJun-ichiro itojun Hagino * Unicast routing exchange: 47686cdd19SJun-ichiro itojun Hagino * - RIPng: Impossible. Uses link-local multicast packet toward ff02::9, 48686cdd19SJun-ichiro itojun Hagino * and link-local addresses as nexthop. 49686cdd19SJun-ichiro itojun Hagino * - OSPFv6: Impossible. OSPFv6 assumes that there's link-local address 50686cdd19SJun-ichiro itojun Hagino * assigned to the link, and makes use of them. Also, HELLO packets use 51686cdd19SJun-ichiro itojun Hagino * link-local multicast addresses (ff02::5 and ff02::6). 52686cdd19SJun-ichiro itojun Hagino * - BGP4+: Maybe. You can only use global address as nexthop, and global 53686cdd19SJun-ichiro itojun Hagino * address as TCP endpoint address. 54686cdd19SJun-ichiro itojun Hagino * 55686cdd19SJun-ichiro itojun Hagino * Multicast routing protocols: 56686cdd19SJun-ichiro itojun Hagino * - PIM: Hello packet cannot be used to discover adjacent PIM routers. 57686cdd19SJun-ichiro itojun Hagino * Adjacent PIM routers must be configured manually (is it really spec-wise 58686cdd19SJun-ichiro itojun Hagino * correct thing to do?). 59686cdd19SJun-ichiro itojun Hagino * 60686cdd19SJun-ichiro itojun Hagino * ICMPv6: 61686cdd19SJun-ichiro itojun Hagino * - Redirects cannot be used due to the lack of link-local address. 62686cdd19SJun-ichiro itojun Hagino * 6333841545SHajimu UMEMOTO * stf interface does not have, and will not need, a link-local address. 6433841545SHajimu UMEMOTO * It seems to have no real benefit and does not help the above symptoms much. 6533841545SHajimu UMEMOTO * Even if we assign link-locals to interface, we cannot really 6633841545SHajimu UMEMOTO * use link-local unicast/multicast on top of 6to4 cloud (since there's no 6733841545SHajimu UMEMOTO * encapsulation defined for link-local address), and the above analysis does 6833841545SHajimu UMEMOTO * not change. RFC3056 does not mandate the assignment of link-local address 6933841545SHajimu UMEMOTO * either. 70686cdd19SJun-ichiro itojun Hagino * 71686cdd19SJun-ichiro itojun Hagino * 6to4 interface has security issues. Refer to 72686cdd19SJun-ichiro itojun Hagino * http://playground.iijlab.net/i-d/draft-itojun-ipv6-transition-abuse-00.txt 73686cdd19SJun-ichiro itojun Hagino * for details. The code tries to filter out some of malicious packets. 74686cdd19SJun-ichiro itojun Hagino * Note that there is no way to be 100% secure. 75686cdd19SJun-ichiro itojun Hagino */ 76686cdd19SJun-ichiro itojun Hagino 77686cdd19SJun-ichiro itojun Hagino #include "opt_inet.h" 78686cdd19SJun-ichiro itojun Hagino #include "opt_inet6.h" 79686cdd19SJun-ichiro itojun Hagino 80686cdd19SJun-ichiro itojun Hagino #include <sys/param.h> 81686cdd19SJun-ichiro itojun Hagino #include <sys/systm.h> 82686cdd19SJun-ichiro itojun Hagino #include <sys/socket.h> 83686cdd19SJun-ichiro itojun Hagino #include <sys/sockio.h> 84686cdd19SJun-ichiro itojun Hagino #include <sys/mbuf.h> 85686cdd19SJun-ichiro itojun Hagino #include <sys/errno.h> 86686cdd19SJun-ichiro itojun Hagino #include <sys/protosw.h> 87686cdd19SJun-ichiro itojun Hagino #include <sys/kernel.h> 88686cdd19SJun-ichiro itojun Hagino #include <machine/cpu.h> 89686cdd19SJun-ichiro itojun Hagino 90686cdd19SJun-ichiro itojun Hagino #include <sys/malloc.h> 91686cdd19SJun-ichiro itojun Hagino 92686cdd19SJun-ichiro itojun Hagino #include <net/if.h> 93686cdd19SJun-ichiro itojun Hagino #include <net/route.h> 94686cdd19SJun-ichiro itojun Hagino #include <net/netisr.h> 95686cdd19SJun-ichiro itojun Hagino #include <net/if_types.h> 96686cdd19SJun-ichiro itojun Hagino #include <net/if_stf.h> 97686cdd19SJun-ichiro itojun Hagino 98686cdd19SJun-ichiro itojun Hagino #include <netinet/in.h> 99686cdd19SJun-ichiro itojun Hagino #include <netinet/in_systm.h> 100686cdd19SJun-ichiro itojun Hagino #include <netinet/ip.h> 101686cdd19SJun-ichiro itojun Hagino #include <netinet/ip_var.h> 102686cdd19SJun-ichiro itojun Hagino #include <netinet/in_var.h> 103686cdd19SJun-ichiro itojun Hagino 104686cdd19SJun-ichiro itojun Hagino #include <netinet/ip6.h> 105686cdd19SJun-ichiro itojun Hagino #include <netinet6/ip6_var.h> 106686cdd19SJun-ichiro itojun Hagino #include <netinet6/in6_gif.h> 107686cdd19SJun-ichiro itojun Hagino #include <netinet6/in6_var.h> 108686cdd19SJun-ichiro itojun Hagino #include <netinet/ip_ecn.h> 109686cdd19SJun-ichiro itojun Hagino 110686cdd19SJun-ichiro itojun Hagino #include <netinet/ip_encap.h> 111686cdd19SJun-ichiro itojun Hagino 112686cdd19SJun-ichiro itojun Hagino #include <machine/stdarg.h> 113686cdd19SJun-ichiro itojun Hagino 114686cdd19SJun-ichiro itojun Hagino #include <net/net_osdep.h> 115686cdd19SJun-ichiro itojun Hagino 116686cdd19SJun-ichiro itojun Hagino #include "bpf.h" 117686cdd19SJun-ichiro itojun Hagino #define NBPFILTER NBPF 118686cdd19SJun-ichiro itojun Hagino #include "stf.h" 119686cdd19SJun-ichiro itojun Hagino #include "gif.h" /*XXX*/ 120686cdd19SJun-ichiro itojun Hagino 121686cdd19SJun-ichiro itojun Hagino #if NBPFILTER > 0 122686cdd19SJun-ichiro itojun Hagino #include <net/bpf.h> 123686cdd19SJun-ichiro itojun Hagino #endif 124686cdd19SJun-ichiro itojun Hagino 125686cdd19SJun-ichiro itojun Hagino #if NGIF > 0 126686cdd19SJun-ichiro itojun Hagino #include <net/if_gif.h> 127686cdd19SJun-ichiro itojun Hagino #endif 128686cdd19SJun-ichiro itojun Hagino 129686cdd19SJun-ichiro itojun Hagino #if NSTF > 0 130686cdd19SJun-ichiro itojun Hagino #if NSTF != 1 131686cdd19SJun-ichiro itojun Hagino # error only single stf interface allowed 132686cdd19SJun-ichiro itojun Hagino #endif 133686cdd19SJun-ichiro itojun Hagino 134686cdd19SJun-ichiro itojun Hagino #define IN6_IS_ADDR_6TO4(x) (ntohs((x)->s6_addr16[0]) == 0x2002) 135686cdd19SJun-ichiro itojun Hagino #define GET_V4(x) ((struct in_addr *)(&(x)->s6_addr16[1])) 136686cdd19SJun-ichiro itojun Hagino 137686cdd19SJun-ichiro itojun Hagino struct stf_softc { 138686cdd19SJun-ichiro itojun Hagino struct ifnet sc_if; /* common area */ 139686cdd19SJun-ichiro itojun Hagino union { 140686cdd19SJun-ichiro itojun Hagino struct route __sc_ro4; 141686cdd19SJun-ichiro itojun Hagino struct route_in6 __sc_ro6; /* just for safety */ 142686cdd19SJun-ichiro itojun Hagino } __sc_ro46; 143686cdd19SJun-ichiro itojun Hagino #define sc_ro __sc_ro46.__sc_ro4 144686cdd19SJun-ichiro itojun Hagino const struct encaptab *encap_cookie; 145686cdd19SJun-ichiro itojun Hagino }; 146686cdd19SJun-ichiro itojun Hagino 147686cdd19SJun-ichiro itojun Hagino static struct stf_softc *stf; 148686cdd19SJun-ichiro itojun Hagino static int nstf; 149686cdd19SJun-ichiro itojun Hagino 150686cdd19SJun-ichiro itojun Hagino #if NGIF > 0 151686cdd19SJun-ichiro itojun Hagino extern int ip_gif_ttl; /*XXX*/ 152686cdd19SJun-ichiro itojun Hagino #else 153686cdd19SJun-ichiro itojun Hagino static int ip_gif_ttl = 40; /*XXX*/ 154686cdd19SJun-ichiro itojun Hagino #endif 155686cdd19SJun-ichiro itojun Hagino 156686cdd19SJun-ichiro itojun Hagino extern struct protosw in_stf_protosw; 157686cdd19SJun-ichiro itojun Hagino 158686cdd19SJun-ichiro itojun Hagino void stfattach __P((void *)); 159686cdd19SJun-ichiro itojun Hagino static int stf_encapcheck __P((const struct mbuf *, int, int, void *)); 160686cdd19SJun-ichiro itojun Hagino static struct in6_ifaddr *stf_getsrcifa6 __P((struct ifnet *)); 161686cdd19SJun-ichiro itojun Hagino static int stf_output __P((struct ifnet *, struct mbuf *, struct sockaddr *, 162686cdd19SJun-ichiro itojun Hagino struct rtentry *)); 16333841545SHajimu UMEMOTO static int stf_checkaddr4 __P((struct stf_softc *, struct in_addr *, 16433841545SHajimu UMEMOTO struct ifnet *)); 16533841545SHajimu UMEMOTO static int stf_checkaddr6 __P((struct stf_softc *, struct in6_addr *, 16633841545SHajimu UMEMOTO struct ifnet *)); 167686cdd19SJun-ichiro itojun Hagino static void stf_rtrequest __P((int, struct rtentry *, struct sockaddr *)); 168686cdd19SJun-ichiro itojun Hagino static int stf_ioctl __P((struct ifnet *, u_long, caddr_t)); 169686cdd19SJun-ichiro itojun Hagino 170686cdd19SJun-ichiro itojun Hagino void 171686cdd19SJun-ichiro itojun Hagino stfattach(dummy) 172686cdd19SJun-ichiro itojun Hagino void *dummy; 173686cdd19SJun-ichiro itojun Hagino { 174686cdd19SJun-ichiro itojun Hagino struct stf_softc *sc; 175686cdd19SJun-ichiro itojun Hagino int i; 176686cdd19SJun-ichiro itojun Hagino const struct encaptab *p; 177686cdd19SJun-ichiro itojun Hagino 178686cdd19SJun-ichiro itojun Hagino nstf = NSTF; 1792a0c503eSBosko Milekic stf = malloc(nstf * sizeof(struct stf_softc), M_DEVBUF, M_WAITOK); 180686cdd19SJun-ichiro itojun Hagino bzero(stf, nstf * sizeof(struct stf_softc)); 181686cdd19SJun-ichiro itojun Hagino sc = stf; 182686cdd19SJun-ichiro itojun Hagino 183686cdd19SJun-ichiro itojun Hagino /* XXX just in case... */ 184686cdd19SJun-ichiro itojun Hagino for (i = 0; i < nstf; i++) { 185686cdd19SJun-ichiro itojun Hagino sc = &stf[i]; 186686cdd19SJun-ichiro itojun Hagino bzero(sc, sizeof(*sc)); 187686cdd19SJun-ichiro itojun Hagino sc->sc_if.if_name = "stf"; 188686cdd19SJun-ichiro itojun Hagino sc->sc_if.if_unit = i; 189686cdd19SJun-ichiro itojun Hagino 190686cdd19SJun-ichiro itojun Hagino p = encap_attach_func(AF_INET, IPPROTO_IPV6, stf_encapcheck, 191686cdd19SJun-ichiro itojun Hagino &in_stf_protosw, sc); 192686cdd19SJun-ichiro itojun Hagino if (p == NULL) { 193686cdd19SJun-ichiro itojun Hagino printf("%s: attach failed\n", if_name(&sc->sc_if)); 194686cdd19SJun-ichiro itojun Hagino continue; 195686cdd19SJun-ichiro itojun Hagino } 196686cdd19SJun-ichiro itojun Hagino sc->encap_cookie = p; 197686cdd19SJun-ichiro itojun Hagino 198686cdd19SJun-ichiro itojun Hagino sc->sc_if.if_mtu = IPV6_MMTU; 199686cdd19SJun-ichiro itojun Hagino sc->sc_if.if_flags = 0; 200686cdd19SJun-ichiro itojun Hagino sc->sc_if.if_ioctl = stf_ioctl; 201686cdd19SJun-ichiro itojun Hagino sc->sc_if.if_output = stf_output; 202686cdd19SJun-ichiro itojun Hagino sc->sc_if.if_type = IFT_STF; 20333841545SHajimu UMEMOTO #if 0 20433841545SHajimu UMEMOTO /* turn off ingress filter */ 20533841545SHajimu UMEMOTO sc->sc_if.if_flags |= IFF_LINK2; 20633841545SHajimu UMEMOTO #endif 207686cdd19SJun-ichiro itojun Hagino sc->sc_if.if_snd.ifq_maxlen = IFQ_MAXLEN; 208686cdd19SJun-ichiro itojun Hagino if_attach(&sc->sc_if); 209686cdd19SJun-ichiro itojun Hagino #if NBPFILTER > 0 210686cdd19SJun-ichiro itojun Hagino #ifdef HAVE_OLD_BPF 211686cdd19SJun-ichiro itojun Hagino bpfattach(&sc->sc_if, DLT_NULL, sizeof(u_int)); 212686cdd19SJun-ichiro itojun Hagino #else 213686cdd19SJun-ichiro itojun Hagino bpfattach(&sc->sc_if.if_bpf, &sc->sc_if, DLT_NULL, sizeof(u_int)); 214686cdd19SJun-ichiro itojun Hagino #endif 215686cdd19SJun-ichiro itojun Hagino #endif 216686cdd19SJun-ichiro itojun Hagino } 217686cdd19SJun-ichiro itojun Hagino } 218686cdd19SJun-ichiro itojun Hagino 219686cdd19SJun-ichiro itojun Hagino PSEUDO_SET(stfattach, if_stf); 220686cdd19SJun-ichiro itojun Hagino 221686cdd19SJun-ichiro itojun Hagino static int 222686cdd19SJun-ichiro itojun Hagino stf_encapcheck(m, off, proto, arg) 223686cdd19SJun-ichiro itojun Hagino const struct mbuf *m; 224686cdd19SJun-ichiro itojun Hagino int off; 225686cdd19SJun-ichiro itojun Hagino int proto; 226686cdd19SJun-ichiro itojun Hagino void *arg; 227686cdd19SJun-ichiro itojun Hagino { 228686cdd19SJun-ichiro itojun Hagino struct ip ip; 229686cdd19SJun-ichiro itojun Hagino struct in6_ifaddr *ia6; 230686cdd19SJun-ichiro itojun Hagino struct stf_softc *sc; 231686cdd19SJun-ichiro itojun Hagino struct in_addr a, b; 232686cdd19SJun-ichiro itojun Hagino 233686cdd19SJun-ichiro itojun Hagino sc = (struct stf_softc *)arg; 234686cdd19SJun-ichiro itojun Hagino if (sc == NULL) 235686cdd19SJun-ichiro itojun Hagino return 0; 236686cdd19SJun-ichiro itojun Hagino 237686cdd19SJun-ichiro itojun Hagino if ((sc->sc_if.if_flags & IFF_UP) == 0) 238686cdd19SJun-ichiro itojun Hagino return 0; 239686cdd19SJun-ichiro itojun Hagino 24033841545SHajimu UMEMOTO /* IFF_LINK0 means "no decapsulation" */ 24133841545SHajimu UMEMOTO if ((sc->sc_if.if_flags & IFF_LINK0) != 0) 24233841545SHajimu UMEMOTO return 0; 24333841545SHajimu UMEMOTO 244686cdd19SJun-ichiro itojun Hagino if (proto != IPPROTO_IPV6) 245686cdd19SJun-ichiro itojun Hagino return 0; 246686cdd19SJun-ichiro itojun Hagino 247686cdd19SJun-ichiro itojun Hagino /* LINTED const cast */ 248686cdd19SJun-ichiro itojun Hagino m_copydata((struct mbuf *)m, 0, sizeof(ip), (caddr_t)&ip); 249686cdd19SJun-ichiro itojun Hagino 250686cdd19SJun-ichiro itojun Hagino if (ip.ip_v != 4) 251686cdd19SJun-ichiro itojun Hagino return 0; 252686cdd19SJun-ichiro itojun Hagino 253686cdd19SJun-ichiro itojun Hagino ia6 = stf_getsrcifa6(&sc->sc_if); 254686cdd19SJun-ichiro itojun Hagino if (ia6 == NULL) 255686cdd19SJun-ichiro itojun Hagino return 0; 256686cdd19SJun-ichiro itojun Hagino 257686cdd19SJun-ichiro itojun Hagino /* 258686cdd19SJun-ichiro itojun Hagino * check if IPv4 dst matches the IPv4 address derived from the 259686cdd19SJun-ichiro itojun Hagino * local 6to4 address. 260686cdd19SJun-ichiro itojun Hagino * success on: dst = 10.1.1.1, ia6->ia_addr = 2002:0a01:0101:... 261686cdd19SJun-ichiro itojun Hagino */ 262686cdd19SJun-ichiro itojun Hagino if (bcmp(GET_V4(&ia6->ia_addr.sin6_addr), &ip.ip_dst, 263686cdd19SJun-ichiro itojun Hagino sizeof(ip.ip_dst)) != 0) 264686cdd19SJun-ichiro itojun Hagino return 0; 265686cdd19SJun-ichiro itojun Hagino 266686cdd19SJun-ichiro itojun Hagino /* 267686cdd19SJun-ichiro itojun Hagino * check if IPv4 src matches the IPv4 address derived from the 268686cdd19SJun-ichiro itojun Hagino * local 6to4 address masked by prefixmask. 269686cdd19SJun-ichiro itojun Hagino * success on: src = 10.1.1.1, ia6->ia_addr = 2002:0a00:.../24 270686cdd19SJun-ichiro itojun Hagino * fail on: src = 10.1.1.1, ia6->ia_addr = 2002:0b00:.../24 271686cdd19SJun-ichiro itojun Hagino */ 272686cdd19SJun-ichiro itojun Hagino bzero(&a, sizeof(a)); 273686cdd19SJun-ichiro itojun Hagino a.s_addr = GET_V4(&ia6->ia_addr.sin6_addr)->s_addr; 274686cdd19SJun-ichiro itojun Hagino a.s_addr &= GET_V4(&ia6->ia_prefixmask.sin6_addr)->s_addr; 275686cdd19SJun-ichiro itojun Hagino b = ip.ip_src; 276686cdd19SJun-ichiro itojun Hagino b.s_addr &= GET_V4(&ia6->ia_prefixmask.sin6_addr)->s_addr; 277686cdd19SJun-ichiro itojun Hagino if (a.s_addr != b.s_addr) 278686cdd19SJun-ichiro itojun Hagino return 0; 279686cdd19SJun-ichiro itojun Hagino 280686cdd19SJun-ichiro itojun Hagino /* stf interface makes single side match only */ 281686cdd19SJun-ichiro itojun Hagino return 32; 282686cdd19SJun-ichiro itojun Hagino } 283686cdd19SJun-ichiro itojun Hagino 284686cdd19SJun-ichiro itojun Hagino static struct in6_ifaddr * 285686cdd19SJun-ichiro itojun Hagino stf_getsrcifa6(ifp) 286686cdd19SJun-ichiro itojun Hagino struct ifnet *ifp; 287686cdd19SJun-ichiro itojun Hagino { 288686cdd19SJun-ichiro itojun Hagino struct ifaddr *ia; 289686cdd19SJun-ichiro itojun Hagino struct in_ifaddr *ia4; 290686cdd19SJun-ichiro itojun Hagino struct sockaddr_in6 *sin6; 291686cdd19SJun-ichiro itojun Hagino struct in_addr in; 292686cdd19SJun-ichiro itojun Hagino 29322f29826SPoul-Henning Kamp for (ia = TAILQ_FIRST(&ifp->if_addrlist); 294686cdd19SJun-ichiro itojun Hagino ia; 29522f29826SPoul-Henning Kamp ia = TAILQ_NEXT(ia, ifa_list)) 296686cdd19SJun-ichiro itojun Hagino { 297686cdd19SJun-ichiro itojun Hagino if (ia->ifa_addr == NULL) 298686cdd19SJun-ichiro itojun Hagino continue; 299686cdd19SJun-ichiro itojun Hagino if (ia->ifa_addr->sa_family != AF_INET6) 300686cdd19SJun-ichiro itojun Hagino continue; 301686cdd19SJun-ichiro itojun Hagino sin6 = (struct sockaddr_in6 *)ia->ifa_addr; 302686cdd19SJun-ichiro itojun Hagino if (!IN6_IS_ADDR_6TO4(&sin6->sin6_addr)) 303686cdd19SJun-ichiro itojun Hagino continue; 304686cdd19SJun-ichiro itojun Hagino 305686cdd19SJun-ichiro itojun Hagino bcopy(GET_V4(&sin6->sin6_addr), &in, sizeof(in)); 306686cdd19SJun-ichiro itojun Hagino for (ia4 = TAILQ_FIRST(&in_ifaddrhead); 307686cdd19SJun-ichiro itojun Hagino ia4; 308686cdd19SJun-ichiro itojun Hagino ia4 = TAILQ_NEXT(ia4, ia_link)) 309686cdd19SJun-ichiro itojun Hagino { 310686cdd19SJun-ichiro itojun Hagino if (ia4->ia_addr.sin_addr.s_addr == in.s_addr) 311686cdd19SJun-ichiro itojun Hagino break; 312686cdd19SJun-ichiro itojun Hagino } 313686cdd19SJun-ichiro itojun Hagino if (ia4 == NULL) 314686cdd19SJun-ichiro itojun Hagino continue; 315686cdd19SJun-ichiro itojun Hagino 316686cdd19SJun-ichiro itojun Hagino return (struct in6_ifaddr *)ia; 317686cdd19SJun-ichiro itojun Hagino } 318686cdd19SJun-ichiro itojun Hagino 319686cdd19SJun-ichiro itojun Hagino return NULL; 320686cdd19SJun-ichiro itojun Hagino } 321686cdd19SJun-ichiro itojun Hagino 322686cdd19SJun-ichiro itojun Hagino static int 323686cdd19SJun-ichiro itojun Hagino stf_output(ifp, m, dst, rt) 324686cdd19SJun-ichiro itojun Hagino struct ifnet *ifp; 325686cdd19SJun-ichiro itojun Hagino struct mbuf *m; 326686cdd19SJun-ichiro itojun Hagino struct sockaddr *dst; 327686cdd19SJun-ichiro itojun Hagino struct rtentry *rt; 328686cdd19SJun-ichiro itojun Hagino { 329686cdd19SJun-ichiro itojun Hagino struct stf_softc *sc; 330686cdd19SJun-ichiro itojun Hagino struct sockaddr_in6 *dst6; 33133841545SHajimu UMEMOTO struct in_addr *in4; 332686cdd19SJun-ichiro itojun Hagino struct sockaddr_in *dst4; 333686cdd19SJun-ichiro itojun Hagino u_int8_t tos; 334686cdd19SJun-ichiro itojun Hagino struct ip *ip; 335686cdd19SJun-ichiro itojun Hagino struct ip6_hdr *ip6; 336686cdd19SJun-ichiro itojun Hagino struct in6_ifaddr *ia6; 337686cdd19SJun-ichiro itojun Hagino 338686cdd19SJun-ichiro itojun Hagino sc = (struct stf_softc*)ifp; 339686cdd19SJun-ichiro itojun Hagino dst6 = (struct sockaddr_in6 *)dst; 340686cdd19SJun-ichiro itojun Hagino 341686cdd19SJun-ichiro itojun Hagino /* just in case */ 342686cdd19SJun-ichiro itojun Hagino if ((ifp->if_flags & IFF_UP) == 0) { 343686cdd19SJun-ichiro itojun Hagino m_freem(m); 344686cdd19SJun-ichiro itojun Hagino return ENETDOWN; 345686cdd19SJun-ichiro itojun Hagino } 346686cdd19SJun-ichiro itojun Hagino 347686cdd19SJun-ichiro itojun Hagino /* 348686cdd19SJun-ichiro itojun Hagino * If we don't have an ip4 address that match my inner ip6 address, 349686cdd19SJun-ichiro itojun Hagino * we shouldn't generate output. Without this check, we'll end up 350686cdd19SJun-ichiro itojun Hagino * using wrong IPv4 source. 351686cdd19SJun-ichiro itojun Hagino */ 352686cdd19SJun-ichiro itojun Hagino ia6 = stf_getsrcifa6(ifp); 353686cdd19SJun-ichiro itojun Hagino if (ia6 == NULL) { 354686cdd19SJun-ichiro itojun Hagino m_freem(m); 355686cdd19SJun-ichiro itojun Hagino return ENETDOWN; 356686cdd19SJun-ichiro itojun Hagino } 357686cdd19SJun-ichiro itojun Hagino 358686cdd19SJun-ichiro itojun Hagino if (m->m_len < sizeof(*ip6)) { 359686cdd19SJun-ichiro itojun Hagino m = m_pullup(m, sizeof(*ip6)); 360686cdd19SJun-ichiro itojun Hagino if (!m) 361686cdd19SJun-ichiro itojun Hagino return ENOBUFS; 362686cdd19SJun-ichiro itojun Hagino } 363686cdd19SJun-ichiro itojun Hagino ip6 = mtod(m, struct ip6_hdr *); 364686cdd19SJun-ichiro itojun Hagino tos = (ntohl(ip6->ip6_flow) >> 20) & 0xff; 365686cdd19SJun-ichiro itojun Hagino 36633841545SHajimu UMEMOTO /* 36733841545SHajimu UMEMOTO * Pickup the right outer dst addr from the list of candidates. 36833841545SHajimu UMEMOTO * ip6_dst has priority as it may be able to give us shorter IPv4 hops. 36933841545SHajimu UMEMOTO */ 37033841545SHajimu UMEMOTO if (IN6_IS_ADDR_6TO4(&ip6->ip6_dst)) 37133841545SHajimu UMEMOTO in4 = GET_V4(&ip6->ip6_dst); 37233841545SHajimu UMEMOTO else if (IN6_IS_ADDR_6TO4(&dst6->sin6_addr)) 37333841545SHajimu UMEMOTO in4 = GET_V4(&dst6->sin6_addr); 37433841545SHajimu UMEMOTO else { 37533841545SHajimu UMEMOTO m_freem(m); 37633841545SHajimu UMEMOTO return ENETUNREACH; 37733841545SHajimu UMEMOTO } 37833841545SHajimu UMEMOTO 379686cdd19SJun-ichiro itojun Hagino M_PREPEND(m, sizeof(struct ip), M_DONTWAIT); 380686cdd19SJun-ichiro itojun Hagino if (m && m->m_len < sizeof(struct ip)) 381686cdd19SJun-ichiro itojun Hagino m = m_pullup(m, sizeof(struct ip)); 382686cdd19SJun-ichiro itojun Hagino if (m == NULL) 383686cdd19SJun-ichiro itojun Hagino return ENOBUFS; 384686cdd19SJun-ichiro itojun Hagino ip = mtod(m, struct ip *); 385686cdd19SJun-ichiro itojun Hagino 386686cdd19SJun-ichiro itojun Hagino bzero(ip, sizeof(*ip)); 387686cdd19SJun-ichiro itojun Hagino 388686cdd19SJun-ichiro itojun Hagino bcopy(GET_V4(&((struct sockaddr_in6 *)&ia6->ia_addr)->sin6_addr), 389686cdd19SJun-ichiro itojun Hagino &ip->ip_src, sizeof(ip->ip_src)); 39033841545SHajimu UMEMOTO bcopy(in4, &ip->ip_dst, sizeof(ip->ip_dst)); 391686cdd19SJun-ichiro itojun Hagino ip->ip_p = IPPROTO_IPV6; 392686cdd19SJun-ichiro itojun Hagino ip->ip_ttl = ip_gif_ttl; /*XXX*/ 393686cdd19SJun-ichiro itojun Hagino ip->ip_len = m->m_pkthdr.len; /*host order*/ 394686cdd19SJun-ichiro itojun Hagino if (ifp->if_flags & IFF_LINK1) 395686cdd19SJun-ichiro itojun Hagino ip_ecn_ingress(ECN_ALLOWED, &ip->ip_tos, &tos); 39633841545SHajimu UMEMOTO else 39733841545SHajimu UMEMOTO ip_ecn_ingress(ECN_NOCARE, &ip->ip_tos, &tos); 398686cdd19SJun-ichiro itojun Hagino 399686cdd19SJun-ichiro itojun Hagino dst4 = (struct sockaddr_in *)&sc->sc_ro.ro_dst; 400686cdd19SJun-ichiro itojun Hagino if (dst4->sin_family != AF_INET || 401686cdd19SJun-ichiro itojun Hagino bcmp(&dst4->sin_addr, &ip->ip_dst, sizeof(ip->ip_dst)) != 0) { 402686cdd19SJun-ichiro itojun Hagino /* cache route doesn't match */ 403686cdd19SJun-ichiro itojun Hagino dst4->sin_family = AF_INET; 404686cdd19SJun-ichiro itojun Hagino dst4->sin_len = sizeof(struct sockaddr_in); 405686cdd19SJun-ichiro itojun Hagino bcopy(&ip->ip_dst, &dst4->sin_addr, sizeof(dst4->sin_addr)); 406686cdd19SJun-ichiro itojun Hagino if (sc->sc_ro.ro_rt) { 407686cdd19SJun-ichiro itojun Hagino RTFREE(sc->sc_ro.ro_rt); 408686cdd19SJun-ichiro itojun Hagino sc->sc_ro.ro_rt = NULL; 409686cdd19SJun-ichiro itojun Hagino } 410686cdd19SJun-ichiro itojun Hagino } 411686cdd19SJun-ichiro itojun Hagino 412686cdd19SJun-ichiro itojun Hagino if (sc->sc_ro.ro_rt == NULL) { 413686cdd19SJun-ichiro itojun Hagino rtalloc(&sc->sc_ro); 414686cdd19SJun-ichiro itojun Hagino if (sc->sc_ro.ro_rt == NULL) { 415686cdd19SJun-ichiro itojun Hagino m_freem(m); 416686cdd19SJun-ichiro itojun Hagino return ENETUNREACH; 417686cdd19SJun-ichiro itojun Hagino } 418686cdd19SJun-ichiro itojun Hagino } 419686cdd19SJun-ichiro itojun Hagino 420686cdd19SJun-ichiro itojun Hagino return ip_output(m, NULL, &sc->sc_ro, 0, NULL); 421686cdd19SJun-ichiro itojun Hagino } 422686cdd19SJun-ichiro itojun Hagino 423686cdd19SJun-ichiro itojun Hagino static int 42433841545SHajimu UMEMOTO stf_checkaddr4(sc, in, inifp) 42533841545SHajimu UMEMOTO struct stf_softc *sc; 426686cdd19SJun-ichiro itojun Hagino struct in_addr *in; 42733841545SHajimu UMEMOTO struct ifnet *inifp; /* incoming interface */ 428686cdd19SJun-ichiro itojun Hagino { 429686cdd19SJun-ichiro itojun Hagino struct in_ifaddr *ia4; 430686cdd19SJun-ichiro itojun Hagino 431686cdd19SJun-ichiro itojun Hagino /* 432686cdd19SJun-ichiro itojun Hagino * reject packets with the following address: 433686cdd19SJun-ichiro itojun Hagino * 224.0.0.0/4 0.0.0.0/8 127.0.0.0/8 255.0.0.0/8 434686cdd19SJun-ichiro itojun Hagino */ 435d1d1144bSJun-ichiro itojun Hagino if (IN_MULTICAST(ntohl(in->s_addr))) 436686cdd19SJun-ichiro itojun Hagino return -1; 437686cdd19SJun-ichiro itojun Hagino switch ((ntohl(in->s_addr) & 0xff000000) >> 24) { 438686cdd19SJun-ichiro itojun Hagino case 0: case 127: case 255: 439686cdd19SJun-ichiro itojun Hagino return -1; 440686cdd19SJun-ichiro itojun Hagino } 441686cdd19SJun-ichiro itojun Hagino 442686cdd19SJun-ichiro itojun Hagino /* 443686cdd19SJun-ichiro itojun Hagino * reject packets with broadcast 444686cdd19SJun-ichiro itojun Hagino */ 445686cdd19SJun-ichiro itojun Hagino for (ia4 = TAILQ_FIRST(&in_ifaddrhead); 446686cdd19SJun-ichiro itojun Hagino ia4; 447686cdd19SJun-ichiro itojun Hagino ia4 = TAILQ_NEXT(ia4, ia_link)) 448686cdd19SJun-ichiro itojun Hagino { 449686cdd19SJun-ichiro itojun Hagino if ((ia4->ia_ifa.ifa_ifp->if_flags & IFF_BROADCAST) == 0) 450686cdd19SJun-ichiro itojun Hagino continue; 451686cdd19SJun-ichiro itojun Hagino if (in->s_addr == ia4->ia_broadaddr.sin_addr.s_addr) 452686cdd19SJun-ichiro itojun Hagino return -1; 453686cdd19SJun-ichiro itojun Hagino } 454686cdd19SJun-ichiro itojun Hagino 455686cdd19SJun-ichiro itojun Hagino /* 456686cdd19SJun-ichiro itojun Hagino * perform ingress filter 457686cdd19SJun-ichiro itojun Hagino */ 45833841545SHajimu UMEMOTO if (sc && (sc->sc_if.if_flags & IFF_LINK2) == 0 && inifp) { 459686cdd19SJun-ichiro itojun Hagino struct sockaddr_in sin; 460686cdd19SJun-ichiro itojun Hagino struct rtentry *rt; 461686cdd19SJun-ichiro itojun Hagino 462686cdd19SJun-ichiro itojun Hagino bzero(&sin, sizeof(sin)); 463686cdd19SJun-ichiro itojun Hagino sin.sin_family = AF_INET; 464686cdd19SJun-ichiro itojun Hagino sin.sin_len = sizeof(struct sockaddr_in); 465686cdd19SJun-ichiro itojun Hagino sin.sin_addr = *in; 466686cdd19SJun-ichiro itojun Hagino rt = rtalloc1((struct sockaddr *)&sin, 0, 0UL); 46733841545SHajimu UMEMOTO if (!rt || rt->rt_ifp != inifp) { 46833841545SHajimu UMEMOTO #if 0 46933841545SHajimu UMEMOTO log(LOG_WARNING, "%s: packet from 0x%x dropped " 47033841545SHajimu UMEMOTO "due to ingress filter\n", if_name(&sc->sc_if), 47133841545SHajimu UMEMOTO (u_int32_t)ntohl(sin.sin_addr.s_addr)); 47233841545SHajimu UMEMOTO #endif 47333841545SHajimu UMEMOTO if (rt) 474686cdd19SJun-ichiro itojun Hagino rtfree(rt); 475686cdd19SJun-ichiro itojun Hagino return -1; 476686cdd19SJun-ichiro itojun Hagino } 477686cdd19SJun-ichiro itojun Hagino rtfree(rt); 478686cdd19SJun-ichiro itojun Hagino } 479686cdd19SJun-ichiro itojun Hagino 480686cdd19SJun-ichiro itojun Hagino return 0; 481686cdd19SJun-ichiro itojun Hagino } 482686cdd19SJun-ichiro itojun Hagino 483686cdd19SJun-ichiro itojun Hagino static int 48433841545SHajimu UMEMOTO stf_checkaddr6(sc, in6, inifp) 48533841545SHajimu UMEMOTO struct stf_softc *sc; 486686cdd19SJun-ichiro itojun Hagino struct in6_addr *in6; 48733841545SHajimu UMEMOTO struct ifnet *inifp; /* incoming interface */ 488686cdd19SJun-ichiro itojun Hagino { 489686cdd19SJun-ichiro itojun Hagino /* 490686cdd19SJun-ichiro itojun Hagino * check 6to4 addresses 491686cdd19SJun-ichiro itojun Hagino */ 492686cdd19SJun-ichiro itojun Hagino if (IN6_IS_ADDR_6TO4(in6)) 49333841545SHajimu UMEMOTO return stf_checkaddr4(sc, GET_V4(in6), inifp); 494686cdd19SJun-ichiro itojun Hagino 495686cdd19SJun-ichiro itojun Hagino /* 496686cdd19SJun-ichiro itojun Hagino * reject anything that look suspicious. the test is implemented 497686cdd19SJun-ichiro itojun Hagino * in ip6_input too, but we check here as well to 498686cdd19SJun-ichiro itojun Hagino * (1) reject bad packets earlier, and 499686cdd19SJun-ichiro itojun Hagino * (2) to be safe against future ip6_input change. 500686cdd19SJun-ichiro itojun Hagino */ 501686cdd19SJun-ichiro itojun Hagino if (IN6_IS_ADDR_V4COMPAT(in6) || IN6_IS_ADDR_V4MAPPED(in6)) 502686cdd19SJun-ichiro itojun Hagino return -1; 503686cdd19SJun-ichiro itojun Hagino 504686cdd19SJun-ichiro itojun Hagino return 0; 505686cdd19SJun-ichiro itojun Hagino } 506686cdd19SJun-ichiro itojun Hagino 507686cdd19SJun-ichiro itojun Hagino void 508686cdd19SJun-ichiro itojun Hagino #if __STDC__ 509686cdd19SJun-ichiro itojun Hagino in_stf_input(struct mbuf *m, ...) 510686cdd19SJun-ichiro itojun Hagino #else 511686cdd19SJun-ichiro itojun Hagino in_stf_input(m, va_alist) 51233841545SHajimu UMEMOTO struct mbuf *m; 513686cdd19SJun-ichiro itojun Hagino #endif 514686cdd19SJun-ichiro itojun Hagino { 515686cdd19SJun-ichiro itojun Hagino int off, proto; 516686cdd19SJun-ichiro itojun Hagino struct stf_softc *sc; 517686cdd19SJun-ichiro itojun Hagino struct ip *ip; 518686cdd19SJun-ichiro itojun Hagino struct ip6_hdr *ip6; 519686cdd19SJun-ichiro itojun Hagino u_int8_t otos, itos; 520df5e1987SJonathan Lemon int len, isr; 521686cdd19SJun-ichiro itojun Hagino struct ifqueue *ifq = NULL; 522686cdd19SJun-ichiro itojun Hagino struct ifnet *ifp; 523686cdd19SJun-ichiro itojun Hagino va_list ap; 524686cdd19SJun-ichiro itojun Hagino 525686cdd19SJun-ichiro itojun Hagino va_start(ap, m); 526686cdd19SJun-ichiro itojun Hagino off = va_arg(ap, int); 527686cdd19SJun-ichiro itojun Hagino proto = va_arg(ap, int); 528686cdd19SJun-ichiro itojun Hagino va_end(ap); 529686cdd19SJun-ichiro itojun Hagino 530686cdd19SJun-ichiro itojun Hagino if (proto != IPPROTO_IPV6) { 531686cdd19SJun-ichiro itojun Hagino m_freem(m); 532686cdd19SJun-ichiro itojun Hagino return; 533686cdd19SJun-ichiro itojun Hagino } 534686cdd19SJun-ichiro itojun Hagino 535686cdd19SJun-ichiro itojun Hagino ip = mtod(m, struct ip *); 536686cdd19SJun-ichiro itojun Hagino 537686cdd19SJun-ichiro itojun Hagino sc = (struct stf_softc *)encap_getarg(m); 538686cdd19SJun-ichiro itojun Hagino 539686cdd19SJun-ichiro itojun Hagino if (sc == NULL || (sc->sc_if.if_flags & IFF_UP) == 0) { 540686cdd19SJun-ichiro itojun Hagino m_freem(m); 541686cdd19SJun-ichiro itojun Hagino return; 542686cdd19SJun-ichiro itojun Hagino } 543686cdd19SJun-ichiro itojun Hagino 544686cdd19SJun-ichiro itojun Hagino ifp = &sc->sc_if; 545686cdd19SJun-ichiro itojun Hagino 546686cdd19SJun-ichiro itojun Hagino /* 547686cdd19SJun-ichiro itojun Hagino * perform sanity check against outer src/dst. 548686cdd19SJun-ichiro itojun Hagino * for source, perform ingress filter as well. 549686cdd19SJun-ichiro itojun Hagino */ 55033841545SHajimu UMEMOTO if (stf_checkaddr4(sc, &ip->ip_dst, NULL) < 0 || 55133841545SHajimu UMEMOTO stf_checkaddr4(sc, &ip->ip_src, m->m_pkthdr.rcvif) < 0) { 552686cdd19SJun-ichiro itojun Hagino m_freem(m); 553686cdd19SJun-ichiro itojun Hagino return; 554686cdd19SJun-ichiro itojun Hagino } 555686cdd19SJun-ichiro itojun Hagino 556686cdd19SJun-ichiro itojun Hagino otos = ip->ip_tos; 557686cdd19SJun-ichiro itojun Hagino m_adj(m, off); 558686cdd19SJun-ichiro itojun Hagino 559686cdd19SJun-ichiro itojun Hagino if (m->m_len < sizeof(*ip6)) { 560686cdd19SJun-ichiro itojun Hagino m = m_pullup(m, sizeof(*ip6)); 561686cdd19SJun-ichiro itojun Hagino if (!m) 562686cdd19SJun-ichiro itojun Hagino return; 563686cdd19SJun-ichiro itojun Hagino } 564686cdd19SJun-ichiro itojun Hagino ip6 = mtod(m, struct ip6_hdr *); 565686cdd19SJun-ichiro itojun Hagino 566686cdd19SJun-ichiro itojun Hagino /* 567686cdd19SJun-ichiro itojun Hagino * perform sanity check against inner src/dst. 568686cdd19SJun-ichiro itojun Hagino * for source, perform ingress filter as well. 569686cdd19SJun-ichiro itojun Hagino */ 57033841545SHajimu UMEMOTO if (stf_checkaddr6(sc, &ip6->ip6_dst, NULL) < 0 || 57133841545SHajimu UMEMOTO stf_checkaddr6(sc, &ip6->ip6_src, m->m_pkthdr.rcvif) < 0) { 572686cdd19SJun-ichiro itojun Hagino m_freem(m); 573686cdd19SJun-ichiro itojun Hagino return; 574686cdd19SJun-ichiro itojun Hagino } 575686cdd19SJun-ichiro itojun Hagino 576686cdd19SJun-ichiro itojun Hagino itos = (ntohl(ip6->ip6_flow) >> 20) & 0xff; 577686cdd19SJun-ichiro itojun Hagino if ((ifp->if_flags & IFF_LINK1) != 0) 578686cdd19SJun-ichiro itojun Hagino ip_ecn_egress(ECN_ALLOWED, &otos, &itos); 57933841545SHajimu UMEMOTO else 58033841545SHajimu UMEMOTO ip_ecn_egress(ECN_NOCARE, &otos, &itos); 581686cdd19SJun-ichiro itojun Hagino ip6->ip6_flow &= ~htonl(0xff << 20); 582686cdd19SJun-ichiro itojun Hagino ip6->ip6_flow |= htonl((u_int32_t)itos << 20); 583686cdd19SJun-ichiro itojun Hagino 584686cdd19SJun-ichiro itojun Hagino m->m_pkthdr.rcvif = ifp; 585686cdd19SJun-ichiro itojun Hagino 586686cdd19SJun-ichiro itojun Hagino #if NBPFILTER > 0 587686cdd19SJun-ichiro itojun Hagino if (ifp->if_bpf) { 588686cdd19SJun-ichiro itojun Hagino /* 589686cdd19SJun-ichiro itojun Hagino * We need to prepend the address family as 590686cdd19SJun-ichiro itojun Hagino * a four byte field. Cons up a dummy header 591686cdd19SJun-ichiro itojun Hagino * to pacify bpf. This is safe because bpf 592686cdd19SJun-ichiro itojun Hagino * will only read from the mbuf (i.e., it won't 593686cdd19SJun-ichiro itojun Hagino * try to free it or keep a pointer a to it). 594686cdd19SJun-ichiro itojun Hagino */ 595686cdd19SJun-ichiro itojun Hagino struct mbuf m0; 59633841545SHajimu UMEMOTO u_int32_t af = AF_INET6; 597686cdd19SJun-ichiro itojun Hagino 598686cdd19SJun-ichiro itojun Hagino m0.m_next = m; 599686cdd19SJun-ichiro itojun Hagino m0.m_len = 4; 600686cdd19SJun-ichiro itojun Hagino m0.m_data = (char *)⁡ 601686cdd19SJun-ichiro itojun Hagino 602686cdd19SJun-ichiro itojun Hagino #ifdef HAVE_OLD_BPF 603686cdd19SJun-ichiro itojun Hagino bpf_mtap(ifp, &m0); 604686cdd19SJun-ichiro itojun Hagino #else 605686cdd19SJun-ichiro itojun Hagino bpf_mtap(ifp->if_bpf, &m0); 606686cdd19SJun-ichiro itojun Hagino #endif 607686cdd19SJun-ichiro itojun Hagino } 608686cdd19SJun-ichiro itojun Hagino #endif /*NBPFILTER > 0*/ 609686cdd19SJun-ichiro itojun Hagino 610686cdd19SJun-ichiro itojun Hagino /* 611686cdd19SJun-ichiro itojun Hagino * Put the packet to the network layer input queue according to the 612686cdd19SJun-ichiro itojun Hagino * specified address family. 613686cdd19SJun-ichiro itojun Hagino * See net/if_gif.c for possible issues with packet processing 614686cdd19SJun-ichiro itojun Hagino * reorder due to extra queueing. 615686cdd19SJun-ichiro itojun Hagino */ 616686cdd19SJun-ichiro itojun Hagino ifq = &ip6intrq; 617686cdd19SJun-ichiro itojun Hagino isr = NETISR_IPV6; 618686cdd19SJun-ichiro itojun Hagino 619df5e1987SJonathan Lemon len = m->m_pkthdr.len; 620df5e1987SJonathan Lemon if (! IF_HANDOFF(ifq, m, NULL)) 621686cdd19SJun-ichiro itojun Hagino return; 622686cdd19SJun-ichiro itojun Hagino schednetisr(isr); 623686cdd19SJun-ichiro itojun Hagino ifp->if_ipackets++; 624df5e1987SJonathan Lemon ifp->if_ibytes += len; 625686cdd19SJun-ichiro itojun Hagino } 626686cdd19SJun-ichiro itojun Hagino 627686cdd19SJun-ichiro itojun Hagino /* ARGSUSED */ 628686cdd19SJun-ichiro itojun Hagino static void 629686cdd19SJun-ichiro itojun Hagino stf_rtrequest(cmd, rt, sa) 630686cdd19SJun-ichiro itojun Hagino int cmd; 631686cdd19SJun-ichiro itojun Hagino struct rtentry *rt; 632686cdd19SJun-ichiro itojun Hagino struct sockaddr *sa; 633686cdd19SJun-ichiro itojun Hagino { 634686cdd19SJun-ichiro itojun Hagino 635686cdd19SJun-ichiro itojun Hagino if (rt) 636686cdd19SJun-ichiro itojun Hagino rt->rt_rmx.rmx_mtu = IPV6_MMTU; 637686cdd19SJun-ichiro itojun Hagino } 638686cdd19SJun-ichiro itojun Hagino 639686cdd19SJun-ichiro itojun Hagino static int 640686cdd19SJun-ichiro itojun Hagino stf_ioctl(ifp, cmd, data) 641686cdd19SJun-ichiro itojun Hagino struct ifnet *ifp; 642686cdd19SJun-ichiro itojun Hagino u_long cmd; 643686cdd19SJun-ichiro itojun Hagino caddr_t data; 644686cdd19SJun-ichiro itojun Hagino { 645686cdd19SJun-ichiro itojun Hagino struct ifaddr *ifa; 646686cdd19SJun-ichiro itojun Hagino struct ifreq *ifr; 647686cdd19SJun-ichiro itojun Hagino struct sockaddr_in6 *sin6; 648686cdd19SJun-ichiro itojun Hagino int error; 649686cdd19SJun-ichiro itojun Hagino 650686cdd19SJun-ichiro itojun Hagino error = 0; 651686cdd19SJun-ichiro itojun Hagino switch (cmd) { 652686cdd19SJun-ichiro itojun Hagino case SIOCSIFADDR: 653686cdd19SJun-ichiro itojun Hagino ifa = (struct ifaddr *)data; 654686cdd19SJun-ichiro itojun Hagino if (ifa == NULL || ifa->ifa_addr->sa_family != AF_INET6) { 655686cdd19SJun-ichiro itojun Hagino error = EAFNOSUPPORT; 656686cdd19SJun-ichiro itojun Hagino break; 657686cdd19SJun-ichiro itojun Hagino } 658686cdd19SJun-ichiro itojun Hagino sin6 = (struct sockaddr_in6 *)ifa->ifa_addr; 659686cdd19SJun-ichiro itojun Hagino if (IN6_IS_ADDR_6TO4(&sin6->sin6_addr)) { 660686cdd19SJun-ichiro itojun Hagino ifa->ifa_rtrequest = stf_rtrequest; 661686cdd19SJun-ichiro itojun Hagino ifp->if_flags |= IFF_UP; 662686cdd19SJun-ichiro itojun Hagino } else 663686cdd19SJun-ichiro itojun Hagino error = EINVAL; 664686cdd19SJun-ichiro itojun Hagino break; 665686cdd19SJun-ichiro itojun Hagino 666686cdd19SJun-ichiro itojun Hagino case SIOCADDMULTI: 667686cdd19SJun-ichiro itojun Hagino case SIOCDELMULTI: 668686cdd19SJun-ichiro itojun Hagino ifr = (struct ifreq *)data; 669686cdd19SJun-ichiro itojun Hagino if (ifr && ifr->ifr_addr.sa_family == AF_INET6) 670686cdd19SJun-ichiro itojun Hagino ; 671686cdd19SJun-ichiro itojun Hagino else 672686cdd19SJun-ichiro itojun Hagino error = EAFNOSUPPORT; 673686cdd19SJun-ichiro itojun Hagino break; 674686cdd19SJun-ichiro itojun Hagino 675686cdd19SJun-ichiro itojun Hagino default: 676686cdd19SJun-ichiro itojun Hagino error = EINVAL; 677686cdd19SJun-ichiro itojun Hagino break; 678686cdd19SJun-ichiro itojun Hagino } 679686cdd19SJun-ichiro itojun Hagino 680686cdd19SJun-ichiro itojun Hagino return error; 681686cdd19SJun-ichiro itojun Hagino } 682686cdd19SJun-ichiro itojun Hagino 683686cdd19SJun-ichiro itojun Hagino #endif /* NSTF > 0 */ 684