if_tun.c revision 1.42.2.7
1 1.42.2.4 nathanw /* $NetBSD: if_tun.c,v 1.42.2.7 2002/10/18 02:45:13 nathanw Exp $ */ 2 1.14 cgd 3 1.1 cgd /* 4 1.8 deraadt * Copyright (c) 1988, Julian Onions <jpo (at) cs.nott.ac.uk> 5 1.8 deraadt * Nottingham University 1987. 6 1.1 cgd * 7 1.1 cgd * This source may be freely distributed, however I would be interested 8 1.1 cgd * in any changes that are made. 9 1.6 deraadt * 10 1.1 cgd * This driver takes packets off the IP i/f and hands them up to a 11 1.21 scottr * user process to have its wicked way with. This driver has its 12 1.1 cgd * roots in a similar driver written by Phil Cockcroft (formerly) at 13 1.27 mycroft * UCL. This driver is based much more on read/write/poll mode of 14 1.1 cgd * operation though. 15 1.1 cgd */ 16 1.1 cgd 17 1.42.2.3 nathanw #include <sys/cdefs.h> 18 1.42.2.3 nathanw __KERNEL_RCSID(0, "$NetBSD: if_tun.c,v 1.42.2.7 2002/10/18 02:45:13 nathanw Exp $"); 19 1.42.2.3 nathanw 20 1.8 deraadt #include "tun.h" 21 1.33 jonathan 22 1.33 jonathan #include "opt_inet.h" 23 1.34 jonathan #include "opt_ns.h" 24 1.8 deraadt 25 1.6 deraadt #include <sys/param.h> 26 1.8 deraadt #include <sys/proc.h> 27 1.6 deraadt #include <sys/systm.h> 28 1.6 deraadt #include <sys/mbuf.h> 29 1.6 deraadt #include <sys/buf.h> 30 1.6 deraadt #include <sys/protosw.h> 31 1.6 deraadt #include <sys/socket.h> 32 1.6 deraadt #include <sys/ioctl.h> 33 1.6 deraadt #include <sys/errno.h> 34 1.6 deraadt #include <sys/syslog.h> 35 1.6 deraadt #include <sys/select.h> 36 1.27 mycroft #include <sys/poll.h> 37 1.8 deraadt #include <sys/file.h> 38 1.22 christos #include <sys/signalvar.h> 39 1.23 christos #include <sys/conf.h> 40 1.9 deraadt 41 1.9 deraadt #include <machine/cpu.h> 42 1.6 deraadt 43 1.6 deraadt #include <net/if.h> 44 1.30 is #include <net/if_ether.h> 45 1.6 deraadt #include <net/netisr.h> 46 1.6 deraadt #include <net/route.h> 47 1.1 cgd 48 1.30 is 49 1.1 cgd #ifdef INET 50 1.6 deraadt #include <netinet/in.h> 51 1.6 deraadt #include <netinet/in_systm.h> 52 1.6 deraadt #include <netinet/in_var.h> 53 1.6 deraadt #include <netinet/ip.h> 54 1.30 is #include <netinet/if_inarp.h> 55 1.1 cgd #endif 56 1.1 cgd 57 1.1 cgd #ifdef NS 58 1.6 deraadt #include <netns/ns.h> 59 1.6 deraadt #include <netns/ns_if.h> 60 1.1 cgd #endif 61 1.1 cgd 62 1.8 deraadt #include "bpfilter.h" 63 1.8 deraadt #if NBPFILTER > 0 64 1.8 deraadt #include <sys/time.h> 65 1.8 deraadt #include <net/bpf.h> 66 1.8 deraadt #endif 67 1.8 deraadt 68 1.8 deraadt #include <net/if_tun.h> 69 1.8 deraadt 70 1.29 christos #define TUNDEBUG if (tundebug) printf 71 1.6 deraadt int tundebug = 0; 72 1.1 cgd 73 1.6 deraadt extern int ifqmaxlen; 74 1.22 christos void tunattach __P((int)); 75 1.42.2.3 nathanw LIST_HEAD(, tun_softc) tun_softc_list; 76 1.42.2.3 nathanw static struct simplelock tun_softc_lock; 77 1.6 deraadt 78 1.22 christos int tun_ioctl __P((struct ifnet *, u_long, caddr_t)); 79 1.22 christos int tun_output __P((struct ifnet *, struct mbuf *, struct sockaddr *, 80 1.22 christos struct rtentry *rt)); 81 1.42.2.3 nathanw int tun_clone_create __P((struct if_clone *, int)); 82 1.42.2.3 nathanw void tun_clone_destroy __P((struct ifnet *)); 83 1.42.2.3 nathanw 84 1.42.2.3 nathanw struct if_clone tun_cloner = 85 1.42.2.3 nathanw IF_CLONE_INITIALIZER("tun", tun_clone_create, tun_clone_destroy); 86 1.6 deraadt 87 1.42.2.3 nathanw static void tunattach0 __P((struct tun_softc *)); 88 1.26 pk static void tuninit __P((struct tun_softc *)); 89 1.42.2.4 nathanw #ifdef ALTQ 90 1.42.2.4 nathanw static void tunstart __P((struct ifnet *)); 91 1.42.2.4 nathanw #endif 92 1.42.2.3 nathanw static struct tun_softc *tun_find_unit __P((dev_t)); 93 1.6 deraadt 94 1.42.2.6 nathanw dev_type_open(tunopen); 95 1.42.2.6 nathanw dev_type_close(tunclose); 96 1.42.2.6 nathanw dev_type_read(tunread); 97 1.42.2.6 nathanw dev_type_write(tunwrite); 98 1.42.2.6 nathanw dev_type_ioctl(tunioctl); 99 1.42.2.6 nathanw dev_type_poll(tunpoll); 100 1.42.2.6 nathanw 101 1.42.2.6 nathanw const struct cdevsw tun_cdevsw = { 102 1.42.2.6 nathanw tunopen, tunclose, tunread, tunwrite, tunioctl, 103 1.42.2.6 nathanw nostop, notty, tunpoll, nommap, 104 1.42.2.6 nathanw }; 105 1.42.2.6 nathanw 106 1.8 deraadt void 107 1.8 deraadt tunattach(unused) 108 1.8 deraadt int unused; 109 1.8 deraadt { 110 1.8 deraadt 111 1.42.2.3 nathanw simple_lock_init(&tun_softc_lock); 112 1.42.2.3 nathanw LIST_INIT(&tun_softc_list); 113 1.42.2.3 nathanw if_clone_attach(&tun_cloner); 114 1.42.2.3 nathanw } 115 1.42.2.3 nathanw 116 1.42.2.3 nathanw int 117 1.42.2.3 nathanw tun_clone_create(ifc, unit) 118 1.42.2.3 nathanw struct if_clone *ifc; 119 1.42.2.3 nathanw int unit; 120 1.42.2.3 nathanw { 121 1.42.2.3 nathanw struct tun_softc *sc; 122 1.42.2.3 nathanw 123 1.42.2.3 nathanw sc = malloc(sizeof(struct tun_softc), M_DEVBUF, M_WAITOK); 124 1.42.2.3 nathanw (void)memset(sc, 0, sizeof(struct tun_softc)); 125 1.42.2.3 nathanw 126 1.42.2.3 nathanw (void)snprintf(sc->tun_if.if_xname, sizeof(sc->tun_if.if_xname), 127 1.42.2.3 nathanw "%s%d", ifc->ifc_name, unit); 128 1.42.2.3 nathanw sc->tun_unit = unit; 129 1.42.2.3 nathanw simple_lock_init(&sc->tun_lock); 130 1.42.2.3 nathanw 131 1.42.2.3 nathanw tunattach0(sc); 132 1.42.2.3 nathanw 133 1.42.2.3 nathanw simple_lock(&tun_softc_lock); 134 1.42.2.3 nathanw LIST_INSERT_HEAD(&tun_softc_list, sc, tun_list); 135 1.42.2.3 nathanw simple_unlock(&tun_softc_lock); 136 1.42.2.3 nathanw 137 1.42.2.3 nathanw return (0); 138 1.42.2.3 nathanw } 139 1.42.2.3 nathanw 140 1.42.2.3 nathanw void 141 1.42.2.3 nathanw tunattach0(sc) 142 1.42.2.3 nathanw struct tun_softc *sc; 143 1.42.2.3 nathanw { 144 1.42.2.3 nathanw struct ifnet *ifp = (void *)sc; 145 1.42.2.3 nathanw 146 1.42.2.3 nathanw sc->tun_flags = TUN_INITED; 147 1.8 deraadt 148 1.42.2.3 nathanw ifp = &sc->tun_if; 149 1.42.2.3 nathanw ifp->if_softc = sc; 150 1.42.2.3 nathanw ifp->if_mtu = TUNMTU; 151 1.42.2.3 nathanw ifp->if_ioctl = tun_ioctl; 152 1.42.2.3 nathanw ifp->if_output = tun_output; 153 1.42.2.4 nathanw #ifdef ALTQ 154 1.42.2.4 nathanw ifp->if_start = tunstart; 155 1.42.2.4 nathanw #endif 156 1.42.2.3 nathanw ifp->if_flags = IFF_POINTOPOINT; 157 1.42.2.3 nathanw ifp->if_snd.ifq_maxlen = ifqmaxlen; 158 1.42.2.3 nathanw ifp->if_collisions = 0; 159 1.42.2.3 nathanw ifp->if_ierrors = 0; 160 1.42.2.3 nathanw ifp->if_oerrors = 0; 161 1.42.2.3 nathanw ifp->if_ipackets = 0; 162 1.42.2.3 nathanw ifp->if_opackets = 0; 163 1.42.2.3 nathanw ifp->if_dlt = DLT_NULL; 164 1.42.2.4 nathanw IFQ_SET_READY(&ifp->if_snd); 165 1.42.2.3 nathanw if_attach(ifp); 166 1.42.2.3 nathanw if_alloc_sadl(ifp); 167 1.8 deraadt #if NBPFILTER > 0 168 1.42.2.3 nathanw bpfattach(ifp, DLT_NULL, sizeof(u_int32_t)); 169 1.8 deraadt #endif 170 1.42.2.3 nathanw } 171 1.42.2.3 nathanw 172 1.42.2.3 nathanw void 173 1.42.2.3 nathanw tun_clone_destroy(ifp) 174 1.42.2.3 nathanw struct ifnet *ifp; 175 1.42.2.3 nathanw { 176 1.42.2.3 nathanw struct tun_softc *tp = (void *)ifp; 177 1.42.2.3 nathanw struct proc *p; 178 1.42.2.3 nathanw 179 1.42.2.3 nathanw simple_lock(&tun_softc_lock); 180 1.42.2.3 nathanw simple_lock(&tp->tun_lock); 181 1.42.2.3 nathanw LIST_REMOVE(tp, tun_list); 182 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 183 1.42.2.3 nathanw simple_unlock(&tun_softc_lock); 184 1.42.2.3 nathanw 185 1.42.2.3 nathanw if (tp->tun_flags & TUN_RWAIT) { 186 1.42.2.3 nathanw tp->tun_flags &= ~TUN_RWAIT; 187 1.42.2.3 nathanw wakeup((caddr_t)tp); 188 1.42.2.3 nathanw } 189 1.42.2.3 nathanw if (tp->tun_flags & TUN_ASYNC && tp->tun_pgrp) { 190 1.42.2.3 nathanw if (tp->tun_pgrp > 0) 191 1.42.2.3 nathanw gsignal(tp->tun_pgrp, SIGIO); 192 1.42.2.3 nathanw else if ((p = pfind(-tp->tun_pgrp)) != NULL) 193 1.42.2.3 nathanw psignal(p, SIGIO); 194 1.8 deraadt } 195 1.42.2.3 nathanw selwakeup(&tp->tun_rsel); 196 1.42.2.3 nathanw 197 1.42.2.3 nathanw #if NBPFILTER > 0 198 1.42.2.3 nathanw bpfdetach(ifp); 199 1.42.2.3 nathanw #endif 200 1.42.2.3 nathanw if_detach(ifp); 201 1.42.2.3 nathanw 202 1.42.2.3 nathanw free(tp, M_DEVBUF); 203 1.42.2.3 nathanw } 204 1.42.2.3 nathanw 205 1.42.2.3 nathanw static struct tun_softc * 206 1.42.2.3 nathanw tun_find_unit(dev) 207 1.42.2.3 nathanw dev_t dev; 208 1.42.2.3 nathanw { 209 1.42.2.3 nathanw struct tun_softc *tp; 210 1.42.2.3 nathanw int unit = minor(dev); 211 1.42.2.3 nathanw 212 1.42.2.3 nathanw simple_lock(&tun_softc_lock); 213 1.42.2.3 nathanw LIST_FOREACH(tp, &tun_softc_list, tun_list) 214 1.42.2.3 nathanw if (unit == tp->tun_unit) 215 1.42.2.3 nathanw break; 216 1.42.2.3 nathanw if (tp) 217 1.42.2.3 nathanw simple_lock(&tp->tun_lock); 218 1.42.2.3 nathanw simple_unlock(&tun_softc_lock); 219 1.42.2.3 nathanw 220 1.42.2.3 nathanw return (tp); 221 1.8 deraadt } 222 1.8 deraadt 223 1.6 deraadt /* 224 1.6 deraadt * tunnel open - must be superuser & the device must be 225 1.6 deraadt * configured in 226 1.6 deraadt */ 227 1.6 deraadt int 228 1.6 deraadt tunopen(dev, flag, mode, p) 229 1.6 deraadt dev_t dev; 230 1.6 deraadt int flag, mode; 231 1.6 deraadt struct proc *p; 232 1.6 deraadt { 233 1.6 deraadt struct ifnet *ifp; 234 1.8 deraadt struct tun_softc *tp; 235 1.42.2.3 nathanw int error; 236 1.1 cgd 237 1.22 christos if ((error = suser(p->p_ucred, &p->p_acflag)) != 0) 238 1.5 deraadt return (error); 239 1.5 deraadt 240 1.42.2.3 nathanw if (NTUN < 1) 241 1.6 deraadt return (ENXIO); 242 1.42.2.3 nathanw 243 1.42.2.3 nathanw tp = tun_find_unit(dev); 244 1.42.2.3 nathanw 245 1.42.2.5 nathanw if (!tp) { 246 1.42.2.5 nathanw (void)tun_clone_create(&tun_cloner, minor(dev)); 247 1.42.2.5 nathanw tp = tun_find_unit(dev); 248 1.42.2.5 nathanw } 249 1.42.2.5 nathanw 250 1.42.2.3 nathanw if (!tp) 251 1.42.2.3 nathanw return (ENXIO); 252 1.42.2.3 nathanw 253 1.42.2.3 nathanw if (tp->tun_flags & TUN_OPEN) { 254 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 255 1.42.2.3 nathanw return (EBUSY); 256 1.42.2.3 nathanw } 257 1.42.2.3 nathanw 258 1.6 deraadt ifp = &tp->tun_if; 259 1.6 deraadt tp->tun_flags |= TUN_OPEN; 260 1.24 thorpej TUNDEBUG("%s: open\n", ifp->if_xname); 261 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 262 1.6 deraadt return (0); 263 1.1 cgd } 264 1.1 cgd 265 1.6 deraadt /* 266 1.6 deraadt * tunclose - close the device - mark i/f down & delete 267 1.6 deraadt * routing info 268 1.6 deraadt */ 269 1.6 deraadt int 270 1.22 christos tunclose(dev, flag, mode, p) 271 1.6 deraadt dev_t dev; 272 1.6 deraadt int flag; 273 1.22 christos int mode; 274 1.22 christos struct proc *p; 275 1.6 deraadt { 276 1.42.2.3 nathanw int s; 277 1.42.2.3 nathanw struct tun_softc *tp; 278 1.42.2.3 nathanw struct ifnet *ifp; 279 1.6 deraadt 280 1.42.2.3 nathanw tp = tun_find_unit(dev); 281 1.42.2.3 nathanw 282 1.42.2.3 nathanw /* interface was "destroyed" before the close */ 283 1.42.2.3 nathanw if (tp == NULL) 284 1.42.2.3 nathanw return (0); 285 1.42.2.3 nathanw 286 1.42.2.3 nathanw ifp = &tp->tun_if; 287 1.42.2.3 nathanw 288 1.10 andrew tp->tun_flags &= ~TUN_OPEN; 289 1.6 deraadt 290 1.6 deraadt /* 291 1.6 deraadt * junk all pending output 292 1.6 deraadt */ 293 1.42.2.4 nathanw s = splnet(); 294 1.42.2.4 nathanw IFQ_PURGE(&ifp->if_snd); 295 1.42.2.4 nathanw splx(s); 296 1.6 deraadt 297 1.6 deraadt if (ifp->if_flags & IFF_UP) { 298 1.42.2.1 nathanw s = splnet(); 299 1.6 deraadt if_down(ifp); 300 1.8 deraadt if (ifp->if_flags & IFF_RUNNING) { 301 1.17 mycroft /* find internet addresses and delete routes */ 302 1.39 augustss struct ifaddr *ifa; 303 1.42.2.3 nathanw TAILQ_FOREACH(ifa, &ifp->if_addrlist, ifa_list) { 304 1.38 itojun #ifdef INET 305 1.18 mycroft if (ifa->ifa_addr->sa_family == AF_INET) { 306 1.18 mycroft rtinit(ifa, (int)RTM_DELETE, 307 1.26 pk tp->tun_flags & TUN_DSTADDR 308 1.26 pk ? RTF_HOST 309 1.26 pk : 0); 310 1.18 mycroft } 311 1.38 itojun #endif 312 1.11 deraadt } 313 1.8 deraadt } 314 1.6 deraadt splx(s); 315 1.6 deraadt } 316 1.6 deraadt tp->tun_pgrp = 0; 317 1.7 deraadt selwakeup(&tp->tun_rsel); 318 1.6 deraadt 319 1.24 thorpej TUNDEBUG ("%s: closed\n", ifp->if_xname); 320 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 321 1.6 deraadt return (0); 322 1.1 cgd } 323 1.1 cgd 324 1.26 pk static void 325 1.24 thorpej tuninit(tp) 326 1.24 thorpej struct tun_softc *tp; 327 1.6 deraadt { 328 1.6 deraadt struct ifnet *ifp = &tp->tun_if; 329 1.42.2.3 nathanw struct ifaddr *ifa; 330 1.8 deraadt 331 1.24 thorpej TUNDEBUG("%s: tuninit\n", ifp->if_xname); 332 1.6 deraadt 333 1.6 deraadt ifp->if_flags |= IFF_UP | IFF_RUNNING; 334 1.8 deraadt 335 1.26 pk tp->tun_flags &= ~(TUN_IASET|TUN_DSTADDR); 336 1.42.2.3 nathanw TAILQ_FOREACH(ifa, &ifp->if_addrlist, ifa_list) { 337 1.38 itojun #ifdef INET 338 1.11 deraadt if (ifa->ifa_addr->sa_family == AF_INET) { 339 1.17 mycroft struct sockaddr_in *sin; 340 1.11 deraadt 341 1.17 mycroft sin = satosin(ifa->ifa_addr); 342 1.17 mycroft if (sin && sin->sin_addr.s_addr) 343 1.17 mycroft tp->tun_flags |= TUN_IASET; 344 1.17 mycroft 345 1.26 pk if (ifp->if_flags & IFF_POINTOPOINT) { 346 1.26 pk sin = satosin(ifa->ifa_dstaddr); 347 1.26 pk if (sin && sin->sin_addr.s_addr) 348 1.26 pk tp->tun_flags |= TUN_DSTADDR; 349 1.26 pk } 350 1.11 deraadt } 351 1.38 itojun #endif 352 1.18 mycroft } 353 1.8 deraadt 354 1.26 pk return; 355 1.1 cgd } 356 1.1 cgd 357 1.1 cgd /* 358 1.1 cgd * Process an ioctl request. 359 1.1 cgd */ 360 1.1 cgd int 361 1.22 christos tun_ioctl(ifp, cmd, data) 362 1.6 deraadt struct ifnet *ifp; 363 1.25 mycroft u_long cmd; 364 1.6 deraadt caddr_t data; 365 1.6 deraadt { 366 1.6 deraadt int error = 0, s; 367 1.42.2.3 nathanw struct tun_softc *tp = (struct tun_softc *)(ifp->if_softc); 368 1.42.2.3 nathanw 369 1.42.2.3 nathanw simple_lock(&tp->tun_lock); 370 1.6 deraadt 371 1.42.2.1 nathanw s = splnet(); 372 1.6 deraadt switch(cmd) { 373 1.6 deraadt case SIOCSIFADDR: 374 1.24 thorpej tuninit((struct tun_softc *)(ifp->if_softc)); 375 1.24 thorpej TUNDEBUG("%s: address set\n", ifp->if_xname); 376 1.6 deraadt break; 377 1.6 deraadt case SIOCSIFDSTADDR: 378 1.24 thorpej tuninit((struct tun_softc *)(ifp->if_softc)); 379 1.24 thorpej TUNDEBUG("%s: destination address set\n", ifp->if_xname); 380 1.6 deraadt break; 381 1.26 pk case SIOCSIFBRDADDR: 382 1.26 pk TUNDEBUG("%s: broadcast address set\n", ifp->if_xname); 383 1.26 pk break; 384 1.31 matt case SIOCSIFMTU: { 385 1.31 matt struct ifreq *ifr = (struct ifreq *) data; 386 1.31 matt if (ifr->ifr_mtu > TUNMTU || ifr->ifr_mtu < 576) { 387 1.31 matt error = EINVAL; 388 1.31 matt break; 389 1.31 matt } 390 1.31 matt TUNDEBUG("%s: interface mtu set\n", ifp->if_xname); 391 1.31 matt ifp->if_mtu = ifr->ifr_mtu; 392 1.32 matt break; 393 1.32 matt } 394 1.32 matt case SIOCADDMULTI: 395 1.32 matt case SIOCDELMULTI: { 396 1.32 matt struct ifreq *ifr = (struct ifreq *) data; 397 1.32 matt if (ifr == 0) { 398 1.32 matt error = EAFNOSUPPORT; /* XXX */ 399 1.32 matt break; 400 1.32 matt } 401 1.32 matt switch (ifr->ifr_addr.sa_family) { 402 1.32 matt 403 1.32 matt #ifdef INET 404 1.32 matt case AF_INET: 405 1.32 matt break; 406 1.32 matt #endif 407 1.32 matt 408 1.32 matt default: 409 1.32 matt error = EAFNOSUPPORT; 410 1.32 matt break; 411 1.32 matt } 412 1.31 matt break; 413 1.31 matt } 414 1.38 itojun case SIOCSIFFLAGS: 415 1.38 itojun break; 416 1.6 deraadt default: 417 1.6 deraadt error = EINVAL; 418 1.6 deraadt } 419 1.6 deraadt splx(s); 420 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 421 1.6 deraadt return (error); 422 1.1 cgd } 423 1.1 cgd 424 1.1 cgd /* 425 1.22 christos * tun_output - queue packets from higher level ready to put out. 426 1.1 cgd */ 427 1.6 deraadt int 428 1.22 christos tun_output(ifp, m0, dst, rt) 429 1.6 deraadt struct ifnet *ifp; 430 1.6 deraadt struct mbuf *m0; 431 1.6 deraadt struct sockaddr *dst; 432 1.12 deraadt struct rtentry *rt; 433 1.6 deraadt { 434 1.24 thorpej struct tun_softc *tp = ifp->if_softc; 435 1.6 deraadt struct proc *p; 436 1.38 itojun #ifdef INET 437 1.6 deraadt int s; 438 1.42.2.4 nathanw int error; 439 1.38 itojun #endif 440 1.42.2.4 nathanw ALTQ_DECL(struct altq_pktattr pktattr;) 441 1.6 deraadt 442 1.42.2.3 nathanw simple_lock(&tp->tun_lock); 443 1.24 thorpej TUNDEBUG ("%s: tun_output\n", ifp->if_xname); 444 1.1 cgd 445 1.8 deraadt if ((tp->tun_flags & TUN_READY) != TUN_READY) { 446 1.24 thorpej TUNDEBUG ("%s: not ready 0%o\n", ifp->if_xname, 447 1.24 thorpej tp->tun_flags); 448 1.8 deraadt m_freem (m0); 449 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 450 1.26 pk return (EHOSTDOWN); 451 1.8 deraadt } 452 1.8 deraadt 453 1.42.2.4 nathanw /* 454 1.42.2.4 nathanw * if the queueing discipline needs packet classification, 455 1.42.2.4 nathanw * do it before prepending link headers. 456 1.42.2.4 nathanw */ 457 1.42.2.4 nathanw IFQ_CLASSIFY(&ifp->if_snd, m0, dst->sa_family, &pktattr); 458 1.42.2.4 nathanw 459 1.8 deraadt #if NBPFILTER > 0 460 1.40 thorpej if (ifp->if_bpf) { 461 1.8 deraadt /* 462 1.8 deraadt * We need to prepend the address family as 463 1.8 deraadt * a four byte field. Cons up a dummy header 464 1.8 deraadt * to pacify bpf. This is safe because bpf 465 1.8 deraadt * will only read from the mbuf (i.e., it won't 466 1.8 deraadt * try to free it or keep a pointer to it). 467 1.8 deraadt */ 468 1.8 deraadt struct mbuf m; 469 1.16 cgd u_int32_t af = dst->sa_family; 470 1.8 deraadt 471 1.8 deraadt m.m_next = m0; 472 1.16 cgd m.m_len = sizeof(af); 473 1.8 deraadt m.m_data = (char *)⁡ 474 1.8 deraadt 475 1.40 thorpej bpf_mtap(ifp->if_bpf, &m); 476 1.8 deraadt } 477 1.8 deraadt #endif 478 1.8 deraadt 479 1.6 deraadt switch(dst->sa_family) { 480 1.1 cgd #ifdef INET 481 1.6 deraadt case AF_INET: 482 1.26 pk if (tp->tun_flags & TUN_PREPADDR) { 483 1.26 pk /* Simple link-layer header */ 484 1.26 pk M_PREPEND(m0, dst->sa_len, M_DONTWAIT); 485 1.26 pk if (m0 == NULL) { 486 1.26 pk IF_DROP(&ifp->if_snd); 487 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 488 1.26 pk return (ENOBUFS); 489 1.26 pk } 490 1.26 pk bcopy(dst, mtod(m0, char *), dst->sa_len); 491 1.26 pk } 492 1.36 sommerfe /* FALLTHROUGH */ 493 1.36 sommerfe case AF_UNSPEC: 494 1.42.2.1 nathanw s = splnet(); 495 1.42.2.4 nathanw IFQ_ENQUEUE(&ifp->if_snd, m0, &pktattr, error); 496 1.42.2.4 nathanw if (error) { 497 1.6 deraadt splx(s); 498 1.6 deraadt ifp->if_collisions++; 499 1.42.2.4 nathanw return (error); 500 1.6 deraadt } 501 1.6 deraadt splx(s); 502 1.6 deraadt ifp->if_opackets++; 503 1.6 deraadt break; 504 1.1 cgd #endif 505 1.6 deraadt default: 506 1.6 deraadt m_freem(m0); 507 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 508 1.26 pk return (EAFNOSUPPORT); 509 1.6 deraadt } 510 1.6 deraadt 511 1.6 deraadt if (tp->tun_flags & TUN_RWAIT) { 512 1.6 deraadt tp->tun_flags &= ~TUN_RWAIT; 513 1.6 deraadt wakeup((caddr_t)tp); 514 1.6 deraadt } 515 1.6 deraadt if (tp->tun_flags & TUN_ASYNC && tp->tun_pgrp) { 516 1.6 deraadt if (tp->tun_pgrp > 0) 517 1.6 deraadt gsignal(tp->tun_pgrp, SIGIO); 518 1.22 christos else if ((p = pfind(-tp->tun_pgrp)) != NULL) 519 1.6 deraadt psignal(p, SIGIO); 520 1.6 deraadt } 521 1.6 deraadt selwakeup(&tp->tun_rsel); 522 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 523 1.26 pk return (0); 524 1.1 cgd } 525 1.1 cgd 526 1.1 cgd /* 527 1.1 cgd * the cdevsw interface is now pretty minimal. 528 1.1 cgd */ 529 1.6 deraadt int 530 1.20 mycroft tunioctl(dev, cmd, data, flag, p) 531 1.6 deraadt dev_t dev; 532 1.15 cgd u_long cmd; 533 1.6 deraadt caddr_t data; 534 1.6 deraadt int flag; 535 1.12 deraadt struct proc *p; 536 1.6 deraadt { 537 1.42.2.3 nathanw int s; 538 1.42.2.3 nathanw struct tun_softc *tp; 539 1.42.2.3 nathanw 540 1.42.2.3 nathanw tp = tun_find_unit(dev); 541 1.42.2.3 nathanw 542 1.42.2.3 nathanw /* interface was "destroyed" already */ 543 1.42.2.3 nathanw if (tp == NULL) 544 1.42.2.3 nathanw return (ENXIO); 545 1.6 deraadt 546 1.6 deraadt switch (cmd) { 547 1.6 deraadt case TUNSDEBUG: 548 1.6 deraadt tundebug = *(int *)data; 549 1.6 deraadt break; 550 1.26 pk 551 1.6 deraadt case TUNGDEBUG: 552 1.6 deraadt *(int *)data = tundebug; 553 1.6 deraadt break; 554 1.26 pk 555 1.26 pk case TUNSIFMODE: 556 1.31 matt switch (*(int *)data & (IFF_POINTOPOINT|IFF_BROADCAST)) { 557 1.26 pk case IFF_POINTOPOINT: 558 1.26 pk case IFF_BROADCAST: 559 1.42.2.1 nathanw s = splnet(); 560 1.26 pk if (tp->tun_if.if_flags & IFF_UP) { 561 1.26 pk splx(s); 562 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 563 1.26 pk return (EBUSY); 564 1.26 pk } 565 1.26 pk tp->tun_if.if_flags &= 566 1.31 matt ~(IFF_BROADCAST|IFF_POINTOPOINT|IFF_MULTICAST); 567 1.26 pk tp->tun_if.if_flags |= *(int *)data; 568 1.26 pk splx(s); 569 1.26 pk break; 570 1.26 pk default: 571 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 572 1.26 pk return (EINVAL); 573 1.26 pk } 574 1.26 pk break; 575 1.26 pk 576 1.26 pk case TUNSLMODE: 577 1.26 pk if (*(int *)data) 578 1.26 pk tp->tun_flags |= TUN_PREPADDR; 579 1.26 pk else 580 1.26 pk tp->tun_flags &= ~TUN_PREPADDR; 581 1.26 pk break; 582 1.26 pk 583 1.6 deraadt case FIONBIO: 584 1.6 deraadt if (*(int *)data) 585 1.6 deraadt tp->tun_flags |= TUN_NBIO; 586 1.6 deraadt else 587 1.6 deraadt tp->tun_flags &= ~TUN_NBIO; 588 1.6 deraadt break; 589 1.26 pk 590 1.6 deraadt case FIOASYNC: 591 1.6 deraadt if (*(int *)data) 592 1.6 deraadt tp->tun_flags |= TUN_ASYNC; 593 1.6 deraadt else 594 1.6 deraadt tp->tun_flags &= ~TUN_ASYNC; 595 1.6 deraadt break; 596 1.26 pk 597 1.6 deraadt case FIONREAD: 598 1.42.2.1 nathanw s = splnet(); 599 1.6 deraadt if (tp->tun_if.if_snd.ifq_head) 600 1.19 pk *(int *)data = tp->tun_if.if_snd.ifq_head->m_pkthdr.len; 601 1.6 deraadt else 602 1.6 deraadt *(int *)data = 0; 603 1.6 deraadt splx(s); 604 1.6 deraadt break; 605 1.26 pk 606 1.6 deraadt case TIOCSPGRP: 607 1.6 deraadt tp->tun_pgrp = *(int *)data; 608 1.6 deraadt break; 609 1.26 pk 610 1.6 deraadt case TIOCGPGRP: 611 1.6 deraadt *(int *)data = tp->tun_pgrp; 612 1.6 deraadt break; 613 1.26 pk 614 1.6 deraadt default: 615 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 616 1.6 deraadt return (ENOTTY); 617 1.6 deraadt } 618 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 619 1.6 deraadt return (0); 620 1.1 cgd } 621 1.1 cgd 622 1.1 cgd /* 623 1.6 deraadt * The cdevsw read interface - reads a packet at a time, or at 624 1.6 deraadt * least as much of a packet as can be read. 625 1.1 cgd */ 626 1.6 deraadt int 627 1.22 christos tunread(dev, uio, ioflag) 628 1.6 deraadt dev_t dev; 629 1.6 deraadt struct uio *uio; 630 1.22 christos int ioflag; 631 1.6 deraadt { 632 1.42.2.3 nathanw struct tun_softc *tp; 633 1.42.2.3 nathanw struct ifnet *ifp; 634 1.6 deraadt struct mbuf *m, *m0; 635 1.42.2.3 nathanw int error=0, len, s, index; 636 1.42.2.3 nathanw 637 1.42.2.3 nathanw tp = tun_find_unit(dev); 638 1.42.2.3 nathanw 639 1.42.2.3 nathanw /* interface was "destroyed" already */ 640 1.42.2.3 nathanw if (tp == NULL) 641 1.42.2.3 nathanw return (ENXIO); 642 1.42.2.3 nathanw 643 1.42.2.3 nathanw index = tp->tun_if.if_index; 644 1.42.2.3 nathanw ifp = &tp->tun_if; 645 1.6 deraadt 646 1.24 thorpej TUNDEBUG ("%s: read\n", ifp->if_xname); 647 1.8 deraadt if ((tp->tun_flags & TUN_READY) != TUN_READY) { 648 1.26 pk TUNDEBUG ("%s: not ready 0%o\n", ifp->if_xname, tp->tun_flags); 649 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 650 1.8 deraadt return EHOSTDOWN; 651 1.8 deraadt } 652 1.8 deraadt 653 1.6 deraadt tp->tun_flags &= ~TUN_RWAIT; 654 1.6 deraadt 655 1.42.2.1 nathanw s = splnet(); 656 1.6 deraadt do { 657 1.42.2.4 nathanw IFQ_DEQUEUE(&ifp->if_snd, m0); 658 1.6 deraadt if (m0 == 0) { 659 1.6 deraadt if (tp->tun_flags & TUN_NBIO) { 660 1.6 deraadt splx(s); 661 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 662 1.26 pk return (EWOULDBLOCK); 663 1.6 deraadt } 664 1.6 deraadt tp->tun_flags |= TUN_RWAIT; 665 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 666 1.26 pk if (tsleep((caddr_t)tp, PZERO|PCATCH, "tunread", 0)) { 667 1.26 pk splx(s); 668 1.26 pk return (EINTR); 669 1.42.2.3 nathanw } else { 670 1.42.2.3 nathanw /* 671 1.42.2.3 nathanw * Maybe the interface was destroyed while 672 1.42.2.3 nathanw * we were sleeping, so let's ensure that 673 1.42.2.3 nathanw * we're looking at the same (valid) tun 674 1.42.2.3 nathanw * interface before looping. 675 1.42.2.3 nathanw */ 676 1.42.2.3 nathanw tp = tun_find_unit(dev); 677 1.42.2.3 nathanw if (tp == NULL || 678 1.42.2.3 nathanw tp->tun_if.if_index != index) { 679 1.42.2.3 nathanw splx(s); 680 1.42.2.3 nathanw if (tp) 681 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 682 1.42.2.3 nathanw return (ENXIO); 683 1.42.2.3 nathanw } 684 1.26 pk } 685 1.6 deraadt } 686 1.6 deraadt } while (m0 == 0); 687 1.6 deraadt splx(s); 688 1.6 deraadt 689 1.6 deraadt while (m0 && uio->uio_resid > 0 && error == 0) { 690 1.13 deraadt len = min(uio->uio_resid, m0->m_len); 691 1.42.2.2 nathanw if (len != 0) 692 1.42.2.2 nathanw error = uiomove(mtod(m0, caddr_t), len, uio); 693 1.6 deraadt MFREE(m0, m); 694 1.6 deraadt m0 = m; 695 1.6 deraadt } 696 1.6 deraadt 697 1.6 deraadt if (m0) { 698 1.6 deraadt TUNDEBUG("Dropping mbuf\n"); 699 1.6 deraadt m_freem(m0); 700 1.6 deraadt } 701 1.19 pk if (error) 702 1.19 pk ifp->if_ierrors++; 703 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 704 1.26 pk return (error); 705 1.1 cgd } 706 1.1 cgd 707 1.1 cgd /* 708 1.1 cgd * the cdevsw write interface - an atomic write is a packet - or else! 709 1.1 cgd */ 710 1.6 deraadt int 711 1.22 christos tunwrite(dev, uio, ioflag) 712 1.8 deraadt dev_t dev; 713 1.6 deraadt struct uio *uio; 714 1.22 christos int ioflag; 715 1.6 deraadt { 716 1.42.2.3 nathanw struct tun_softc *tp; 717 1.42.2.3 nathanw struct ifnet *ifp; 718 1.6 deraadt struct mbuf *top, **mp, *m; 719 1.26 pk struct ifqueue *ifq; 720 1.26 pk struct sockaddr dst; 721 1.26 pk int isr, error=0, s, tlen, mlen; 722 1.6 deraadt 723 1.42.2.3 nathanw tp = tun_find_unit(dev); 724 1.42.2.3 nathanw 725 1.42.2.3 nathanw /* interface was "destroyed" already */ 726 1.42.2.3 nathanw if (tp == NULL) 727 1.42.2.3 nathanw return (ENXIO); 728 1.42.2.3 nathanw 729 1.42.2.3 nathanw ifp = &tp->tun_if; 730 1.42.2.3 nathanw 731 1.24 thorpej TUNDEBUG("%s: tunwrite\n", ifp->if_xname); 732 1.6 deraadt 733 1.26 pk if (tp->tun_flags & TUN_PREPADDR) { 734 1.42.2.3 nathanw if (uio->uio_resid < sizeof(dst)) { 735 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 736 1.26 pk return (EIO); 737 1.42.2.3 nathanw } 738 1.26 pk error = uiomove((caddr_t)&dst, sizeof(dst), uio); 739 1.26 pk if (dst.sa_len > sizeof(dst)) { 740 1.26 pk /* Duh.. */ 741 1.26 pk char discard; 742 1.26 pk int n = dst.sa_len - sizeof(dst); 743 1.26 pk while (n--) 744 1.42.2.3 nathanw if ((error = uiomove(&discard, 1, uio)) != 0) { 745 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 746 1.26 pk return (error); 747 1.42.2.3 nathanw } 748 1.26 pk } 749 1.26 pk } else { 750 1.26 pk #ifdef INET 751 1.26 pk dst.sa_family = AF_INET; 752 1.26 pk #endif 753 1.26 pk } 754 1.26 pk 755 1.42.2.7 nathanw if (uio->uio_resid > TUNMTU) { 756 1.37 mjacob TUNDEBUG("%s: len=%lu!\n", ifp->if_xname, 757 1.37 mjacob (unsigned long)uio->uio_resid); 758 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 759 1.26 pk return (EIO); 760 1.6 deraadt } 761 1.26 pk 762 1.26 pk switch (dst.sa_family) { 763 1.26 pk #ifdef INET 764 1.26 pk case AF_INET: 765 1.26 pk ifq = &ipintrq; 766 1.26 pk isr = NETISR_IP; 767 1.26 pk break; 768 1.26 pk #endif 769 1.26 pk default: 770 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 771 1.26 pk return (EAFNOSUPPORT); 772 1.26 pk } 773 1.26 pk 774 1.8 deraadt tlen = uio->uio_resid; 775 1.8 deraadt 776 1.8 deraadt /* get a header mbuf */ 777 1.8 deraadt MGETHDR(m, M_DONTWAIT, MT_DATA); 778 1.42.2.3 nathanw if (m == NULL) { 779 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 780 1.26 pk return (ENOBUFS); 781 1.42.2.3 nathanw } 782 1.8 deraadt mlen = MHLEN; 783 1.8 deraadt 784 1.6 deraadt top = 0; 785 1.6 deraadt mp = ⊤ 786 1.6 deraadt while (error == 0 && uio->uio_resid > 0) { 787 1.13 deraadt m->m_len = min(mlen, uio->uio_resid); 788 1.8 deraadt error = uiomove(mtod (m, caddr_t), m->m_len, uio); 789 1.6 deraadt *mp = m; 790 1.6 deraadt mp = &m->m_next; 791 1.8 deraadt if (uio->uio_resid > 0) { 792 1.8 deraadt MGET (m, M_DONTWAIT, MT_DATA); 793 1.8 deraadt if (m == 0) { 794 1.8 deraadt error = ENOBUFS; 795 1.8 deraadt break; 796 1.8 deraadt } 797 1.8 deraadt mlen = MLEN; 798 1.8 deraadt } 799 1.6 deraadt } 800 1.6 deraadt if (error) { 801 1.6 deraadt if (top) 802 1.8 deraadt m_freem (top); 803 1.19 pk ifp->if_ierrors++; 804 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 805 1.26 pk return (error); 806 1.6 deraadt } 807 1.6 deraadt 808 1.8 deraadt top->m_pkthdr.len = tlen; 809 1.8 deraadt top->m_pkthdr.rcvif = ifp; 810 1.8 deraadt 811 1.8 deraadt #if NBPFILTER > 0 812 1.40 thorpej if (ifp->if_bpf) { 813 1.8 deraadt /* 814 1.8 deraadt * We need to prepend the address family as 815 1.8 deraadt * a four byte field. Cons up a dummy header 816 1.8 deraadt * to pacify bpf. This is safe because bpf 817 1.8 deraadt * will only read from the mbuf (i.e., it won't 818 1.8 deraadt * try to free it or keep a pointer to it). 819 1.8 deraadt */ 820 1.8 deraadt struct mbuf m; 821 1.16 cgd u_int32_t af = AF_INET; 822 1.8 deraadt 823 1.8 deraadt m.m_next = top; 824 1.16 cgd m.m_len = sizeof(af); 825 1.8 deraadt m.m_data = (char *)⁡ 826 1.8 deraadt 827 1.40 thorpej bpf_mtap(ifp->if_bpf, &m); 828 1.6 deraadt } 829 1.8 deraadt #endif 830 1.6 deraadt 831 1.42.2.1 nathanw s = splnet(); 832 1.26 pk if (IF_QFULL(ifq)) { 833 1.26 pk IF_DROP(ifq); 834 1.6 deraadt splx(s); 835 1.6 deraadt ifp->if_collisions++; 836 1.6 deraadt m_freem(top); 837 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 838 1.26 pk return (ENOBUFS); 839 1.6 deraadt } 840 1.26 pk IF_ENQUEUE(ifq, top); 841 1.6 deraadt splx(s); 842 1.6 deraadt ifp->if_ipackets++; 843 1.26 pk schednetisr(isr); 844 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 845 1.26 pk return (error); 846 1.1 cgd } 847 1.1 cgd 848 1.42.2.4 nathanw #ifdef ALTQ 849 1.42.2.4 nathanw /* 850 1.42.2.4 nathanw * Start packet transmission on the interface. 851 1.42.2.4 nathanw * when the interface queue is rate-limited by ALTQ or TBR, 852 1.42.2.4 nathanw * if_start is needed to drain packets from the queue in order 853 1.42.2.4 nathanw * to notify readers when outgoing packets become ready. 854 1.42.2.4 nathanw */ 855 1.42.2.4 nathanw static void 856 1.42.2.4 nathanw tunstart(ifp) 857 1.42.2.4 nathanw struct ifnet *ifp; 858 1.42.2.4 nathanw { 859 1.42.2.4 nathanw struct tun_softc *tp = ifp->if_softc; 860 1.42.2.4 nathanw struct mbuf *m; 861 1.42.2.4 nathanw struct proc *p; 862 1.42.2.4 nathanw 863 1.42.2.4 nathanw if (!ALTQ_IS_ENABLED(&ifp->if_snd) && !TBR_IS_ENABLED(&ifp->if_snd)) 864 1.42.2.4 nathanw return; 865 1.42.2.4 nathanw 866 1.42.2.4 nathanw IFQ_POLL(&ifp->if_snd, m); 867 1.42.2.4 nathanw if (m != NULL) { 868 1.42.2.4 nathanw if (tp->tun_flags & TUN_RWAIT) { 869 1.42.2.4 nathanw tp->tun_flags &= ~TUN_RWAIT; 870 1.42.2.4 nathanw wakeup((caddr_t)tp); 871 1.42.2.4 nathanw } 872 1.42.2.4 nathanw if (tp->tun_flags & TUN_ASYNC && tp->tun_pgrp) { 873 1.42.2.4 nathanw if (tp->tun_pgrp > 0) 874 1.42.2.4 nathanw gsignal(tp->tun_pgrp, SIGIO); 875 1.42.2.4 nathanw else if ((p = pfind(-tp->tun_pgrp)) != NULL) 876 1.42.2.4 nathanw psignal(p, SIGIO); 877 1.42.2.4 nathanw } 878 1.42.2.4 nathanw selwakeup(&tp->tun_rsel); 879 1.42.2.4 nathanw } 880 1.42.2.4 nathanw } 881 1.42.2.4 nathanw #endif /* ALTQ */ 882 1.1 cgd /* 883 1.27 mycroft * tunpoll - the poll interface, this is only useful on reads 884 1.6 deraadt * really. The write detect always returns true, write never blocks 885 1.6 deraadt * anyway, it either accepts the packet or drops it. 886 1.6 deraadt */ 887 1.6 deraadt int 888 1.27 mycroft tunpoll(dev, events, p) 889 1.6 deraadt dev_t dev; 890 1.27 mycroft int events; 891 1.22 christos struct proc *p; 892 1.6 deraadt { 893 1.42.2.3 nathanw struct tun_softc *tp; 894 1.42.2.3 nathanw struct ifnet *ifp; 895 1.42.2.3 nathanw int s, revents = 0; 896 1.42.2.3 nathanw 897 1.42.2.3 nathanw tp = tun_find_unit(dev); 898 1.42.2.3 nathanw 899 1.42.2.3 nathanw /* interface was "destroyed" already */ 900 1.42.2.3 nathanw if (tp == NULL) 901 1.42.2.3 nathanw return (0); 902 1.42.2.3 nathanw 903 1.42.2.3 nathanw ifp = &tp->tun_if; 904 1.6 deraadt 905 1.42.2.1 nathanw s = splnet(); 906 1.27 mycroft TUNDEBUG("%s: tunpoll\n", ifp->if_xname); 907 1.6 deraadt 908 1.35 veego if (events & (POLLIN | POLLRDNORM)) { 909 1.42.2.4 nathanw if (IFQ_IS_EMPTY(&ifp->if_snd) == 0) { 910 1.27 mycroft TUNDEBUG("%s: tunpoll q=%d\n", ifp->if_xname, 911 1.24 thorpej ifp->if_snd.ifq_len); 912 1.27 mycroft revents |= events & (POLLIN | POLLRDNORM); 913 1.27 mycroft } else { 914 1.27 mycroft TUNDEBUG("%s: tunpoll waiting\n", ifp->if_xname); 915 1.27 mycroft selrecord(p, &tp->tun_rsel); 916 1.6 deraadt } 917 1.35 veego } 918 1.27 mycroft 919 1.27 mycroft if (events & (POLLOUT | POLLWRNORM)) 920 1.27 mycroft revents |= events & (POLLOUT | POLLWRNORM); 921 1.27 mycroft 922 1.6 deraadt splx(s); 923 1.42.2.3 nathanw simple_unlock(&tp->tun_lock); 924 1.27 mycroft return (revents); 925 1.1 cgd } 926
Indexes created Wed Oct 15 03:09:54 GMT 2025