FreeBSD/Linux Kernel Cross Reference
sys/net/if_tun.c
1 /* $NetBSD: if_tun.c,v 1.14 1994/06/29 06:36:25 cgd Exp $ */
2
3 /*-
4 * Copyright (c) 1988, Julian Onions <jpo@cs.nott.ac.uk>
5 * Nottingham University 1987.
6 *
7 * This source may be freely distributed, however I would be interested
8 * in any changes that are made.
9 *
10 * This driver takes packets off the IP i/f and hands them up to a
11 * user process to have its wicked way with. This driver has it's
12 * roots in a similar driver written by Phil Cockcroft (formerly) at
13 * UCL. This driver is based much more on read/write/poll mode of
14 * operation though.
15 *
16 * $FreeBSD: releng/6.0/sys/net/if_tun.c 149443 2005-08-25 05:01:24Z rwatson $
17 */
18
19 #include "opt_atalk.h"
20 #include "opt_inet.h"
21 #include "opt_inet6.h"
22 #include "opt_ipx.h"
23 #include "opt_mac.h"
24
25 #include <sys/param.h>
26 #include <sys/proc.h>
27 #include <sys/systm.h>
28 #include <sys/mac.h>
29 #include <sys/mbuf.h>
30 #include <sys/module.h>
31 #include <sys/socket.h>
32 #include <sys/fcntl.h>
33 #include <sys/filio.h>
34 #include <sys/sockio.h>
35 #include <sys/ttycom.h>
36 #include <sys/poll.h>
37 #include <sys/selinfo.h>
38 #include <sys/signalvar.h>
39 #include <sys/filedesc.h>
40 #include <sys/kernel.h>
41 #include <sys/sysctl.h>
42 #include <sys/conf.h>
43 #include <sys/uio.h>
44 #include <sys/malloc.h>
45 #include <sys/random.h>
46
47 #include <net/if.h>
48 #include <net/if_types.h>
49 #include <net/netisr.h>
50 #include <net/route.h>
51 #ifdef INET
52 #include <netinet/in.h>
53 #endif
54 #include <net/bpf.h>
55 #include <net/if_tun.h>
56
57 #include <sys/queue.h>
58
59 /*
60 * tun_list is protected by global tunmtx. Other mutable fields are
61 * protected by tun->tun_mtx, or by their owning subsystem. tun_dev is
62 * static for the duration of a tunnel interface.
63 */
64 struct tun_softc {
65 TAILQ_ENTRY(tun_softc) tun_list;
66 struct cdev *tun_dev;
67 u_short tun_flags; /* misc flags */
68 #define TUN_OPEN 0x0001
69 #define TUN_INITED 0x0002
70 #define TUN_RCOLL 0x0004
71 #define TUN_IASET 0x0008
72 #define TUN_DSTADDR 0x0010
73 #define TUN_LMODE 0x0020
74 #define TUN_RWAIT 0x0040
75 #define TUN_ASYNC 0x0080
76 #define TUN_IFHEAD 0x0100
77
78 #define TUN_READY (TUN_OPEN | TUN_INITED)
79
80 /*
81 * XXXRW: tun_pid is used to exclusively lock /dev/tun. Is this
82 * actually needed? Can we just return EBUSY if already open?
83 * Problem is that this involved inherent races when a tun device
84 * is handed off from one process to another, as opposed to just
85 * being slightly stale informationally.
86 */
87 pid_t tun_pid; /* owning pid */
88 struct ifnet *tun_ifp; /* the interface */
89 struct sigio *tun_sigio; /* information for async I/O */
90 struct selinfo tun_rsel; /* read select */
91 struct mtx tun_mtx; /* protect mutable softc fields */
92 };
93 #define TUN2IFP(sc) ((sc)->tun_ifp)
94
95 #define TUNDEBUG if (tundebug) if_printf
96 #define TUNNAME "tun"
97
98 /*
99 * All mutable global variables in if_tun are locked using tunmtx, with
100 * the exception of tundebug, which is used unlocked, and tunclones,
101 * which is static after setup.
102 */
103 static struct mtx tunmtx;
104 static MALLOC_DEFINE(M_TUN, TUNNAME, "Tunnel Interface");
105 static int tundebug = 0;
106 static struct clonedevs *tunclones;
107 static TAILQ_HEAD(,tun_softc) tunhead = TAILQ_HEAD_INITIALIZER(tunhead);
108 SYSCTL_INT(_debug, OID_AUTO, if_tun_debug, CTLFLAG_RW, &tundebug, 0, "");
109
110 static void tunclone(void *arg, struct ucred *cred, char *name,
111 int namelen, struct cdev **dev);
112 static void tuncreate(struct cdev *dev);
113 static int tunifioctl(struct ifnet *, u_long, caddr_t);
114 static int tuninit(struct ifnet *);
115 static int tunmodevent(module_t, int, void *);
116 static int tunoutput(struct ifnet *, struct mbuf *, struct sockaddr *,
117 struct rtentry *rt);
118 static void tunstart(struct ifnet *);
119
120 static d_open_t tunopen;
121 static d_close_t tunclose;
122 static d_read_t tunread;
123 static d_write_t tunwrite;
124 static d_ioctl_t tunioctl;
125 static d_poll_t tunpoll;
126
127 static struct cdevsw tun_cdevsw = {
128 .d_version = D_VERSION,
129 .d_flags = D_PSEUDO | D_NEEDGIANT,
130 .d_open = tunopen,
131 .d_close = tunclose,
132 .d_read = tunread,
133 .d_write = tunwrite,
134 .d_ioctl = tunioctl,
135 .d_poll = tunpoll,
136 .d_name = TUNNAME,
137 };
138
139 static void
140 tunclone(void *arg, struct ucred *cred, char *name, int namelen,
141 struct cdev **dev)
142 {
143 int u, i;
144
145 if (*dev != NULL)
146 return;
147
148 if (strcmp(name, TUNNAME) == 0) {
149 u = -1;
150 } else if (dev_stdclone(name, NULL, TUNNAME, &u) != 1)
151 return; /* Don't recognise the name */
152 if (u != -1 && u > IF_MAXUNIT)
153 return; /* Unit number too high */
154
155 /* find any existing device, or allocate new unit number */
156 i = clone_create(&tunclones, &tun_cdevsw, &u, dev, 0);
157 if (i) {
158 /* No preexisting struct cdev *, create one */
159 *dev = make_dev(&tun_cdevsw, unit2minor(u),
160 UID_UUCP, GID_DIALER, 0600, "tun%d", u);
161 if (*dev != NULL) {
162 dev_ref(*dev);
163 (*dev)->si_flags |= SI_CHEAPCLONE;
164 }
165 }
166 }
167
168 static void
169 tun_destroy(struct tun_softc *tp)
170 {
171 struct cdev *dev;
172
173 /* Unlocked read. */
174 KASSERT((tp->tun_flags & TUN_OPEN) == 0,
175 ("tununits is out of sync - unit %d", TUN2IFP(tp)->if_dunit));
176
177 dev = tp->tun_dev;
178 bpfdetach(TUN2IFP(tp));
179 if_detach(TUN2IFP(tp));
180 if_free(TUN2IFP(tp));
181 destroy_dev(dev);
182 mtx_destroy(&tp->tun_mtx);
183 free(tp, M_TUN);
184 }
185
186 static int
187 tunmodevent(module_t mod, int type, void *data)
188 {
189 static eventhandler_tag tag;
190 struct tun_softc *tp;
191
192 switch (type) {
193 case MOD_LOAD:
194 mtx_init(&tunmtx, "tunmtx", NULL, MTX_DEF);
195 clone_setup(&tunclones);
196 tag = EVENTHANDLER_REGISTER(dev_clone, tunclone, 0, 1000);
197 if (tag == NULL)
198 return (ENOMEM);
199 break;
200 case MOD_UNLOAD:
201 EVENTHANDLER_DEREGISTER(dev_clone, tag);
202
203 mtx_lock(&tunmtx);
204 while ((tp = TAILQ_FIRST(&tunhead)) != NULL) {
205 TAILQ_REMOVE(&tunhead, tp, tun_list);
206 mtx_unlock(&tunmtx);
207 tun_destroy(tp);
208 mtx_lock(&tunmtx);
209 }
210 mtx_unlock(&tunmtx);
211 clone_cleanup(&tunclones);
212 mtx_destroy(&tunmtx);
213 break;
214 default:
215 return EOPNOTSUPP;
216 }
217 return 0;
218 }
219
220 static moduledata_t tun_mod = {
221 "if_tun",
222 tunmodevent,
223 0
224 };
225
226 DECLARE_MODULE(if_tun, tun_mod, SI_SUB_PSEUDO, SI_ORDER_ANY);
227
228 static void
229 tunstart(struct ifnet *ifp)
230 {
231 struct tun_softc *tp = ifp->if_softc;
232 struct mbuf *m;
233
234 if (ALTQ_IS_ENABLED(&ifp->if_snd)) {
235 IFQ_LOCK(&ifp->if_snd);
236 IFQ_POLL_NOLOCK(&ifp->if_snd, m);
237 if (m == NULL) {
238 IFQ_UNLOCK(&ifp->if_snd);
239 return;
240 }
241 IFQ_UNLOCK(&ifp->if_snd);
242 }
243
244 mtx_lock(&tp->tun_mtx);
245 if (tp->tun_flags & TUN_RWAIT) {
246 tp->tun_flags &= ~TUN_RWAIT;
247 wakeup(tp);
248 }
249 if (tp->tun_flags & TUN_ASYNC && tp->tun_sigio) {
250 mtx_unlock(&tp->tun_mtx);
251 pgsigio(&tp->tun_sigio, SIGIO, 0);
252 } else
253 mtx_unlock(&tp->tun_mtx);
254 selwakeuppri(&tp->tun_rsel, PZERO + 1);
255 }
256
257 /* XXX: should return an error code so it can fail. */
258 static void
259 tuncreate(struct cdev *dev)
260 {
261 struct tun_softc *sc;
262 struct ifnet *ifp;
263
264 dev->si_flags &= ~SI_CHEAPCLONE;
265
266 MALLOC(sc, struct tun_softc *, sizeof(*sc), M_TUN, M_WAITOK | M_ZERO);
267 mtx_init(&sc->tun_mtx, "tun_mtx", NULL, MTX_DEF);
268 sc->tun_flags = TUN_INITED;
269 sc->tun_dev = dev;
270 mtx_lock(&tunmtx);
271 TAILQ_INSERT_TAIL(&tunhead, sc, tun_list);
272 mtx_unlock(&tunmtx);
273
274 ifp = sc->tun_ifp = if_alloc(IFT_PPP);
275 if (ifp == NULL)
276 panic("%s%d: failed to if_alloc() interface.\n",
277 TUNNAME, dev2unit(dev));
278 if_initname(ifp, TUNNAME, dev2unit(dev));
279 ifp->if_mtu = TUNMTU;
280 ifp->if_ioctl = tunifioctl;
281 ifp->if_output = tunoutput;
282 ifp->if_start = tunstart;
283 ifp->if_flags = IFF_POINTOPOINT | IFF_MULTICAST;
284 ifp->if_softc = sc;
285 IFQ_SET_MAXLEN(&ifp->if_snd, ifqmaxlen);
286 ifp->if_snd.ifq_drv_maxlen = 0;
287 IFQ_SET_READY(&ifp->if_snd);
288
289 if_attach(ifp);
290 bpfattach(ifp, DLT_NULL, sizeof(u_int32_t));
291 dev->si_drv1 = sc;
292 }
293
294 static int
295 tunopen(struct cdev *dev, int flag, int mode, struct thread *td)
296 {
297 struct ifnet *ifp;
298 struct tun_softc *tp;
299
300 /*
301 * XXXRW: Non-atomic test and set of dev->si_drv1 requires
302 * synchronization.
303 */
304 tp = dev->si_drv1;
305 if (!tp) {
306 tuncreate(dev);
307 tp = dev->si_drv1;
308 }
309
310 /*
311 * XXXRW: This use of tun_pid is subject to error due to the
312 * fact that a reference to the tunnel can live beyond the
313 * death of the process that created it. Can we replace this
314 * with a simple busy flag?
315 */
316 mtx_lock(&tp->tun_mtx);
317 if (tp->tun_pid != 0 && tp->tun_pid != td->td_proc->p_pid) {
318 mtx_unlock(&tp->tun_mtx);
319 return (EBUSY);
320 }
321 tp->tun_pid = td->td_proc->p_pid;
322
323 tp->tun_flags |= TUN_OPEN;
324 mtx_unlock(&tp->tun_mtx);
325 ifp = TUN2IFP(tp);
326 TUNDEBUG(ifp, "open\n");
327
328 return (0);
329 }
330
331 /*
332 * tunclose - close the device - mark i/f down & delete
333 * routing info
334 */
335 static int
336 tunclose(struct cdev *dev, int foo, int bar, struct thread *td)
337 {
338 struct tun_softc *tp;
339 struct ifnet *ifp;
340 int s;
341
342 tp = dev->si_drv1;
343 ifp = TUN2IFP(tp);
344
345 mtx_lock(&tp->tun_mtx);
346 tp->tun_flags &= ~TUN_OPEN;
347 tp->tun_pid = 0;
348
349 /*
350 * junk all pending output
351 */
352 s = splimp();
353 IFQ_PURGE(&ifp->if_snd);
354 splx(s);
355 mtx_unlock(&tp->tun_mtx);
356
357 if (ifp->if_flags & IFF_UP) {
358 s = splimp();
359 if_down(ifp);
360 splx(s);
361 }
362
363 if (ifp->if_drv_flags & IFF_DRV_RUNNING) {
364 struct ifaddr *ifa;
365
366 s = splimp();
367 /* find internet addresses and delete routes */
368 TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link)
369 if (ifa->ifa_addr->sa_family == AF_INET)
370 /* Unlocked read. */
371 rtinit(ifa, (int)RTM_DELETE,
372 tp->tun_flags & TUN_DSTADDR ? RTF_HOST : 0);
373 ifp->if_drv_flags &= ~IFF_DRV_RUNNING;
374 splx(s);
375 }
376
377 funsetown(&tp->tun_sigio);
378 selwakeuppri(&tp->tun_rsel, PZERO + 1);
379 TUNDEBUG (ifp, "closed\n");
380 return (0);
381 }
382
383 static int
384 tuninit(struct ifnet *ifp)
385 {
386 struct tun_softc *tp = ifp->if_softc;
387 struct ifaddr *ifa;
388 int error = 0;
389
390 TUNDEBUG(ifp, "tuninit\n");
391
392 ifp->if_flags |= IFF_UP;
393 ifp->if_drv_flags |= IFF_DRV_RUNNING;
394 getmicrotime(&ifp->if_lastchange);
395
396 for (ifa = TAILQ_FIRST(&ifp->if_addrhead); ifa;
397 ifa = TAILQ_NEXT(ifa, ifa_link)) {
398 if (ifa->ifa_addr == NULL)
399 error = EFAULT;
400 /* XXX: Should maybe return straight off? */
401 else {
402 #ifdef INET
403 if (ifa->ifa_addr->sa_family == AF_INET) {
404 struct sockaddr_in *si;
405
406 si = (struct sockaddr_in *)ifa->ifa_addr;
407 mtx_lock(&tp->tun_mtx);
408 if (si->sin_addr.s_addr)
409 tp->tun_flags |= TUN_IASET;
410
411 si = (struct sockaddr_in *)ifa->ifa_dstaddr;
412 if (si && si->sin_addr.s_addr)
413 tp->tun_flags |= TUN_DSTADDR;
414 mtx_unlock(&tp->tun_mtx);
415 }
416 #endif
417 }
418 }
419 return (error);
420 }
421
422 /*
423 * Process an ioctl request.
424 */
425 static int
426 tunifioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
427 {
428 struct ifreq *ifr = (struct ifreq *)data;
429 struct tun_softc *tp = ifp->if_softc;
430 struct ifstat *ifs;
431 int error = 0, s;
432
433 s = splimp();
434 switch(cmd) {
435 case SIOCGIFSTATUS:
436 ifs = (struct ifstat *)data;
437 mtx_lock(&tp->tun_mtx);
438 if (tp->tun_pid)
439 sprintf(ifs->ascii + strlen(ifs->ascii),
440 "\tOpened by PID %d\n", tp->tun_pid);
441 mtx_unlock(&tp->tun_mtx);
442 break;
443 case SIOCSIFADDR:
444 error = tuninit(ifp);
445 TUNDEBUG(ifp, "address set, error=%d\n", error);
446 break;
447 case SIOCSIFDSTADDR:
448 error = tuninit(ifp);
449 TUNDEBUG(ifp, "destination address set, error=%d\n", error);
450 break;
451 case SIOCSIFMTU:
452 ifp->if_mtu = ifr->ifr_mtu;
453 TUNDEBUG(ifp, "mtu set\n");
454 break;
455 case SIOCSIFFLAGS:
456 case SIOCADDMULTI:
457 case SIOCDELMULTI:
458 break;
459 default:
460 error = EINVAL;
461 }
462 splx(s);
463 return (error);
464 }
465
466 /*
467 * tunoutput - queue packets from higher level ready to put out.
468 */
469 static int
470 tunoutput(
471 struct ifnet *ifp,
472 struct mbuf *m0,
473 struct sockaddr *dst,
474 struct rtentry *rt)
475 {
476 struct tun_softc *tp = ifp->if_softc;
477 u_short cached_tun_flags;
478 int error;
479 u_int32_t af;
480
481 TUNDEBUG (ifp, "tunoutput\n");
482
483 #ifdef MAC
484 error = mac_check_ifnet_transmit(ifp, m0);
485 if (error) {
486 m_freem(m0);
487 return (error);
488 }
489 #endif
490
491 /* Could be unlocked read? */
492 mtx_lock(&tp->tun_mtx);
493 cached_tun_flags = tp->tun_flags;
494 mtx_unlock(&tp->tun_mtx);
495 if ((cached_tun_flags & TUN_READY) != TUN_READY) {
496 TUNDEBUG (ifp, "not ready 0%o\n", tp->tun_flags);
497 m_freem (m0);
498 return (EHOSTDOWN);
499 }
500
501 if ((ifp->if_flags & IFF_UP) != IFF_UP) {
502 m_freem (m0);
503 return (EHOSTDOWN);
504 }
505
506 /* BPF writes need to be handled specially. */
507 if (dst->sa_family == AF_UNSPEC) {
508 bcopy(dst->sa_data, &af, sizeof(af));
509 dst->sa_family = af;
510 }
511
512 if (ifp->if_bpf) {
513 af = dst->sa_family;
514 bpf_mtap2(ifp->if_bpf, &af, sizeof(af), m0);
515 }
516
517 /* prepend sockaddr? this may abort if the mbuf allocation fails */
518 if (cached_tun_flags & TUN_LMODE) {
519 /* allocate space for sockaddr */
520 M_PREPEND(m0, dst->sa_len, M_DONTWAIT);
521
522 /* if allocation failed drop packet */
523 if (m0 == NULL) {
524 ifp->if_iqdrops++;
525 ifp->if_oerrors++;
526 return (ENOBUFS);
527 } else {
528 bcopy(dst, m0->m_data, dst->sa_len);
529 }
530 }
531
532 if (cached_tun_flags & TUN_IFHEAD) {
533 /* Prepend the address family */
534 M_PREPEND(m0, 4, M_DONTWAIT);
535
536 /* if allocation failed drop packet */
537 if (m0 == NULL) {
538 ifp->if_iqdrops++;
539 ifp->if_oerrors++;
540 return (ENOBUFS);
541 } else
542 *(u_int32_t *)m0->m_data = htonl(dst->sa_family);
543 } else {
544 #ifdef INET
545 if (dst->sa_family != AF_INET)
546 #endif
547 {
548 m_freem(m0);
549 return (EAFNOSUPPORT);
550 }
551 }
552
553 IFQ_HANDOFF(ifp, m0, error);
554 if (error) {
555 ifp->if_collisions++;
556 return (ENOBUFS);
557 }
558 ifp->if_opackets++;
559 return (0);
560 }
561
562 /*
563 * the cdevsw interface is now pretty minimal.
564 */
565 static int
566 tunioctl(struct cdev *dev, u_long cmd, caddr_t data, int flag, struct thread *td)
567 {
568 int s;
569 int error;
570 struct tun_softc *tp = dev->si_drv1;
571 struct tuninfo *tunp;
572
573 switch (cmd) {
574 case TUNSIFINFO:
575 tunp = (struct tuninfo *)data;
576 if (tunp->mtu < IF_MINMTU)
577 return (EINVAL);
578 if (TUN2IFP(tp)->if_mtu != tunp->mtu
579 && (error = suser(td)) != 0)
580 return (error);
581 TUN2IFP(tp)->if_mtu = tunp->mtu;
582 TUN2IFP(tp)->if_type = tunp->type;
583 TUN2IFP(tp)->if_baudrate = tunp->baudrate;
584 break;
585 case TUNGIFINFO:
586 tunp = (struct tuninfo *)data;
587 tunp->mtu = TUN2IFP(tp)->if_mtu;
588 tunp->type = TUN2IFP(tp)->if_type;
589 tunp->baudrate = TUN2IFP(tp)->if_baudrate;
590 break;
591 case TUNSDEBUG:
592 tundebug = *(int *)data;
593 break;
594 case TUNGDEBUG:
595 *(int *)data = tundebug;
596 break;
597 case TUNSLMODE:
598 mtx_lock(&tp->tun_mtx);
599 if (*(int *)data) {
600 tp->tun_flags |= TUN_LMODE;
601 tp->tun_flags &= ~TUN_IFHEAD;
602 } else
603 tp->tun_flags &= ~TUN_LMODE;
604 mtx_unlock(&tp->tun_mtx);
605 break;
606 case TUNSIFHEAD:
607 mtx_lock(&tp->tun_mtx);
608 if (*(int *)data) {
609 tp->tun_flags |= TUN_IFHEAD;
610 tp->tun_flags &= ~TUN_LMODE;
611 } else
612 tp->tun_flags &= ~TUN_IFHEAD;
613 mtx_unlock(&tp->tun_mtx);
614 break;
615 case TUNGIFHEAD:
616 /* Could be unlocked read? */
617 mtx_lock(&tp->tun_mtx);
618 *(int *)data = (tp->tun_flags & TUN_IFHEAD) ? 1 : 0;
619 mtx_unlock(&tp->tun_mtx);
620 break;
621 case TUNSIFMODE:
622 /* deny this if UP */
623 if (TUN2IFP(tp)->if_flags & IFF_UP)
624 return(EBUSY);
625
626 switch (*(int *)data & ~IFF_MULTICAST) {
627 case IFF_POINTOPOINT:
628 case IFF_BROADCAST:
629 TUN2IFP(tp)->if_flags &=
630 ~(IFF_BROADCAST|IFF_POINTOPOINT|IFF_MULTICAST);
631 TUN2IFP(tp)->if_flags |= *(int *)data;
632 break;
633 default:
634 return(EINVAL);
635 }
636 break;
637 case TUNSIFPID:
638 mtx_lock(&tp->tun_mtx);
639 tp->tun_pid = curthread->td_proc->p_pid;
640 mtx_unlock(&tp->tun_mtx);
641 break;
642 case FIONBIO:
643 break;
644 case FIOASYNC:
645 mtx_lock(&tp->tun_mtx);
646 if (*(int *)data)
647 tp->tun_flags |= TUN_ASYNC;
648 else
649 tp->tun_flags &= ~TUN_ASYNC;
650 mtx_unlock(&tp->tun_mtx);
651 break;
652 case FIONREAD:
653 s = splimp();
654 if (!IFQ_IS_EMPTY(&TUN2IFP(tp)->if_snd)) {
655 struct mbuf *mb;
656 IFQ_LOCK(&TUN2IFP(tp)->if_snd);
657 IFQ_POLL_NOLOCK(&TUN2IFP(tp)->if_snd, mb);
658 for( *(int *)data = 0; mb != 0; mb = mb->m_next)
659 *(int *)data += mb->m_len;
660 IFQ_UNLOCK(&TUN2IFP(tp)->if_snd);
661 } else
662 *(int *)data = 0;
663 splx(s);
664 break;
665 case FIOSETOWN:
666 return (fsetown(*(int *)data, &tp->tun_sigio));
667
668 case FIOGETOWN:
669 *(int *)data = fgetown(&tp->tun_sigio);
670 return (0);
671
672 /* This is deprecated, FIOSETOWN should be used instead. */
673 case TIOCSPGRP:
674 return (fsetown(-(*(int *)data), &tp->tun_sigio));
675
676 /* This is deprecated, FIOGETOWN should be used instead. */
677 case TIOCGPGRP:
678 *(int *)data = -fgetown(&tp->tun_sigio);
679 return (0);
680
681 default:
682 return (ENOTTY);
683 }
684 return (0);
685 }
686
687 /*
688 * The cdevsw read interface - reads a packet at a time, or at
689 * least as much of a packet as can be read.
690 */
691 static int
692 tunread(struct cdev *dev, struct uio *uio, int flag)
693 {
694 struct tun_softc *tp = dev->si_drv1;
695 struct ifnet *ifp = TUN2IFP(tp);
696 struct mbuf *m;
697 int error=0, len, s;
698
699 TUNDEBUG (ifp, "read\n");
700 mtx_lock(&tp->tun_mtx);
701 if ((tp->tun_flags & TUN_READY) != TUN_READY) {
702 mtx_unlock(&tp->tun_mtx);
703 TUNDEBUG (ifp, "not ready 0%o\n", tp->tun_flags);
704 return (EHOSTDOWN);
705 }
706
707 tp->tun_flags &= ~TUN_RWAIT;
708 mtx_unlock(&tp->tun_mtx);
709
710 s = splimp();
711 do {
712 IFQ_DEQUEUE(&ifp->if_snd, m);
713 if (m == NULL) {
714 if (flag & O_NONBLOCK) {
715 splx(s);
716 return (EWOULDBLOCK);
717 }
718 mtx_lock(&tp->tun_mtx);
719 tp->tun_flags |= TUN_RWAIT;
720 mtx_unlock(&tp->tun_mtx);
721 if((error = tsleep(tp, PCATCH | (PZERO + 1),
722 "tunread", 0)) != 0) {
723 splx(s);
724 return (error);
725 }
726 }
727 } while (m == NULL);
728 splx(s);
729
730 while (m && uio->uio_resid > 0 && error == 0) {
731 len = min(uio->uio_resid, m->m_len);
732 if (len != 0)
733 error = uiomove(mtod(m, void *), len, uio);
734 m = m_free(m);
735 }
736
737 if (m) {
738 TUNDEBUG(ifp, "Dropping mbuf\n");
739 m_freem(m);
740 }
741 return (error);
742 }
743
744 /*
745 * the cdevsw write interface - an atomic write is a packet - or else!
746 */
747 static int
748 tunwrite(struct cdev *dev, struct uio *uio, int flag)
749 {
750 struct tun_softc *tp = dev->si_drv1;
751 struct ifnet *ifp = TUN2IFP(tp);
752 struct mbuf *m;
753 int error = 0;
754 uint32_t family;
755 int isr;
756
757 TUNDEBUG(ifp, "tunwrite\n");
758
759 if ((ifp->if_flags & IFF_UP) != IFF_UP)
760 /* ignore silently */
761 return (0);
762
763 if (uio->uio_resid == 0)
764 return (0);
765
766 if (uio->uio_resid < 0 || uio->uio_resid > TUNMRU) {
767 TUNDEBUG(ifp, "len=%d!\n", uio->uio_resid);
768 return (EIO);
769 }
770
771 if ((m = m_uiotombuf(uio, M_DONTWAIT, 0, 0)) == NULL) {
772 ifp->if_ierrors++;
773 return (error);
774 }
775
776 m->m_pkthdr.rcvif = ifp;
777 #ifdef MAC
778 mac_create_mbuf_from_ifnet(ifp, m);
779 #endif
780
781 /* Could be unlocked read? */
782 mtx_lock(&tp->tun_mtx);
783 if (tp->tun_flags & TUN_IFHEAD) {
784 mtx_unlock(&tp->tun_mtx);
785 if (m->m_len < sizeof(family) &&
786 (m = m_pullup(m, sizeof(family))) == NULL)
787 return (ENOBUFS);
788 family = ntohl(*mtod(m, u_int32_t *));
789 m_adj(m, sizeof(family));
790 } else {
791 mtx_unlock(&tp->tun_mtx);
792 family = AF_INET;
793 }
794
795 BPF_MTAP2(ifp, &family, sizeof(family), m);
796
797 switch (family) {
798 #ifdef INET
799 case AF_INET:
800 isr = NETISR_IP;
801 break;
802 #endif
803 #ifdef INET6
804 case AF_INET6:
805 isr = NETISR_IPV6;
806 break;
807 #endif
808 #ifdef IPX
809 case AF_IPX:
810 isr = NETISR_IPX;
811 break;
812 #endif
813 #ifdef NETATALK
814 case AF_APPLETALK:
815 isr = NETISR_ATALK2;
816 break;
817 #endif
818 default:
819 m_freem(m);
820 return (EAFNOSUPPORT);
821 }
822 /* First chunk of an mbuf contains good junk */
823 if (harvest.point_to_point)
824 random_harvest(m, 16, 3, 0, RANDOM_NET);
825 ifp->if_ibytes += m->m_pkthdr.len;
826 ifp->if_ipackets++;
827 netisr_dispatch(isr, m);
828 return (0);
829 }
830
831 /*
832 * tunpoll - the poll interface, this is only useful on reads
833 * really. The write detect always returns true, write never blocks
834 * anyway, it either accepts the packet or drops it.
835 */
836 static int
837 tunpoll(struct cdev *dev, int events, struct thread *td)
838 {
839 int s;
840 struct tun_softc *tp = dev->si_drv1;
841 struct ifnet *ifp = TUN2IFP(tp);
842 int revents = 0;
843 struct mbuf *m;
844
845 s = splimp();
846 TUNDEBUG(ifp, "tunpoll\n");
847
848 if (events & (POLLIN | POLLRDNORM)) {
849 IFQ_LOCK(&ifp->if_snd);
850 IFQ_POLL_NOLOCK(&ifp->if_snd, m);
851 if (m != NULL) {
852 TUNDEBUG(ifp, "tunpoll q=%d\n", ifp->if_snd.ifq_len);
853 revents |= events & (POLLIN | POLLRDNORM);
854 } else {
855 TUNDEBUG(ifp, "tunpoll waiting\n");
856 selrecord(td, &tp->tun_rsel);
857 }
858 IFQ_UNLOCK(&ifp->if_snd);
859 }
860 if (events & (POLLOUT | POLLWRNORM))
861 revents |= events & (POLLOUT | POLLWRNORM);
862
863 splx(s);
864 return (revents);
865 }
Cache object: 51de8f277882e32b44f87aa37842011c
|