sys/dev/ppbus/if_plip.c

   1 /*-
   2  * Copyright (c) 1997 Poul-Henning Kamp
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright
  11  *    notice, this list of conditions and the following disclaimer in the
  12  *    documentation and/or other materials provided with the distribution.
  13  *
  14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  15  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  16  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  17  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  18  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  19  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  20  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  21  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  22  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  23  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  24  * SUCH DAMAGE.
  25  *
  26  *      From Id: lpt.c,v 1.55.2.1 1996/11/12 09:08:38 phk Exp
  27  */
  28
  29 #include <sys/cdefs.h>
  30 __FBSDID("$FreeBSD$");
  31
  32 /*
  33  * Parallel port TCP/IP interfaces added.  I looked at the driver from
  34  * MACH but this is a complete rewrite, and btw. incompatible, and it
  35  * should perform better too.  I have never run the MACH driver though.
  36  *
  37  * This driver sends two bytes (0x08, 0x00) in front of each packet,
  38  * to allow us to distinguish another format later.
  39  *
  40  * Now added a Linux/Crynwr compatibility mode which is enabled using
  41  * IF_LINK0 - Tim Wilkinson.
  42  *
  43  * TODO:
  44  *    Make HDLC/PPP mode, use IF_LLC1 to enable.
  45  *
  46  * Connect the two computers using a Laplink parallel cable to use this
  47  * feature:
  48  *
  49  *      +----------------------------------------+
  50  *      |A-name A-End   B-End   Descr.  Port/Bit |
  51  *      +----------------------------------------+
  52  *      |DATA0  2       15      Data    0/0x01   |
  53  *      |-ERROR 15      2               1/0x08   |
  54  *      +----------------------------------------+
  55  *      |DATA1  3       13      Data    0/0x02   |
  56  *      |+SLCT  13      3               1/0x10   |
  57  *      +----------------------------------------+
  58  *      |DATA2  4       12      Data    0/0x04   |
  59  *      |+PE    12      4               1/0x20   |
  60  *      +----------------------------------------+
  61  *      |DATA3  5       10      Strobe  0/0x08   |
  62  *      |-ACK   10      5               1/0x40   |
  63  *      +----------------------------------------+
  64  *      |DATA4  6       11      Data    0/0x10   |
  65  *      |BUSY   11      6               1/~0x80  |
  66  *      +----------------------------------------+
  67  *      |GND    18-25   18-25   GND     -        |
  68  *      +----------------------------------------+
  69  *
  70  * Expect transfer-rates up to 75 kbyte/sec.
  71  *
  72  * If GCC could correctly grok
  73  *      register int port asm("edx")
  74  * the code would be cleaner
  75  *
  76  * Poul-Henning Kamp <phk@freebsd.org>
  77  */
  78
  79 /*
  80  * Update for ppbus, PLIP support only - Nicolas Souchu
  81  */
  82
  83 #include "opt_plip.h"
  84
  85 #include <sys/param.h>
  86 #include <sys/systm.h>
  87 #include <sys/module.h>
  88 #include <sys/bus.h>
  89 #include <sys/mbuf.h>
  90 #include <sys/socket.h>
  91 #include <sys/sockio.h>
  92 #include <sys/kernel.h>
  93 #include <sys/malloc.h>
  94
  95 #include <machine/bus.h>
  96 #include <machine/resource.h>
  97 #include <sys/rman.h>
  98
  99 #include <net/if.h>
 100 #include <net/if_types.h>
 101 #include <net/netisr.h>
 102 #include <net/route.h>
 103
 104 #include <netinet/in.h>
 105 #include <netinet/in_var.h>
 106
 107 #include <net/bpf.h>
 108
 109 #include <dev/ppbus/ppbconf.h>
 110 #include "ppbus_if.h"
 111 #include <dev/ppbus/ppbio.h>
 112
 113 #ifndef LPMTU                   /* MTU for the lp# interfaces */
 114 #define LPMTU           1500
 115 #endif
 116
 117 #ifndef LPMAXSPIN1              /* DELAY factor for the lp# interfaces */
 118 #define LPMAXSPIN1      8000   /* Spinning for remote intr to happen */
 119 #endif
 120
 121 #ifndef LPMAXSPIN2              /* DELAY factor for the lp# interfaces */
 122 #define LPMAXSPIN2      500     /* Spinning for remote handshake to happen */
 123 #endif
 124
 125 #ifndef LPMAXERRS               /* Max errors before !RUNNING */
 126 #define LPMAXERRS       100
 127 #endif
 128
 129 #define CLPIPHDRLEN     14      /* We send dummy ethernet addresses (two) + packet type in front of packet */
 130 #define CLPIP_SHAKE     0x80    /* This bit toggles between nibble reception */
 131 #define MLPIPHDRLEN     CLPIPHDRLEN
 132
 133 #define LPIPHDRLEN      2       /* We send 0x08, 0x00 in front of packet */
 134 #define LPIP_SHAKE      0x40    /* This bit toggles between nibble reception */
 135 #if !defined(MLPIPHDRLEN) || LPIPHDRLEN > MLPIPHDRLEN
 136 #define MLPIPHDRLEN     LPIPHDRLEN
 137 #endif
 138
 139 #define LPIPTBLSIZE     256     /* Size of octet translation table */
 140
 141 #define lprintf         if (lptflag) printf
 142
 143 #ifdef PLIP_DEBUG
 144 static int volatile lptflag = 1;
 145 #else
 146 static int volatile lptflag = 0;
 147 #endif
 148
 149 struct lp_data {
 150         struct  ifnet   *sc_ifp;
 151         device_t        sc_dev;
 152         u_char          *sc_ifbuf;
 153         int             sc_iferrs;
 154
 155         struct resource *res_irq;
 156         void            *sc_intr_cookie;
 157 };
 158
 159 static struct mtx lp_tables_lock;
 160 MTX_SYSINIT(lp_tables, &lp_tables_lock, "plip tables", MTX_DEF);
 161
 162 /* Tables for the lp# interface */
 163 static u_char *txmith;
 164 #define txmitl (txmith + (1 * LPIPTBLSIZE))
 165 #define trecvh (txmith + (2 * LPIPTBLSIZE))
 166 #define trecvl (txmith + (3 * LPIPTBLSIZE))
 167
 168 static u_char *ctxmith;
 169 #define ctxmitl (ctxmith + (1 * LPIPTBLSIZE))
 170 #define ctrecvh (ctxmith + (2 * LPIPTBLSIZE))
 171 #define ctrecvl (ctxmith + (3 * LPIPTBLSIZE))
 172
 173 /* Functions for the lp# interface */
 174 static int lpinittables(void);
 175 static int lpioctl(struct ifnet *, u_long, caddr_t);
 176 static int lpoutput(struct ifnet *, struct mbuf *, struct sockaddr *,
 177        struct route *);
 178 static void lpstop(struct lp_data *);
 179 static void lp_intr(void *);
 180 static int lp_module_handler(module_t, int, void *);
 181
 182 #define DEVTOSOFTC(dev) \
 183         ((struct lp_data *)device_get_softc(dev))
 184
 185 static devclass_t lp_devclass;
 186
 187 static int
 188 lp_module_handler(module_t mod, int what, void *arg)
 189 {
 190
 191         switch (what) {
 192         case MOD_UNLOAD:
 193                 mtx_lock(&lp_tables_lock);
 194                 if (txmith != NULL) {
 195                         free(txmith, M_DEVBUF);
 196                         txmith = NULL;
 197                 }
 198                 if (ctxmith != NULL) {
 199                         free(ctxmith, M_DEVBUF);
 200                         ctxmith = NULL;
 201                 }
 202                 mtx_unlock(&lp_tables_lock);
 203                 break;
 204         case MOD_LOAD:
 205         case MOD_QUIESCE:
 206                 break;
 207         default:
 208                 return (EOPNOTSUPP);
 209         }
 210         return (0);
 211 }
 212
 213 static void
 214 lp_identify(driver_t *driver, device_t parent)
 215 {
 216         device_t dev;
 217
 218         dev = device_find_child(parent, "plip", -1);
 219         if (!dev)
 220                 BUS_ADD_CHILD(parent, 0, "plip", -1);
 221 }
 222
 223 static int
 224 lp_probe(device_t dev)
 225 {
 226
 227         device_set_desc(dev, "PLIP network interface");
 228
 229         return (0);
 230 }
 231
 232 static int
 233 lp_attach(device_t dev)
 234 {
 235         struct lp_data *lp = DEVTOSOFTC(dev);
 236         struct ifnet *ifp;
 237         int error, rid = 0;
 238
 239         lp->sc_dev = dev;
 240
 241         /*
 242          * Reserve the interrupt resource.  If we don't have one, the
 243          * attach fails.
 244          */
 245         lp->res_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid,
 246             RF_SHAREABLE);
 247         if (lp->res_irq == 0) {
 248                 device_printf(dev, "cannot reserve interrupt, failed.\n");
 249                 return (ENXIO);
 250         }
 251
 252         ifp = lp->sc_ifp = if_alloc(IFT_PARA);
 253         if (ifp == NULL) {
 254                 return (ENOSPC);
 255         }
 256
 257         ifp->if_softc = lp;
 258         if_initname(ifp, device_get_name(dev), device_get_unit(dev));
 259         ifp->if_mtu = LPMTU;
 260         ifp->if_flags = IFF_SIMPLEX | IFF_POINTOPOINT | IFF_MULTICAST;
 261         ifp->if_ioctl = lpioctl;
 262         ifp->if_output = lpoutput;
 263         ifp->if_hdrlen = 0;
 264         ifp->if_addrlen = 0;
 265         ifp->if_snd.ifq_maxlen = ifqmaxlen;
 266         if_attach(ifp);
 267
 268         bpfattach(ifp, DLT_NULL, sizeof(u_int32_t));
 269
 270         /*
 271          * Attach our interrupt handler.  It is only called while we
 272          * own the ppbus.
 273          */
 274         error = bus_setup_intr(dev, lp->res_irq, INTR_TYPE_NET | INTR_MPSAFE,
 275             NULL, lp_intr, lp, &lp->sc_intr_cookie);
 276         if (error) {
 277                 bpfdetach(ifp);
 278                 if_detach(ifp);
 279                 bus_release_resource(dev, SYS_RES_IRQ, 0, lp->res_irq);
 280                 device_printf(dev, "Unable to register interrupt handler\n");
 281                 return (error);
 282         }
 283
 284         return (0);
 285 }
 286
 287 static int
 288 lp_detach(device_t dev)
 289 {
 290         struct lp_data *sc = device_get_softc(dev);
 291         device_t ppbus = device_get_parent(dev);
 292
 293         ppb_lock(ppbus);
 294         lpstop(sc);
 295         ppb_unlock(ppbus);
 296         bpfdetach(sc->sc_ifp);
 297         if_detach(sc->sc_ifp);
 298         bus_teardown_intr(dev, sc->res_irq, sc->sc_intr_cookie);
 299         bus_release_resource(dev, SYS_RES_IRQ, 0, sc->res_irq);
 300         return (0);
 301 }
 302
 303 /*
 304  * Build the translation tables for the LPIP (BSD unix) protocol.
 305  * We don't want to calculate these nasties in our tight loop, so we
 306  * precalculate them when we initialize.
 307  */
 308 static int
 309 lpinittables(void)
 310 {
 311         int i;
 312
 313         mtx_lock(&lp_tables_lock);
 314         if (txmith == NULL)
 315                 txmith = malloc(4 * LPIPTBLSIZE, M_DEVBUF, M_NOWAIT);
 316
 317         if (txmith == NULL) {
 318                 mtx_unlock(&lp_tables_lock);
 319                 return (1);
 320         }
 321
 322         if (ctxmith == NULL)
 323                 ctxmith = malloc(4 * LPIPTBLSIZE, M_DEVBUF, M_NOWAIT);
 324
 325         if (ctxmith == NULL) {
 326                 mtx_unlock(&lp_tables_lock);
 327                 return (1);
 328         }
 329
 330         for (i = 0; i < LPIPTBLSIZE; i++) {
 331                 ctxmith[i] = (i & 0xF0) >> 4;
 332                 ctxmitl[i] = 0x10 | (i & 0x0F);
 333                 ctrecvh[i] = (i & 0x78) << 1;
 334                 ctrecvl[i] = (i & 0x78) >> 3;
 335         }
 336
 337         for (i = 0; i < LPIPTBLSIZE; i++) {
 338                 txmith[i] = ((i & 0x80) >> 3) | ((i & 0x70) >> 4) | 0x08;
 339                 txmitl[i] = ((i & 0x08) << 1) | (i & 0x07);
 340                 trecvh[i] = ((~i) & 0x80) | ((i & 0x38) << 1);
 341                 trecvl[i] = (((~i) & 0x80) >> 4) | ((i & 0x38) >> 3);
 342         }
 343         mtx_unlock(&lp_tables_lock);
 344
 345         return (0);
 346 }
 347
 348 static void
 349 lpstop(struct lp_data *sc)
 350 {
 351         device_t ppbus = device_get_parent(sc->sc_dev);
 352
 353         ppb_assert_locked(ppbus);
 354         ppb_wctr(ppbus, 0x00);
 355         sc->sc_ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE);
 356         free(sc->sc_ifbuf, M_DEVBUF);
 357         sc->sc_ifbuf = NULL;
 358
 359         /* IFF_UP is not set, try to release the bus anyway */
 360         ppb_release_bus(ppbus, sc->sc_dev);
 361 }
 362
 363 static int
 364 lpinit_locked(struct ifnet *ifp)
 365 {
 366         struct lp_data *sc = ifp->if_softc;
 367         device_t dev = sc->sc_dev;
 368         device_t ppbus = device_get_parent(dev);
 369         int error;
 370
 371         ppb_assert_locked(ppbus);
 372         error = ppb_request_bus(ppbus, dev, PPB_DONTWAIT);
 373         if (error)
 374                 return (error);
 375
 376         /* Now IFF_UP means that we own the bus */
 377         ppb_set_mode(ppbus, PPB_COMPATIBLE);
 378
 379         if (lpinittables()) {
 380                 ppb_release_bus(ppbus, dev);
 381                 return (ENOBUFS);
 382         }
 383
 384         sc->sc_ifbuf = malloc(sc->sc_ifp->if_mtu + MLPIPHDRLEN,
 385             M_DEVBUF, M_NOWAIT);
 386         if (sc->sc_ifbuf == NULL) {
 387                 ppb_release_bus(ppbus, dev);
 388                 return (ENOBUFS);
 389         }
 390
 391         ppb_wctr(ppbus, IRQENABLE);
 392
 393         ifp->if_drv_flags |= IFF_DRV_RUNNING;
 394         ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
 395         return (0);
 396 }
 397
 398 /*
 399  * Process an ioctl request.
 400  */
 401 static int
 402 lpioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
 403 {
 404         struct lp_data *sc = ifp->if_softc;
 405         device_t dev = sc->sc_dev;
 406         device_t ppbus = device_get_parent(dev);
 407         struct ifaddr *ifa = (struct ifaddr *)data;
 408         struct ifreq *ifr = (struct ifreq *)data;
 409         u_char *ptr;
 410         int error;
 411
 412         switch (cmd) {
 413         case SIOCSIFDSTADDR:
 414         case SIOCAIFADDR:
 415         case SIOCSIFADDR:
 416                 if (ifa->ifa_addr->sa_family != AF_INET)
 417                         return (EAFNOSUPPORT);
 418
 419                 ifp->if_flags |= IFF_UP;
 420                 /* FALLTHROUGH */
 421         case SIOCSIFFLAGS:
 422                 error = 0;
 423                 ppb_lock(ppbus);
 424                 if ((!(ifp->if_flags & IFF_UP)) &&
 425                     (ifp->if_drv_flags & IFF_DRV_RUNNING))
 426                         lpstop(sc);
 427                 else if (((ifp->if_flags & IFF_UP)) &&
 428                     (!(ifp->if_drv_flags & IFF_DRV_RUNNING)))
 429                         error = lpinit_locked(ifp);
 430                 ppb_unlock(ppbus);
 431                 return (error);
 432
 433         case SIOCSIFMTU:
 434                 ppb_lock(ppbus);
 435                 if (ifp->if_drv_flags & IFF_DRV_RUNNING) {
 436                         ptr = malloc(ifr->ifr_mtu + MLPIPHDRLEN, M_DEVBUF,
 437                             M_NOWAIT);
 438                         if (ptr == NULL) {
 439                                 ppb_unlock(ppbus);
 440                                 return (ENOBUFS);
 441                         }
 442                         if (sc->sc_ifbuf)
 443                                 free(sc->sc_ifbuf, M_DEVBUF);
 444                         sc->sc_ifbuf = ptr;
 445                 }
 446                 sc->sc_ifp->if_mtu = ifr->ifr_mtu;
 447                 ppb_unlock(ppbus);
 448                 break;
 449
 450         case SIOCGIFMTU:
 451                 ifr->ifr_mtu = sc->sc_ifp->if_mtu;
 452                 break;
 453
 454         case SIOCADDMULTI:
 455         case SIOCDELMULTI:
 456                 if (ifr == 0) {
 457                         return (EAFNOSUPPORT);          /* XXX */
 458                 }
 459                 switch (ifr->ifr_addr.sa_family) {
 460                 case AF_INET:
 461                         break;
 462                 default:
 463                         return (EAFNOSUPPORT);
 464                 }
 465                 break;
 466
 467         case SIOCGIFMEDIA:
 468                 /*
 469                  * No ifmedia support at this stage; maybe use it
 470                  * in future for eg. protocol selection.
 471                  */
 472                 return (EINVAL);
 473
 474         default:
 475                 lprintf("LP:ioctl(0x%lx)\n", cmd);
 476                 return (EINVAL);
 477         }
 478         return (0);
 479 }
 480
 481 static __inline int
 482 clpoutbyte(u_char byte, int spin, device_t ppbus)
 483 {
 484
 485         ppb_wdtr(ppbus, ctxmitl[byte]);
 486         while (ppb_rstr(ppbus) & CLPIP_SHAKE)
 487                 if (--spin == 0) {
 488                         return (1);
 489                 }
 490         ppb_wdtr(ppbus, ctxmith[byte]);
 491         while (!(ppb_rstr(ppbus) & CLPIP_SHAKE))
 492                 if (--spin == 0) {
 493                         return (1);
 494                 }
 495         return (0);
 496 }
 497
 498 static __inline int
 499 clpinbyte(int spin, device_t ppbus)
 500 {
 501         u_char c, cl;
 502
 503         while ((ppb_rstr(ppbus) & CLPIP_SHAKE))
 504                 if (!--spin) {
 505                         return (-1);
 506                 }
 507         cl = ppb_rstr(ppbus);
 508         ppb_wdtr(ppbus, 0x10);
 509
 510         while (!(ppb_rstr(ppbus) & CLPIP_SHAKE))
 511                 if (!--spin) {
 512                         return (-1);
 513                 }
 514         c = ppb_rstr(ppbus);
 515         ppb_wdtr(ppbus, 0x00);
 516
 517         return (ctrecvl[cl] | ctrecvh[c]);
 518 }
 519
 520 static void
 521 lptap(struct ifnet *ifp, struct mbuf *m)
 522 {
 523         u_int32_t af = AF_INET;
 524
 525         bpf_mtap2(ifp->if_bpf, &af, sizeof(af), m);
 526 }
 527
 528 static void
 529 lp_intr(void *arg)
 530 {
 531         struct lp_data *sc = arg;
 532         device_t ppbus = device_get_parent(sc->sc_dev);
 533         int len, j;
 534         u_char *bp;
 535         u_char c, cl;
 536         struct mbuf *top;
 537
 538         ppb_assert_locked(ppbus);
 539         if (sc->sc_ifp->if_flags & IFF_LINK0) {
 540
 541                 /* Ack. the request */
 542                 ppb_wdtr(ppbus, 0x01);
 543
 544                 /* Get the packet length */
 545                 j = clpinbyte(LPMAXSPIN2, ppbus);
 546                 if (j == -1)
 547                         goto err;
 548                 len = j;
 549                 j = clpinbyte(LPMAXSPIN2, ppbus);
 550                 if (j == -1)
 551                         goto err;
 552                 len = len + (j << 8);
 553                 if (len > sc->sc_ifp->if_mtu + MLPIPHDRLEN)
 554                         goto err;
 555
 556                 bp = sc->sc_ifbuf;
 557
 558                 while (len--) {
 559                         j = clpinbyte(LPMAXSPIN2, ppbus);
 560                         if (j == -1) {
 561                                 goto err;
 562                         }
 563                         *bp++ = j;
 564                 }
 565
 566                 /* Get and ignore checksum */
 567                 j = clpinbyte(LPMAXSPIN2, ppbus);
 568                 if (j == -1) {
 569                         goto err;
 570                 }
 571
 572                 len = bp - sc->sc_ifbuf;
 573                 if (len <= CLPIPHDRLEN)
 574                         goto err;
 575
 576                 sc->sc_iferrs = 0;
 577
 578                 len -= CLPIPHDRLEN;
 579                 sc->sc_ifp->if_ipackets++;
 580                 sc->sc_ifp->if_ibytes += len;
 581                 top = m_devget(sc->sc_ifbuf + CLPIPHDRLEN, len, 0, sc->sc_ifp,
 582                     0);
 583                 if (top) {
 584                         ppb_unlock(ppbus);
 585                         if (bpf_peers_present(sc->sc_ifp->if_bpf))
 586                                 lptap(sc->sc_ifp, top);
 587
 588                         M_SETFIB(top, sc->sc_ifp->if_fib);
 589
 590                         /* mbuf is free'd on failure. */
 591                         netisr_queue(NETISR_IP, top);
 592                         ppb_lock(ppbus);
 593                 }
 594                 return;
 595         }
 596         while ((ppb_rstr(ppbus) & LPIP_SHAKE)) {
 597                 len = sc->sc_ifp->if_mtu + LPIPHDRLEN;
 598                 bp  = sc->sc_ifbuf;
 599                 while (len--) {
 600
 601                         cl = ppb_rstr(ppbus);
 602                         ppb_wdtr(ppbus, 8);
 603
 604                         j = LPMAXSPIN2;
 605                         while ((ppb_rstr(ppbus) & LPIP_SHAKE))
 606                                 if (!--j)
 607                                         goto err;
 608
 609                         c = ppb_rstr(ppbus);
 610                         ppb_wdtr(ppbus, 0);
 611
 612                         *bp++= trecvh[cl] | trecvl[c];
 613
 614                         j = LPMAXSPIN2;
 615                         while (!((cl = ppb_rstr(ppbus)) & LPIP_SHAKE)) {
 616                                 if (cl != c &&
 617                                     (((cl = ppb_rstr(ppbus)) ^ 0xb8) & 0xf8) ==
 618                                     (c & 0xf8))
 619                                         goto end;
 620                                 if (!--j)
 621                                         goto err;
 622                         }
 623                 }
 624
 625         end:
 626                 len = bp - sc->sc_ifbuf;
 627                 if (len <= LPIPHDRLEN)
 628                         goto err;
 629
 630                 sc->sc_iferrs = 0;
 631
 632                 len -= LPIPHDRLEN;
 633                 sc->sc_ifp->if_ipackets++;
 634                 sc->sc_ifp->if_ibytes += len;
 635                 top = m_devget(sc->sc_ifbuf + LPIPHDRLEN, len, 0, sc->sc_ifp,
 636                     0);
 637                 if (top) {
 638                         ppb_unlock(ppbus);
 639                         if (bpf_peers_present(sc->sc_ifp->if_bpf))
 640                                 lptap(sc->sc_ifp, top);
 641
 642                         M_SETFIB(top, sc->sc_ifp->if_fib);
 643
 644                         /* mbuf is free'd on failure. */
 645                         netisr_queue(NETISR_IP, top);
 646                         ppb_lock(ppbus);
 647                 }
 648         }
 649         return;
 650
 651 err:
 652         ppb_wdtr(ppbus, 0);
 653         lprintf("R");
 654         sc->sc_ifp->if_ierrors++;
 655         sc->sc_iferrs++;
 656
 657         /*
 658          * We are not able to send receive anything for now,
 659          * so stop wasting our time
 660          */
 661         if (sc->sc_iferrs > LPMAXERRS) {
 662                 if_printf(sc->sc_ifp, "Too many errors, Going off-line.\n");
 663                 ppb_wctr(ppbus, 0x00);
 664                 sc->sc_ifp->if_drv_flags &= ~IFF_DRV_RUNNING;
 665                 sc->sc_iferrs = 0;
 666         }
 667 }
 668
 669 static __inline int
 670 lpoutbyte(u_char byte, int spin, device_t ppbus)
 671 {
 672
 673         ppb_wdtr(ppbus, txmith[byte]);
 674         while (!(ppb_rstr(ppbus) & LPIP_SHAKE))
 675                 if (--spin == 0)
 676                         return (1);
 677         ppb_wdtr(ppbus, txmitl[byte]);
 678         while (ppb_rstr(ppbus) & LPIP_SHAKE)
 679                 if (--spin == 0)
 680                         return (1);
 681         return (0);
 682 }
 683
 684 static int
 685 lpoutput(struct ifnet *ifp, struct mbuf *m, struct sockaddr *dst,
 686     struct route *ro)
 687 {
 688         struct lp_data *sc = ifp->if_softc;
 689         device_t dev = sc->sc_dev;
 690         device_t ppbus = device_get_parent(dev);
 691         int err;
 692         struct mbuf *mm;
 693         u_char *cp = "\0\0";
 694         u_char chksum = 0;
 695         int count = 0;
 696         int i, len, spin;
 697
 698         /* We need a sensible value if we abort */
 699         cp++;
 700         ppb_lock(ppbus);
 701         ifp->if_drv_flags |= IFF_DRV_OACTIVE;
 702
 703         err = 1;                /* assume we're aborting because of an error */
 704
 705         /* Suspend (on laptops) or receive-errors might have taken us offline */
 706         ppb_wctr(ppbus, IRQENABLE);
 707
 708         if (ifp->if_flags & IFF_LINK0) {
 709                 if (!(ppb_rstr(ppbus) & CLPIP_SHAKE)) {
 710                         lprintf("&");
 711                         lp_intr(sc);
 712                 }
 713
 714                 /* Alert other end to pending packet */
 715                 spin = LPMAXSPIN1;
 716                 ppb_wdtr(ppbus, 0x08);
 717                 while ((ppb_rstr(ppbus) & 0x08) == 0)
 718                         if (--spin == 0) {
 719                                 goto nend;
 720                         }
 721
 722                 /* Calculate length of packet, then send that */
 723
 724                 count += 14;            /* Ethernet header len */
 725
 726                 mm = m;
 727                 for (mm = m; mm; mm = mm->m_next) {
 728                         count += mm->m_len;
 729                 }
 730                 if (clpoutbyte(count & 0xFF, LPMAXSPIN1, ppbus))
 731                         goto nend;
 732                 if (clpoutbyte((count >> 8) & 0xFF, LPMAXSPIN1, ppbus))
 733                         goto nend;
 734
 735                 /* Send dummy ethernet header */
 736                 for (i = 0; i < 12; i++) {
 737                         if (clpoutbyte(i, LPMAXSPIN1, ppbus))
 738                                 goto nend;
 739                         chksum += i;
 740                 }
 741
 742                 if (clpoutbyte(0x08, LPMAXSPIN1, ppbus))
 743                         goto nend;
 744                 if (clpoutbyte(0x00, LPMAXSPIN1, ppbus))
 745                         goto nend;
 746                 chksum += 0x08 + 0x00;          /* Add into checksum */
 747
 748                 mm = m;
 749                 do {
 750                         cp = mtod(mm, u_char *);
 751                         len = mm->m_len;
 752                         while (len--) {
 753                                 chksum += *cp;
 754                                 if (clpoutbyte(*cp++, LPMAXSPIN2, ppbus))
 755                                         goto nend;
 756                         }
 757                 } while ((mm = mm->m_next));
 758
 759                 /* Send checksum */
 760                 if (clpoutbyte(chksum, LPMAXSPIN2, ppbus))
 761                         goto nend;
 762
 763                 /* Go quiescent */
 764                 ppb_wdtr(ppbus, 0);
 765
 766                 err = 0;                        /* No errors */
 767
 768         nend:
 769                 ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
 770                 if (err)  {                     /* if we didn't timeout... */
 771                         ifp->if_oerrors++;
 772                         lprintf("X");
 773                 } else {
 774                         ifp->if_opackets++;
 775                         ifp->if_obytes += m->m_pkthdr.len;
 776                         if (bpf_peers_present(ifp->if_bpf))
 777                                 lptap(ifp, m);
 778                 }
 779
 780                 m_freem(m);
 781
 782                 if (!(ppb_rstr(ppbus) & CLPIP_SHAKE)) {
 783                         lprintf("^");
 784                         lp_intr(sc);
 785                 }
 786                 ppb_unlock(ppbus);
 787                 return (0);
 788         }
 789
 790         if (ppb_rstr(ppbus) & LPIP_SHAKE) {
 791                 lprintf("&");
 792                 lp_intr(sc);
 793         }
 794
 795         if (lpoutbyte(0x08, LPMAXSPIN1, ppbus))
 796                 goto end;
 797         if (lpoutbyte(0x00, LPMAXSPIN2, ppbus))
 798                 goto end;
 799
 800         mm = m;
 801         do {
 802                 cp = mtod(mm, u_char *);
 803                 len = mm->m_len;
 804                 while (len--)
 805                         if (lpoutbyte(*cp++, LPMAXSPIN2, ppbus))
 806                                 goto end;
 807         } while ((mm = mm->m_next));
 808
 809         err = 0;                        /* no errors were encountered */
 810
 811 end:
 812         --cp;
 813         ppb_wdtr(ppbus, txmitl[*cp] ^ 0x17);
 814
 815         ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
 816         if (err)  {                     /* if we didn't timeout... */
 817                 ifp->if_oerrors++;
 818                 lprintf("X");
 819         } else {
 820                 ifp->if_opackets++;
 821                 ifp->if_obytes += m->m_pkthdr.len;
 822                 if (bpf_peers_present(ifp->if_bpf))
 823                         lptap(ifp, m);
 824         }
 825
 826         m_freem(m);
 827
 828         if (ppb_rstr(ppbus) & LPIP_SHAKE) {
 829                 lprintf("^");
 830                 lp_intr(sc);
 831         }
 832
 833         ppb_unlock(ppbus);
 834         return (0);
 835 }
 836
 837 static device_method_t lp_methods[] = {
 838         /* device interface */
 839         DEVMETHOD(device_identify,      lp_identify),
 840         DEVMETHOD(device_probe,         lp_probe),
 841         DEVMETHOD(device_attach,        lp_attach),
 842         DEVMETHOD(device_detach,        lp_detach),
 843
 844         { 0, 0 }
 845 };
 846
 847 static driver_t lp_driver = {
 848         "plip",
 849         lp_methods,
 850         sizeof(struct lp_data),
 851 };
 852
 853 DRIVER_MODULE(plip, ppbus, lp_driver, lp_devclass, lp_module_handler, 0);
 854 MODULE_DEPEND(plip, ppbus, 1, 1, 1);