df746a8c42
device, the device is probed multiple times (so each device is detected N times after unloading/loading the module N-1 times). The real fix is (quote Doug and Warner): > : In an ideal world, there should be some kind of BUS_UNIDENTIFY method > : which a driver could use to delete the devices it created in > : BUS_IDENTIFY. > > Or the bus would have a driver deleted routine that got called and it > would remove all instances of the devclass attached to it. Reviewed by: Doug Rabson & Warner Losh
579 lines
12 KiB
C
579 lines
12 KiB
C
/*-
|
|
* Copyright (c) 1997, 1998, 1999 Nicolas Souchu, Michael Smith
|
|
* 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.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``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 AUTHOR OR CONTRIBUTORS 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.
|
|
*
|
|
*
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__FBSDID("$FreeBSD$");
|
|
#include "opt_ppb_1284.h"
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/module.h>
|
|
#include <sys/bus.h>
|
|
#include <sys/conf.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/uio.h>
|
|
#include <sys/fcntl.h>
|
|
|
|
#include <machine/bus.h>
|
|
#include <machine/resource.h>
|
|
#include <sys/rman.h>
|
|
|
|
#include <dev/ppbus/ppbconf.h>
|
|
#include <dev/ppbus/ppb_msq.h>
|
|
|
|
#ifdef PERIPH_1284
|
|
#include <dev/ppbus/ppb_1284.h>
|
|
#endif
|
|
|
|
#include <dev/ppbus/ppi.h>
|
|
|
|
#include "ppbus_if.h"
|
|
|
|
#include <dev/ppbus/ppbio.h>
|
|
|
|
#define BUFSIZE 512
|
|
|
|
struct ppi_data {
|
|
|
|
int ppi_unit;
|
|
int ppi_flags;
|
|
#define HAVE_PPBUS (1<<0)
|
|
#define HAD_PPBUS (1<<1)
|
|
|
|
int ppi_count;
|
|
int ppi_mode; /* IEEE1284 mode */
|
|
char ppi_buffer[BUFSIZE];
|
|
|
|
#ifdef PERIPH_1284
|
|
struct resource *intr_resource; /* interrupt resource */
|
|
void *intr_cookie; /* interrupt registration cookie */
|
|
#endif /* PERIPH_1284 */
|
|
};
|
|
|
|
#define DEVTOSOFTC(dev) \
|
|
((struct ppi_data *)device_get_softc(dev))
|
|
#define UNITOSOFTC(unit) \
|
|
((struct ppi_data *)devclass_get_softc(ppi_devclass, (unit)))
|
|
#define UNITODEVICE(unit) \
|
|
(devclass_get_device(ppi_devclass, (unit)))
|
|
|
|
static devclass_t ppi_devclass;
|
|
|
|
static d_open_t ppiopen;
|
|
static d_close_t ppiclose;
|
|
static d_ioctl_t ppiioctl;
|
|
static d_write_t ppiwrite;
|
|
static d_read_t ppiread;
|
|
|
|
static struct cdevsw ppi_cdevsw = {
|
|
.d_version = D_VERSION,
|
|
.d_flags = D_NEEDGIANT,
|
|
.d_open = ppiopen,
|
|
.d_close = ppiclose,
|
|
.d_read = ppiread,
|
|
.d_write = ppiwrite,
|
|
.d_ioctl = ppiioctl,
|
|
.d_name = "ppi",
|
|
};
|
|
|
|
#ifdef PERIPH_1284
|
|
|
|
static void
|
|
ppi_enable_intr(device_t ppidev)
|
|
{
|
|
char r;
|
|
device_t ppbus = device_get_parent(ppidev);
|
|
|
|
r = ppb_rctr(ppbus);
|
|
ppb_wctr(ppbus, r | IRQENABLE);
|
|
|
|
return;
|
|
}
|
|
|
|
static void
|
|
ppi_disable_intr(device_t ppidev)
|
|
{
|
|
char r;
|
|
device_t ppbus = device_get_parent(ppidev);
|
|
|
|
r = ppb_rctr(ppbus);
|
|
ppb_wctr(ppbus, r & ~IRQENABLE);
|
|
|
|
return;
|
|
}
|
|
|
|
#endif /* PERIPH_1284 */
|
|
|
|
static void
|
|
ppi_identify(driver_t *driver, device_t parent)
|
|
{
|
|
|
|
device_t dev;
|
|
|
|
dev = device_find_child(parent, "ppi", 0);
|
|
if (!dev)
|
|
BUS_ADD_CHILD(parent, 0, "ppi", -1);
|
|
}
|
|
|
|
/*
|
|
* ppi_probe()
|
|
*/
|
|
static int
|
|
ppi_probe(device_t dev)
|
|
{
|
|
struct ppi_data *ppi;
|
|
|
|
/* probe is always ok */
|
|
device_set_desc(dev, "Parallel I/O");
|
|
|
|
ppi = DEVTOSOFTC(dev);
|
|
bzero(ppi, sizeof(struct ppi_data));
|
|
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* ppi_attach()
|
|
*/
|
|
static int
|
|
ppi_attach(device_t dev)
|
|
{
|
|
#ifdef PERIPH_1284
|
|
uintptr_t irq;
|
|
int zero = 0;
|
|
struct ppi_data *ppi = DEVTOSOFTC(dev);
|
|
|
|
/* retrive the irq */
|
|
BUS_READ_IVAR(device_get_parent(dev), dev, PPBUS_IVAR_IRQ, &irq);
|
|
|
|
/* declare our interrupt handler */
|
|
ppi->intr_resource = bus_alloc_resource(dev, SYS_RES_IRQ,
|
|
&zero, irq, irq, 1, RF_ACTIVE);
|
|
#endif /* PERIPH_1284 */
|
|
|
|
make_dev(&ppi_cdevsw, device_get_unit(dev), /* XXX cleanup */
|
|
UID_ROOT, GID_WHEEL,
|
|
0600, "ppi%d", device_get_unit(dev));
|
|
|
|
return (0);
|
|
}
|
|
|
|
#ifdef PERIPH_1284
|
|
/*
|
|
* Cable
|
|
* -----
|
|
*
|
|
* Use an IEEE1284 compliant (DB25/DB25) cable with the following tricks:
|
|
*
|
|
* nStrobe <-> nAck 1 <-> 10
|
|
* nAutofd <-> Busy 11 <-> 14
|
|
* nSelectin <-> Select 17 <-> 13
|
|
* nInit <-> nFault 15 <-> 16
|
|
*
|
|
*/
|
|
static void
|
|
ppiintr(void *arg)
|
|
{
|
|
device_t ppidev = (device_t)arg;
|
|
device_t ppbus = device_get_parent(ppidev);
|
|
struct ppi_data *ppi = DEVTOSOFTC(ppidev);
|
|
|
|
ppi_disable_intr(ppidev);
|
|
|
|
switch (ppb_1284_get_state(ppbus)) {
|
|
|
|
/* accept IEEE1284 negotiation then wakeup a waiting process to
|
|
* continue negotiation at process level */
|
|
case PPB_FORWARD_IDLE:
|
|
/* Event 1 */
|
|
if ((ppb_rstr(ppbus) & (SELECT | nBUSY)) ==
|
|
(SELECT | nBUSY)) {
|
|
/* IEEE1284 negotiation */
|
|
#ifdef DEBUG_1284
|
|
printf("N");
|
|
#endif
|
|
|
|
/* Event 2 - prepare for reading the ext. value */
|
|
ppb_wctr(ppbus, (PCD | STROBE | nINIT) & ~SELECTIN);
|
|
|
|
ppb_1284_set_state(ppbus, PPB_NEGOCIATION);
|
|
|
|
} else {
|
|
#ifdef DEBUG_1284
|
|
printf("0x%x", ppb_rstr(ppbus));
|
|
#endif
|
|
ppb_peripheral_terminate(ppbus, PPB_DONTWAIT);
|
|
break;
|
|
}
|
|
|
|
/* wake up any process waiting for negotiation from
|
|
* remote master host */
|
|
|
|
/* XXX should set a variable to warn the process about
|
|
* the interrupt */
|
|
|
|
wakeup(ppi);
|
|
break;
|
|
default:
|
|
#ifdef DEBUG_1284
|
|
printf("?%d", ppb_1284_get_state(ppbus));
|
|
#endif
|
|
ppb_1284_set_state(ppbus, PPB_FORWARD_IDLE);
|
|
ppb_set_mode(ppbus, PPB_COMPATIBLE);
|
|
break;
|
|
}
|
|
|
|
ppi_enable_intr(ppidev);
|
|
|
|
return;
|
|
}
|
|
#endif /* PERIPH_1284 */
|
|
|
|
static int
|
|
ppiopen(dev_t dev, int flags, int fmt, struct thread *td)
|
|
{
|
|
u_int unit = minor(dev);
|
|
struct ppi_data *ppi = UNITOSOFTC(unit);
|
|
device_t ppidev = UNITODEVICE(unit);
|
|
device_t ppbus = device_get_parent(ppidev);
|
|
int res;
|
|
|
|
if (!ppi)
|
|
return (ENXIO);
|
|
|
|
if (!(ppi->ppi_flags & HAVE_PPBUS)) {
|
|
if ((res = ppb_request_bus(ppbus, ppidev,
|
|
(flags & O_NONBLOCK) ? PPB_DONTWAIT :
|
|
(PPB_WAIT | PPB_INTR))))
|
|
return (res);
|
|
|
|
ppi->ppi_flags |= HAVE_PPBUS;
|
|
|
|
#ifdef PERIPH_1284
|
|
if (ppi->intr_resource) {
|
|
/* register our interrupt handler */
|
|
BUS_SETUP_INTR(device_get_parent(ppidev), ppidev, ppi->intr_resource,
|
|
INTR_TYPE_TTY, ppiintr, dev, &ppi->intr_cookie);
|
|
}
|
|
#endif /* PERIPH_1284 */
|
|
}
|
|
ppi->ppi_count += 1;
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
ppiclose(dev_t dev, int flags, int fmt, struct thread *td)
|
|
{
|
|
u_int unit = minor(dev);
|
|
struct ppi_data *ppi = UNITOSOFTC(unit);
|
|
device_t ppidev = UNITODEVICE(unit);
|
|
device_t ppbus = device_get_parent(ppidev);
|
|
|
|
ppi->ppi_count --;
|
|
if (!ppi->ppi_count) {
|
|
|
|
#ifdef PERIPH_1284
|
|
switch (ppb_1284_get_state(ppbus)) {
|
|
case PPB_PERIPHERAL_IDLE:
|
|
ppb_peripheral_terminate(ppbus, 0);
|
|
break;
|
|
case PPB_REVERSE_IDLE:
|
|
case PPB_EPP_IDLE:
|
|
case PPB_ECP_FORWARD_IDLE:
|
|
default:
|
|
ppb_1284_terminate(ppbus);
|
|
break;
|
|
}
|
|
#endif /* PERIPH_1284 */
|
|
|
|
/* unregistration of interrupt forced by release */
|
|
ppb_release_bus(ppbus, ppidev);
|
|
|
|
ppi->ppi_flags &= ~HAVE_PPBUS;
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* ppiread()
|
|
*
|
|
* IEEE1284 compliant read.
|
|
*
|
|
* First, try negotiation to BYTE then NIBBLE mode
|
|
* If no data is available, wait for it otherwise transfer as much as possible
|
|
*/
|
|
static int
|
|
ppiread(dev_t dev, struct uio *uio, int ioflag)
|
|
{
|
|
#ifdef PERIPH_1284
|
|
u_int unit = minor(dev);
|
|
struct ppi_data *ppi = UNITOSOFTC(unit);
|
|
device_t ppidev = UNITODEVICE(unit);
|
|
device_t ppbus = device_get_parent(ppidev);
|
|
int len, error = 0;
|
|
|
|
switch (ppb_1284_get_state(ppbus)) {
|
|
case PPB_PERIPHERAL_IDLE:
|
|
ppb_peripheral_terminate(ppbus, 0);
|
|
/* FALLTHROUGH */
|
|
|
|
case PPB_FORWARD_IDLE:
|
|
/* if can't negotiate NIBBLE mode then try BYTE mode,
|
|
* the peripheral may be a computer
|
|
*/
|
|
if ((ppb_1284_negociate(ppbus,
|
|
ppi->ppi_mode = PPB_NIBBLE, 0))) {
|
|
|
|
/* XXX Wait 2 seconds to let the remote host some
|
|
* time to terminate its interrupt
|
|
*/
|
|
tsleep(ppi, PPBPRI, "ppiread", 2*hz);
|
|
|
|
if ((error = ppb_1284_negociate(ppbus,
|
|
ppi->ppi_mode = PPB_BYTE, 0)))
|
|
return (error);
|
|
}
|
|
break;
|
|
|
|
case PPB_REVERSE_IDLE:
|
|
case PPB_EPP_IDLE:
|
|
case PPB_ECP_FORWARD_IDLE:
|
|
default:
|
|
break;
|
|
}
|
|
|
|
#ifdef DEBUG_1284
|
|
printf("N");
|
|
#endif
|
|
/* read data */
|
|
len = 0;
|
|
while (uio->uio_resid) {
|
|
if ((error = ppb_1284_read(ppbus, ppi->ppi_mode,
|
|
ppi->ppi_buffer, min(BUFSIZE, uio->uio_resid),
|
|
&len))) {
|
|
goto error;
|
|
}
|
|
|
|
if (!len)
|
|
goto error; /* no more data */
|
|
|
|
#ifdef DEBUG_1284
|
|
printf("d");
|
|
#endif
|
|
if ((error = uiomove(ppi->ppi_buffer, len, uio)))
|
|
goto error;
|
|
}
|
|
|
|
error:
|
|
|
|
#else /* PERIPH_1284 */
|
|
int error = ENODEV;
|
|
#endif
|
|
|
|
return (error);
|
|
}
|
|
|
|
/*
|
|
* ppiwrite()
|
|
*
|
|
* IEEE1284 compliant write
|
|
*
|
|
* Actually, this is the peripheral side of a remote IEEE1284 read
|
|
*
|
|
* The first part of the negotiation (IEEE1284 device detection) is
|
|
* done at interrupt level, then the remaining is done by the writing
|
|
* process
|
|
*
|
|
* Once negotiation done, transfer data
|
|
*/
|
|
static int
|
|
ppiwrite(dev_t dev, struct uio *uio, int ioflag)
|
|
{
|
|
#ifdef PERIPH_1284
|
|
u_int unit = minor(dev);
|
|
struct ppi_data *ppi = UNITOSOFTC(unit);
|
|
device_t ppidev = UNITODEVICE(unit);
|
|
device_t ppbus = device_get_parent(ppidev);
|
|
int len, error = 0, sent;
|
|
|
|
#if 0
|
|
int ret;
|
|
|
|
#define ADDRESS MS_PARAM(0, 0, MS_TYP_PTR)
|
|
#define LENGTH MS_PARAM(0, 1, MS_TYP_INT)
|
|
|
|
struct ppb_microseq msq[] = {
|
|
{ MS_OP_PUT, { MS_UNKNOWN, MS_UNKNOWN, MS_UNKNOWN } },
|
|
MS_RET(0)
|
|
};
|
|
|
|
/* negotiate ECP mode */
|
|
if (ppb_1284_negociate(ppbus, PPB_ECP, 0)) {
|
|
printf("ppiwrite: ECP negotiation failed\n");
|
|
}
|
|
|
|
while (!error && (len = min(uio->uio_resid, BUFSIZE))) {
|
|
uiomove(ppi->ppi_buffer, len, uio);
|
|
|
|
ppb_MS_init_msq(msq, 2, ADDRESS, ppi->ppi_buffer, LENGTH, len);
|
|
|
|
error = ppb_MS_microseq(ppbus, msq, &ret);
|
|
}
|
|
#endif
|
|
|
|
/* we have to be peripheral to be able to send data, so
|
|
* wait for the appropriate state
|
|
*/
|
|
if (ppb_1284_get_state(ppbus) < PPB_PERIPHERAL_NEGOCIATION)
|
|
ppb_1284_terminate(ppbus);
|
|
|
|
while (ppb_1284_get_state(ppbus) != PPB_PERIPHERAL_IDLE) {
|
|
/* XXX should check a variable before sleeping */
|
|
#ifdef DEBUG_1284
|
|
printf("s");
|
|
#endif
|
|
|
|
ppi_enable_intr(ppidev);
|
|
|
|
/* sleep until IEEE1284 negotiation starts */
|
|
error = tsleep(ppi, PCATCH | PPBPRI, "ppiwrite", 0);
|
|
|
|
switch (error) {
|
|
case 0:
|
|
/* negotiate peripheral side with BYTE mode */
|
|
ppb_peripheral_negociate(ppbus, PPB_BYTE, 0);
|
|
break;
|
|
case EWOULDBLOCK:
|
|
break;
|
|
default:
|
|
goto error;
|
|
}
|
|
}
|
|
#ifdef DEBUG_1284
|
|
printf("N");
|
|
#endif
|
|
|
|
/* negotiation done, write bytes to master host */
|
|
while ((len = min(uio->uio_resid, BUFSIZE)) != 0) {
|
|
uiomove(ppi->ppi_buffer, len, uio);
|
|
if ((error = byte_peripheral_write(ppbus,
|
|
ppi->ppi_buffer, len, &sent)))
|
|
goto error;
|
|
#ifdef DEBUG_1284
|
|
printf("d");
|
|
#endif
|
|
}
|
|
|
|
error:
|
|
|
|
#else /* PERIPH_1284 */
|
|
int error = ENODEV;
|
|
#endif
|
|
|
|
return (error);
|
|
}
|
|
|
|
static int
|
|
ppiioctl(dev_t dev, u_long cmd, caddr_t data, int flags, struct thread *td)
|
|
{
|
|
u_int unit = minor(dev);
|
|
device_t ppidev = UNITODEVICE(unit);
|
|
device_t ppbus = device_get_parent(ppidev);
|
|
int error = 0;
|
|
u_int8_t *val = (u_int8_t *)data;
|
|
|
|
switch (cmd) {
|
|
|
|
case PPIGDATA: /* get data register */
|
|
*val = ppb_rdtr(ppbus);
|
|
break;
|
|
case PPIGSTATUS: /* get status bits */
|
|
*val = ppb_rstr(ppbus);
|
|
break;
|
|
case PPIGCTRL: /* get control bits */
|
|
*val = ppb_rctr(ppbus);
|
|
break;
|
|
case PPIGEPPD: /* get EPP data bits */
|
|
*val = ppb_repp_D(ppbus);
|
|
break;
|
|
case PPIGECR: /* get ECP bits */
|
|
*val = ppb_recr(ppbus);
|
|
break;
|
|
case PPIGFIFO: /* read FIFO */
|
|
*val = ppb_rfifo(ppbus);
|
|
break;
|
|
case PPISDATA: /* set data register */
|
|
ppb_wdtr(ppbus, *val);
|
|
break;
|
|
case PPISSTATUS: /* set status bits */
|
|
ppb_wstr(ppbus, *val);
|
|
break;
|
|
case PPISCTRL: /* set control bits */
|
|
ppb_wctr(ppbus, *val);
|
|
break;
|
|
case PPISEPPD: /* set EPP data bits */
|
|
ppb_wepp_D(ppbus, *val);
|
|
break;
|
|
case PPISECR: /* set ECP bits */
|
|
ppb_wecr(ppbus, *val);
|
|
break;
|
|
case PPISFIFO: /* write FIFO */
|
|
ppb_wfifo(ppbus, *val);
|
|
break;
|
|
case PPIGEPPA: /* get EPP address bits */
|
|
*val = ppb_repp_A(ppbus);
|
|
break;
|
|
case PPISEPPA: /* set EPP address bits */
|
|
ppb_wepp_A(ppbus, *val);
|
|
break;
|
|
default:
|
|
error = ENOTTY;
|
|
break;
|
|
}
|
|
|
|
return (error);
|
|
}
|
|
|
|
static device_method_t ppi_methods[] = {
|
|
/* device interface */
|
|
DEVMETHOD(device_identify, ppi_identify),
|
|
DEVMETHOD(device_probe, ppi_probe),
|
|
DEVMETHOD(device_attach, ppi_attach),
|
|
|
|
{ 0, 0 }
|
|
};
|
|
|
|
static driver_t ppi_driver = {
|
|
"ppi",
|
|
ppi_methods,
|
|
sizeof(struct ppi_data),
|
|
};
|
|
DRIVER_MODULE(ppi, ppbus, ppi_driver, ppi_devclass, 0, 0);
|