freebsd-skq/sys/scsi/sd.c
rgrimes c56db4c78a The dynamically allocated struct's where not getting properly initialized
as malloc memory is NOT zerod.  Added bzero's after the malloc calls
to make sure that things are initialized.

>From Julian Elischer
1993-09-20 06:27:06 +00:00

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.8 1993/09/10 18:03:21 ats 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),
2000,
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