06a1e2ded2
on the net (I lost the mail). This should fix some units not showing up during probes.
1648 lines
46 KiB
C
1648 lines
46 KiB
C
/*
|
|
* Written by Julian Elischer (julian@dialix.oz.au)
|
|
* for TRW Financial Systems for use under the MACH(2.5) operating system.
|
|
*
|
|
* TRW Financial Systems, in accordance with their agreement with Carnegie
|
|
* Mellon University, makes this software available to CMU to distribute
|
|
* or use in any manner that they see fit as long as this message is kept with
|
|
* the software. For this reason TFS also grants any other persons or
|
|
* organisations permission to use or modify this software.
|
|
*
|
|
* TFS supplies this software to be publicly redistributed
|
|
* on the understanding that TFS is not responsible for the correct
|
|
* functioning of this software in any circumstances.
|
|
*
|
|
* Ported to run under 386BSD by Julian Elischer (julian@dialix.oz.au) Sept 1992
|
|
*
|
|
* $Id: sd.c,v 1.9 1993/09/20 06:27:04 rgrimes Exp $
|
|
*/
|
|
|
|
#define SPLSD splbio
|
|
#define ESUCCESS 0
|
|
#include <sd.h>
|
|
#include <sys/types.h>
|
|
#include <sys/param.h>
|
|
#include <sys/dkbad.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/conf.h>
|
|
#include <sys/file.h>
|
|
#include <sys/stat.h>
|
|
#include <sys/ioctl.h>
|
|
#include <sys/buf.h>
|
|
#include <sys/uio.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/errno.h>
|
|
#include <sys/disklabel.h>
|
|
#include <scsi/scsi_all.h>
|
|
#include <scsi/scsi_disk.h>
|
|
#include <scsi/scsiconf.h>
|
|
|
|
long int sdstrats,sdqueues;
|
|
|
|
|
|
#include <ddb.h>
|
|
#if NDDB > 0
|
|
int Debugger();
|
|
#else NDDB > 0
|
|
#define Debugger()
|
|
#endif NDDB > 0
|
|
|
|
|
|
#define PAGESIZ 4096
|
|
#define SECSIZE 512
|
|
#define PDLOCATION 29
|
|
#define BOOTRECORDSIGNATURE (0x55aa & 0x00ff)
|
|
#define SDOUTSTANDING 2
|
|
#define SDQSIZE 4
|
|
#define SD_RETRIES 4
|
|
|
|
#define MAKESDDEV(maj, unit, part) (makedev(maj,((unit<<3)+part)))
|
|
#define UNITSHIFT 3
|
|
#define PARTITION(z) (minor(z) & 0x07)
|
|
#define RAW_PART 3
|
|
#define UNIT(z) ( (minor(z) >> UNITSHIFT) )
|
|
|
|
#define WHOLE_DISK(unit) ( (unit << UNITSHIFT) + RAW_PART )
|
|
|
|
struct buf sd_buf_queue[NSD];
|
|
int sd_done();
|
|
int sdstrategy();
|
|
|
|
#ifdef SDDEBUG
|
|
int sd_debug = 0;
|
|
#endif /*SDDEBUG*/
|
|
|
|
struct scsi_xfer *sd_free_xfer[NSD];
|
|
int sd_xfer_block_wait[NSD];
|
|
|
|
struct sd_data
|
|
{
|
|
int flags;
|
|
#define SDVALID 0x02 /* PARAMS LOADED */
|
|
#define SDINIT 0x04 /* device has been init'd */
|
|
#define SDWAIT 0x08 /* device has someone waiting */
|
|
#define SDHAVELABEL 0x10 /* have read the label */
|
|
#define SDDOSPART 0x20 /* Have read the DOS partition table */
|
|
#define SDWRITEPROT 0x40 /* Device in readonly mode (S/W)*/
|
|
struct scsi_switch *sc_sw; /* address of scsi low level switch */
|
|
int ctlr; /* so they know which one we want */
|
|
int targ; /* our scsi target ID */
|
|
int lu; /* out scsi lu */
|
|
long int ad_info; /* info about the adapter */
|
|
int cmdscount; /* cmds allowed outstanding by board*/
|
|
int wlabel; /* label is writable */
|
|
struct disk_parms
|
|
{
|
|
u_char heads; /* Number of heads */
|
|
u_short cyls; /* Number of cylinders */
|
|
u_char sectors;/*dubious*/ /* Number of sectors/track */
|
|
u_short secsiz; /* Number of bytes/sector */
|
|
u_long disksize; /* total number sectors */
|
|
}params;
|
|
struct disklabel disklabel;
|
|
struct dos_partition dosparts[NDOSPART]; /* DOS view of disk */
|
|
int partflags[MAXPARTITIONS]; /* per partition flags */
|
|
#define SDOPEN 0x01
|
|
int openparts; /* one bit for each open partition */
|
|
unsigned int sd_start_of_unix; /* unix vs dos partitions */
|
|
}*sd_data[NSD];
|
|
|
|
|
|
static int next_sd_unit = 0;
|
|
/***********************************************************************\
|
|
* The routine called by the low level scsi routine when it discovers *
|
|
* A device suitable for this driver *
|
|
\***********************************************************************/
|
|
|
|
int sdattach(ctlr,targ,lu,scsi_switch)
|
|
struct scsi_switch *scsi_switch;
|
|
{
|
|
int unit,i;
|
|
unsigned char *tbl;
|
|
struct sd_data *sd;
|
|
struct disk_parms *dp;
|
|
long int ad_info;
|
|
struct scsi_xfer *sd_scsi_xfer;
|
|
|
|
unit = next_sd_unit++;
|
|
#ifdef SDDEBUG
|
|
if(scsi_debug & PRINTROUTINES) printf("sdattach: ");
|
|
#endif /*SDDEBUG*/
|
|
/*******************************************************\
|
|
* Check we have the resources for another drive *
|
|
\*******************************************************/
|
|
if( unit >= NSD)
|
|
{
|
|
printf("Too many scsi disks..(%d > %d) reconfigure kernel\n",(unit + 1),NSD);
|
|
return(0);
|
|
}
|
|
if(sd_data[unit])
|
|
{
|
|
printf("sd%d: unit already has storage allocated!\n",unit);
|
|
return(0);
|
|
}
|
|
sd = sd_data[unit] = malloc(sizeof(struct sd_data),M_DEVBUF,M_NOWAIT);
|
|
if(!sd)
|
|
{
|
|
printf("malloc failed in sd.c\n");
|
|
return(0);
|
|
}
|
|
bzero(sd,sizeof(struct sd_data));
|
|
|
|
dp = &(sd->params);
|
|
/*******************************************************\
|
|
* Store information needed to contact our base driver *
|
|
\*******************************************************/
|
|
sd->sc_sw = scsi_switch;
|
|
sd->ctlr = ctlr;
|
|
sd->targ = targ;
|
|
sd->lu = lu;
|
|
if(sd->sc_sw->adapter_info)
|
|
{
|
|
sd->ad_info = ( (*(sd->sc_sw->adapter_info))(ctlr));
|
|
sd->cmdscount = sd->ad_info & AD_INF_MAX_CMDS;
|
|
if(sd->cmdscount > SDOUTSTANDING)
|
|
{
|
|
sd->cmdscount = SDOUTSTANDING;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
sd->ad_info = 1;
|
|
sd->cmdscount = 1;
|
|
}
|
|
|
|
i = sd->cmdscount;
|
|
sd_scsi_xfer = (struct scsi_xfer *)malloc(sizeof(struct scsi_xfer) * i
|
|
,M_TEMP, M_NOWAIT);
|
|
while(i-- )
|
|
{
|
|
sd_scsi_xfer->next = sd_free_xfer[unit];
|
|
sd_free_xfer[unit] = sd_scsi_xfer;
|
|
sd_scsi_xfer++;
|
|
}
|
|
/*******************************************************\
|
|
* Use the subdriver to request information regarding *
|
|
* the drive. We cannot use interrupts yet, so the *
|
|
* request must specify this. *
|
|
\*******************************************************/
|
|
sd_get_parms(unit, SCSI_NOSLEEP | SCSI_NOMASK);
|
|
printf("sd%d: %dMB (%d total sec), %d cyl, %d head, %d sec, bytes/sec %d\n",
|
|
unit,
|
|
dp->disksize / ((1024L * 1024L) / dp->secsiz),
|
|
dp->disksize,
|
|
dp->cyls,
|
|
dp->heads,
|
|
dp->sectors,
|
|
dp->secsiz);
|
|
sd->flags |= SDINIT;
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*******************************************************\
|
|
* open the device. Make sure the partition info *
|
|
* is a up-to-date as can be. *
|
|
\*******************************************************/
|
|
sdopen(dev)
|
|
{
|
|
int errcode = 0;
|
|
int unit, part;
|
|
struct disk_parms disk_parms;
|
|
struct sd_data *sd ;
|
|
|
|
unit = UNIT(dev);
|
|
part = PARTITION(dev);
|
|
sd = sd_data[unit];
|
|
#ifdef SDDEBUG
|
|
if(scsi_debug & (PRINTROUTINES | TRACEOPENS))
|
|
printf("sdopen: dev=0x%x (unit %d (of %d),partition %d)\n"
|
|
, dev, unit, NSD, part);
|
|
#endif /*SDDEBUG*/
|
|
/*******************************************************\
|
|
* Check the unit is legal *
|
|
\*******************************************************/
|
|
if ( unit >= NSD )
|
|
{
|
|
return(ENXIO);
|
|
}
|
|
/*******************************************************\
|
|
* Make sure the disk has been initialised *
|
|
* At some point in the future, get the scsi driver *
|
|
* to look for a new device if we are not initted *
|
|
\*******************************************************/
|
|
if (! (sd->flags & SDINIT))
|
|
{
|
|
return(ENXIO);
|
|
}
|
|
|
|
/*******************************************************\
|
|
* If it's been invalidated, and not everybody has *
|
|
* closed it then forbid re-entry. *
|
|
\*******************************************************/
|
|
if ((! (sd->flags & SDVALID))
|
|
&& ( sd->openparts))
|
|
return(ENXIO);
|
|
/*******************************************************\
|
|
* "unit attention" errors should occur here if the *
|
|
* drive has been restarted or the pack changed. *
|
|
* just ingnore the result, it's a decoy instruction *
|
|
* The error code will act on the error though *
|
|
* and invalidate any media information we had. *
|
|
\*******************************************************/
|
|
sd_test_unit_ready(unit,0);
|
|
|
|
/*******************************************************\
|
|
* In case it is a funny one, tell it to start *
|
|
* not needed for most hard drives (ignore failure) *
|
|
\*******************************************************/
|
|
sd_start_unit(unit,SCSI_ERR_OK|SCSI_SILENT);
|
|
|
|
/*******************************************************\
|
|
* Check that it is still responding and ok. *
|
|
\*******************************************************/
|
|
if (sd_test_unit_ready(unit,0))
|
|
{
|
|
#ifdef SDDEBUG
|
|
if(scsi_debug & TRACEOPENS) printf("device not reponding\n");
|
|
#endif /*SDDEBUG*/
|
|
return(ENXIO);
|
|
}
|
|
#ifdef SDDEBUG
|
|
if(scsi_debug & TRACEOPENS)
|
|
printf("device ok\n");
|
|
#endif /*SDDEBUG*/
|
|
|
|
/*******************************************************\
|
|
* Load the physical device parameters *
|
|
\*******************************************************/
|
|
sd_get_parms(unit, 0); /* sets SDVALID */
|
|
if (sd->params.secsiz != SECSIZE) /* XXX One day...*/
|
|
{
|
|
printf("sd%d: Can't deal with %d bytes logical blocks\n"
|
|
,unit, sd->params.secsiz);
|
|
Debugger();
|
|
return(ENXIO);
|
|
}
|
|
#ifdef SDDEBUG
|
|
if(scsi_debug & TRACEOPENS)
|
|
printf("Params loaded ");
|
|
#endif /*SDDEBUG*/
|
|
/*******************************************************\
|
|
* Load the partition info if not already loaded *
|
|
* Lock the pack in *
|
|
\*******************************************************/
|
|
sd_prevent(unit,PR_PREVENT,SCSI_ERR_OK|SCSI_SILENT);
|
|
if((errcode = sdgetdisklabel(unit)) && (part != RAW_PART))
|
|
{
|
|
sd_prevent(unit,PR_ALLOW,SCSI_ERR_OK|SCSI_SILENT);
|
|
return(errcode);
|
|
}
|
|
#ifdef SDDEBUG
|
|
if(scsi_debug & TRACEOPENS)
|
|
printf("Disklabel loaded ");
|
|
#endif /*SDDEBUG*/
|
|
/*******************************************************\
|
|
* Check the partition is legal *
|
|
\*******************************************************/
|
|
if ( part >= MAXPARTITIONS ) {
|
|
sd_prevent(unit,PR_ALLOW,SCSI_ERR_OK|SCSI_SILENT); /* who cares if it fails? */
|
|
return(ENXIO);
|
|
}
|
|
#ifdef SDDEBUG
|
|
if(scsi_debug & TRACEOPENS)
|
|
printf("ok");
|
|
#endif /*SDDEBUG*/
|
|
/*******************************************************\
|
|
* Check that the partition exists *
|
|
\*******************************************************/
|
|
if (( sd->disklabel.d_partitions[part].p_size == 0 )
|
|
&& (part != RAW_PART))
|
|
{
|
|
sd_prevent(unit,PR_ALLOW,SCSI_ERR_OK|SCSI_SILENT); /* who cares if it fails? */
|
|
return(ENXIO);
|
|
}
|
|
sd->partflags[part] |= SDOPEN;
|
|
sd->openparts |= (1 << part);
|
|
#ifdef SDDEBUG
|
|
if(scsi_debug & TRACEOPENS)
|
|
printf("open %d %d\n",sdstrats,sdqueues);
|
|
#endif /*SDDEBUG*/
|
|
return(0);
|
|
}
|
|
|
|
/*******************************************************\
|
|
* Get ownership of a scsi_xfer *
|
|
* If need be, sleep on it, until it comes free *
|
|
\*******************************************************/
|
|
struct scsi_xfer *sd_get_xs(unit,flags)
|
|
int flags;
|
|
int unit;
|
|
{
|
|
struct scsi_xfer *xs;
|
|
int s;
|
|
|
|
if(flags & (SCSI_NOSLEEP | SCSI_NOMASK))
|
|
{
|
|
if (xs = sd_free_xfer[unit])
|
|
{
|
|
sd_free_xfer[unit] = xs->next;
|
|
xs->flags = 0;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
s = SPLSD();
|
|
while (!(xs = sd_free_xfer[unit]))
|
|
{
|
|
sd_xfer_block_wait[unit]++; /* someone waiting! */
|
|
sleep((caddr_t)&sd_free_xfer[unit], PRIBIO+1);
|
|
sd_xfer_block_wait[unit]--;
|
|
}
|
|
sd_free_xfer[unit] = xs->next;
|
|
splx(s);
|
|
xs->flags = 0;
|
|
}
|
|
return(xs);
|
|
}
|
|
|
|
/*******************************************************\
|
|
* Free a scsi_xfer, wake processes waiting for it *
|
|
\*******************************************************/
|
|
sd_free_xs(unit,xs,flags)
|
|
struct scsi_xfer *xs;
|
|
int unit;
|
|
int flags;
|
|
{
|
|
int s;
|
|
|
|
if(flags & SCSI_NOMASK)
|
|
{
|
|
if (sd_xfer_block_wait[unit])
|
|
{
|
|
printf("doing a wakeup from NOMASK mode\n");
|
|
wakeup((caddr_t)&sd_free_xfer[unit]);
|
|
}
|
|
xs->next = sd_free_xfer[unit];
|
|
sd_free_xfer[unit] = xs;
|
|
}
|
|
else
|
|
{
|
|
s = SPLSD();
|
|
if (sd_xfer_block_wait[unit])
|
|
wakeup((caddr_t)&sd_free_xfer[unit]);
|
|
xs->next = sd_free_xfer[unit];
|
|
sd_free_xfer[unit] = xs;
|
|
splx(s);
|
|
}
|
|
}
|
|
|
|
/*******************************************************\
|
|
* trim the size of the transfer if needed, *
|
|
* called by physio *
|
|
* basically the smaller of our max and the scsi driver's*
|
|
* minphys (note we have no max) *
|
|
\*******************************************************/
|
|
/* Trim buffer length if buffer-size is bigger than page size */
|
|
void sdminphys(bp)
|
|
struct buf *bp;
|
|
{
|
|
(*(sd_data[UNIT(bp->b_dev)]->sc_sw->scsi_minphys))(bp);
|
|
}
|
|
|
|
/*******************************************************\
|
|
* Actually translate the requested transfer into *
|
|
* one the physical driver can understand *
|
|
* The transfer is described by a buf and will include *
|
|
* only one physical transfer. *
|
|
\*******************************************************/
|
|
|
|
int sdstrategy(bp)
|
|
struct buf *bp;
|
|
{
|
|
struct buf *dp;
|
|
unsigned int opri;
|
|
struct sd_data *sd ;
|
|
int unit;
|
|
|
|
sdstrats++;
|
|
unit = UNIT((bp->b_dev));
|
|
sd = sd_data[unit];
|
|
#ifdef SDDEBUG
|
|
if(scsi_debug & PRINTROUTINES) printf("\nsdstrategy ");
|
|
if(scsi_debug & SHOWREQUESTS) printf("sd%d: %d bytes @ blk%d\n",
|
|
unit,bp->b_bcount,bp->b_blkno);
|
|
#endif /*SDDEBUG*/
|
|
sdminphys(bp);
|
|
/*******************************************************\
|
|
* If the device has been made invalid, error out *
|
|
\*******************************************************/
|
|
if(!(sd->flags & SDVALID))
|
|
{
|
|
bp->b_error = EIO;
|
|
goto bad;
|
|
}
|
|
/*******************************************************\
|
|
* "soft" write protect check *
|
|
\*******************************************************/
|
|
if ((sd->flags & SDWRITEPROT) && (bp->b_flags & B_READ) == 0) {
|
|
bp->b_error = EROFS;
|
|
goto bad;
|
|
}
|
|
/*******************************************************\
|
|
* If it's a null transfer, return immediatly *
|
|
\*******************************************************/
|
|
if (bp->b_bcount == 0)
|
|
{
|
|
goto done;
|
|
}
|
|
|
|
/*******************************************************\
|
|
* Decide which unit and partition we are talking about *
|
|
* only raw is ok if no label *
|
|
\*******************************************************/
|
|
if(PARTITION(bp->b_dev) != RAW_PART)
|
|
{
|
|
if (!(sd->flags & SDHAVELABEL))
|
|
{
|
|
bp->b_error = EIO;
|
|
goto bad;
|
|
}
|
|
|
|
/*
|
|
* do bounds checking, adjust transfer. if error, process.
|
|
* if end of partition, just return
|
|
*/
|
|
if (bounds_check_with_label(bp,&sd->disklabel,sd->wlabel) <= 0)
|
|
goto done;
|
|
/* otherwise, process transfer request */
|
|
}
|
|
|
|
opri = SPLSD();
|
|
dp = &sd_buf_queue[unit];
|
|
|
|
/*******************************************************\
|
|
* Place it in the queue of disk activities for this disk*
|
|
\*******************************************************/
|
|
disksort(dp, bp);
|
|
|
|
/*******************************************************\
|
|
* Tell the device to get going on the transfer if it's *
|
|
* not doing anything, otherwise just wait for completion*
|
|
\*******************************************************/
|
|
sdstart(unit);
|
|
|
|
splx(opri);
|
|
return;
|
|
bad:
|
|
bp->b_flags |= B_ERROR;
|
|
done:
|
|
|
|
/*******************************************************\
|
|
* Correctly set the buf to indicate a completed xfer *
|
|
\*******************************************************/
|
|
bp->b_resid = bp->b_bcount;
|
|
biodone(bp);
|
|
return;
|
|
}
|
|
|
|
/***************************************************************\
|
|
* sdstart looks to see if there is a buf waiting for the device *
|
|
* and that the device is not already busy. If both are true, *
|
|
* It dequeues the buf and creates a scsi command to perform the *
|
|
* transfer in the buf. The transfer request will call sd_done *
|
|
* on completion, which will in turn call this routine again *
|
|
* so that the next queued transfer is performed. *
|
|
* The bufs are queued by the strategy routine (sdstrategy) *
|
|
* *
|
|
* This routine is also called after other non-queued requests *
|
|
* have been made of the scsi driver, to ensure that the queue *
|
|
* continues to be drained. *
|
|
* *
|
|
* must be called at the correct (highish) spl level *
|
|
\***************************************************************/
|
|
/* sdstart() is called at SPLSD from sdstrategy and sd_done*/
|
|
sdstart(unit)
|
|
int unit;
|
|
{
|
|
int drivecount;
|
|
register struct buf *bp = 0;
|
|
register struct buf *dp;
|
|
struct scsi_xfer *xs;
|
|
struct scsi_rw_big cmd;
|
|
int blkno, nblk;
|
|
struct sd_data *sd = sd_data[unit];
|
|
struct partition *p ;
|
|
|
|
#ifdef SDDEBUG
|
|
if(scsi_debug & PRINTROUTINES) printf("sdstart%d ",unit);
|
|
#endif /*SDDEBUG*/
|
|
/*******************************************************\
|
|
* Check if the device is already running full capacity *
|
|
\*******************************************************/
|
|
if(!sd_free_xfer[unit])
|
|
{
|
|
return; /* none for us, unit already underway */
|
|
}
|
|
|
|
/*******************************************************\
|
|
* there is excess capacity, but a special waits *
|
|
* It'll need the adapter as soon as we clear out of the *
|
|
* way and let it run (user level wait). *
|
|
\*******************************************************/
|
|
if(sd_xfer_block_wait[unit])
|
|
{
|
|
return;
|
|
}
|
|
|
|
/*******************************************************\
|
|
* See if there is a buf with work for us to do.. *
|
|
\*******************************************************/
|
|
dp = &sd_buf_queue[unit];
|
|
if ((bp = dp->b_actf) == NULL) /* yes, an assign */
|
|
{
|
|
return;
|
|
}
|
|
|
|
dp->b_actf = bp->av_forw;
|
|
|
|
/*******************************************************\
|
|
* If the device has become invalid, abort all the *
|
|
* reads and writes until all files have been closed and *
|
|
* re-openned *
|
|
\*******************************************************/
|
|
if(!(sd->flags & SDVALID))
|
|
{
|
|
goto bad;
|
|
}
|
|
/*******************************************************\
|
|
* We have a buf, now we know we are going to go through *
|
|
* With this thing.. *
|
|
* *
|
|
* First, translate the block to absolute *
|
|
\*******************************************************/
|
|
p = sd->disklabel.d_partitions + PARTITION(bp->b_dev);
|
|
blkno = bp->b_blkno + p->p_offset;
|
|
nblk = (bp->b_bcount + 511) >> 9;
|
|
|
|
/*******************************************************\
|
|
* Fill out the scsi command *
|
|
\*******************************************************/
|
|
bzero(&cmd, sizeof(cmd));
|
|
cmd.op_code = (bp->b_flags & B_READ)
|
|
? READ_BIG : WRITE_BIG;
|
|
cmd.addr_3 = (blkno & 0xff000000) >> 24;
|
|
cmd.addr_2 = (blkno & 0xff0000) >> 16;
|
|
cmd.addr_1 = (blkno & 0xff00) >> 8;
|
|
cmd.addr_0 = blkno & 0xff;
|
|
cmd.length2 = (nblk & 0xff00) >> 8;
|
|
cmd.length1 = (nblk & 0xff);
|
|
/*******************************************************\
|
|
* Call the routine that chats with the adapter *
|
|
* Note: we cannot sleep as we may be an interrupt *
|
|
\*******************************************************/
|
|
if (sd_scsi_cmd(unit,
|
|
&cmd,
|
|
sizeof(cmd),
|
|
(u_char *)bp->b_un.b_addr,
|
|
bp->b_bcount,
|
|
10000,
|
|
bp,
|
|
SCSI_NOSLEEP| ((bp->b_flags & B_READ)?
|
|
SCSI_DATA_IN : SCSI_DATA_OUT))
|
|
!= SUCCESSFULLY_QUEUED)
|
|
{
|
|
bad:
|
|
printf("sd%d: oops not queued",unit);
|
|
bp->b_error = EIO;
|
|
bp->b_flags |= B_ERROR;
|
|
biodone(bp);
|
|
return ;
|
|
}
|
|
sdqueues++;
|
|
}
|
|
|
|
/*******************************************************\
|
|
* Perform special action on behalf of the user *
|
|
* Knows about the internals of this device *
|
|
\*******************************************************/
|
|
sdioctl(dev_t dev, int cmd, caddr_t addr, int flag)
|
|
{
|
|
/* struct sd_cmd_buf *args;*/
|
|
int error = 0;
|
|
unsigned int opri;
|
|
unsigned char unit, part;
|
|
register struct sd_data *sd;
|
|
|
|
|
|
/*******************************************************\
|
|
* Find the device that the user is talking about *
|
|
\*******************************************************/
|
|
unit = UNIT(dev);
|
|
part = PARTITION(dev);
|
|
sd = sd_data[unit];
|
|
#ifdef SDDEBUG
|
|
if(scsi_debug & PRINTROUTINES) printf("sdioctl%d ",unit);
|
|
#endif /*SDDEBUG*/
|
|
|
|
/*******************************************************\
|
|
* If the device is not valid.. abandon ship *
|
|
\*******************************************************/
|
|
if (!(sd->flags & SDVALID))
|
|
return(EIO);
|
|
switch(cmd)
|
|
{
|
|
|
|
case DIOCSBAD:
|
|
error = EINVAL;
|
|
break;
|
|
|
|
case DIOCGDINFO:
|
|
*(struct disklabel *)addr = sd->disklabel;
|
|
break;
|
|
|
|
case DIOCGPART:
|
|
((struct partinfo *)addr)->disklab = &sd->disklabel;
|
|
((struct partinfo *)addr)->part =
|
|
&sd->disklabel.d_partitions[PARTITION(dev)];
|
|
break;
|
|
|
|
case DIOCSDINFO:
|
|
if ((flag & FWRITE) == 0)
|
|
error = EBADF;
|
|
else
|
|
error = setdisklabel(&sd->disklabel,
|
|
(struct disklabel *)addr,
|
|
/*(sd->flags & DKFL_BSDLABEL) ? sd->openparts : */0,
|
|
sd->dosparts);
|
|
if (error == 0) {
|
|
sd->flags |= SDHAVELABEL;
|
|
}
|
|
break;
|
|
|
|
case DIOCWLABEL:
|
|
sd->flags &= ~SDWRITEPROT;
|
|
if ((flag & FWRITE) == 0)
|
|
error = EBADF;
|
|
else
|
|
sd->wlabel = *(int *)addr;
|
|
break;
|
|
|
|
case DIOCWDINFO:
|
|
sd->flags &= ~SDWRITEPROT;
|
|
if ((flag & FWRITE) == 0)
|
|
error = EBADF;
|
|
else
|
|
{
|
|
if ((error = setdisklabel(&sd->disklabel
|
|
, (struct disklabel *)addr
|
|
, /*(sd->flags & SDHAVELABEL) ? sd->openparts :*/ 0
|
|
, sd->dosparts)) == 0)
|
|
{
|
|
int wlab;
|
|
|
|
sd->flags |= SDHAVELABEL; /* ok write will succeed */
|
|
|
|
/* simulate opening partition 0 so write succeeds */
|
|
sd->openparts |= (1 << 0); /* XXX */
|
|
wlab = sd->wlabel;
|
|
sd->wlabel = 1;
|
|
error = writedisklabel(dev, sdstrategy,
|
|
&sd->disklabel, sd->dosparts);
|
|
sd->wlabel = wlab;
|
|
}
|
|
}
|
|
break;
|
|
|
|
|
|
default:
|
|
error = ENOTTY;
|
|
break;
|
|
}
|
|
return (error);
|
|
}
|
|
|
|
|
|
/*******************************************************\
|
|
* Load the label information on the named device *
|
|
\*******************************************************/
|
|
int sdgetdisklabel(unit)
|
|
unsigned char unit;
|
|
{
|
|
/*unsigned int n, m;*/
|
|
char *errstring;
|
|
struct dos_partition *dos_partition_p;
|
|
struct sd_data *sd = sd_data[unit];
|
|
|
|
/*******************************************************\
|
|
* If the inflo is already loaded, use it *
|
|
\*******************************************************/
|
|
if(sd->flags & SDHAVELABEL) return(ESUCCESS);
|
|
|
|
bzero(&sd->disklabel,sizeof(struct disklabel));
|
|
/*******************************************************\
|
|
* make partition 3 the whole disk in case of failure *
|
|
* then get pdinfo *
|
|
* for historical reasons, make part a same as raw part *
|
|
\*******************************************************/
|
|
sd->disklabel.d_partitions[0].p_offset = 0;
|
|
sd->disklabel.d_partitions[0].p_size = sd->params.disksize;
|
|
sd->disklabel.d_partitions[RAW_PART].p_offset = 0;
|
|
sd->disklabel.d_partitions[RAW_PART].p_size = sd->params.disksize;
|
|
sd->disklabel.d_npartitions = MAXPARTITIONS;
|
|
sd->disklabel.d_secsize = 512; /* as long as it's not 0 */
|
|
sd->disklabel.d_ntracks = sd->params.heads;
|
|
sd->disklabel.d_nsectors = sd->params.sectors;
|
|
sd->disklabel.d_ncylinders = sd->params.cyls;
|
|
sd->disklabel.d_secpercyl = sd->params.heads * sd->params.sectors;
|
|
if (sd->disklabel.d_secpercyl == 0)
|
|
{
|
|
sd->disklabel.d_secpercyl = 100;
|
|
/* as long as it's not 0 */
|
|
/* readdisklabel divides by it (?)*/
|
|
}
|
|
|
|
/*******************************************************\
|
|
* Call the generic disklabel extraction routine *
|
|
\*******************************************************/
|
|
if(errstring = readdisklabel(makedev(0 ,(unit<<UNITSHIFT )+3)
|
|
, sdstrategy
|
|
, &sd->disklabel
|
|
, sd->dosparts
|
|
, 0
|
|
, 0))
|
|
{
|
|
printf("sd%d: %s\n",unit, errstring);
|
|
return(ENXIO);
|
|
}
|
|
|
|
sd->flags |= SDHAVELABEL; /* WE HAVE IT ALL NOW */
|
|
return(ESUCCESS);
|
|
}
|
|
|
|
/*******************************************************\
|
|
* Find out from the device what it's capacity is *
|
|
\*******************************************************/
|
|
sd_size(unit, flags)
|
|
{
|
|
struct scsi_read_cap_data rdcap;
|
|
struct scsi_read_capacity scsi_cmd;
|
|
int size;
|
|
|
|
/*******************************************************\
|
|
* make up a scsi command and ask the scsi driver to do *
|
|
* it for you. *
|
|
\*******************************************************/
|
|
bzero(&scsi_cmd, sizeof(scsi_cmd));
|
|
scsi_cmd.op_code = READ_CAPACITY;
|
|
|
|
/*******************************************************\
|
|
* If the command works, interpret the result as a 4 byte*
|
|
* number of blocks *
|
|
\*******************************************************/
|
|
if (sd_scsi_cmd(unit,
|
|
&scsi_cmd,
|
|
sizeof(scsi_cmd),
|
|
&rdcap,
|
|
sizeof(rdcap),
|
|
6000,
|
|
NULL,
|
|
flags | SCSI_DATA_IN) != 0)
|
|
{
|
|
printf("sd%d: could not get size\n", unit);
|
|
return(0);
|
|
} else {
|
|
size = rdcap.addr_0 + 1 ;
|
|
size += rdcap.addr_1 << 8;
|
|
size += rdcap.addr_2 << 16;
|
|
size += rdcap.addr_3 << 24;
|
|
}
|
|
return(size);
|
|
}
|
|
|
|
/*******************************************************\
|
|
* Get scsi driver to send a "are you ready?" command *
|
|
\*******************************************************/
|
|
sd_test_unit_ready(unit,flags)
|
|
int unit,flags;
|
|
{
|
|
struct scsi_test_unit_ready scsi_cmd;
|
|
|
|
bzero(&scsi_cmd, sizeof(scsi_cmd));
|
|
scsi_cmd.op_code = TEST_UNIT_READY;
|
|
|
|
return (sd_scsi_cmd(unit,
|
|
&scsi_cmd,
|
|
sizeof(scsi_cmd),
|
|
0,
|
|
0,
|
|
100000,
|
|
NULL,
|
|
flags));
|
|
}
|
|
|
|
/*******************************************************\
|
|
* Prevent or allow the user to remove the tape *
|
|
* Don't change this status if any partitions are open *
|
|
\*******************************************************/
|
|
sd_prevent(unit,type,flags)
|
|
int unit,type,flags;
|
|
{
|
|
struct scsi_prevent scsi_cmd;
|
|
|
|
if(sd_data[unit]->openparts) return;
|
|
|
|
bzero(&scsi_cmd, sizeof(scsi_cmd));
|
|
scsi_cmd.op_code = PREVENT_ALLOW;
|
|
scsi_cmd.how=type;
|
|
return (sd_scsi_cmd(unit,
|
|
&scsi_cmd,
|
|
sizeof(scsi_cmd),
|
|
0,
|
|
0,
|
|
5000,
|
|
NULL,
|
|
flags) );
|
|
}
|
|
/*******************************************************\
|
|
* Get scsi driver to send a "start up" command *
|
|
\*******************************************************/
|
|
sd_start_unit(unit,flags)
|
|
int unit,flags;
|
|
{
|
|
struct scsi_start_stop scsi_cmd;
|
|
|
|
bzero(&scsi_cmd, sizeof(scsi_cmd));
|
|
scsi_cmd.op_code = START_STOP;
|
|
scsi_cmd.how = SSS_START;
|
|
|
|
return (sd_scsi_cmd(unit,
|
|
&scsi_cmd,
|
|
sizeof(scsi_cmd),
|
|
0,
|
|
0,
|
|
2000,
|
|
NULL,
|
|
flags));
|
|
}
|
|
|
|
/*******************************************************\
|
|
* Tell the device to map out a defective block *
|
|
\*******************************************************/
|
|
sd_reassign_blocks(unit,block)
|
|
{
|
|
struct scsi_reassign_blocks scsi_cmd;
|
|
struct scsi_reassign_blocks_data rbdata;
|
|
|
|
|
|
bzero(&scsi_cmd, sizeof(scsi_cmd));
|
|
bzero(&rbdata, sizeof(rbdata));
|
|
scsi_cmd.op_code = REASSIGN_BLOCKS;
|
|
|
|
rbdata.length_msb = 0;
|
|
rbdata.length_lsb = sizeof(rbdata.defect_descriptor[0]);
|
|
rbdata.defect_descriptor[0].dlbaddr_3 = ((block >> 24) & 0xff);
|
|
rbdata.defect_descriptor[0].dlbaddr_2 = ((block >> 16) & 0xff);
|
|
rbdata.defect_descriptor[0].dlbaddr_1 = ((block >> 8) & 0xff);
|
|
rbdata.defect_descriptor[0].dlbaddr_0 = ((block ) & 0xff);
|
|
|
|
return(sd_scsi_cmd(unit,
|
|
&scsi_cmd,
|
|
sizeof(scsi_cmd),
|
|
&rbdata,
|
|
sizeof(rbdata),
|
|
5000,
|
|
NULL,
|
|
SCSI_DATA_OUT));
|
|
}
|
|
|
|
#define b2tol(a) (((unsigned)(a##_1) << 8) + (unsigned)a##_0 )
|
|
|
|
/*******************************************************\
|
|
* Get the scsi driver to send a full inquiry to the *
|
|
* device and use the results to fill out the disk *
|
|
* parameter structure. *
|
|
\*******************************************************/
|
|
|
|
int sd_get_parms(unit, flags)
|
|
{
|
|
struct sd_data *sd = sd_data[unit];
|
|
struct disk_parms *disk_parms = &sd->params;
|
|
struct scsi_mode_sense scsi_cmd;
|
|
struct scsi_mode_sense_data
|
|
{
|
|
struct scsi_mode_header header;
|
|
struct blk_desc blk_desc;
|
|
union disk_pages pages;
|
|
}scsi_sense;
|
|
int sectors;
|
|
|
|
/*******************************************************\
|
|
* First check if we have it all loaded *
|
|
\*******************************************************/
|
|
if(sd->flags & SDVALID) return(0);
|
|
/*******************************************************\
|
|
* First do a mode sense page 3 *
|
|
\*******************************************************/
|
|
#ifdef SDDEBUG
|
|
if (sd_debug)
|
|
{
|
|
bzero(&scsi_cmd, sizeof(scsi_cmd));
|
|
scsi_cmd.op_code = MODE_SENSE;
|
|
scsi_cmd.page = 3;
|
|
scsi_cmd.length = 0x24;
|
|
/*******************************************************\
|
|
* do the command, but we don't need the results *
|
|
* just print them for our interest's sake *
|
|
\*******************************************************/
|
|
if (sd_scsi_cmd(unit,
|
|
&scsi_cmd,
|
|
sizeof(scsi_cmd),
|
|
&scsi_sense,
|
|
sizeof(scsi_sense),
|
|
2000,
|
|
NULL,
|
|
flags | SCSI_DATA_IN) != 0)
|
|
{
|
|
printf("sd%d: could not mode sense (3)\n", unit);
|
|
}
|
|
else
|
|
{
|
|
printf("unit %d: %d trk/zone, %d alt_sec/zone, %d alt_trk/zone, %d alt_trk/lun\n",
|
|
unit,
|
|
b2tol(scsi_sense.pages.disk_format.trk_z),
|
|
b2tol(scsi_sense.pages.disk_format.alt_sec),
|
|
b2tol(scsi_sense.pages.disk_format.alt_trk_z),
|
|
b2tol(scsi_sense.pages.disk_format.alt_trk_v));
|
|
printf(" %d sec/trk, %d bytes/sec, %d interleave, %d %d bytes/log_blk\n",
|
|
b2tol(scsi_sense.pages.disk_format.ph_sec_t),
|
|
b2tol(scsi_sense.pages.disk_format.bytes_s),
|
|
b2tol(scsi_sense.pages.disk_format.interleave),
|
|
sd_size(unit, flags),
|
|
_3btol(scsi_sense.blk_desc.blklen));
|
|
}
|
|
}
|
|
#endif /*SDDEBUG*/
|
|
|
|
|
|
/*******************************************************\
|
|
* do a "mode sense page 4" *
|
|
\*******************************************************/
|
|
bzero(&scsi_cmd, sizeof(scsi_cmd));
|
|
scsi_cmd.op_code = MODE_SENSE;
|
|
scsi_cmd.page = 4;
|
|
scsi_cmd.length = 0x20;
|
|
/*******************************************************\
|
|
* If the command worked, use the results to fill out *
|
|
* the parameter structure *
|
|
\*******************************************************/
|
|
if (sd_scsi_cmd(unit,
|
|
&scsi_cmd,
|
|
sizeof(scsi_cmd),
|
|
&scsi_sense,
|
|
sizeof(scsi_sense),
|
|
2000,
|
|
NULL,
|
|
flags | SCSI_DATA_IN) != 0)
|
|
{
|
|
printf("sd%d could not mode sense (4).", unit);
|
|
printf(" Using ficticious geometry\n");
|
|
/*
|
|
* use adaptec standard ficticious geometry
|
|
* this depends on which controller (e.g. 1542C is
|
|
* different. but we have to put SOMETHING here..)
|
|
*/
|
|
sectors = sd_size(unit, flags);
|
|
disk_parms->heads = 64;
|
|
disk_parms->sectors = 32;
|
|
disk_parms->cyls = sectors/(64 * 32);
|
|
disk_parms->secsiz = SECSIZE;
|
|
disk_parms->disksize = sectors;
|
|
}
|
|
else
|
|
{
|
|
|
|
#ifdef SDDEBUG
|
|
if (sd_debug)
|
|
{
|
|
printf(" %d cyls, %d heads, %d precomp, %d red_write, %d land_zone\n",
|
|
_3btol(&scsi_sense.pages.rigid_geometry.ncyl_2),
|
|
scsi_sense.pages.rigid_geometry.nheads,
|
|
b2tol(scsi_sense.pages.rigid_geometry.st_cyl_wp),
|
|
b2tol(scsi_sense.pages.rigid_geometry.st_cyl_rwc),
|
|
b2tol(scsi_sense.pages.rigid_geometry.land_zone));
|
|
}
|
|
#endif /*SDDEBUG*/
|
|
|
|
/*******************************************************\
|
|
* KLUDGE!!(for zone recorded disks) *
|
|
* give a number of sectors so that sec * trks * cyls *
|
|
* is <= disk_size *
|
|
* can lead to wasted space! THINK ABOUT THIS ! *
|
|
\*******************************************************/
|
|
disk_parms->heads = scsi_sense.pages.rigid_geometry.nheads;
|
|
disk_parms->cyls = _3btol(&scsi_sense.pages.rigid_geometry.ncyl_2);
|
|
disk_parms->secsiz = _3btol(&scsi_sense.blk_desc.blklen);
|
|
|
|
sectors = sd_size(unit, flags);
|
|
disk_parms->disksize = sectors;
|
|
sectors /= (disk_parms->heads * disk_parms->cyls);
|
|
disk_parms->sectors = sectors; /* dubious on SCSI*//*XXX*/
|
|
}
|
|
|
|
sd->flags |= SDVALID;
|
|
return(0);
|
|
}
|
|
|
|
/*******************************************************\
|
|
* close the device.. only called if we are the LAST *
|
|
* occurence of an open device *
|
|
* convenient now but usually a pain *
|
|
\*******************************************************/
|
|
sdclose(dev)
|
|
dev_t dev;
|
|
{
|
|
unsigned char unit, part;
|
|
unsigned int old_priority;
|
|
struct sd_data *sd;
|
|
|
|
unit = UNIT(dev);
|
|
part = PARTITION(dev);
|
|
sd = sd_data[unit];
|
|
sd->partflags[part] &= ~SDOPEN;
|
|
sd->openparts &= ~(1 << part);
|
|
sd_prevent(unit,PR_ALLOW,SCSI_SILENT|SCSI_ERR_OK);
|
|
return(0);
|
|
}
|
|
|
|
/*******************************************************\
|
|
* This routine is called by the scsi interrupt when *
|
|
* the transfer is complete.
|
|
\*******************************************************/
|
|
int sd_done(unit,xs)
|
|
int unit;
|
|
struct scsi_xfer *xs;
|
|
{
|
|
struct buf *bp;
|
|
int retval;
|
|
int retries = 0;
|
|
|
|
#ifdef SDDEBUG
|
|
if(scsi_debug & PRINTROUTINES) printf("sd_done%d ",unit);
|
|
#endif /*SDDEBUG*/
|
|
#ifdef PARANOID
|
|
if (! (xs->flags & INUSE))
|
|
panic("scsi_xfer not in use!");
|
|
#endif
|
|
if((bp = xs->bp) == NULL)
|
|
{
|
|
/***********************************************\
|
|
* if it's a normal user level request, then ask *
|
|
* The user level code to handle error checking *
|
|
* rather than doing it here at interrupt time *
|
|
\***********************************************/
|
|
wakeup(xs);
|
|
return;
|
|
}
|
|
|
|
/***********************************************\
|
|
* If it has a buf, we might be working with *
|
|
* a request from the buffer cache or some other *
|
|
* piece of code that requires us to process *
|
|
* errors right now, despite cost *
|
|
\***********************************************/
|
|
switch(xs->error)
|
|
{
|
|
case XS_NOERROR:
|
|
bp->b_error = 0;
|
|
bp->b_resid = 0;
|
|
break;
|
|
|
|
case XS_SENSE:
|
|
retval = (sd_interpret_sense(unit,xs));
|
|
if(retval)
|
|
{
|
|
bp->b_flags |= B_ERROR;
|
|
bp->b_error = retval;
|
|
}
|
|
break;
|
|
|
|
case XS_BUSY:
|
|
/*should somehow arange for a 1 sec delay here (how?)*/
|
|
case XS_TIMEOUT:
|
|
/***********************************************\
|
|
* If we can, resubmit it to the adapter. *
|
|
\***********************************************/
|
|
if(xs->retries--)
|
|
{
|
|
xs->error = XS_NOERROR;
|
|
xs->flags &= ~ITSDONE;
|
|
if ( (*(sd_data[unit]->sc_sw->scsi_cmd))(xs)
|
|
== SUCCESSFULLY_QUEUED)
|
|
{ /* don't wake the job, ok? */
|
|
return;
|
|
}
|
|
xs->flags |= ITSDONE;
|
|
} /* fall through */
|
|
|
|
case XS_DRIVER_STUFFUP:
|
|
bp->b_flags |= B_ERROR;
|
|
bp->b_error = EIO;
|
|
break;
|
|
default:
|
|
printf("sd%d: unknown error category from scsi driver\n"
|
|
,unit);
|
|
}
|
|
/*******************************\
|
|
* tell the owner we're done *
|
|
* then free our resources *
|
|
* and see if there's more work *
|
|
\*******************************/
|
|
biodone(bp);
|
|
sd_free_xs(unit,xs,0);
|
|
sdstart(unit); /* If there's anything waiting.. do it */
|
|
}
|
|
|
|
/*******************************************************\
|
|
* ask the scsi driver to perform a command for us. *
|
|
* Call it through the switch table, and tell it which *
|
|
* sub-unit we want, and what target and lu we wish to *
|
|
* talk to. Also tell it where to find the command *
|
|
* and how long it is. *
|
|
* Also tell it where to read/write the data, and how *
|
|
* long the data is supposed to be. If we have a buf *
|
|
* to associate with the transfer, we need that too. *
|
|
\*******************************************************/
|
|
int sd_scsi_cmd(unit,scsi_cmd,cmdlen,data_addr,datalen,timeout,bp,flags)
|
|
|
|
int unit,flags;
|
|
struct scsi_generic *scsi_cmd;
|
|
int cmdlen;
|
|
int timeout;
|
|
u_char *data_addr;
|
|
int datalen;
|
|
struct buf *bp;
|
|
{
|
|
struct scsi_xfer *xs;
|
|
int retval;
|
|
int s;
|
|
struct sd_data *sd = sd_data[unit];
|
|
|
|
#ifdef SDDEBUG
|
|
if(scsi_debug & PRINTROUTINES) printf("\nsd_scsi_cmd%d ",unit);
|
|
#endif /*SDDEBUG*/
|
|
|
|
#ifdef PARANOID
|
|
if(!(sd->sc_sw)) /* If we have a scsi driver */
|
|
{/* How we got here is anyone's guess */
|
|
printf("sd%d: not set up\n",unit);
|
|
return(EINVAL);
|
|
}
|
|
#endif
|
|
xs = sd_get_xs(unit,flags); /* should wait unless booting */
|
|
#ifdef PARANOID
|
|
if(!xs)
|
|
{
|
|
printf("sd_scsi_cmd%d: controller busy"
|
|
" (this should never happen)\n",unit);
|
|
return(EBUSY);
|
|
}
|
|
#endif
|
|
/*******************************************************\
|
|
* Fill out the scsi_xfer structure *
|
|
\*******************************************************/
|
|
xs->flags = INUSE | flags;
|
|
xs->adapter = sd->ctlr;
|
|
xs->targ = sd->targ;
|
|
xs->lu = sd->lu;
|
|
xs->retries = SD_RETRIES;
|
|
xs->timeout = timeout;
|
|
xs->cmd = scsi_cmd;
|
|
xs->cmdlen = cmdlen;
|
|
xs->data = data_addr;
|
|
xs->datalen = datalen;
|
|
xs->resid = datalen;
|
|
xs->when_done = sd_done;
|
|
xs->done_arg = unit;
|
|
xs->done_arg2 = (int)xs;
|
|
xs->bp = bp;
|
|
retry: xs->error = XS_NOERROR;
|
|
|
|
/*******************************************************\
|
|
* Do the transfer. If we are polling we will return: *
|
|
* COMPLETE, Was poll, and sd_done has been called *
|
|
* HAD_ERROR, Was poll and an error was encountered *
|
|
* TRY_AGAIN_LATER, Adapter short resources, try again *
|
|
* *
|
|
* if under full steam (interrupts) it will return: *
|
|
* SUCCESSFULLY_QUEUED, will do a wakeup when complete *
|
|
* HAD_ERROR, had an erro before it could queue *
|
|
* TRY_AGAIN_LATER, (as for polling) *
|
|
* After the wakeup, we must still check if it succeeded *
|
|
* *
|
|
* If we have a bp however, all the error proccessing *
|
|
* and the buffer code both expect us to return straight *
|
|
* to them, so as soon as the command is queued, return *
|
|
\*******************************************************/
|
|
retval = (*(sd->sc_sw->scsi_cmd))(xs);
|
|
if(bp) return retval; /* will sleep (or not) elsewhere */
|
|
|
|
/*******************************************************\
|
|
* Only here for non I/O cmds. It's cheaper to process *
|
|
* the error status here than at interrupt time so *
|
|
* sd_done will have done nothing except wake us up. *
|
|
\*******************************************************/
|
|
switch(retval)
|
|
{
|
|
case SUCCESSFULLY_QUEUED:
|
|
s = splbio();
|
|
while(!(xs->flags & ITSDONE))
|
|
sleep(xs,PRIBIO+1);
|
|
splx(s);
|
|
/* fall through to check success of completed command */
|
|
|
|
case HAD_ERROR:
|
|
switch(xs->error)
|
|
{
|
|
case XS_NOERROR: /* nearly always hit this one */
|
|
retval = ESUCCESS;
|
|
break;
|
|
|
|
case XS_SENSE:
|
|
retval = (sd_interpret_sense(unit,xs));
|
|
break;
|
|
case XS_BUSY:
|
|
/* should sleep 1 sec here */
|
|
case XS_TIMEOUT:
|
|
if(xs->retries-- )
|
|
{
|
|
xs->flags &= ~ITSDONE;
|
|
goto retry;
|
|
}
|
|
case XS_DRIVER_STUFFUP:
|
|
retval = EIO;
|
|
break;
|
|
default:
|
|
retval = EIO;
|
|
printf("sd%d: unknown error category from scsi driver\n"
|
|
,unit);
|
|
}
|
|
break;
|
|
case COMPLETE: /* Polling command completed ok */
|
|
retval = ESUCCESS;
|
|
break;
|
|
|
|
case TRY_AGAIN_LATER: /* adapter resource shortage */
|
|
/* should sleep 1 sec here */
|
|
if(xs->retries-- )
|
|
{
|
|
xs->flags &= ~ITSDONE;
|
|
goto retry;
|
|
}
|
|
default:
|
|
retval = EIO;
|
|
}
|
|
/*******************************************************\
|
|
* we have finished with the xfer stuct, free it and *
|
|
* check if anyone else needs to be started up. *
|
|
\*******************************************************/
|
|
sd_free_xs(unit,xs,flags);
|
|
sdstart(unit); /* check queue */
|
|
return(retval);
|
|
}
|
|
|
|
/***************************************************************\
|
|
* Look at the returned sense and act on the error and detirmine *
|
|
* The unix error number to pass back... (0 = report no error) *
|
|
\***************************************************************/
|
|
|
|
int sd_interpret_sense(unit,xs)
|
|
int unit;
|
|
struct scsi_xfer *xs;
|
|
{
|
|
struct scsi_sense_data *sense;
|
|
int key;
|
|
int silent;
|
|
long int info;
|
|
|
|
/***************************************************************\
|
|
* If the flags say errs are ok, then always return ok. *
|
|
\***************************************************************/
|
|
if (xs->flags & SCSI_ERR_OK) return(ESUCCESS);
|
|
silent = (xs->flags & SCSI_SILENT);
|
|
|
|
sense = &(xs->sense);
|
|
info = ((sense->ext.extended.info[0] <<24)|
|
|
(sense->ext.extended.info[1] <<16)|
|
|
(sense->ext.extended.info[2] <<8)|
|
|
(sense->ext.extended.info[3] ));
|
|
switch(sense->error_code & SSD_ERRCODE)
|
|
{
|
|
case 0x70:
|
|
{
|
|
key=sense->ext.extended.flags & SSD_KEY;
|
|
switch(key)
|
|
{
|
|
case 0x0:
|
|
return(ESUCCESS);
|
|
case 0x1:
|
|
if(!silent)
|
|
{
|
|
printf("sd%d: soft error(corrected) ", unit);
|
|
if(sense->error_code & SSD_ERRCODE_VALID)
|
|
{
|
|
printf("block no. %d (decimal)",info);
|
|
}
|
|
printf("\n");
|
|
}
|
|
return(ESUCCESS);
|
|
case 0x2:
|
|
if(!silent)printf("sd%d: not ready\n ",
|
|
unit);
|
|
return(ENODEV);
|
|
case 0x3:
|
|
if(!silent)
|
|
{
|
|
printf("sd%d: medium error ", unit);
|
|
if(sense->error_code & SSD_ERRCODE_VALID)
|
|
{
|
|
printf("block no. %d (decimal)",info);
|
|
}
|
|
printf("\n");
|
|
}
|
|
return(EIO);
|
|
case 0x4:
|
|
if(!silent)printf("sd%d: non-media hardware failure\n ",
|
|
unit);
|
|
return(EIO);
|
|
case 0x5:
|
|
if(!silent)printf("sd%d: illegal request\n ",
|
|
unit);
|
|
return(EINVAL);
|
|
case 0x6:
|
|
/***********************************************\
|
|
* If we are not open, then this is not an error *
|
|
* as we don't have state yet. Either way, make *
|
|
* sure that we don't have any residual state *
|
|
\***********************************************/
|
|
if(!silent)printf("sd%d: Unit attention.\n ", unit);
|
|
sd_data[unit]->flags &= ~(SDVALID | SDHAVELABEL);
|
|
if (sd_data[unit]->openparts)
|
|
{
|
|
return(EIO);
|
|
}
|
|
return(ESUCCESS); /* not an error if nothing's open */
|
|
case 0x7:
|
|
if(!silent)
|
|
{
|
|
printf("sd%d: attempted protection violation ",
|
|
unit);
|
|
if(sense->error_code & SSD_ERRCODE_VALID)
|
|
{
|
|
printf("block no. %d (decimal)\n",info);
|
|
}
|
|
printf("\n");
|
|
}
|
|
return(EACCES);
|
|
case 0x8:
|
|
if(!silent)
|
|
{
|
|
printf("sd%d: block wrong state (format?)\n ",
|
|
unit);
|
|
if(sense->error_code & SSD_ERRCODE_VALID)
|
|
{
|
|
printf("block no. %d (decimal)\n",info);
|
|
}
|
|
printf("\n");
|
|
}
|
|
return(EIO);
|
|
case 0x9:
|
|
if(!silent)printf("sd%d: vendor unique\n",
|
|
unit);
|
|
return(EIO);
|
|
case 0xa:
|
|
if(!silent)printf("sd%d: copy aborted\n ",
|
|
unit);
|
|
return(EIO);
|
|
case 0xb:
|
|
if(!silent)printf("sd%d: command aborted\n ",
|
|
unit);
|
|
return(EIO);
|
|
case 0xc:
|
|
if(!silent)
|
|
{
|
|
printf("sd%d: search returned\n ",
|
|
unit);
|
|
if(sense->error_code & SSD_ERRCODE_VALID)
|
|
{
|
|
printf("block no. %d (decimal)\n",info);
|
|
}
|
|
printf("\n");
|
|
}
|
|
return(ESUCCESS);
|
|
case 0xd:
|
|
if(!silent)printf("sd%d: volume overflow\n ",
|
|
unit);
|
|
return(ENOSPC);
|
|
case 0xe:
|
|
if(!silent)
|
|
{
|
|
printf("sd%d: verify miscompare\n ",
|
|
unit);
|
|
if(sense->error_code & SSD_ERRCODE_VALID)
|
|
{
|
|
printf("block no. %d (decimal)\n",info);
|
|
}
|
|
printf("\n");
|
|
}
|
|
return(EIO);
|
|
case 0xf:
|
|
if(!silent)printf("sd%d: unknown error key\n ",
|
|
unit);
|
|
return(EIO);
|
|
}
|
|
break;
|
|
}
|
|
default:
|
|
{
|
|
if(!silent)printf("sd%d: code %d\n",
|
|
unit,
|
|
sense->error_code & SSD_ERRCODE);
|
|
if(sense->error_code & SSD_ERRCODE_VALID)
|
|
if(!silent)printf("block no. %d (decimal)\n",
|
|
(sense->ext.unextended.blockhi <<16)
|
|
+ (sense->ext.unextended.blockmed <<8)
|
|
+ (sense->ext.unextended.blocklow ));
|
|
}
|
|
return(EIO);
|
|
}
|
|
}
|
|
|
|
|
|
|
|
|
|
int
|
|
sdsize(dev_t dev)
|
|
{
|
|
int unit = UNIT(dev), part = PARTITION(dev), val;
|
|
struct sd_data *sd;
|
|
|
|
if (unit >= NSD)
|
|
return(-1);
|
|
|
|
sd = sd_data[unit];
|
|
if(!sd) return(-1);
|
|
if((sd->flags & SDINIT) == 0) return(-1);
|
|
if (sd == 0 || (sd->flags & SDHAVELABEL) == 0)
|
|
val = sdopen (MAKESDDEV(major(dev), unit, RAW_PART), FREAD, S_IFBLK, 0);
|
|
if ( val != 0 || sd->flags & SDWRITEPROT)
|
|
return (-1);
|
|
|
|
return((int)sd->disklabel.d_partitions[part].p_size);
|
|
}
|
|
/*#define SCSIDUMP*/
|
|
#ifdef SCSIDUMP
|
|
#include <vm/vm.h>
|
|
/***********************************************************************\
|
|
* dump all of physical memory into the partition specified, starting *
|
|
* at offset 'dumplo' into the partition. *
|
|
\***********************************************************************/
|
|
static struct scsi_xfer sx;
|
|
#define MAXTRANSFER 8 /* 1 page at a time */
|
|
int
|
|
sddump(dev_t dev) /* dump core after a system crash */
|
|
{
|
|
register struct sd_data *sd; /* disk unit to do the IO */
|
|
long num; /* number of sectors to write */
|
|
int unit, part, sdc;
|
|
long blkoff, blknum, blkcnt;
|
|
long nblocks;
|
|
char *addr;
|
|
struct scsi_rw_big cmd;
|
|
extern int Maxmem;
|
|
static sddoingadump = 0 ;
|
|
extern caddr_t CADDR1; /* map the page we are about to write, here*/
|
|
struct scsi_xfer *xs = &sx;
|
|
int retval;
|
|
|
|
addr = (char *) 0; /* starting address */
|
|
|
|
/* toss any characters present prior to dump */
|
|
while (sgetc(1))
|
|
;
|
|
|
|
/* size of memory to dump */
|
|
num = Maxmem;
|
|
unit = UNIT(dev); /* eventually support floppies? */
|
|
part = PARTITION(dev); /* file system */
|
|
/* check for acceptable drive number */
|
|
if (unit >= NSD) return(ENXIO); /* 31 Jul 92*/
|
|
|
|
sd = sd_data[unit];
|
|
if(!sd) return (ENXIO);
|
|
/* was it ever initialized etc. ? */
|
|
if (!(sd->flags & SDINIT)) return (ENXIO);
|
|
if (sd->flags & SDVALID != SDVALID) return (ENXIO) ;
|
|
if (sd->flags & SDWRITEPROT) return (ENXIO);
|
|
|
|
/* Convert to disk sectors */
|
|
num = (u_long) num * NBPG / sd->disklabel.d_secsize;
|
|
|
|
/* check if controller active */
|
|
if (sddoingadump) return(EFAULT);
|
|
|
|
nblocks = sd->disklabel.d_partitions[part].p_size;
|
|
blkoff = sd->disklabel.d_partitions[part].p_offset;
|
|
|
|
/* check transfer bounds against partition size */
|
|
if ((dumplo < 0) || ((dumplo + num) > nblocks))
|
|
return(EINVAL);
|
|
|
|
sddoingadump = 1 ;
|
|
|
|
blknum = dumplo + blkoff;
|
|
while (num > 0)
|
|
{
|
|
if (blkcnt > MAXTRANSFER) blkcnt = MAXTRANSFER;
|
|
pmap_enter( kernel_pmap,
|
|
CADDR1,
|
|
trunc_page(addr),
|
|
VM_PROT_READ,
|
|
TRUE);
|
|
#ifndef NOT_TRUSTED
|
|
/*******************************************************\
|
|
* Fill out the scsi command *
|
|
\*******************************************************/
|
|
bzero(&cmd, sizeof(cmd));
|
|
cmd.op_code = WRITE_BIG;
|
|
cmd.addr_3 = (blknum & 0xff000000) >> 24;
|
|
cmd.addr_2 = (blknum & 0xff0000) >> 16;
|
|
cmd.addr_1 = (blknum & 0xff00) >> 8;
|
|
cmd.addr_0 = blknum & 0xff;
|
|
cmd.length2 = (blkcnt & 0xff00) >> 8;
|
|
cmd.length1 = (blkcnt & 0xff);
|
|
/*******************************************************\
|
|
* Fill out the scsi_xfer structure *
|
|
* Note: we cannot sleep as we may be an interrupt *
|
|
\*******************************************************/
|
|
bzero(xs, sizeof(sx));
|
|
xs->flags |= SCSI_NOMASK|SCSI_NOSLEEP|INUSE;
|
|
xs->adapter = sd->ctlr;
|
|
xs->targ = sd->targ;
|
|
xs->lu = sd->lu;
|
|
xs->retries = SD_RETRIES;
|
|
xs->timeout = 10000;/* 10000 millisecs for a disk !*/
|
|
xs->cmd = (struct scsi_generic *)&cmd;
|
|
xs->cmdlen = sizeof(cmd);
|
|
xs->resid = blkcnt * 512;
|
|
xs->when_done = 0;
|
|
xs->done_arg = unit;
|
|
xs->done_arg2 = (int)xs;
|
|
xs->error = XS_NOERROR;
|
|
xs->bp = 0;
|
|
xs->data = (u_char *)CADDR1;
|
|
xs->datalen = blkcnt * 512;
|
|
|
|
/*******************************************************\
|
|
* Pass all this info to the scsi driver. *
|
|
\*******************************************************/
|
|
retval = (*(sd->sc_sw->scsi_cmd))(xs);
|
|
switch(retval)
|
|
{
|
|
case SUCCESSFULLY_QUEUED:
|
|
case HAD_ERROR:
|
|
return(ENXIO); /* we said not to sleep! */
|
|
case COMPLETE:
|
|
break;
|
|
default:
|
|
return(ENXIO); /* we said not to sleep! */
|
|
}
|
|
#else NOT_TRUSTED
|
|
/* lets just talk about this first...*/
|
|
printf ("sd%d: dump addr 0x%x, blk %d\n",unit,addr,blknum);
|
|
#endif NOT_TRUSTED
|
|
|
|
if ((unsigned)addr % (1024*1024) == 0) printf("%d ", num/2048) ;
|
|
/* update block count */
|
|
num -= MAXTRANSFER;
|
|
blknum += MAXTRANSFER ;
|
|
(int) addr += 512 * MAXTRANSFER;
|
|
|
|
/* operator aborting dump? */
|
|
if (sgetc(1))
|
|
return(EINTR);
|
|
}
|
|
return(0);
|
|
}
|
|
#else SCSIDUMP
|
|
sddump()
|
|
{
|
|
printf("\nsddump() -- not implemented\n");
|
|
DELAY(20000000); /* 20 seconds */
|
|
return(-1);
|
|
}
|
|
#endif SCSIDUMP
|
|
|