blob: 846a466b079caa271e60669a70ade8b993396753 [file] [log] [blame]
/****************************************************************************
* 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/blk.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 "hosts.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 void 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;
// 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;
}
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:;
}
/****************************************************************
* 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;
}
static void internal_done(Scsi_Cmnd *SCpnt)
{
SCpnt->SCp.Status++;
}
/****************************************************************
* Name: Pci2220i_Command
*
* Description: Process a command from the SCSI manager.
*
* Parameters: SCpnt - Pointer to SCSI command structure.
*
* Returns: Status code.
*
****************************************************************/
int Pci2220i_Command (Scsi_Cmnd *SCpnt)
{
Pci2220i_QueueCommand (SCpnt, internal_done);
SCpnt->SCp.Status = 0;
while (!SCpnt->SCp.Status)
barrier ();
return SCpnt->result;
}
/****************************************************************
* 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;
if ( !pci_present () )
{
printk ("pci2220i: PCI BIOS not present\n");
return 0;
}
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