67727fc1c1
totally dynamic.
this is only the devices in i386/isa
I'll do more tomorrow.
they're completely masked by #ifdef JREMOD at this stage...
the eventual aim is that every driver will do a SYSINIT
at startup BEFORE the probes, which will effectively
link it into the devsw tables etc.
If I'd thought about it more I'd have put that in in this set (damn)
The ioconf lines generated by config will also end up in the
device's own scope as well, so ioconf.c will eventually be gutted
the SYSINIT call to the driver will include a phase where the
driver links it's ioconf line into a chain of such. when this phase is done
then the user can modify them with the boot: -c
config menu if he wants, just like now..
config will put the config lines out in the .h file
(e.g. in aha.h will be the addresses for the aha driver to look.)
as I said this is a very small first step..
the aim of THIS set of edits is to not have to edit conf.c at all when
adding a new device.. the tabe will be a simple skeleton..
when this is done, it will allow other changes to be made,
all teh time still having a fully working kernel tree,
but the logical outcome is the complete REMOVAL of the devsw tables.
By the end of this, linked in drivers will be exactly the same as
run-time loaded drivers, except they JUST HAPPEN to already be linked
and present at startup..
the SYSINIT calls will be the equivalent of the "init" call
made to a newly loaded driver in every respect.
For this edit,
each of the files has the following code inserted into it:
obviously, tailored to suit..
----------------------somewhere at the top:
#ifdef JREMOD
#include <sys/conf.h>
#define CDEV_MAJOR 13
#define BDEV_MAJOR 4
static void sd_devsw_install();
#endif /*JREMOD */
---------------------somewhere that's run during bootup: EVENTUALLY a SYSINIT
#ifdef JREMOD
sd_devsw_install();
#endif /*JREMOD*/
-----------------------at the bottom:
#ifdef JREMOD
struct bdevsw sd_bdevsw =
{ sdopen, sdclose, sdstrategy, sdioctl, /*4*/
sddump, sdsize, 0 };
struct cdevsw sd_cdevsw =
{ sdopen, sdclose, rawread, rawwrite, /*13*/
sdioctl, nostop, nullreset, nodevtotty,/* sd */
seltrue, nommap, sdstrategy };
static sd_devsw_installed = 0;
static void sd_devsw_install()
{
dev_t descript;
if( ! sd_devsw_installed ) {
descript = makedev(CDEV_MAJOR,0);
cdevsw_add(&descript,&sd_cdevsw,NULL);
#if defined(BDEV_MAJOR)
descript = makedev(BDEV_MAJOR,0);
bdevsw_add(&descript,&sd_bdevsw,NULL);
#endif /*BDEV_MAJOR*/
sd_devsw_installed = 1;
}
}
#endif /* JREMOD */
661 lines
17 KiB
C
661 lines
17 KiB
C
/*
|
|
* FreeBSD device driver for B004-compatible Transputer boards.
|
|
*
|
|
* based on Linux version Copyright (C) 1993 by Christoph Niemann
|
|
*
|
|
* Rewritten for FreeBSD by
|
|
* Luigi Rizzo (luigi@iet.unipi.it) and
|
|
* Lorenzo Vicisano (l.vicisano@iet.unipi.it)
|
|
* Dipartimento di Ingegneria dell'Informazione
|
|
* Universita` di Pisa
|
|
* via Diotisalvi 2, 56126 Pisa, ITALY
|
|
* 14 september 1994
|
|
*
|
|
* 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 product includes software developed by Christoph Niemann,
|
|
* Luigi Rizzo and Lorenzo Vicisano - Dipartimento di Ingegneria
|
|
* dell'Informazione
|
|
* 4. The names of these contributors may not be used to endorse or promote
|
|
* products derived from this software without specific prior written
|
|
* permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE 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 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.
|
|
*
|
|
* NOTE NOTE NOTE
|
|
* The assembler version is still under development.
|
|
*/
|
|
|
|
/* #define USE_ASM */
|
|
|
|
#include "bqu.h"
|
|
#if NBQU > 0
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/proc.h>
|
|
#include <sys/uio.h>
|
|
#include <sys/devconf.h>
|
|
|
|
#include <machine/clock.h>
|
|
|
|
#include <i386/isa/b004.h>
|
|
#include <i386/isa/isa.h>
|
|
#include <i386/isa/isa_device.h>
|
|
|
|
#ifdef JREMOD
|
|
#include <sys/conf.h>
|
|
#define CDEV_MAJOR 8
|
|
static void bqu_devsw_install();
|
|
#endif /*JREMOD*/
|
|
|
|
static u_char d_inb(u_int port);
|
|
static void d_outb(u_int port, u_char data);
|
|
|
|
static struct kern_devconf kdc_bqu[NBQU] = { {
|
|
0, 0, 0, /* filled in by dev_attach */
|
|
"bqu", 0, { MDDT_ISA, 0 },
|
|
isa_generic_externalize, 0, 0, ISA_EXTERNALLEN,
|
|
&kdc_isa0, /* parent */
|
|
0, /* parentdata */
|
|
DC_UNCONFIGURED, /* always start here */
|
|
"B004-compatible Transputer board",
|
|
DC_CLS_MISC
|
|
} };
|
|
|
|
#define IOCTL_OUT(arg, ret) *(int*)arg = ret
|
|
|
|
#define B004PRI (PZERO+8)
|
|
|
|
#define B004_CHANCE 8
|
|
|
|
/*
|
|
* Define these symbols if you want to debug the code.
|
|
*/
|
|
#undef B004_DEBUG
|
|
#undef B004_DEBUG_2
|
|
|
|
#ifdef B004_DEBUG
|
|
#define out(port,data) d_outb(port, data)
|
|
#define in(a) d_inb(((u_int)a))
|
|
#else
|
|
#define out(port, data) outb(port,data)
|
|
#define in(port) inb(((u_int)port))
|
|
#endif B004_DEBUG
|
|
|
|
#ifdef B004_DEBUG
|
|
#define DEB(x) x
|
|
#define NO_DEB(x) /* */
|
|
#else
|
|
#define DEB(x) /* */
|
|
#define NO_DEB(x) x
|
|
#endif
|
|
|
|
#ifdef B004_DEBUG_2
|
|
#define DEB2(x) x
|
|
#else
|
|
#define DEB2(x)
|
|
#endif
|
|
|
|
static int bquprobe(struct isa_device *idp);
|
|
static int bquattach(struct isa_device *idp);
|
|
|
|
|
|
struct isa_driver bqudriver = {
|
|
bquprobe, bquattach, "bqu"
|
|
};
|
|
|
|
static int b004_sleep; /* wait address */
|
|
|
|
static struct b004_struct b004_table[NBQU];
|
|
|
|
static int first_time=1;
|
|
|
|
/*
|
|
* At these addresses the driver will search for B004-compatible boards
|
|
*/
|
|
static int
|
|
b004_base_addresses[B004_CHANCE] = {
|
|
/* 0x150, 0x170, 0x190, 0x200, 0x300, 0x320, 0x340, 0x360 */
|
|
0x150, 0x190, 0, 0, 0, 0, 0, 0
|
|
};
|
|
|
|
|
|
static void
|
|
d_outb(u_int port, u_char data)
|
|
{
|
|
|
|
printf("OUT 0x%x TO 0x%x\n",data,port);
|
|
outb(port,data);
|
|
}
|
|
|
|
static u_char d_inb(u_int port)
|
|
{
|
|
u_char ap;
|
|
ap=inb(port);
|
|
printf("INPUT 0x%x FROM 0x%x\n",ap,port);
|
|
return(ap);
|
|
}
|
|
|
|
static int
|
|
detected(int base)
|
|
{
|
|
int i;
|
|
for(i=0;i<NBQU;i++)
|
|
if ((B004_F(i) & B004_EXIST) && (B004_BASE(i)==base)) return 1;
|
|
return (0);
|
|
}
|
|
|
|
#define b004_delay(a) DELAY(10000)
|
|
|
|
/*
|
|
* static void bqureset(): reset transputer network.
|
|
*
|
|
*/
|
|
|
|
static void
|
|
bqureset( const int dev_min )
|
|
{
|
|
DEB(printf("B004 resetting transputer at link %d.\n", dev_min);)
|
|
out(B004_BASE(dev_min)+B004_ANALYSE_OFFSET, B004_DEASSERT_ANALYSE);
|
|
b004_delay(dev_min);
|
|
|
|
out(B004_BASE(dev_min) + B004_RESET_OFFSET, B004_DEASSERT_RESET);
|
|
b004_delay(dev_min);
|
|
|
|
out(B004_BASE(dev_min) + B004_RESET_OFFSET, B004_ASSERT_RESET);
|
|
b004_delay(dev_min);
|
|
|
|
out(B004_BASE(dev_min) + B004_RESET_OFFSET, B004_DEASSERT_RESET);
|
|
b004_delay(dev_min);
|
|
|
|
DEB(printf("B004 reset done.\n");)
|
|
}
|
|
|
|
/*
|
|
* static void bquanalyse(): switch transputer network to analyse mode.
|
|
*
|
|
*/
|
|
|
|
static void
|
|
bquanalyse( const int dev_min )
|
|
{
|
|
DEB(printf("B004 analysing transputer at link %d.\n", dev_min);)
|
|
|
|
out(B004_BASE(dev_min) + B004_ANALYSE_OFFSET, B004_DEASSERT_ANALYSE);
|
|
b004_delay(dev_min);
|
|
|
|
out(B004_BASE(dev_min) + B004_ANALYSE_OFFSET, B004_ASSERT_ANALYSE);
|
|
b004_delay(dev_min);
|
|
|
|
out(B004_BASE(dev_min) + B004_RESET_OFFSET, B004_ASSERT_RESET);
|
|
b004_delay(dev_min);
|
|
|
|
out(B004_BASE(dev_min) + B004_RESET_OFFSET, B004_DEASSERT_RESET);
|
|
b004_delay(dev_min);
|
|
|
|
out(B004_BASE(dev_min) + B004_ANALYSE_OFFSET, B004_DEASSERT_ANALYSE);
|
|
b004_delay(dev_min);
|
|
|
|
DEB(printf("B004 switching to analyse-mode done.\n");)
|
|
}
|
|
|
|
|
|
/****************************************************************************
|
|
*
|
|
* int bquread() - read bytes from the link interface.
|
|
*
|
|
* At first, the driver checks if the link-interface is ready to send a byte
|
|
* to the PC. If not, this check is repeated up to B004_MAXTRY times.
|
|
* If the link-interface is not ready after this loop, the driver sleeps for
|
|
* an NO=1 ticks and then checks the link-interface again.
|
|
* If the interface is still not ready, repeats as above incrementing NO.
|
|
* Once almost one byte is read N0 is set to 1.
|
|
* If B004_TIMEOUT != 0 and the link-interface is not ready for more than
|
|
* B004_TIMEOUT ticks read aborts returnig with the number of bytes read
|
|
* or with an error if no byte was read.
|
|
*
|
|
* By default, B004_TIMEOUT is = 0 (read is blocking)
|
|
*
|
|
*****************************************************************************/
|
|
|
|
int
|
|
bquread(dev_t dev, struct uio *uio, int flag)
|
|
{
|
|
unsigned int dev_min = minor(dev) & 7;
|
|
|
|
int timeout=B004_TIMEOUT(dev_min);
|
|
int Timeout=timeout;
|
|
int idr=B004_IDR(dev_min);
|
|
int isr=B004_ISR(dev_min);
|
|
char buffer[B004_MAX_BYTES];
|
|
|
|
if ( uio->uio_resid < 0) {
|
|
DEB(printf("B004: invalid count for reading = %d.\n", uio->uio_resid);)
|
|
return EINVAL;
|
|
}
|
|
|
|
while ( uio->uio_resid ) {
|
|
int sleep_ticks=0;
|
|
char *p, *last, *lim;
|
|
int i, end = min(B004_MAX_BYTES,uio->uio_resid);
|
|
lim= &buffer[end];
|
|
for (p= buffer; p<lim;) {
|
|
last=p;
|
|
/*** try to read as much as possible ***/
|
|
#ifdef USE_ASM
|
|
/* assembly code uses a very tight loop, with
|
|
* BX= data port, DX= address port, CX=count, ES:DI=p, AL=data, AH=1
|
|
* SI=retry counter
|
|
*/
|
|
__asm__ (
|
|
"movl %1, %%edx\n\t" /* isr */
|
|
"movl %2, %%ebx\n\t" /* idr */
|
|
"movl %3, %%edi\n" /* p */
|
|
"movl %4, %%ecx\n\t" /* lim */
|
|
"subl %%edi, %%ecx\n\t"
|
|
|
|
"push %%es\n\t"
|
|
"movw %%ss, %%ax\n\t" /** prepare ES, DF for transfer */
|
|
"movw %%ax, %%es\n\t"
|
|
"cld\n\t"
|
|
"movb $1, %%ah\n\t"
|
|
|
|
"1:\tinb %%dx, %%al\n\t"
|
|
"testb %%ah, %%al\n\t"
|
|
"jz 2f\n\t"
|
|
"xchgl %%edx, %%ebx\n\t"
|
|
"insb\n\t"
|
|
"xchgl %%edx, %%ebx\n"
|
|
"2:\tloop 1b\n\t"
|
|
|
|
"pop %%es\n\t"
|
|
"movl %%edi, %0\n\t" /* store p */
|
|
: /* out */ "=g" (p)
|
|
: /* in */ "g" (isr), "g" (idr), "g" (p), "g" (lim)
|
|
: /* regs */ "eax", "ebx", "edx", "ecx", "edi");
|
|
#else
|
|
for (i=lim - p; i-- ;)
|
|
if (inb(isr)&B004_READBYTE) *p++ =(char) inb(idr);
|
|
#endif
|
|
if (last!=p) {
|
|
sleep_ticks = 0;
|
|
} else {
|
|
/*** no new data read, must sleep ***/
|
|
sleep_ticks= (sleep_ticks<20 ? sleep_ticks+1 : sleep_ticks);
|
|
if (Timeout) {
|
|
if (timeout <=0) {
|
|
DEB2(printf("Read : TIMEOUT OCCURRED XXXXXXXXXXX\n");)
|
|
break;
|
|
}
|
|
if (timeout < sleep_ticks) sleep_ticks=timeout;
|
|
timeout -= sleep_ticks;
|
|
}
|
|
DEB2(printf("Read: SLEEPING FOR %d TICKS XXXXX\n",sleep_ticks);)
|
|
if (tsleep((caddr_t)&b004_sleep, B004PRI | PCATCH,
|
|
"b004_rd", sleep_ticks)!=EWOULDBLOCK) return 1;
|
|
}
|
|
}
|
|
if (p != buffer) {
|
|
uiomove((caddr_t)buffer, p - buffer, uio);
|
|
}
|
|
if( (Timeout) && (timeout <= 0) )
|
|
break;
|
|
}
|
|
return 0;
|
|
} /* bquread() */
|
|
|
|
|
|
/*
|
|
* int bquwrite() - write to the link interface.
|
|
*/
|
|
|
|
int
|
|
bquwrite(dev_t dev, struct uio *uio, int flag)
|
|
{
|
|
unsigned int dev_min = minor(dev) & 7;
|
|
|
|
int i, end;
|
|
int timeout=B004_TIMEOUT(dev_min);
|
|
int Timeout=timeout;
|
|
int odr=B004_ODR(dev_min);
|
|
int osr=B004_OSR(dev_min);
|
|
char buffer[B004_MAX_BYTES];
|
|
|
|
if ( uio->uio_resid < 0) {
|
|
DEB(printf("B004 invalid argument for writing: count = %d.\n", uio->uio_resid);)
|
|
return EINVAL;
|
|
}
|
|
|
|
while ( uio->uio_resid ) {
|
|
int sleep_ticks=0;
|
|
char *p, *last, *lim;
|
|
end = min(B004_MAX_BYTES,uio->uio_resid);
|
|
uiomove((caddr_t)buffer, end, uio);
|
|
|
|
lim= &buffer[end];
|
|
for (p= &buffer[0]; p<lim;) {
|
|
last=p;
|
|
#ifdef USE_ASM
|
|
/* assembly code uses a very tight loop, with
|
|
* BX= data port, DX= address port, CX=count, DS:SI=p, AL=data, AH=1
|
|
* DI= retry counter
|
|
* Unfortunately, C is almost as fast as this!
|
|
*/
|
|
__asm__ (
|
|
"movl %1, %%edx\n\t" /* osr */
|
|
"movl %2, %%ebx\n\t" /* odr */
|
|
"movl %3, %%esi\n" /* p */
|
|
"movl %4, %%ecx\n\t" /* lim */
|
|
"subl %%esi, %%ecx\n\t"
|
|
|
|
"push %%ds\n\t"
|
|
"movw %%ss, %%ax\n\t" /** prepare DS, DF for transfer */
|
|
"movw %%ax, %%ds\n\t"
|
|
"cld\n\t"
|
|
"movb $1, %%ah\n\t"
|
|
"movw $100, %%di\n\t"
|
|
|
|
"1:\tinb %%dx, %%al\n\t"
|
|
"testb %%ah, %%al\n\t"
|
|
"jz 2f\n\t"
|
|
"xchgl %%edx, %%ebx\n\t"
|
|
"outsb\n\t"
|
|
"xchgl %%edx, %%ebx\n\t"
|
|
"loop 1b\n\t"
|
|
"jmp 3f\n"
|
|
|
|
"2:\tdec %%di\n\t"
|
|
"jnc 1b\n\t"
|
|
|
|
"3:\tpop %%ds\n"
|
|
"movl %%esi, %0\n\t" /* store p */
|
|
: /* out */ "=g" (p)
|
|
: /* in */ "g" (osr), "g" (odr), "g" (p), "g" (lim)
|
|
: /* regs */ "eax", "ebx", "edx", "ecx", "esi", "edi");
|
|
#else
|
|
for (i=lim - p; i-- ; ) {
|
|
if (inb(osr)&B004_WRITEBYTE) outb(odr, *p++);
|
|
}
|
|
#endif
|
|
if (p != last ) {
|
|
sleep_ticks=0;
|
|
} else {
|
|
sleep_ticks= (sleep_ticks<20 ? sleep_ticks+1 : sleep_ticks);
|
|
if (Timeout) {
|
|
if (timeout <=0) {
|
|
DEB2(printf("Write : TIMEOUT OCCURRED XXXXXXXXXXX\n");)
|
|
uio->uio_resid += (lim - p);
|
|
break;
|
|
}
|
|
if (timeout < sleep_ticks) sleep_ticks=timeout;
|
|
timeout -= sleep_ticks;
|
|
}
|
|
DEB2(printf("Write: SLEEPING FOR %d TICKS XXXXXXX\n",sleep_ticks);)
|
|
if (tsleep((caddr_t)&b004_sleep, B004PRI | PCATCH,
|
|
"b004_rd", sleep_ticks)!=EWOULDBLOCK) return 1;
|
|
}
|
|
}
|
|
if( (Timeout) && (timeout <= 0) )
|
|
break;
|
|
}
|
|
return 0;
|
|
} /* bquwrite() */
|
|
|
|
/*
|
|
* int bquopen() -- open the link-device.
|
|
*
|
|
*/
|
|
|
|
int
|
|
bquopen(dev_t dev, int flags, int fmt, struct proc *p)
|
|
{
|
|
unsigned int dev_min = minor(dev) & 7;
|
|
|
|
if (dev_min >= NBQU) {
|
|
DEB(printf("B004 not opened, minor number >= %d.\n", NBQU);)
|
|
return ENXIO;
|
|
}
|
|
if ((B004_F(dev_min) & B004_EXIST) == 0) {
|
|
DEB(printf("B004 not opened, board %d does not exist.\n", dev_min);)
|
|
return ENXIO;
|
|
}
|
|
if (B004_F(dev_min) & B004_BUSY) {
|
|
DEB(printf("B004 not opened, board busy (minor = %d).\n", dev_min);)
|
|
return EBUSY;
|
|
}
|
|
B004_F(dev_min) |= B004_BUSY;
|
|
kdc_bqu[dev_min].kdc_state = DC_BUSY;
|
|
B004_TIMEOUT(dev_min) = 0;
|
|
DEB(printf( "B004 opened, minor = %d.\n", dev_min );)
|
|
return 0;
|
|
} /* bquopen() */
|
|
|
|
|
|
/*
|
|
* int b004close() -- close the link device.
|
|
*/
|
|
|
|
int
|
|
bquclose(dev_t dev, int flags, int fmt, struct proc *p)
|
|
{
|
|
unsigned int dev_min = minor(dev) & 7;
|
|
|
|
if (dev_min >= NBQU) {
|
|
DEB(printf("B004 not released, minor number >= %d.\n", NBQU);)
|
|
return ENXIO;
|
|
}
|
|
B004_F(dev_min) &= ~B004_BUSY;
|
|
kdc_bqu[dev_min].kdc_state = DC_IDLE;
|
|
DEB(printf("B004(%d) released.\n", dev_min );)
|
|
return 0;
|
|
}
|
|
|
|
int
|
|
bquselect(dev_t dev, int rw, struct proc *p)
|
|
{
|
|
/* still unimplemented */
|
|
return(1);
|
|
}
|
|
|
|
/*
|
|
* int bquioctl()
|
|
*
|
|
* Supported functions:
|
|
* - reset
|
|
* - analyse
|
|
* - test error flag
|
|
* - set timeout
|
|
*/
|
|
|
|
int
|
|
bquioctl(dev_t dev, int cmd, caddr_t addr, int flag, struct proc *p)
|
|
{
|
|
unsigned int dev_min = minor(dev) & 7;
|
|
int result = 0;
|
|
|
|
if (dev_min >= NBQU) {
|
|
DEB(printf("B004 ioctl exit, minor >= %d.\n", NBQU );)
|
|
return ENODEV;
|
|
}
|
|
|
|
if ((B004_F(dev_min) & B004_EXIST) == 0) {
|
|
DEB(printf("B004 ioctl exit, (B004_F & B004_EXIST) == 0.\n" );)
|
|
return ENODEV;
|
|
}
|
|
|
|
switch ( cmd ) {
|
|
case B004RESET: /* reset transputer */
|
|
bqureset(dev_min);
|
|
DEB(printf("B004 ioctl B004RESET, done\n" );)
|
|
break;
|
|
case B004WRITEABLE: /* can we write a byte to the C012 ? */
|
|
IOCTL_OUT (addr, ((in(B004_OSR(dev_min))&B004_WRITEBYTE) != 0 ));
|
|
break;
|
|
case B004READABLE: /* can we read a byte from C012 ? */
|
|
IOCTL_OUT (addr, ((in(B004_ISR(dev_min)) & B004_READBYTE) != 0 ));
|
|
break;
|
|
case B004ANALYSE: /* switch transputer to analyse mode */
|
|
bquanalyse(dev_min);
|
|
break;
|
|
case B004ERROR: /* test error-flag */
|
|
IOCTL_OUT (addr,
|
|
((inb(B004_BASE(dev_min)+B004_ERROR_OFFSET) &
|
|
B004_TEST_ERROR) ? 0 : 1));
|
|
break;
|
|
case B004TIMEOUT: /* set, retrieve timeout for writing & reading*/
|
|
B004_TIMEOUT(dev_min) = *((int *)addr);
|
|
break;
|
|
default: result = EINVAL;
|
|
}
|
|
return result;
|
|
} /* bquioctl() */
|
|
|
|
|
|
static inline void
|
|
bqu_registerdev(struct isa_device *id)
|
|
{
|
|
if(id->id_unit)
|
|
kdc_bqu[id->id_unit] = kdc_bqu[0];
|
|
kdc_bqu[id->id_unit].kdc_unit = id->id_unit;
|
|
kdc_bqu[id->id_unit].kdc_parentdata = id;
|
|
dev_attach(&kdc_bqu[id->id_unit]);
|
|
}
|
|
|
|
static int
|
|
bquattach(struct isa_device *idp)
|
|
{
|
|
kdc_bqu[idp->id_unit].kdc_state = DC_IDLE;
|
|
return 1;
|
|
}
|
|
|
|
/*
|
|
* int bquprobe
|
|
*
|
|
* Initializes the driver. It tries to detect the hardware
|
|
* and sets up all relevant data-structures.
|
|
*/
|
|
|
|
static int
|
|
bquprobe(struct isa_device *idp)
|
|
{
|
|
unsigned int test;
|
|
unsigned int dev_min = idp->id_unit;
|
|
int i,found = 0;
|
|
/* After a reset it should be possible to write a byte to
|
|
the B004. So let'S do a reset and then test the output status
|
|
register
|
|
*/
|
|
#ifdef undef
|
|
printf("bquprobe::\nIOBASE 0x%x\nIRQ %d\nDRQ %d\nMSIZE %d\nUNIT %d\nFLAGS x0%x\nALIVE %d\n",idp->id_iobase,idp->id_irq,idp->id_drq,idp->id_msize,idp->id_unit,idp->id_flags,idp->id_alive);
|
|
#endif
|
|
if(first_time){
|
|
for(i=0;i<NBQU;i++) B004_F(i) &= ~B004_EXIST;
|
|
first_time=0;
|
|
}
|
|
|
|
if(dev_min >= NBQU) return (0); /* No more descriptors */
|
|
if ((idp->id_iobase < 0x100) || (idp->id_iobase >= 0x1000))
|
|
idp->id_iobase=0; /* Dangerous isa addres ) */
|
|
#ifndef DEV_LKM
|
|
bqu_registerdev(idp);
|
|
#endif /* not DEV_LKM */
|
|
#ifdef JREMOD
|
|
bqu_devsw_install();
|
|
#endif /*JREMOD*/
|
|
|
|
|
|
for (test = 0; (test < B004_CHANCE); test++) {
|
|
if((idp->id_iobase==0)&&((!b004_base_addresses[test])||
|
|
detected(b004_base_addresses[test])))
|
|
continue;
|
|
idp->id_iobase=b004_base_addresses[test];
|
|
|
|
DEB(printf("Probing device %d at address 0x%x\n",dev_min,
|
|
idp->id_iobase);
|
|
)
|
|
b004_delay(test);
|
|
B004_F(dev_min) = 0;
|
|
B004_TIMEOUT(dev_min) = B004_INIT_TIMEOUT;
|
|
B004_BASE(dev_min) = idp->id_iobase;
|
|
B004_ODR(dev_min) = B004_BASE(dev_min) + B004_ODR_OFFSET;
|
|
B004_ISR(dev_min) = B004_BASE(dev_min) + B004_ISR_OFFSET;
|
|
B004_OSR(dev_min) = B004_BASE(dev_min) + B004_OSR_OFFSET;
|
|
bqureset(dev_min);
|
|
|
|
for (i = 0; i < B004_MAXTRY; i++)
|
|
if ( in(B004_OSR(dev_min)) == B004_WRITEBYTE) {
|
|
B004_F(dev_min) |= B004_EXIST;
|
|
out(B004_BASE(dev_min) + B008_INT_OFFSET, 0);
|
|
b004_delay(test);
|
|
if (in(B004_BASE(dev_min) + B008_INT_OFFSET) & 0x0f == 0)
|
|
B004_BOARDTYPE(dev_min) = B008;
|
|
else
|
|
B004_BOARDTYPE(dev_min) = B004;
|
|
printf("bqu%d at 0x0%x (polling) is a B00%s\n",
|
|
dev_min,B004_IDR(dev_min),
|
|
(B004_BOARDTYPE(dev_min) == B004) ? "4" : "8");
|
|
found = 1;
|
|
break;
|
|
}
|
|
if(!found) {
|
|
idp->id_iobase=0;
|
|
}
|
|
else break;
|
|
|
|
}
|
|
|
|
if (!found){
|
|
printf("b004probe(): no B004-board found.\n");
|
|
return (0);
|
|
}
|
|
|
|
idp->id_maddr=NULL;
|
|
idp->id_irq=0;
|
|
if(B004_BOARDTYPE(dev_min) == B004)
|
|
return(18);
|
|
else
|
|
return(20);
|
|
} /* bquprobe() */
|
|
|
|
#ifdef JREMOD
|
|
struct cdevsw bqu_cdevsw =
|
|
{ bquopen, bquclose, bquread, bquwrite, /*8*/
|
|
bquioctl, nostop, nullreset, nodevtotty,/* tputer */
|
|
bquselect, nommap, NULL };
|
|
|
|
static bqu_devsw_installed = 0;
|
|
|
|
static void bqu_devsw_install()
|
|
{
|
|
dev_t descript;
|
|
if( ! bqu_devsw_installed ) {
|
|
descript = makedev(CDEV_MAJOR,0);
|
|
cdevsw_add(&descript,&bqu_cdevsw,NULL);
|
|
#if defined(BDEV_MAJOR)
|
|
descript = makedev(BDEV_MAJOR,0);
|
|
bdevsw_add(&descript,&bqu_bdevsw,NULL);
|
|
#endif /*BDEV_MAJOR*/
|
|
bqu_devsw_installed = 1;
|
|
}
|
|
}
|
|
#endif /* JREMOD */
|
|
#endif /* NBQU */
|