if_tun.c revision 1.2 1 1.1 cgd /* UNFINISHED CONVERSION TO 386BSD -wfj */
2 1.1 cgd
3 1.1 cgd /* if_tun.c - tunnel interface module & driver */
4 1.1 cgd
5 1.1 cgd /*
6 1.1 cgd * Copyright (c) 1988, Julian Onions.
7 1.1 cgd *
8 1.1 cgd * This source may be freely distributed, however I would be interested
9 1.1 cgd * in any changes that are made.
10 1.1 cgd */
11 1.1 cgd
12 1.1 cgd /*
13 1.1 cgd * 90/02/06 15:03 - Fixed a bug in where TIOCGPGRP and TIOCSPGRP were
14 1.1 cgd * mixed up. Anders Klemets - klemets (at) sics.se
15 1.1 cgd *
16 1.2 cgd * $Id: if_tun.c,v 1.2 1993/05/18 18:19:58 cgd Exp $
17 1.1 cgd *
18 1.2 cgd * $Log: if_tun.c,v $
19 1.2 cgd * Revision 1.2 1993/05/18 18:19:58 cgd
20 1.2 cgd * make kernel select interface be one-stop shopping & clean it all up.
21 1.2 cgd *
22 1.1 cgd * Revision 1.1.1.1 1993/03/21 09:46:06 cgd
23 1.1 cgd * initial import of 386bsd-0.1 sources
24 1.1 cgd *
25 1.1 cgd * Revision 1.13 88/07/11 08:28:51 jpo
26 1.1 cgd * Some tidying up
27 1.1 cgd *
28 1.1 cgd * Revision 1.12 87/12/10 09:16:29 jpo
29 1.1 cgd * Decided the vax/mtpr was unnecessay.
30 1.1 cgd *
31 1.1 cgd * Revision 1.11 87/12/10 09:10:36 jpo
32 1.1 cgd * Fixed some minor things & 1 major bug.
33 1.1 cgd *
34 1.1 cgd * Revision 1.10 87/11/04 14:27:41 jpo
35 1.1 cgd * A few sanity checks added.
36 1.1 cgd *
37 1.1 cgd * Revision 1.9 87/11/04 14:13:45 jpo
38 1.1 cgd * Added some ioctls for non-blocking & async I/O
39 1.1 cgd *
40 1.1 cgd * Revision 1.8 87/10/19 10:28:14 jpo
41 1.1 cgd * Another touch up (sigh)
42 1.1 cgd *
43 1.1 cgd * Revision 1.7 87/10/19 10:25:48 jpo
44 1.1 cgd * Touch up.
45 1.1 cgd *
46 1.1 cgd * Revision 1.6 87/10/19 09:15:14 jpo
47 1.1 cgd * Touch up.
48 1.1 cgd *
49 1.1 cgd * Revision 1.5 87/10/19 08:34:51 jpo
50 1.1 cgd * General clean up - plus sun specific fixes
51 1.1 cgd *
52 1.1 cgd * Revision 1.4 87/10/16 17:10:12 jpo
53 1.1 cgd * Purged all ioctl read/writes and non-standard routing stuff.
54 1.1 cgd *
55 1.1 cgd * Revision 1.3 87/10/05 11:57:09 jpo
56 1.1 cgd * More debugging - in error mainly.
57 1.1 cgd *
58 1.1 cgd * Revision 1.2 87/10/04 18:29:45 jpo
59 1.1 cgd * Select & read/write working.
60 1.1 cgd */
61 1.1 cgd
62 1.1 cgd #include "tun.h"
63 1.1 cgd #if NTUN > 0
64 1.1 cgd
65 1.1 cgd /*
66 1.1 cgd * Tunnel driver.
67 1.1 cgd *
68 1.1 cgd * This driver takes packets off the IP i/f and hands them up to a
69 1.1 cgd * user process to have it's wicked way with. This driver has it's
70 1.1 cgd * roots in a similar driver written by Phil Cockcroft (formerly) at
71 1.1 cgd * UCL. This driver is based much more on read/write/select mode of
72 1.1 cgd * operation though.
73 1.1 cgd *
74 1.1 cgd * Julian Onions <jpo (at) cs.nott.ac.uk>
75 1.1 cgd * Nottingham University 1987.
76 1.1 cgd */
77 1.1 cgd
78 1.1 cgd #include "param.h"
79 1.1 cgd #include "systm.h"
80 1.1 cgd #include "mbuf.h"
81 1.1 cgd #include "buf.h"
82 1.1 cgd #include "protosw.h"
83 1.1 cgd #include "socket.h"
84 1.1 cgd #include "ioctl.h"
85 1.1 cgd #include "errno.h"
86 1.1 cgd #include "syslog.h"
87 1.1 cgd
88 1.1 cgd #include "net/if.h"
89 1.1 cgd #include "net/netisr.h"
90 1.1 cgd #include "net/route.h"
91 1.1 cgd
92 1.1 cgd #ifdef INET
93 1.1 cgd #include "netinet/in.h"
94 1.1 cgd #include "netinet/in_systm.h"
95 1.1 cgd #include "netinet/in_var.h"
96 1.1 cgd #include "netinet/ip.h"
97 1.1 cgd #include "netinet/if_ether.h"
98 1.1 cgd #endif
99 1.1 cgd
100 1.1 cgd #ifdef NS
101 1.1 cgd #include "netns/ns.h"
102 1.1 cgd #include "netns/ns_if.h"
103 1.1 cgd #endif
104 1.1 cgd
105 1.1 cgd #define TUNDEBUG if (tundebug) printf
106 1.1 cgd
107 1.1 cgd int tundebug = 0;
108 1.1 cgd struct tunctl
109 1.1 cgd {
110 1.2 cgd u_short tun_flags; /* misc flags */
111 1.2 cgd struct ifnet tun_if; /* the interface */
112 1.1 cgd int tun_pgrp; /* the process group - if any */
113 1.1 cgd struct selinfo tun_rsel; /* read select */
114 1.1 cgd struct selinfo tun_wsel; /* write select (not used) */
115 1.1 cgd } tunctl[NTUN];
116 1.1 cgd
117 1.1 cgd extern int ifqmaxlen;
118 1.1 cgd
119 1.1 cgd int tunoutput (), tunioctl (), tuninit ();
120 1.1 cgd
121 1.1 cgd /* tunnel open - must be superuser & the device must be configured in */
122 1.1 cgd tunopen (dev, flag)
123 1.1 cgd dev_t dev;
124 1.1 cgd {
125 1.1 cgd register int unit;
126 1.1 cgd struct tunctl *tp;
127 1.1 cgd register struct ifnet *ifp;
128 1.1 cgd
129 1.1 cgd if (!suser ())
130 1.1 cgd return EACCES;
131 1.1 cgd if ((unit = minor (dev)) >= NTUN)
132 1.1 cgd return (ENXIO);
133 1.1 cgd tp = &tunctl[unit];
134 1.1 cgd if (tp->tun_flags & TUN_OPEN)
135 1.1 cgd return ENXIO;
136 1.1 cgd if ((tp->tun_flags & TUN_INITED) == 0) {
137 1.1 cgd tp->tun_flags = TUN_INITED;
138 1.1 cgd tunattach (unit);
139 1.1 cgd }
140 1.1 cgd ifp = &tp->tun_if;
141 1.1 cgd tp->tun_flags |= TUN_OPEN;
142 1.1 cgd TUNDEBUG ("%s%d: open\n", ifp->if_name, ifp->if_unit);
143 1.1 cgd return (0);
144 1.1 cgd }
145 1.1 cgd
146 1.1 cgd /* tunclose - close the device - mark i/f down & delete routing info */
147 1.1 cgd tunclose (dev, flag)
148 1.1 cgd dev_t dev;
149 1.1 cgd {
150 1.1 cgd int s;
151 1.1 cgd register int unit = minor (dev);
152 1.1 cgd register struct tunctl *tp = &tunctl[unit];
153 1.1 cgd register struct ifnet *ifp = &tp->tun_if;
154 1.1 cgd register struct mbuf *m;
155 1.1 cgd
156 1.1 cgd tp->tun_flags &= TUN_INITED;
157 1.1 cgd
158 1.1 cgd /*
159 1.1 cgd * junk all pending output
160 1.1 cgd */
161 1.1 cgd do {
162 1.1 cgd s = splimp ();
163 1.1 cgd IF_DEQUEUE (&ifp->if_snd, m);
164 1.1 cgd splx (s);
165 1.1 cgd if (m) /* actually - m_freem checks this - but what the hell */
166 1.1 cgd m_freem (m);
167 1.1 cgd } while (m != 0);
168 1.1 cgd if (ifp->if_flags & IFF_UP) {
169 1.1 cgd s = splimp ();
170 1.1 cgd if_down (ifp);
171 1.1 cgd if (ifp->if_flags & IFF_RUNNING)
172 1.1 cgd rtinit (ifp->if_addrlist, (int)SIOCDELRT, RTF_HOST);
173 1.1 cgd splx (s);
174 1.2 cgd }
175 1.1 cgd tp -> tun_pgrp = 0;
176 1.1 cgd if (tp -> tun_rsel)
177 1.1 cgd selwakeup (&tp->tun_rsel);
178 1.1 cgd
179 1.1 cgd tp -> tun_rsel = tp -> tun_wsel = (struct proc *)0;
180 1.1 cgd
181 1.1 cgd TUNDEBUG ("%s%d: closed\n", ifp->if_name, ifp->if_unit);
182 1.1 cgd return (0);
183 1.1 cgd }
184 1.1 cgd
185 1.1 cgd /*
186 1.1 cgd * attach an interface N.B. argument is not same as other drivers
187 1.1 cgd */
188 1.1 cgd int
189 1.1 cgd tunattach (unit)
190 1.1 cgd int unit;
191 1.1 cgd {
192 1.1 cgd register struct ifnet *ifp = &tunctl[unit].tun_if;
193 1.1 cgd register struct sockaddr_in *sin;
194 1.1 cgd
195 1.1 cgd ifp->if_unit = unit;
196 1.1 cgd ifp->if_name = "tun";
197 1.1 cgd ifp->if_mtu = TUNMTU;
198 1.1 cgd ifp->if_ioctl = tunioctl;
199 1.1 cgd ifp->if_output = tunoutput;
200 1.1 cgd ifp->if_init = tuninit;
201 1.1 cgd #ifndef BSD4_3
202 1.1 cgd sin = (struct sockaddr_in *) & ifp->if_addr;
203 1.1 cgd sin->sin_family = AF_INET;
204 1.1 cgd #endif
205 1.1 cgd ifp->if_flags = IFF_POINTOPOINT;
206 1.1 cgd ifp->if_snd.ifq_maxlen = ifqmaxlen;
207 1.1 cgd ifp->if_collisions = ifp->if_ierrors = ifp->if_oerrors = 0;
208 1.1 cgd ifp->if_ipackets = ifp->if_opackets = 0;
209 1.1 cgd if_attach (ifp);
210 1.1 cgd TUNDEBUG ("%s%d: tunattach\n", ifp->if_name, ifp->if_unit);
211 1.1 cgd return 0;
212 1.1 cgd }
213 1.1 cgd
214 1.1 cgd int
215 1.1 cgd tuninit (unit)
216 1.1 cgd int unit;
217 1.1 cgd {
218 1.1 cgd register struct tunctl *tp = &tunctl[unit];
219 1.1 cgd register struct ifnet *ifp = &tp->tun_if;
220 1.1 cgd #ifndef BSD4_3
221 1.1 cgd register struct sockaddr_in *sin;
222 1.1 cgd
223 1.1 cgd sin = (struct sockaddr_in *) & ifp->if_addr;
224 1.1 cgd if (sin->sin_addr.s_addr == 0) /* if address still unknown */
225 1.1 cgd return;
226 1.1 cgd if_rtinit (ifp, RTF_UP);
227 1.1 cgd #endif
228 1.1 cgd ifp->if_flags |= IFF_UP | IFF_RUNNING;
229 1.1 cgd tp->tun_flags |= TUN_IASET;
230 1.1 cgd TUNDEBUG ("%s%d: tuninit\n", ifp->if_name, ifp->if_unit);
231 1.1 cgd return 0;
232 1.1 cgd }
233 1.1 cgd
234 1.1 cgd /*
235 1.1 cgd * Process an ioctl request.
236 1.1 cgd * The problem here is 4.2 pass a struct ifreq * to this routine,
237 1.1 cgd * sun only passes a struct sockaddr * since 3.2 at least. This is
238 1.1 cgd * rather upsetting! Also, sun doesn't pass the SIOCDSTADDR ioctl through
239 1.1 cgd * so we can't detect this being set directly. This is the reason for
240 1.1 cgd * tuncheckready.
241 1.1 cgd * Under 4.3 and SunOs 4.0 we now get the SIOCSIFDSTADDR ioctl, and we get a
242 1.1 cgd * struct in_ifaddr * for data. (tte)
243 1.1 cgd */
244 1.1 cgd
245 1.1 cgd #if !defined(BSD4_3) && defined(sun)
246 1.1 cgd
247 1.1 cgd /*
248 1.1 cgd * workaround for not being able to detect DSTADDR being set.
249 1.1 cgd */
250 1.1 cgd
251 1.1 cgd tuncheckready (ifp)
252 1.1 cgd struct ifnet *ifp;
253 1.1 cgd {
254 1.1 cgd struct tunctl *tp = &tunctl[ifp->if_unit];
255 1.1 cgd struct sockaddr_in *sin;
256 1.1 cgd
257 1.1 cgd sin = (struct sockaddr_in *) &ifp->if_dstaddr;
258 1.1 cgd if (sin->sin_addr.s_addr == 0)
259 1.1 cgd return 0;
260 1.1 cgd tp -> tun_flags |= TUN_DSTADDR;
261 1.1 cgd return 1;
262 1.1 cgd }
263 1.1 cgd #else
264 1.1 cgd #define tuncheckready(dummy) 1
265 1.1 cgd #endif /* !defined(BSD4_3) && defined(sun) */
266 1.1 cgd
267 1.1 cgd int
268 1.1 cgd tunioctl (ifp, cmd, data)
269 1.1 cgd register struct ifnet *ifp;
270 1.1 cgd int cmd;
271 1.1 cgd caddr_t data;
272 1.1 cgd {
273 1.1 cgd #ifndef BSD4_3
274 1.1 cgd #ifdef sun
275 1.1 cgd struct sockaddr_in *sin = (struct sockaddr_in *) data;
276 1.1 cgd #else
277 1.1 cgd struct sockaddr_in *sin;
278 1.1 cgd struct ifreq *ifr = (struct ifreq *) data;
279 1.1 cgd #endif
280 1.1 cgd #endif /* BSD4_3 */
281 1.1 cgd
282 1.1 cgd int s = splimp (), error = 0;
283 1.1 cgd struct tunctl *tp = &tunctl[ifp->if_unit];
284 1.1 cgd
285 1.1 cgd switch (cmd)
286 1.1 cgd {
287 1.1 cgd case SIOCSIFADDR:
288 1.1 cgd #ifndef BSD4_3
289 1.1 cgd if (ifp->if_flags & IFF_RUNNING)
290 1.1 cgd if_rtinit (ifp, -1); /* delete previous route */
291 1.1 cgd #ifndef sun
292 1.1 cgd sin = (struct sockaddr_in *)&ifr -> ifr_addr;
293 1.1 cgd #endif
294 1.1 cgd ifp->if_addr = *((struct sockaddr *) sin);
295 1.1 cgd ifp->if_net = in_netof (sin->sin_addr);
296 1.1 cgd ifp->if_host[0] = in_lnaof (sin->sin_addr);
297 1.1 cgd #endif
298 1.1 cgd tuninit (ifp->if_unit);
299 1.1 cgd break;
300 1.1 cgd case SIOCSIFDSTADDR:
301 1.1 cgd tp->tun_flags |= TUN_DSTADDR;
302 1.1 cgd #ifndef BSD4_3
303 1.1 cgd #ifndef sun
304 1.1 cgd sin = (struct sockaddr_in *)&ifr -> ifr_addr;
305 1.1 cgd #endif
306 1.1 cgd ifp->if_dstaddr = *((struct sockaddr *)sin);
307 1.1 cgd #endif BSD4_3
308 1.1 cgd TUNDEBUG ("%s%d: destination addres set\n", ifp->if_name,
309 1.1 cgd ifp -> if_unit);
310 1.1 cgd break;
311 1.1 cgd default:
312 1.1 cgd error = EINVAL;
313 1.1 cgd }
314 1.1 cgd splx (s);
315 1.1 cgd return (error);
316 1.1 cgd }
317 1.1 cgd
318 1.1 cgd /*
319 1.1 cgd * tunoutput - queue packets from higher level ready to put out.
320 1.1 cgd */
321 1.1 cgd tunoutput (ifp, m0, dst)
322 1.1 cgd struct ifnet *ifp;
323 1.1 cgd struct mbuf *m0;
324 1.1 cgd struct sockaddr *dst;
325 1.1 cgd {
326 1.1 cgd struct tunctl *tp;
327 1.1 cgd struct proc *p;
328 1.1 cgd int s;
329 1.1 cgd
330 1.1 cgd TUNDEBUG ("%s%d: tunoutput\n", ifp->if_name, ifp->if_unit);
331 1.1 cgd tp = &tunctl[ifp->if_unit];
332 1.1 cgd if ((tp->tun_flags & TUN_READY) != TUN_READY) {
333 1.1 cgd if(tuncheckready(ifp) == 0) {
334 1.1 cgd TUNDEBUG ("%s%d: not ready 0%o\n", ifp->if_name,
335 1.1 cgd ifp->if_unit, tp->tun_flags);
336 1.1 cgd m_freem (m0);
337 1.1 cgd return EHOSTDOWN;
338 1.1 cgd }
339 1.1 cgd }
340 1.1 cgd
341 1.1 cgd switch (dst->sa_family) {
342 1.1 cgd #ifdef INET
343 1.1 cgd case AF_INET:
344 1.1 cgd s = splimp ();
345 1.1 cgd if (IF_QFULL (&ifp->if_snd))
346 1.1 cgd {
347 1.1 cgd IF_DROP (&ifp->if_snd);
348 1.1 cgd m_freem (m0);
349 1.1 cgd splx (s);
350 1.1 cgd ifp->if_collisions++;
351 1.1 cgd return (ENOBUFS);
352 1.1 cgd }
353 1.1 cgd IF_ENQUEUE (&ifp->if_snd, m0);
354 1.1 cgd splx (s);
355 1.1 cgd ifp->if_opackets++;
356 1.1 cgd break;
357 1.1 cgd #endif
358 1.1 cgd default:
359 1.1 cgd m_freem (m0);
360 1.1 cgd return EAFNOSUPPORT;
361 1.1 cgd }
362 1.1 cgd
363 1.1 cgd if (tp->tun_flags & TUN_RWAIT) {
364 1.1 cgd tp->tun_flags &= ~TUN_RWAIT;
365 1.1 cgd wakeup ((caddr_t) tp);
366 1.1 cgd }
367 1.1 cgd if (tp->tun_flags & TUN_ASYNC && tp -> tun_pgrp != 0) {
368 1.1 cgd if (tp->tun_pgrp > 0)
369 1.1 cgd gsignal (tp->tun_pgrp, SIGIO);
370 1.2 cgd else if ((p = pfind (-tp->tun_pgrp)) != 0)
371 1.1 cgd psignal (p, SIGIO);
372 1.1 cgd }
373 1.1 cgd selwakeup (&tp->tun_rsel);
374 1.1 cgd return 0;
375 1.1 cgd }
376 1.1 cgd
377 1.1 cgd /*
378 1.1 cgd * the cdevsw interface is now pretty minimal.
379 1.1 cgd */
380 1.1 cgd
381 1.1 cgd tuncioctl (dev, cmd, data, flag)
382 1.1 cgd dev_t dev;
383 1.1 cgd caddr_t data;
384 1.1 cgd {
385 1.1 cgd int unit = minor(dev);
386 1.1 cgd struct tunctl *tp = &tunctl[unit];
387 1.1 cgd int s;
388 1.1 cgd
389 1.1 cgd switch (cmd) {
390 1.1 cgd case TUNSDEBUG:
391 1.1 cgd tundebug = *(int *)data;
392 1.1 cgd break;
393 1.1 cgd
394 1.1 cgd case TUNGDEBUG:
395 1.1 cgd *(int *)data = tundebug;
396 1.1 cgd break;
397 1.1 cgd
398 1.1 cgd case FIONBIO:
399 1.1 cgd if (*(int *)data)
400 1.1 cgd tp->tun_flags |= TUN_NBIO;
401 1.1 cgd else
402 1.1 cgd tp->tun_flags &= ~TUN_NBIO;
403 1.1 cgd break;
404 1.1 cgd
405 1.1 cgd case FIOASYNC:
406 1.1 cgd if (*(int *)data)
407 1.1 cgd tp->tun_flags |= TUN_ASYNC;
408 1.1 cgd else
409 1.1 cgd tp->tun_flags &= ~TUN_ASYNC;
410 1.1 cgd break;
411 1.1 cgd
412 1.1 cgd case FIONREAD:
413 1.1 cgd s = splimp ();
414 1.1 cgd if (tp->tun_if.if_snd.ifq_head)
415 1.1 cgd *(int *)data = tp->tun_if.if_snd.ifq_head->m_len;
416 1.1 cgd else *(int *)data = 0;
417 1.1 cgd splx (s);
418 1.1 cgd break;
419 1.1 cgd
420 1.1 cgd case TIOCSPGRP:
421 1.1 cgd tp->tun_pgrp = *(int *)data;
422 1.1 cgd break;
423 1.1 cgd
424 1.1 cgd case TIOCGPGRP:
425 1.1 cgd *(int *)data = tp->tun_pgrp;
426 1.1 cgd break;
427 1.1 cgd
428 1.1 cgd default:
429 1.1 cgd return (ENOTTY);
430 1.1 cgd }
431 1.1 cgd return (0);
432 1.1 cgd }
433 1.1 cgd
434 1.1 cgd /*
435 1.1 cgd * The cdevsw read interface - reads a packet at a time, or at least as much
436 1.1 cgd * of a packet as can be read.
437 1.1 cgd */
438 1.1 cgd tunread (dev, uio)
439 1.1 cgd dev_t dev;
440 1.1 cgd struct uio *uio;
441 1.1 cgd {
442 1.1 cgd register struct ifnet *ifp;
443 1.1 cgd register struct mbuf *m, *m0;
444 1.1 cgd int unit = minor (dev);
445 1.1 cgd int len, s;
446 1.1 cgd int error = 0;
447 1.1 cgd struct tunctl *tp;
448 1.1 cgd
449 1.1 cgd tp = &tunctl[unit];
450 1.1 cgd ifp = &tp->tun_if;
451 1.1 cgd TUNDEBUG ("%s%d: read\n", ifp->if_name, ifp->if_unit);
452 1.1 cgd if ((tp->tun_flags & TUN_READY) != TUN_READY) {
453 1.1 cgd if(tuncheckready(ifp) == 0) {
454 1.1 cgd TUNDEBUG ("%s%d: not ready 0%o\n", ifp->if_name,
455 1.1 cgd ifp->if_unit, tp->tun_flags);
456 1.1 cgd return EHOSTDOWN;
457 1.1 cgd }
458 1.1 cgd }
459 1.1 cgd
460 1.1 cgd tp->tun_flags &= ~TUN_RWAIT;
461 1.1 cgd
462 1.1 cgd s = splimp ();
463 1.1 cgd do {
464 1.1 cgd IF_DEQUEUE (&ifp->if_snd, m0);
465 1.1 cgd if (m0 == 0) {
466 1.1 cgd if (tp -> tun_flags & TUN_NBIO) {
467 1.1 cgd splx (s);
468 1.1 cgd return EWOULDBLOCK;
469 1.1 cgd }
470 1.1 cgd tp->tun_flags |= TUN_RWAIT;
471 1.1 cgd sleep ((caddr_t) tp, PZERO + 1);
472 1.1 cgd }
473 1.1 cgd } while (m0 == 0);
474 1.1 cgd splx (s);
475 1.1 cgd
476 1.1 cgd while (m0 && uio->uio_resid > 0 && error == 0) {
477 1.1 cgd len = MIN (uio->uio_resid, m0->m_len);
478 1.1 cgd if (len == 0)
479 1.1 cgd break;
480 1.1 cgd error = uiomove (mtod (m0, caddr_t), len,
481 1.1 cgd UIO_READ, uio);
482 1.1 cgd MFREE (m0, m);
483 1.1 cgd m0 = m;
484 1.1 cgd }
485 1.1 cgd
486 1.1 cgd if (m0 != 0) {
487 1.1 cgd TUNDEBUG ("Dropping mbuf\n");
488 1.1 cgd m_freem (m0);
489 1.1 cgd }
490 1.1 cgd return error;
491 1.1 cgd }
492 1.1 cgd
493 1.1 cgd /*
494 1.1 cgd * the cdevsw write interface - an atomic write is a packet - or else!
495 1.1 cgd */
496 1.1 cgd
497 1.1 cgd tunwrite (dev, uio)
498 1.1 cgd int dev;
499 1.1 cgd struct uio *uio;
500 1.1 cgd {
501 1.1 cgd int error = 0;
502 1.1 cgd int unit = minor (dev);
503 1.1 cgd struct mbuf *top, **mp, *m;
504 1.1 cgd struct ifnet *ifp = &(tunctl[unit].tun_if);
505 1.1 cgd int s;
506 1.1 cgd
507 1.1 cgd TUNDEBUG ("%s%d: tunwrite\n", ifp->if_name, ifp->if_unit);
508 1.1 cgd
509 1.1 cgd if (uio->uio_resid < 0 || uio->uio_resid > TUNMTU) {
510 1.1 cgd TUNDEBUG ("%s%d: len=%d!\n", ifp->if_name, ifp->if_unit,
511 1.1 cgd uio->uio_resid);
512 1.1 cgd return EIO;
513 1.1 cgd }
514 1.1 cgd top = 0;
515 1.1 cgd mp = ⊤
516 1.1 cgd while (error == 0 && uio->uio_resid > 0) {
517 1.1 cgd MGET (m, M_DONTWAIT, MT_DATA);
518 1.1 cgd if (m == 0) {
519 1.1 cgd error = ENOBUFS;
520 1.1 cgd break;
521 1.1 cgd }
522 1.1 cgd m->m_len = MIN (MLEN, uio->uio_resid);
523 1.1 cgd error = uiomove (mtod (m, caddr_t), m->m_len, UIO_WRITE, uio);
524 1.1 cgd *mp = m;
525 1.1 cgd mp = &m->m_next;
526 1.1 cgd }
527 1.1 cgd if (error) {
528 1.1 cgd if (top)
529 1.1 cgd m_freem (top);
530 1.1 cgd return error;
531 1.1 cgd }
532 1.1 cgd
533 1.1 cgd #ifdef BSD4_3
534 1.1 cgd /*
535 1.1 cgd * Place interface pointer before the data
536 1.1 cgd * for the receiving protocol.
537 1.1 cgd */
538 1.1 cgd if (top->m_off <= MMAXOFF &&
539 1.1 cgd top->m_off >= MMINOFF + sizeof(struct ifnet *)) {
540 1.1 cgd top->m_off -= sizeof(struct ifnet *);
541 1.1 cgd top->m_len += sizeof(struct ifnet *);
542 1.1 cgd } else {
543 1.1 cgd MGET(m, M_DONTWAIT, MT_HEADER);
544 1.1 cgd if (m == (struct mbuf *)0)
545 1.1 cgd return (ENOBUFS);
546 1.1 cgd m->m_len = sizeof(struct ifnet *);
547 1.1 cgd m->m_next = top;
548 1.1 cgd top = m;
549 1.1 cgd }
550 1.1 cgd *(mtod(top, struct ifnet **)) = ifp;
551 1.1 cgd #endif /* BSD4_3 */
552 1.1 cgd
553 1.1 cgd s = splimp ();
554 1.1 cgd if (IF_QFULL (&ipintrq)) {
555 1.1 cgd IF_DROP (&ipintrq);
556 1.1 cgd splx (s);
557 1.1 cgd ifp->if_collisions++;
558 1.1 cgd m_freem (top);
559 1.1 cgd return ENOBUFS;
560 1.1 cgd }
561 1.1 cgd IF_ENQUEUE (&ipintrq, top);
562 1.1 cgd splx (s);
563 1.1 cgd ifp->if_ipackets++;
564 1.1 cgd schednetisr (NETISR_IP);
565 1.1 cgd return error;
566 1.1 cgd }
567 1.1 cgd
568 1.1 cgd /*
569 1.1 cgd * tunselect - the select interface, this is only useful on reads really.
570 1.1 cgd * The write detect always returns true, write never blocks anyway, it either
571 1.1 cgd * accepts the packet or drops it.
572 1.1 cgd */
573 1.1 cgd tunselect (dev, rw)
574 1.1 cgd dev_t dev;
575 1.1 cgd int rw;
576 1.1 cgd {
577 1.1 cgd int unit = minor (dev);
578 1.1 cgd register struct tunctl *tp = &tunctl[unit];
579 1.1 cgd struct ifnet *ifp = &tp->tun_if;
580 1.1 cgd int s = splimp ();
581 1.1 cgd
582 1.1 cgd TUNDEBUG ("%s%d: tunselect\n", ifp->if_name, ifp->if_unit);
583 1.1 cgd switch (rw) {
584 1.1 cgd case FREAD:
585 1.1 cgd if (ifp->if_snd.ifq_len > 0) {
586 1.1 cgd splx (s);
587 1.1 cgd TUNDEBUG ("%s%d: tunselect q=%d\n", ifp->if_name,
588 1.2 cgd ifp->if_unit, ifp->if_snd.ifq_len);
589 1.1 cgd return 1;
590 1.1 cgd }
591 1.1 cgd selrecord(p, &tp->tun_rsel);
592 1.1 cgd break;
593 1.1 cgd case FWRITE:
594 1.1 cgd splx (s);
595 1.1 cgd return 1;
596 1.1 cgd }
597 1.1 cgd splx (s);
598 1.1 cgd TUNDEBUG ("%s%d: tunselect waiting\n", ifp->if_name, ifp->if_unit);
599 return 0;
600 }
601 #endif NTUN
602