ultrix/if_ppp.c

   1 /*
   2  * if_ppp.c - Point-to-Point Protocol (PPP) Asynchronous driver.
   3  *
   4  * Copyright (c) 1989 Carnegie Mellon University.
   5  * All rights reserved.
   6  *
   7  * Redistribution and use in source and binary forms are permitted
   8  * provided that the above copyright notice and this paragraph are
   9  * duplicated in all such forms and that any documentation,
  10  * advertising materials, and other materials related to such
  11  * distribution and use acknowledge that the software was developed
  12  * by Carnegie Mellon University.  The name of the
  13  * University may not be used to endorse or promote products derived
  14  * from this software without specific prior written permission.
  15  * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR
  16  * IMPLIED WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED
  17  * WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  18  *
  19  * Drew D. Perkins
  20  * Carnegie Mellon University
  21  * 4910 Forbes Ave.
  22  * Pittsburgh, PA 15213
  23  * (412) 268-8576
  24  * ddp@andrew.cmu.edu
  25  *
  26  * Based on:
  27  *      @(#)if_sl.c     7.6.1.2 (Berkeley) 2/15/89
  28  *
  29  * Copyright (c) 1987 Regents of the University of California.
  30  * All rights reserved.
  31  *
  32  * Redistribution and use in source and binary forms are permitted
  33  * provided that the above copyright notice and this paragraph are
  34  * duplicated in all such forms and that any documentation,
  35  * advertising materials, and other materials related to such
  36  * distribution and use acknowledge that the software was developed
  37  * by the University of California, Berkeley.  The name of the
  38  * University may not be used to endorse or promote products derived
  39  * from this software without specific prior written permission.
  40  * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR
  41  * IMPLIED WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED
  42  * WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  43  *
  44  * Serial Line interface
  45  *
  46  * Rick Adams
  47  * Center for Seismic Studies
  48  * 1300 N 17th Street, Suite 1450
  49  * Arlington, Virginia 22209
  50  * (703)276-7900
  51  * rick@seismo.ARPA
  52  * seismo!rick
  53  *
  54  * Pounded on heavily by Chris Torek (chris@mimsy.umd.edu, umcp-cs!chris).
  55  * Converted to 4.3BSD Beta by Chris Torek.
  56  * Other changes made at Berkeley, based in part on code by Kirk Smith.
  57  *
  58  * Converted to 4.3BSD+ 386BSD by Brad Parker (brad@cayman.com)
  59  * Added VJ tcp header compression; more unified ioctls
  60  *
  61  * Extensively modified by Paul Mackerras (paulus@cs.anu.edu.au).
  62  * Cleaned up a lot of the mbuf-related code to fix bugs that
  63  * caused system crashes and packet corruption.  Changed pppstart
  64  * so that it doesn't just give up with a collision if the whole
  65  * packet doesn't fit in the output ring buffer.
  66  *
  67  * Added priority queueing for interactive IP packets, following
  68  * the model of if_sl.c, plus hooks for bpf.
  69  * Paul Mackerras (paulus@cs.anu.edu.au).
  70  *
  71  * Ultrix port by Per Sundstrom <sundstrom@stkhlm.enet.dec.com>,
  72  * Robert Olsson <robert@robur.slu.se> and Paul Mackerras.
  73  */
  74
  75 /* $Id: if_ppp.c,v 1.10 1996/07/01 01:24:25 paulus Exp $ */
  76 /* from if_sl.c,v 1.11 84/10/04 12:54:47 rick Exp */
  77 /* from NetBSD: if_ppp.c,v 1.15.2.2 1994/07/28 05:17:58 cgd Exp */
  78
  79 #include "ppp.h"
  80 #if NPPP > 0
  81
  82 #define VJC
  83 #define PPP_COMPRESS
  84
  85 #include "../h/param.h"
  86 #include "../h/user.h"
  87 #include "../h/proc.h"
  88 #include "../h/mbuf.h"
  89 #include "../h/buf.h"
  90 #include "../h/socket.h"
  91 #include "../h/ioctl.h"
  92 #include "../h/systm.h"
  93 #include "../h/time.h"
  94
  95 #include "../net/net/if.h"
  96 #include "../net/net/netisr.h"
  97 #include "../net/net/route.h"
  98
  99 #if INET
 100 #include "../net/netinet/in.h"
 101 #include "../net/netinet/in_systm.h"
 102 #include "../net/netinet/in_var.h"
 103 #include "../net/netinet/ip.h"
 104 #endif
 105
 106 #ifdef vax
 107 #include "../machine/mtpr.h"
 108 #endif
 109
 110 #ifdef VJC
 111 #include "slcompress.h"
 112 #endif
 113
 114 #include "ppp_defs.h"
 115 #include "if_ppp.h"
 116 #include "if_pppvar.h"
 117
 118 #ifdef PPP_COMPRESS
 119 #define PACKETPTR       struct mbuf *
 120 #include "ppp-comp.h"
 121 #endif
 122
 123 static void     ppp_requeue __P((struct ppp_softc *));
 124 static void     ppp_outpkt __P((struct ppp_softc *));
 125 static void     ppp_ccp __P((struct ppp_softc *, struct mbuf *m, int rcvd));
 126 static void     ppp_ccp_closed __P((struct ppp_softc *));
 127 static void     ppp_inproc __P((struct ppp_softc *, struct mbuf *));
 128 static void     pppdumpm __P((struct mbuf *m0));
 129
 130 /*
 131  * Some useful mbuf macros not in mbuf.h.
 132  */
 133 #define M_IS_CLUSTER(m) ((m)->m_off > MMAXOFF)
 134
 135 #define M_TRAILINGSPACE(m) \
 136         ((M_IS_CLUSTER(m) ? (u_int)(m)->m_clptr + M_CLUSTERSZ : MSIZE) \
 137          - ((m)->m_off + (m)->m_len))
 138
 139 #define M_OFFSTART(m)   \
 140         (M_IS_CLUSTER(m) ? (u_int)(m)->m_clptr : MMINOFF)
 141
 142 #define M_DATASIZE(m)   \
 143         (M_IS_CLUSTER(m) ? M_CLUSTERSZ : MLEN)
 144
 145 /*
 146  * The following disgusting hack gets around the problem that IP TOS
 147  * can't be set yet.  We want to put "interactive" traffic on a high
 148  * priority queue.  To decide if traffic is interactive, we check that
 149  * a) it is TCP and b) one of its ports is telnet, rlogin or ftp control.
 150  */
 151 static u_short interactive_ports[8] = {
 152         0,      513,    0,      0,
 153         0,      21,     0,      23,
 154 };
 155 #define INTERACTIVE(p) (interactive_ports[(p) & 7] == (p))
 156
 157 #ifdef PPP_COMPRESS
 158 /*
 159  * List of compressors we know about.
 160  */
 161
 162 extern struct compressor ppp_bsd_compress;
 163 extern struct compressor ppp_deflate;
 164
 165 struct compressor *ppp_compressors[] = {
 166 #if DO_BSD_COMPRESS
 167     &ppp_bsd_compress,
 168 #endif
 169 #if DO_DEFLATE
 170     &ppp_deflate,
 171 #endif
 172     NULL
 173 };
 174 #endif /* PPP_COMPRESS */
 175
 176
 177 /*
 178  * Called from boot code to establish ppp interfaces.
 179  */
 180 void
 181 pppattach()
 182 {
 183     register struct ppp_softc *sc;
 184     register int i = 0;
 185
 186     for (sc = ppp_softc; i < NPPP; sc++) {
 187         sc->sc_if.if_name = "ppp";
 188         sc->sc_if.if_unit = i++;
 189         sc->sc_if.if_mtu = PPP_MTU;
 190         sc->sc_if.if_flags = IFF_POINTOPOINT;
 191         sc->sc_if.if_type = IFT_PPP;
 192         sc->sc_if.if_hdrlen = PPP_HDRLEN;
 193         sc->sc_if.if_ioctl = pppsioctl;
 194         sc->sc_if.if_output = pppoutput;
 195         sc->sc_if.if_snd.ifq_maxlen = IFQ_MAXLEN;
 196         sc->sc_inq.ifq_maxlen = IFQ_MAXLEN;
 197         sc->sc_fastq.ifq_maxlen = IFQ_MAXLEN;
 198         sc->sc_rawq.ifq_maxlen = IFQ_MAXLEN;
 199         if_attach(&sc->sc_if);
 200 #if NBPFILTER > 0
 201         bpfattach(&sc->sc_bpf, &sc->sc_if, DLT_PPP, PPP_HDRLEN);
 202 #endif
 203     }
 204 }
 205
 206 /*
 207  * Allocate a ppp interface unit and initialize it.
 208  */
 209 struct ppp_softc *
 210 pppalloc(pid)
 211     pid_t pid;
 212 {
 213     int nppp, i;
 214     struct ppp_softc *sc;
 215
 216     for (nppp = 0, sc = ppp_softc; nppp < NPPP; nppp++, sc++)
 217         if (sc->sc_xfer == pid) {
 218             sc->sc_xfer = 0;
 219             return sc;
 220         }
 221     for (nppp = 0, sc = ppp_softc; nppp < NPPP; nppp++, sc++)
 222         if (sc->sc_devp == NULL)
 223             break;
 224     if (nppp >= NPPP)
 225         return NULL;
 226
 227     sc->sc_flags = 0;
 228     sc->sc_mru = PPP_MRU;
 229     sc->sc_relinq = NULL;
 230     bzero((char *)&sc->sc_stats, sizeof(sc->sc_stats));
 231 #ifdef VJC
 232     KM_ALLOC(sc->sc_comp, struct slcompress *, sizeof(struct slcompress),
 233            KM_DEVBUF, KM_NOARG);
 234     if (sc->sc_comp)
 235         sl_compress_init(sc->sc_comp, -1);
 236 #endif
 237 #ifdef PPP_COMPRESS
 238     sc->sc_xc_state = NULL;
 239     sc->sc_rc_state = NULL;
 240 #endif /* PPP_COMPRESS */
 241     for (i = 0; i < NUM_NP; ++i)
 242         sc->sc_npmode[i] = NPMODE_ERROR;
 243     sc->sc_npqueue = NULL;
 244     sc->sc_npqtail = &sc->sc_npqueue;
 245     sc->sc_last_sent = sc->sc_last_recv = time.tv_sec;
 246
 247     return sc;
 248 }
 249
 250 /*
 251  * Deallocate a ppp unit.  Must be called at splnet or higher.
 252  */
 253 void
 254 pppdealloc(sc)
 255     struct ppp_softc *sc;
 256 {
 257     struct mbuf *m;
 258
 259     if_down(&sc->sc_if);
 260     sc->sc_if.if_flags &= ~(IFF_UP|IFF_RUNNING);
 261     sc->sc_devp = NULL;
 262     sc->sc_xfer = 0;
 263     for (;;) {
 264         IF_DEQUEUE(&sc->sc_rawq, m);
 265         if (m == NULL)
 266             break;
 267         m_freem(m);
 268     }
 269     for (;;) {
 270         IF_DEQUEUE(&sc->sc_inq, m);
 271         if (m == NULL)
 272             break;
 273         m_freem(m);
 274     }
 275     for (;;) {
 276         IF_DEQUEUE(&sc->sc_fastq, m);
 277         if (m == NULL)
 278             break;
 279         m_freem(m);
 280     }
 281     while ((m = sc->sc_npqueue) != NULL) {
 282         sc->sc_npqueue = m->m_act;
 283         m_freem(m);
 284     }
 285     if (sc->sc_togo != NULL) {
 286         m_freem(sc->sc_togo);
 287         sc->sc_togo = NULL;
 288     }
 289 #ifdef PPP_COMPRESS
 290     ppp_ccp_closed(sc);
 291     sc->sc_xc_state = NULL;
 292     sc->sc_rc_state = NULL;
 293 #endif /* PPP_COMPRESS */
 294 #ifdef VJC
 295     if (sc->sc_comp != 0) {
 296         KM_FREE(sc->sc_comp, KM_DEVBUF);
 297         sc->sc_comp = 0;
 298     }
 299 #endif
 300 }
 301
 302 /*
 303  * Ioctl routine for generic ppp devices.
 304  */
 305 int
 306 pppioctl(sc, cmd, data, flag)
 307     struct ppp_softc *sc;
 308     caddr_t data;
 309     int cmd, flag;
 310 {
 311     struct proc *p = u.u_procp;
 312     int s, error, flags, mru, mtu, nb, npx;
 313     struct ppp_option_data *odp;
 314     struct compressor **cp;
 315     struct npioctl *npi;
 316     time_t t;
 317 #ifdef  PPP_COMPRESS
 318     u_char ccp_option[CCP_MAX_OPTION_LENGTH];
 319 #endif
 320
 321     switch (cmd) {
 322     case FIONREAD:
 323         *(int *)data = sc->sc_inq.ifq_len;
 324         break;
 325
 326     case PPPIOCGUNIT:
 327         *(int *)data = sc->sc_if.if_unit;
 328         break;
 329
 330     case PPPIOCGFLAGS:
 331         *(u_int *)data = sc->sc_flags;
 332         break;
 333
 334     case PPPIOCSFLAGS:
 335         if (!suser())
 336             return EPERM;
 337         flags = *(int *)data & SC_MASK;
 338         s = splnet();
 339 #ifdef PPP_COMPRESS
 340         if (sc->sc_flags & SC_CCP_OPEN && !(flags & SC_CCP_OPEN))
 341             ppp_ccp_closed(sc);
 342 #endif
 343         splimp();
 344         sc->sc_flags = (sc->sc_flags & ~SC_MASK) | flags;
 345         splx(s);
 346         break;
 347
 348     case PPPIOCSMRU:
 349         if (!suser())
 350             return EPERM;
 351         mru = *(int *)data;
 352         if (mru >= PPP_MRU && mru <= PPP_MAXMRU)
 353             sc->sc_mru = mru;
 354         break;
 355
 356     case PPPIOCGMRU:
 357         *(int *)data = sc->sc_mru;
 358         break;
 359
 360     /*
 361      * PPPIOC[GS]MTU are implemented here, instead of supporting
 362      * SIOC[GS]IFMTU in pppsioctl, because under Ultrix, we can't get an
 363      * interface ioctl through to the interface until it has an IP
 364      * address set.
 365      */
 366     case PPPIOCSMTU:
 367         if (!suser())
 368             return EPERM;
 369         mtu = *(int *) data;
 370         if (mtu <= 0 || mtu > PPP_MAXMRU)
 371             return EINVAL;
 372         s = splimp();
 373         sc->sc_if.if_mtu = mtu;
 374         splx(s);
 375         break;
 376
 377     case PPPIOCGMTU:
 378         *(int *) data = sc->sc_if.if_mtu;
 379         break;
 380
 381 #ifdef VJC
 382     case PPPIOCSMAXCID:
 383         if (!suser())
 384             return EPERM;
 385         if (sc->sc_comp) {
 386             s = splnet();
 387             sl_compress_init(sc->sc_comp, *(int *)data);
 388             splx(s);
 389         }
 390         break;
 391 #endif
 392
 393     case PPPIOCXFERUNIT:
 394         if (!suser())
 395             return EPERM;
 396         sc->sc_xfer = p->p_pid;
 397         break;
 398
 399 #ifdef PPP_COMPRESS
 400     case PPPIOCSCOMPRESS:
 401         if (!suser())
 402             return EPERM;
 403         odp = (struct ppp_option_data *) data;
 404         nb = odp->length;
 405         if (nb > sizeof(ccp_option))
 406             nb = sizeof(ccp_option);
 407         if ((error = copyin(odp->ptr, ccp_option, nb)) != 0)
 408             return (error);
 409         if (ccp_option[1] < 2)  /* preliminary check on the length byte */
 410             return (EINVAL);
 411         for (cp = ppp_compressors; *cp != NULL; ++cp)
 412             if ((*cp)->compress_proto == ccp_option[0]) {
 413                 /*
 414                  * Found a handler for the protocol - try to allocate
 415                  * a compressor or decompressor.
 416                  */
 417                 error = 0;
 418                 if (odp->transmit) {
 419                     s = splnet();
 420                     if (sc->sc_xc_state != NULL)
 421                         (*sc->sc_xcomp->comp_free)(sc->sc_xc_state);
 422                     sc->sc_xcomp = *cp;
 423                     sc->sc_xc_state = (*cp)->comp_alloc(ccp_option, nb);
 424                     if (sc->sc_xc_state == NULL) {
 425                         if (sc->sc_flags & SC_DEBUG)
 426                             printf("ppp%d: comp_alloc failed\n",
 427                                sc->sc_if.if_unit);
 428                         error = ENOBUFS;
 429                     }
 430                     splimp();
 431                     sc->sc_flags &= ~SC_COMP_RUN;
 432                     splx(s);
 433                 } else {
 434                     s = splnet();
 435                     if (sc->sc_rc_state != NULL)
 436                         (*sc->sc_rcomp->decomp_free)(sc->sc_rc_state);
 437                     sc->sc_rcomp = *cp;
 438                     sc->sc_rc_state = (*cp)->decomp_alloc(ccp_option, nb);
 439                     if (sc->sc_rc_state == NULL) {
 440                         if (sc->sc_flags & SC_DEBUG)
 441                             printf("ppp%d: decomp_alloc failed\n",
 442                                sc->sc_if.if_unit);
 443                         error = ENOBUFS;
 444                     }
 445                     splimp();
 446                     sc->sc_flags &= ~SC_DECOMP_RUN;
 447                     splx(s);
 448                 }
 449                 return (error);
 450             }
 451         if (sc->sc_flags & SC_DEBUG)
 452             printf("ppp%d: no compressor for [%x %x %x], %x\n",
 453                    sc->sc_if.if_unit, ccp_option[0], ccp_option[1],
 454                    ccp_option[2], nb);
 455         return (EINVAL);        /* no handler found */
 456 #endif /* PPP_COMPRESS */
 457
 458     case PPPIOCGNPMODE:
 459     case PPPIOCSNPMODE:
 460         npi = (struct npioctl *) data;
 461         switch (npi->protocol) {
 462         case PPP_IP:
 463             npx = NP_IP;
 464             break;
 465         default:
 466             return EINVAL;
 467         }
 468         if (cmd == PPPIOCGNPMODE) {
 469             npi->mode = sc->sc_npmode[npx];
 470         } else {
 471             if (!suser())
 472                 return EPERM;
 473             if (npi->mode != sc->sc_npmode[npx]) {
 474                 s = splnet();
 475                 sc->sc_npmode[npx] = npi->mode;
 476                 if (npi->mode != NPMODE_QUEUE) {
 477                     ppp_requeue(sc);
 478                     (*sc->sc_start)(sc);
 479                 }
 480                 splx(s);
 481             }
 482         }
 483         break;
 484
 485     case PPPIOCGIDLE:
 486         s = splnet();
 487         t = time.tv_sec;
 488         ((struct ppp_idle *)data)->xmit_idle = t - sc->sc_last_sent;
 489         ((struct ppp_idle *)data)->recv_idle = t - sc->sc_last_recv;
 490         splx(s);
 491         break;
 492
 493     default:
 494         return (-1);
 495     }
 496     return (0);
 497 }
 498
 499 /*
 500  * Process an ioctl request to the ppp network interface.
 501  */
 502 int
 503 pppsioctl(ifp, cmd, data)
 504     register struct ifnet *ifp;
 505     int cmd;
 506     caddr_t data;
 507 {
 508     struct proc *p = u.u_procp;
 509     register struct ppp_softc *sc = &ppp_softc[ifp->if_unit];
 510     register struct ifaddr *ifa = (struct ifaddr *)data;
 511     register struct ifreq *ifr = (struct ifreq *)data;
 512     struct ppp_stats *psp;
 513 #ifdef  PPP_COMPRESS
 514     struct ppp_comp_stats *pcp;
 515 #endif
 516     int s = splimp(), error = 0;
 517
 518     switch (cmd) {
 519     case SIOCSIFFLAGS:
 520         if ((ifp->if_flags & IFF_RUNNING) == 0)
 521             ifp->if_flags &= ~IFF_UP;
 522         break;
 523
 524     case SIOCSIFADDR:
 525         if (ifa->ifa_addr.sa_family != AF_INET)
 526             error = EAFNOSUPPORT;
 527         break;
 528
 529     case SIOCSIFDSTADDR:
 530         if (ifa->ifa_addr.sa_family != AF_INET)
 531             error = EAFNOSUPPORT;
 532         break;
 533
 534 /*
 535  * Ioctls other than the above don't get through until the
 536  * interface has its IP addresses set :-(
 537  */
 538
 539 #if 0
 540     case SIOCSIFMTU:
 541         if (!suser())
 542             return EPERM;
 543         sc->sc_if.if_mtu = ifr->ifr_mtu;
 544         break;
 545
 546     case SIOCGIFMTU:
 547         ifr->ifr_mtu = sc->sc_if.if_mtu;
 548         break;
 549 #endif
 550
 551     case SIOCGPPPSTATS:
 552         psp = &((struct ifpppstatsreq *) data)->stats;
 553         bzero(psp, sizeof(*psp));
 554         psp->p = sc->sc_stats;
 555 #if defined(VJC) && !defined(SL_NO_STATS)
 556         if (sc->sc_comp) {
 557             psp->vj.vjs_packets = sc->sc_comp->sls_packets;
 558             psp->vj.vjs_compressed = sc->sc_comp->sls_compressed;
 559             psp->vj.vjs_searches = sc->sc_comp->sls_searches;
 560             psp->vj.vjs_misses = sc->sc_comp->sls_misses;
 561             psp->vj.vjs_uncompressedin = sc->sc_comp->sls_uncompressedin;
 562             psp->vj.vjs_compressedin = sc->sc_comp->sls_compressedin;
 563             psp->vj.vjs_errorin = sc->sc_comp->sls_errorin;
 564             psp->vj.vjs_tossed = sc->sc_comp->sls_tossed;
 565         }
 566 #endif /* VJC */
 567         break;
 568
 569 #ifdef PPP_COMPRESS
 570     case SIOCGPPPCSTATS:
 571         pcp = &((struct ifpppcstatsreq *) data)->stats;
 572         bzero(pcp, sizeof(*pcp));
 573         if (sc->sc_xc_state != NULL)
 574             (*sc->sc_xcomp->comp_stat)(sc->sc_xc_state, &pcp->c);
 575         if (sc->sc_rc_state != NULL)
 576             (*sc->sc_rcomp->decomp_stat)(sc->sc_rc_state, &pcp->d);
 577         break;
 578 #endif /* PPP_COMPRESS */
 579
 580     default:
 581         error = EINVAL;
 582     }
 583     splx(s);
 584     return (error);
 585 }
 586
 587 /*
 588  * Queue a packet.  Start transmission if not active.
 589  * Packet is placed in Information field of PPP frame.
 590  */
 591 int
 592 pppoutput(ifp, m0, dst)
 593     struct ifnet *ifp;
 594     struct mbuf *m0;
 595     struct sockaddr *dst;
 596 {
 597     register struct ppp_softc *sc = &ppp_softc[ifp->if_unit];
 598     int protocol, address, control;
 599     u_char *cp;
 600     int s, error;
 601     struct ip *ip;
 602     struct ifqueue *ifq;
 603     enum NPmode mode;
 604
 605     if (sc->sc_devp == NULL || (ifp->if_flags & IFF_RUNNING) == 0
 606         || ((ifp->if_flags & IFF_UP) == 0 && dst->sa_family != AF_UNSPEC)) {
 607         error = ENETDOWN;       /* sort of */
 608         goto bad;
 609     }
 610
 611     /*
 612      * Compute PPP header.
 613      * We use the m_context field of the mbuf to indicate whether
 614      * the packet should go on the fast queue.
 615      */
 616     m0->m_context = 0;
 617     switch (dst->sa_family) {
 618 #ifdef INET
 619     case AF_INET:
 620         address = PPP_ALLSTATIONS;
 621         control = PPP_UI;
 622         protocol = PPP_IP;
 623         mode = sc->sc_npmode[NP_IP];
 624
 625         /*
 626          * If this is a TCP packet to or from an "interactive" port,
 627          * put the packet on the fastq instead.
 628          */
 629         if ((ip = mtod(m0, struct ip *))->ip_p == IPPROTO_TCP) {
 630             register int p = ntohl(((int *)ip)[ip->ip_hl]);
 631             if (INTERACTIVE(p & 0xffff) || INTERACTIVE(p >> 16))
 632                 m0->m_context = 1;
 633         }
 634         break;
 635 #endif
 636     case AF_UNSPEC:
 637         address = PPP_ADDRESS(dst->sa_data);
 638         control = PPP_CONTROL(dst->sa_data);
 639         protocol = PPP_PROTOCOL(dst->sa_data);
 640         mode = NPMODE_PASS;
 641         break;
 642     default:
 643         printf("ppp%d: af%d not supported\n", ifp->if_unit, dst->sa_family);
 644         error = EAFNOSUPPORT;
 645         goto bad;
 646     }
 647
 648     /*
 649      * Drop this packet, or return an error, if necessary.
 650      */
 651     if (mode == NPMODE_ERROR) {
 652         error = ENETDOWN;
 653         goto bad;
 654     }
 655     if (mode == NPMODE_DROP) {
 656         error = 0;
 657         goto bad;
 658     }
 659
 660     /*
 661      * Add PPP header.  If no space in first mbuf, allocate another.
 662      */
 663     if (M_IS_CLUSTER(m0) || m0->m_off < MMINOFF + PPP_HDRLEN) {
 664         struct mbuf *m;
 665
 666         MGET(m, M_DONTWAIT, MT_DATA);
 667         if (m == NULL) {
 668             m_freem(m0);
 669             return (ENOBUFS);
 670         }
 671         m->m_len = 0;
 672         m->m_next = m0;
 673         m0 = m;
 674     } else
 675         m0->m_off -= PPP_HDRLEN;
 676
 677     cp = mtod(m0, u_char *);
 678     *cp++ = address;
 679     *cp++ = control;
 680     *cp++ = protocol >> 8;
 681     *cp++ = protocol & 0xff;
 682     m0->m_len += PPP_HDRLEN;
 683
 684     if (sc->sc_flags & SC_LOG_OUTPKT) {
 685         printf("ppp%d output: ", ifp->if_unit);
 686         pppdumpm(m0);
 687     }
 688
 689     if ((protocol & 0x8000) == 0) {
 690         /*
 691          * Update the time we sent the most recent data packet.
 692          */
 693         sc->sc_last_sent = time.tv_sec;
 694     }
 695
 696 #if NBPFILTER > 0
 697     /*
 698      * See if bpf wants to look at the packet.
 699      */
 700     if (sc->sc_bpf)
 701         bpf_mtap(sc->sc_bpf, m0);
 702 #endif
 703
 704     /*
 705      * Put the packet on the appropriate queue.
 706      */
 707     s = splnet();
 708     if (mode == NPMODE_QUEUE) {
 709         /* XXX we should limit the number of packets on this queue */
 710         *sc->sc_npqtail = m0;
 711         m0->m_act = NULL;
 712         sc->sc_npqtail = &m0->m_act;
 713     } else {
 714         ifq = m0->m_context? &sc->sc_fastq: &ifp->if_snd;
 715         if (IF_QFULL(ifq) && dst->sa_family != AF_UNSPEC) {
 716             IF_DROP(ifq);
 717             splx(s);
 718             sc->sc_if.if_oerrors++;
 719             sc->sc_stats.ppp_oerrors++;
 720             error = ENOBUFS;
 721             goto bad;
 722         }
 723         IF_ENQUEUE(ifq, m0);
 724         (*sc->sc_start)(sc);
 725     }
 726     ifp->if_opackets++;
 727     ifp->if_obytes += len;
 728
 729     splx(s);
 730     return (0);
 731
 732 bad:
 733     m_freem(m0);
 734     return (error);
 735 }
 736
 737 /*
 738  * After a change in the NPmode for some NP, move packets from the
 739  * npqueue to the send queue or the fast queue as appropriate.
 740  * Should be called at splnet.
 741  */
 742 static void
 743 ppp_requeue(sc)
 744     struct ppp_softc *sc;
 745 {
 746     struct mbuf *m, **mpp;
 747     struct ifqueue *ifq;
 748     enum NPmode mode;
 749
 750     for (mpp = &sc->sc_npqueue; (m = *mpp) != NULL; ) {
 751         switch (PPP_PROTOCOL(mtod(m, u_char *))) {
 752         case PPP_IP:
 753             mode = sc->sc_npmode[NP_IP];
 754             break;
 755         default:
 756             mode = NPMODE_PASS;
 757         }
 758
 759         switch (mode) {
 760         case NPMODE_PASS:
 761             /*
 762              * This packet can now go on one of the queues to be sent.
 763              */
 764             *mpp = m->m_act;
 765             m->m_act = NULL;
 766             ifq = m->m_context? &sc->sc_fastq: &sc->sc_if.if_snd;
 767             if (IF_QFULL(ifq)) {
 768                 IF_DROP(ifq);
 769                 sc->sc_if.if_oerrors++;
 770                 sc->sc_stats.ppp_oerrors++;
 771             } else
 772                 IF_ENQUEUE(ifq, m);
 773             break;
 774
 775         case NPMODE_DROP:
 776         case NPMODE_ERROR:
 777             *mpp = m->m_act;
 778             m_freem(m);
 779             break;
 780
 781         case NPMODE_QUEUE:
 782             mpp = &m->m_act;
 783             break;
 784         }
 785     }
 786     sc->sc_npqtail = mpp;
 787 }
 788
 789 /*
 790  * Transmitter has finished outputting some stuff;
 791  * remember to call sc->sc_start later at splsoftnet.
 792  */
 793 void
 794 ppp_restart(sc)
 795     struct ppp_softc *sc;
 796 {
 797     int s = splimp();
 798
 799     sc->sc_flags &= ~SC_TBUSY;
 800     schednetisr(NETISR_PPP);
 801     splx(s);
 802 }
 803
 804 /*
 805  * Get a packet to send.  This procedure is intended to be called at
 806  * splsoftnet, since it may involve time-consuming operations such as
 807  * applying VJ compression, packet compression, address/control and/or
 808  * protocol field compression to the packet.
 809  */
 810 struct mbuf *
 811 ppp_dequeue(sc)
 812     struct ppp_softc *sc;
 813 {
 814     struct mbuf *m, *mp;
 815     u_char *cp;
 816     int address, control, protocol;
 817     int s;
 818
 819     /*
 820      * Grab a packet to send: first try the fast queue, then the
 821      * normal queue.
 822      */
 823     IF_DEQUEUE(&sc->sc_fastq, m);
 824     if (m == NULL)
 825         IF_DEQUEUE(&sc->sc_if.if_snd, m);
 826     if (m == NULL)
 827         return NULL;
 828
 829     ++sc->sc_stats.ppp_opackets;
 830
 831     /*
 832      * Extract the ppp header of the new packet.
 833      * The ppp header will be in one mbuf.
 834      */
 835     cp = mtod(m, u_char *);
 836     address = PPP_ADDRESS(cp);
 837     control = PPP_CONTROL(cp);
 838     protocol = PPP_PROTOCOL(cp);
 839
 840     switch (protocol) {
 841     case PPP_IP:
 842 #ifdef VJC
 843         /*
 844          * If the packet is a TCP/IP packet, see if we can compress it.
 845          */
 846         if ((sc->sc_flags & SC_COMP_TCP) && sc->sc_comp != NULL) {
 847             struct ip *ip;
 848             int type;
 849
 850             mp = m;
 851             ip = (struct ip *) (cp + PPP_HDRLEN);
 852             if (mp->m_len <= PPP_HDRLEN) {
 853                 mp = mp->m_next;
 854                 if (mp == NULL)
 855                     break;
 856                 ip = mtod(mp, struct ip *);
 857             }
 858             /* this code assumes the IP/TCP header is in one non-shared mbuf */
 859             if (ip->ip_p == IPPROTO_TCP) {
 860                 type = sl_compress_tcp(mp, ip, sc->sc_comp,
 861                                        !(sc->sc_flags & SC_NO_TCP_CCID));
 862                 switch (type) {
 863                 case TYPE_UNCOMPRESSED_TCP:
 864                     protocol = PPP_VJC_UNCOMP;
 865                     break;
 866                 case TYPE_COMPRESSED_TCP:
 867                     protocol = PPP_VJC_COMP;
 868                     cp = mtod(m, u_char *);
 869                     cp[0] = address;    /* header has moved */
 870                     cp[1] = control;
 871                     cp[2] = 0;
 872                     break;
 873                 }
 874                 cp[3] = protocol;       /* update protocol in PPP header */
 875             }
 876         }
 877 #endif  /* VJC */
 878         break;
 879
 880 #ifdef PPP_COMPRESS
 881     case PPP_CCP:
 882         ppp_ccp(sc, m, 0);
 883         break;
 884 #endif  /* PPP_COMPRESS */
 885     }
 886
 887 #ifdef PPP_COMPRESS
 888     if (protocol != PPP_LCP && protocol != PPP_CCP
 889         && sc->sc_xc_state && (sc->sc_flags & SC_COMP_RUN)) {
 890         struct mbuf *mcomp = NULL;
 891         int slen, clen;
 892
 893         slen = 0;
 894         for (mp = m; mp != NULL; mp = mp->m_next)
 895             slen += mp->m_len;
 896         clen = (*sc->sc_xcomp->compress)
 897             (sc->sc_xc_state, &mcomp, m, slen,
 898              (sc->sc_flags & SC_CCP_UP? sc->sc_if.if_mtu: 0));
 899         if (mcomp != NULL) {
 900             m_freem(m);
 901             m = mcomp;
 902             cp = mtod(m, u_char *);
 903             protocol = cp[3];
 904         }
 905     }
 906 #endif  /* PPP_COMPRESS */
 907
 908     /*
 909      * Compress the address/control and protocol, if possible.
 910      */
 911     if (sc->sc_flags & SC_COMP_AC && address == PPP_ALLSTATIONS &&
 912         control == PPP_UI && protocol != PPP_ALLSTATIONS &&
 913         protocol != PPP_LCP) {
 914         /* can compress address/control */
 915         m->m_off += 2;
 916         m->m_len -= 2;
 917     }
 918     if (sc->sc_flags & SC_COMP_PROT && protocol < 0xFF) {
 919         /* can compress protocol */
 920         if (mtod(m, u_char *) == cp) {
 921             cp[2] = cp[1];      /* move address/control up */
 922             cp[1] = cp[0];
 923         }
 924         ++m->m_off;
 925         --m->m_len;
 926     }
 927
 928     return m;
 929 }
 930
 931 /*
 932  * Software interrupt routine, called at splsoftnet.
 933  */
 934 void
 935 pppintr()
 936 {
 937     struct ppp_softc *sc;
 938     int i, s, s2;
 939     struct mbuf *m;
 940
 941     sc = ppp_softc;
 942     s = splsoftnet();
 943     for (i = 0; i < NPPP; ++i, ++sc) {
 944         if (!(sc->sc_flags & SC_TBUSY)
 945             && (sc->sc_if.if_snd.ifq_head || sc->sc_fastq.ifq_head)) {
 946             s2 = splimp();
 947             sc->sc_flags |= SC_TBUSY;
 948             splx(s2);
 949             (*sc->sc_start)(sc);
 950         }
 951         for (;;) {
 952             s2 = splimp();
 953             IF_DEQUEUE(&sc->sc_rawq, m);
 954             splx(s2);
 955             if (m == NULL)
 956                 break;
 957             ppp_inproc(sc, m);
 958         }
 959     }
 960     splx(s);
 961 }
 962
 963 #ifdef PPP_COMPRESS
 964 /*
 965  * Handle a CCP packet.  `rcvd' is 1 if the packet was received,
 966  * 0 if it is about to be transmitted.
 967  */
 968 static void
 969 ppp_ccp(sc, m, rcvd)
 970     struct ppp_softc *sc;
 971     struct mbuf *m;
 972     int rcvd;
 973 {
 974     u_char *dp, *ep;
 975     struct mbuf *mp;
 976     int slen, s;
 977
 978     /*
 979      * Get a pointer to the data after the PPP header.
 980      */
 981     if (m->m_len <= PPP_HDRLEN) {
 982         mp = m->m_next;
 983         if (mp == NULL)
 984             return;
 985         dp = (mp != NULL)? mtod(mp, u_char *): NULL;
 986     } else {
 987         mp = m;
 988         dp = mtod(mp, u_char *) + PPP_HDRLEN;
 989     }
 990
 991     ep = mtod(mp, u_char *) + mp->m_len;
 992     if (dp + CCP_HDRLEN > ep)
 993         return;
 994     slen = CCP_LENGTH(dp);
 995     if (dp + slen > ep) {
 996         if (sc->sc_flags & SC_DEBUG)
 997             printf("if_ppp/ccp: not enough data in mbuf (%x+%x > %x+%x)\n",
 998                    dp, slen, mtod(mp, u_char *), mp->m_len);
 999         return;
1000     }
1001
1002     switch (CCP_CODE(dp)) {
1003     case CCP_CONFREQ:
1004     case CCP_TERMREQ:
1005     case CCP_TERMACK:
1006         /* CCP must be going down - disable compression */
1007         if (sc->sc_flags & SC_CCP_UP) {
1008             s = splimp();
1009             sc->sc_flags &= ~(SC_CCP_UP | SC_COMP_RUN | SC_DECOMP_RUN);
1010             splx(s);
1011         }
1012         break;
1013
1014     case CCP_CONFACK:
1015         if (sc->sc_flags & SC_CCP_OPEN && !(sc->sc_flags & SC_CCP_UP)
1016             && slen >= CCP_HDRLEN + CCP_OPT_MINLEN
1017             && slen >= CCP_OPT_LENGTH(dp + CCP_HDRLEN) + CCP_HDRLEN) {
1018             if (!rcvd) {
1019                 /* we're agreeing to send compressed packets. */
1020                 if (sc->sc_xc_state != NULL
1021                     && (*sc->sc_xcomp->comp_init)
1022                         (sc->sc_xc_state, dp + CCP_HDRLEN, slen - CCP_HDRLEN,
1023                          sc->sc_if.if_unit, 0, sc->sc_flags & SC_DEBUG)) {
1024                     s = splimp();
1025                     sc->sc_flags |= SC_COMP_RUN;
1026                     splx(s);
1027                 }
1028             } else {
1029                 /* peer is agreeing to send compressed packets. */
1030                 if (sc->sc_rc_state != NULL
1031                     && (*sc->sc_rcomp->decomp_init)
1032                         (sc->sc_rc_state, dp + CCP_HDRLEN, slen - CCP_HDRLEN,
1033                          sc->sc_if.if_unit, 0, sc->sc_mru,
1034                          sc->sc_flags & SC_DEBUG)) {
1035                     s = splimp();
1036                     sc->sc_flags |= SC_DECOMP_RUN;
1037                     sc->sc_flags &= ~(SC_DC_ERROR | SC_DC_FERROR);
1038                     splx(s);
1039                 }
1040             }
1041         }
1042         break;
1043
1044     case CCP_RESETACK:
1045         if (sc->sc_flags & SC_CCP_UP) {
1046             if (!rcvd) {
1047                 if (sc->sc_xc_state && (sc->sc_flags & SC_COMP_RUN))
1048                     (*sc->sc_xcomp->comp_reset)(sc->sc_xc_state);
1049             } else {
1050                 if (sc->sc_rc_state && (sc->sc_flags & SC_DECOMP_RUN)) {
1051                     (*sc->sc_rcomp->decomp_reset)(sc->sc_rc_state);
1052                     s = splimp();
1053                     sc->sc_flags &= ~SC_DC_ERROR;
1054                     splx(s);
1055                 }
1056             }
1057         }
1058         break;
1059     }
1060 }
1061
1062 /*
1063  * CCP is down; free (de)compressor state if necessary.
1064  */
1065 static void
1066 ppp_ccp_closed(sc)
1067     struct ppp_softc *sc;
1068 {
1069     if (sc->sc_xc_state) {
1070         (*sc->sc_xcomp->comp_free)(sc->sc_xc_state);
1071         sc->sc_xc_state = NULL;
1072     }
1073     if (sc->sc_rc_state) {
1074         (*sc->sc_rcomp->decomp_free)(sc->sc_rc_state);
1075         sc->sc_rc_state = NULL;
1076     }
1077 }
1078 #endif /* PPP_COMPRESS */
1079
1080 /*
1081  * PPP packet input routine.
1082  * The caller has checked and removed the FCS and has inserted
1083  * the address/control bytes and the protocol high byte if they
1084  * were omitted.
1085  */
1086 void
1087 ppppktin(sc, m, lost)
1088     struct ppp_softc *sc;
1089     struct mbuf *m;
1090     int lost;
1091 {
1092     int s = splimp();
1093
1094     m->m_context = lost;
1095     IF_ENQUEUE(&sc->sc_rawq, m);
1096     schednetisr(NETISR_PPP);
1097     splx(s);
1098 }
1099
1100 /*
1101  * Process a received PPP packet, doing decompression as necessary.
1102  * Should be called at splnet.
1103  */
1104 #define COMPTYPE(proto) ((proto) == PPP_VJC_COMP? TYPE_COMPRESSED_TCP: \
1105                          TYPE_UNCOMPRESSED_TCP)
1106
1107 static void
1108 ppp_inproc(sc, m)
1109     struct ppp_softc *sc;
1110     struct mbuf *m;
1111 {
1112     struct ifnet *ifp = &sc->sc_if;
1113     struct ifqueue *inq, *lock;
1114     int s, ilen, xlen, proto, rv;
1115     u_char *cp, adrs, ctrl;
1116     struct mbuf *mp, *dmp = NULL, *pc;
1117     u_char *iphdr;
1118     u_int hlen;
1119
1120     sc->sc_stats.ppp_ipackets++;
1121
1122     if (sc->sc_flags & SC_LOG_INPKT) {
1123         ilen = 0;
1124         for (mp = m; mp != NULL; mp = mp->m_next)
1125             ilen += mp->m_len;
1126         printf("ppp%d: got %d bytes\n", ifp->if_unit, ilen);
1127         pppdumpm(m);
1128     }
1129
1130     cp = mtod(m, u_char *);
1131     adrs = PPP_ADDRESS(cp);
1132     ctrl = PPP_CONTROL(cp);
1133     proto = PPP_PROTOCOL(cp);
1134
1135     if (m->m_context) {
1136         s = splimp();
1137         sc->sc_flags |= SC_VJ_RESET;
1138         splx(s);
1139     }
1140
1141 #ifdef PPP_COMPRESS
1142     /*
1143      * Decompress this packet if necessary, update the receiver's
1144      * dictionary, or take appropriate action on a CCP packet.
1145      */
1146     if (proto == PPP_COMP && sc->sc_rc_state && (sc->sc_flags & SC_DECOMP_RUN)
1147         && !(sc->sc_flags & SC_DC_ERROR) && !(sc->sc_flags & SC_DC_FERROR)) {
1148         /* decompress this packet */
1149         rv = (*sc->sc_rcomp->decompress)(sc->sc_rc_state, m, &dmp);
1150         if (rv == DECOMP_OK) {
1151             m_freem(m);
1152             if (dmp == NULL) {
1153                 /* no error, but no decompressed packet produced */
1154                 return;
1155             }
1156             m = dmp;
1157             cp = mtod(m, u_char *);
1158             proto = PPP_PROTOCOL(cp);
1159
1160         } else {
1161             /*
1162              * An error has occurred in decompression.
1163              * Pass the compressed packet up to pppd, which may take
1164              * CCP down or issue a Reset-Req.
1165              */
1166             if (sc->sc_flags & SC_DEBUG)
1167                 printf("ppp%d: decompress failed %d\n", ifp->if_unit, rv);
1168             s = splimp();
1169             sc->sc_flags |= SC_VJ_RESET;
1170             if (rv == DECOMP_ERROR)
1171                 sc->sc_flags |= SC_DC_ERROR;
1172             else
1173                 sc->sc_flags |= SC_DC_FERROR;
1174             splx(s);
1175         }
1176
1177     } else {
1178         if (sc->sc_rc_state && (sc->sc_flags & SC_DECOMP_RUN)) {
1179             (*sc->sc_rcomp->incomp)(sc->sc_rc_state, m);
1180         }
1181         if (proto == PPP_CCP) {
1182             ppp_ccp(sc, m, 1);
1183         }
1184     }
1185 #endif
1186
1187     ilen = 0;
1188     for (mp = m; mp != NULL; mp = mp->m_next)
1189         ilen += mp->m_len;
1190
1191 #ifdef VJC
1192     if (sc->sc_flags & SC_VJ_RESET) {
1193         /*
1194          * If we've missed a packet, we must toss subsequent compressed
1195          * packets which don't have an explicit connection ID.
1196          */
1197         if (sc->sc_comp)
1198             sl_uncompress_tcp(NULL, 0, TYPE_ERROR, sc->sc_comp);
1199         s = splimp();
1200         sc->sc_flags &= ~SC_VJ_RESET;
1201         splx(s);
1202     }
1203
1204     /*
1205      * See if we have a VJ-compressed packet to uncompress.
1206      */
1207     if (proto == PPP_VJC_COMP) {
1208         if ((sc->sc_flags & SC_REJ_COMP_TCP) || sc->sc_comp == 0)
1209             goto bad;
1210
1211         xlen = sl_uncompress_tcp_core(cp + PPP_HDRLEN, m->m_len - PPP_HDRLEN,
1212                                       ilen - PPP_HDRLEN, TYPE_COMPRESSED_TCP,
1213                                       sc->sc_comp, &iphdr, &hlen);
1214
1215         if (xlen <= 0) {
1216             if (sc->sc_flags & SC_DEBUG)
1217                 printf("ppp%d: VJ uncompress failed on type comp\n",
1218                         ifp->if_unit);
1219             goto bad;
1220         }
1221
1222         /* Copy the PPP and IP headers into a new mbuf. */
1223         MGET(mp, M_DONTWAIT, MT_DATA);
1224         if (mp == NULL)
1225             goto bad;
1226         mp->m_len = 0;
1227         mp->m_next = NULL;
1228         if (hlen + PPP_HDRLEN > MLEN) {
1229             MCLGET(mp, pc);
1230             if (M_TRAILINGSPACE(mp) < hlen + PPP_HDRLEN) {
1231                 m_freem(mp);
1232                 goto bad;       /* lose if big headers and no clusters */
1233             }
1234         }
1235         cp = mtod(mp, u_char *);
1236         cp[0] = adrs;
1237         cp[1] = ctrl;
1238         cp[2] = 0;
1239         cp[3] = PPP_IP;
1240         proto = PPP_IP;
1241         bcopy(iphdr, cp + PPP_HDRLEN, hlen);
1242         mp->m_len = hlen + PPP_HDRLEN;
1243
1244         /*
1245          * Trim the PPP and VJ headers off the old mbuf
1246          * and stick the new and old mbufs together.
1247          */
1248         m->m_off += PPP_HDRLEN + xlen;
1249         m->m_len -= PPP_HDRLEN + xlen;
1250         if (m->m_len <= M_TRAILINGSPACE(mp)) {
1251             bcopy(mtod(m, u_char *), mtod(mp, u_char *) + mp->m_len, m->m_len);
1252             mp->m_len += m->m_len;
1253             MFREE(m, mp->m_next);
1254         } else
1255             mp->m_next = m;
1256         m = mp;
1257         ilen += hlen - xlen;
1258
1259     } else if (proto == PPP_VJC_UNCOMP) {
1260         if ((sc->sc_flags & SC_REJ_COMP_TCP) || sc->sc_comp == 0)
1261             goto bad;
1262
1263         xlen = sl_uncompress_tcp_core(cp + PPP_HDRLEN, m->m_len - PPP_HDRLEN,
1264                                       ilen - PPP_HDRLEN, TYPE_UNCOMPRESSED_TCP,
1265                                       sc->sc_comp, &iphdr, &hlen);
1266
1267         if (xlen < 0) {
1268             if (sc->sc_flags & SC_DEBUG)
1269                 printf("ppp%d: VJ uncompress failed on type uncomp\n",
1270                         ifp->if_unit);
1271             goto bad;
1272         }
1273
1274         proto = PPP_IP;
1275         cp[3] = PPP_IP;
1276     }
1277 #endif /* VJC */
1278
1279     /*
1280      * If the packet will fit in an ordinary mbuf, don't waste a
1281      * whole cluster on it.
1282      */
1283     if (ilen <= MLEN && M_IS_CLUSTER(m)) {
1284         MGET(mp, M_DONTWAIT, MT_DATA);
1285         if (mp != NULL) {
1286             m_copydata(m, mtod(mp, caddr_t), ilen);
1287             m_freem(m);
1288             m = mp;
1289             m->m_len = ilen;
1290         }
1291     }
1292
1293     /*
1294      * Record the time that we received this packet.
1295      */
1296     if ((proto & 0x8000) == 0) {
1297         sc->sc_last_recv = time.tv_sec;
1298     }
1299
1300 #if NBPFILTER > 0
1301     /* See if bpf wants to look at the packet. */
1302     if (sc->sc_bpf)
1303         bpf_mtap(sc->sc_bpf, m);
1304 #endif
1305
1306     rv = 0;
1307     switch (proto) {
1308 #ifdef INET
1309     case PPP_IP:
1310         /*
1311          * IP packet - take off the ppp header and pass it up to IP.
1312          */
1313         if ((ifp->if_flags & IFF_UP) == 0
1314             || sc->sc_npmode[NP_IP] != NPMODE_PASS) {
1315             /* interface is down - drop the packet. */
1316             m_freem(m);
1317             return;
1318         }
1319         m->m_off += PPP_HDRLEN;
1320         m->m_len -= PPP_HDRLEN;
1321         schednetisr(NETISR_IP);
1322         inq = &ipintrq;
1323         break;
1324 #endif
1325
1326     default:
1327         /*
1328          * Some other protocol - place on input queue for read().
1329          */
1330         inq = &sc->sc_inq;
1331         rv = 1;
1332         break;
1333     }
1334
1335     /*
1336      * Put the packet on the appropriate input queue.
1337      */
1338     s = splimp();
1339     lock = inq;
1340     smp_lock(&lock->lk_ifqueue, LK_RETRY);
1341     if (IF_QFULL(inq)) {
1342         IF_DROP(inq);
1343         smp_unlock(&lock->lk_ifqueue);
1344         splx(s);
1345         if (sc->sc_flags & SC_DEBUG)
1346             printf("ppp%d: input queue full\n", ifp->if_unit);
1347         goto bad;
1348     }
1349     IF_ENQUEUEIF(inq, m, &sc->sc_if);
1350     smp_unlock(&lock->lk_ifqueue);
1351     splx(s);
1352     ifp->if_ipackets++;
1353     ifp->if_ibytes += ilen;
1354
1355     if (rv)
1356         (*sc->sc_ctlp)(sc);
1357
1358     return;
1359
1360  bad:
1361     m_freem(m);
1362     sc->sc_if.if_ierrors++;
1363     sc->sc_stats.ppp_ierrors++;
1364 }
1365
1366 #define MAX_DUMP_BYTES  128
1367
1368 static void
1369 pppdumpm(m0)
1370     struct mbuf *m0;
1371 {
1372     char buf[3*MAX_DUMP_BYTES+4];
1373     char *bp = buf;
1374     struct mbuf *m;
1375     static char digits[] = "0123456789abcdef";
1376
1377     for (m = m0; m; m = m->m_next) {
1378         int l = m->m_len;
1379         u_char *rptr = mtod(m, u_char *);
1380
1381         while (l--) {
1382             if (bp > buf + sizeof(buf) - 4)
1383                 goto done;
1384             *bp++ = digits[*rptr >> 4]; /* convert byte to ascii hex */
1385             *bp++ = digits[*rptr++ & 0xf];
1386         }
1387
1388         if (m->m_next) {
1389             if (bp > buf + sizeof(buf) - 3)
1390                 goto done;
1391             *bp++ = '|';
1392         } else
1393             *bp++ = ' ';
1394     }
1395 done:
1396     if (m)
1397         *bp++ = '>';
1398     *bp = 0;
1399     printf("%s\n", buf);
1400 }
1401
1402 #endif  /* NPPP > 0 */