df5e198723
before adding/removing packets from the queue. Also, the if_obytes and if_omcasts fields should only be manipulated under protection of the mutex. IF_ENQUEUE, IF_PREPEND, and IF_DEQUEUE perform all necessary locking on the queue. An IF_LOCK macro is provided, as well as the old (mutex-less) versions of the macros in the form _IF_ENQUEUE, _IF_QFULL, for code which needs them, but their use is discouraged. Two new macros are introduced: IF_DRAIN() to drain a queue, and IF_HANDOFF, which takes care of locking/enqueue, and also statistics updating/start if necessary.
1447 lines
35 KiB
C
1447 lines
35 KiB
C
/*
|
|
* 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: unknown origin, 386BSD 0.1
|
|
* $FreeBSD$
|
|
*/
|
|
|
|
/*
|
|
* Device Driver for AT parallel printer port
|
|
* Written by William Jolitz 12/18/90
|
|
*/
|
|
|
|
/*
|
|
* Parallel port TCP/IP interfaces added. I looked at the driver from
|
|
* MACH but this is a complete rewrite, and btw. incompatible, and it
|
|
* should perform better too. I have never run the MACH driver though.
|
|
*
|
|
* This driver sends two bytes (0x08, 0x00) in front of each packet,
|
|
* to allow us to distinguish another format later.
|
|
*
|
|
* Now added an Linux/Crynwr compatibility mode which is enabled using
|
|
* IF_LINK0 - Tim Wilkinson.
|
|
*
|
|
* TODO:
|
|
* Make HDLC/PPP mode, use IF_LLC1 to enable.
|
|
*
|
|
* Connect the two computers using a Laplink parallel cable to use this
|
|
* feature:
|
|
*
|
|
* +----------------------------------------+
|
|
* |A-name A-End B-End Descr. Port/Bit |
|
|
* +----------------------------------------+
|
|
* |DATA0 2 15 Data 0/0x01 |
|
|
* |-ERROR 15 2 1/0x08 |
|
|
* +----------------------------------------+
|
|
* |DATA1 3 13 Data 0/0x02 |
|
|
* |+SLCT 13 3 1/0x10 |
|
|
* +----------------------------------------+
|
|
* |DATA2 4 12 Data 0/0x04 |
|
|
* |+PE 12 4 1/0x20 |
|
|
* +----------------------------------------+
|
|
* |DATA3 5 10 Strobe 0/0x08 |
|
|
* |-ACK 10 5 1/0x40 |
|
|
* +----------------------------------------+
|
|
* |DATA4 6 11 Data 0/0x10 |
|
|
* |BUSY 11 6 1/~0x80 |
|
|
* +----------------------------------------+
|
|
* |GND 18-25 18-25 GND - |
|
|
* +----------------------------------------+
|
|
*
|
|
* Expect transfer-rates up to 75 kbyte/sec.
|
|
*
|
|
* If GCC could correctly grok
|
|
* register int port asm("edx")
|
|
* the code would be cleaner
|
|
*
|
|
* Poul-Henning Kamp <phk@freebsd.org>
|
|
*/
|
|
|
|
#include "olpt.h"
|
|
#include "opt_inet.h"
|
|
#ifdef PC98
|
|
#undef INET /* PLIP is not supported for old PC-98 */
|
|
#define LPT_DRVINIT_AT_ATTACH /* avoid conflicting with lpt on ppbus */
|
|
#endif
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/conf.h>
|
|
#include <sys/bio.h>
|
|
#include <sys/buf.h>
|
|
#include <sys/bus.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/uio.h>
|
|
#include <sys/syslog.h>
|
|
|
|
#include <i386/isa/isa_device.h>
|
|
#include <i386/isa/lptreg.h>
|
|
#include <dev/ppbus/lptio.h>
|
|
|
|
#ifdef INET
|
|
#include <sys/malloc.h>
|
|
#include <sys/mbuf.h>
|
|
#include <sys/socket.h>
|
|
#include <sys/sockio.h>
|
|
|
|
#include <net/if.h>
|
|
#include <net/if_types.h>
|
|
#include <net/netisr.h>
|
|
#include <netinet/in.h>
|
|
#include <netinet/in_var.h>
|
|
#include <net/bpf.h>
|
|
#endif /* INET */
|
|
|
|
#ifndef COMPAT_OLDISA
|
|
#error "The olpt device requires the old isa compatibility shims"
|
|
#endif
|
|
|
|
#define LPINITRDY 4 /* wait up to 4 seconds for a ready */
|
|
#define LPTOUTINITIAL 10 /* initial timeout to wait for ready 1/10 s */
|
|
#define LPTOUTMAX 1 /* maximal timeout 1 s */
|
|
#define LPPRI (PZERO+8)
|
|
#define BUFSIZE 1024
|
|
|
|
#ifdef INET
|
|
#ifndef LPMTU /* MTU for the lp# interfaces */
|
|
#define LPMTU 1500
|
|
#endif
|
|
|
|
#ifndef LPMAXSPIN1 /* DELAY factor for the lp# interfaces */
|
|
#define LPMAXSPIN1 8000 /* Spinning for remote intr to happen */
|
|
#endif
|
|
|
|
#ifndef LPMAXSPIN2 /* DELAY factor for the lp# interfaces */
|
|
#define LPMAXSPIN2 500 /* Spinning for remote handshake to happen */
|
|
#endif
|
|
|
|
#ifndef LPMAXERRS /* Max errors before !RUNNING */
|
|
#define LPMAXERRS 100
|
|
#endif
|
|
|
|
#define CLPIPHDRLEN 14 /* We send dummy ethernet addresses (two) + packet type in front of packet */
|
|
#define CLPIP_SHAKE 0x80 /* This bit toggles between nibble reception */
|
|
#define MLPIPHDRLEN CLPIPHDRLEN
|
|
|
|
#define LPIPHDRLEN 2 /* We send 0x08, 0x00 in front of packet */
|
|
#define LPIP_SHAKE 0x40 /* This bit toggles between nibble reception */
|
|
#if !defined(MLPIPHDRLEN) || LPIPHDRLEN > MLPIPHDRLEN
|
|
#define MLPIPHDRLEN LPIPHDRLEN
|
|
#endif
|
|
|
|
#define LPIPTBLSIZE 256 /* Size of octet translation table */
|
|
|
|
#endif /* INET */
|
|
|
|
#ifndef PC98
|
|
/* BIOS printer list - used by BIOS probe*/
|
|
#define BIOS_LPT_PORTS 0x408
|
|
#define BIOS_PORTS (short *)(KERNBASE+BIOS_LPT_PORTS)
|
|
#define BIOS_MAX_LPT 4
|
|
#endif
|
|
|
|
|
|
#ifndef DEBUG
|
|
#define lprintf(args)
|
|
#else
|
|
#define lprintf(args) do { \
|
|
if (lptflag) \
|
|
printf args; \
|
|
} while (0)
|
|
static int volatile lptflag = 1;
|
|
#endif
|
|
|
|
#define LPTUNIT(s) ((s)&0x03)
|
|
#define LPTFLAGS(s) ((s)&0xfc)
|
|
|
|
static struct lpt_softc {
|
|
int sc_port;
|
|
short sc_state;
|
|
/* default case: negative prime, negative ack, handshake strobe,
|
|
prime once */
|
|
u_char sc_control;
|
|
char sc_flags;
|
|
#define LP_POS_INIT 0x04 /* if we are a postive init signal */
|
|
#define LP_POS_ACK 0x08 /* if we are a positive going ack */
|
|
#define LP_NO_PRIME 0x10 /* don't prime the printer at all */
|
|
#define LP_PRIMEOPEN 0x20 /* prime on every open */
|
|
#define LP_AUTOLF 0x40 /* tell printer to do an automatic lf */
|
|
#define LP_BYPASS 0x80 /* bypass printer ready checks */
|
|
struct buf *sc_inbuf;
|
|
short sc_xfercnt ;
|
|
char sc_primed;
|
|
char *sc_cp ;
|
|
u_char sc_irq ; /* IRQ status of port */
|
|
#define LP_HAS_IRQ 0x01 /* we have an irq available */
|
|
#define LP_USE_IRQ 0x02 /* we are using our irq */
|
|
#define LP_ENABLE_IRQ 0x04 /* enable IRQ on open */
|
|
u_char sc_backoff ; /* time to call lptout() again */
|
|
|
|
#ifdef INET
|
|
struct ifnet sc_if;
|
|
u_char *sc_ifbuf;
|
|
int sc_iferrs;
|
|
#endif
|
|
} lpt_sc[NOLPT] ;
|
|
|
|
/* bits for state */
|
|
#define OPEN (1<<0) /* device is open */
|
|
#define ASLP (1<<1) /* awaiting draining of printer */
|
|
#define ERROR (1<<2) /* error was received from printer */
|
|
#define OBUSY (1<<3) /* printer is busy doing output */
|
|
#define LPTOUT (1<<4) /* timeout while not selected */
|
|
#define TOUT (1<<5) /* timeout while not selected */
|
|
#define INIT (1<<6) /* waiting to initialize for open */
|
|
#define INTERRUPTED (1<<7) /* write call was interrupted */
|
|
|
|
|
|
/* status masks to interrogate printer status */
|
|
#define RDY_MASK (LPS_SEL|LPS_OUT|LPS_NBSY|LPS_NERR) /* ready ? */
|
|
#define LP_READY (LPS_SEL|LPS_NBSY|LPS_NERR)
|
|
|
|
/* Printer Ready condition - from lpa.c */
|
|
/* Only used in polling code */
|
|
#ifdef PC98
|
|
#define NOT_READY(x) ((inb(x) & LPS_NBSY) != LPS_NBSY)
|
|
#else /* IBM-PC */
|
|
#define LPS_INVERT (LPS_NBSY | LPS_NACK | LPS_SEL | LPS_NERR)
|
|
#define LPS_MASK (LPS_NBSY | LPS_NACK | LPS_OUT | LPS_SEL | LPS_NERR)
|
|
#define NOT_READY(x) ((inb(x)^LPS_INVERT)&LPS_MASK)
|
|
#endif
|
|
|
|
#define MAX_SLEEP (hz*5) /* Timeout while waiting for device ready */
|
|
#define MAX_SPIN 20 /* Max delay for device ready in usecs */
|
|
|
|
static timeout_t lptout;
|
|
static int lptprobe (struct isa_device *dvp);
|
|
static int lptattach (struct isa_device *isdp);
|
|
static ointhand2_t lptintr;
|
|
static void lpt_drvinit(void *unused);
|
|
|
|
#ifdef INET
|
|
|
|
/* Tables for the lp# interface */
|
|
static u_char *txmith;
|
|
#define txmitl (txmith+(1*LPIPTBLSIZE))
|
|
#define trecvh (txmith+(2*LPIPTBLSIZE))
|
|
#define trecvl (txmith+(3*LPIPTBLSIZE))
|
|
|
|
static u_char *ctxmith;
|
|
#define ctxmitl (ctxmith+(1*LPIPTBLSIZE))
|
|
#define ctrecvh (ctxmith+(2*LPIPTBLSIZE))
|
|
#define ctrecvl (ctxmith+(3*LPIPTBLSIZE))
|
|
|
|
/* Functions for the lp# interface */
|
|
static void lpattach(struct lpt_softc *,int);
|
|
#ifndef PC98
|
|
static int lpinittables(void);
|
|
#endif
|
|
static int lpioctl(struct ifnet *, u_long, caddr_t);
|
|
static int lpoutput(struct ifnet *, struct mbuf *, struct sockaddr *,
|
|
struct rtentry *);
|
|
static void lpintr(int);
|
|
#endif /* INET */
|
|
|
|
struct isa_driver olptdriver = {
|
|
INTR_TYPE_TTY,
|
|
lptprobe,
|
|
lptattach,
|
|
"olpt"
|
|
};
|
|
COMPAT_ISA_DRIVER(olpt, olptdriver);
|
|
|
|
static d_open_t lptopen;
|
|
static d_close_t lptclose;
|
|
static d_write_t lptwrite;
|
|
static d_ioctl_t lptioctl;
|
|
|
|
#define CDEV_MAJOR 16
|
|
static struct cdevsw lpt_cdevsw = {
|
|
/* open */ lptopen,
|
|
/* close */ lptclose,
|
|
/* read */ noread,
|
|
/* write */ lptwrite,
|
|
/* ioctl */ lptioctl,
|
|
/* poll */ nopoll,
|
|
/* mmap */ nommap,
|
|
/* strategy */ nostrategy,
|
|
/* name */ "lpt",
|
|
/* maj */ CDEV_MAJOR,
|
|
/* dump */ nodump,
|
|
/* psize */ nopsize,
|
|
/* flags */ 0,
|
|
/* bmaj */ -1
|
|
};
|
|
|
|
#ifndef PC98
|
|
/*
|
|
* Internal routine to lptprobe to do port tests of one byte value
|
|
*/
|
|
static int
|
|
lpt_port_test (int port, u_char data, u_char mask)
|
|
{
|
|
int temp, timeout;
|
|
|
|
data = data & mask;
|
|
outb(port, data);
|
|
timeout = 10000;
|
|
do {
|
|
DELAY(10);
|
|
temp = inb(port) & mask;
|
|
}
|
|
while (temp != data && --timeout);
|
|
lprintf(("Port 0x%x\tout=%x\tin=%x\ttout=%d\n",
|
|
port, data, temp, timeout));
|
|
return (temp == data);
|
|
}
|
|
#endif /* PC98 */
|
|
|
|
/*
|
|
* New lpt port probe Geoff Rehmet - Rhodes University - 14/2/94
|
|
* Based partially on Rod Grimes' printer probe
|
|
*
|
|
* Logic:
|
|
* 1) If no port address was given, use the bios detected ports
|
|
* and autodetect what ports the printers are on.
|
|
* 2) Otherwise, probe the data port at the address given,
|
|
* using the method in Rod Grimes' port probe.
|
|
* (Much code ripped off directly from Rod's probe.)
|
|
*
|
|
* Comments from Rod's probe:
|
|
* 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.
|
|
*
|
|
* We are finally left with a mask of 0x14, due to some printers
|
|
* being adamant about holding other bits high ........
|
|
*
|
|
* Before probing the control port, we write a 0 to the data port -
|
|
* If not, some printers chuck out garbage when the strobe line
|
|
* gets toggled.
|
|
*
|
|
* 3) Set the data and control ports to a value of 0
|
|
*
|
|
* This probe routine has been tested on Epson Lx-800, HP LJ3P,
|
|
* Epson FX-1170 and C.Itoh 8510RM
|
|
* printers.
|
|
* Quick exit on fail added.
|
|
*/
|
|
|
|
int
|
|
lptprobe(struct isa_device *dvp)
|
|
{
|
|
#ifdef PC98
|
|
#define PC98_OLD_LPT 0x40
|
|
#define PC98_IEEE_1284_FUNCTION 0x149
|
|
unsigned int pc98_ieee_mode, tmp;
|
|
|
|
if (dvp->id_iobase == PC98_OLD_LPT) {
|
|
tmp = inb(PC98_IEEE_1284_FUNCTION);
|
|
pc98_ieee_mode = tmp;
|
|
if ((tmp & 0x10) == 0x10) {
|
|
outb(PC98_IEEE_1284_FUNCTION, tmp & ~0x10);
|
|
tmp = inb(PC98_IEEE_1284_FUNCTION);
|
|
if ((tmp & 0x10) != 0x10) {
|
|
outb(PC98_IEEE_1284_FUNCTION, pc98_ieee_mode);
|
|
return 0;
|
|
}
|
|
}
|
|
}
|
|
return 8;
|
|
#else
|
|
int port;
|
|
static short next_bios_lpt = 0;
|
|
int status;
|
|
static u_char testbyte[18] = {
|
|
0x55, /* alternating zeros */
|
|
0xaa, /* alternating ones */
|
|
0xfe, 0xfd, 0xfb, 0xf7,
|
|
0xef, 0xdf, 0xbf, 0x7f, /* walking zero */
|
|
0x01, 0x02, 0x04, 0x08,
|
|
0x10, 0x20, 0x40, 0x80 /* walking one */
|
|
};
|
|
int i;
|
|
|
|
/*
|
|
* Make sure there is some way for lptopen to see that
|
|
* the port is not configured
|
|
* This 0 will remain if the port isn't attached
|
|
*/
|
|
(lpt_sc + dvp->id_unit)->sc_port = 0;
|
|
|
|
status = IO_LPTSIZE;
|
|
/* If port not specified, use bios list */
|
|
if(dvp->id_iobase < 0) { /* port? */
|
|
if((next_bios_lpt < BIOS_MAX_LPT) &&
|
|
(*(BIOS_PORTS+next_bios_lpt) != 0) ) {
|
|
dvp->id_iobase = *(BIOS_PORTS+next_bios_lpt++);
|
|
goto end_probe;
|
|
} else
|
|
return (0);
|
|
}
|
|
|
|
/* Port was explicitly specified */
|
|
/* This allows probing of ports unknown to the BIOS */
|
|
port = dvp->id_iobase + lpt_data;
|
|
for (i = 0; i < 18; i++) {
|
|
if (!lpt_port_test(port, testbyte[i], 0xff)) {
|
|
status = 0;
|
|
goto end_probe;
|
|
}
|
|
}
|
|
|
|
end_probe:
|
|
/* write 0's to control and data ports */
|
|
outb(dvp->id_iobase+lpt_data, 0);
|
|
outb(dvp->id_iobase+lpt_control, 0);
|
|
|
|
return (status);
|
|
#endif
|
|
}
|
|
|
|
/* XXX Todo - try and detect if interrupt is working */
|
|
int
|
|
lptattach(struct isa_device *isdp)
|
|
{
|
|
struct lpt_softc *sc;
|
|
int unit;
|
|
|
|
isdp->id_ointr = lptintr;
|
|
unit = isdp->id_unit;
|
|
sc = lpt_sc + unit;
|
|
sc->sc_port = isdp->id_iobase;
|
|
sc->sc_primed = 0; /* not primed yet */
|
|
#ifdef PC98
|
|
outb(sc->sc_port+lpt_pstb_ctrl, LPC_DIS_PSTB); /* PSTB disable */
|
|
outb(sc->sc_port+lpt_control, LPC_MODE8255); /* 8255 mode set */
|
|
outb(sc->sc_port+lpt_control, LPC_NIRQ8); /* IRQ8 inactive */
|
|
outb(sc->sc_port+lpt_control, LPC_NPSTB); /* PSTB inactive */
|
|
outb(sc->sc_port+lpt_pstb_ctrl, LPC_EN_PSTB); /* PSTB enable */
|
|
#else
|
|
outb(sc->sc_port+lpt_control, LPC_NINIT);
|
|
#endif
|
|
|
|
/* check if we can use interrupt */
|
|
lprintf(("oldirq %x\n", sc->sc_irq));
|
|
if (isdp->id_irq) {
|
|
sc->sc_irq = LP_HAS_IRQ | LP_USE_IRQ | LP_ENABLE_IRQ;
|
|
printf("lpt%d: Interrupt-driven port\n", unit);
|
|
#ifdef INET
|
|
lpattach(sc, unit);
|
|
#endif
|
|
} else {
|
|
sc->sc_irq = 0;
|
|
lprintf(("lpt%d: Polled port\n", unit));
|
|
}
|
|
lprintf(("irq %x\n", sc->sc_irq));
|
|
|
|
/* XXX what to do about the flags in the minor number? */
|
|
make_dev(&lpt_cdevsw, unit, UID_ROOT, GID_WHEEL, 0600, "lpt%d", unit);
|
|
make_dev(&lpt_cdevsw, unit | LP_BYPASS,
|
|
UID_ROOT, GID_WHEEL, 0600, "lpctl%d", unit);
|
|
|
|
#ifdef LPT_DRVINIT_AT_ATTACH
|
|
lpt_drvinit(NULL);
|
|
#endif
|
|
return (1);
|
|
}
|
|
|
|
/*
|
|
* lptopen -- reset the printer, then wait until it's selected and not busy.
|
|
* If LP_BYPASS flag is selected, then we do not try to select the
|
|
* printer -- this is just used for passing ioctls.
|
|
*/
|
|
|
|
static int
|
|
lptopen (dev_t dev, int flags, int fmt, struct proc *p)
|
|
{
|
|
struct lpt_softc *sc;
|
|
int s;
|
|
#ifdef PC98
|
|
int port;
|
|
#else
|
|
int trys, port;
|
|
#endif
|
|
u_int unit = LPTUNIT(minor(dev));
|
|
|
|
sc = lpt_sc + unit;
|
|
if ((unit >= NOLPT) || (sc->sc_port == 0))
|
|
return (ENXIO);
|
|
|
|
#ifdef INET
|
|
if (sc->sc_if.if_flags & IFF_UP)
|
|
return(EBUSY);
|
|
#endif
|
|
|
|
if (sc->sc_state) {
|
|
lprintf(("lp: still open %x\n", sc->sc_state));
|
|
return(EBUSY);
|
|
} else
|
|
sc->sc_state |= INIT;
|
|
|
|
sc->sc_flags = LPTFLAGS(minor(dev));
|
|
|
|
/* Check for open with BYPASS flag set. */
|
|
if (sc->sc_flags & LP_BYPASS) {
|
|
sc->sc_state = OPEN;
|
|
return(0);
|
|
}
|
|
|
|
s = spltty();
|
|
lprintf(("lp flags 0x%x\n", sc->sc_flags));
|
|
port = sc->sc_port;
|
|
|
|
/* set IRQ status according to ENABLE_IRQ flag */
|
|
if (sc->sc_irq & LP_ENABLE_IRQ)
|
|
sc->sc_irq |= LP_USE_IRQ;
|
|
else
|
|
sc->sc_irq &= ~LP_USE_IRQ;
|
|
|
|
/* init printer */
|
|
#ifndef PC98
|
|
if ((sc->sc_flags & LP_NO_PRIME) == 0) {
|
|
if((sc->sc_flags & LP_PRIMEOPEN) || sc->sc_primed == 0) {
|
|
outb(port+lpt_control, 0);
|
|
sc->sc_primed++;
|
|
DELAY(500);
|
|
}
|
|
}
|
|
|
|
outb (port+lpt_control, LPC_SEL|LPC_NINIT);
|
|
|
|
/* wait till ready (printer running diagnostics) */
|
|
trys = 0;
|
|
do {
|
|
/* ran out of waiting for the printer */
|
|
if (trys++ >= LPINITRDY*4) {
|
|
splx(s);
|
|
sc->sc_state = 0;
|
|
lprintf(("status %x\n", inb(port+lpt_status)));
|
|
return (EBUSY);
|
|
}
|
|
|
|
/* wait 1/4 second, give up if we get a signal */
|
|
if (tsleep ((caddr_t)sc, LPPRI|PCATCH, "lptinit", hz/4) !=
|
|
EWOULDBLOCK) {
|
|
sc->sc_state = 0;
|
|
splx(s);
|
|
return (EBUSY);
|
|
}
|
|
|
|
/* is printer online and ready for output */
|
|
} while ((inb(port+lpt_status) & (LPS_SEL|LPS_OUT|LPS_NBSY|LPS_NERR)) !=
|
|
(LPS_SEL|LPS_NBSY|LPS_NERR));
|
|
|
|
sc->sc_control = LPC_SEL|LPC_NINIT;
|
|
if (sc->sc_flags & LP_AUTOLF)
|
|
sc->sc_control |= LPC_AUTOL;
|
|
|
|
/* enable interrupt if interrupt-driven */
|
|
if (sc->sc_irq & LP_USE_IRQ)
|
|
sc->sc_control |= LPC_ENA;
|
|
|
|
outb(port+lpt_control, sc->sc_control);
|
|
#endif
|
|
|
|
sc->sc_state = OPEN;
|
|
sc->sc_inbuf = geteblk(BUFSIZE);
|
|
sc->sc_xfercnt = 0;
|
|
splx(s);
|
|
|
|
/* only use timeout if using interrupt */
|
|
lprintf(("irq %x\n", sc->sc_irq));
|
|
if (sc->sc_irq & LP_USE_IRQ) {
|
|
sc->sc_state |= TOUT;
|
|
timeout (lptout, (caddr_t)sc,
|
|
(sc->sc_backoff = hz/LPTOUTINITIAL));
|
|
}
|
|
|
|
lprintf(("opened.\n"));
|
|
return(0);
|
|
}
|
|
|
|
static void
|
|
lptout (void *arg)
|
|
{
|
|
struct lpt_softc *sc = arg;
|
|
int pl;
|
|
|
|
lprintf(("T %x ", inb(sc->sc_port+lpt_status)));
|
|
if (sc->sc_state & OPEN) {
|
|
sc->sc_backoff++;
|
|
if (sc->sc_backoff > hz/LPTOUTMAX)
|
|
sc->sc_backoff = sc->sc_backoff > hz/LPTOUTMAX;
|
|
timeout (lptout, (caddr_t)sc, sc->sc_backoff);
|
|
} else
|
|
sc->sc_state &= ~TOUT;
|
|
|
|
if (sc->sc_state & ERROR)
|
|
sc->sc_state &= ~ERROR;
|
|
|
|
/*
|
|
* Avoid possible hangs do to missed interrupts
|
|
*/
|
|
if (sc->sc_xfercnt) {
|
|
pl = spltty();
|
|
lptintr(sc - lpt_sc);
|
|
splx(pl);
|
|
} else {
|
|
sc->sc_state &= ~OBUSY;
|
|
wakeup((caddr_t)sc);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* lptclose -- close the device, free the local line buffer.
|
|
*
|
|
* Check for interrupted write call added.
|
|
*/
|
|
|
|
static int
|
|
lptclose(dev_t dev, int flags, int fmt, struct proc *p)
|
|
{
|
|
struct lpt_softc *sc = lpt_sc + LPTUNIT(minor(dev));
|
|
#ifndef PC98
|
|
int port = sc->sc_port;
|
|
#endif
|
|
|
|
if(sc->sc_flags & LP_BYPASS)
|
|
goto end_close;
|
|
|
|
sc->sc_state &= ~OPEN;
|
|
|
|
#ifndef PC98
|
|
/* if the last write was interrupted, don't complete it */
|
|
if((!(sc->sc_state & INTERRUPTED)) && (sc->sc_irq & LP_USE_IRQ))
|
|
while ((inb(port+lpt_status) & (LPS_SEL|LPS_OUT|LPS_NBSY|LPS_NERR)) !=
|
|
(LPS_SEL|LPS_NBSY|LPS_NERR) || sc->sc_xfercnt)
|
|
/* wait 1/4 second, give up if we get a signal */
|
|
if (tsleep ((caddr_t)sc, LPPRI|PCATCH,
|
|
"lpclose", hz) != EWOULDBLOCK)
|
|
break;
|
|
|
|
outb(sc->sc_port+lpt_control, LPC_NINIT);
|
|
#endif
|
|
brelse(sc->sc_inbuf);
|
|
|
|
end_close:
|
|
sc->sc_state = 0;
|
|
sc->sc_xfercnt = 0;
|
|
lprintf(("closed.\n"));
|
|
return(0);
|
|
}
|
|
|
|
/*
|
|
* pushbytes()
|
|
* Workhorse for actually spinning and writing bytes to printer
|
|
* Derived from lpa.c
|
|
* Originally by ?
|
|
*
|
|
* This code is only used when we are polling the port
|
|
*/
|
|
static int
|
|
pushbytes(struct lpt_softc * sc)
|
|
{
|
|
int spin, err, tic;
|
|
char ch;
|
|
int port = sc->sc_port;
|
|
|
|
lprintf(("p"));
|
|
/* loop for every character .. */
|
|
while (sc->sc_xfercnt > 0) {
|
|
/* printer data */
|
|
ch = *(sc->sc_cp);
|
|
sc->sc_cp++;
|
|
sc->sc_xfercnt--;
|
|
|
|
/*
|
|
* Wait for printer ready.
|
|
* Loop 20 usecs testing BUSY bit, then sleep
|
|
* for exponentially increasing timeout. (vak)
|
|
*/
|
|
for (spin=0; NOT_READY(port+lpt_status) && spin<MAX_SPIN; ++spin)
|
|
DELAY(1); /* XXX delay is NOT this accurate! */
|
|
if (spin >= MAX_SPIN) {
|
|
tic = 0;
|
|
while (NOT_READY(port+lpt_status)) {
|
|
/*
|
|
* Now sleep, every cycle a
|
|
* little longer ..
|
|
*/
|
|
tic = tic + tic + 1;
|
|
/*
|
|
* But no more than 10 seconds. (vak)
|
|
*/
|
|
if (tic > MAX_SLEEP)
|
|
tic = MAX_SLEEP;
|
|
err = tsleep((caddr_t)sc, LPPRI,
|
|
"lptpoll", tic);
|
|
if (err != EWOULDBLOCK) {
|
|
return (err);
|
|
}
|
|
}
|
|
}
|
|
|
|
/* output data */
|
|
outb(port+lpt_data, ch);
|
|
#ifdef PC98
|
|
DELAY(1);
|
|
outb(port+lpt_control, LPC_PSTB);
|
|
DELAY(1);
|
|
outb(port+lpt_control, LPC_NPSTB);
|
|
#else
|
|
/* strobe */
|
|
outb(port+lpt_control, sc->sc_control|LPC_STB);
|
|
outb(port+lpt_control, sc->sc_control);
|
|
#endif
|
|
|
|
}
|
|
return(0);
|
|
}
|
|
|
|
/*
|
|
* lptwrite --copy a line from user space to a local buffer, then call
|
|
* putc to get the chars moved to the output queue.
|
|
*
|
|
* Flagging of interrupted write added.
|
|
*/
|
|
|
|
static int
|
|
lptwrite(dev_t dev, struct uio * uio, int ioflag)
|
|
{
|
|
register unsigned n;
|
|
int pl, err;
|
|
struct lpt_softc *sc = lpt_sc + LPTUNIT(minor(dev));
|
|
|
|
if(sc->sc_flags & LP_BYPASS) {
|
|
/* we can't do writes in bypass mode */
|
|
return(EPERM);
|
|
}
|
|
|
|
sc->sc_state &= ~INTERRUPTED;
|
|
while ((n = min(BUFSIZE, uio->uio_resid)) != 0) {
|
|
sc->sc_cp = sc->sc_inbuf->b_data ;
|
|
uiomove(sc->sc_cp, n, uio);
|
|
sc->sc_xfercnt = n ;
|
|
while ((sc->sc_xfercnt > 0)&&(sc->sc_irq & LP_USE_IRQ)) {
|
|
lprintf(("i"));
|
|
/* if the printer is ready for a char, */
|
|
/* give it one */
|
|
if ((sc->sc_state & OBUSY) == 0){
|
|
lprintf(("\nC %d. ", sc->sc_xfercnt));
|
|
pl = spltty();
|
|
lptintr(sc - lpt_sc);
|
|
(void) splx(pl);
|
|
}
|
|
lprintf(("W "));
|
|
if (sc->sc_state & OBUSY)
|
|
if ((err = tsleep ((caddr_t)sc,
|
|
LPPRI|PCATCH, "lpwrite", 0))) {
|
|
sc->sc_state |= INTERRUPTED;
|
|
return(err);
|
|
}
|
|
}
|
|
/* check to see if we must do a polled write */
|
|
if(!(sc->sc_irq & LP_USE_IRQ) && (sc->sc_xfercnt)) {
|
|
lprintf(("p"));
|
|
if((err = pushbytes(sc)))
|
|
return(err);
|
|
}
|
|
}
|
|
return(0);
|
|
}
|
|
|
|
/*
|
|
* lptintr -- handle printer interrupts which occur when the printer is
|
|
* ready to accept another char.
|
|
*
|
|
* do checking for interrupted write call.
|
|
*/
|
|
|
|
static void
|
|
lptintr(int unit)
|
|
{
|
|
#if defined(INET) || !defined(PC98)
|
|
struct lpt_softc *sc = lpt_sc + unit;
|
|
#endif
|
|
#ifndef PC98
|
|
int port = sc->sc_port, sts;
|
|
int i;
|
|
#endif
|
|
|
|
#ifdef INET
|
|
if(sc->sc_if.if_flags & IFF_UP) {
|
|
lpintr(unit);
|
|
return;
|
|
}
|
|
#endif /* INET */
|
|
|
|
#ifndef PC98
|
|
/*
|
|
* Is printer online and ready for output?
|
|
*
|
|
* Avoid falling back to lptout() too quickly. First spin-loop
|
|
* to see if the printer will become ready ``really soon now''.
|
|
*/
|
|
for (i = 0;
|
|
i < 100 &&
|
|
((sts=inb(port+lpt_status)) & RDY_MASK) != LP_READY;
|
|
i++) ;
|
|
if ((sts & RDY_MASK) == LP_READY) {
|
|
sc->sc_state = (sc->sc_state | OBUSY) & ~ERROR;
|
|
sc->sc_backoff = hz/LPTOUTINITIAL;
|
|
|
|
if (sc->sc_xfercnt) {
|
|
/* send char */
|
|
/*lprintf(("%x ", *sc->sc_cp)); */
|
|
outb(port+lpt_data, *sc->sc_cp++) ;
|
|
outb(port+lpt_control, sc->sc_control|LPC_STB);
|
|
/* DELAY(X) */
|
|
outb(port+lpt_control, sc->sc_control);
|
|
|
|
/* any more data for printer */
|
|
if(--(sc->sc_xfercnt) > 0) return;
|
|
}
|
|
|
|
/*
|
|
* No more data waiting for printer.
|
|
* Wakeup is not done if write call was interrupted.
|
|
*/
|
|
sc->sc_state &= ~OBUSY;
|
|
if(!(sc->sc_state & INTERRUPTED))
|
|
wakeup((caddr_t)sc);
|
|
lprintf(("w "));
|
|
return;
|
|
} else { /* check for error */
|
|
if(((sts & (LPS_NERR | LPS_OUT) ) != LPS_NERR) &&
|
|
(sc->sc_state & OPEN))
|
|
sc->sc_state |= ERROR;
|
|
/* lptout() will jump in and try to restart. */
|
|
}
|
|
#endif
|
|
lprintf(("sts %x ", sts));
|
|
}
|
|
|
|
static int
|
|
lptioctl(dev_t dev, u_long cmd, caddr_t data, int flags, struct proc *p)
|
|
{
|
|
int error = 0;
|
|
struct lpt_softc *sc;
|
|
u_int unit = LPTUNIT(minor(dev));
|
|
u_char old_sc_irq; /* old printer IRQ status */
|
|
|
|
sc = lpt_sc + unit;
|
|
|
|
switch (cmd) {
|
|
case LPT_IRQ :
|
|
if(sc->sc_irq & LP_HAS_IRQ) {
|
|
/*
|
|
* NOTE:
|
|
* If the IRQ status is changed,
|
|
* this will only be visible on the
|
|
* next open.
|
|
*
|
|
* If interrupt status changes,
|
|
* this gets syslog'd.
|
|
*/
|
|
old_sc_irq = sc->sc_irq;
|
|
if(*(int*)data == 0)
|
|
sc->sc_irq &= (~LP_ENABLE_IRQ);
|
|
else
|
|
sc->sc_irq |= LP_ENABLE_IRQ;
|
|
if (old_sc_irq != sc->sc_irq )
|
|
log(LOG_NOTICE, "lpt%c switched to %s mode\n",
|
|
(char)unit+'0',
|
|
(sc->sc_irq & LP_ENABLE_IRQ)?
|
|
"interrupt-driven":"polled");
|
|
} else /* polled port */
|
|
error = EOPNOTSUPP;
|
|
break;
|
|
default:
|
|
error = ENODEV;
|
|
}
|
|
|
|
return(error);
|
|
}
|
|
|
|
#ifdef INET
|
|
|
|
static void
|
|
lpattach (struct lpt_softc *sc, int unit)
|
|
{
|
|
struct ifnet *ifp = &sc->sc_if;
|
|
|
|
ifp->if_softc = sc;
|
|
ifp->if_name = "lp";
|
|
ifp->if_unit = unit;
|
|
ifp->if_mtu = LPMTU;
|
|
ifp->if_flags = IFF_SIMPLEX | IFF_POINTOPOINT | IFF_MULTICAST;
|
|
ifp->if_ioctl = lpioctl;
|
|
ifp->if_output = lpoutput;
|
|
ifp->if_type = IFT_PARA;
|
|
ifp->if_hdrlen = 0;
|
|
ifp->if_addrlen = 0;
|
|
ifp->if_snd.ifq_maxlen = IFQ_MAXLEN;
|
|
if_attach(ifp);
|
|
printf("lp%d: TCP/IP capable interface\n", unit);
|
|
|
|
bpfattach(ifp, DLT_NULL, LPIPHDRLEN);
|
|
}
|
|
|
|
#ifndef PC98
|
|
/*
|
|
* Build the translation tables for the LPIP (BSD unix) protocol.
|
|
* We don't want to calculate these nasties in our tight loop, so we
|
|
* precalculate them when we initialize.
|
|
*/
|
|
static int
|
|
lpinittables (void)
|
|
{
|
|
int i;
|
|
|
|
if (!txmith)
|
|
txmith = malloc(4*LPIPTBLSIZE, M_DEVBUF, M_NOWAIT);
|
|
|
|
if (!txmith)
|
|
return 1;
|
|
|
|
if (!ctxmith)
|
|
ctxmith = malloc(4*LPIPTBLSIZE, M_DEVBUF, M_NOWAIT);
|
|
|
|
if (!ctxmith)
|
|
return 1;
|
|
|
|
for (i=0; i < LPIPTBLSIZE; i++) {
|
|
ctxmith[i] = (i & 0xF0) >> 4;
|
|
ctxmitl[i] = 0x10 | (i & 0x0F);
|
|
ctrecvh[i] = (i & 0x78) << 1;
|
|
ctrecvl[i] = (i & 0x78) >> 3;
|
|
}
|
|
|
|
for (i=0; i < LPIPTBLSIZE; i++) {
|
|
txmith[i] = ((i & 0x80) >> 3) | ((i & 0x70) >> 4) | 0x08;
|
|
txmitl[i] = ((i & 0x08) << 1) | (i & 0x07);
|
|
trecvh[i] = ((~i) & 0x80) | ((i & 0x38) << 1);
|
|
trecvl[i] = (((~i) & 0x80) >> 4) | ((i & 0x38) >> 3);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
#endif /* PC98 */
|
|
|
|
/*
|
|
* Process an ioctl request.
|
|
*/
|
|
|
|
static int
|
|
lpioctl (struct ifnet *ifp, u_long cmd, caddr_t data)
|
|
{
|
|
struct lpt_softc *sc = lpt_sc + ifp->if_unit;
|
|
struct ifaddr *ifa = (struct ifaddr *)data;
|
|
struct ifreq *ifr = (struct ifreq *)data;
|
|
u_char *ptr;
|
|
|
|
switch (cmd) {
|
|
|
|
case SIOCSIFDSTADDR:
|
|
case SIOCAIFADDR:
|
|
case SIOCSIFADDR:
|
|
if (ifa->ifa_addr->sa_family != AF_INET)
|
|
return EAFNOSUPPORT;
|
|
ifp->if_flags |= IFF_UP;
|
|
/* FALLTHROUGH */
|
|
case SIOCSIFFLAGS:
|
|
if ((!(ifp->if_flags & IFF_UP)) && (ifp->if_flags & IFF_RUNNING)) {
|
|
outb(sc->sc_port + lpt_control, 0x00);
|
|
ifp->if_flags &= ~IFF_RUNNING;
|
|
break;
|
|
}
|
|
#ifdef PC98
|
|
/* XXX */
|
|
return ENOBUFS;
|
|
#else
|
|
if (((ifp->if_flags & IFF_UP)) && (!(ifp->if_flags & IFF_RUNNING))) {
|
|
if (lpinittables())
|
|
return ENOBUFS;
|
|
sc->sc_ifbuf = malloc(sc->sc_if.if_mtu + MLPIPHDRLEN,
|
|
M_DEVBUF, M_WAITOK);
|
|
if (!sc->sc_ifbuf)
|
|
return ENOBUFS;
|
|
|
|
outb(sc->sc_port + lpt_control, LPC_ENA);
|
|
ifp->if_flags |= IFF_RUNNING;
|
|
}
|
|
break;
|
|
#endif
|
|
case SIOCSIFMTU:
|
|
ptr = sc->sc_ifbuf;
|
|
sc->sc_ifbuf = malloc(ifr->ifr_mtu+MLPIPHDRLEN, M_DEVBUF, M_NOWAIT);
|
|
if (!sc->sc_ifbuf) {
|
|
sc->sc_ifbuf = ptr;
|
|
return ENOBUFS;
|
|
}
|
|
if (ptr)
|
|
free(ptr,M_DEVBUF);
|
|
sc->sc_if.if_mtu = ifr->ifr_mtu;
|
|
break;
|
|
|
|
case SIOCGIFMTU:
|
|
ifr->ifr_mtu = sc->sc_if.if_mtu;
|
|
break;
|
|
|
|
case SIOCADDMULTI:
|
|
case SIOCDELMULTI:
|
|
if (ifr == 0) {
|
|
return EAFNOSUPPORT; /* XXX */
|
|
}
|
|
switch (ifr->ifr_addr.sa_family) {
|
|
|
|
#ifdef INET
|
|
case AF_INET:
|
|
break;
|
|
#endif
|
|
|
|
default:
|
|
return EAFNOSUPPORT;
|
|
}
|
|
break;
|
|
|
|
default:
|
|
lprintf(("LP:ioctl(0x%lx)\n", cmd));
|
|
return EINVAL;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static __inline int
|
|
clpoutbyte (u_char byte, int spin, int data_port, int status_port)
|
|
{
|
|
outb(data_port, ctxmitl[byte]);
|
|
while (inb(status_port) & CLPIP_SHAKE)
|
|
if (--spin == 0) {
|
|
return 1;
|
|
}
|
|
outb(data_port, ctxmith[byte]);
|
|
while (!(inb(status_port) & CLPIP_SHAKE))
|
|
if (--spin == 0) {
|
|
return 1;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static __inline int
|
|
clpinbyte (int spin, int data_port, int status_port)
|
|
{
|
|
int c, cl;
|
|
|
|
while((inb(status_port) & CLPIP_SHAKE))
|
|
if(!--spin) {
|
|
return -1;
|
|
}
|
|
cl = inb(status_port);
|
|
outb(data_port, 0x10);
|
|
|
|
while(!(inb(status_port) & CLPIP_SHAKE))
|
|
if(!--spin) {
|
|
return -1;
|
|
}
|
|
c = inb(status_port);
|
|
outb(data_port, 0x00);
|
|
|
|
return (ctrecvl[cl] | ctrecvh[c]);
|
|
}
|
|
|
|
static void
|
|
lpintr (int unit)
|
|
{
|
|
struct lpt_softc *sc = lpt_sc + unit;
|
|
register int lpt_data_port = sc->sc_port + lpt_data;
|
|
register int lpt_stat_port = sc->sc_port + lpt_status;
|
|
int lpt_ctrl_port = sc->sc_port + lpt_control;
|
|
int len, s, j;
|
|
u_char *bp;
|
|
u_char c, cl;
|
|
struct mbuf *top;
|
|
|
|
s = splhigh();
|
|
|
|
if (sc->sc_if.if_flags & IFF_LINK0) {
|
|
|
|
/* Ack. the request */
|
|
outb(lpt_data_port, 0x01);
|
|
|
|
/* Get the packet length */
|
|
j = clpinbyte(LPMAXSPIN2, lpt_data_port, lpt_stat_port);
|
|
if (j == -1)
|
|
goto err;
|
|
len = j;
|
|
j = clpinbyte(LPMAXSPIN2, lpt_data_port, lpt_stat_port);
|
|
if (j == -1)
|
|
goto err;
|
|
len = len + (j << 8);
|
|
if (len > sc->sc_if.if_mtu + MLPIPHDRLEN)
|
|
goto err;
|
|
|
|
bp = sc->sc_ifbuf;
|
|
|
|
while (len--) {
|
|
j = clpinbyte(LPMAXSPIN2, lpt_data_port, lpt_stat_port);
|
|
if (j == -1) {
|
|
goto err;
|
|
}
|
|
*bp++ = j;
|
|
}
|
|
/* Get and ignore checksum */
|
|
j = clpinbyte(LPMAXSPIN2, lpt_data_port, lpt_stat_port);
|
|
if (j == -1) {
|
|
goto err;
|
|
}
|
|
|
|
len = bp - sc->sc_ifbuf;
|
|
if (len <= CLPIPHDRLEN)
|
|
goto err;
|
|
|
|
sc->sc_iferrs = 0;
|
|
|
|
len -= CLPIPHDRLEN;
|
|
sc->sc_if.if_ipackets++;
|
|
sc->sc_if.if_ibytes += len;
|
|
top = m_devget(sc->sc_ifbuf + CLPIPHDRLEN, len, 0, &sc->sc_if, 0);
|
|
if (top) {
|
|
if (! IF_HANDOFF(&ipintrq, top, NULL))
|
|
lprintf(("DROP"));
|
|
else
|
|
schednetisr(NETISR_IP);
|
|
}
|
|
goto done;
|
|
}
|
|
while ((inb(lpt_stat_port) & LPIP_SHAKE)) {
|
|
len = sc->sc_if.if_mtu + LPIPHDRLEN;
|
|
bp = sc->sc_ifbuf;
|
|
while (len--) {
|
|
|
|
cl = inb(lpt_stat_port);
|
|
outb(lpt_data_port, 8);
|
|
|
|
j = LPMAXSPIN2;
|
|
while((inb(lpt_stat_port) & LPIP_SHAKE))
|
|
if(!--j) goto err;
|
|
|
|
c = inb(lpt_stat_port);
|
|
outb(lpt_data_port, 0);
|
|
|
|
*bp++= trecvh[cl] | trecvl[c];
|
|
|
|
j = LPMAXSPIN2;
|
|
while (!((cl=inb(lpt_stat_port)) & LPIP_SHAKE)) {
|
|
if (cl != c &&
|
|
(((cl = inb(lpt_stat_port)) ^ 0xb8) & 0xf8) ==
|
|
(c & 0xf8))
|
|
goto end;
|
|
if (!--j) goto err;
|
|
}
|
|
}
|
|
|
|
end:
|
|
len = bp - sc->sc_ifbuf;
|
|
if (len <= LPIPHDRLEN)
|
|
goto err;
|
|
|
|
sc->sc_iferrs = 0;
|
|
|
|
if (sc->sc_if.if_bpf) {
|
|
bpf_tap(&sc->sc_if, sc->sc_ifbuf, len);
|
|
}
|
|
len -= LPIPHDRLEN;
|
|
sc->sc_if.if_ipackets++;
|
|
sc->sc_if.if_ibytes += len;
|
|
top = m_devget(sc->sc_ifbuf + LPIPHDRLEN, len, 0, &sc->sc_if, 0);
|
|
if (top) {
|
|
if (! IF_HANDOFF(&ipintrq, top, NULL))
|
|
lprintf(("DROP"));
|
|
else
|
|
schednetisr(NETISR_IP);
|
|
}
|
|
}
|
|
goto done;
|
|
|
|
err:
|
|
outb(lpt_data_port, 0);
|
|
lprintf(("R"));
|
|
sc->sc_if.if_ierrors++;
|
|
sc->sc_iferrs++;
|
|
|
|
/*
|
|
* We are not able to send receive anything for now,
|
|
* so stop wasting our time
|
|
*/
|
|
if (sc->sc_iferrs > LPMAXERRS) {
|
|
printf("lp%d: Too many errors, Going off-line.\n", unit);
|
|
outb(lpt_ctrl_port, 0x00);
|
|
sc->sc_if.if_flags &= ~IFF_RUNNING;
|
|
sc->sc_iferrs=0;
|
|
}
|
|
|
|
done:
|
|
splx(s);
|
|
return;
|
|
}
|
|
|
|
static __inline int
|
|
lpoutbyte (u_char byte, int spin, int data_port, int status_port)
|
|
{
|
|
outb(data_port, txmith[byte]);
|
|
while (!(inb(status_port) & LPIP_SHAKE))
|
|
if (--spin == 0)
|
|
return 1;
|
|
outb(data_port, txmitl[byte]);
|
|
while (inb(status_port) & LPIP_SHAKE)
|
|
if (--spin == 0)
|
|
return 1;
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
lpoutput (struct ifnet *ifp, struct mbuf *m,
|
|
struct sockaddr *dst, struct rtentry *rt)
|
|
{
|
|
register int lpt_data_port = lpt_sc[ifp->if_unit].sc_port + lpt_data;
|
|
register int lpt_stat_port = lpt_sc[ifp->if_unit].sc_port + lpt_status;
|
|
#ifndef PC98
|
|
int lpt_ctrl_port = lpt_sc[ifp->if_unit].sc_port + lpt_control;
|
|
#endif
|
|
|
|
int s, err;
|
|
struct mbuf *mm;
|
|
u_char *cp = "\0\0";
|
|
u_char chksum = 0;
|
|
int count = 0;
|
|
int i;
|
|
int spin;
|
|
|
|
/* We need a sensible value if we abort */
|
|
cp++;
|
|
ifp->if_flags |= IFF_RUNNING;
|
|
|
|
err = 1; /* assume we're aborting because of an error */
|
|
|
|
s = splhigh();
|
|
|
|
#ifndef PC98
|
|
/* Suspend (on laptops) or receive-errors might have taken us offline */
|
|
outb(lpt_ctrl_port, LPC_ENA);
|
|
#endif
|
|
|
|
if (ifp->if_flags & IFF_LINK0) {
|
|
|
|
if (!(inb(lpt_stat_port) & CLPIP_SHAKE)) {
|
|
lprintf(("&"));
|
|
lptintr(ifp->if_unit);
|
|
}
|
|
|
|
/* Alert other end to pending packet */
|
|
spin = LPMAXSPIN1;
|
|
outb(lpt_data_port, 0x08);
|
|
while ((inb(lpt_stat_port) & 0x08) == 0)
|
|
if (--spin == 0) {
|
|
goto nend;
|
|
}
|
|
|
|
/* Calculate length of packet, then send that */
|
|
|
|
count += 14; /* Ethernet header len */
|
|
|
|
mm = m;
|
|
for (mm = m; mm; mm = mm->m_next) {
|
|
count += mm->m_len;
|
|
}
|
|
if (clpoutbyte(count & 0xFF, LPMAXSPIN1, lpt_data_port, lpt_stat_port))
|
|
goto nend;
|
|
if (clpoutbyte((count >> 8) & 0xFF, LPMAXSPIN1, lpt_data_port, lpt_stat_port))
|
|
goto nend;
|
|
|
|
/* Send dummy ethernet header */
|
|
for (i = 0; i < 12; i++) {
|
|
if (clpoutbyte(i, LPMAXSPIN1, lpt_data_port, lpt_stat_port))
|
|
goto nend;
|
|
chksum += i;
|
|
}
|
|
|
|
if (clpoutbyte(0x08, LPMAXSPIN1, lpt_data_port, lpt_stat_port))
|
|
goto nend;
|
|
if (clpoutbyte(0x00, LPMAXSPIN1, lpt_data_port, lpt_stat_port))
|
|
goto nend;
|
|
chksum += 0x08 + 0x00; /* Add into checksum */
|
|
|
|
mm = m;
|
|
do {
|
|
cp = mtod(mm, u_char *);
|
|
while (mm->m_len--) {
|
|
chksum += *cp;
|
|
if (clpoutbyte(*cp++, LPMAXSPIN2, lpt_data_port, lpt_stat_port))
|
|
goto nend;
|
|
}
|
|
} while ((mm = mm->m_next));
|
|
|
|
/* Send checksum */
|
|
if (clpoutbyte(chksum, LPMAXSPIN2, lpt_data_port, lpt_stat_port))
|
|
goto nend;
|
|
|
|
/* Go quiescent */
|
|
outb(lpt_data_port, 0);
|
|
|
|
err = 0; /* No errors */
|
|
|
|
nend:
|
|
if (err) { /* if we didn't timeout... */
|
|
ifp->if_oerrors++;
|
|
lprintf(("X"));
|
|
} else {
|
|
ifp->if_opackets++;
|
|
ifp->if_obytes += m->m_pkthdr.len;
|
|
}
|
|
|
|
m_freem(m);
|
|
|
|
if (!(inb(lpt_stat_port) & CLPIP_SHAKE)) {
|
|
lprintf(("^"));
|
|
lptintr(ifp->if_unit);
|
|
}
|
|
(void) splx(s);
|
|
return 0;
|
|
}
|
|
|
|
if (inb(lpt_stat_port) & LPIP_SHAKE) {
|
|
lprintf(("&"));
|
|
lptintr(ifp->if_unit);
|
|
}
|
|
|
|
if (lpoutbyte(0x08, LPMAXSPIN1, lpt_data_port, lpt_stat_port))
|
|
goto end;
|
|
if (lpoutbyte(0x00, LPMAXSPIN2, lpt_data_port, lpt_stat_port))
|
|
goto end;
|
|
|
|
mm = m;
|
|
do {
|
|
cp = mtod(mm,u_char *);
|
|
while (mm->m_len--)
|
|
if (lpoutbyte(*cp++, LPMAXSPIN2, lpt_data_port, lpt_stat_port))
|
|
goto end;
|
|
} while ((mm = mm->m_next));
|
|
|
|
err = 0; /* no errors were encountered */
|
|
|
|
end:
|
|
--cp;
|
|
outb(lpt_data_port, txmitl[*cp] ^ 0x17);
|
|
|
|
if (err) { /* if we didn't timeout... */
|
|
ifp->if_oerrors++;
|
|
lprintf(("X"));
|
|
} else {
|
|
ifp->if_opackets++;
|
|
ifp->if_obytes += m->m_pkthdr.len;
|
|
if (ifp->if_bpf) {
|
|
/*
|
|
* We need to prepend the packet type as
|
|
* a two byte field. Cons up a dummy header
|
|
* to pacify bpf. This is safe because bpf
|
|
* will only read from the mbuf (i.e., it won't
|
|
* try to free it or keep a pointer to it).
|
|
*/
|
|
struct mbuf m0;
|
|
u_short hdr = 0x800;
|
|
|
|
m0.m_next = m;
|
|
m0.m_len = 2;
|
|
m0.m_data = (char *)&hdr;
|
|
|
|
bpf_mtap(ifp, &m0);
|
|
}
|
|
}
|
|
|
|
m_freem(m);
|
|
|
|
if (inb(lpt_stat_port) & LPIP_SHAKE) {
|
|
lprintf(("^"));
|
|
lptintr(ifp->if_unit);
|
|
}
|
|
|
|
(void) splx(s);
|
|
return 0;
|
|
}
|
|
|
|
#endif /* INET */
|
|
|
|
static int lpt_devsw_installed;
|
|
|
|
static void lpt_drvinit(void *unused)
|
|
{
|
|
|
|
if( ! lpt_devsw_installed ) {
|
|
cdevsw_add(&lpt_cdevsw);
|
|
lpt_devsw_installed = 1;
|
|
}
|
|
}
|
|
#ifndef LPT_DRVINIT_AT_ATTACH
|
|
SYSINIT(lptdev,SI_SUB_DRIVERS,SI_ORDER_MIDDLE+CDEV_MAJOR,lpt_drvinit,NULL)
|
|
#endif
|