NetBSD/sys/arch/arm32/mainbus/lpt.c

/* $NetBSD: lpt.c,v 1.2 1996/02/15 21:33:52 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.2 1996/02/15 21:33:52 mark Exp $
 *	$Id: lpt.c,v 1.2 1996/02/15 21:33:52 mark Exp $
 */

/*
 * Device Driver for AT parallel printer port
 */
/*
 * PLIP driver code added by Mark Brinicombe
 */

#include <sys/param.h>
#include <sys/systm.h>
#include <sys/proc.h>
#include <sys/user.h>
#include <sys/buf.h>
#include <sys/kernel.h>
#include <sys/ioctl.h>
#include <sys/uio.h>
#include <sys/device.h>
#include <sys/syslog.h>

#if defined(INET) && defined(PLIP)
#include <sys/mbuf.h>
#include <sys/socket.h>
#include <net/if.h>
#include <net/if_types.h>
#include <net/netisr.h>
#include <net/route.h>
#include <netinet/in.h>
#include <netinet/in_systm.h>
#include <netinet/in_var.h>
#include <netinet/ip.h>
#include <netinet/if_ether.h>
#include "bpfilter.h"
#if NBPFILTER > 0
#include <sys/time.h>
#include <net/bpf.h>
#endif
#endif

#include <machine/cpu.h>
#include <machine/katelib.h>
#include <machine/irqhandler.h>
#include <machine/io.h>
#include <arm32/mainbus/lptreg.h>
#include <arm32/mainbus/mainbus.h>

#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