/* $NetBSD: lpt.c,v 1.1 1996/01/31 23:24:49 mark Exp $ */ /* * Copyright (c) 1995 Mark Brinicombe * Copyright (c) 1993, 1994 Charles Hannum. * Copyright (c) 1990 William F. Jolitz, TeleMuse * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. All advertising materials mentioning features or use of this software * must display the following acknowledgement: * This software is a component of "386BSD" developed by * William F. Jolitz, TeleMuse. * 4. Neither the name of the developer nor the name "386BSD" * may be used to endorse or promote products derived from this software * without specific prior written permission. * * THIS SOFTWARE IS A COMPONENT OF 386BSD DEVELOPED BY WILLIAM F. JOLITZ * AND IS INTENDED FOR RESEARCH AND EDUCATIONAL PURPOSES ONLY. THIS * SOFTWARE SHOULD NOT BE CONSIDERED TO BE A COMMERCIAL PRODUCT. * THE DEVELOPER URGES THAT USERS WHO REQUIRE A COMMERCIAL PRODUCT * NOT MAKE USE OF THIS WORK. * * FOR USERS WHO WISH TO UNDERSTAND THE 386BSD SYSTEM DEVELOPED * BY WILLIAM F. JOLITZ, WE RECOMMEND THE USER STUDY WRITTEN * REFERENCES SUCH AS THE "PORTING UNIX TO THE 386" SERIES * (BEGINNING JANUARY 1991 "DR. DOBBS JOURNAL", USA AND BEGINNING * JUNE 1991 "UNIX MAGAZIN", GERMANY) BY WILLIAM F. JOLITZ AND * LYNNE GREER JOLITZ, AS WELL AS OTHER BOOKS ON UNIX AND THE * ON-LINE 386BSD USER MANUAL BEFORE USE. A BOOK DISCUSSING THE INTERNALS * OF 386BSD ENTITLED "386BSD FROM THE INSIDE OUT" WILL BE AVAILABLE LATE 1992. * * THIS SOFTWARE IS PROVIDED BY THE DEVELOPER ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE DEVELOPER BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. * * from:$NetBSD: lpt.c,v 1.1 1996/01/31 23:24:49 mark Exp $ * $Id: lpt.c,v 1.1 1996/01/31 23:24:49 mark Exp $ */ /* * Device Driver for AT parallel printer port */ /* * PLIP driver code added by Mark Brinicombe */ #include #include #include #include #include #include #include #include #include #include #if defined(INET) && defined(PLIP) #include #include #include #include #include #include #include #include #include #include #include #include "bpfilter.h" #if NBPFILTER > 0 #include #include #endif #endif #include #include #include #include #include #include #define inb ReadByte #define outb WriteByte #define TIMEOUT hz*16 /* wait up to 16 seconds for a ready */ #define STEP hz/4 #define LPTPRI (PZERO+8) #define LPT_BSIZE 1024 #if defined(INET) && defined(PLIP) #ifndef PLIPMTU /* MTU for the plip# interfaces */ #if defined(COMPAT_PLIP10) #define PLIPMTU 1600 #else #define PLIPMTU (ETHERMTU - ifp->if_hdrlen) #endif #endif #ifndef PLIPMXSPIN1 /* DELAY factor for the plip# interfaces */ #define PLIPMXSPIN1 2000 /* Spinning for remote intr to happen */ #endif #ifndef PLIPMXSPIN2 /* DELAY factor for the plip# interfaces */ #define PLIPMXSPIN2 6000 /* Spinning for remote handshake to happen */ #endif #ifndef PLIPMXERRS /* Max errors before !RUNNING */ #define PLIPMXERRS 100 #endif #ifndef PLIPMXRETRY #define PLIPMXRETRY 10 /* Max number of retransmits */ #endif #ifndef PLIPRETRY #define PLIPRETRY hz/10 /* Time between retransmits */ #endif #endif #if !defined(DEBUG) || !defined(notdef) #define lprintf #else #define lprintf if (lptdebug) printf int lptdebug = 1; #endif struct lpt_softc { struct device sc_dev; irqhandler_t sc_ih; size_t sc_count; struct buf *sc_inbuf; u_char *sc_cp; int sc_spinmax; int sc_iobase; int sc_irq; u_char sc_state; #define LPT_OPEN 0x01 /* device is open */ #define LPT_OBUSY 0x02 /* printer is busy doing output */ #define LPT_INIT 0x04 /* waiting to initialize for open */ #define LPT_PLIP 0x08 /* busy with PLIP */ u_char sc_flags; #define LPT_AUTOLF 0x20 /* automatic LF on CR */ #define LPT_NOPRIME 0x40 /* don't prime on open */ #define LPT_NOINTR 0x80 /* do not use interrupt */ u_char sc_control; u_char sc_laststatus; #if defined(INET) && defined(PLIP) struct arpcom sc_arpcom; u_char *sc_ifbuf; int sc_iferrs; int sc_ifretry; #if defined(COMPAT_PLIP10) u_char sc_adrcksum; #endif #endif }; int lptprobe __P((struct device *, void *, void *)); void lptattach __P((struct device *, struct device *, void *)); int lptintr __P((void *)); #if defined(INET) && defined(PLIP) /* Functions for the plip# interface */ static void plipattach(struct lpt_softc *,int); static int plipioctl(struct ifnet *, u_long, caddr_t); static void plipstart(struct ifnet *); static int plipintr(struct lpt_softc *); #endif struct cfdriver lptcd = { NULL, "lpt", lptprobe, lptattach, DV_TTY, sizeof(struct lpt_softc) }; #define LPTUNIT(s) (minor(s) & 0x1f) #define LPTFLAGS(s) (minor(s) & 0xe0) #define LPS_INVERT (LPS_SELECT|LPS_NERR|LPS_NBSY|LPS_NACK) #define LPS_MASK (LPS_SELECT|LPS_NERR|LPS_NBSY|LPS_NACK|LPS_NOPAPER) #define NOT_READY() ((inb(iobase + lpt_status) ^ LPS_INVERT) & LPS_MASK) #define NOT_READY_ERR() not_ready(inb(iobase + lpt_status), sc) static int not_ready __P((u_char, struct lpt_softc *)); static void lptwakeup __P((void *arg)); static int pushbytes __P((struct lpt_softc *)); /* * Internal routine to lptprobe to do port tests of one byte value. */ int lpt_port_test(port, data, mask) int port; u_char data, mask; { int timeout; u_char temp; data &= mask; outb(port, data); timeout = 1000; do { delay(10); temp = inb(port) & mask; } while (temp != data && --timeout); lprintf("lpt: port=0x%x out=0x%x in=0x%x timeout=%d\n", port, data, temp, timeout); return (temp == data); } /* * Logic: * 1) You should be able to write to and read back the same value * to the data port. Do an alternating zeros, alternating ones, * walking zero, and walking one test to check for stuck bits. * * 2) You should be able to write to and read back the same value * to the control port lower 5 bits, the upper 3 bits are reserved * per the IBM PC technical reference manauls and different boards * do different things with them. Do an alternating zeros, alternating * ones, walking zero, and walking one test to check for stuck bits. * * Some printers drag the strobe line down when the are powered off * so this bit has been masked out of the control port test. * * XXX Some printers may not like a fast pulse on init or strobe, I * don't know at this point, if that becomes a problem these bits * should be turned off in the mask byte for the control port test. * * 3) Set the data and control ports to a value of 0 */ int lptprobe(parent, match, aux) struct device *parent; void *match, *aux; { struct mainbus_attach_args *mb = aux; int iobase = mb->mb_iobase; int port; u_char mask, data; int i; #ifdef DEBUG #define ABORT do {printf("lptprobe: mask %x data %x failed\n", mask, data); \ return 0;} while (0) #else #define ABORT return 0 #endif port = iobase + lpt_data; mask = 0xff; data = 0x55; /* Alternating zeros */ if (!lpt_port_test(port, data, mask)) ABORT; data = 0xaa; /* Alternating ones */ if (!lpt_port_test(port, data, mask)) ABORT; for (i = 0; i < CHAR_BIT; i++) { /* Walking zero */ data = ~(1 << i); if (!lpt_port_test(port, data, mask)) ABORT; } for (i = 0; i < CHAR_BIT; i++) { /* Walking one */ data = (1 << i); if (!lpt_port_test(port, data, mask)) ABORT; } outb(iobase + lpt_data, 0); outb(iobase + lpt_control, 0); mb->mb_iosize = LPT_NPORTS; return 1; } void lptattach(parent, self, aux) struct device *parent, *self; void *aux; { struct lpt_softc *sc = (void *)self; struct mainbus_attach_args *mb = aux; int iobase = mb->mb_iobase; if (mb->mb_irq != IRQUNK) printf("\n"); else printf(": polled\n"); sc->sc_iobase = iobase; sc->sc_irq = mb->mb_irq; sc->sc_state = 0; outb(iobase + lpt_control, LPC_NINIT); if (mb->mb_irq != IRQUNK) { sc->sc_ih.ih_func = lptintr; sc->sc_ih.ih_arg = sc; #if defined(INET) && defined(PLIP) sc->sc_ih.ih_level = IPL_NET; plipattach(sc, self->dv_unit); #else sc->sc_ih.ih_level = IPL_NONE; #endif irq_claim(mb->mb_irq, &sc->sc_ih); } #if defined(INET) && defined(PLIP) else { printf("Warning PLIP device needs IRQ driven lpt driver\n"); } #endif } /* * Reset the printer, then wait until it's selected and not busy. */ int lptopen(dev, flag) dev_t dev; int flag; { int unit = LPTUNIT(dev); u_char flags = LPTFLAGS(dev); struct lpt_softc *sc; int iobase; u_char control; int error; int spin; if (unit >= lptcd.cd_ndevs) return ENXIO; sc = lptcd.cd_devs[unit]; if (!sc) return ENXIO; if (sc->sc_irq == IRQUNK && (flags & LPT_NOINTR) == 0) return ENXIO; #ifdef DIAGNOSTIC if (sc->sc_state) printf("%s: stat=0x%x not zero\n", sc->sc_dev.dv_xname, sc->sc_state); #endif if (sc->sc_state) return EBUSY; sc->sc_state = LPT_INIT; sc->sc_flags = flags; lprintf("%s: open: flags=0x%x\n", sc->sc_dev.dv_xname, flags); iobase = sc->sc_iobase; if ((flags & LPT_NOPRIME) == 0) { /* assert INIT for 100 usec to start up printer */ outb(iobase + lpt_control, LPC_SELECT); delay(100); } control = LPC_SELECT | LPC_NINIT; outb(iobase + lpt_control, control); /* wait till ready (printer running diagnostics) */ for (spin = 0; NOT_READY_ERR(); spin += STEP) { if (spin >= TIMEOUT) { sc->sc_state = 0; return EBUSY; } /* wait 1/4 second, give up if we get a signal */ if (error = tsleep((caddr_t)sc, LPTPRI | PCATCH, "lptopen", STEP) != EWOULDBLOCK) { sc->sc_state = 0; return error; } } if ((flags & LPT_NOINTR) == 0) control |= LPC_IENABLE; if (flags & LPT_AUTOLF) control |= LPC_AUTOLF; sc->sc_control = control; outb(iobase + lpt_control, control); sc->sc_inbuf = geteblk(LPT_BSIZE); sc->sc_count = 0; sc->sc_state = LPT_OPEN; if ((sc->sc_flags & LPT_NOINTR) == 0) lptwakeup(sc); lprintf("%s: opened\n", sc->sc_dev.dv_xname); return 0; } int not_ready(status, sc) u_char status; struct lpt_softc *sc; { u_char new; status = (status ^ LPS_INVERT) & LPS_MASK; new = status & ~sc->sc_laststatus; sc->sc_laststatus = status; if (new & LPS_SELECT) log(LOG_NOTICE, "%s: offline\n", sc->sc_dev.dv_xname); else if (new & LPS_NOPAPER) log(LOG_NOTICE, "%s: out of paper\n", sc->sc_dev.dv_xname); else if (new & LPS_NERR) log(LOG_NOTICE, "%s: output error\n", sc->sc_dev.dv_xname); return status; } void lptwakeup(arg) void *arg; { struct lpt_softc *sc = arg; int s; s = spltty(); lptintr(sc); splx(s); timeout(lptwakeup, sc, STEP); } /* * Close the device, and free the local line buffer. */ lptclose(dev, flag) dev_t dev; int flag; { int unit = LPTUNIT(dev); struct lpt_softc *sc = lptcd.cd_devs[unit]; int iobase = sc->sc_iobase; if (sc->sc_count) (void) pushbytes(sc); if ((sc->sc_flags & LPT_NOINTR) == 0) untimeout(lptwakeup, sc); outb(iobase + lpt_control, LPC_NINIT); sc->sc_state = 0; outb(iobase + lpt_control, LPC_NINIT); brelse(sc->sc_inbuf); lprintf("%s: closed\n", sc->sc_dev.dv_xname); return 0; } int pushbytes(sc) struct lpt_softc *sc; { int iobase = sc->sc_iobase; int error; if (sc->sc_flags & LPT_NOINTR) { int spin, tic; u_char control = sc->sc_control; while (sc->sc_count > 0) { spin = 0; while (NOT_READY()) { if (++spin < sc->sc_spinmax) continue; tic = 0; /* adapt busy-wait algorithm */ sc->sc_spinmax++; while (NOT_READY_ERR()) { /* exponential backoff */ tic = tic + tic + 1; if (tic > TIMEOUT) tic = TIMEOUT; error = tsleep((caddr_t)sc, LPTPRI | PCATCH, "lptpsh", tic); if (error != EWOULDBLOCK) return error; } break; } outb(iobase + lpt_data, *sc->sc_cp++); outb(iobase + lpt_control, control | LPC_STROBE); sc->sc_count--; outb(iobase + lpt_control, control); /* adapt busy-wait algorithm */ if (spin*2 + 16 < sc->sc_spinmax) sc->sc_spinmax--; } } else { int s; while (sc->sc_count > 0) { /* if the printer is ready for a char, give it one */ if ((sc->sc_state & LPT_OBUSY) == 0) { lprintf("%s: write %d\n", sc->sc_dev.dv_xname, sc->sc_count); s = spltty(); (void) lptintr(sc); splx(s); } if (error = tsleep((caddr_t)sc, LPTPRI | PCATCH, "lptwrite2", 0)) return error; } } return 0; } /* * Copy a line from user space to a local buffer, then call putc to get the * chars moved to the output queue. */ lptwrite(dev, uio) dev_t dev; struct uio *uio; { struct lpt_softc *sc = lptcd.cd_devs[LPTUNIT(dev)]; size_t n; int error = 0; while (n = min(LPT_BSIZE, uio->uio_resid)) { uiomove(sc->sc_cp = sc->sc_inbuf->b_data, n, uio); sc->sc_count = n; error = pushbytes(sc); if (error) { /* * Return accurate residual if interrupted or timed * out. */ uio->uio_resid += sc->sc_count; sc->sc_count = 0; return error; } } return 0; } /* * Handle printer interrupts which occur when the printer is ready to accept * another char. */ int lptintr(arg) void *arg; { struct lpt_softc *sc = arg; int iobase = sc->sc_iobase; printf("lptintr:\n"); #if defined(INET) && defined(PLIP) if (sc->sc_arpcom.ac_if.if_flags & IFF_UP) { return(plipintr(sc)); } #endif #if 0 if ((sc->sc_state & LPT_OPEN) == 0) return 0; #endif /* is printer online and ready for output */ if (NOT_READY() && NOT_READY_ERR()) return 0; if (sc->sc_count) { u_char control = sc->sc_control; /* send char */ outb(iobase + lpt_data, *sc->sc_cp++); outb(iobase + lpt_control, control | LPC_STROBE); sc->sc_count--; outb(iobase + lpt_control, control); sc->sc_state |= LPT_OBUSY; } else sc->sc_state &= ~LPT_OBUSY; if (sc->sc_count == 0) { /* none, wake up the top half to get more */ wakeup((caddr_t)sc); } return(1); } int lptioctl(dev, cmd, data, flag) dev_t dev; u_long cmd; caddr_t data; int flag; { int error = 0; switch (cmd) { default: error = ENODEV; } return error; } #if defined(INET) && defined(PLIP) #define PLIP_INTR_ENABLE (LPC_NINIT | LPC_SELECT | LPC_IENABLE) #define PLIP_INTR_DISABLE (LPC_NINIT | LPC_SELECT) #define PLIP_DATA (iobase + lpt_data) #define PLIP_STATUS (iobase + lpt_status) #define PLIP_CONTROL (iobase + lpt_control) #define PLIP_REMOTE_TRIGGER 0x08 #define PLIP_DELAY_UNIT 50 #if PLIP_DELAY_UNIT > 0 #define PLIP_DELAY DELAY(PLIP_DELAY_UNIT) #else #define PLIP_DELAY #endif #define PLIP_DEBUG_RX 0x01 #define PLIP_DEBUG_TX 0x02 #define PLIP_DEBUG_IF 0x04 #define PLIP_DEBUG 0x07 #if PLIP_DEBUG != 0 static int plip_debug = PLIP_DEBUG; #endif static void plipattach(struct lpt_softc *sc, int unit) { struct ifnet *ifp = &sc->sc_arpcom.ac_if; sc->sc_ifbuf = NULL; ifp->if_unit = unit; ifp->if_name = "plip"; ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_NOTRAILERS; ifp->if_output = ether_output; ifp->if_start = plipstart; ifp->if_ioctl = plipioctl; ifp->if_watchdog = 0; ifp->if_type = IFT_ETHER; ifp->if_addrlen = 6; ifp->if_hdrlen = 14; ifp->if_mtu = PLIPMTU; if_attach(ifp); ether_ifattach(ifp); printf("plip%d at lpt%d: mtu=%d,%d,%d", unit, unit, (int) ifp->if_mtu, ifp->if_hdrlen, ifp->if_addrlen); if (sizeof(struct ether_header) != 14) printf(" ethhdr super kludge mode enabled\n"); else printf("\n"); #if NBPFILTER > 0 bpfattach(&ifp->if_bpf, ifp, DLT_EN10MB, sizeof(struct ether_header)); #endif } /* * Process an ioctl request. */ static int plipioctl(struct ifnet *ifp, u_long cmd, caddr_t data) { struct proc *p = curproc; struct lpt_softc *sc = (struct lpt_softc *) lptcd.cd_devs[ifp->if_unit]; unsigned int iobase = sc->sc_iobase; struct ifaddr *ifa = (struct ifaddr *)data; struct ifreq *ifr = (struct ifreq *)data; int s; int error = 0; #if PLIP_DEBUG > 0 printf("plipioctl: cmd=%08x ifp=%08x data=%08x\n", cmd, ifp, data); printf("plipioctl: ifp->flags=%08x\n", ifp->if_flags); #endif switch (cmd) { case SIOCSIFFLAGS: if (((ifp->if_flags & IFF_UP) == 0) && (ifp->if_flags & IFF_RUNNING)) { ifp->if_flags &= ~IFF_RUNNING; /* Deactive the parallel port */ #if PLIP_DEBUG != 0 if (plip_debug & PLIP_DEBUG_IF) printf("plip: Disabling lpt irqs\n"); #endif outb(PLIP_DATA, 0x00); outb(PLIP_CONTROL, PLIP_INTR_DISABLE); sc->sc_state = 0; if (sc->sc_ifbuf) free(sc->sc_ifbuf, M_DEVBUF); sc->sc_ifbuf = NULL; } if (((ifp->if_flags & IFF_UP)) && ((ifp->if_flags & IFF_RUNNING) == 0)) { if (sc->sc_state) { error = EBUSY; break; } /* if (!(ifp->if_flags & IFF_DEBUG)) plip_debug = PLIP_DEBUG; else plip_debug = 0;*/ sc->sc_state = LPT_OPEN | LPT_PLIP; if (!sc->sc_ifbuf) sc->sc_ifbuf = malloc(ifp->if_mtu + ifp->if_hdrlen, M_DEVBUF, M_WAITOK); ifp->if_flags |= IFF_RUNNING; /* This starts it running */ /* Enable lpt interrupts */ #if PLIP_DEBUG != 0 if (plip_debug & PLIP_DEBUG_IF) printf("plip: Enabling lpt irqs\n"); #endif outb(PLIP_CONTROL, PLIP_INTR_ENABLE); outb(PLIP_DATA, 0x00); } break; case SIOCSIFADDR: if (ifa->ifa_addr->sa_family == AF_INET) { if (!sc->sc_ifbuf) sc->sc_ifbuf = malloc(PLIPMTU + ifp->if_hdrlen, M_DEVBUF, M_WAITOK); sc->sc_arpcom.ac_enaddr[0] = 0xfc; sc->sc_arpcom.ac_enaddr[1] = 0xfc; bcopy((caddr_t)&IA_SIN(ifa)->sin_addr, (caddr_t)&sc->sc_arpcom.ac_enaddr[2], 4); sc->sc_arpcom.ac_ipaddr = IA_SIN(ifa)->sin_addr; #if defined(COMPAT_PLIP10) if (ifp->if_flags & IFF_LINK0) { int i; sc->sc_arpcom.ac_enaddr[0] = 0xfd; sc->sc_arpcom.ac_enaddr[1] = 0xfd; for (i = sc->sc_adrcksum = 0; i < 5; i++) sc->sc_adrcksum += sc->sc_arpcom.ac_enaddr[i]; sc->sc_adrcksum *= 2; } #endif ifp->if_flags |= IFF_RUNNING | IFF_UP; #if 0 for (ifa = ifp->if_addrlist; ifa; ifa = ifa->ifa_next) { struct sockaddr_dl *sdl; if ((sdl = (struct sockaddr_dl *)ifa->ifa_addr) && sdl->sdl_family == AF_LINK) { sdl->sdl_type = IFT_ETHER; sdl->sdl_alen = ifp->if_addrlen; bcopy((caddr_t)((struct arpcom *)ifp)->ac_enaddr, LLADDR(sdl), ifp->if_addrlen); break; } } #endif /* Looks the same as the start condition above */ /* Enable lpt interrupts */ #if PLIP_DEBUG != 0 if (plip_debug & PLIP_DEBUG_IF) printf("plip: Enabling lpt irqs\n"); #endif outb(PLIP_CONTROL, PLIP_INTR_ENABLE); outb(PLIP_DATA, 0x00); arp_ifinit(&sc->sc_arpcom, ifa); } else error = EAFNOSUPPORT; break; case SIOCAIFADDR: case SIOCDIFADDR: case SIOCSIFDSTADDR: if (ifa->ifa_addr->sa_family != AF_INET) error = EAFNOSUPPORT; break; case SIOCSIFMTU: if ((error = suser(p->p_ucred, &p->p_acflag))) return(error); if (ifp->if_mtu != ifr->ifr_metric) { ifp->if_mtu = ifr->ifr_metric; if (sc->sc_ifbuf) { s = splimp(); free(sc->sc_ifbuf, M_DEVBUF); sc->sc_ifbuf = malloc(ifp->if_mtu + ifp->if_hdrlen, M_DEVBUF, M_WAITOK); splx(s); } } break; case SIOCGIFMTU: ifr->ifr_metric = ifp->if_mtu; break; default: error = EINVAL; } return (error); } static int plipreceive(unsigned int iobase, u_char *buf, int len) { int i; u_char cksum = 0, c; u_char c0, c1; #if PLIP_DEBUG != 0 if (plip_debug & PLIP_DEBUG_RX) printf("Rx: "); #endif while (len--) { i = PLIPMXSPIN2; /* Receive a byte */ /* Wait for a steady handshake */ while (1) { c0 = inb(PLIP_STATUS); if ((c0 & LPS_NBSY) == 0) { c1 = inb(PLIP_STATUS); if (c0 == c1) break; #if PLIP_DEBUG != 0 if (plip_debug & PLIP_DEBUG_RX) printf("rx: %02x-%02x ", c0, c1); #endif } --i; if (i < 0) { #if PLIP_DEBUG > 0 printf("timeout rx lsn %02x\n", c0); #endif return(-1); } PLIP_DELAY; } c = (c0 >> 3) & 0x0f; /* Acknowledge */ outb(PLIP_DATA, 0x10); /* Another handshake */ i = PLIPMXSPIN2; while (1) { c0 = inb(PLIP_STATUS); if (c0 & LPS_NBSY) { c1 = inb(PLIP_STATUS); if (c0 == c1) break; #if PLIP_DEBUG != 0 if (plip_debug & PLIP_DEBUG_RX) printf("rx: %02x-%02x ", c0, c1); #endif } --i; if (i < 0) { #if PLIP_DEBUG > 0 printf("timeout rx msn %02x\n", c0); #endif return(-1); } PLIP_DELAY; } c = c | ((c0 << 1) & 0xf0); /* Acknowledge */ outb(PLIP_DATA, 0x00); #if PLIP_DEBUG != 0 if (plip_debug & PLIP_DEBUG_RX) printf("%02x ", c); #endif cksum += (*buf++ = c); } #if PLIP_DEBUG != 0 if (plip_debug & PLIP_DEBUG_RX) printf("\n"); #endif return(cksum); } static int plipintr(struct lpt_softc *sc) { extern struct mbuf *m_devget(char *, int, int, struct ifnet *, void (*)()); struct ifnet *ifp = &sc->sc_arpcom.ac_if; unsigned int iobase = sc->sc_iobase; struct mbuf *m; struct ether_header *eh; u_char *p = sc->sc_ifbuf, minibuf[4]; int c, s, len, cksum; u_char c0; printf("plipintr:\n"); /* Get the status */ c0 = inb(PLIP_STATUS); #if PLIP_DEBUG > 0 if ((c0 & 0xf8) != 0xc0) { printf("st5=%02x ", c0); } #endif /* Don't want ints while receiving */ outb(PLIP_CONTROL, PLIP_INTR_DISABLE); outb(PLIP_DATA, 0x01); /* send ACK */ /* via NERR */ #if defined(COMPAT_PLIP10) if (ifp->if_flags & IFF_LINK0) { if (plipreceive(iobase, minibuf, 3) < 0) goto err; len = (minibuf[1] << 8) | minibuf[2]; if (len > (ifp->if_mtu + ifp->if_hdrlen)) goto err; switch (minibuf[0]) { case 0xfc: p[0] = p[ 6] = ifp->ac_enaddr[0]; p[1] = p[ 7] = ifp->ac_enaddr[1]; p[2] = p[ 8] = ifp->ac_enaddr[2]; p[3] = p[ 9] = ifp->ac_enaddr[3]; p[4] = p[10] = ifp->ac_enaddr[4]; p += 5; if ((cksum = plipreceive(iobase, p, 1)) < 0) goto err; p += 6; if ((c = plipreceive(iobase, p, len - 11)) < 0) goto err; cksum += c + sc->sc_adrcksum; c = p[1]; p[1] = p[2]; p[2] = c; cksum &= 0xff; break; case 0xfd: if ((cksum = plipreceive(iobase, p, len)) < 0) goto err; break; default: goto err; } } else #endif { if (plipreceive(iobase, minibuf, 2) < 0) goto err; len = (minibuf[1] << 8) | minibuf[0]; if (len > (ifp->if_mtu + ifp->if_hdrlen)) { log(LOG_NOTICE, "plip%d: packet > MTU\n", ifp->if_unit); goto err; } #if PLIP_DEBUG != 0 if (plip_debug & PLIP_DEBUG_RX) printf("len=%d ", len); #endif if (sizeof(struct ether_header) != 14) { if ((cksum = plipreceive(iobase, p, 14)) < 0) goto err; if ((c = plipreceive(iobase, p+16, len-14)) < 0) goto err; cksum += c; len += 2; } else if ((cksum = plipreceive(iobase, p, len)) < 0) goto err; } if (plipreceive(iobase, minibuf, 1) < 0) goto err; if ((cksum & 0xff) != minibuf[0]) { printf("cksum=%d, %d, %d\n", cksum, c, minibuf[0]); log(LOG_NOTICE, "plip%d: checksum error\n", ifp->if_unit); goto err; } outb(PLIP_DATA, 0x00); /* clear ACK */ /* via NERR */ #if PLIP_DEBUG != 0 if (plip_debug & PLIP_DEBUG_RX) printf("done\n"); #endif s = splimp(); eh = (struct ether_header *)sc->sc_ifbuf; if ((m = m_devget(sc->sc_ifbuf + sizeof(struct ether_header), len - sizeof(struct ether_header), 0, ifp, NULL))) { /* We assume that the header fit entirely in one mbuf. */ /* eh = mtod(m, struct ether_header *);*/ /* m->m_pkthdr.len -= sizeof(*eh);*/ /* m->m_len -= sizeof(*eh);*/ /* m->m_data += sizeof(*eh);*/ /* printf("m->m_data=%08x ifbuf=%08x eh=%08x\n", m->m_data, sc->sc_ifbuf, eh);*/ #if NBPFILTER > 0 /* * Check if there's a BPF listener on this interface. * If so, hand off the raw packet to bpf. */ if (sc->sc_arpcom.ac_if.if_bpf) { bpf_mtap(sc->sc_arpcom.ac_if.if_bpf, m); } #endif ether_input(ifp, eh, m); } splx(s); sc->sc_iferrs = 0; ifp->if_ipackets++; /* Allow ints again */ outb(PLIP_CONTROL, PLIP_INTR_ENABLE); return(1); err: outb(PLIP_DATA, 0x00); /* clear ACK */ /* via NERR */ ifp->if_ierrors++; sc->sc_iferrs++; if (sc->sc_iferrs > PLIPMXERRS || (sc->sc_iferrs > 5 && (inb(iobase + lpt_status) & LPS_NBSY))) { /* We are not able to send receive anything for now, * so stop wasting our time and leave the interrupt * disabled. */ if (sc->sc_iferrs == PLIPMXERRS + 1) log(LOG_NOTICE, "plip%d: rx hard error\n", ifp->if_unit); /* xxx i8255->port_a |= LPA_ACTIVE;*/ } else ; /* xxx i8255->port_a |= LPA_ACKENABLE | LPA_ACTIVE;*/ /* Allow ints again */ outb(PLIP_CONTROL, PLIP_INTR_ENABLE); return(1); } static int pliptransmit(unsigned int iobase, u_char *buf, int len) { int i; u_char cksum = 0, c; u_char c0; #if PLIP_DEBUG != 0 if (plip_debug & PLIP_DEBUG_TX) printf("tx: len=%d ", len); #endif while (len--) { i = PLIPMXSPIN2; cksum += (c = *buf++); #if PLIP_DEBUG != 0 if (plip_debug & PLIP_DEBUG_TX) printf("%02x ", c); #endif /* xxx while ((i8255->port_c & LPC_NBUSY) == 0) if (i-- < 0) return -1; i8255->port_b = c & 0x0f; i8255->port_b = c & 0x0f | 0x10; c >>= 4; while ((i8255->port_c & LPC_NBUSY) != 0) if (i-- < 0) return -1; i8255->port_b = c | 0x10; i8255->port_b = c; */ /* Send the nibble + handshake */ outb(PLIP_DATA, 0x00 | (c & 0x0f)); outb(PLIP_DATA, 0x10 | (c & 0x0f)); while (1) { c0 = inb(PLIP_STATUS); if ((c0 & LPS_NBSY) == 0) break; if (--i == 0) { /* time out */ #if PLIP_DEBUG > 0 printf("timeout tx lsn %02x ", c0); #endif return(-1); } PLIP_DELAY; } outb(PLIP_DATA, 0x10 | (c >> 4)); outb(PLIP_DATA, 0x00 | (c >> 4)); i = PLIPMXSPIN2; while (1) { c0 = inb(PLIP_STATUS); if ((c0 & LPS_NBSY) != 0) break; if (--i == 0) { /* time out */ #if PLIP_DEBUG > 0 printf("timeout tx msn %02x ", c0); #endif return(-1); } PLIP_DELAY; } } #if PLIP_DEBUG != 0 if (plip_debug & PLIP_DEBUG_TX) printf("done\n"); #endif return(cksum); } /* * Setup output on interface. */ static void plipstart(struct ifnet *ifp) { struct lpt_softc *sc = (struct lpt_softc *) lptcd.cd_devs[ifp->if_unit]; unsigned int iobase = sc->sc_iobase; struct mbuf *m0, *m; u_char minibuf[4], cksum; int len, i, s; u_char *p; #if PLIP_DEBUG != 0 if (plip_debug & PLIP_DEBUG_TX) printf("plipstart: "); #endif if (ifp->if_flags & IFF_OACTIVE) return; ifp->if_flags |= IFF_OACTIVE; if (sc->sc_ifretry) untimeout((void (*)(void *))plipstart, ifp); for (;;) { s = splimp(); IF_DEQUEUE(&ifp->if_snd, m0); splx(s); if (!m0) break; for (len = 0, m = m0; m; m = m->m_next) { #if PLIP_DEBUG > 0 if (plip_debug & PLIP_DEBUG_TX) printf("len=%d %d\n", m->m_len, len); #endif len += m->m_len; } #if NBPFILTER > 0 p = sc->sc_ifbuf; for (m = m0; m; m = m->m_next) { if (m->m_len == 0) continue; bcopy(mtod(m, u_char *), p, m->m_len); p += m->m_len; } if (sc->sc_arpcom.ac_if.if_bpf) bpf_tap(sc->sc_arpcom.ac_if.if_bpf, sc->sc_ifbuf, len); #endif if (sizeof(struct ether_header) != 14) len -= 2; #if defined(COMPAT_PLIP10) if (ifp->if_flags & IFF_LINK0) { minibuf[0] = 3; minibuf[1] = 0xfd; minibuf[2] = len >> 8; minibuf[3] = len; } else #endif { minibuf[0] = 2; minibuf[1] = len; minibuf[2] = len >> 8; } /*yyy for (i = PLIPMXSPIN1; (inb(PLIP_STATUS) & LPS_NERR) != 0; i--) if (i < 0) goto retry;*/ /* Trigger remote interrupt */ #if PLIP_DEBUG > 0 if (plip_debug & PLIP_DEBUG_TX) printf("st=%02x ", inb(PLIP_STATUS)); #endif if (inb(PLIP_STATUS) & LPS_NERR) { for (i = PLIPMXSPIN1; (inb(PLIP_STATUS) & LPS_NERR) != 0; i--) PLIP_DELAY; #if PLIP_DEBUG > 0 if (plip_debug & PLIP_DEBUG_TX) printf("st1=%02x ", inb(PLIP_STATUS)); #endif } outb(PLIP_DATA, PLIP_REMOTE_TRIGGER); for (i = PLIPMXSPIN1; (inb(PLIP_STATUS) & LPS_NERR) == 0; i--) { if (i < 0 || (i > PLIPMXSPIN1/3 && inb(PLIP_STATUS) & LPS_NACK)) { #if PLIP_DEBUG > 0 printf("trigger ack timeout\n"); #endif goto retry; } PLIP_DELAY; } #if PLIP_DEBUG > 0 if (plip_debug & PLIP_DEBUG_TX) printf("st3=%02x ", inb(PLIP_STATUS)); #endif /* Don't want ints while transmitting */ outb(PLIP_CONTROL, PLIP_INTR_DISABLE); if (pliptransmit(iobase, minibuf + 1, minibuf[0]) < 0) goto retry; for (cksum = 0, m = m0; m; m = m->m_next) { if (sizeof(struct ether_header) != 14 && m == m0) { i = pliptransmit(iobase, mtod(m, u_char *), 14); if (i < 0) goto retry; cksum += i; i = pliptransmit(iobase, mtod(m, u_char *)+16, m->m_len-16); if (i < 0) goto retry; } else i = pliptransmit(iobase, mtod(m, u_char *), m->m_len); if (i < 0) goto retry; cksum += i; } if (pliptransmit(iobase, &cksum, 1) < 0) goto retry; i = PLIPMXSPIN2; while ((inb(PLIP_STATUS) & LPS_NBSY) == 0) if (i-- < 0) goto retry; outb(iobase + lpt_data, 0x00); /* Re-enable ints */ outb(PLIP_CONTROL, PLIP_INTR_ENABLE); ifp->if_opackets++; ifp->if_obytes += len + 4; sc->sc_ifretry = 0; s = splimp(); m_freem(m0); splx(s); } ifp->if_flags &= ~IFF_OACTIVE; return; retry: #if PLIP_DEBUG > 0 if (plip_debug & PLIP_DEBUG_TX) printf("retry: %02x", inb(iobase + lpt_status)); #endif if (inb(PLIP_STATUS & LPS_NACK)) ifp->if_collisions++; else ifp->if_oerrors++; if ((ifp->if_flags & (IFF_RUNNING | IFF_UP)) == (IFF_RUNNING | IFF_UP) && sc->sc_ifretry < PLIPMXRETRY) { sc->sc_ifretry++; s = splimp(); IF_PREPEND(&ifp->if_snd, m0); splx(s); timeout((void (*)(void *))plipstart, ifp, PLIPRETRY); } else { if (sc->sc_ifretry == PLIPMXRETRY) { sc->sc_ifretry++; log(LOG_NOTICE, "plip%d: tx hard error\n", ifp->if_unit); } s = splimp(); m_freem(m0); splx(s); } ifp->if_flags &= ~IFF_OACTIVE; outb(PLIP_DATA, 0x00); /* Re-enable ints */ outb(PLIP_CONTROL, PLIP_INTR_ENABLE); /*xxx if (sc->sc_iferrs > PLIPMXERRS) i8255->port_a |= LPA_ACTIVE; else i8255->port_a |= LPA_ACKENABLE | LPA_ACTIVE;*/ return; } #endif