2916 lines
89 KiB
C
2916 lines
89 KiB
C
|
/****************************************************************************
|
||
|
* Perceptive Solutions, Inc. PCI-2220I device driver for Linux.
|
||
|
*
|
||
|
* pci2220i.c - Linux Host Driver for PCI-2220I EIDE RAID Adapters
|
||
|
*
|
||
|
* Copyright (c) 1997-1999 Perceptive Solutions, Inc.
|
||
|
* All Rights Reserved.
|
||
|
*
|
||
|
* Redistribution and use in source and binary forms, with or without
|
||
|
* modification, are permitted provided that redistributions of source
|
||
|
* code retain the above copyright notice and this comment without
|
||
|
* modification.
|
||
|
*
|
||
|
* Technical updates and product information at:
|
||
|
* http://www.psidisk.com
|
||
|
*
|
||
|
* Please send questions, comments, bug reports to:
|
||
|
* tech@psidisk.com Technical Support
|
||
|
*
|
||
|
*
|
||
|
* Revisions 1.10 Mar-26-1999
|
||
|
* - Updated driver for RAID and hot reconstruct support.
|
||
|
*
|
||
|
* Revisions 1.11 Mar-26-1999
|
||
|
* - Fixed spinlock and PCI configuration.
|
||
|
*
|
||
|
* Revision 2.00 December-1-1999
|
||
|
* - Added code for the PCI-2240I controller
|
||
|
* - Added code for ATAPI devices.
|
||
|
* - Double buffer for scatter/gather support
|
||
|
*
|
||
|
* Revision 2.10 March-27-2000
|
||
|
* - Added support for dynamic DMA
|
||
|
*
|
||
|
****************************************************************************/
|
||
|
|
||
|
#error Convert me to understand page+offset based scatterlists
|
||
|
|
||
|
//#define DEBUG 1
|
||
|
|
||
|
#include <linux/interrupt.h>
|
||
|
#include <linux/module.h>
|
||
|
#include <linux/kernel.h>
|
||
|
#include <linux/types.h>
|
||
|
#include <linux/string.h>
|
||
|
#include <linux/slab.h>
|
||
|
#include <linux/pci.h>
|
||
|
#include <linux/ioport.h>
|
||
|
#include <linux/delay.h>
|
||
|
#include <linux/sched.h>
|
||
|
#include <linux/proc_fs.h>
|
||
|
#include <linux/stat.h>
|
||
|
#include <linux/blkdev.h>
|
||
|
#include <linux/timer.h>
|
||
|
#include <linux/spinlock.h>
|
||
|
|
||
|
#include <asm/dma.h>
|
||
|
#include <asm/system.h>
|
||
|
#include <asm/io.h>
|
||
|
|
||
|
#include "scsi.h"
|
||
|
#include <scsi/scsi_host.h>
|
||
|
#include "pci2220i.h"
|
||
|
#include "psi_dale.h"
|
||
|
|
||
|
|
||
|
#define PCI2220I_VERSION "2.10"
|
||
|
#define READ_CMD IDE_CMD_READ_MULTIPLE
|
||
|
#define WRITE_CMD IDE_CMD_WRITE_MULTIPLE
|
||
|
#define MAX_BUS_MASTER_BLOCKS SECTORSXFER // This is the maximum we can bus master
|
||
|
|
||
|
#ifdef DEBUG
|
||
|
#define DEB(x) x
|
||
|
#define STOP_HERE() {int st;for(st=0;st<100;st++){st=1;}}
|
||
|
#else
|
||
|
#define DEB(x)
|
||
|
#define STOP_HERE()
|
||
|
#endif
|
||
|
|
||
|
#define MAXADAPTER 4 // Increase this and the sizes of the arrays below, if you need more.
|
||
|
|
||
|
|
||
|
typedef struct
|
||
|
{
|
||
|
UCHAR byte6; // device select register image
|
||
|
UCHAR spigot; // spigot number
|
||
|
UCHAR spigots[2]; // RAID spigots
|
||
|
UCHAR deviceID[2]; // device ID codes
|
||
|
USHORT sectors; // number of sectors per track
|
||
|
USHORT heads; // number of heads
|
||
|
USHORT cylinders; // number of cylinders for this device
|
||
|
USHORT spareword; // placeholder
|
||
|
ULONG blocks; // number of blocks on device
|
||
|
DISK_MIRROR DiskMirror[2]; // RAID status and control
|
||
|
ULONG lastsectorlba[2]; // last addressable sector on the drive
|
||
|
USHORT raid; // RAID active flag
|
||
|
USHORT mirrorRecon;
|
||
|
UCHAR reconOn;
|
||
|
USHORT reconCount;
|
||
|
USHORT reconIsStarting; // indicate hot reconstruct is starting
|
||
|
UCHAR cmdDrqInt; // flag for command interrupt
|
||
|
UCHAR packet; // command packet size in bytes
|
||
|
} OUR_DEVICE, *POUR_DEVICE;
|
||
|
|
||
|
typedef struct
|
||
|
{
|
||
|
USHORT bigD; // identity is a PCI-2240I if true, otherwise a PCI-2220I
|
||
|
USHORT atapi; // this interface is for ATAPI devices only
|
||
|
ULONG regDmaDesc; // address of the DMA discriptor register for direction of transfer
|
||
|
ULONG regDmaCmdStat; // Byte #1 of DMA command status register
|
||
|
ULONG regDmaAddrPci; // 32 bit register for PCI address of DMA
|
||
|
ULONG regDmaAddrLoc; // 32 bit register for local bus address of DMA
|
||
|
ULONG regDmaCount; // 32 bit register for DMA transfer count
|
||
|
ULONG regDmaMode; // 32 bit register for DMA mode control
|
||
|
ULONG regRemap; // 32 bit local space remap
|
||
|
ULONG regDesc; // 32 bit local region descriptor
|
||
|
ULONG regRange; // 32 bit local range
|
||
|
ULONG regIrqControl; // 16 bit Interrupt enable/disable and status
|
||
|
ULONG regScratchPad; // scratch pad I/O base address
|
||
|
ULONG regBase; // Base I/O register for data space
|
||
|
ULONG regData; // data register I/O address
|
||
|
ULONG regError; // error register I/O address
|
||
|
ULONG regSectCount; // sector count register I/O address
|
||
|
ULONG regLba0; // least significant byte of LBA
|
||
|
ULONG regLba8; // next least significant byte of LBA
|
||
|
ULONG regLba16; // next most significan byte of LBA
|
||
|
ULONG regLba24; // head and most 4 significant bits of LBA
|
||
|
ULONG regStatCmd; // status on read and command on write register
|
||
|
ULONG regStatSel; // board status on read and spigot select on write register
|
||
|
ULONG regFail; // fail bits control register
|
||
|
ULONG regAltStat; // alternate status and drive control register
|
||
|
ULONG basePort; // PLX base I/O port
|
||
|
USHORT timingMode; // timing mode currently set for adapter
|
||
|
USHORT timingPIO; // TRUE if PIO timing is active
|
||
|
struct pci_dev *pcidev;
|
||
|
ULONG timingAddress; // address to use on adapter for current timing mode
|
||
|
ULONG irqOwned; // owned IRQ or zero if shared
|
||
|
UCHAR numberOfDrives; // saved number of drives on this controller
|
||
|
UCHAR failRegister; // current inverted data in fail register
|
||
|
OUR_DEVICE device[BIGD_MAXDRIVES];
|
||
|
DISK_MIRROR *raidData[BIGD_MAXDRIVES];
|
||
|
ULONG startSector;
|
||
|
USHORT sectorCount;
|
||
|
ULONG readCount;
|
||
|
UCHAR *currentSgBuffer;
|
||
|
ULONG currentSgCount;
|
||
|
USHORT nextSg;
|
||
|
UCHAR cmd;
|
||
|
Scsi_Cmnd *SCpnt;
|
||
|
POUR_DEVICE pdev; // current device opearating on
|
||
|
USHORT devInReconIndex;
|
||
|
USHORT expectingIRQ;
|
||
|
USHORT reconOn; // Hot reconstruct is to be done.
|
||
|
USHORT reconPhase; // Hot reconstruct operation is in progress.
|
||
|
ULONG reconSize;
|
||
|
USHORT demoFail; // flag for RAID failure demonstration
|
||
|
USHORT survivor;
|
||
|
USHORT failinprog;
|
||
|
struct timer_list reconTimer;
|
||
|
struct timer_list timer;
|
||
|
UCHAR *kBuffer;
|
||
|
dma_addr_t kBufferDma;
|
||
|
UCHAR reqSense;
|
||
|
UCHAR atapiCdb[16];
|
||
|
UCHAR atapiSpecial;
|
||
|
} ADAPTER2220I, *PADAPTER2220I;
|
||
|
|
||
|
#define HOSTDATA(host) ((PADAPTER2220I)&host->hostdata)
|
||
|
|
||
|
#define RECON_PHASE_READY 0x01
|
||
|
#define RECON_PHASE_COPY 0x02
|
||
|
#define RECON_PHASE_UPDATE 0x03
|
||
|
#define RECON_PHASE_LAST 0x04
|
||
|
#define RECON_PHASE_END 0x07
|
||
|
#define RECON_PHASE_MARKING 0x80
|
||
|
#define RECON_PHASE_FAILOVER 0xFF
|
||
|
|
||
|
static struct Scsi_Host *PsiHost[MAXADAPTER] = {NULL,}; // One for each adapter
|
||
|
static int NumAdapters = 0;
|
||
|
static int Installed = 0;
|
||
|
static SETUP DaleSetup;
|
||
|
static DISK_MIRROR DiskMirror[BIGD_MAXDRIVES];
|
||
|
static ULONG ModeArray[] = {DALE_DATA_MODE2, DALE_DATA_MODE3, DALE_DATA_MODE4, DALE_DATA_MODE5};
|
||
|
static ULONG ModeArray2[] = {BIGD_DATA_MODE2, BIGD_DATA_MODE3, BIGD_DATA_MODE4, BIGD_DATA_MODE5};
|
||
|
|
||
|
static void ReconTimerExpiry (unsigned long data);
|
||
|
|
||
|
/*******************************************************************************************************
|
||
|
* Name: Alarm
|
||
|
*
|
||
|
* Description: Sound the for the given device
|
||
|
*
|
||
|
* Parameters: padapter - Pointer adapter data structure.
|
||
|
* device - Device number.
|
||
|
*
|
||
|
* Returns: Nothing.
|
||
|
*
|
||
|
******************************************************************************************************/
|
||
|
static void Alarm (PADAPTER2220I padapter, UCHAR device)
|
||
|
{
|
||
|
UCHAR zc;
|
||
|
|
||
|
if ( padapter->bigD )
|
||
|
{
|
||
|
zc = device | (FAIL_ANY | FAIL_AUDIBLE);
|
||
|
if ( padapter->failRegister & FAIL_ANY )
|
||
|
zc |= FAIL_MULTIPLE;
|
||
|
|
||
|
padapter->failRegister = zc;
|
||
|
outb_p (~zc, padapter->regFail);
|
||
|
}
|
||
|
else
|
||
|
outb_p (0x3C | (1 << device), padapter->regFail); // sound alarm and set fail light
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: MuteAlarm :LOCAL
|
||
|
*
|
||
|
* Description: Mute the audible alarm.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer adapter data structure.
|
||
|
*
|
||
|
* Returns: TRUE if drive does not assert DRQ in time.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static void MuteAlarm (PADAPTER2220I padapter)
|
||
|
{
|
||
|
UCHAR old;
|
||
|
|
||
|
if ( padapter->bigD )
|
||
|
{
|
||
|
padapter->failRegister &= ~FAIL_AUDIBLE;
|
||
|
outb_p (~padapter->failRegister, padapter->regFail);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
old = (inb_p (padapter->regStatSel) >> 3) | (inb_p (padapter->regStatSel) & 0x83);
|
||
|
outb_p (old | 0x40, padapter->regFail);
|
||
|
}
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: WaitReady :LOCAL
|
||
|
*
|
||
|
* Description: Wait for device ready.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer adapter data structure.
|
||
|
*
|
||
|
* Returns: TRUE if drive does not assert DRQ in time.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static int WaitReady (PADAPTER2220I padapter)
|
||
|
{
|
||
|
ULONG z;
|
||
|
UCHAR status;
|
||
|
|
||
|
for ( z = 0; z < (TIMEOUT_READY * 4); z++ )
|
||
|
{
|
||
|
status = inb_p (padapter->regStatCmd);
|
||
|
if ( (status & (IDE_STATUS_DRDY | IDE_STATUS_BUSY)) == IDE_STATUS_DRDY )
|
||
|
return 0;
|
||
|
udelay (250);
|
||
|
}
|
||
|
return status;
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: WaitReadyReset :LOCAL
|
||
|
*
|
||
|
* Description: Wait for device ready.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer adapter data structure.
|
||
|
*
|
||
|
* Returns: TRUE if drive does not assert DRQ in time.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static int WaitReadyReset (PADAPTER2220I padapter)
|
||
|
{
|
||
|
ULONG z;
|
||
|
UCHAR status;
|
||
|
|
||
|
for ( z = 0; z < (125 * 16); z++ ) // wait up to 1/4 second
|
||
|
{
|
||
|
status = inb_p (padapter->regStatCmd);
|
||
|
if ( (status & (IDE_STATUS_DRDY | IDE_STATUS_BUSY)) == IDE_STATUS_DRDY )
|
||
|
{
|
||
|
DEB (printk ("\nPCI2220I: Reset took %ld mSec to be ready", z / 8));
|
||
|
return 0;
|
||
|
}
|
||
|
udelay (125);
|
||
|
}
|
||
|
DEB (printk ("\nPCI2220I: Reset took more than 2 Seconds to come ready, Disk Failure"));
|
||
|
return status;
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: WaitDrq :LOCAL
|
||
|
*
|
||
|
* Description: Wait for device ready for data transfer.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer adapter data structure.
|
||
|
*
|
||
|
* Returns: TRUE if drive does not assert DRQ in time.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static int WaitDrq (PADAPTER2220I padapter)
|
||
|
{
|
||
|
ULONG z;
|
||
|
UCHAR status;
|
||
|
|
||
|
for ( z = 0; z < (TIMEOUT_DRQ * 4); z++ )
|
||
|
{
|
||
|
status = inb_p (padapter->regStatCmd);
|
||
|
if ( status & IDE_STATUS_DRQ )
|
||
|
return 0;
|
||
|
udelay (250);
|
||
|
}
|
||
|
return status;
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: AtapiWaitReady :LOCAL
|
||
|
*
|
||
|
* Description: Wait for device busy and DRQ to be cleared.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer adapter data structure.
|
||
|
* msec - Number of milliseconds to wait.
|
||
|
*
|
||
|
* Returns: TRUE if drive does not clear busy in time.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static int AtapiWaitReady (PADAPTER2220I padapter, int msec)
|
||
|
{
|
||
|
int z;
|
||
|
|
||
|
for ( z = 0; z < (msec * 16); z++ )
|
||
|
{
|
||
|
if ( !(inb_p (padapter->regStatCmd) & (IDE_STATUS_BUSY | IDE_STATUS_DRQ)) )
|
||
|
return FALSE;
|
||
|
udelay (125);
|
||
|
}
|
||
|
return TRUE;
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: AtapiWaitDrq :LOCAL
|
||
|
*
|
||
|
* Description: Wait for device ready for data transfer.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer adapter data structure.
|
||
|
* msec - Number of milliseconds to wait.
|
||
|
*
|
||
|
* Returns: TRUE if drive does not assert DRQ in time.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static int AtapiWaitDrq (PADAPTER2220I padapter, int msec)
|
||
|
{
|
||
|
ULONG z;
|
||
|
|
||
|
for ( z = 0; z < (msec * 16); z++ )
|
||
|
{
|
||
|
if ( inb_p (padapter->regStatCmd) & IDE_STATUS_DRQ )
|
||
|
return 0;
|
||
|
udelay (128);
|
||
|
}
|
||
|
return TRUE;
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: HardReset :LOCAL
|
||
|
*
|
||
|
* Description: Wait for device ready for data transfer.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer adapter data structure.
|
||
|
* pdev - Pointer to device.
|
||
|
* spigot - Spigot number.
|
||
|
*
|
||
|
* Returns: TRUE if drive does not assert DRQ in time.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static int HardReset (PADAPTER2220I padapter, POUR_DEVICE pdev, UCHAR spigot)
|
||
|
{
|
||
|
DEB (printk ("\npci2220i:RESET spigot = %X devices = %d, %d", spigot, pdev->deviceID[0], pdev->deviceID[1]));
|
||
|
mdelay (100); // just wait 100 mSec to let drives flush
|
||
|
SelectSpigot (padapter, spigot | SEL_IRQ_OFF);
|
||
|
|
||
|
outb_p (0x0E, padapter->regAltStat); // reset the suvivor
|
||
|
udelay (100); // wait a little
|
||
|
outb_p (0x08, padapter->regAltStat); // clear the reset
|
||
|
udelay (100);
|
||
|
|
||
|
outb_p (0xA0, padapter->regLba24); // select the master drive
|
||
|
if ( WaitReadyReset (padapter) )
|
||
|
{
|
||
|
DEB (printk ("\npci2220i: master not ready after reset"));
|
||
|
return TRUE;
|
||
|
}
|
||
|
outb_p (0xB0, padapter->regLba24); // try the slave drive
|
||
|
if ( (inb_p (padapter->regStatCmd) & (IDE_STATUS_DRDY | IDE_STATUS_BUSY)) == IDE_STATUS_DRDY )
|
||
|
{
|
||
|
DEB (printk ("\nPCI2220I: initializing slave drive on spigot %X", spigot));
|
||
|
outb_p (SECTORSXFER, padapter->regSectCount);
|
||
|
WriteCommand (padapter, IDE_CMD_SET_MULTIPLE);
|
||
|
if ( WaitReady (padapter) )
|
||
|
{
|
||
|
DEB (printk ("\npci2220i: slave not ready after set multiple"));
|
||
|
return TRUE;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
outb_p (0xA0, padapter->regLba24); // select the drive
|
||
|
outb_p (SECTORSXFER, padapter->regSectCount);
|
||
|
WriteCommand (padapter, IDE_CMD_SET_MULTIPLE);
|
||
|
if ( WaitReady (padapter) )
|
||
|
{
|
||
|
DEB (printk ("\npci2220i: master not ready after set multiple"));
|
||
|
return TRUE;
|
||
|
}
|
||
|
return FALSE;
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: AtapiReset :LOCAL
|
||
|
*
|
||
|
* Description: Wait for device ready for data transfer.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer adapter data structure.
|
||
|
* pdev - Pointer to device.
|
||
|
*
|
||
|
* Returns: TRUE if drive does not come ready.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static int AtapiReset (PADAPTER2220I padapter, POUR_DEVICE pdev)
|
||
|
{
|
||
|
SelectSpigot (padapter, pdev->spigot);
|
||
|
AtapiDevice (padapter, pdev->byte6);
|
||
|
AtapiCountLo (padapter, 0);
|
||
|
AtapiCountHi (padapter, 0);
|
||
|
WriteCommand (padapter, IDE_COMMAND_ATAPI_RESET);
|
||
|
udelay (125);
|
||
|
if ( AtapiWaitReady (padapter, 1000) )
|
||
|
return TRUE;
|
||
|
if ( inb_p (padapter->regStatCmd) || (inb_p (padapter->regLba8) != 0x14) || (inb_p (padapter->regLba16) != 0xEB) )
|
||
|
return TRUE;
|
||
|
return FALSE;
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: WalkScatGath :LOCAL
|
||
|
*
|
||
|
* Description: Transfer data to/from scatter/gather buffers.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer adapter data structure.
|
||
|
* datain - TRUE if data read.
|
||
|
* length - Number of bytes to transfer.
|
||
|
*
|
||
|
* Returns: Nothing.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static void WalkScatGath (PADAPTER2220I padapter, UCHAR datain, ULONG length)
|
||
|
{
|
||
|
ULONG count;
|
||
|
UCHAR *buffer = padapter->kBuffer;
|
||
|
|
||
|
while ( length )
|
||
|
{
|
||
|
count = ( length > padapter->currentSgCount ) ? padapter->currentSgCount : length;
|
||
|
|
||
|
if ( datain )
|
||
|
memcpy (padapter->currentSgBuffer, buffer, count);
|
||
|
else
|
||
|
memcpy (buffer, padapter->currentSgBuffer, count);
|
||
|
|
||
|
padapter->currentSgCount -= count;
|
||
|
if ( !padapter->currentSgCount )
|
||
|
{
|
||
|
if ( padapter->nextSg < padapter->SCpnt->use_sg )
|
||
|
{
|
||
|
padapter->currentSgBuffer = ((struct scatterlist *)padapter->SCpnt->request_buffer)[padapter->nextSg].address;
|
||
|
padapter->currentSgCount = ((struct scatterlist *)padapter->SCpnt->request_buffer)[padapter->nextSg].length;
|
||
|
padapter->nextSg++;
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
padapter->currentSgBuffer += count;
|
||
|
|
||
|
length -= count;
|
||
|
buffer += count;
|
||
|
}
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: BusMaster :LOCAL
|
||
|
*
|
||
|
* Description: Do a bus master I/O.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer adapter data structure.
|
||
|
* datain - TRUE if data read.
|
||
|
* irq - TRUE if bus master interrupt expected.
|
||
|
*
|
||
|
* Returns: Nothing.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static void BusMaster (PADAPTER2220I padapter, UCHAR datain, UCHAR irq)
|
||
|
{
|
||
|
ULONG zl;
|
||
|
|
||
|
zl = ( padapter->sectorCount > MAX_BUS_MASTER_BLOCKS ) ? MAX_BUS_MASTER_BLOCKS : padapter->sectorCount;
|
||
|
padapter->sectorCount -= zl;
|
||
|
zl *= (ULONG)BYTES_PER_SECTOR;
|
||
|
|
||
|
if ( datain )
|
||
|
{
|
||
|
padapter->readCount = zl;
|
||
|
outb_p (8, padapter->regDmaDesc); // read operation
|
||
|
if ( padapter->bigD )
|
||
|
{
|
||
|
if ( irq && !padapter->sectorCount )
|
||
|
outb_p (0x0C, padapter->regDmaMode); // interrupt on
|
||
|
else
|
||
|
outb_p (0x08, padapter->regDmaMode); // no interrupt
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if ( irq && !padapter->sectorCount )
|
||
|
outb_p (0x05, padapter->regDmaMode); // interrupt on
|
||
|
else
|
||
|
outb_p (0x01, padapter->regDmaMode); // no interrupt
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
outb_p (0x00, padapter->regDmaDesc); // write operation
|
||
|
if ( padapter->bigD )
|
||
|
outb_p (0x08, padapter->regDmaMode); // no interrupt
|
||
|
else
|
||
|
outb_p (0x01, padapter->regDmaMode); // no interrupt
|
||
|
WalkScatGath (padapter, FALSE, zl);
|
||
|
}
|
||
|
|
||
|
outl (padapter->timingAddress, padapter->regDmaAddrLoc);
|
||
|
outl (padapter->kBufferDma, padapter->regDmaAddrPci);
|
||
|
outl (zl, padapter->regDmaCount);
|
||
|
outb_p (0x03, padapter->regDmaCmdStat); // kick the DMA engine in gear
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: AtapiBusMaster :LOCAL
|
||
|
*
|
||
|
* Description: Do a bus master I/O.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer adapter data structure.
|
||
|
* datain - TRUE if data read.
|
||
|
* length - Number of bytes to transfer.
|
||
|
*
|
||
|
* Returns: Nothing.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static void AtapiBusMaster (PADAPTER2220I padapter, UCHAR datain, ULONG length)
|
||
|
{
|
||
|
outl (padapter->timingAddress, padapter->regDmaAddrLoc);
|
||
|
outl (padapter->kBufferDma, padapter->regDmaAddrPci);
|
||
|
outl (length, padapter->regDmaCount);
|
||
|
if ( datain )
|
||
|
{
|
||
|
if ( padapter->readCount )
|
||
|
WalkScatGath (padapter, TRUE, padapter->readCount);
|
||
|
outb_p (0x08, padapter->regDmaDesc); // read operation
|
||
|
outb_p (0x08, padapter->regDmaMode); // no interrupt
|
||
|
padapter->readCount = length;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
outb_p (0x00, padapter->regDmaDesc); // write operation
|
||
|
outb_p (0x08, padapter->regDmaMode); // no interrupt
|
||
|
if ( !padapter->atapiSpecial )
|
||
|
WalkScatGath (padapter, FALSE, length);
|
||
|
}
|
||
|
outb_p (0x03, padapter->regDmaCmdStat); // kick the DMA engine in gear
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: WriteData :LOCAL
|
||
|
*
|
||
|
* Description: Write data to device.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer adapter data structure.
|
||
|
*
|
||
|
* Returns: TRUE if drive does not assert DRQ in time.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static int WriteData (PADAPTER2220I padapter)
|
||
|
{
|
||
|
ULONG zl;
|
||
|
|
||
|
if ( !WaitDrq (padapter) )
|
||
|
{
|
||
|
if ( padapter->timingPIO )
|
||
|
{
|
||
|
zl = (padapter->sectorCount > MAX_BUS_MASTER_BLOCKS) ? MAX_BUS_MASTER_BLOCKS : padapter->sectorCount;
|
||
|
WalkScatGath (padapter, FALSE, zl * BYTES_PER_SECTOR);
|
||
|
outsw (padapter->regData, padapter->kBuffer, zl * (BYTES_PER_SECTOR / 2));
|
||
|
padapter->sectorCount -= zl;
|
||
|
}
|
||
|
else
|
||
|
BusMaster (padapter, 0, 0);
|
||
|
return 0;
|
||
|
}
|
||
|
padapter->cmd = 0; // null out the command byte
|
||
|
return 1;
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: WriteDataBoth :LOCAL
|
||
|
*
|
||
|
* Description: Write data to device.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer to adapter structure.
|
||
|
* pdev - Pointer to device structure
|
||
|
*
|
||
|
* Returns: Index + 1 of drive not failed or zero for OK.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static int WriteDataBoth (PADAPTER2220I padapter, POUR_DEVICE pdev)
|
||
|
{
|
||
|
ULONG zl;
|
||
|
UCHAR status0, status1;
|
||
|
|
||
|
SelectSpigot (padapter, pdev->spigots[0]);
|
||
|
status0 = WaitDrq (padapter);
|
||
|
if ( !status0 )
|
||
|
{
|
||
|
SelectSpigot (padapter, pdev->spigots[1]);
|
||
|
status1 = WaitDrq (padapter);
|
||
|
if ( !status1 )
|
||
|
{
|
||
|
SelectSpigot (padapter, pdev->spigots[0] | pdev->spigots[1] | padapter->bigD);
|
||
|
if ( padapter->timingPIO )
|
||
|
{
|
||
|
zl = (padapter->sectorCount > MAX_BUS_MASTER_BLOCKS) ? MAX_BUS_MASTER_BLOCKS : padapter->sectorCount;
|
||
|
WalkScatGath (padapter, FALSE, zl * BYTES_PER_SECTOR);
|
||
|
outsw (padapter->regData, padapter->kBuffer, zl * (BYTES_PER_SECTOR / 2));
|
||
|
padapter->sectorCount -= zl;
|
||
|
}
|
||
|
else
|
||
|
BusMaster (padapter, 0, 0);
|
||
|
return 0;
|
||
|
}
|
||
|
}
|
||
|
padapter->cmd = 0; // null out the command byte
|
||
|
if ( status0 )
|
||
|
return 2;
|
||
|
return 1;
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: IdeCmd :LOCAL
|
||
|
*
|
||
|
* Description: Process an IDE command.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer adapter data structure.
|
||
|
* pdev - Pointer to device.
|
||
|
*
|
||
|
* Returns: Zero if no error or status register contents on error.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static UCHAR IdeCmd (PADAPTER2220I padapter, POUR_DEVICE pdev)
|
||
|
{
|
||
|
UCHAR status;
|
||
|
|
||
|
SelectSpigot (padapter, pdev->spigot | padapter->bigD); // select the spigot
|
||
|
outb_p (pdev->byte6 | ((UCHAR *)(&padapter->startSector))[3], padapter->regLba24); // select the drive
|
||
|
status = WaitReady (padapter);
|
||
|
if ( !status )
|
||
|
{
|
||
|
outb_p (padapter->sectorCount, padapter->regSectCount);
|
||
|
outb_p (((UCHAR *)(&padapter->startSector))[0], padapter->regLba0);
|
||
|
outb_p (((UCHAR *)(&padapter->startSector))[1], padapter->regLba8);
|
||
|
outb_p (((UCHAR *)(&padapter->startSector))[2], padapter->regLba16);
|
||
|
padapter->expectingIRQ = TRUE;
|
||
|
WriteCommand (padapter, padapter->cmd);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
padapter->cmd = 0; // null out the command byte
|
||
|
return status;
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: IdeCmdBoth :LOCAL
|
||
|
*
|
||
|
* Description: Process an IDE command to both drivers.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer adapter data structure.
|
||
|
* pdev - Pointer to device structure
|
||
|
*
|
||
|
* Returns: Index + 1 of drive not failed or zero for OK.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static UCHAR IdeCmdBoth (PADAPTER2220I padapter, POUR_DEVICE pdev)
|
||
|
{
|
||
|
UCHAR status0;
|
||
|
UCHAR status1;
|
||
|
|
||
|
SelectSpigot (padapter, pdev->spigots[0] | pdev->spigots[1]); // select the spigots
|
||
|
outb_p (padapter->pdev->byte6 | ((UCHAR *)(&padapter->startSector))[3], padapter->regLba24);// select the drive
|
||
|
SelectSpigot (padapter, pdev->spigots[0]);
|
||
|
status0 = WaitReady (padapter);
|
||
|
if ( !status0 )
|
||
|
{
|
||
|
SelectSpigot (padapter, pdev->spigots[1]);
|
||
|
status1 = WaitReady (padapter);
|
||
|
if ( !status1 )
|
||
|
{
|
||
|
SelectSpigot (padapter, pdev->spigots[0] | pdev->spigots[1] | padapter->bigD);
|
||
|
outb_p (padapter->sectorCount, padapter->regSectCount);
|
||
|
outb_p (((UCHAR *)(&padapter->startSector))[0], padapter->regLba0);
|
||
|
outb_p (((UCHAR *)(&padapter->startSector))[1], padapter->regLba8);
|
||
|
outb_p (((UCHAR *)(&padapter->startSector))[2], padapter->regLba16);
|
||
|
padapter->expectingIRQ = TRUE;
|
||
|
WriteCommand (padapter, padapter->cmd);
|
||
|
return 0;
|
||
|
}
|
||
|
}
|
||
|
padapter->cmd = 0; // null out the command byte
|
||
|
if ( status0 )
|
||
|
return 2;
|
||
|
return 1;
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: OpDone :LOCAL
|
||
|
*
|
||
|
* Description: Complete an operatoin done sequence.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer to host data block.
|
||
|
* spigot - Spigot select code.
|
||
|
* device - Device byte code.
|
||
|
*
|
||
|
* Returns: Nothing.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static void OpDone (PADAPTER2220I padapter, ULONG result)
|
||
|
{
|
||
|
Scsi_Cmnd *SCpnt = padapter->SCpnt;
|
||
|
|
||
|
if ( padapter->reconPhase )
|
||
|
{
|
||
|
padapter->reconPhase = 0;
|
||
|
if ( padapter->SCpnt )
|
||
|
{
|
||
|
Pci2220i_QueueCommand (SCpnt, SCpnt->scsi_done);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if ( padapter->reconOn )
|
||
|
{
|
||
|
ReconTimerExpiry ((unsigned long)padapter);
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
padapter->cmd = 0;
|
||
|
padapter->SCpnt = NULL;
|
||
|
padapter->pdev = NULL;
|
||
|
SCpnt->result = result;
|
||
|
SCpnt->scsi_done (SCpnt);
|
||
|
if ( padapter->reconOn && !padapter->reconTimer.data )
|
||
|
{
|
||
|
padapter->reconTimer.expires = jiffies + (HZ / 4); // start in 1/4 second
|
||
|
padapter->reconTimer.data = (unsigned long)padapter;
|
||
|
add_timer (&padapter->reconTimer);
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: InlineIdentify :LOCAL
|
||
|
*
|
||
|
* Description: Do an intline inquiry on a drive.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer to host data block.
|
||
|
* spigot - Spigot select code.
|
||
|
* device - Device byte code.
|
||
|
*
|
||
|
* Returns: Last addressable sector or zero if none.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static ULONG InlineIdentify (PADAPTER2220I padapter, UCHAR spigot, UCHAR device)
|
||
|
{
|
||
|
PIDENTIFY_DATA pid = (PIDENTIFY_DATA)padapter->kBuffer;
|
||
|
|
||
|
SelectSpigot (padapter, spigot | SEL_IRQ_OFF); // select the spigot
|
||
|
outb_p ((device << 4) | 0xA0, padapter->regLba24); // select the drive
|
||
|
if ( WaitReady (padapter) )
|
||
|
return 0;
|
||
|
WriteCommand (padapter, IDE_COMMAND_IDENTIFY);
|
||
|
if ( WaitDrq (padapter) )
|
||
|
return 0;
|
||
|
insw (padapter->regData, padapter->kBuffer, sizeof (IDENTIFY_DATA) >> 1);
|
||
|
return (pid->LBATotalSectors - 1);
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: AtapiIdentify :LOCAL
|
||
|
*
|
||
|
* Description: Do an intline inquiry on a drive.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer to host data block.
|
||
|
* pdev - Pointer to device table.
|
||
|
*
|
||
|
* Returns: TRUE on error.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static ULONG AtapiIdentify (PADAPTER2220I padapter, POUR_DEVICE pdev)
|
||
|
{
|
||
|
ATAPI_GENERAL_0 ag0;
|
||
|
USHORT zs;
|
||
|
int z;
|
||
|
|
||
|
AtapiDevice (padapter, pdev->byte6);
|
||
|
WriteCommand (padapter, IDE_COMMAND_ATAPI_IDENTIFY);
|
||
|
if ( AtapiWaitDrq (padapter, 3000) )
|
||
|
return TRUE;
|
||
|
|
||
|
*(USHORT *)&ag0 = inw_p (padapter->regData);
|
||
|
for ( z = 0; z < 255; z++ )
|
||
|
zs = inw_p (padapter->regData);
|
||
|
|
||
|
if ( ag0.ProtocolType == 2 )
|
||
|
{
|
||
|
if ( ag0.CmdDrqType == 1 )
|
||
|
pdev->cmdDrqInt = TRUE;
|
||
|
switch ( ag0.CmdPacketSize )
|
||
|
{
|
||
|
case 0:
|
||
|
pdev->packet = 6;
|
||
|
break;
|
||
|
case 1:
|
||
|
pdev->packet = 8;
|
||
|
break;
|
||
|
default:
|
||
|
pdev->packet = 6;
|
||
|
break;
|
||
|
}
|
||
|
return FALSE;
|
||
|
}
|
||
|
return TRUE;
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: Atapi2Scsi
|
||
|
*
|
||
|
* Description: Convert ATAPI data to SCSI data.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer adapter data structure.
|
||
|
* SCpnt - Pointer to SCSI command structure.
|
||
|
*
|
||
|
* Returns: Nothing.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
void Atapi2Scsi (PADAPTER2220I padapter, Scsi_Cmnd *SCpnt)
|
||
|
{
|
||
|
UCHAR *buff = padapter->currentSgBuffer;
|
||
|
|
||
|
switch ( SCpnt->cmnd[0] )
|
||
|
{
|
||
|
case SCSIOP_MODE_SENSE:
|
||
|
buff[0] = padapter->kBuffer[1];
|
||
|
buff[1] = padapter->kBuffer[2];
|
||
|
buff[2] = padapter->kBuffer[3];
|
||
|
buff[3] = padapter->kBuffer[7];
|
||
|
memcpy (&buff[4], &padapter->kBuffer[8], padapter->atapiCdb[8] - 8);
|
||
|
break;
|
||
|
case SCSIOP_INQUIRY:
|
||
|
padapter->kBuffer[2] = 2;
|
||
|
memcpy (buff, padapter->kBuffer, padapter->currentSgCount);
|
||
|
break;
|
||
|
default:
|
||
|
if ( padapter->readCount )
|
||
|
WalkScatGath (padapter, TRUE, padapter->readCount);
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: Scsi2Atapi
|
||
|
*
|
||
|
* Description: Convert SCSI packet command to Atapi packet command.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer adapter data structure.
|
||
|
* SCpnt - Pointer to SCSI command structure.
|
||
|
*
|
||
|
* Returns: Nothing.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static void Scsi2Atapi (PADAPTER2220I padapter, Scsi_Cmnd *SCpnt)
|
||
|
{
|
||
|
UCHAR *cdb = SCpnt->cmnd;
|
||
|
UCHAR *buff = padapter->currentSgBuffer;
|
||
|
|
||
|
switch (cdb[0])
|
||
|
{
|
||
|
case SCSIOP_READ6:
|
||
|
padapter->atapiCdb[0] = SCSIOP_READ;
|
||
|
padapter->atapiCdb[1] = cdb[1] & 0xE0;
|
||
|
padapter->atapiCdb[3] = cdb[1] & 0x1F;
|
||
|
padapter->atapiCdb[4] = cdb[2];
|
||
|
padapter->atapiCdb[5] = cdb[3];
|
||
|
padapter->atapiCdb[8] = cdb[4];
|
||
|
padapter->atapiCdb[9] = cdb[5];
|
||
|
break;
|
||
|
case SCSIOP_WRITE6:
|
||
|
padapter->atapiCdb[0] = SCSIOP_WRITE;
|
||
|
padapter->atapiCdb[1] = cdb[1] & 0xE0;
|
||
|
padapter->atapiCdb[3] = cdb[1] & 0x1F;
|
||
|
padapter->atapiCdb[4] = cdb[2];
|
||
|
padapter->atapiCdb[5] = cdb[3];
|
||
|
padapter->atapiCdb[8] = cdb[4];
|
||
|
padapter->atapiCdb[9] = cdb[5];
|
||
|
break;
|
||
|
case SCSIOP_MODE_SENSE:
|
||
|
padapter->atapiCdb[0] = SCSIOP_MODE_SENSE10;
|
||
|
padapter->atapiCdb[2] = cdb[2];
|
||
|
padapter->atapiCdb[8] = cdb[4] + 4;
|
||
|
break;
|
||
|
|
||
|
case SCSIOP_MODE_SELECT:
|
||
|
padapter->atapiSpecial = TRUE;
|
||
|
padapter->atapiCdb[0] = SCSIOP_MODE_SELECT10;
|
||
|
padapter->atapiCdb[1] = cdb[1] | 0x10;
|
||
|
memcpy (padapter->kBuffer, buff, 4);
|
||
|
padapter->kBuffer[4] = padapter->kBuffer[5] = 0;
|
||
|
padapter->kBuffer[6] = padapter->kBuffer[7] = 0;
|
||
|
memcpy (&padapter->kBuffer[8], &buff[4], cdb[4] - 4);
|
||
|
padapter->atapiCdb[8] = cdb[4] + 4;
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: AtapiSendCdb
|
||
|
*
|
||
|
* Description: Send the CDB packet to the device.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer adapter data structure.
|
||
|
* pdev - Pointer to device.
|
||
|
* cdb - Pointer to 16 byte SCSI cdb.
|
||
|
*
|
||
|
* Returns: Nothing.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static void AtapiSendCdb (PADAPTER2220I padapter, POUR_DEVICE pdev, CHAR *cdb)
|
||
|
{
|
||
|
DEB (printk ("\nPCI2242I: CDB: %X %X %X %X %X %X %X %X %X %X %X %X", cdb[0], cdb[1], cdb[2], cdb[3], cdb[4], cdb[5], cdb[6], cdb[7], cdb[8], cdb[9], cdb[10], cdb[11]));
|
||
|
outsw (padapter->regData, cdb, pdev->packet);
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: AtapiRequestSense
|
||
|
*
|
||
|
* Description: Send the CDB packet to the device.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer adapter data structure.
|
||
|
* pdev - Pointer to device.
|
||
|
* SCpnt - Pointer to SCSI command structure.
|
||
|
* pass - If true then this is the second pass to send cdb.
|
||
|
*
|
||
|
* Returns: TRUE on error.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static int AtapiRequestSense (PADAPTER2220I padapter, POUR_DEVICE pdev, Scsi_Cmnd *SCpnt, UCHAR pass)
|
||
|
{
|
||
|
UCHAR cdb[16] = {SCSIOP_REQUEST_SENSE,0,0,0,16,0,0,0,0,0,0,0,0,0,0,0};
|
||
|
|
||
|
DEB (printk ("\nPCI2242I: AUTO REQUEST SENSE"));
|
||
|
cdb[4] = (UCHAR)(sizeof (SCpnt->sense_buffer));
|
||
|
if ( !pass )
|
||
|
{
|
||
|
padapter->reqSense = TRUE;
|
||
|
AtapiCountLo (padapter, cdb[4]);
|
||
|
AtapiCountHi (padapter, 0);
|
||
|
outb_p (0, padapter->regError);
|
||
|
WriteCommand (padapter, IDE_COMMAND_ATAPI_PACKET);
|
||
|
if ( pdev->cmdDrqInt )
|
||
|
return FALSE;
|
||
|
|
||
|
if ( AtapiWaitDrq (padapter, 500) )
|
||
|
return TRUE;
|
||
|
}
|
||
|
AtapiSendCdb (padapter, pdev, cdb);
|
||
|
return FALSE;
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: InlineReadSignature :LOCAL
|
||
|
*
|
||
|
* Description: Do an inline read RAID sigature.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer adapter data structure.
|
||
|
* pdev - Pointer to device.
|
||
|
* index - index of data to read.
|
||
|
*
|
||
|
* Returns: Zero if no error or status register contents on error.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static UCHAR InlineReadSignature (PADAPTER2220I padapter, POUR_DEVICE pdev, int index)
|
||
|
{
|
||
|
UCHAR status;
|
||
|
ULONG zl = pdev->lastsectorlba[index];
|
||
|
|
||
|
SelectSpigot (padapter, pdev->spigots[index] | SEL_IRQ_OFF); // select the spigot without interrupts
|
||
|
outb_p (pdev->byte6 | ((UCHAR *)&zl)[3], padapter->regLba24);
|
||
|
status = WaitReady (padapter);
|
||
|
if ( !status )
|
||
|
{
|
||
|
outb_p (((UCHAR *)&zl)[2], padapter->regLba16);
|
||
|
outb_p (((UCHAR *)&zl)[1], padapter->regLba8);
|
||
|
outb_p (((UCHAR *)&zl)[0], padapter->regLba0);
|
||
|
outb_p (1, padapter->regSectCount);
|
||
|
WriteCommand (padapter, IDE_COMMAND_READ);
|
||
|
status = WaitDrq (padapter);
|
||
|
if ( !status )
|
||
|
{
|
||
|
insw (padapter->regData, padapter->kBuffer, BYTES_PER_SECTOR / 2);
|
||
|
((ULONG *)(&pdev->DiskMirror[index]))[0] = ((ULONG *)(&padapter->kBuffer[DISK_MIRROR_POSITION]))[0];
|
||
|
((ULONG *)(&pdev->DiskMirror[index]))[1] = ((ULONG *)(&padapter->kBuffer[DISK_MIRROR_POSITION]))[1];
|
||
|
// some drives assert DRQ before IRQ so let's make sure we clear the IRQ
|
||
|
WaitReady (padapter);
|
||
|
return 0;
|
||
|
}
|
||
|
}
|
||
|
return status;
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: DecodeError :LOCAL
|
||
|
*
|
||
|
* Description: Decode and process device errors.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer to adapter data.
|
||
|
* status - Status register code.
|
||
|
*
|
||
|
* Returns: The driver status code.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static ULONG DecodeError (PADAPTER2220I padapter, UCHAR status)
|
||
|
{
|
||
|
UCHAR error;
|
||
|
|
||
|
padapter->expectingIRQ = 0;
|
||
|
if ( status & IDE_STATUS_WRITE_FAULT )
|
||
|
{
|
||
|
return DID_PARITY << 16;
|
||
|
}
|
||
|
if ( status & IDE_STATUS_BUSY )
|
||
|
return DID_BUS_BUSY << 16;
|
||
|
|
||
|
error = inb_p (padapter->regError);
|
||
|
DEB(printk ("\npci2220i error register: %x", error));
|
||
|
switch ( error )
|
||
|
{
|
||
|
case IDE_ERROR_AMNF:
|
||
|
case IDE_ERROR_TKONF:
|
||
|
case IDE_ERROR_ABRT:
|
||
|
case IDE_ERROR_IDFN:
|
||
|
case IDE_ERROR_UNC:
|
||
|
case IDE_ERROR_BBK:
|
||
|
default:
|
||
|
return DID_ERROR << 16;
|
||
|
}
|
||
|
return DID_ERROR << 16;
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: StartTimer :LOCAL
|
||
|
*
|
||
|
* Description: Start the timer.
|
||
|
*
|
||
|
* Parameters: ipadapter - Pointer adapter data structure.
|
||
|
*
|
||
|
* Returns: Nothing.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static void StartTimer (PADAPTER2220I padapter)
|
||
|
{
|
||
|
padapter->timer.expires = jiffies + TIMEOUT_DATA;
|
||
|
add_timer (&padapter->timer);
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: WriteSignature :LOCAL
|
||
|
*
|
||
|
* Description: Start the timer.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer adapter data structure.
|
||
|
* pdev - Pointer to our device.
|
||
|
* spigot - Selected spigot.
|
||
|
* index - index of mirror signature on device.
|
||
|
*
|
||
|
* Returns: TRUE on any error.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static int WriteSignature (PADAPTER2220I padapter, POUR_DEVICE pdev, UCHAR spigot, int index)
|
||
|
{
|
||
|
ULONG zl;
|
||
|
|
||
|
SelectSpigot (padapter, spigot);
|
||
|
zl = pdev->lastsectorlba[index];
|
||
|
outb_p (pdev->byte6 | ((UCHAR *)&zl)[3], padapter->regLba24);
|
||
|
outb_p (((UCHAR *)&zl)[2], padapter->regLba16);
|
||
|
outb_p (((UCHAR *)&zl)[1], padapter->regLba8);
|
||
|
outb_p (((UCHAR *)&zl)[0], padapter->regLba0);
|
||
|
outb_p (1, padapter->regSectCount);
|
||
|
|
||
|
WriteCommand (padapter, IDE_COMMAND_WRITE);
|
||
|
if ( WaitDrq (padapter) )
|
||
|
return TRUE;
|
||
|
StartTimer (padapter);
|
||
|
padapter->expectingIRQ = TRUE;
|
||
|
|
||
|
((ULONG *)(&padapter->kBuffer[DISK_MIRROR_POSITION]))[0] = ((ULONG *)(&pdev->DiskMirror[index]))[0];
|
||
|
((ULONG *)(&padapter->kBuffer[DISK_MIRROR_POSITION]))[1] = ((ULONG *)(&pdev->DiskMirror[index]))[1];
|
||
|
outsw (padapter->regData, padapter->kBuffer, BYTES_PER_SECTOR / 2);
|
||
|
return FALSE;
|
||
|
}
|
||
|
/*******************************************************************************************************
|
||
|
* Name: InitFailover
|
||
|
*
|
||
|
* Description: This is the beginning of the failover routine
|
||
|
*
|
||
|
* Parameters: SCpnt - Pointer to SCSI command structure.
|
||
|
* padapter - Pointer adapter data structure.
|
||
|
* pdev - Pointer to our device.
|
||
|
*
|
||
|
* Returns: TRUE on error.
|
||
|
*
|
||
|
******************************************************************************************************/
|
||
|
static int InitFailover (PADAPTER2220I padapter, POUR_DEVICE pdev)
|
||
|
{
|
||
|
UCHAR spigot;
|
||
|
|
||
|
DEB (printk ("\npci2220i: Initialize failover process - survivor = %d", pdev->deviceID[padapter->survivor]));
|
||
|
pdev->raid = FALSE; //initializes system for non raid mode
|
||
|
pdev->reconOn = FALSE;
|
||
|
spigot = pdev->spigots[padapter->survivor];
|
||
|
|
||
|
if ( pdev->DiskMirror[padapter->survivor].status & UCBF_REBUILD )
|
||
|
{
|
||
|
DEB (printk ("\n failed, is survivor"));
|
||
|
return (TRUE);
|
||
|
}
|
||
|
|
||
|
if ( HardReset (padapter, pdev, spigot) )
|
||
|
{
|
||
|
DEB (printk ("\n failed, reset"));
|
||
|
return TRUE;
|
||
|
}
|
||
|
|
||
|
Alarm (padapter, pdev->deviceID[padapter->survivor ^ 1]);
|
||
|
pdev->DiskMirror[padapter->survivor].status = UCBF_MIRRORED | UCBF_SURVIVOR; //clear present status
|
||
|
|
||
|
if ( WriteSignature (padapter, pdev, spigot, padapter->survivor) )
|
||
|
{
|
||
|
DEB (printk ("\n failed, write signature"));
|
||
|
return TRUE;
|
||
|
}
|
||
|
padapter->failinprog = TRUE;
|
||
|
return FALSE;
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: TimerExpiry :LOCAL
|
||
|
*
|
||
|
* Description: Timer expiry routine.
|
||
|
*
|
||
|
* Parameters: data - Pointer adapter data structure.
|
||
|
*
|
||
|
* Returns: Nothing.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static void TimerExpiry (unsigned long data)
|
||
|
{
|
||
|
PADAPTER2220I padapter = (PADAPTER2220I)data;
|
||
|
struct Scsi_Host *host = padapter->SCpnt->device->host;
|
||
|
POUR_DEVICE pdev = padapter->pdev;
|
||
|
UCHAR status = IDE_STATUS_BUSY;
|
||
|
UCHAR temp, temp1;
|
||
|
unsigned long flags;
|
||
|
|
||
|
/*
|
||
|
* Disable interrupts, if they aren't already disabled and acquire
|
||
|
* the I/O spinlock.
|
||
|
*/
|
||
|
spin_lock_irqsave (host->host_lock, flags);
|
||
|
DEB (printk ("\nPCI2220I: Timeout expired "));
|
||
|
|
||
|
if ( padapter->failinprog )
|
||
|
{
|
||
|
DEB (printk ("in failover process"));
|
||
|
OpDone (padapter, DecodeError (padapter, inb_p (padapter->regStatCmd)));
|
||
|
goto timerExpiryDone;
|
||
|
}
|
||
|
|
||
|
while ( padapter->reconPhase )
|
||
|
{
|
||
|
DEB (printk ("in recon phase %X", padapter->reconPhase));
|
||
|
switch ( padapter->reconPhase )
|
||
|
{
|
||
|
case RECON_PHASE_MARKING:
|
||
|
case RECON_PHASE_LAST:
|
||
|
padapter->survivor = ( pdev->spigot == pdev->spigots[0] ) ? 1 : 0;
|
||
|
DEB (printk ("\npci2220i: FAILURE 1"));
|
||
|
if ( InitFailover (padapter, pdev) )
|
||
|
OpDone (padapter, DID_ERROR << 16);
|
||
|
goto timerExpiryDone;
|
||
|
|
||
|
case RECON_PHASE_READY:
|
||
|
OpDone (padapter, DID_ERROR << 16);
|
||
|
goto timerExpiryDone;
|
||
|
|
||
|
case RECON_PHASE_COPY:
|
||
|
padapter->survivor = ( pdev->spigot == pdev->spigots[0] ) ? 0 : 1;
|
||
|
DEB (printk ("\npci2220i: FAILURE 2"));
|
||
|
DEB (printk ("\n spig/stat = %X", inb_p (padapter->regStatSel));
|
||
|
if ( InitFailover (padapter, pdev) )
|
||
|
OpDone (padapter, DID_ERROR << 16);
|
||
|
goto timerExpiryDone;
|
||
|
|
||
|
case RECON_PHASE_UPDATE:
|
||
|
padapter->survivor = ( pdev->spigot == pdev->spigots[0] ) ? 0 : 1;
|
||
|
DEB (printk ("\npci2220i: FAILURE 3")));
|
||
|
if ( InitFailover (padapter, pdev) )
|
||
|
OpDone (padapter, DID_ERROR << 16);
|
||
|
goto timerExpiryDone;
|
||
|
|
||
|
case RECON_PHASE_END:
|
||
|
padapter->survivor = ( pdev->spigot == pdev->spigots[0] ) ? 0 : 1;
|
||
|
DEB (printk ("\npci2220i: FAILURE 4"));
|
||
|
if ( InitFailover (padapter, pdev) )
|
||
|
OpDone (padapter, DID_ERROR << 16);
|
||
|
goto timerExpiryDone;
|
||
|
|
||
|
default:
|
||
|
goto timerExpiryDone;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
while ( padapter->cmd )
|
||
|
{
|
||
|
outb_p (0x08, padapter->regDmaCmdStat); // cancel interrupt from DMA engine
|
||
|
if ( pdev->raid )
|
||
|
{
|
||
|
if ( padapter->cmd == WRITE_CMD )
|
||
|
{
|
||
|
DEB (printk ("in RAID write operation"));
|
||
|
temp = ( pdev->spigot & (SEL_1 | SEL_2) ) ? SEL_1 : SEL_3;
|
||
|
if ( inb_p (padapter->regStatSel) & temp )
|
||
|
{
|
||
|
DEB (printk ("\npci2220i: Determined A OK"));
|
||
|
SelectSpigot (padapter, temp | SEL_IRQ_OFF); // Masking the interrupt during spigot select
|
||
|
temp = inb_p (padapter->regStatCmd);
|
||
|
}
|
||
|
else
|
||
|
temp = IDE_STATUS_BUSY;
|
||
|
|
||
|
temp1 = ( pdev->spigot & (SEL_1 | SEL_2) ) ? SEL_2 : SEL_4;
|
||
|
if ( inb (padapter->regStatSel) & temp1 )
|
||
|
{
|
||
|
DEB (printk ("\npci2220i: Determined B OK"));
|
||
|
SelectSpigot (padapter, temp1 | SEL_IRQ_OFF); // Masking the interrupt during spigot select
|
||
|
temp1 = inb_p (padapter->regStatCmd);
|
||
|
}
|
||
|
else
|
||
|
temp1 = IDE_STATUS_BUSY;
|
||
|
|
||
|
if ( (temp & IDE_STATUS_BUSY) || (temp1 & IDE_STATUS_BUSY) )
|
||
|
{
|
||
|
DEB (printk ("\npci2220i: Status A: %X B: %X", temp & 0xFF, temp1 & 0xFF));
|
||
|
if ( (temp & IDE_STATUS_BUSY) && (temp1 & IDE_STATUS_BUSY) )
|
||
|
{
|
||
|
status = temp;
|
||
|
break;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if ( temp & IDE_STATUS_BUSY )
|
||
|
padapter->survivor = 1;
|
||
|
else
|
||
|
padapter->survivor = 0;
|
||
|
if ( InitFailover (padapter, pdev) )
|
||
|
{
|
||
|
status = inb_p (padapter->regStatCmd);
|
||
|
break;
|
||
|
}
|
||
|
goto timerExpiryDone;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
DEB (printk ("in RAID read operation"));
|
||
|
padapter->survivor = ( pdev->spigot == pdev->spigots[0] ) ? 0 : 1;
|
||
|
DEB (printk ("\npci2220i: FAILURE 6"));
|
||
|
if ( InitFailover (padapter, pdev) )
|
||
|
{
|
||
|
status = inb_p (padapter->regStatCmd);
|
||
|
break;
|
||
|
}
|
||
|
goto timerExpiryDone;
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
DEB (printk ("in I/O operation"));
|
||
|
status = inb_p (padapter->regStatCmd);
|
||
|
}
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
OpDone (padapter, DecodeError (padapter, status));
|
||
|
|
||
|
timerExpiryDone:;
|
||
|
/*
|
||
|
* Release the I/O spinlock and restore the original flags
|
||
|
* which will enable interrupts if and only if they were
|
||
|
* enabled on entry.
|
||
|
*/
|
||
|
spin_unlock_irqrestore (host->host_lock, flags);
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: SetReconstruct :LOCAL
|
||
|
*
|
||
|
* Description: Set the reconstruct up.
|
||
|
*
|
||
|
* Parameters: pdev - Pointer to device structure.
|
||
|
* index - Mirror index number.
|
||
|
*
|
||
|
* Returns: Number of sectors on new disk required.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static LONG SetReconstruct (POUR_DEVICE pdev, int index)
|
||
|
{
|
||
|
pdev->DiskMirror[index].status = UCBF_MIRRORED; // setup the flags
|
||
|
pdev->DiskMirror[index ^ 1].status = UCBF_MIRRORED | UCBF_REBUILD;
|
||
|
pdev->DiskMirror[index ^ 1].reconstructPoint = 0; // start the reconstruct
|
||
|
pdev->reconCount = 1990; // mark target drive early
|
||
|
return pdev->DiskMirror[index].reconstructPoint;
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: ReconTimerExpiry :LOCAL
|
||
|
*
|
||
|
* Description: Reconstruct timer expiry routine.
|
||
|
*
|
||
|
* Parameters: data - Pointer adapter data structure.
|
||
|
*
|
||
|
* Returns: Nothing.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static void ReconTimerExpiry (unsigned long data)
|
||
|
{
|
||
|
PADAPTER2220I padapter = (PADAPTER2220I)data;
|
||
|
struct Scsi_Host *host = padapter->SCpnt->device->host;
|
||
|
POUR_DEVICE pdev;
|
||
|
ULONG testsize = 0;
|
||
|
PIDENTIFY_DATA pid;
|
||
|
USHORT minmode;
|
||
|
ULONG zl;
|
||
|
UCHAR zc;
|
||
|
USHORT z;
|
||
|
unsigned long flags;
|
||
|
|
||
|
/*
|
||
|
* Disable interrupts, if they aren't already disabled and acquire
|
||
|
* the I/O spinlock.
|
||
|
*/
|
||
|
spin_lock_irqsave(host->host_lock, flags);
|
||
|
|
||
|
if ( padapter->SCpnt )
|
||
|
goto reconTimerExpiry;
|
||
|
|
||
|
padapter->reconTimer.data = 0;
|
||
|
for ( z = padapter->devInReconIndex + 1; z < BIGD_MAXDRIVES; z++ )
|
||
|
{
|
||
|
if ( padapter->device[z].reconOn )
|
||
|
break;
|
||
|
}
|
||
|
if ( z < BIGD_MAXDRIVES )
|
||
|
pdev = &padapter->device[z];
|
||
|
else
|
||
|
{
|
||
|
for ( z = 0; z < BIGD_MAXDRIVES; z++ )
|
||
|
{
|
||
|
if ( padapter->device[z].reconOn )
|
||
|
break;
|
||
|
}
|
||
|
if ( z < BIGD_MAXDRIVES )
|
||
|
pdev = &padapter->device[z];
|
||
|
else
|
||
|
{
|
||
|
padapter->reconOn = FALSE;
|
||
|
goto reconTimerExpiry;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
padapter->devInReconIndex = z;
|
||
|
pid = (PIDENTIFY_DATA)padapter->kBuffer;
|
||
|
padapter->pdev = pdev;
|
||
|
if ( pdev->reconIsStarting )
|
||
|
{
|
||
|
pdev->reconIsStarting = FALSE;
|
||
|
pdev->reconOn = FALSE;
|
||
|
|
||
|
while ( (pdev->DiskMirror[0].signature == SIGNATURE) && (pdev->DiskMirror[1].signature == SIGNATURE) &&
|
||
|
(pdev->DiskMirror[0].pairIdentifier == (pdev->DiskMirror[1].pairIdentifier ^ 1)) )
|
||
|
{
|
||
|
if ( (pdev->DiskMirror[0].status & UCBF_MATCHED) && (pdev->DiskMirror[1].status & UCBF_MATCHED) )
|
||
|
break;
|
||
|
|
||
|
if ( pdev->DiskMirror[0].status & UCBF_SURVIVOR ) // is first drive survivor?
|
||
|
testsize = SetReconstruct (pdev, 0);
|
||
|
else
|
||
|
if ( pdev->DiskMirror[1].status & UCBF_SURVIVOR ) // is second drive survivor?
|
||
|
testsize = SetReconstruct (pdev, 1);
|
||
|
|
||
|
if ( (pdev->DiskMirror[0].status & UCBF_REBUILD) || (pdev->DiskMirror[1].status & UCBF_REBUILD) )
|
||
|
{
|
||
|
if ( pdev->DiskMirror[0].status & UCBF_REBUILD )
|
||
|
pdev->mirrorRecon = 0;
|
||
|
else
|
||
|
pdev->mirrorRecon = 1;
|
||
|
pdev->reconOn = TRUE;
|
||
|
}
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
if ( !pdev->reconOn )
|
||
|
goto reconTimerExpiry;
|
||
|
|
||
|
if ( padapter->bigD )
|
||
|
{
|
||
|
padapter->failRegister = 0;
|
||
|
outb_p (~padapter->failRegister, padapter->regFail);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
zc = ((inb_p (padapter->regStatSel) >> 3) | inb_p (padapter->regStatSel)) & 0x83; // mute the alarm
|
||
|
outb_p (0xFF, padapter->regFail);
|
||
|
}
|
||
|
|
||
|
while ( 1 )
|
||
|
{
|
||
|
DEB (printk ("\npci2220i: hard reset issue"));
|
||
|
if ( HardReset (padapter, pdev, pdev->spigots[pdev->mirrorRecon]) )
|
||
|
{
|
||
|
DEB (printk ("\npci2220i: sub 1"));
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
pdev->lastsectorlba[pdev->mirrorRecon] = InlineIdentify (padapter, pdev->spigots[pdev->mirrorRecon], pdev->deviceID[pdev->mirrorRecon] & 1);
|
||
|
|
||
|
if ( pdev->lastsectorlba[pdev->mirrorRecon] < testsize )
|
||
|
{
|
||
|
DEB (printk ("\npci2220i: sub 2 %ld %ld", pdev->lastsectorlba[pdev->mirrorRecon], testsize));
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
// test LBA and multiper sector transfer compatibility
|
||
|
if (!pid->SupportLBA || (pid->NumSectorsPerInt < SECTORSXFER) || !pid->Valid_64_70 )
|
||
|
{
|
||
|
DEB (printk ("\npci2220i: sub 3"));
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
// test PIO/bus matering mode compatibility
|
||
|
if ( (pid->MinPIOCycleWithoutFlow > 240) && !pid->SupportIORDYDisable && !padapter->timingPIO )
|
||
|
{
|
||
|
DEB (printk ("\npci2220i: sub 4"));
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
if ( pid->MinPIOCycleWithoutFlow <= 120 ) // setup timing mode of drive
|
||
|
minmode = 5;
|
||
|
else
|
||
|
{
|
||
|
if ( pid->MinPIOCylceWithFlow <= 150 )
|
||
|
minmode = 4;
|
||
|
else
|
||
|
{
|
||
|
if ( pid->MinPIOCylceWithFlow <= 180 )
|
||
|
minmode = 3;
|
||
|
else
|
||
|
{
|
||
|
if ( pid->MinPIOCylceWithFlow <= 240 )
|
||
|
minmode = 2;
|
||
|
else
|
||
|
{
|
||
|
DEB (printk ("\npci2220i: sub 5"));
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if ( padapter->timingMode > minmode ) // set minimum timing mode
|
||
|
padapter->timingMode = minmode;
|
||
|
if ( padapter->timingMode >= 2 )
|
||
|
padapter->timingAddress = ModeArray[padapter->timingMode - 2];
|
||
|
else
|
||
|
padapter->timingPIO = TRUE;
|
||
|
|
||
|
padapter->reconOn = TRUE;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
if ( !pdev->reconOn )
|
||
|
{
|
||
|
padapter->survivor = pdev->mirrorRecon ^ 1;
|
||
|
padapter->reconPhase = RECON_PHASE_FAILOVER;
|
||
|
DEB (printk ("\npci2220i: FAILURE 7"));
|
||
|
InitFailover (padapter, pdev);
|
||
|
goto reconTimerExpiry;
|
||
|
}
|
||
|
|
||
|
pdev->raid = TRUE;
|
||
|
|
||
|
if ( WriteSignature (padapter, pdev, pdev->spigot, pdev->mirrorRecon ^ 1) )
|
||
|
goto reconTimerExpiry;
|
||
|
padapter->reconPhase = RECON_PHASE_MARKING;
|
||
|
goto reconTimerExpiry;
|
||
|
}
|
||
|
|
||
|
//**********************************
|
||
|
// reconstruct copy starts here
|
||
|
//**********************************
|
||
|
if ( pdev->reconCount++ > 2000 )
|
||
|
{
|
||
|
pdev->reconCount = 0;
|
||
|
if ( WriteSignature (padapter, pdev, pdev->spigots[pdev->mirrorRecon], pdev->mirrorRecon) )
|
||
|
{
|
||
|
padapter->survivor = pdev->mirrorRecon ^ 1;
|
||
|
padapter->reconPhase = RECON_PHASE_FAILOVER;
|
||
|
DEB (printk ("\npci2220i: FAILURE 8"));
|
||
|
InitFailover (padapter, pdev);
|
||
|
goto reconTimerExpiry;
|
||
|
}
|
||
|
padapter->reconPhase = RECON_PHASE_UPDATE;
|
||
|
goto reconTimerExpiry;
|
||
|
}
|
||
|
|
||
|
zl = pdev->DiskMirror[pdev->mirrorRecon].reconstructPoint;
|
||
|
padapter->reconSize = pdev->DiskMirror[pdev->mirrorRecon ^ 1].reconstructPoint - zl;
|
||
|
if ( padapter->reconSize > MAX_BUS_MASTER_BLOCKS )
|
||
|
padapter->reconSize = MAX_BUS_MASTER_BLOCKS;
|
||
|
|
||
|
if ( padapter->reconSize )
|
||
|
{
|
||
|
SelectSpigot (padapter, pdev->spigots[0] | pdev->spigots[1]); // select the spigots
|
||
|
outb_p (pdev->byte6 | ((UCHAR *)(&zl))[3], padapter->regLba24); // select the drive
|
||
|
SelectSpigot (padapter, pdev->spigot);
|
||
|
if ( WaitReady (padapter) )
|
||
|
goto reconTimerExpiry;
|
||
|
|
||
|
SelectSpigot (padapter, pdev->spigots[pdev->mirrorRecon]);
|
||
|
if ( WaitReady (padapter) )
|
||
|
{
|
||
|
padapter->survivor = pdev->mirrorRecon ^ 1;
|
||
|
padapter->reconPhase = RECON_PHASE_FAILOVER;
|
||
|
DEB (printk ("\npci2220i: FAILURE 9"));
|
||
|
InitFailover (padapter, pdev);
|
||
|
goto reconTimerExpiry;
|
||
|
}
|
||
|
|
||
|
SelectSpigot (padapter, pdev->spigots[0] | pdev->spigots[1]);
|
||
|
outb_p (padapter->reconSize & 0xFF, padapter->regSectCount);
|
||
|
outb_p (((UCHAR *)(&zl))[0], padapter->regLba0);
|
||
|
outb_p (((UCHAR *)(&zl))[1], padapter->regLba8);
|
||
|
outb_p (((UCHAR *)(&zl))[2], padapter->regLba16);
|
||
|
padapter->expectingIRQ = TRUE;
|
||
|
padapter->reconPhase = RECON_PHASE_READY;
|
||
|
SelectSpigot (padapter, pdev->spigots[pdev->mirrorRecon]);
|
||
|
WriteCommand (padapter, WRITE_CMD);
|
||
|
StartTimer (padapter);
|
||
|
SelectSpigot (padapter, pdev->spigot);
|
||
|
WriteCommand (padapter, READ_CMD);
|
||
|
goto reconTimerExpiry;
|
||
|
}
|
||
|
|
||
|
pdev->DiskMirror[pdev->mirrorRecon].status = UCBF_MIRRORED | UCBF_MATCHED;
|
||
|
pdev->DiskMirror[pdev->mirrorRecon ^ 1].status = UCBF_MIRRORED | UCBF_MATCHED;
|
||
|
if ( WriteSignature (padapter, pdev, pdev->spigot, pdev->mirrorRecon ^ 1) )
|
||
|
goto reconTimerExpiry;
|
||
|
padapter->reconPhase = RECON_PHASE_LAST;
|
||
|
|
||
|
reconTimerExpiry:;
|
||
|
/*
|
||
|
* Release the I/O spinlock and restore the original flags
|
||
|
* which will enable interrupts if and only if they were
|
||
|
* enabled on entry.
|
||
|
*/
|
||
|
spin_unlock_irqrestore(host->host_lock, flags);
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: Irq_Handler :LOCAL
|
||
|
*
|
||
|
* Description: Interrupt handler.
|
||
|
*
|
||
|
* Parameters: irq - Hardware IRQ number.
|
||
|
* dev_id -
|
||
|
* regs -
|
||
|
*
|
||
|
* Returns: TRUE if drive is not ready in time.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static irqreturn_t Irq_Handler (int irq, void *dev_id, struct pt_regs *regs)
|
||
|
{
|
||
|
struct Scsi_Host *shost = NULL; // Pointer to host data block
|
||
|
PADAPTER2220I padapter; // Pointer to adapter control structure
|
||
|
POUR_DEVICE pdev;
|
||
|
Scsi_Cmnd *SCpnt;
|
||
|
UCHAR status;
|
||
|
UCHAR status1;
|
||
|
ATAPI_STATUS statusa;
|
||
|
ATAPI_REASON reasona;
|
||
|
ATAPI_ERROR errora;
|
||
|
int z;
|
||
|
ULONG zl;
|
||
|
unsigned long flags;
|
||
|
int handled = 0;
|
||
|
|
||
|
// DEB (printk ("\npci2220i received interrupt\n"));
|
||
|
|
||
|
for ( z = 0; z < NumAdapters; z++ ) // scan for interrupt to process
|
||
|
{
|
||
|
if ( PsiHost[z]->irq == (UCHAR)(irq & 0xFF) )
|
||
|
{
|
||
|
if ( inw_p (HOSTDATA(PsiHost[z])->regIrqControl) & 0x8000 )
|
||
|
{
|
||
|
shost = PsiHost[z];
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if ( !shost )
|
||
|
{
|
||
|
DEB (printk ("\npci2220i: not my interrupt"));
|
||
|
goto out;
|
||
|
}
|
||
|
|
||
|
handled = 1;
|
||
|
spin_lock_irqsave(shost->host_lock, flags);
|
||
|
padapter = HOSTDATA(shost);
|
||
|
pdev = padapter->pdev;
|
||
|
SCpnt = padapter->SCpnt;
|
||
|
outb_p (0x08, padapter->regDmaCmdStat); // cancel interrupt from DMA engine
|
||
|
|
||
|
if ( padapter->atapi && SCpnt )
|
||
|
{
|
||
|
*(char *)&statusa = inb_p (padapter->regStatCmd); // read the device status
|
||
|
*(char *)&reasona = inb_p (padapter->regSectCount); // read the device interrupt reason
|
||
|
|
||
|
if ( !statusa.bsy )
|
||
|
{
|
||
|
if ( statusa.drq ) // test for transfer phase
|
||
|
{
|
||
|
if ( !reasona.cod ) // test for data phase
|
||
|
{
|
||
|
z = (ULONG)inb_p (padapter->regLba8) | (ULONG)(inb_p (padapter->regLba16) << 8);
|
||
|
if ( padapter->reqSense )
|
||
|
insw (padapter->regData, SCpnt->sense_buffer, z / 2);
|
||
|
else
|
||
|
AtapiBusMaster (padapter, reasona.io, z);
|
||
|
goto irq_return;
|
||
|
}
|
||
|
if ( reasona.cod && !reasona.io ) // test for command packet phase
|
||
|
{
|
||
|
if ( padapter->reqSense )
|
||
|
AtapiRequestSense (padapter, pdev, SCpnt, TRUE);
|
||
|
else
|
||
|
AtapiSendCdb (padapter, pdev, padapter->atapiCdb);
|
||
|
goto irq_return;
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if ( reasona.io && statusa.drdy ) // test for status phase
|
||
|
{
|
||
|
Atapi2Scsi (padapter, SCpnt);
|
||
|
if ( statusa.check )
|
||
|
{
|
||
|
*(UCHAR *)&errora = inb_p (padapter->regError); // read the device error
|
||
|
if ( errora.senseKey )
|
||
|
{
|
||
|
if ( padapter->reqSense || AtapiRequestSense (padapter, pdev, SCpnt, FALSE) )
|
||
|
OpDone (padapter, DID_ERROR << 16);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if ( errora.ili || errora.abort )
|
||
|
OpDone (padapter, DID_ERROR << 16);
|
||
|
else
|
||
|
OpDone (padapter, DID_OK << 16);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
if ( padapter->reqSense )
|
||
|
{
|
||
|
DEB (printk ("PCI2242I: Sense codes - %X %X %X ", ((UCHAR *)SCpnt->sense_buffer)[0], ((UCHAR *)SCpnt->sense_buffer)[12], ((UCHAR *)SCpnt->sense_buffer)[13]));
|
||
|
OpDone (padapter, (DRIVER_SENSE << 24) | (DID_OK << 16) | 2);
|
||
|
}
|
||
|
else
|
||
|
OpDone (padapter, DID_OK << 16);
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
goto irq_return;
|
||
|
}
|
||
|
|
||
|
if ( !padapter->expectingIRQ || !(SCpnt || padapter->reconPhase) )
|
||
|
{
|
||
|
DEB(printk ("\npci2220i Unsolicited interrupt\n"));
|
||
|
STOP_HERE ();
|
||
|
goto irq_return;
|
||
|
}
|
||
|
padapter->expectingIRQ = 0;
|
||
|
|
||
|
if ( padapter->failinprog )
|
||
|
{
|
||
|
DEB (printk ("\npci2220i interrupt failover complete"));
|
||
|
padapter->failinprog = FALSE;
|
||
|
status = inb_p (padapter->regStatCmd); // read the device status
|
||
|
if ( status & (IDE_STATUS_ERROR | IDE_STATUS_WRITE_FAULT) )
|
||
|
{
|
||
|
DEB (printk ("\npci2220i: interrupt failover error from drive %X", status));
|
||
|
padapter->cmd = 0;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
DEB (printk ("\npci2220i: restarting failed opertation."));
|
||
|
pdev->spigot = (padapter->survivor) ? pdev->spigots[1] : pdev->spigots[0];
|
||
|
del_timer (&padapter->timer);
|
||
|
if ( padapter->reconPhase )
|
||
|
OpDone (padapter, DID_OK << 16);
|
||
|
else
|
||
|
Pci2220i_QueueCommand (SCpnt, SCpnt->scsi_done);
|
||
|
goto irq_return;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if ( padapter->reconPhase )
|
||
|
{
|
||
|
switch ( padapter->reconPhase )
|
||
|
{
|
||
|
case RECON_PHASE_MARKING:
|
||
|
case RECON_PHASE_LAST:
|
||
|
status = inb_p (padapter->regStatCmd); // read the device status
|
||
|
del_timer (&padapter->timer);
|
||
|
if ( padapter->reconPhase == RECON_PHASE_LAST )
|
||
|
{
|
||
|
if ( status & (IDE_STATUS_ERROR | IDE_STATUS_WRITE_FAULT) )
|
||
|
{
|
||
|
padapter->survivor = ( pdev->spigot == pdev->spigots[0] ) ? 1 : 0;
|
||
|
DEB (printk ("\npci2220i: FAILURE 10"));
|
||
|
if ( InitFailover (padapter, pdev) )
|
||
|
OpDone (padapter, DecodeError (padapter, status));
|
||
|
goto irq_return;
|
||
|
}
|
||
|
if ( WriteSignature (padapter, pdev, pdev->spigots[pdev->mirrorRecon], pdev->mirrorRecon) )
|
||
|
{
|
||
|
padapter->survivor = ( pdev->spigot == pdev->spigots[0] ) ? 0 : 1;
|
||
|
DEB (printk ("\npci2220i: FAILURE 11"));
|
||
|
if ( InitFailover (padapter, pdev) )
|
||
|
OpDone (padapter, DecodeError (padapter, status));
|
||
|
goto irq_return;
|
||
|
}
|
||
|
padapter->reconPhase = RECON_PHASE_END;
|
||
|
goto irq_return;
|
||
|
}
|
||
|
OpDone (padapter, DID_OK << 16);
|
||
|
goto irq_return;
|
||
|
|
||
|
case RECON_PHASE_READY:
|
||
|
status = inb_p (padapter->regStatCmd); // read the device status
|
||
|
if ( status & (IDE_STATUS_ERROR | IDE_STATUS_WRITE_FAULT) )
|
||
|
{
|
||
|
del_timer (&padapter->timer);
|
||
|
OpDone (padapter, DecodeError (padapter, status));
|
||
|
goto irq_return;
|
||
|
}
|
||
|
SelectSpigot (padapter, pdev->spigots[pdev->mirrorRecon]);
|
||
|
if ( WaitDrq (padapter) )
|
||
|
{
|
||
|
del_timer (&padapter->timer);
|
||
|
padapter->survivor = ( pdev->spigot == pdev->spigots[0] ) ? 0 : 1;
|
||
|
DEB (printk ("\npci2220i: FAILURE 12"));
|
||
|
if ( InitFailover (padapter, pdev) )
|
||
|
OpDone (padapter, DecodeError (padapter, status));
|
||
|
goto irq_return;
|
||
|
}
|
||
|
SelectSpigot (padapter, pdev->spigot | SEL_COPY | padapter->bigD);
|
||
|
padapter->reconPhase = RECON_PHASE_COPY;
|
||
|
padapter->expectingIRQ = TRUE;
|
||
|
if ( padapter->timingPIO )
|
||
|
{
|
||
|
insw (padapter->regData, padapter->kBuffer, padapter->reconSize * (BYTES_PER_SECTOR / 2));
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if ( (padapter->timingMode > 3) )
|
||
|
{
|
||
|
if ( padapter->bigD )
|
||
|
outl (BIGD_DATA_MODE3, padapter->regDmaAddrLoc);
|
||
|
else
|
||
|
outl (DALE_DATA_MODE3, padapter->regDmaAddrLoc);
|
||
|
}
|
||
|
else
|
||
|
outl (padapter->timingAddress, padapter->regDmaAddrLoc);
|
||
|
outl (padapter->kBufferDma, padapter->regDmaAddrPci);
|
||
|
outl (padapter->reconSize * BYTES_PER_SECTOR, padapter->regDmaCount);
|
||
|
outb_p (8, padapter->regDmaDesc); // read operation
|
||
|
if ( padapter->bigD )
|
||
|
outb_p (8, padapter->regDmaMode); // no interrupt
|
||
|
else
|
||
|
outb_p (1, padapter->regDmaMode); // no interrupt
|
||
|
outb_p (0x03, padapter->regDmaCmdStat); // kick the DMA engine in gear
|
||
|
}
|
||
|
goto irq_return;
|
||
|
|
||
|
case RECON_PHASE_COPY:
|
||
|
pdev->DiskMirror[pdev->mirrorRecon].reconstructPoint += padapter->reconSize;
|
||
|
|
||
|
case RECON_PHASE_UPDATE:
|
||
|
SelectSpigot (padapter, pdev->spigots[pdev->mirrorRecon] | SEL_IRQ_OFF);
|
||
|
status = inb_p (padapter->regStatCmd); // read the device status
|
||
|
del_timer (&padapter->timer);
|
||
|
if ( status & (IDE_STATUS_ERROR | IDE_STATUS_WRITE_FAULT) )
|
||
|
{
|
||
|
padapter->survivor = ( pdev->spigot == pdev->spigots[0] ) ? 0 : 1;
|
||
|
DEB (printk ("\npci2220i: FAILURE 13"));
|
||
|
DEB (printk ("\n status register = %X error = %X", status, inb_p (padapter->regError)));
|
||
|
if ( InitFailover (padapter, pdev) )
|
||
|
OpDone (padapter, DecodeError (padapter, status));
|
||
|
goto irq_return;
|
||
|
}
|
||
|
OpDone (padapter, DID_OK << 16);
|
||
|
goto irq_return;
|
||
|
|
||
|
case RECON_PHASE_END:
|
||
|
status = inb_p (padapter->regStatCmd); // read the device status
|
||
|
del_timer (&padapter->timer);
|
||
|
if ( status & (IDE_STATUS_ERROR | IDE_STATUS_WRITE_FAULT) )
|
||
|
{
|
||
|
padapter->survivor = ( pdev->spigot == pdev->spigots[0] ) ? 0 : 1;
|
||
|
DEB (printk ("\npci2220i: FAILURE 14"));
|
||
|
if ( InitFailover (padapter, pdev) )
|
||
|
OpDone (padapter, DecodeError (padapter, status));
|
||
|
goto irq_return;
|
||
|
}
|
||
|
pdev->reconOn = 0;
|
||
|
if ( padapter->bigD )
|
||
|
{
|
||
|
for ( z = 0; z < padapter->numberOfDrives; z++ )
|
||
|
{
|
||
|
if ( padapter->device[z].DiskMirror[0].status & UCBF_SURVIVOR )
|
||
|
{
|
||
|
Alarm (padapter, padapter->device[z].deviceID[0] ^ 2);
|
||
|
MuteAlarm (padapter);
|
||
|
}
|
||
|
if ( padapter->device[z].DiskMirror[1].status & UCBF_SURVIVOR )
|
||
|
{
|
||
|
Alarm (padapter, padapter->device[z].deviceID[1] ^ 2);
|
||
|
MuteAlarm (padapter);
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
OpDone (padapter, DID_OK << 16);
|
||
|
goto irq_return;
|
||
|
|
||
|
default:
|
||
|
goto irq_return;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
switch ( padapter->cmd ) // decide how to handle the interrupt
|
||
|
{
|
||
|
case READ_CMD:
|
||
|
if ( padapter->sectorCount )
|
||
|
{
|
||
|
status = inb_p (padapter->regStatCmd); // read the device status
|
||
|
if ( status & (IDE_STATUS_ERROR | IDE_STATUS_WRITE_FAULT) )
|
||
|
{
|
||
|
if ( pdev->raid )
|
||
|
{
|
||
|
padapter->survivor = ( pdev->spigot == pdev->spigots[0] ) ? 1 : 0;
|
||
|
del_timer (&padapter->timer);
|
||
|
DEB (printk ("\npci2220i: FAILURE 15"));
|
||
|
if ( !InitFailover (padapter, pdev) )
|
||
|
goto irq_return;
|
||
|
}
|
||
|
break;
|
||
|
}
|
||
|
if ( padapter->timingPIO )
|
||
|
{
|
||
|
insw (padapter->regData, padapter->kBuffer, padapter->readCount / 2);
|
||
|
padapter->sectorCount -= padapter->readCount / BYTES_PER_SECTOR;
|
||
|
WalkScatGath (padapter, TRUE, padapter->readCount);
|
||
|
if ( !padapter->sectorCount )
|
||
|
{
|
||
|
status = 0;
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if ( padapter->readCount )
|
||
|
WalkScatGath (padapter, TRUE, padapter->readCount);
|
||
|
BusMaster (padapter, 1, 1);
|
||
|
}
|
||
|
padapter->expectingIRQ = TRUE;
|
||
|
goto irq_return;
|
||
|
}
|
||
|
if ( padapter->readCount && !padapter->timingPIO )
|
||
|
WalkScatGath (padapter, TRUE, padapter->readCount);
|
||
|
status = 0;
|
||
|
break;
|
||
|
|
||
|
case WRITE_CMD:
|
||
|
if ( pdev->raid )
|
||
|
{
|
||
|
SelectSpigot (padapter, pdev->spigots[0] | SEL_IRQ_OFF);
|
||
|
status = inb_p (padapter->regStatCmd); // read the device status
|
||
|
SelectSpigot (padapter, pdev->spigots[1] | SEL_IRQ_OFF);
|
||
|
status1 = inb_p (padapter->regStatCmd); // read the device status
|
||
|
}
|
||
|
else
|
||
|
SelectSpigot (padapter, pdev->spigot | SEL_IRQ_OFF);
|
||
|
status = inb_p (padapter->regStatCmd); // read the device status
|
||
|
status1 = 0;
|
||
|
|
||
|
if ( status & (IDE_STATUS_ERROR | IDE_STATUS_WRITE_FAULT) )
|
||
|
{
|
||
|
if ( pdev->raid && !(status1 & (IDE_STATUS_ERROR | IDE_STATUS_WRITE_FAULT)) )
|
||
|
{
|
||
|
padapter->survivor = 1;
|
||
|
del_timer (&padapter->timer);
|
||
|
SelectSpigot (padapter, pdev->spigot | SEL_IRQ_OFF);
|
||
|
DEB (printk ("\npci2220i: FAILURE 16 status = %X error = %X", status, inb_p (padapter->regError)));
|
||
|
if ( !InitFailover (padapter, pdev) )
|
||
|
goto irq_return;
|
||
|
}
|
||
|
break;
|
||
|
}
|
||
|
if ( pdev->raid )
|
||
|
{
|
||
|
if ( status1 & (IDE_STATUS_ERROR | IDE_STATUS_WRITE_FAULT) )
|
||
|
{
|
||
|
padapter->survivor = 0;
|
||
|
del_timer (&padapter->timer);
|
||
|
DEB (printk ("\npci2220i: FAILURE 17 status = %X error = %X", status1, inb_p (padapter->regError)));
|
||
|
if ( !InitFailover (padapter, pdev) )
|
||
|
goto irq_return;
|
||
|
status = status1;
|
||
|
break;
|
||
|
}
|
||
|
if ( padapter->sectorCount )
|
||
|
{
|
||
|
status = WriteDataBoth (padapter, pdev);
|
||
|
if ( status )
|
||
|
{
|
||
|
padapter->survivor = status >> 1;
|
||
|
del_timer (&padapter->timer);
|
||
|
DEB (printk ("\npci2220i: FAILURE 18"));
|
||
|
if ( !InitFailover (padapter, pdev) )
|
||
|
goto irq_return;
|
||
|
SelectSpigot (padapter, pdev->spigots[status] | SEL_IRQ_OFF);
|
||
|
status = inb_p (padapter->regStatCmd); // read the device status
|
||
|
break;
|
||
|
}
|
||
|
padapter->expectingIRQ = TRUE;
|
||
|
goto irq_return;
|
||
|
}
|
||
|
status = 0;
|
||
|
break;
|
||
|
}
|
||
|
if ( padapter->sectorCount )
|
||
|
{
|
||
|
SelectSpigot (padapter, pdev->spigot | padapter->bigD);
|
||
|
status = WriteData (padapter);
|
||
|
if ( status )
|
||
|
break;
|
||
|
padapter->expectingIRQ = TRUE;
|
||
|
goto irq_return;
|
||
|
}
|
||
|
status = 0;
|
||
|
break;
|
||
|
|
||
|
case IDE_COMMAND_IDENTIFY:
|
||
|
{
|
||
|
PINQUIRYDATA pinquiryData = SCpnt->request_buffer;
|
||
|
PIDENTIFY_DATA pid = (PIDENTIFY_DATA)padapter->kBuffer;
|
||
|
|
||
|
status = inb_p (padapter->regStatCmd);
|
||
|
if ( status & IDE_STATUS_DRQ )
|
||
|
{
|
||
|
insw (padapter->regData, pid, sizeof (IDENTIFY_DATA) >> 1);
|
||
|
|
||
|
memset (pinquiryData, 0, SCpnt->request_bufflen); // Zero INQUIRY data structure.
|
||
|
pinquiryData->DeviceType = 0;
|
||
|
pinquiryData->Versions = 2;
|
||
|
pinquiryData->AdditionalLength = 35 - 4;
|
||
|
|
||
|
// Fill in vendor identification fields.
|
||
|
for ( z = 0; z < 20; z += 2 )
|
||
|
{
|
||
|
pinquiryData->VendorId[z] = ((UCHAR *)pid->ModelNumber)[z + 1];
|
||
|
pinquiryData->VendorId[z + 1] = ((UCHAR *)pid->ModelNumber)[z];
|
||
|
}
|
||
|
|
||
|
// Initialize unused portion of product id.
|
||
|
for ( z = 0; z < 4; z++ )
|
||
|
pinquiryData->ProductId[12 + z] = ' ';
|
||
|
|
||
|
// Move firmware revision from IDENTIFY data to
|
||
|
// product revision in INQUIRY data.
|
||
|
for ( z = 0; z < 4; z += 2 )
|
||
|
{
|
||
|
pinquiryData->ProductRevisionLevel[z] = ((UCHAR *)pid->FirmwareRevision)[z + 1];
|
||
|
pinquiryData->ProductRevisionLevel[z + 1] = ((UCHAR *)pid->FirmwareRevision)[z];
|
||
|
}
|
||
|
if ( pdev == padapter->device )
|
||
|
*((USHORT *)(&pinquiryData->VendorSpecific)) = DEVICE_DALE_1;
|
||
|
|
||
|
status = 0;
|
||
|
}
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
default:
|
||
|
status = 0;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
del_timer (&padapter->timer);
|
||
|
if ( status )
|
||
|
{
|
||
|
DEB (printk ("\npci2220i Interrupt handler return error"));
|
||
|
zl = DecodeError (padapter, status);
|
||
|
}
|
||
|
else
|
||
|
zl = DID_OK << 16;
|
||
|
|
||
|
OpDone (padapter, zl);
|
||
|
irq_return:
|
||
|
spin_unlock_irqrestore(shost->host_lock, flags);
|
||
|
out:
|
||
|
return IRQ_RETVAL(handled);
|
||
|
}
|
||
|
|
||
|
/****************************************************************
|
||
|
* Name: Pci2220i_QueueCommand
|
||
|
*
|
||
|
* Description: Process a queued command from the SCSI manager.
|
||
|
*
|
||
|
* Parameters: SCpnt - Pointer to SCSI command structure.
|
||
|
* done - Pointer to done function to call.
|
||
|
*
|
||
|
* Returns: Status code.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
int Pci2220i_QueueCommand (Scsi_Cmnd *SCpnt, void (*done)(Scsi_Cmnd *))
|
||
|
{
|
||
|
UCHAR *cdb = (UCHAR *)SCpnt->cmnd; // Pointer to SCSI CDB
|
||
|
PADAPTER2220I padapter = HOSTDATA(SCpnt->device->host); // Pointer to adapter control structure
|
||
|
POUR_DEVICE pdev = &padapter->device[SCpnt->device->id];// Pointer to device information
|
||
|
UCHAR rc; // command return code
|
||
|
int z;
|
||
|
PDEVICE_RAID1 pdr;
|
||
|
|
||
|
SCpnt->scsi_done = done;
|
||
|
padapter->SCpnt = SCpnt; // Save this command data
|
||
|
padapter->readCount = 0;
|
||
|
|
||
|
if ( SCpnt->use_sg )
|
||
|
{
|
||
|
padapter->currentSgBuffer = ((struct scatterlist *)SCpnt->request_buffer)[0].address;
|
||
|
padapter->currentSgCount = ((struct scatterlist *)SCpnt->request_buffer)[0].length;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
padapter->currentSgBuffer = SCpnt->request_buffer;
|
||
|
padapter->currentSgCount = SCpnt->request_bufflen;
|
||
|
}
|
||
|
padapter->nextSg = 1;
|
||
|
|
||
|
if ( !done )
|
||
|
{
|
||
|
printk("pci2220i_queuecommand: %02X: done can't be NULL\n", *cdb);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
if ( padapter->atapi )
|
||
|
{
|
||
|
UCHAR zlo, zhi;
|
||
|
|
||
|
DEB (printk ("\nPCI2242I: ID %d, LUN %d opcode %X ", SCpnt->device->id, SCpnt->device->lun, *cdb));
|
||
|
padapter->pdev = pdev;
|
||
|
if ( !pdev->byte6 || SCpnt->device->lun )
|
||
|
{
|
||
|
OpDone (padapter, DID_BAD_TARGET << 16);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
padapter->atapiSpecial = FALSE;
|
||
|
padapter->reqSense = FALSE;
|
||
|
memset (padapter->atapiCdb, 0, 16);
|
||
|
SelectSpigot (padapter, pdev->spigot); // select the spigot
|
||
|
AtapiDevice (padapter, pdev->byte6); // select the drive
|
||
|
if ( AtapiWaitReady (padapter, 100) )
|
||
|
{
|
||
|
OpDone (padapter, DID_NO_CONNECT << 16);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
switch ( cdb[0] )
|
||
|
{
|
||
|
case SCSIOP_MODE_SENSE:
|
||
|
case SCSIOP_MODE_SELECT:
|
||
|
Scsi2Atapi (padapter, SCpnt);
|
||
|
z = SCpnt->request_bufflen + 4;
|
||
|
break;
|
||
|
case SCSIOP_READ6:
|
||
|
case SCSIOP_WRITE6:
|
||
|
Scsi2Atapi (padapter, SCpnt);
|
||
|
z = SCpnt->request_bufflen;
|
||
|
break;
|
||
|
default:
|
||
|
memcpy (padapter->atapiCdb, cdb, SCpnt->cmd_len);
|
||
|
z = SCpnt->request_bufflen;
|
||
|
break;
|
||
|
}
|
||
|
if ( z > ATAPI_TRANSFER )
|
||
|
z = ATAPI_TRANSFER;
|
||
|
zlo = (UCHAR)(z & 0xFF);
|
||
|
zhi = (UCHAR)(z >> 8);
|
||
|
|
||
|
AtapiCountLo (padapter, zlo);
|
||
|
AtapiCountHi (padapter, zhi);
|
||
|
outb_p (0, padapter->regError);
|
||
|
WriteCommand (padapter, IDE_COMMAND_ATAPI_PACKET);
|
||
|
if ( pdev->cmdDrqInt )
|
||
|
return 0;
|
||
|
|
||
|
if ( AtapiWaitDrq (padapter, 500) )
|
||
|
{
|
||
|
OpDone (padapter, DID_ERROR << 16);
|
||
|
return 0;
|
||
|
}
|
||
|
AtapiSendCdb (padapter, pdev, padapter->atapiCdb);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
if ( padapter->reconPhase )
|
||
|
return 0;
|
||
|
if ( padapter->reconTimer.data )
|
||
|
{
|
||
|
del_timer (&padapter->reconTimer);
|
||
|
padapter->reconTimer.data = 0;
|
||
|
}
|
||
|
|
||
|
if ( (SCpnt->device->id >= padapter->numberOfDrives) || SCpnt->device->lun )
|
||
|
{
|
||
|
OpDone (padapter, DID_BAD_TARGET << 16);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
switch ( *cdb )
|
||
|
{
|
||
|
case SCSIOP_INQUIRY: // inquiry CDB
|
||
|
{
|
||
|
if ( cdb[2] == SC_MY_RAID )
|
||
|
{
|
||
|
switch ( cdb[3] )
|
||
|
{
|
||
|
case MY_SCSI_REBUILD:
|
||
|
for ( z = 0; z < padapter->numberOfDrives; z++ )
|
||
|
{
|
||
|
pdev = &padapter->device[z];
|
||
|
if ( ((pdev->DiskMirror[0].status & UCBF_SURVIVOR) && (pdev->DiskMirror[1].status & UCBF_MIRRORED)) ||
|
||
|
((pdev->DiskMirror[1].status & UCBF_SURVIVOR) && (pdev->DiskMirror[0].status & UCBF_MIRRORED)) )
|
||
|
{
|
||
|
padapter->reconOn = pdev->reconOn = pdev->reconIsStarting = TRUE;
|
||
|
}
|
||
|
}
|
||
|
OpDone (padapter, DID_OK << 16);
|
||
|
break;
|
||
|
case MY_SCSI_ALARMMUTE:
|
||
|
MuteAlarm (padapter);
|
||
|
OpDone (padapter, DID_OK << 16);
|
||
|
break;
|
||
|
case MY_SCSI_DEMOFAIL:
|
||
|
padapter->demoFail = TRUE;
|
||
|
OpDone (padapter, DID_OK << 16);
|
||
|
break;
|
||
|
default:
|
||
|
z = cdb[5]; // get index
|
||
|
pdr = (PDEVICE_RAID1)SCpnt->request_buffer;
|
||
|
if ( padapter->raidData[z] )
|
||
|
{
|
||
|
memcpy (&pdr->DiskRaid1, padapter->raidData[z], sizeof (DISK_MIRROR));
|
||
|
if ( padapter->raidData[z]->reconstructPoint > padapter->raidData[z ^ 2]->reconstructPoint )
|
||
|
pdr->TotalSectors = padapter->raidData[z]->reconstructPoint;
|
||
|
else
|
||
|
pdr->TotalSectors = padapter->raidData[z ^ 2]->reconstructPoint;
|
||
|
}
|
||
|
else
|
||
|
memset (pdr, 0, sizeof (DEVICE_RAID1));
|
||
|
OpDone (padapter, DID_OK << 16);
|
||
|
break;
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
padapter->cmd = IDE_COMMAND_IDENTIFY;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
case SCSIOP_TEST_UNIT_READY: // test unit ready CDB
|
||
|
OpDone (padapter, DID_OK << 16);
|
||
|
return 0;
|
||
|
case SCSIOP_READ_CAPACITY: // read capctiy CDB
|
||
|
{
|
||
|
PREAD_CAPACITY_DATA pdata = (PREAD_CAPACITY_DATA)SCpnt->request_buffer;
|
||
|
|
||
|
pdata->blksiz = 0x20000;
|
||
|
XANY2SCSI ((UCHAR *)&pdata->blks, pdev->blocks);
|
||
|
OpDone (padapter, DID_OK << 16);
|
||
|
return 0;
|
||
|
}
|
||
|
case SCSIOP_VERIFY: // verify CDB
|
||
|
padapter->startSector = XSCSI2LONG (&cdb[2]);
|
||
|
padapter->sectorCount = (UCHAR)((USHORT)cdb[8] | ((USHORT)cdb[7] << 8));
|
||
|
padapter->cmd = IDE_COMMAND_VERIFY;
|
||
|
break;
|
||
|
case SCSIOP_READ: // read10 CDB
|
||
|
padapter->startSector = XSCSI2LONG (&cdb[2]);
|
||
|
padapter->sectorCount = (USHORT)cdb[8] | ((USHORT)cdb[7] << 8);
|
||
|
padapter->cmd = READ_CMD;
|
||
|
break;
|
||
|
case SCSIOP_READ6: // read6 CDB
|
||
|
padapter->startSector = SCSI2LONG (&cdb[1]);
|
||
|
padapter->sectorCount = cdb[4];
|
||
|
padapter->cmd = READ_CMD;
|
||
|
break;
|
||
|
case SCSIOP_WRITE: // write10 CDB
|
||
|
padapter->startSector = XSCSI2LONG (&cdb[2]);
|
||
|
padapter->sectorCount = (USHORT)cdb[8] | ((USHORT)cdb[7] << 8);
|
||
|
padapter->cmd = WRITE_CMD;
|
||
|
break;
|
||
|
case SCSIOP_WRITE6: // write6 CDB
|
||
|
padapter->startSector = SCSI2LONG (&cdb[1]);
|
||
|
padapter->sectorCount = cdb[4];
|
||
|
padapter->cmd = WRITE_CMD;
|
||
|
break;
|
||
|
default:
|
||
|
DEB (printk ("pci2220i_queuecommand: Unsupported command %02X\n", *cdb));
|
||
|
OpDone (padapter, DID_ERROR << 16);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
if ( padapter->reconPhase )
|
||
|
return 0;
|
||
|
|
||
|
padapter->pdev = pdev;
|
||
|
|
||
|
while ( padapter->demoFail )
|
||
|
{
|
||
|
pdev = padapter->pdev = &padapter->device[0];
|
||
|
padapter->demoFail = FALSE;
|
||
|
if ( !pdev->raid ||
|
||
|
(pdev->DiskMirror[0].status & UCBF_SURVIVOR) ||
|
||
|
(pdev->DiskMirror[1].status & UCBF_SURVIVOR) )
|
||
|
{
|
||
|
break;
|
||
|
}
|
||
|
if ( pdev->DiskMirror[0].status & UCBF_REBUILD )
|
||
|
padapter->survivor = 1;
|
||
|
else
|
||
|
padapter->survivor = 0;
|
||
|
DEB (printk ("\npci2220i: FAILURE 19"));
|
||
|
if ( InitFailover (padapter, pdev) )
|
||
|
break;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
StartTimer (padapter);
|
||
|
if ( pdev->raid && (padapter->cmd == WRITE_CMD) )
|
||
|
{
|
||
|
rc = IdeCmdBoth (padapter, pdev);
|
||
|
if ( !rc )
|
||
|
rc = WriteDataBoth (padapter, pdev);
|
||
|
if ( rc )
|
||
|
{
|
||
|
del_timer (&padapter->timer);
|
||
|
padapter->expectingIRQ = 0;
|
||
|
padapter->survivor = rc >> 1;
|
||
|
DEB (printk ("\npci2220i: FAILURE 20"));
|
||
|
if ( InitFailover (padapter, pdev) )
|
||
|
{
|
||
|
OpDone (padapter, DID_ERROR << 16);
|
||
|
return 0;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
rc = IdeCmd (padapter, pdev);
|
||
|
if ( (padapter->cmd == WRITE_CMD) && !rc )
|
||
|
rc = WriteData (padapter);
|
||
|
if ( rc )
|
||
|
{
|
||
|
del_timer (&padapter->timer);
|
||
|
padapter->expectingIRQ = 0;
|
||
|
if ( pdev->raid )
|
||
|
{
|
||
|
padapter->survivor = (pdev->spigot ^ 3) >> 1;
|
||
|
DEB (printk ("\npci2220i: FAILURE 21"));
|
||
|
if ( !InitFailover (padapter, pdev) )
|
||
|
return 0;
|
||
|
}
|
||
|
OpDone (padapter, DID_ERROR << 16);
|
||
|
return 0;
|
||
|
}
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: ReadFlash
|
||
|
*
|
||
|
* Description: Read information from controller Flash memory.
|
||
|
*
|
||
|
* Parameters: padapter - Pointer to host interface data structure.
|
||
|
* pdata - Pointer to data structures.
|
||
|
* base - base address in Flash.
|
||
|
* length - lenght of data space in bytes.
|
||
|
*
|
||
|
* Returns: Nothing.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static VOID ReadFlash (PADAPTER2220I padapter, VOID *pdata, ULONG base, ULONG length)
|
||
|
{
|
||
|
ULONG oldremap;
|
||
|
UCHAR olddesc;
|
||
|
ULONG z;
|
||
|
UCHAR *pd = (UCHAR *)pdata;
|
||
|
|
||
|
oldremap = inl (padapter->regRemap); // save values to restore later
|
||
|
olddesc = inb_p (padapter->regDesc);
|
||
|
|
||
|
outl (base | 1, padapter->regRemap); // remap to Flash space as specified
|
||
|
outb_p (0x40, padapter->regDesc); // describe remap region as 8 bit
|
||
|
for ( z = 0; z < length; z++) // get "length" data count
|
||
|
*pd++ = inb_p (padapter->regBase + z); // read in the data
|
||
|
|
||
|
outl (oldremap, padapter->regRemap); // restore remap register values
|
||
|
outb_p (olddesc, padapter->regDesc);
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: GetRegs
|
||
|
*
|
||
|
* Description: Initialize the regester information.
|
||
|
*
|
||
|
* Parameters: pshost - Pointer to SCSI host data structure.
|
||
|
* bigd - PCI-2240I identifier
|
||
|
* pcidev - Pointer to device data structure.
|
||
|
*
|
||
|
* Returns: TRUE if failure to install.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
static USHORT GetRegs (struct Scsi_Host *pshost, BOOL bigd, struct pci_dev *pcidev)
|
||
|
{
|
||
|
PADAPTER2220I padapter;
|
||
|
int setirq;
|
||
|
int z;
|
||
|
USHORT zr, zl;
|
||
|
UCHAR *consistent;
|
||
|
dma_addr_t consistentDma;
|
||
|
|
||
|
padapter = HOSTDATA(pshost);
|
||
|
memset (padapter, 0, sizeof (ADAPTER2220I));
|
||
|
memset (&DaleSetup, 0, sizeof (DaleSetup));
|
||
|
memset (DiskMirror, 0, sizeof (DiskMirror));
|
||
|
|
||
|
zr = pci_resource_start (pcidev, 1);
|
||
|
zl = pci_resource_start (pcidev, 2);
|
||
|
|
||
|
padapter->basePort = zr;
|
||
|
padapter->regRemap = zr + RTR_LOCAL_REMAP; // 32 bit local space remap
|
||
|
padapter->regDesc = zr + RTR_REGIONS; // 32 bit local region descriptor
|
||
|
padapter->regRange = zr + RTR_LOCAL_RANGE; // 32 bit local range
|
||
|
padapter->regIrqControl = zr + RTR_INT_CONTROL_STATUS; // 16 bit interrupt control and status
|
||
|
padapter->regScratchPad = zr + RTR_MAILBOX; // 16 byte scratchpad I/O base address
|
||
|
|
||
|
padapter->regBase = zl;
|
||
|
padapter->regData = zl + REG_DATA; // data register I/O address
|
||
|
padapter->regError = zl + REG_ERROR; // error register I/O address
|
||
|
padapter->regSectCount = zl + REG_SECTOR_COUNT; // sector count register I/O address
|
||
|
padapter->regLba0 = zl + REG_LBA_0; // least significant byte of LBA
|
||
|
padapter->regLba8 = zl + REG_LBA_8; // next least significant byte of LBA
|
||
|
padapter->regLba16 = zl + REG_LBA_16; // next most significan byte of LBA
|
||
|
padapter->regLba24 = zl + REG_LBA_24; // head and most 4 significant bits of LBA
|
||
|
padapter->regStatCmd = zl + REG_STAT_CMD; // status on read and command on write register
|
||
|
padapter->regStatSel = zl + REG_STAT_SEL; // board status on read and spigot select on write register
|
||
|
padapter->regFail = zl + REG_FAIL;
|
||
|
padapter->regAltStat = zl + REG_ALT_STAT;
|
||
|
padapter->pcidev = pcidev;
|
||
|
|
||
|
if ( bigd )
|
||
|
{
|
||
|
padapter->regDmaDesc = zr + RTR_DMA0_DESC_PTR; // address of the DMA discriptor register for direction of transfer
|
||
|
padapter->regDmaCmdStat = zr + RTR_DMA_COMMAND_STATUS; // Byte #0 of DMA command status register
|
||
|
padapter->regDmaAddrPci = zr + RTR_DMA0_PCI_ADDR; // 32 bit register for PCI address of DMA
|
||
|
padapter->regDmaAddrLoc = zr + RTR_DMA0_LOCAL_ADDR; // 32 bit register for local bus address of DMA
|
||
|
padapter->regDmaCount = zr + RTR_DMA0_COUNT; // 32 bit register for DMA transfer count
|
||
|
padapter->regDmaMode = zr + RTR_DMA0_MODE + 1; // 32 bit register for DMA mode control
|
||
|
padapter->bigD = SEL_NEW_SPEED_1; // set spigot speed control bit
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
padapter->regDmaDesc = zl + RTL_DMA1_DESC_PTR; // address of the DMA discriptor register for direction of transfer
|
||
|
padapter->regDmaCmdStat = zl + RTL_DMA_COMMAND_STATUS + 1; // Byte #1 of DMA command status register
|
||
|
padapter->regDmaAddrPci = zl + RTL_DMA1_PCI_ADDR; // 32 bit register for PCI address of DMA
|
||
|
padapter->regDmaAddrLoc = zl + RTL_DMA1_LOCAL_ADDR; // 32 bit register for local bus address of DMA
|
||
|
padapter->regDmaCount = zl + RTL_DMA1_COUNT; // 32 bit register for DMA transfer count
|
||
|
padapter->regDmaMode = zl + RTL_DMA1_MODE + 1; // 32 bit register for DMA mode control
|
||
|
}
|
||
|
|
||
|
padapter->numberOfDrives = inb_p (padapter->regScratchPad + BIGD_NUM_DRIVES);
|
||
|
if ( !bigd && !padapter->numberOfDrives ) // if no devices on this board
|
||
|
return TRUE;
|
||
|
|
||
|
pshost->irq = pcidev->irq;
|
||
|
setirq = 1;
|
||
|
for ( z = 0; z < Installed; z++ ) // scan for shared interrupts
|
||
|
{
|
||
|
if ( PsiHost[z]->irq == pshost->irq ) // if shared then, don't posses
|
||
|
setirq = 0;
|
||
|
}
|
||
|
if ( setirq ) // if not shared, posses
|
||
|
{
|
||
|
if ( request_irq (pshost->irq, Irq_Handler, SA_SHIRQ, "pci2220i", padapter) < 0 )
|
||
|
{
|
||
|
if ( request_irq (pshost->irq, Irq_Handler, SA_INTERRUPT | SA_SHIRQ, "pci2220i", padapter) < 0 )
|
||
|
{
|
||
|
printk ("Unable to allocate IRQ for PCI-2220I controller.\n");
|
||
|
return TRUE;
|
||
|
}
|
||
|
}
|
||
|
padapter->irqOwned = pshost->irq; // set IRQ as owned
|
||
|
}
|
||
|
|
||
|
if ( padapter->numberOfDrives )
|
||
|
consistent = pci_alloc_consistent (pcidev, SECTORSXFER * BYTES_PER_SECTOR, &consistentDma);
|
||
|
else
|
||
|
consistent = pci_alloc_consistent (pcidev, ATAPI_TRANSFER, &consistentDma);
|
||
|
if ( !consistent )
|
||
|
{
|
||
|
printk ("Unable to allocate DMA buffer for PCI-2220I controller.\n");
|
||
|
free_irq (pshost->irq, padapter);
|
||
|
return TRUE;
|
||
|
}
|
||
|
padapter->kBuffer = consistent;
|
||
|
padapter->kBufferDma = consistentDma;
|
||
|
|
||
|
PsiHost[Installed] = pshost; // save SCSI_HOST pointer
|
||
|
pshost->io_port = padapter->basePort;
|
||
|
pshost->n_io_port = 0xFF;
|
||
|
pshost->unique_id = padapter->regBase;
|
||
|
|
||
|
outb_p (0x01, padapter->regRange); // fix our range register because other drivers want to tromp on it
|
||
|
|
||
|
padapter->timingMode = inb_p (padapter->regScratchPad + DALE_TIMING_MODE);
|
||
|
if ( padapter->timingMode >= 2 )
|
||
|
{
|
||
|
if ( bigd )
|
||
|
padapter->timingAddress = ModeArray2[padapter->timingMode - 2];
|
||
|
else
|
||
|
padapter->timingAddress = ModeArray[padapter->timingMode - 2];
|
||
|
}
|
||
|
else
|
||
|
padapter->timingPIO = TRUE;
|
||
|
|
||
|
ReadFlash (padapter, &DaleSetup, DALE_FLASH_SETUP, sizeof (SETUP));
|
||
|
ReadFlash (padapter, &DiskMirror, DALE_FLASH_RAID, sizeof (DiskMirror));
|
||
|
|
||
|
return FALSE;
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: SetupFinish
|
||
|
*
|
||
|
* Description: Complete the driver initialization process for a card
|
||
|
*
|
||
|
* Parameters: padapter - Pointer to SCSI host data structure.
|
||
|
* str - Pointer to board type string.
|
||
|
*
|
||
|
* Returns: Nothing.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
VOID SetupFinish (PADAPTER2220I padapter, char *str, int irq)
|
||
|
{
|
||
|
init_timer (&padapter->timer);
|
||
|
padapter->timer.function = TimerExpiry;
|
||
|
padapter->timer.data = (unsigned long)padapter;
|
||
|
init_timer (&padapter->reconTimer);
|
||
|
padapter->reconTimer.function = ReconTimerExpiry;
|
||
|
padapter->reconTimer.data = (unsigned long)padapter;
|
||
|
printk("\nPCI-%sI EIDE CONTROLLER: at I/O = %lX/%lX IRQ = %d\n", str, padapter->basePort, padapter->regBase, irq);
|
||
|
printk("Version %s, Compiled %s %s\n\n", PCI2220I_VERSION, __DATE__, __TIME__);
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: Pci2220i_Detect
|
||
|
*
|
||
|
* Description: Detect and initialize our boards.
|
||
|
*
|
||
|
* Parameters: tpnt - Pointer to SCSI host template structure.
|
||
|
*
|
||
|
* Returns: Number of adapters installed.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
int Pci2220i_Detect (Scsi_Host_Template *tpnt)
|
||
|
{
|
||
|
struct Scsi_Host *pshost;
|
||
|
PADAPTER2220I padapter;
|
||
|
POUR_DEVICE pdev;
|
||
|
int unit;
|
||
|
int z;
|
||
|
USHORT raidon;
|
||
|
UCHAR spigot1, spigot2;
|
||
|
UCHAR device;
|
||
|
struct pci_dev *pcidev = NULL;
|
||
|
|
||
|
while ( (pcidev = pci_find_device (VENDOR_PSI, DEVICE_DALE_1, pcidev)) != NULL )
|
||
|
{
|
||
|
if (pci_enable_device(pcidev))
|
||
|
continue;
|
||
|
pshost = scsi_register (tpnt, sizeof(ADAPTER2220I));
|
||
|
if(pshost==NULL)
|
||
|
continue;
|
||
|
|
||
|
padapter = HOSTDATA(pshost);
|
||
|
|
||
|
if ( GetRegs (pshost, FALSE, pcidev) )
|
||
|
goto unregister;
|
||
|
|
||
|
scsi_set_device(pshost, &pcidev->dev);
|
||
|
pshost->max_id = padapter->numberOfDrives;
|
||
|
for ( z = 0; z < padapter->numberOfDrives; z++ )
|
||
|
{
|
||
|
unit = inb_p (padapter->regScratchPad + DALE_CHANNEL_DEVICE_0 + z) & 0x0F;
|
||
|
pdev = &padapter->device[z];
|
||
|
pdev->byte6 = (UCHAR)(((unit & 1) << 4) | 0xE0);
|
||
|
pdev->spigot = (UCHAR)(1 << (unit >> 1));
|
||
|
pdev->sectors = DaleSetup.setupDevice[unit].sectors;
|
||
|
pdev->heads = DaleSetup.setupDevice[unit].heads;
|
||
|
pdev->cylinders = DaleSetup.setupDevice[unit].cylinders;
|
||
|
pdev->blocks = DaleSetup.setupDevice[unit].blocks;
|
||
|
|
||
|
if ( !z )
|
||
|
{
|
||
|
DiskMirror[0].status = inb_p (padapter->regScratchPad + DALE_RAID_0_STATUS);
|
||
|
DiskMirror[1].status = inb_p (padapter->regScratchPad + DALE_RAID_1_STATUS);
|
||
|
if ( (DiskMirror[0].signature == SIGNATURE) && (DiskMirror[1].signature == SIGNATURE) &&
|
||
|
(DiskMirror[0].pairIdentifier == (DiskMirror[1].pairIdentifier ^ 1)) )
|
||
|
{
|
||
|
raidon = TRUE;
|
||
|
if ( unit > (unit ^ 2) )
|
||
|
unit = unit ^ 2;
|
||
|
}
|
||
|
else
|
||
|
raidon = FALSE;
|
||
|
|
||
|
memcpy (pdev->DiskMirror, DiskMirror, sizeof (DiskMirror));
|
||
|
padapter->raidData[0] = &pdev->DiskMirror[0];
|
||
|
padapter->raidData[2] = &pdev->DiskMirror[1];
|
||
|
|
||
|
spigot1 = spigot2 = FALSE;
|
||
|
pdev->spigots[0] = 1;
|
||
|
pdev->spigots[1] = 2;
|
||
|
pdev->lastsectorlba[0] = InlineIdentify (padapter, 1, 0);
|
||
|
pdev->lastsectorlba[1] = InlineIdentify (padapter, 2, 0);
|
||
|
|
||
|
if ( !(pdev->DiskMirror[1].status & UCBF_SURVIVOR) && pdev->lastsectorlba[0] )
|
||
|
spigot1 = TRUE;
|
||
|
if ( !(pdev->DiskMirror[0].status & UCBF_SURVIVOR) && pdev->lastsectorlba[1] )
|
||
|
spigot2 = TRUE;
|
||
|
if ( pdev->DiskMirror[0].status & DiskMirror[1].status & UCBF_SURVIVOR )
|
||
|
spigot1 = TRUE;
|
||
|
|
||
|
if ( spigot1 && (pdev->DiskMirror[0].status & UCBF_REBUILD) )
|
||
|
InlineReadSignature (padapter, pdev, 0);
|
||
|
if ( spigot2 && (pdev->DiskMirror[1].status & UCBF_REBUILD) )
|
||
|
InlineReadSignature (padapter, pdev, 1);
|
||
|
|
||
|
if ( spigot1 && spigot2 && raidon )
|
||
|
{
|
||
|
pdev->raid = 1;
|
||
|
if ( pdev->DiskMirror[0].status & UCBF_REBUILD )
|
||
|
pdev->spigot = 2;
|
||
|
else
|
||
|
pdev->spigot = 1;
|
||
|
if ( (pdev->DiskMirror[0].status & UCBF_REBUILD) || (pdev->DiskMirror[1].status & UCBF_REBUILD) )
|
||
|
padapter->reconOn = pdev->reconOn = pdev->reconIsStarting = TRUE;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if ( spigot1 )
|
||
|
{
|
||
|
if ( pdev->DiskMirror[0].status & UCBF_REBUILD )
|
||
|
goto unregister;
|
||
|
pdev->DiskMirror[0].status = UCBF_MIRRORED | UCBF_SURVIVOR;
|
||
|
pdev->spigot = 1;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if ( pdev->DiskMirror[1].status & UCBF_REBUILD )
|
||
|
goto unregister;
|
||
|
pdev->DiskMirror[1].status = UCBF_MIRRORED | UCBF_SURVIVOR;
|
||
|
pdev->spigot = 2;
|
||
|
}
|
||
|
if ( DaleSetup.rebootRebuild && raidon )
|
||
|
padapter->reconOn = pdev->reconOn = pdev->reconIsStarting = TRUE;
|
||
|
}
|
||
|
|
||
|
if ( raidon )
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
SetupFinish (padapter, "2220", pshost->irq);
|
||
|
|
||
|
if ( ++Installed < MAXADAPTER )
|
||
|
continue;
|
||
|
break;
|
||
|
unregister:;
|
||
|
scsi_unregister (pshost);
|
||
|
}
|
||
|
|
||
|
while ( (pcidev = pci_find_device (VENDOR_PSI, DEVICE_BIGD_1, pcidev)) != NULL )
|
||
|
{
|
||
|
pshost = scsi_register (tpnt, sizeof(ADAPTER2220I));
|
||
|
padapter = HOSTDATA(pshost);
|
||
|
|
||
|
if ( GetRegs (pshost, TRUE, pcidev) )
|
||
|
goto unregister1;
|
||
|
|
||
|
for ( z = 0; z < BIGD_MAXDRIVES; z++ )
|
||
|
DiskMirror[z].status = inb_p (padapter->regScratchPad + BIGD_RAID_0_STATUS + z);
|
||
|
|
||
|
scsi_set_pci_device(pshost, pcidev);
|
||
|
pshost->max_id = padapter->numberOfDrives;
|
||
|
padapter->failRegister = inb_p (padapter->regScratchPad + BIGD_ALARM_IMAGE);
|
||
|
for ( z = 0; z < padapter->numberOfDrives; z++ )
|
||
|
{
|
||
|
unit = inb_p (padapter->regScratchPad + BIGD_DEVICE_0 + z);
|
||
|
pdev = &padapter->device[z];
|
||
|
pdev->byte6 = (UCHAR)(((unit & 1) << 4) | 0xE0);
|
||
|
pdev->spigot = (UCHAR)(1 << (unit >> 1));
|
||
|
pdev->sectors = DaleSetup.setupDevice[unit].sectors;
|
||
|
pdev->heads = DaleSetup.setupDevice[unit].heads;
|
||
|
pdev->cylinders = DaleSetup.setupDevice[unit].cylinders;
|
||
|
pdev->blocks = DaleSetup.setupDevice[unit].blocks;
|
||
|
|
||
|
if ( (DiskMirror[unit].signature == SIGNATURE) && (DiskMirror[unit ^ 2].signature == SIGNATURE) &&
|
||
|
(DiskMirror[unit].pairIdentifier == (DiskMirror[unit ^ 2].pairIdentifier ^ 1)) )
|
||
|
{
|
||
|
raidon = TRUE;
|
||
|
if ( unit > (unit ^ 2) )
|
||
|
unit = unit ^ 2;
|
||
|
}
|
||
|
else
|
||
|
raidon = FALSE;
|
||
|
|
||
|
spigot1 = spigot2 = FALSE;
|
||
|
memcpy (&pdev->DiskMirror[0], &DiskMirror[unit], sizeof (DISK_MIRROR));
|
||
|
memcpy (&pdev->DiskMirror[1], &DiskMirror[unit ^ 2], sizeof (DISK_MIRROR));
|
||
|
padapter->raidData[unit] = &pdev->DiskMirror[0];
|
||
|
padapter->raidData[unit ^ 2] = &pdev->DiskMirror[1];
|
||
|
pdev->spigots[0] = 1 << (unit >> 1);
|
||
|
pdev->spigots[1] = 1 << ((unit ^ 2) >> 1);
|
||
|
pdev->deviceID[0] = unit;
|
||
|
pdev->deviceID[1] = unit ^ 2;
|
||
|
pdev->lastsectorlba[0] = InlineIdentify (padapter, pdev->spigots[0], unit & 1);
|
||
|
pdev->lastsectorlba[1] = InlineIdentify (padapter, pdev->spigots[1], unit & 1);
|
||
|
|
||
|
if ( !(pdev->DiskMirror[1].status & UCBF_SURVIVOR) && pdev->lastsectorlba[0] )
|
||
|
spigot1 = TRUE;
|
||
|
if ( !(pdev->DiskMirror[0].status & UCBF_SURVIVOR) && pdev->lastsectorlba[1] )
|
||
|
spigot2 = TRUE;
|
||
|
if ( pdev->DiskMirror[0].status & pdev->DiskMirror[1].status & UCBF_SURVIVOR )
|
||
|
spigot1 = TRUE;
|
||
|
|
||
|
if ( spigot1 && (pdev->DiskMirror[0].status & UCBF_REBUILD) )
|
||
|
InlineReadSignature (padapter, pdev, 0);
|
||
|
if ( spigot2 && (pdev->DiskMirror[1].status & UCBF_REBUILD) )
|
||
|
InlineReadSignature (padapter, pdev, 1);
|
||
|
|
||
|
if ( spigot1 && spigot2 && raidon )
|
||
|
{
|
||
|
pdev->raid = 1;
|
||
|
if ( pdev->DiskMirror[0].status & UCBF_REBUILD )
|
||
|
pdev->spigot = pdev->spigots[1];
|
||
|
else
|
||
|
pdev->spigot = pdev->spigots[0];
|
||
|
if ( (pdev->DiskMirror[0].status & UCBF_REBUILD) || (pdev->DiskMirror[1].status & UCBF_REBUILD) )
|
||
|
padapter->reconOn = pdev->reconOn = pdev->reconIsStarting = TRUE;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if ( spigot1 )
|
||
|
{
|
||
|
if ( pdev->DiskMirror[0].status & UCBF_REBUILD )
|
||
|
goto unregister1;
|
||
|
pdev->DiskMirror[0].status = UCBF_MIRRORED | UCBF_SURVIVOR;
|
||
|
pdev->spigot = pdev->spigots[0];
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if ( pdev->DiskMirror[1].status & UCBF_REBUILD )
|
||
|
goto unregister;
|
||
|
pdev->DiskMirror[1].status = UCBF_MIRRORED | UCBF_SURVIVOR;
|
||
|
pdev->spigot = pdev->spigots[1];
|
||
|
}
|
||
|
if ( DaleSetup.rebootRebuild && raidon )
|
||
|
padapter->reconOn = pdev->reconOn = pdev->reconIsStarting = TRUE;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if ( !padapter->numberOfDrives ) // If no ATA devices then scan ATAPI
|
||
|
{
|
||
|
unit = 0;
|
||
|
for ( spigot1 = 0; spigot1 < 4; spigot1++ )
|
||
|
{
|
||
|
for ( device = 0; device < 2; device++ )
|
||
|
{
|
||
|
DEB (printk ("\nPCI2242I: scanning for ID %d ", (spigot1 * 2) + device));
|
||
|
pdev = &(padapter->device[(spigot1 * 2) + device]);
|
||
|
pdev->byte6 = 0x0A | (device << 4);
|
||
|
pdev->spigot = 1 << spigot1;
|
||
|
if ( !AtapiReset (padapter, pdev) )
|
||
|
{
|
||
|
DEB (printk (" Device found "));
|
||
|
if ( !AtapiIdentify (padapter, pdev) )
|
||
|
{
|
||
|
DEB (printk (" Device verified"));
|
||
|
unit++;
|
||
|
continue;
|
||
|
}
|
||
|
}
|
||
|
pdev->spigot = pdev->byte6 = 0;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if ( unit )
|
||
|
{
|
||
|
padapter->atapi = TRUE;
|
||
|
padapter->timingAddress = DALE_DATA_MODE3;
|
||
|
outw_p (0x0900, padapter->regIrqControl); // Turn our interrupts on
|
||
|
outw_p (0x0C41, padapter->regDmaMode - 1); // setup for 16 bits, ready enabled, done IRQ enabled, no incriment
|
||
|
outb_p (0xFF, padapter->regFail); // all fail lights and alarm off
|
||
|
pshost->max_id = 8;
|
||
|
}
|
||
|
}
|
||
|
SetupFinish (padapter, "2240", pshost->irq);
|
||
|
|
||
|
if ( ++Installed < MAXADAPTER )
|
||
|
continue;
|
||
|
break;
|
||
|
unregister1:;
|
||
|
scsi_unregister (pshost);
|
||
|
}
|
||
|
|
||
|
NumAdapters = Installed;
|
||
|
return Installed;
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: Pci2220i_Abort
|
||
|
*
|
||
|
* Description: Process the Abort command from the SCSI manager.
|
||
|
*
|
||
|
* Parameters: SCpnt - Pointer to SCSI command structure.
|
||
|
*
|
||
|
* Returns: Allways snooze.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
int Pci2220i_Abort (Scsi_Cmnd *SCpnt)
|
||
|
{
|
||
|
PADAPTER2220I padapter = HOSTDATA(SCpnt->device->host); // Pointer to adapter control structure
|
||
|
POUR_DEVICE pdev = &padapter->device[SCpnt->device->id];// Pointer to device information
|
||
|
|
||
|
if ( !padapter->SCpnt )
|
||
|
return SCSI_ABORT_NOT_RUNNING;
|
||
|
|
||
|
if ( padapter->atapi )
|
||
|
{
|
||
|
if ( AtapiReset (padapter, pdev) )
|
||
|
return SCSI_ABORT_ERROR;
|
||
|
OpDone (padapter, DID_ABORT << 16);
|
||
|
return SCSI_ABORT_SUCCESS;
|
||
|
}
|
||
|
return SCSI_ABORT_SNOOZE;
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: Pci2220i_Reset
|
||
|
*
|
||
|
* Description: Process the Reset command from the SCSI manager.
|
||
|
*
|
||
|
* Parameters: SCpnt - Pointer to SCSI command structure.
|
||
|
* flags - Flags about the reset command
|
||
|
*
|
||
|
* Returns: No active command at this time, so this means
|
||
|
* that each time we got some kind of response the
|
||
|
* last time through. Tell the mid-level code to
|
||
|
* request sense information in order to decide what
|
||
|
* to do next.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
int Pci2220i_Reset (Scsi_Cmnd *SCpnt, unsigned int reset_flags)
|
||
|
{
|
||
|
PADAPTER2220I padapter = HOSTDATA(SCpnt->device->host); // Pointer to adapter control structure
|
||
|
POUR_DEVICE pdev = &padapter->device[SCpnt->device->id];// Pointer to device information
|
||
|
|
||
|
if ( padapter->atapi )
|
||
|
{
|
||
|
if ( AtapiReset (padapter, pdev) )
|
||
|
return SCSI_RESET_ERROR;
|
||
|
return SCSI_RESET_SUCCESS;
|
||
|
}
|
||
|
return SCSI_RESET_PUNT;
|
||
|
}
|
||
|
/****************************************************************
|
||
|
* Name: Pci2220i_Release
|
||
|
*
|
||
|
* Description: Release resources allocated for a single each adapter.
|
||
|
*
|
||
|
* Parameters: pshost - Pointer to SCSI command structure.
|
||
|
*
|
||
|
* Returns: zero.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
int Pci2220i_Release (struct Scsi_Host *pshost)
|
||
|
{
|
||
|
PADAPTER2220I padapter = HOSTDATA (pshost);
|
||
|
USHORT z;
|
||
|
|
||
|
if ( padapter->reconOn )
|
||
|
{
|
||
|
padapter->reconOn = FALSE; // shut down the hot reconstruct
|
||
|
if ( padapter->reconPhase )
|
||
|
mdelay (300);
|
||
|
if ( padapter->reconTimer.data ) // is the timer running?
|
||
|
{
|
||
|
del_timer (&padapter->reconTimer);
|
||
|
padapter->reconTimer.data = 0;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
// save RAID status on the board
|
||
|
if ( padapter->bigD )
|
||
|
{
|
||
|
outb_p (padapter->failRegister, padapter->regScratchPad + BIGD_ALARM_IMAGE);
|
||
|
for ( z = 0; z < BIGD_MAXDRIVES; z++ )
|
||
|
{
|
||
|
if ( padapter->raidData )
|
||
|
outb_p (padapter->raidData[z]->status, padapter->regScratchPad + BIGD_RAID_0_STATUS + z);
|
||
|
else
|
||
|
outb_p (0, padapter->regScratchPad + BIGD_RAID_0_STATUS);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
outb_p (padapter->device[0].DiskMirror[0].status, padapter->regScratchPad + DALE_RAID_0_STATUS);
|
||
|
outb_p (padapter->device[0].DiskMirror[1].status, padapter->regScratchPad + DALE_RAID_1_STATUS);
|
||
|
}
|
||
|
|
||
|
if ( padapter->irqOwned )
|
||
|
free_irq (pshost->irq, padapter);
|
||
|
release_region (pshost->io_port, pshost->n_io_port);
|
||
|
if ( padapter->numberOfDrives )
|
||
|
pci_free_consistent (padapter->pcidev, SECTORSXFER * BYTES_PER_SECTOR, padapter->kBuffer, padapter->kBufferDma);
|
||
|
else
|
||
|
pci_free_consistent (padapter->pcidev, ATAPI_TRANSFER, padapter->kBuffer, padapter->kBufferDma);
|
||
|
scsi_unregister(pshost);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/****************************************************************
|
||
|
* Name: Pci2220i_BiosParam
|
||
|
*
|
||
|
* Description: Process the biosparam request from the SCSI manager to
|
||
|
* return C/H/S data.
|
||
|
*
|
||
|
* Parameters: disk - Pointer to SCSI disk structure.
|
||
|
* dev - Major/minor number from kernel.
|
||
|
* geom - Pointer to integer array to place geometry data.
|
||
|
*
|
||
|
* Returns: zero.
|
||
|
*
|
||
|
****************************************************************/
|
||
|
int Pci2220i_BiosParam (struct scsi_device *sdev, struct block_device *dev,
|
||
|
sector_t capacity, int geom[])
|
||
|
{
|
||
|
POUR_DEVICE pdev;
|
||
|
|
||
|
if ( !(HOSTDATA(sdev->host))->atapi )
|
||
|
{
|
||
|
pdev = &(HOSTDATA(sdev->host)->device[sdev->id]);
|
||
|
|
||
|
geom[0] = pdev->heads;
|
||
|
geom[1] = pdev->sectors;
|
||
|
geom[2] = pdev->cylinders;
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
MODULE_LICENSE("Dual BSD/GPL");
|
||
|
|
||
|
static Scsi_Host_Template driver_template = {
|
||
|
.proc_name = "pci2220i",
|
||
|
.name = "PCI-2220I/PCI-2240I",
|
||
|
.detect = Pci2220i_Detect,
|
||
|
.release = Pci2220i_Release,
|
||
|
.queuecommand = Pci2220i_QueueCommand,
|
||
|
.abort = Pci2220i_Abort,
|
||
|
.reset = Pci2220i_Reset,
|
||
|
.bios_param = Pci2220i_BiosParam,
|
||
|
.can_queue = 1,
|
||
|
.this_id = -1,
|
||
|
.sg_tablesize = SG_ALL,
|
||
|
.cmd_per_lun = 1,
|
||
|
.use_clustering = DISABLE_CLUSTERING,
|
||
|
};
|
||
|
#include "scsi_module.c"
|