int
floppyinit(void)
{
FDrive *dp;
FType *t;
ulong maxtsize;
int mask;
dmainit(DMAchan);
floppysetup0(&fl);
/*
* init dependent parameters
*/
maxtsize = 0;
for(t = floppytype; t < &floppytype[nelem(floppytype)]; t++) {
t->cap = t->bytes * t->heads * t->sectors * t->tracks;
t->bcode = b2c[t->bytes/128];
t->tsize = t->bytes * t->sectors;
if(maxtsize < t->tsize)
maxtsize = t->tsize;
}
fl.selected = fl.d;
floppydetach = _floppydetach;
floppydetach();
/*
* init drives
*/
mask = 0;
for(dp = fl.d; dp < &fl.d[fl.ndrive]; dp++) {
dp->dev = dp - fl.d;
if(dp->dt == Tnone)
continue;
mask |= 1<<dp->dev;
floppysetdef(dp);
dp->cyl = -1; /* because we don't know */
dp->cache = (uchar*)xspanalloc(maxtsize, BY2PG, 64*1024);
dp->ccyl = -1;
dp->vers = 0;
dp->maxtries = 5;
}
/*
* first operation will recalibrate
*/
fl.confused = 1;
floppysetup1(&fl);
/* to turn the motor off when inactive */
alarm(5*1000, floppyalarm, 0);
return mask;
}
static void
floppyreset(void)
{
FDrive *dp;
FType *t;
ulong maxtsize;
floppysetup0(&fl);
if(fl.ndrive == 0)
return;
/*
* init dependent parameters
*/
maxtsize = 0;
for(t = floppytype; t < &floppytype[nelem(floppytype)]; t++){
t->cap = t->bytes * t->heads * t->sectors * t->tracks;
t->bcode = b2c[t->bytes/128];
t->tsize = t->bytes * t->sectors;
if(maxtsize < t->tsize)
maxtsize = t->tsize;
}
/*
* Should check if this fails. Can do so
* if there is no space <= 16MB for the DMA
* bounce buffer.
*/
dmainit(DMAchan, maxtsize);
/*
* allocate the drive storage
*/
fl.d = xalloc(fl.ndrive*sizeof(FDrive));
fl.selected = fl.d;
/*
* stop the motors
*/
fl.motor = 0;
delay(10);
outb(Pdor, fl.motor | Fintena | Fena);
delay(10);
/*
* init drives
*/
for(dp = fl.d; dp < &fl.d[fl.ndrive]; dp++){
dp->dev = dp - fl.d;
dp->dt = T1440kb;
floppysetdef(dp);
dp->cyl = -1; /* because we don't know */
dp->cache = (uchar*)xspanalloc(maxtsize, BY2PG, 64*1024);
dp->ccyl = -1;
dp->vers = 0;
}
/*
* first operation will recalibrate
*/
fl.confused = 1;
floppysetup1(&fl);
}
