bpf: Use bpf global token instead mplock to protect bpf stuffs
[dragonfly.git] / sys / net / sl / if_sl.c
1 /*
2  * (MPSAFE)
3  *
4  * Copyright (c) 1987, 1989, 1992, 1993
5  *      The Regents of the University of California.  All rights reserved.
6  *
7  * Redistribution and use in source and binary forms, with or without
8  * modification, are permitted provided that the following conditions
9  * are met:
10  * 1. Redistributions of source code must retain the above copyright
11  *    notice, this list of conditions and the following disclaimer.
12  * 2. Redistributions in binary form must reproduce the above copyright
13  *    notice, this list of conditions and the following disclaimer in the
14  *    documentation and/or other materials provided with the distribution.
15  * 3. All advertising materials mentioning features or use of this software
16  *    must display the following acknowledgement:
17  *      This product includes software developed by the University of
18  *      California, Berkeley and its contributors.
19  * 4. Neither the name of the University nor the names of its contributors
20  *    may be used to endorse or promote products derived from this software
21  *    without specific prior written permission.
22  *
23  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
24  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
25  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
26  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
27  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
28  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
29  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
30  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
31  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
32  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
33  * SUCH DAMAGE.
34  *
35  *      @(#)if_sl.c     8.6 (Berkeley) 2/1/94
36  * $FreeBSD: src/sys/net/if_sl.c,v 1.84.2.2 2002/02/13 00:43:10 dillon Exp $
37  * $DragonFly: src/sys/net/sl/if_sl.c,v 1.32 2008/05/14 11:59:23 sephe Exp $
38  */
39
40 /*
41  * Serial Line interface
42  *
43  * Rick Adams
44  * Center for Seismic Studies
45  * 1300 N 17th Street, Suite 1450
46  * Arlington, Virginia 22209
47  * (703)276-7900
48  * rick@seismo.ARPA
49  * seismo!rick
50  *
51  * Pounded on heavily by Chris Torek (chris@mimsy.umd.edu, umcp-cs!chris).
52  * N.B.: this belongs in netinet, not net, the way it stands now.
53  * Should have a link-layer type designation, but wouldn't be
54  * backwards-compatible.
55  *
56  * Converted to 4.3BSD Beta by Chris Torek.
57  * Other changes made at Berkeley, based in part on code by Kirk Smith.
58  * W. Jolitz added slip abort.
59  *
60  * Hacked almost beyond recognition by Van Jacobson (van@helios.ee.lbl.gov).
61  * Added priority queuing for "interactive" traffic; hooks for TCP
62  * header compression; ICMP filtering (at 2400 baud, some cretin
63  * pinging you can use up all your bandwidth).  Made low clist behavior
64  * more robust and slightly less likely to hang serial line.
65  * Sped up a bunch of things.
66  */
67
68 #include "use_sl.h"
69
70 #include "opt_inet.h"
71 #if !defined(KLD_MODULE)
72 #include "opt_slip.h"
73 #endif
74 #include <sys/param.h>
75 #include <sys/systm.h>
76 #include <sys/proc.h>
77 #include <sys/priv.h>
78 #include <sys/malloc.h>
79 #include <sys/mbuf.h>
80 #include <sys/dkstat.h>
81 #include <sys/socket.h>
82 #include <sys/sockio.h>
83 #include <sys/fcntl.h>
84 #include <sys/signalvar.h>
85 #include <sys/tty.h>
86 #include <sys/clist.h>
87 #include <sys/kernel.h>
88 #include <sys/conf.h>
89 #include <sys/thread2.h>
90
91 #include <net/if.h>
92 #include <net/if_types.h>
93 #include <net/ifq_var.h>
94 #include <net/netisr.h>
95
96 #if INET
97 #include <netinet/in.h>
98 #include <netinet/in_systm.h>
99 #include <netinet/in_var.h>
100 #include <netinet/ip.h>
101 #else
102 #error "Huh? Slip without inet?"
103 #endif
104
105 #include <net/slcompress.h>
106 #include "if_slvar.h"
107 #include <net/slip.h>
108
109 #include <net/bpf.h>
110
111 static void slattach (void *);
112 PSEUDO_SET(slattach, if_sl);
113
114 /*
115  * SLRMAX is a hard limit on input packet size.  To simplify the code
116  * and improve performance, we require that packets fit in an mbuf
117  * cluster, and if we get a compressed packet, there's enough extra
118  * room to expand the header into a max length tcp/ip header (128
119  * bytes).  So, SLRMAX can be at most
120  *      MCLBYTES - 128
121  *
122  * SLMTU is the default transmit MTU. The transmit MTU should be kept
123  * small enough so that interactive use doesn't suffer, but large
124  * enough to provide good performance. 552 is a good choice for SLMTU
125  * because it is high enough to not fragment TCP packets being routed
126  * through this host. Packet fragmentation is bad with SLIP because
127  * fragment headers aren't compressed. The previous assumptions about
128  * the best MTU value don't really hold when using modern modems with
129  * BTLZ data compression because the modem buffers play a much larger
130  * role in interactive performance than the MTU. The MTU can be changed
131  * at any time to suit the specific environment with ifconfig(8), and
132  * its maximum value is defined as SLTMAX. SLTMAX must not be so large
133  * that it would overflow the stack if BPF is configured (XXX; if_ppp.c
134  * handles this better).
135  *
136  * SLIP_HIWAT is the amount of data that will be queued 'downstream'
137  * of us (i.e., in clists waiting to be picked up by the tty output
138  * interrupt).  If we queue a lot of data downstream, it's immune to
139  * our t.o.s. queuing.
140  * E.g., if SLIP_HIWAT is 1024, the interactive traffic in mixed
141  * telnet/ftp will see a 1 sec wait, independent of the mtu (the
142  * wait is dependent on the ftp window size but that's typically
143  * 1k - 4k).  So, we want SLIP_HIWAT just big enough to amortize
144  * the cost (in idle time on the wire) of the tty driver running
145  * off the end of its clists & having to call back slstart for a
146  * new packet.  For a tty interface with any buffering at all, this
147  * cost will be zero.  Even with a totally brain dead interface (like
148  * the one on a typical workstation), the cost will be <= 1 character
149  * time.  So, setting SLIP_HIWAT to ~100 guarantees that we'll lose
150  * at most 1% while maintaining good interactive response.
151  */
152 #define BUFOFFSET       (128+sizeof(struct ifnet **)+SLIP_HDRLEN)
153 #define SLRMAX          (MCLBYTES - BUFOFFSET)
154 #define SLBUFSIZE       (SLRMAX + BUFOFFSET)
155 #ifndef SLMTU
156 #define SLMTU           552             /* default MTU */
157 #endif
158 #define SLTMAX          1500            /* maximum MTU */
159 #define SLIP_HIWAT      roundup(50,CBSIZE)
160 #define CLISTRESERVE    1024            /* Can't let clists get too low */
161
162 /*
163  * SLIP ABORT ESCAPE MECHANISM:
164  *      (inspired by HAYES modem escape arrangement)
165  *      1sec escape 1sec escape 1sec escape { 1sec escape 1sec escape }
166  *      within window time signals a "soft" exit from slip mode by remote end
167  *      if the IFF_DEBUG flag is on.
168  */
169 #define ABT_ESC         '\033'  /* can't be t_intr - distant host must know it*/
170 #define ABT_IDLE        1       /* in seconds - idle before an escape */
171 #define ABT_COUNT       3       /* count of escapes for abort */
172 #define ABT_WINDOW      (ABT_COUNT*2+2) /* in seconds - time to count */
173
174 static struct sl_softc sl_softc[NSL];
175
176 #define FRAME_END               0xc0            /* Frame End */
177 #define FRAME_ESCAPE            0xdb            /* Frame Esc */
178 #define TRANS_FRAME_END         0xdc            /* transposed frame end */
179 #define TRANS_FRAME_ESCAPE      0xdd            /* transposed frame esc */
180
181 static int slinit (struct sl_softc *);
182 static struct mbuf *sl_btom (struct sl_softc *, int);
183 static timeout_t sl_keepalive;
184 static timeout_t sl_outfill;
185 static int      slclose (struct tty *,int);
186 static int      slinput (int, struct tty *);
187 static int      slioctl (struct ifnet *, u_long, caddr_t, struct ucred *);
188 static int      sltioctl (struct tty *, u_long, caddr_t, int, struct ucred *);
189 static int      slopen (cdev_t, struct tty *);
190 static int      sloutput (struct ifnet *,
191             struct mbuf *, struct sockaddr *, struct rtentry *);
192 static int      slstart (struct tty *);
193
194 static struct linesw slipdisc = {
195         slopen,         slclose,        l_noread,       l_nowrite,
196         sltioctl,       slinput,        slstart,        ttymodem,
197         FRAME_END
198 };
199
200 /*
201  * Called from boot code to establish sl interfaces.
202  */
203 static void
204 slattach(void *dummy)
205 {
206         struct sl_softc *sc;
207         int i = 0;
208
209         lwkt_gettoken(&tty_token);
210         linesw[SLIPDISC] = slipdisc;
211
212         for (sc = sl_softc; i < NSL; sc++) {
213                 if_initname(&(sc->sc_if), "sl", i++);
214                 sc->sc_if.if_mtu = SLMTU;
215                 sc->sc_if.if_flags =
216 #ifdef SLIP_IFF_OPTS
217                     SLIP_IFF_OPTS;
218 #else
219                     IFF_POINTOPOINT | SC_AUTOCOMP | IFF_MULTICAST;
220 #endif
221                 sc->sc_if.if_type = IFT_SLIP;
222                 sc->sc_if.if_ioctl = slioctl;
223                 sc->sc_if.if_output = sloutput;
224                 ifq_set_maxlen(&sc->sc_if.if_snd, 50);
225                 ifq_set_ready(&sc->sc_if.if_snd);
226                 sc->sc_fastq.ifq_maxlen = 32;
227                 sc->sc_if.if_linkmib = sc;
228                 sc->sc_if.if_linkmiblen = sizeof *sc;
229                 callout_init_mp(&sc->sc_oftimeout);
230                 callout_init_mp(&sc->sc_katimeout);
231                 if_attach(&sc->sc_if, NULL);
232                 bpfattach(&sc->sc_if, DLT_SLIP, SLIP_HDRLEN);
233         }
234         lwkt_reltoken(&tty_token);
235 }
236
237 static int
238 slinit(struct sl_softc *sc)
239 {
240         lwkt_gettoken(&tty_token);
241         if (sc->sc_ep == NULL)
242                 sc->sc_ep = kmalloc(SLBUFSIZE, M_DEVBUF, M_WAITOK);
243         sc->sc_buf = sc->sc_ep + SLBUFSIZE - SLRMAX;
244         sc->sc_mp = sc->sc_buf;
245         sl_compress_init(&sc->sc_comp, -1);
246         lwkt_reltoken(&tty_token);
247         return (1);
248 }
249
250 /*
251  * Line specific open routine.
252  * Attach the given tty to the first available sl unit.
253  */
254 /* ARGSUSED */
255 static int
256 slopen(cdev_t dev, struct tty *tp)
257 {
258         struct sl_softc *sc;
259         int nsl;
260         int error;
261         struct thread *td = curthread;  /* XXX */
262
263         error = priv_check(td, PRIV_ROOT);
264         if (error)
265                 return (error);
266
267         lwkt_gettoken(&tty_token);
268         if (tp->t_line == SLIPDISC) {
269                 lwkt_reltoken(&tty_token);
270                 return (0);
271         }
272
273         for (nsl = NSL, sc = sl_softc; --nsl >= 0; sc++)
274                 if (sc->sc_ttyp == NULL && !(sc->sc_flags & SC_STATIC)) {
275                         if (slinit(sc) == 0) {
276                                 lwkt_reltoken(&tty_token);
277                                 return (ENOBUFS);
278                         }
279                         tp->t_sc = (caddr_t)sc;
280                         sc->sc_ttyp = tp;
281                         sc->sc_if.if_baudrate = tp->t_ospeed;
282                         ttyflush(tp, FREAD | FWRITE);
283
284                         tp->t_line = SLIPDISC;
285                         /*
286                          * We don't use t_canq or t_rawq, so reduce their
287                          * cblock resources to 0.  Reserve enough cblocks
288                          * for t_outq to guarantee that we can fit a full
289                          * packet if the SLIP_HIWAT check allows slstart()
290                          * to loop.  Use the same value for the cblock
291                          * limit since the reserved blocks should always
292                          * be enough.  Reserving cblocks probably makes
293                          * the CLISTRESERVE check unnecessary and wasteful.
294                          */
295                         clist_alloc_cblocks(&tp->t_canq, 0, 0);
296                         clist_alloc_cblocks(&tp->t_outq,
297                             SLIP_HIWAT + 2 * sc->sc_if.if_mtu + 1,
298                             SLIP_HIWAT + 2 * sc->sc_if.if_mtu + 1);
299                         clist_alloc_cblocks(&tp->t_rawq, 0, 0);
300
301                         crit_enter();
302                         if_up(&sc->sc_if);
303                         crit_exit();
304                         lwkt_reltoken(&tty_token);
305                         return (0);
306                 }
307         lwkt_reltoken(&tty_token);
308         return (ENXIO);
309 }
310
311 /*
312  * Line specific close routine.
313  * Detach the tty from the sl unit.
314  */
315 static int
316 slclose(struct tty *tp, int flag)
317 {
318         struct sl_softc *sc;
319
320         lwkt_gettoken(&tty_token);
321         ttyflush(tp, FREAD | FWRITE);
322         crit_enter();
323
324         clist_free_cblocks(&tp->t_outq);
325         tp->t_line = 0;
326         sc = (struct sl_softc *)tp->t_sc;
327         if (sc != NULL) {
328                 if (sc->sc_outfill) {
329                         sc->sc_outfill = 0;
330                         callout_stop(&sc->sc_oftimeout);
331                 }
332                 if (sc->sc_keepalive) {
333                         sc->sc_keepalive = 0;
334                         callout_stop(&sc->sc_katimeout);
335                 }
336                 if_down(&sc->sc_if);
337                 sc->sc_flags &= SC_STATIC;
338                 sc->sc_ttyp = NULL;
339                 tp->t_sc = NULL;
340                 if (sc->sc_ep) {
341                         kfree(sc->sc_ep, M_DEVBUF);
342                         sc->sc_ep = NULL;
343                 }
344                 sc->sc_mp = 0;
345                 sc->sc_buf = 0;
346         }
347         crit_exit();
348         lwkt_reltoken(&tty_token);
349         return 0;
350 }
351
352 /*
353  * Line specific (tty) ioctl routine.
354  * Provide a way to get the sl unit number.
355  */
356 /* ARGSUSED */
357 static int
358 sltioctl(struct tty *tp, u_long cmd, caddr_t data, int flag, struct ucred *cred)
359 {
360         struct sl_softc *sc = (struct sl_softc *)tp->t_sc, *nc, *tmpnc;
361         int nsl;
362
363         crit_enter();
364         lwkt_gettoken(&tty_token);
365
366         switch (cmd) {
367         case SLIOCGUNIT:
368                 *(int *)data = sc->sc_if.if_dunit;
369                 break;
370
371         case SLIOCSUNIT:
372                 if (sc->sc_if.if_dunit != *(u_int *)data) {
373                         for (nsl = NSL, nc = sl_softc; --nsl >= 0; nc++) {
374                                 if (   nc->sc_if.if_dunit == *(u_int *)data
375                                     && nc->sc_ttyp == NULL
376                                    ) {
377                                         tmpnc = kmalloc(sizeof *tmpnc, M_TEMP,
378                                                        M_WAITOK);
379                                         *tmpnc = *nc;
380                                         *nc = *sc;
381                                         nc->sc_if = tmpnc->sc_if;
382                                         tmpnc->sc_if = sc->sc_if;
383                                         *sc = *tmpnc;
384                                         kfree(tmpnc, M_TEMP);
385                                         if (sc->sc_if.if_flags & IFF_UP) {
386                                                 if_down(&sc->sc_if);
387                                                 if (!(nc->sc_if.if_flags & IFF_UP))
388                                                         if_up(&nc->sc_if);
389                                         } else if (nc->sc_if.if_flags & IFF_UP)
390                                                 if_down(&nc->sc_if);
391                                         sc->sc_flags &= ~SC_STATIC;
392                                         sc->sc_flags |= (nc->sc_flags & SC_STATIC);
393                                         tp->t_sc = sc = nc;
394                                         clist_alloc_cblocks(&tp->t_outq,
395                                             SLIP_HIWAT + 2 * sc->sc_if.if_mtu + 1,
396                                             SLIP_HIWAT + 2 * sc->sc_if.if_mtu + 1);
397                                         sl_compress_init(&sc->sc_comp, -1);
398                                         goto slfound;
399                                 }
400                         }
401                         lwkt_reltoken(&tty_token);
402                         crit_exit();
403                         return (ENXIO);
404                 }
405         slfound:
406                 sc->sc_flags |= SC_STATIC;
407                 break;
408
409         case SLIOCSKEEPAL:
410                 sc->sc_keepalive = *(u_int *)data * hz;
411                 if (sc->sc_keepalive) {
412                         sc->sc_flags |= SC_KEEPALIVE;
413                         callout_reset(&sc->sc_katimeout, sc->sc_keepalive,
414                                         sl_keepalive, sc);
415                 } else {
416                         if ((sc->sc_flags & SC_KEEPALIVE) != 0) {
417                                 callout_stop(&sc->sc_katimeout);
418                                 sc->sc_flags &= ~SC_KEEPALIVE;
419                         }
420                 }
421                 break;
422
423         case SLIOCGKEEPAL:
424                 *(int *)data = sc->sc_keepalive / hz;
425                 break;
426
427         case SLIOCSOUTFILL:
428                 sc->sc_outfill = *(u_int *)data * hz;
429                 if (sc->sc_outfill) {
430                         sc->sc_flags |= SC_OUTWAIT;
431                         callout_reset(&sc->sc_oftimeout, sc->sc_outfill, 
432                                         sl_outfill, sc);
433                 } else {
434                         if ((sc->sc_flags & SC_OUTWAIT) != 0) {
435                                 callout_stop(&sc->sc_oftimeout);
436                                 sc->sc_flags &= ~SC_OUTWAIT;
437                         }
438                 }
439                 break;
440
441         case SLIOCGOUTFILL:
442                 *(int *)data = sc->sc_outfill / hz;
443                 break;
444
445         default:
446                 lwkt_reltoken(&tty_token);
447                 crit_exit();
448                 return (ENOIOCTL);
449         }
450         lwkt_reltoken(&tty_token);
451         crit_exit();
452         return (0);
453 }
454
455 /*
456  * Queue a packet.  Start transmission if not active.
457  * Compression happens in slstart; if we do it here, IP TOS
458  * will cause us to not compress "background" packets, because
459  * ordering gets trashed.  It can be done for all packets in slstart.
460  */
461 static int
462 sloutput_serialized(struct ifnet *ifp, struct mbuf *m, struct sockaddr *dst,
463                     struct rtentry *rtp)
464 {
465         struct sl_softc *sc = &sl_softc[ifp->if_dunit];
466         struct ip *ip;
467         int error;
468         struct altq_pktattr pktattr;
469
470         ifq_classify(&ifp->if_snd, m, dst->sa_family, &pktattr);
471
472         /*
473          * `Cannot happen' (see slioctl).  Someday we will extend
474          * the line protocol to support other address families.
475          */
476         if (dst->sa_family != AF_INET) {
477                 kprintf("%s: af%d not supported\n", sc->sc_if.if_xname,
478                         dst->sa_family);
479                 m_freem(m);
480                 sc->sc_if.if_noproto++;
481                 return (EAFNOSUPPORT);
482         }
483
484         if (sc->sc_ttyp == NULL || !(ifp->if_flags & IFF_UP)) {
485                 m_freem(m);
486                 return (ENETDOWN);
487         }
488         if ((sc->sc_ttyp->t_state & TS_CONNECTED) == 0) {
489                 m_freem(m);
490                 return (EHOSTUNREACH);
491         }
492         ip = mtod(m, struct ip *);
493         if (sc->sc_if.if_flags & SC_NOICMP && ip->ip_p == IPPROTO_ICMP) {
494                 m_freem(m);
495                 return (ENETRESET);             /* XXX ? */
496         }
497
498         crit_enter();
499
500         if ((ip->ip_tos & IPTOS_LOWDELAY) && !ifq_is_enabled(&sc->sc_if.if_snd)) {
501                 if (IF_QFULL(&sc->sc_fastq)) {
502                         IF_DROP(&sc->sc_fastq);
503                         m_freem(m);
504                         error = ENOBUFS;
505                 } else {
506                         IF_ENQUEUE(&sc->sc_fastq, m);
507                         error = 0;
508                 }
509         } else {
510                 error = ifq_enqueue(&sc->sc_if.if_snd, m, &pktattr);
511         }
512         if (error) {
513                 sc->sc_if.if_oerrors++;
514                 crit_exit();
515                 return (error);
516         }
517         if (sc->sc_ttyp->t_outq.c_cc == 0)
518                 slstart(sc->sc_ttyp);
519         crit_exit();
520         return (0);
521 }
522
523 static int
524 sloutput(struct ifnet *ifp, struct mbuf *m, struct sockaddr *dst,
525          struct rtentry *rtp)
526 {
527         int error;
528
529         ifnet_serialize_tx(ifp);
530         error = sloutput_serialized(ifp, m, dst, rtp);
531         ifnet_deserialize_tx(ifp);
532
533         return error;
534 }
535
536 /*
537  * Start output on interface.  Get another datagram
538  * to send from the interface queue and map it to
539  * the interface before starting output.
540  */
541 static int
542 slstart(struct tty *tp)
543 {
544         struct sl_softc *sc = (struct sl_softc *)tp->t_sc;
545         struct mbuf *m;
546         u_char *cp;
547         struct ip *ip;
548         u_char bpfbuf[SLTMAX + SLIP_HDRLEN];
549         int len = 0;
550
551         lwkt_gettoken(&tty_token);
552         for (;;) {
553                 /*
554                  * Call output process whether or not there is more in the
555                  * output queue.  We are being called in lieu of ttstart
556                  * and must do what it would.
557                  */
558                 (*tp->t_oproc)(tp);
559
560                 if (tp->t_outq.c_cc != 0) {
561                         if (sc != NULL)
562                                 sc->sc_flags &= ~SC_OUTWAIT;
563                         if (tp->t_outq.c_cc > SLIP_HIWAT) {
564                                 lwkt_reltoken(&tty_token);
565                                 return 0;
566                         }
567                 }
568
569                 /*
570                  * This happens briefly when the line shuts down.
571                  */
572                 if (sc == NULL) {
573                         lwkt_reltoken(&tty_token);
574                         return 0;
575                 }
576
577                 /*
578                  * Get a packet and send it to the interface.
579                  */
580                 crit_enter();
581                 IF_DEQUEUE(&sc->sc_fastq, m);
582                 if (m)
583                         sc->sc_if.if_omcasts++;         /* XXX */
584                 else
585                         m = ifq_dequeue(&sc->sc_if.if_snd, NULL);
586                 crit_exit();
587                 if (m == NULL) {
588                         lwkt_reltoken(&tty_token);
589                         return 0;
590                 }
591
592                 /*
593                  * We do the header compression here rather than in sloutput
594                  * because the packets will be out of order if we are using TOS
595                  * queueing, and the connection id compression will get
596                  * munged when this happens.
597                  */
598                 if (sc->sc_if.if_bpf) {
599                         /*
600                          * We need to save the TCP/IP header before it's
601                          * compressed.  To avoid complicated code, we just
602                          * copy the entire packet into a stack buffer (since
603                          * this is a serial line, packets should be short
604                          * and/or the copy should be negligible cost compared
605                          * to the packet transmission time).
606                          */
607                         struct mbuf *m1 = m;
608                         u_char *cp = bpfbuf + SLIP_HDRLEN;
609
610                         len = 0;
611                         do {
612                                 int mlen = m1->m_len;
613
614                                 bcopy(mtod(m1, caddr_t), cp, mlen);
615                                 cp += mlen;
616                                 len += mlen;
617                         } while ((m1 = m1->m_next) != NULL);
618                 }
619                 ip = mtod(m, struct ip *);
620                 if (ip->ip_v == IPVERSION && ip->ip_p == IPPROTO_TCP) {
621                         if (sc->sc_if.if_flags & SC_COMPRESS)
622                                 *mtod(m, u_char *) |= sl_compress_tcp(m, ip,
623                                     &sc->sc_comp, 1);
624                 }
625                 if (sc->sc_if.if_bpf) {
626                         bpf_gettoken();
627
628                         if (sc->sc_if.if_bpf) {
629                                 /*
630                                  * Put the SLIP pseudo-"link header" in place.
631                                  * The compressed header is now at the
632                                  * beginning of the mbuf.
633                                  */
634                                 bpfbuf[SLX_DIR] = SLIPDIR_OUT;
635                                 bcopy(mtod(m, caddr_t), &bpfbuf[SLX_CHDR],
636                                     CHDR_LEN);
637                                 bpf_tap(sc->sc_if.if_bpf, bpfbuf,
638                                     len + SLIP_HDRLEN);
639                         }
640
641                         bpf_reltoken();
642                 }
643
644                 /*
645                  * If system is getting low on clists, just flush our
646                  * output queue (if the stuff was important, it'll get
647                  * retransmitted). Note that SLTMAX is used instead of
648                  * the current if_mtu setting because connections that
649                  * have already been established still use the original
650                  * (possibly larger) mss.
651                  */
652                 if (cfreecount < CLISTRESERVE + SLTMAX) {
653                         m_freem(m);
654                         sc->sc_if.if_collisions++;
655                         continue;
656                 }
657
658                 sc->sc_flags &= ~SC_OUTWAIT;
659                 /*
660                  * The extra FRAME_END will start up a new packet, and thus
661                  * will flush any accumulated garbage.  We do this whenever
662                  * the line may have been idle for some time.
663                  */
664                 if (tp->t_outq.c_cc == 0) {
665                         ++sc->sc_if.if_obytes;
666                         clist_putc(FRAME_END, &tp->t_outq);
667                 }
668
669                 while (m) {
670                         u_char *ep;
671
672                         cp = mtod(m, u_char *); ep = cp + m->m_len;
673                         while (cp < ep) {
674                                 /*
675                                  * Find out how many bytes in the string we can
676                                  * handle without doing something special.
677                                  */
678                                 u_char *bp = cp;
679
680                                 while (cp < ep) {
681                                         switch (*cp++) {
682                                         case FRAME_ESCAPE:
683                                         case FRAME_END:
684                                                 --cp;
685                                                 goto out;
686                                         }
687                                 }
688                                 out:
689                                 if (cp > bp) {
690                                         /*
691                                          * Put n characters at once
692                                          * into the tty output queue.
693                                          */
694                                         if (b_to_q((char *)bp, cp - bp,
695                                             &tp->t_outq))
696                                                 break;
697                                         sc->sc_if.if_obytes += cp - bp;
698                                 }
699                                 /*
700                                  * If there are characters left in the mbuf,
701                                  * the first one must be special..
702                                  * Put it out in a different form.
703                                  */
704                                 if (cp < ep) {
705                                         if (clist_putc(FRAME_ESCAPE, &tp->t_outq))
706                                                 break;
707                                         if (clist_putc(*cp++ == FRAME_ESCAPE ?
708                                            TRANS_FRAME_ESCAPE : TRANS_FRAME_END,
709                                            &tp->t_outq)) {
710                                                 clist_unputc(&tp->t_outq);
711                                                 break;
712                                         }
713                                         sc->sc_if.if_obytes += 2;
714                                 }
715                         }
716                         m = m_free(m);
717                 }
718
719                 if (clist_putc(FRAME_END, &tp->t_outq)) {
720                         /*
721                          * Not enough room.  Remove a char to make room
722                          * and end the packet normally.
723                          * If you get many collisions (more than one or two
724                          * a day) you probably do not have enough clists
725                          * and you should increase "nclist" in param.c.
726                          */
727                         clist_unputc(&tp->t_outq);
728                         clist_putc(FRAME_END, &tp->t_outq);
729                         sc->sc_if.if_collisions++;
730                 } else {
731                         ++sc->sc_if.if_obytes;
732                         sc->sc_if.if_opackets++;
733                 }
734         }
735         lwkt_reltoken(&tty_token);
736         return 0;
737 }
738
739 /*
740  * Copy data buffer to mbuf chain; add ifnet pointer.
741  */
742 static struct mbuf *
743 sl_btom(struct sl_softc *sc, int len)
744 {
745         struct mbuf *m;
746
747         if (len >= MCLBYTES)
748                 return (NULL);
749
750         MGETHDR(m, MB_DONTWAIT, MT_DATA);
751         if (m == NULL)
752                 return (NULL);
753
754         /*
755          * If we have more than MHLEN bytes, it's cheaper to
756          * queue the cluster we just filled & allocate a new one
757          * for the input buffer.  Otherwise, fill the mbuf we
758          * allocated above.  Note that code in the input routine
759          * guarantees that packet will fit in a cluster.
760          */
761         if (len >= MHLEN) {
762                 MCLGET(m, MB_DONTWAIT);
763                 if ((m->m_flags & M_EXT) == 0) {
764                         /*
765                          * we couldn't get a cluster - if memory's this
766                          * low, it's time to start dropping packets.
767                          */
768                         m_free(m);
769                         return (NULL);
770                 }
771         }
772         bcopy((caddr_t)sc->sc_buf, mtod(m, caddr_t), len);
773         m->m_len = len;
774         m->m_pkthdr.len = len;
775         m->m_pkthdr.rcvif = &sc->sc_if;
776         return (m);
777 }
778
779 /*
780  * tty interface receiver interrupt.
781  */
782 static int
783 slinput(int c, struct tty *tp)
784 {
785         struct sl_softc *sc;
786         struct mbuf *m;
787         int len;
788         u_char chdr[CHDR_LEN];
789
790         lwkt_gettoken(&tty_token);
791         tk_nin++;
792         sc = (struct sl_softc *)tp->t_sc;
793         if (sc == NULL) {
794                 lwkt_reltoken(&tty_token);
795                 return 0;
796         }
797         if (c & TTY_ERRORMASK || (tp->t_state & TS_CONNECTED) == 0) {
798                 sc->sc_flags |= SC_ERROR;
799                 lwkt_reltoken(&tty_token);
800                 return 0;
801         }
802         c &= TTY_CHARMASK;
803
804         ++sc->sc_if.if_ibytes;
805
806         if (sc->sc_if.if_flags & IFF_DEBUG) {
807                 if (c == ABT_ESC) {
808                         /*
809                          * If we have a previous abort, see whether
810                          * this one is within the time limit.
811                          */
812                         if (sc->sc_abortcount &&
813                             time_second >= sc->sc_starttime + ABT_WINDOW)
814                                 sc->sc_abortcount = 0;
815                         /*
816                          * If we see an abort after "idle" time, count it;
817                          * record when the first abort escape arrived.
818                          */
819                         if (time_second >= sc->sc_lasttime + ABT_IDLE) {
820                                 if (++sc->sc_abortcount == 1)
821                                         sc->sc_starttime = time_second;
822                                 if (sc->sc_abortcount >= ABT_COUNT) {
823                                         slclose(tp,0);
824                                         lwkt_reltoken(&tty_token);
825                                         return 0;
826                                 }
827                         }
828                 } else
829                         sc->sc_abortcount = 0;
830                 sc->sc_lasttime = time_second;
831         }
832
833         switch (c) {
834
835         case TRANS_FRAME_ESCAPE:
836                 if (sc->sc_escape)
837                         c = FRAME_ESCAPE;
838                 break;
839
840         case TRANS_FRAME_END:
841                 if (sc->sc_escape)
842                         c = FRAME_END;
843                 break;
844
845         case FRAME_ESCAPE:
846                 sc->sc_escape = 1;
847                 lwkt_reltoken(&tty_token);
848                 return 0;
849
850         case FRAME_END:
851                 sc->sc_flags &= ~SC_KEEPALIVE;
852                 if(sc->sc_flags & SC_ERROR) {
853                         sc->sc_flags &= ~SC_ERROR;
854                         goto newpack;
855                 }
856                 len = sc->sc_mp - sc->sc_buf;
857                 if (len < 3)
858                         /* less than min length packet - ignore */
859                         goto newpack;
860
861                 if (sc->sc_if.if_bpf) {
862                         /*
863                          * Save the compressed header, so we
864                          * can tack it on later.  Note that we
865                          * will end up copying garbage in some
866                          * cases but this is okay.  We remember
867                          * where the buffer started so we can
868                          * compute the new header length.
869                          */
870                         bcopy(sc->sc_buf, chdr, CHDR_LEN);
871                 }
872
873                 if ((c = (*sc->sc_buf & 0xf0)) != (IPVERSION << 4)) {
874                         if (c & 0x80)
875                                 c = TYPE_COMPRESSED_TCP;
876                         else if (c == TYPE_UNCOMPRESSED_TCP)
877                                 *sc->sc_buf &= 0x4f; /* XXX */
878                         /*
879                          * We've got something that's not an IP packet.
880                          * If compression is enabled, try to decompress it.
881                          * Otherwise, if `auto-enable' compression is on and
882                          * it's a reasonable packet, decompress it and then
883                          * enable compression.  Otherwise, drop it.
884                          */
885                         if (sc->sc_if.if_flags & SC_COMPRESS) {
886                                 len = sl_uncompress_tcp(&sc->sc_buf, len,
887                                                         (u_int)c, &sc->sc_comp);
888                                 if (len <= 0)
889                                         goto error;
890                         } else if ((sc->sc_if.if_flags & SC_AUTOCOMP) &&
891                             c == TYPE_UNCOMPRESSED_TCP && len >= 40) {
892                                 len = sl_uncompress_tcp(&sc->sc_buf, len,
893                                                         (u_int)c, &sc->sc_comp);
894                                 if (len <= 0)
895                                         goto error;
896                                 sc->sc_if.if_flags |= SC_COMPRESS;
897                         } else
898                                 goto error;
899                 }
900                 if (sc->sc_if.if_bpf) {
901                         bpf_gettoken();
902
903                         if (sc->sc_if.if_bpf) {
904                                 /*
905                                  * Put the SLIP pseudo-"link header" in place.
906                                  * We couldn't do this any earlier since
907                                  * decompression probably moved the buffer
908                                  * pointer.  Then, invoke BPF.
909                                  */
910                                 u_char *hp = sc->sc_buf - SLIP_HDRLEN;
911
912                                 hp[SLX_DIR] = SLIPDIR_IN;
913                                 bcopy(chdr, &hp[SLX_CHDR], CHDR_LEN);
914                                 bpf_tap(sc->sc_if.if_bpf, hp,
915                                     len + SLIP_HDRLEN);
916                         }
917
918                         bpf_reltoken();
919                 }
920                 m = sl_btom(sc, len);
921                 if (m == NULL)
922                         goto error;
923
924                 sc->sc_if.if_ipackets++;
925
926                 if ((sc->sc_if.if_flags & IFF_UP) == 0) {
927                         m_freem(m);
928                         goto newpack;
929                 }
930
931                 if (netisr_queue(NETISR_IP, m)) {
932                         sc->sc_if.if_ierrors++;
933                         sc->sc_if.if_iqdrops++;
934                 }
935
936                 goto newpack;
937         }
938         if (sc->sc_mp < sc->sc_ep + SLBUFSIZE) {
939                 *sc->sc_mp++ = c;
940                 sc->sc_escape = 0;
941                 lwkt_reltoken(&tty_token);
942                 return 0;
943         }
944
945         /* can't put lower; would miss an extra frame */
946         sc->sc_flags |= SC_ERROR;
947
948 error:
949         sc->sc_if.if_ierrors++;
950 newpack:
951         sc->sc_mp = sc->sc_buf = sc->sc_ep + SLBUFSIZE - SLRMAX;
952         sc->sc_escape = 0;
953         lwkt_reltoken(&tty_token);
954         return 0;
955 }
956
957 /*
958  * Process an ioctl request.
959  */
960 static int
961 slioctl(struct ifnet *ifp, u_long cmd, caddr_t data, struct ucred *cr)
962 {
963         struct ifaddr *ifa = (struct ifaddr *)data;
964         struct ifreq *ifr = (struct ifreq *)data;
965         int error = 0;
966
967         crit_enter();
968
969         switch (cmd) {
970
971         case SIOCSIFFLAGS:
972                 /*
973                  * if.c will set the interface up even if we
974                  * don't want it to.
975                  */
976                 if (sl_softc[ifp->if_dunit].sc_ttyp == NULL) {
977                         ifp->if_flags &= ~IFF_UP;
978                 }
979                 break;
980         case SIOCSIFADDR:
981                 /*
982                  * This is "historical" - set the interface up when
983                  * setting the address.
984                  */
985                 if (ifa->ifa_addr->sa_family == AF_INET) {
986                         if (sl_softc[ifp->if_dunit].sc_ttyp != NULL)
987                                 ifp->if_flags |= IFF_UP;
988                 } else {
989                         error = EAFNOSUPPORT;
990                 }
991                 break;
992
993         case SIOCSIFDSTADDR:
994                 if (ifa->ifa_addr->sa_family != AF_INET)
995                         error = EAFNOSUPPORT;
996                 break;
997
998         case SIOCADDMULTI:
999         case SIOCDELMULTI:
1000                 break;
1001
1002         case SIOCSIFMTU:
1003                 /*
1004                  * Set the interface MTU.
1005                  */
1006                 if (ifr->ifr_mtu > SLTMAX)
1007                         error = EINVAL;
1008                 else {
1009                         struct tty *tp;
1010
1011                         ifp->if_mtu = ifr->ifr_mtu;
1012                         tp = sl_softc[ifp->if_dunit].sc_ttyp;
1013                         if (tp != NULL)
1014                                 clist_alloc_cblocks(&tp->t_outq,
1015                                     SLIP_HIWAT + 2 * ifp->if_mtu + 1,
1016                                     SLIP_HIWAT + 2 * ifp->if_mtu + 1);
1017                 }
1018                 break;
1019
1020         default:
1021                 error = EINVAL;
1022         }
1023
1024         crit_exit();
1025         return (error);
1026 }
1027
1028 static void
1029 sl_keepalive(void *chan)
1030 {
1031         struct sl_softc *sc = chan;
1032
1033         lwkt_gettoken(&tty_token);
1034         lwkt_gettoken(&proc_token);
1035         if (sc->sc_keepalive) {
1036                 if (sc->sc_flags & SC_KEEPALIVE)
1037                         pgsignal (sc->sc_ttyp->t_pgrp, SIGURG, 1);
1038                 else
1039                         sc->sc_flags |= SC_KEEPALIVE;
1040                 callout_reset(&sc->sc_katimeout, sc->sc_keepalive,
1041                                 sl_keepalive, sc);
1042         } else {
1043                 sc->sc_flags &= ~SC_KEEPALIVE;
1044         }
1045         lwkt_reltoken(&proc_token);
1046         lwkt_reltoken(&tty_token);
1047 }
1048
1049 static void
1050 sl_outfill(void *chan)
1051 {
1052         struct sl_softc *sc = chan;
1053         struct tty *tp = sc->sc_ttyp;
1054
1055         lwkt_gettoken(&tty_token);
1056
1057         if (sc->sc_outfill && tp != NULL) {
1058                 if (sc->sc_flags & SC_OUTWAIT) {
1059                         crit_enter();
1060                         ++sc->sc_if.if_obytes;
1061                         clist_putc(FRAME_END, &tp->t_outq);
1062                         (*tp->t_oproc)(tp);
1063                         crit_exit();
1064                 } else
1065                         sc->sc_flags |= SC_OUTWAIT;
1066                 callout_reset(&sc->sc_oftimeout, sc->sc_outfill,
1067                                 sl_outfill, sc);
1068         } else {
1069                 sc->sc_flags &= ~SC_OUTWAIT;
1070         }
1071         lwkt_reltoken(&tty_token);
1072 }