2122 lines
		
	
	
		
			67 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			2122 lines
		
	
	
		
			67 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| // SPDX-License-Identifier: GPL-2.0-or-later
 | |
| 
 | |
| /* NCR (or Symbios) 53c700 and 53c700-66 Driver
 | |
|  *
 | |
|  * Copyright (C) 2001 by James.Bottomley@HansenPartnership.com
 | |
| **-----------------------------------------------------------------------------
 | |
| **  
 | |
| **
 | |
| **-----------------------------------------------------------------------------
 | |
|  */
 | |
| 
 | |
| /* Notes:
 | |
|  *
 | |
|  * This driver is designed exclusively for these chips (virtually the
 | |
|  * earliest of the scripts engine chips).  They need their own drivers
 | |
|  * because they are missing so many of the scripts and snazzy register
 | |
|  * features of their elder brothers (the 710, 720 and 770).
 | |
|  *
 | |
|  * The 700 is the lowliest of the line, it can only do async SCSI.
 | |
|  * The 700-66 can at least do synchronous SCSI up to 10MHz.
 | |
|  * 
 | |
|  * The 700 chip has no host bus interface logic of its own.  However,
 | |
|  * it is usually mapped to a location with well defined register
 | |
|  * offsets.  Therefore, if you can determine the base address and the
 | |
|  * irq your board incorporating this chip uses, you can probably use
 | |
|  * this driver to run it (although you'll probably have to write a
 | |
|  * minimal wrapper for the purpose---see the NCR_D700 driver for
 | |
|  * details about how to do this).
 | |
|  *
 | |
|  *
 | |
|  * TODO List:
 | |
|  *
 | |
|  * 1. Better statistics in the proc fs
 | |
|  *
 | |
|  * 2. Implement message queue (queues SCSI messages like commands) and make
 | |
|  *    the abort and device reset functions use them.
 | |
|  * */
 | |
| 
 | |
| /* CHANGELOG
 | |
|  *
 | |
|  * Version 2.8
 | |
|  *
 | |
|  * Fixed bad bug affecting tag starvation processing (previously the
 | |
|  * driver would hang the system if too many tags starved.  Also fixed
 | |
|  * bad bug having to do with 10 byte command processing and REQUEST
 | |
|  * SENSE (the command would loop forever getting a transfer length
 | |
|  * mismatch in the CMD phase).
 | |
|  *
 | |
|  * Version 2.7
 | |
|  *
 | |
|  * Fixed scripts problem which caused certain devices (notably CDRWs)
 | |
|  * to hang on initial INQUIRY.  Updated NCR_700_readl/writel to use
 | |
|  * __raw_readl/writel for parisc compatibility (Thomas
 | |
|  * Bogendoerfer). Added missing SCp->request_bufflen initialisation
 | |
|  * for sense requests (Ryan Bradetich).
 | |
|  *
 | |
|  * Version 2.6
 | |
|  *
 | |
|  * Following test of the 64 bit parisc kernel by Richard Hirst,
 | |
|  * several problems have now been corrected.  Also adds support for
 | |
|  * consistent memory allocation.
 | |
|  *
 | |
|  * Version 2.5
 | |
|  * 
 | |
|  * More Compatibility changes for 710 (now actually works).  Enhanced
 | |
|  * support for odd clock speeds which constrain SDTR negotiations.
 | |
|  * correct cacheline separation for scsi messages and status for
 | |
|  * incoherent architectures.  Use of the pci mapping functions on
 | |
|  * buffers to begin support for 64 bit drivers.
 | |
|  *
 | |
|  * Version 2.4
 | |
|  *
 | |
|  * Added support for the 53c710 chip (in 53c700 emulation mode only---no 
 | |
|  * special 53c710 instructions or registers are used).
 | |
|  *
 | |
|  * Version 2.3
 | |
|  *
 | |
|  * More endianness/cache coherency changes.
 | |
|  *
 | |
|  * Better bad device handling (handles devices lying about tag
 | |
|  * queueing support and devices which fail to provide sense data on
 | |
|  * contingent allegiance conditions)
 | |
|  *
 | |
|  * Many thanks to Richard Hirst <rhirst@linuxcare.com> for patiently
 | |
|  * debugging this driver on the parisc architecture and suggesting
 | |
|  * many improvements and bug fixes.
 | |
|  *
 | |
|  * Thanks also go to Linuxcare Inc. for providing several PARISC
 | |
|  * machines for me to debug the driver on.
 | |
|  *
 | |
|  * Version 2.2
 | |
|  *
 | |
|  * Made the driver mem or io mapped; added endian invariance; added
 | |
|  * dma cache flushing operations for architectures which need it;
 | |
|  * added support for more varied clocking speeds.
 | |
|  *
 | |
|  * Version 2.1
 | |
|  *
 | |
|  * Initial modularisation from the D700.  See NCR_D700.c for the rest of
 | |
|  * the changelog.
 | |
|  * */
 | |
| #define NCR_700_VERSION "2.8"
 | |
| 
 | |
| #include <linux/kernel.h>
 | |
| #include <linux/types.h>
 | |
| #include <linux/string.h>
 | |
| #include <linux/slab.h>
 | |
| #include <linux/ioport.h>
 | |
| #include <linux/delay.h>
 | |
| #include <linux/spinlock.h>
 | |
| #include <linux/completion.h>
 | |
| #include <linux/init.h>
 | |
| #include <linux/proc_fs.h>
 | |
| #include <linux/blkdev.h>
 | |
| #include <linux/module.h>
 | |
| #include <linux/interrupt.h>
 | |
| #include <linux/device.h>
 | |
| #include <linux/pgtable.h>
 | |
| #include <asm/dma.h>
 | |
| #include <asm/io.h>
 | |
| #include <asm/byteorder.h>
 | |
| 
 | |
| #include <scsi/scsi.h>
 | |
| #include <scsi/scsi_cmnd.h>
 | |
| #include <scsi/scsi_dbg.h>
 | |
| #include <scsi/scsi_eh.h>
 | |
| #include <scsi/scsi_host.h>
 | |
| #include <scsi/scsi_tcq.h>
 | |
| #include <scsi/scsi_transport.h>
 | |
| #include <scsi/scsi_transport_spi.h>
 | |
| 
 | |
| #include "53c700.h"
 | |
| 
 | |
| /* NOTE: For 64 bit drivers there are points in the code where we use
 | |
|  * a non dereferenceable pointer to point to a structure in dma-able
 | |
|  * memory (which is 32 bits) so that we can use all of the structure
 | |
|  * operations but take the address at the end.  This macro allows us
 | |
|  * to truncate the 64 bit pointer down to 32 bits without the compiler
 | |
|  * complaining */
 | |
| #define to32bit(x)	((__u32)((unsigned long)(x)))
 | |
| 
 | |
| #ifdef NCR_700_DEBUG
 | |
| #define STATIC
 | |
| #else
 | |
| #define STATIC static
 | |
| #endif
 | |
| 
 | |
| MODULE_AUTHOR("James Bottomley");
 | |
| MODULE_DESCRIPTION("53c700 and 53c700-66 Driver");
 | |
| MODULE_LICENSE("GPL");
 | |
| 
 | |
| /* This is the script */
 | |
| #include "53c700_d.h"
 | |
| 
 | |
| 
 | |
| STATIC int NCR_700_queuecommand(struct Scsi_Host *h, struct scsi_cmnd *);
 | |
| STATIC int NCR_700_abort(struct scsi_cmnd * SCpnt);
 | |
| STATIC int NCR_700_host_reset(struct scsi_cmnd * SCpnt);
 | |
| STATIC void NCR_700_chip_setup(struct Scsi_Host *host);
 | |
| STATIC void NCR_700_chip_reset(struct Scsi_Host *host);
 | |
| STATIC int NCR_700_slave_alloc(struct scsi_device *SDpnt);
 | |
| STATIC int NCR_700_slave_configure(struct scsi_device *SDpnt);
 | |
| STATIC void NCR_700_slave_destroy(struct scsi_device *SDpnt);
 | |
| static int NCR_700_change_queue_depth(struct scsi_device *SDpnt, int depth);
 | |
| 
 | |
| STATIC struct device_attribute *NCR_700_dev_attrs[];
 | |
| 
 | |
| STATIC struct scsi_transport_template *NCR_700_transport_template = NULL;
 | |
| 
 | |
| static char *NCR_700_phase[] = {
 | |
| 	"",
 | |
| 	"after selection",
 | |
| 	"before command phase",
 | |
| 	"after command phase",
 | |
| 	"after status phase",
 | |
| 	"after data in phase",
 | |
| 	"after data out phase",
 | |
| 	"during data phase",
 | |
| };
 | |
| 
 | |
| static char *NCR_700_condition[] = {
 | |
| 	"",
 | |
| 	"NOT MSG_OUT",
 | |
| 	"UNEXPECTED PHASE",
 | |
| 	"NOT MSG_IN",
 | |
| 	"UNEXPECTED MSG",
 | |
| 	"MSG_IN",
 | |
| 	"SDTR_MSG RECEIVED",
 | |
| 	"REJECT_MSG RECEIVED",
 | |
| 	"DISCONNECT_MSG RECEIVED",
 | |
| 	"MSG_OUT",
 | |
| 	"DATA_IN",
 | |
| 	
 | |
| };
 | |
| 
 | |
| static char *NCR_700_fatal_messages[] = {
 | |
| 	"unexpected message after reselection",
 | |
| 	"still MSG_OUT after message injection",
 | |
| 	"not MSG_IN after selection",
 | |
| 	"Illegal message length received",
 | |
| };
 | |
| 
 | |
| static char *NCR_700_SBCL_bits[] = {
 | |
| 	"IO ",
 | |
| 	"CD ",
 | |
| 	"MSG ",
 | |
| 	"ATN ",
 | |
| 	"SEL ",
 | |
| 	"BSY ",
 | |
| 	"ACK ",
 | |
| 	"REQ ",
 | |
| };
 | |
| 
 | |
| static char *NCR_700_SBCL_to_phase[] = {
 | |
| 	"DATA_OUT",
 | |
| 	"DATA_IN",
 | |
| 	"CMD_OUT",
 | |
| 	"STATE",
 | |
| 	"ILLEGAL PHASE",
 | |
| 	"ILLEGAL PHASE",
 | |
| 	"MSG OUT",
 | |
| 	"MSG IN",
 | |
| };
 | |
| 
 | |
| /* This translates the SDTR message offset and period to a value
 | |
|  * which can be loaded into the SXFER_REG.
 | |
|  *
 | |
|  * NOTE: According to SCSI-2, the true transfer period (in ns) is
 | |
|  *       actually four times this period value */
 | |
| static inline __u8
 | |
| NCR_700_offset_period_to_sxfer(struct NCR_700_Host_Parameters *hostdata,
 | |
| 			       __u8 offset, __u8 period)
 | |
| {
 | |
| 	int XFERP;
 | |
| 
 | |
| 	__u8 min_xferp = (hostdata->chip710
 | |
| 			  ? NCR_710_MIN_XFERP : NCR_700_MIN_XFERP);
 | |
| 	__u8 max_offset = (hostdata->chip710
 | |
| 			   ? NCR_710_MAX_OFFSET : NCR_700_MAX_OFFSET);
 | |
| 
 | |
| 	if(offset == 0)
 | |
| 		return 0;
 | |
| 
 | |
| 	if(period < hostdata->min_period) {
 | |
| 		printk(KERN_WARNING "53c700: Period %dns is less than this chip's minimum, setting to %d\n", period*4, NCR_700_MIN_PERIOD*4);
 | |
| 		period = hostdata->min_period;
 | |
| 	}
 | |
| 	XFERP = (period*4 * hostdata->sync_clock)/1000 - 4;
 | |
| 	if(offset > max_offset) {
 | |
| 		printk(KERN_WARNING "53c700: Offset %d exceeds chip maximum, setting to %d\n",
 | |
| 		       offset, max_offset);
 | |
| 		offset = max_offset;
 | |
| 	}
 | |
| 	if(XFERP < min_xferp) {
 | |
| 		XFERP =  min_xferp;
 | |
| 	}
 | |
| 	return (offset & 0x0f) | (XFERP & 0x07)<<4;
 | |
| }
 | |
| 
 | |
| static inline __u8
 | |
| NCR_700_get_SXFER(struct scsi_device *SDp)
 | |
| {
 | |
| 	struct NCR_700_Host_Parameters *hostdata = 
 | |
| 		(struct NCR_700_Host_Parameters *)SDp->host->hostdata[0];
 | |
| 
 | |
| 	return NCR_700_offset_period_to_sxfer(hostdata,
 | |
| 					      spi_offset(SDp->sdev_target),
 | |
| 					      spi_period(SDp->sdev_target));
 | |
| }
 | |
| 
 | |
| static inline dma_addr_t virt_to_dma(struct NCR_700_Host_Parameters *h, void *p)
 | |
| {
 | |
| 	return h->pScript + ((uintptr_t)p - (uintptr_t)h->script);
 | |
| }
 | |
| 
 | |
| static inline void dma_sync_to_dev(struct NCR_700_Host_Parameters *h,
 | |
| 		void *addr, size_t size)
 | |
| {
 | |
| 	if (h->noncoherent)
 | |
| 		dma_sync_single_for_device(h->dev, virt_to_dma(h, addr),
 | |
| 					   size, DMA_BIDIRECTIONAL);
 | |
| }
 | |
| 
 | |
| static inline void dma_sync_from_dev(struct NCR_700_Host_Parameters *h,
 | |
| 		void *addr, size_t size)
 | |
| {
 | |
| 	if (h->noncoherent)
 | |
| 		dma_sync_single_for_device(h->dev, virt_to_dma(h, addr), size,
 | |
| 					   DMA_BIDIRECTIONAL);
 | |
| }
 | |
| 
 | |
| struct Scsi_Host *
 | |
| NCR_700_detect(struct scsi_host_template *tpnt,
 | |
| 	       struct NCR_700_Host_Parameters *hostdata, struct device *dev)
 | |
| {
 | |
| 	dma_addr_t pScript, pSlots;
 | |
| 	__u8 *memory;
 | |
| 	__u32 *script;
 | |
| 	struct Scsi_Host *host;
 | |
| 	static int banner = 0;
 | |
| 	int j;
 | |
| 
 | |
| 	if(tpnt->sdev_attrs == NULL)
 | |
| 		tpnt->sdev_attrs = NCR_700_dev_attrs;
 | |
| 
 | |
| 	memory = dma_alloc_coherent(dev, TOTAL_MEM_SIZE, &pScript, GFP_KERNEL);
 | |
| 	if (!memory) {
 | |
| 		hostdata->noncoherent = 1;
 | |
| 		memory = dma_alloc_noncoherent(dev, TOTAL_MEM_SIZE, &pScript,
 | |
| 					 DMA_BIDIRECTIONAL, GFP_KERNEL);
 | |
| 	}
 | |
| 	if (!memory) {
 | |
| 		printk(KERN_ERR "53c700: Failed to allocate memory for driver, detaching\n");
 | |
| 		return NULL;
 | |
| 	}
 | |
| 
 | |
| 	script = (__u32 *)memory;
 | |
| 	hostdata->msgin = memory + MSGIN_OFFSET;
 | |
| 	hostdata->msgout = memory + MSGOUT_OFFSET;
 | |
| 	hostdata->status = memory + STATUS_OFFSET;
 | |
| 	hostdata->slots = (struct NCR_700_command_slot *)(memory + SLOTS_OFFSET);
 | |
| 	hostdata->dev = dev;
 | |
| 
 | |
| 	pSlots = pScript + SLOTS_OFFSET;
 | |
| 
 | |
| 	/* Fill in the missing routines from the host template */
 | |
| 	tpnt->queuecommand = NCR_700_queuecommand;
 | |
| 	tpnt->eh_abort_handler = NCR_700_abort;
 | |
| 	tpnt->eh_host_reset_handler = NCR_700_host_reset;
 | |
| 	tpnt->can_queue = NCR_700_COMMAND_SLOTS_PER_HOST;
 | |
| 	tpnt->sg_tablesize = NCR_700_SG_SEGMENTS;
 | |
| 	tpnt->cmd_per_lun = NCR_700_CMD_PER_LUN;
 | |
| 	tpnt->slave_configure = NCR_700_slave_configure;
 | |
| 	tpnt->slave_destroy = NCR_700_slave_destroy;
 | |
| 	tpnt->slave_alloc = NCR_700_slave_alloc;
 | |
| 	tpnt->change_queue_depth = NCR_700_change_queue_depth;
 | |
| 
 | |
| 	if(tpnt->name == NULL)
 | |
| 		tpnt->name = "53c700";
 | |
| 	if(tpnt->proc_name == NULL)
 | |
| 		tpnt->proc_name = "53c700";
 | |
| 
 | |
| 	host = scsi_host_alloc(tpnt, 4);
 | |
| 	if (!host)
 | |
| 		return NULL;
 | |
| 	memset(hostdata->slots, 0, sizeof(struct NCR_700_command_slot)
 | |
| 	       * NCR_700_COMMAND_SLOTS_PER_HOST);
 | |
| 	for (j = 0; j < NCR_700_COMMAND_SLOTS_PER_HOST; j++) {
 | |
| 		dma_addr_t offset = (dma_addr_t)((unsigned long)&hostdata->slots[j].SG[0]
 | |
| 					  - (unsigned long)&hostdata->slots[0].SG[0]);
 | |
| 		hostdata->slots[j].pSG = (struct NCR_700_SG_List *)((unsigned long)(pSlots + offset));
 | |
| 		if(j == 0)
 | |
| 			hostdata->free_list = &hostdata->slots[j];
 | |
| 		else
 | |
| 			hostdata->slots[j-1].ITL_forw = &hostdata->slots[j];
 | |
| 		hostdata->slots[j].state = NCR_700_SLOT_FREE;
 | |
| 	}
 | |
| 
 | |
| 	for (j = 0; j < ARRAY_SIZE(SCRIPT); j++)
 | |
| 		script[j] = bS_to_host(SCRIPT[j]);
 | |
| 
 | |
| 	/* adjust all labels to be bus physical */
 | |
| 	for (j = 0; j < PATCHES; j++)
 | |
| 		script[LABELPATCHES[j]] = bS_to_host(pScript + SCRIPT[LABELPATCHES[j]]);
 | |
| 	/* now patch up fixed addresses. */
 | |
| 	script_patch_32(hostdata, script, MessageLocation,
 | |
| 			pScript + MSGOUT_OFFSET);
 | |
| 	script_patch_32(hostdata, script, StatusAddress,
 | |
| 			pScript + STATUS_OFFSET);
 | |
| 	script_patch_32(hostdata, script, ReceiveMsgAddress,
 | |
| 			pScript + MSGIN_OFFSET);
 | |
| 
 | |
| 	hostdata->script = script;
 | |
| 	hostdata->pScript = pScript;
 | |
| 	dma_sync_single_for_device(hostdata->dev, pScript, sizeof(SCRIPT), DMA_TO_DEVICE);
 | |
| 	hostdata->state = NCR_700_HOST_FREE;
 | |
| 	hostdata->cmd = NULL;
 | |
| 	host->max_id = 8;
 | |
| 	host->max_lun = NCR_700_MAX_LUNS;
 | |
| 	BUG_ON(NCR_700_transport_template == NULL);
 | |
| 	host->transportt = NCR_700_transport_template;
 | |
| 	host->unique_id = (unsigned long)hostdata->base;
 | |
| 	hostdata->eh_complete = NULL;
 | |
| 	host->hostdata[0] = (unsigned long)hostdata;
 | |
| 	/* kick the chip */
 | |
| 	NCR_700_writeb(0xff, host, CTEST9_REG);
 | |
| 	if (hostdata->chip710)
 | |
| 		hostdata->rev = (NCR_700_readb(host, CTEST8_REG)>>4) & 0x0f;
 | |
| 	else
 | |
| 		hostdata->rev = (NCR_700_readb(host, CTEST7_REG)>>4) & 0x0f;
 | |
| 	hostdata->fast = (NCR_700_readb(host, CTEST9_REG) == 0);
 | |
| 	if (banner == 0) {
 | |
| 		printk(KERN_NOTICE "53c700: Version " NCR_700_VERSION " By James.Bottomley@HansenPartnership.com\n");
 | |
| 		banner = 1;
 | |
| 	}
 | |
| 	printk(KERN_NOTICE "scsi%d: %s rev %d %s\n", host->host_no,
 | |
| 	       hostdata->chip710 ? "53c710" :
 | |
| 	       (hostdata->fast ? "53c700-66" : "53c700"),
 | |
| 	       hostdata->rev, hostdata->differential ?
 | |
| 	       "(Differential)" : "");
 | |
| 	/* reset the chip */
 | |
| 	NCR_700_chip_reset(host);
 | |
| 
 | |
| 	if (scsi_add_host(host, dev)) {
 | |
| 		dev_printk(KERN_ERR, dev, "53c700: scsi_add_host failed\n");
 | |
| 		scsi_host_put(host);
 | |
| 		return NULL;
 | |
| 	}
 | |
| 
 | |
| 	spi_signalling(host) = hostdata->differential ? SPI_SIGNAL_HVD :
 | |
| 		SPI_SIGNAL_SE;
 | |
| 
 | |
| 	return host;
 | |
| }
 | |
| 
 | |
| int
 | |
| NCR_700_release(struct Scsi_Host *host)
 | |
| {
 | |
| 	struct NCR_700_Host_Parameters *hostdata = 
 | |
| 		(struct NCR_700_Host_Parameters *)host->hostdata[0];
 | |
| 
 | |
| 	if (hostdata->noncoherent)
 | |
| 		dma_free_noncoherent(hostdata->dev, TOTAL_MEM_SIZE,
 | |
| 				hostdata->script, hostdata->pScript,
 | |
| 				DMA_BIDIRECTIONAL);
 | |
| 	else
 | |
| 		dma_free_coherent(hostdata->dev, TOTAL_MEM_SIZE,
 | |
| 				  hostdata->script, hostdata->pScript);
 | |
| 	return 1;
 | |
| }
 | |
| 
 | |
| static inline __u8
 | |
| NCR_700_identify(int can_disconnect, __u8 lun)
 | |
| {
 | |
| 	return IDENTIFY_BASE |
 | |
| 		((can_disconnect) ? 0x40 : 0) |
 | |
| 		(lun & NCR_700_LUN_MASK);
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * Function : static int data_residual (Scsi_Host *host)
 | |
|  *
 | |
|  * Purpose : return residual data count of what's in the chip.  If you
 | |
|  * really want to know what this function is doing, it's almost a
 | |
|  * direct transcription of the algorithm described in the 53c710
 | |
|  * guide, except that the DBC and DFIFO registers are only 6 bits
 | |
|  * wide on a 53c700.
 | |
|  *
 | |
|  * Inputs : host - SCSI host */
 | |
| static inline int
 | |
| NCR_700_data_residual (struct Scsi_Host *host) {
 | |
| 	struct NCR_700_Host_Parameters *hostdata = 
 | |
| 		(struct NCR_700_Host_Parameters *)host->hostdata[0];
 | |
| 	int count, synchronous = 0;
 | |
| 	unsigned int ddir;
 | |
| 
 | |
| 	if(hostdata->chip710) {
 | |
| 		count = ((NCR_700_readb(host, DFIFO_REG) & 0x7f) -
 | |
| 			 (NCR_700_readl(host, DBC_REG) & 0x7f)) & 0x7f;
 | |
| 	} else {
 | |
| 		count = ((NCR_700_readb(host, DFIFO_REG) & 0x3f) -
 | |
| 			 (NCR_700_readl(host, DBC_REG) & 0x3f)) & 0x3f;
 | |
| 	}
 | |
| 	
 | |
| 	if(hostdata->fast)
 | |
| 		synchronous = NCR_700_readb(host, SXFER_REG) & 0x0f;
 | |
| 	
 | |
| 	/* get the data direction */
 | |
| 	ddir = NCR_700_readb(host, CTEST0_REG) & 0x01;
 | |
| 
 | |
| 	if (ddir) {
 | |
| 		/* Receive */
 | |
| 		if (synchronous) 
 | |
| 			count += (NCR_700_readb(host, SSTAT2_REG) & 0xf0) >> 4;
 | |
| 		else
 | |
| 			if (NCR_700_readb(host, SSTAT1_REG) & SIDL_REG_FULL)
 | |
| 				++count;
 | |
| 	} else {
 | |
| 		/* Send */
 | |
| 		__u8 sstat = NCR_700_readb(host, SSTAT1_REG);
 | |
| 		if (sstat & SODL_REG_FULL)
 | |
| 			++count;
 | |
| 		if (synchronous && (sstat & SODR_REG_FULL))
 | |
| 			++count;
 | |
| 	}
 | |
| #ifdef NCR_700_DEBUG
 | |
| 	if(count)
 | |
| 		printk("RESIDUAL IS %d (ddir %d)\n", count, ddir);
 | |
| #endif
 | |
| 	return count;
 | |
| }
 | |
| 
 | |
| /* print out the SCSI wires and corresponding phase from the SBCL register
 | |
|  * in the chip */
 | |
| static inline char *
 | |
| sbcl_to_string(__u8 sbcl)
 | |
| {
 | |
| 	int i;
 | |
| 	static char ret[256];
 | |
| 
 | |
| 	ret[0]='\0';
 | |
| 	for(i=0; i<8; i++) {
 | |
| 		if((1<<i) & sbcl) 
 | |
| 			strcat(ret, NCR_700_SBCL_bits[i]);
 | |
| 	}
 | |
| 	strcat(ret, NCR_700_SBCL_to_phase[sbcl & 0x07]);
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| static inline __u8
 | |
| bitmap_to_number(__u8 bitmap)
 | |
| {
 | |
| 	__u8 i;
 | |
| 
 | |
| 	for(i=0; i<8 && !(bitmap &(1<<i)); i++)
 | |
| 		;
 | |
| 	return i;
 | |
| }
 | |
| 
 | |
| /* Pull a slot off the free list */
 | |
| STATIC struct NCR_700_command_slot *
 | |
| find_empty_slot(struct NCR_700_Host_Parameters *hostdata)
 | |
| {
 | |
| 	struct NCR_700_command_slot *slot = hostdata->free_list;
 | |
| 
 | |
| 	if(slot == NULL) {
 | |
| 		/* sanity check */
 | |
| 		if(hostdata->command_slot_count != NCR_700_COMMAND_SLOTS_PER_HOST)
 | |
| 			printk(KERN_ERR "SLOTS FULL, but count is %d, should be %d\n", hostdata->command_slot_count, NCR_700_COMMAND_SLOTS_PER_HOST);
 | |
| 		return NULL;
 | |
| 	}
 | |
| 
 | |
| 	if(slot->state != NCR_700_SLOT_FREE)
 | |
| 		/* should panic! */
 | |
| 		printk(KERN_ERR "BUSY SLOT ON FREE LIST!!!\n");
 | |
| 		
 | |
| 
 | |
| 	hostdata->free_list = slot->ITL_forw;
 | |
| 	slot->ITL_forw = NULL;
 | |
| 
 | |
| 
 | |
| 	/* NOTE: set the state to busy here, not queued, since this
 | |
| 	 * indicates the slot is in use and cannot be run by the IRQ
 | |
| 	 * finish routine.  If we cannot queue the command when it
 | |
| 	 * is properly build, we then change to NCR_700_SLOT_QUEUED */
 | |
| 	slot->state = NCR_700_SLOT_BUSY;
 | |
| 	slot->flags = 0;
 | |
| 	hostdata->command_slot_count++;
 | |
| 	
 | |
| 	return slot;
 | |
| }
 | |
| 
 | |
| STATIC void 
 | |
| free_slot(struct NCR_700_command_slot *slot,
 | |
| 	  struct NCR_700_Host_Parameters *hostdata)
 | |
| {
 | |
| 	if((slot->state & NCR_700_SLOT_MASK) != NCR_700_SLOT_MAGIC) {
 | |
| 		printk(KERN_ERR "53c700: SLOT %p is not MAGIC!!!\n", slot);
 | |
| 	}
 | |
| 	if(slot->state == NCR_700_SLOT_FREE) {
 | |
| 		printk(KERN_ERR "53c700: SLOT %p is FREE!!!\n", slot);
 | |
| 	}
 | |
| 	
 | |
| 	slot->resume_offset = 0;
 | |
| 	slot->cmnd = NULL;
 | |
| 	slot->state = NCR_700_SLOT_FREE;
 | |
| 	slot->ITL_forw = hostdata->free_list;
 | |
| 	hostdata->free_list = slot;
 | |
| 	hostdata->command_slot_count--;
 | |
| }
 | |
| 
 | |
| 
 | |
| /* This routine really does very little.  The command is indexed on
 | |
|    the ITL and (if tagged) the ITLQ lists in _queuecommand */
 | |
| STATIC void
 | |
| save_for_reselection(struct NCR_700_Host_Parameters *hostdata,
 | |
| 		     struct scsi_cmnd *SCp, __u32 dsp)
 | |
| {
 | |
| 	/* Its just possible that this gets executed twice */
 | |
| 	if(SCp != NULL) {
 | |
| 		struct NCR_700_command_slot *slot =
 | |
| 			(struct NCR_700_command_slot *)SCp->host_scribble;
 | |
| 
 | |
| 		slot->resume_offset = dsp;
 | |
| 	}
 | |
| 	hostdata->state = NCR_700_HOST_FREE;
 | |
| 	hostdata->cmd = NULL;
 | |
| }
 | |
| 
 | |
| STATIC inline void
 | |
| NCR_700_unmap(struct NCR_700_Host_Parameters *hostdata, struct scsi_cmnd *SCp,
 | |
| 	      struct NCR_700_command_slot *slot)
 | |
| {
 | |
| 	if(SCp->sc_data_direction != DMA_NONE &&
 | |
| 	   SCp->sc_data_direction != DMA_BIDIRECTIONAL)
 | |
| 		scsi_dma_unmap(SCp);
 | |
| }
 | |
| 
 | |
| STATIC inline void
 | |
| NCR_700_scsi_done(struct NCR_700_Host_Parameters *hostdata,
 | |
| 	       struct scsi_cmnd *SCp, int result)
 | |
| {
 | |
| 	hostdata->state = NCR_700_HOST_FREE;
 | |
| 	hostdata->cmd = NULL;
 | |
| 
 | |
| 	if(SCp != NULL) {
 | |
| 		struct NCR_700_command_slot *slot =
 | |
| 			(struct NCR_700_command_slot *)SCp->host_scribble;
 | |
| 
 | |
| 		dma_unmap_single(hostdata->dev, slot->pCmd,
 | |
| 				 MAX_COMMAND_SIZE, DMA_TO_DEVICE);
 | |
| 		if (slot->flags == NCR_700_FLAG_AUTOSENSE) {
 | |
| 			char *cmnd = NCR_700_get_sense_cmnd(SCp->device);
 | |
| 
 | |
| 			dma_unmap_single(hostdata->dev, slot->dma_handle,
 | |
| 					 SCSI_SENSE_BUFFERSIZE, DMA_FROM_DEVICE);
 | |
| 			/* restore the old result if the request sense was
 | |
| 			 * successful */
 | |
| 			if (result == 0)
 | |
| 				result = cmnd[7];
 | |
| 			/* restore the original length */
 | |
| 			SCp->cmd_len = cmnd[8];
 | |
| 		} else
 | |
| 			NCR_700_unmap(hostdata, SCp, slot);
 | |
| 
 | |
| 		free_slot(slot, hostdata);
 | |
| #ifdef NCR_700_DEBUG
 | |
| 		if(NCR_700_get_depth(SCp->device) == 0 ||
 | |
| 		   NCR_700_get_depth(SCp->device) > SCp->device->queue_depth)
 | |
| 			printk(KERN_ERR "Invalid depth in NCR_700_scsi_done(): %d\n",
 | |
| 			       NCR_700_get_depth(SCp->device));
 | |
| #endif /* NCR_700_DEBUG */
 | |
| 		NCR_700_set_depth(SCp->device, NCR_700_get_depth(SCp->device) - 1);
 | |
| 
 | |
| 		SCp->host_scribble = NULL;
 | |
| 		SCp->result = result;
 | |
| 		SCp->scsi_done(SCp);
 | |
| 	} else {
 | |
| 		printk(KERN_ERR "53c700: SCSI DONE HAS NULL SCp\n");
 | |
| 	}
 | |
| }
 | |
| 
 | |
| 
 | |
| STATIC void
 | |
| NCR_700_internal_bus_reset(struct Scsi_Host *host)
 | |
| {
 | |
| 	/* Bus reset */
 | |
| 	NCR_700_writeb(ASSERT_RST, host, SCNTL1_REG);
 | |
| 	udelay(50);
 | |
| 	NCR_700_writeb(0, host, SCNTL1_REG);
 | |
| 
 | |
| }
 | |
| 
 | |
| STATIC void
 | |
| NCR_700_chip_setup(struct Scsi_Host *host)
 | |
| {
 | |
| 	struct NCR_700_Host_Parameters *hostdata = 
 | |
| 		(struct NCR_700_Host_Parameters *)host->hostdata[0];
 | |
| 	__u8 min_period;
 | |
| 	__u8 min_xferp = (hostdata->chip710 ? NCR_710_MIN_XFERP : NCR_700_MIN_XFERP);
 | |
| 
 | |
| 	if(hostdata->chip710) {
 | |
| 		__u8 burst_disable = 0;
 | |
| 		__u8 burst_length = 0;
 | |
| 
 | |
| 		switch (hostdata->burst_length) {
 | |
| 			case 1:
 | |
| 			        burst_length = BURST_LENGTH_1;
 | |
| 			        break;
 | |
| 			case 2:
 | |
| 			        burst_length = BURST_LENGTH_2;
 | |
| 			        break;
 | |
| 			case 4:
 | |
| 			        burst_length = BURST_LENGTH_4;
 | |
| 			        break;
 | |
| 			case 8:
 | |
| 			        burst_length = BURST_LENGTH_8;
 | |
| 			        break;
 | |
| 			default:
 | |
| 			        burst_disable = BURST_DISABLE;
 | |
| 			        break;
 | |
| 		}
 | |
| 		hostdata->dcntl_extra |= COMPAT_700_MODE;
 | |
| 
 | |
| 		NCR_700_writeb(hostdata->dcntl_extra, host, DCNTL_REG);
 | |
| 		NCR_700_writeb(burst_length | hostdata->dmode_extra,
 | |
| 			       host, DMODE_710_REG);
 | |
| 		NCR_700_writeb(burst_disable | hostdata->ctest7_extra |
 | |
| 			       (hostdata->differential ? DIFF : 0),
 | |
| 			       host, CTEST7_REG);
 | |
| 		NCR_700_writeb(BTB_TIMER_DISABLE, host, CTEST0_REG);
 | |
| 		NCR_700_writeb(FULL_ARBITRATION | ENABLE_PARITY | PARITY
 | |
| 			       | AUTO_ATN, host, SCNTL0_REG);
 | |
| 	} else {
 | |
| 		NCR_700_writeb(BURST_LENGTH_8 | hostdata->dmode_extra,
 | |
| 			       host, DMODE_700_REG);
 | |
| 		NCR_700_writeb(hostdata->differential ? 
 | |
| 			       DIFF : 0, host, CTEST7_REG);
 | |
| 		if(hostdata->fast) {
 | |
| 			/* this is for 700-66, does nothing on 700 */
 | |
| 			NCR_700_writeb(LAST_DIS_ENBL | ENABLE_ACTIVE_NEGATION 
 | |
| 				       | GENERATE_RECEIVE_PARITY, host,
 | |
| 				       CTEST8_REG);
 | |
| 		} else {
 | |
| 			NCR_700_writeb(FULL_ARBITRATION | ENABLE_PARITY
 | |
| 				       | PARITY | AUTO_ATN, host, SCNTL0_REG);
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	NCR_700_writeb(1 << host->this_id, host, SCID_REG);
 | |
| 	NCR_700_writeb(0, host, SBCL_REG);
 | |
| 	NCR_700_writeb(ASYNC_OPERATION, host, SXFER_REG);
 | |
| 
 | |
| 	NCR_700_writeb(PHASE_MM_INT | SEL_TIMEOUT_INT | GROSS_ERR_INT | UX_DISC_INT
 | |
| 	     | RST_INT | PAR_ERR_INT | SELECT_INT, host, SIEN_REG);
 | |
| 
 | |
| 	NCR_700_writeb(ABORT_INT | INT_INST_INT | ILGL_INST_INT, host, DIEN_REG);
 | |
| 	NCR_700_writeb(ENABLE_SELECT, host, SCNTL1_REG);
 | |
| 	if(hostdata->clock > 75) {
 | |
| 		printk(KERN_ERR "53c700: Clock speed %dMHz is too high: 75Mhz is the maximum this chip can be driven at\n", hostdata->clock);
 | |
| 		/* do the best we can, but the async clock will be out
 | |
| 		 * of spec: sync divider 2, async divider 3 */
 | |
| 		DEBUG(("53c700: sync 2 async 3\n"));
 | |
| 		NCR_700_writeb(SYNC_DIV_2_0, host, SBCL_REG);
 | |
| 		NCR_700_writeb(ASYNC_DIV_3_0 | hostdata->dcntl_extra, host, DCNTL_REG);
 | |
| 		hostdata->sync_clock = hostdata->clock/2;
 | |
| 	} else	if(hostdata->clock > 50  && hostdata->clock <= 75) {
 | |
| 		/* sync divider 1.5, async divider 3 */
 | |
| 		DEBUG(("53c700: sync 1.5 async 3\n"));
 | |
| 		NCR_700_writeb(SYNC_DIV_1_5, host, SBCL_REG);
 | |
| 		NCR_700_writeb(ASYNC_DIV_3_0 | hostdata->dcntl_extra, host, DCNTL_REG);
 | |
| 		hostdata->sync_clock = hostdata->clock*2;
 | |
| 		hostdata->sync_clock /= 3;
 | |
| 		
 | |
| 	} else if(hostdata->clock > 37 && hostdata->clock <= 50) {
 | |
| 		/* sync divider 1, async divider 2 */
 | |
| 		DEBUG(("53c700: sync 1 async 2\n"));
 | |
| 		NCR_700_writeb(SYNC_DIV_1_0, host, SBCL_REG);
 | |
| 		NCR_700_writeb(ASYNC_DIV_2_0 | hostdata->dcntl_extra, host, DCNTL_REG);
 | |
| 		hostdata->sync_clock = hostdata->clock;
 | |
| 	} else if(hostdata->clock > 25 && hostdata->clock <=37) {
 | |
| 		/* sync divider 1, async divider 1.5 */
 | |
| 		DEBUG(("53c700: sync 1 async 1.5\n"));
 | |
| 		NCR_700_writeb(SYNC_DIV_1_0, host, SBCL_REG);
 | |
| 		NCR_700_writeb(ASYNC_DIV_1_5 | hostdata->dcntl_extra, host, DCNTL_REG);
 | |
| 		hostdata->sync_clock = hostdata->clock;
 | |
| 	} else {
 | |
| 		DEBUG(("53c700: sync 1 async 1\n"));
 | |
| 		NCR_700_writeb(SYNC_DIV_1_0, host, SBCL_REG);
 | |
| 		NCR_700_writeb(ASYNC_DIV_1_0 | hostdata->dcntl_extra, host, DCNTL_REG);
 | |
| 		/* sync divider 1, async divider 1 */
 | |
| 		hostdata->sync_clock = hostdata->clock;
 | |
| 	}
 | |
| 	/* Calculate the actual minimum period that can be supported
 | |
| 	 * by our synchronous clock speed.  See the 710 manual for
 | |
| 	 * exact details of this calculation which is based on a
 | |
| 	 * setting of the SXFER register */
 | |
| 	min_period = 1000*(4+min_xferp)/(4*hostdata->sync_clock);
 | |
| 	hostdata->min_period = NCR_700_MIN_PERIOD;
 | |
| 	if(min_period > NCR_700_MIN_PERIOD)
 | |
| 		hostdata->min_period = min_period;
 | |
| }
 | |
| 
 | |
| STATIC void
 | |
| NCR_700_chip_reset(struct Scsi_Host *host)
 | |
| {
 | |
| 	struct NCR_700_Host_Parameters *hostdata = 
 | |
| 		(struct NCR_700_Host_Parameters *)host->hostdata[0];
 | |
| 	if(hostdata->chip710) {
 | |
| 		NCR_700_writeb(SOFTWARE_RESET_710, host, ISTAT_REG);
 | |
| 		udelay(100);
 | |
| 
 | |
| 		NCR_700_writeb(0, host, ISTAT_REG);
 | |
| 	} else {
 | |
| 		NCR_700_writeb(SOFTWARE_RESET, host, DCNTL_REG);
 | |
| 		udelay(100);
 | |
| 		
 | |
| 		NCR_700_writeb(0, host, DCNTL_REG);
 | |
| 	}
 | |
| 
 | |
| 	mdelay(1000);
 | |
| 
 | |
| 	NCR_700_chip_setup(host);
 | |
| }
 | |
| 
 | |
| /* The heart of the message processing engine is that the instruction
 | |
|  * immediately after the INT is the normal case (and so must be CLEAR
 | |
|  * ACK).  If we want to do something else, we call that routine in
 | |
|  * scripts and set temp to be the normal case + 8 (skipping the CLEAR
 | |
|  * ACK) so that the routine returns correctly to resume its activity
 | |
|  * */
 | |
| STATIC __u32
 | |
| process_extended_message(struct Scsi_Host *host, 
 | |
| 			 struct NCR_700_Host_Parameters *hostdata,
 | |
| 			 struct scsi_cmnd *SCp, __u32 dsp, __u32 dsps)
 | |
| {
 | |
| 	__u32 resume_offset = dsp, temp = dsp + 8;
 | |
| 	__u8 pun = 0xff, lun = 0xff;
 | |
| 
 | |
| 	if(SCp != NULL) {
 | |
| 		pun = SCp->device->id;
 | |
| 		lun = SCp->device->lun;
 | |
| 	}
 | |
| 
 | |
| 	switch(hostdata->msgin[2]) {
 | |
| 	case A_SDTR_MSG:
 | |
| 		if(SCp != NULL && NCR_700_is_flag_set(SCp->device, NCR_700_DEV_BEGIN_SYNC_NEGOTIATION)) {
 | |
| 			struct scsi_target *starget = SCp->device->sdev_target;
 | |
| 			__u8 period = hostdata->msgin[3];
 | |
| 			__u8 offset = hostdata->msgin[4];
 | |
| 
 | |
| 			if(offset == 0 || period == 0) {
 | |
| 				offset = 0;
 | |
| 				period = 0;
 | |
| 			}
 | |
| 
 | |
| 			spi_offset(starget) = offset;
 | |
| 			spi_period(starget) = period;
 | |
| 			
 | |
| 			if(NCR_700_is_flag_set(SCp->device, NCR_700_DEV_PRINT_SYNC_NEGOTIATION)) {
 | |
| 				spi_display_xfer_agreement(starget);
 | |
| 				NCR_700_clear_flag(SCp->device, NCR_700_DEV_PRINT_SYNC_NEGOTIATION);
 | |
| 			}
 | |
| 			
 | |
| 			NCR_700_set_flag(SCp->device, NCR_700_DEV_NEGOTIATED_SYNC);
 | |
| 			NCR_700_clear_flag(SCp->device, NCR_700_DEV_BEGIN_SYNC_NEGOTIATION);
 | |
| 			
 | |
| 			NCR_700_writeb(NCR_700_get_SXFER(SCp->device),
 | |
| 				       host, SXFER_REG);
 | |
| 
 | |
| 		} else {
 | |
| 			/* SDTR message out of the blue, reject it */
 | |
| 			shost_printk(KERN_WARNING, host,
 | |
| 				"Unexpected SDTR msg\n");
 | |
| 			hostdata->msgout[0] = A_REJECT_MSG;
 | |
| 			dma_sync_to_dev(hostdata, hostdata->msgout, 1);
 | |
| 			script_patch_16(hostdata, hostdata->script,
 | |
| 			                MessageCount, 1);
 | |
| 			/* SendMsgOut returns, so set up the return
 | |
| 			 * address */
 | |
| 			resume_offset = hostdata->pScript + Ent_SendMessageWithATN;
 | |
| 		}
 | |
| 		break;
 | |
| 	
 | |
| 	case A_WDTR_MSG:
 | |
| 		printk(KERN_INFO "scsi%d: (%d:%d), Unsolicited WDTR after CMD, Rejecting\n",
 | |
| 		       host->host_no, pun, lun);
 | |
| 		hostdata->msgout[0] = A_REJECT_MSG;
 | |
| 		dma_sync_to_dev(hostdata, hostdata->msgout, 1);
 | |
| 		script_patch_16(hostdata, hostdata->script, MessageCount, 1);
 | |
| 		resume_offset = hostdata->pScript + Ent_SendMessageWithATN;
 | |
| 
 | |
| 		break;
 | |
| 
 | |
| 	default:
 | |
| 		printk(KERN_INFO "scsi%d (%d:%d): Unexpected message %s: ",
 | |
| 		       host->host_no, pun, lun,
 | |
| 		       NCR_700_phase[(dsps & 0xf00) >> 8]);
 | |
| 		spi_print_msg(hostdata->msgin);
 | |
| 		printk("\n");
 | |
| 		/* just reject it */
 | |
| 		hostdata->msgout[0] = A_REJECT_MSG;
 | |
| 		dma_sync_to_dev(hostdata, hostdata->msgout, 1);
 | |
| 		script_patch_16(hostdata, hostdata->script, MessageCount, 1);
 | |
| 		/* SendMsgOut returns, so set up the return
 | |
| 		 * address */
 | |
| 		resume_offset = hostdata->pScript + Ent_SendMessageWithATN;
 | |
| 	}
 | |
| 	NCR_700_writel(temp, host, TEMP_REG);
 | |
| 	return resume_offset;
 | |
| }
 | |
| 
 | |
| STATIC __u32
 | |
| process_message(struct Scsi_Host *host,	struct NCR_700_Host_Parameters *hostdata,
 | |
| 		struct scsi_cmnd *SCp, __u32 dsp, __u32 dsps)
 | |
| {
 | |
| 	/* work out where to return to */
 | |
| 	__u32 temp = dsp + 8, resume_offset = dsp;
 | |
| 	__u8 pun = 0xff, lun = 0xff;
 | |
| 
 | |
| 	if(SCp != NULL) {
 | |
| 		pun = SCp->device->id;
 | |
| 		lun = SCp->device->lun;
 | |
| 	}
 | |
| 
 | |
| #ifdef NCR_700_DEBUG
 | |
| 	printk("scsi%d (%d:%d): message %s: ", host->host_no, pun, lun,
 | |
| 	       NCR_700_phase[(dsps & 0xf00) >> 8]);
 | |
| 	spi_print_msg(hostdata->msgin);
 | |
| 	printk("\n");
 | |
| #endif
 | |
| 
 | |
| 	switch(hostdata->msgin[0]) {
 | |
| 
 | |
| 	case A_EXTENDED_MSG:
 | |
| 		resume_offset =  process_extended_message(host, hostdata, SCp,
 | |
| 							  dsp, dsps);
 | |
| 		break;
 | |
| 
 | |
| 	case A_REJECT_MSG:
 | |
| 		if(SCp != NULL && NCR_700_is_flag_set(SCp->device, NCR_700_DEV_BEGIN_SYNC_NEGOTIATION)) {
 | |
| 			/* Rejected our sync negotiation attempt */
 | |
| 			spi_period(SCp->device->sdev_target) =
 | |
| 				spi_offset(SCp->device->sdev_target) = 0;
 | |
| 			NCR_700_set_flag(SCp->device, NCR_700_DEV_NEGOTIATED_SYNC);
 | |
| 			NCR_700_clear_flag(SCp->device, NCR_700_DEV_BEGIN_SYNC_NEGOTIATION);
 | |
| 		} else if(SCp != NULL && NCR_700_get_tag_neg_state(SCp->device) == NCR_700_DURING_TAG_NEGOTIATION) {
 | |
| 			/* rejected our first simple tag message */
 | |
| 			scmd_printk(KERN_WARNING, SCp,
 | |
| 				"Rejected first tag queue attempt, turning off tag queueing\n");
 | |
| 			/* we're done negotiating */
 | |
| 			NCR_700_set_tag_neg_state(SCp->device, NCR_700_FINISHED_TAG_NEGOTIATION);
 | |
| 			hostdata->tag_negotiated &= ~(1<<scmd_id(SCp));
 | |
| 
 | |
| 			SCp->device->tagged_supported = 0;
 | |
| 			SCp->device->simple_tags = 0;
 | |
| 			scsi_change_queue_depth(SCp->device, host->cmd_per_lun);
 | |
| 		} else {
 | |
| 			shost_printk(KERN_WARNING, host,
 | |
| 				"(%d:%d) Unexpected REJECT Message %s\n",
 | |
| 			       pun, lun,
 | |
| 			       NCR_700_phase[(dsps & 0xf00) >> 8]);
 | |
| 			/* however, just ignore it */
 | |
| 		}
 | |
| 		break;
 | |
| 
 | |
| 	case A_PARITY_ERROR_MSG:
 | |
| 		printk(KERN_ERR "scsi%d (%d:%d) Parity Error!\n", host->host_no,
 | |
| 		       pun, lun);
 | |
| 		NCR_700_internal_bus_reset(host);
 | |
| 		break;
 | |
| 	case A_SIMPLE_TAG_MSG:
 | |
| 		printk(KERN_INFO "scsi%d (%d:%d) SIMPLE TAG %d %s\n", host->host_no,
 | |
| 		       pun, lun, hostdata->msgin[1],
 | |
| 		       NCR_700_phase[(dsps & 0xf00) >> 8]);
 | |
| 		/* just ignore it */
 | |
| 		break;
 | |
| 	default:
 | |
| 		printk(KERN_INFO "scsi%d (%d:%d): Unexpected message %s: ",
 | |
| 		       host->host_no, pun, lun,
 | |
| 		       NCR_700_phase[(dsps & 0xf00) >> 8]);
 | |
| 
 | |
| 		spi_print_msg(hostdata->msgin);
 | |
| 		printk("\n");
 | |
| 		/* just reject it */
 | |
| 		hostdata->msgout[0] = A_REJECT_MSG;
 | |
| 		dma_sync_to_dev(hostdata, hostdata->msgout, 1);
 | |
| 		script_patch_16(hostdata, hostdata->script, MessageCount, 1);
 | |
| 		/* SendMsgOut returns, so set up the return
 | |
| 		 * address */
 | |
| 		resume_offset = hostdata->pScript + Ent_SendMessageWithATN;
 | |
| 
 | |
| 		break;
 | |
| 	}
 | |
| 	NCR_700_writel(temp, host, TEMP_REG);
 | |
| 	/* set us up to receive another message */
 | |
| 	dma_sync_from_dev(hostdata, hostdata->msgin, MSG_ARRAY_SIZE);
 | |
| 	return resume_offset;
 | |
| }
 | |
| 
 | |
| STATIC __u32
 | |
| process_script_interrupt(__u32 dsps, __u32 dsp, struct scsi_cmnd *SCp,
 | |
| 			 struct Scsi_Host *host,
 | |
| 			 struct NCR_700_Host_Parameters *hostdata)
 | |
| {
 | |
| 	__u32 resume_offset = 0;
 | |
| 	__u8 pun = 0xff, lun=0xff;
 | |
| 
 | |
| 	if(SCp != NULL) {
 | |
| 		pun = SCp->device->id;
 | |
| 		lun = SCp->device->lun;
 | |
| 	}
 | |
| 
 | |
| 	if(dsps == A_GOOD_STATUS_AFTER_STATUS) {
 | |
| 		DEBUG(("  COMMAND COMPLETE, status=%02x\n",
 | |
| 		       hostdata->status[0]));
 | |
| 		/* OK, if TCQ still under negotiation, we now know it works */
 | |
| 		if (NCR_700_get_tag_neg_state(SCp->device) == NCR_700_DURING_TAG_NEGOTIATION)
 | |
| 			NCR_700_set_tag_neg_state(SCp->device,
 | |
| 						  NCR_700_FINISHED_TAG_NEGOTIATION);
 | |
| 
 | |
| 		/* check for contingent allegiance conditions */
 | |
| 		if (hostdata->status[0] == SAM_STAT_CHECK_CONDITION ||
 | |
| 		    hostdata->status[0] == SAM_STAT_COMMAND_TERMINATED) {
 | |
| 			struct NCR_700_command_slot *slot =
 | |
| 				(struct NCR_700_command_slot *)SCp->host_scribble;
 | |
| 			if(slot->flags == NCR_700_FLAG_AUTOSENSE) {
 | |
| 				/* OOPS: bad device, returning another
 | |
| 				 * contingent allegiance condition */
 | |
| 				scmd_printk(KERN_ERR, SCp,
 | |
| 					"broken device is looping in contingent allegiance: ignoring\n");
 | |
| 				NCR_700_scsi_done(hostdata, SCp, hostdata->status[0]);
 | |
| 			} else {
 | |
| 				char *cmnd =
 | |
| 					NCR_700_get_sense_cmnd(SCp->device);
 | |
| #ifdef NCR_DEBUG
 | |
| 				scsi_print_command(SCp);
 | |
| 				printk("  cmd %p has status %d, requesting sense\n",
 | |
| 				       SCp, hostdata->status[0]);
 | |
| #endif
 | |
| 				/* we can destroy the command here
 | |
| 				 * because the contingent allegiance
 | |
| 				 * condition will cause a retry which
 | |
| 				 * will re-copy the command from the
 | |
| 				 * saved data_cmnd.  We also unmap any
 | |
| 				 * data associated with the command
 | |
| 				 * here */
 | |
| 				NCR_700_unmap(hostdata, SCp, slot);
 | |
| 				dma_unmap_single(hostdata->dev, slot->pCmd,
 | |
| 						 MAX_COMMAND_SIZE,
 | |
| 						 DMA_TO_DEVICE);
 | |
| 
 | |
| 				cmnd[0] = REQUEST_SENSE;
 | |
| 				cmnd[1] = (lun & 0x7) << 5;
 | |
| 				cmnd[2] = 0;
 | |
| 				cmnd[3] = 0;
 | |
| 				cmnd[4] = SCSI_SENSE_BUFFERSIZE;
 | |
| 				cmnd[5] = 0;
 | |
| 				/* Here's a quiet hack: the
 | |
| 				 * REQUEST_SENSE command is six bytes,
 | |
| 				 * so store a flag indicating that
 | |
| 				 * this was an internal sense request
 | |
| 				 * and the original status at the end
 | |
| 				 * of the command */
 | |
| 				cmnd[6] = NCR_700_INTERNAL_SENSE_MAGIC;
 | |
| 				cmnd[7] = hostdata->status[0];
 | |
| 				cmnd[8] = SCp->cmd_len;
 | |
| 				SCp->cmd_len = 6; /* command length for
 | |
| 						   * REQUEST_SENSE */
 | |
| 				slot->pCmd = dma_map_single(hostdata->dev, cmnd, MAX_COMMAND_SIZE, DMA_TO_DEVICE);
 | |
| 				slot->dma_handle = dma_map_single(hostdata->dev, SCp->sense_buffer, SCSI_SENSE_BUFFERSIZE, DMA_FROM_DEVICE);
 | |
| 				slot->SG[0].ins = bS_to_host(SCRIPT_MOVE_DATA_IN | SCSI_SENSE_BUFFERSIZE);
 | |
| 				slot->SG[0].pAddr = bS_to_host(slot->dma_handle);
 | |
| 				slot->SG[1].ins = bS_to_host(SCRIPT_RETURN);
 | |
| 				slot->SG[1].pAddr = 0;
 | |
| 				slot->resume_offset = hostdata->pScript;
 | |
| 				dma_sync_to_dev(hostdata, slot->SG, sizeof(slot->SG[0])*2);
 | |
| 				dma_sync_from_dev(hostdata, SCp->sense_buffer, SCSI_SENSE_BUFFERSIZE);
 | |
| 
 | |
| 				/* queue the command for reissue */
 | |
| 				slot->state = NCR_700_SLOT_QUEUED;
 | |
| 				slot->flags = NCR_700_FLAG_AUTOSENSE;
 | |
| 				hostdata->state = NCR_700_HOST_FREE;
 | |
| 				hostdata->cmd = NULL;
 | |
| 			}
 | |
| 		} else {
 | |
| 			// Currently rely on the mid layer evaluation
 | |
| 			// of the tag queuing capability
 | |
| 			//
 | |
| 			//if(status_byte(hostdata->status[0]) == GOOD &&
 | |
| 			//   SCp->cmnd[0] == INQUIRY && SCp->use_sg == 0) {
 | |
| 			//	/* Piggy back the tag queueing support
 | |
| 			//	 * on this command */
 | |
| 			//	dma_sync_single_for_cpu(hostdata->dev,
 | |
| 			//			    slot->dma_handle,
 | |
| 			//			    SCp->request_bufflen,
 | |
| 			//			    DMA_FROM_DEVICE);
 | |
| 			//	if(((char *)SCp->request_buffer)[7] & 0x02) {
 | |
| 			//		scmd_printk(KERN_INFO, SCp,
 | |
| 			//		     "Enabling Tag Command Queuing\n");
 | |
| 			//		hostdata->tag_negotiated |= (1<<scmd_id(SCp));
 | |
| 			//		NCR_700_set_flag(SCp->device, NCR_700_DEV_BEGIN_TAG_QUEUEING);
 | |
| 			//	} else {
 | |
| 			//		NCR_700_clear_flag(SCp->device, NCR_700_DEV_BEGIN_TAG_QUEUEING);
 | |
| 			//		hostdata->tag_negotiated &= ~(1<<scmd_id(SCp));
 | |
| 			//	}
 | |
| 			//}
 | |
| 			NCR_700_scsi_done(hostdata, SCp, hostdata->status[0]);
 | |
| 		}
 | |
| 	} else if((dsps & 0xfffff0f0) == A_UNEXPECTED_PHASE) {
 | |
| 		__u8 i = (dsps & 0xf00) >> 8;
 | |
| 
 | |
| 		scmd_printk(KERN_ERR, SCp, "UNEXPECTED PHASE %s (%s)\n",
 | |
| 		       NCR_700_phase[i],
 | |
| 		       sbcl_to_string(NCR_700_readb(host, SBCL_REG)));
 | |
| 		scmd_printk(KERN_ERR, SCp, "         len = %d, cmd =",
 | |
| 			SCp->cmd_len);
 | |
| 		scsi_print_command(SCp);
 | |
| 
 | |
| 		NCR_700_internal_bus_reset(host);
 | |
| 	} else if((dsps & 0xfffff000) == A_FATAL) {
 | |
| 		int i = (dsps & 0xfff);
 | |
| 
 | |
| 		printk(KERN_ERR "scsi%d: (%d:%d) FATAL ERROR: %s\n",
 | |
| 		       host->host_no, pun, lun, NCR_700_fatal_messages[i]);
 | |
| 		if(dsps == A_FATAL_ILLEGAL_MSG_LENGTH) {
 | |
| 			printk(KERN_ERR "     msg begins %02x %02x\n",
 | |
| 			       hostdata->msgin[0], hostdata->msgin[1]);
 | |
| 		}
 | |
| 		NCR_700_internal_bus_reset(host);
 | |
| 	} else if((dsps & 0xfffff0f0) == A_DISCONNECT) {
 | |
| #ifdef NCR_700_DEBUG
 | |
| 		__u8 i = (dsps & 0xf00) >> 8;
 | |
| 
 | |
| 		printk("scsi%d: (%d:%d), DISCONNECTED (%d) %s\n",
 | |
| 		       host->host_no, pun, lun,
 | |
| 		       i, NCR_700_phase[i]);
 | |
| #endif
 | |
| 		save_for_reselection(hostdata, SCp, dsp);
 | |
| 
 | |
| 	} else if(dsps == A_RESELECTION_IDENTIFIED) {
 | |
| 		__u8 lun;
 | |
| 		struct NCR_700_command_slot *slot;
 | |
| 		__u8 reselection_id = hostdata->reselection_id;
 | |
| 		struct scsi_device *SDp;
 | |
| 
 | |
| 		lun = hostdata->msgin[0] & 0x1f;
 | |
| 
 | |
| 		hostdata->reselection_id = 0xff;
 | |
| 		DEBUG(("scsi%d: (%d:%d) RESELECTED!\n",
 | |
| 		       host->host_no, reselection_id, lun));
 | |
| 		/* clear the reselection indicator */
 | |
| 		SDp = __scsi_device_lookup(host, 0, reselection_id, lun);
 | |
| 		if(unlikely(SDp == NULL)) {
 | |
| 			printk(KERN_ERR "scsi%d: (%d:%d) HAS NO device\n",
 | |
| 			       host->host_no, reselection_id, lun);
 | |
| 			BUG();
 | |
| 		}
 | |
| 		if(hostdata->msgin[1] == A_SIMPLE_TAG_MSG) {
 | |
| 			struct scsi_cmnd *SCp;
 | |
| 
 | |
| 			SCp = scsi_host_find_tag(SDp->host, hostdata->msgin[2]);
 | |
| 			if(unlikely(SCp == NULL)) {
 | |
| 				printk(KERN_ERR "scsi%d: (%d:%d) no saved request for tag %d\n", 
 | |
| 				       host->host_no, reselection_id, lun, hostdata->msgin[2]);
 | |
| 				BUG();
 | |
| 			}
 | |
| 
 | |
| 			slot = (struct NCR_700_command_slot *)SCp->host_scribble;
 | |
| 			DDEBUG(KERN_DEBUG, SDp,
 | |
| 				"reselection is tag %d, slot %p(%d)\n",
 | |
| 				hostdata->msgin[2], slot, slot->tag);
 | |
| 		} else {
 | |
| 			struct NCR_700_Device_Parameters *p = SDp->hostdata;
 | |
| 			struct scsi_cmnd *SCp = p->current_cmnd;
 | |
| 
 | |
| 			if(unlikely(SCp == NULL)) {
 | |
| 				sdev_printk(KERN_ERR, SDp,
 | |
| 					"no saved request for untagged cmd\n");
 | |
| 				BUG();
 | |
| 			}
 | |
| 			slot = (struct NCR_700_command_slot *)SCp->host_scribble;
 | |
| 		}
 | |
| 
 | |
| 		if(slot == NULL) {
 | |
| 			printk(KERN_ERR "scsi%d: (%d:%d) RESELECTED but no saved command (MSG = %02x %02x %02x)!!\n",
 | |
| 			       host->host_no, reselection_id, lun,
 | |
| 			       hostdata->msgin[0], hostdata->msgin[1],
 | |
| 			       hostdata->msgin[2]);
 | |
| 		} else {
 | |
| 			if(hostdata->state != NCR_700_HOST_BUSY)
 | |
| 				printk(KERN_ERR "scsi%d: FATAL, host not busy during valid reselection!\n",
 | |
| 				       host->host_no);
 | |
| 			resume_offset = slot->resume_offset;
 | |
| 			hostdata->cmd = slot->cmnd;
 | |
| 
 | |
| 			/* re-patch for this command */
 | |
| 			script_patch_32_abs(hostdata, hostdata->script,
 | |
| 			                    CommandAddress, slot->pCmd);
 | |
| 			script_patch_16(hostdata, hostdata->script,
 | |
| 					CommandCount, slot->cmnd->cmd_len);
 | |
| 			script_patch_32_abs(hostdata, hostdata->script,
 | |
| 			                    SGScriptStartAddress,
 | |
| 					    to32bit(&slot->pSG[0].ins));
 | |
| 
 | |
| 			/* Note: setting SXFER only works if we're
 | |
| 			 * still in the MESSAGE phase, so it is vital
 | |
| 			 * that ACK is still asserted when we process
 | |
| 			 * the reselection message.  The resume offset
 | |
| 			 * should therefore always clear ACK */
 | |
| 			NCR_700_writeb(NCR_700_get_SXFER(hostdata->cmd->device),
 | |
| 				       host, SXFER_REG);
 | |
| 			dma_sync_from_dev(hostdata, hostdata->msgin,
 | |
| 				       MSG_ARRAY_SIZE);
 | |
| 			dma_sync_to_dev(hostdata, hostdata->msgout,
 | |
| 				       MSG_ARRAY_SIZE);
 | |
| 			/* I'm just being paranoid here, the command should
 | |
| 			 * already have been flushed from the cache */
 | |
| 			dma_sync_to_dev(hostdata, slot->cmnd->cmnd,
 | |
| 				       slot->cmnd->cmd_len);
 | |
| 
 | |
| 
 | |
| 			
 | |
| 		}
 | |
| 	} else if(dsps == A_RESELECTED_DURING_SELECTION) {
 | |
| 
 | |
| 		/* This section is full of debugging code because I've
 | |
| 		 * never managed to reach it.  I think what happens is
 | |
| 		 * that, because the 700 runs with selection
 | |
| 		 * interrupts enabled the whole time that we take a
 | |
| 		 * selection interrupt before we manage to get to the
 | |
| 		 * reselected script interrupt */
 | |
| 
 | |
| 		__u8 reselection_id = NCR_700_readb(host, SFBR_REG);
 | |
| 		struct NCR_700_command_slot *slot;
 | |
| 		
 | |
| 		/* Take out our own ID */
 | |
| 		reselection_id &= ~(1<<host->this_id);
 | |
| 		
 | |
| 		/* I've never seen this happen, so keep this as a printk rather
 | |
| 		 * than a debug */
 | |
| 		printk(KERN_INFO "scsi%d: (%d:%d) RESELECTION DURING SELECTION, dsp=%08x[%04x] state=%d, count=%d\n",
 | |
| 		       host->host_no, reselection_id, lun, dsp, dsp - hostdata->pScript, hostdata->state, hostdata->command_slot_count);
 | |
| 
 | |
| 		{
 | |
| 			/* FIXME: DEBUGGING CODE */
 | |
| 			__u32 SG = (__u32)bS_to_cpu(hostdata->script[A_SGScriptStartAddress_used[0]]);
 | |
| 			int i;
 | |
| 
 | |
| 			for(i=0; i< NCR_700_COMMAND_SLOTS_PER_HOST; i++) {
 | |
| 				if(SG >= to32bit(&hostdata->slots[i].pSG[0])
 | |
| 				   && SG <= to32bit(&hostdata->slots[i].pSG[NCR_700_SG_SEGMENTS]))
 | |
| 					break;
 | |
| 			}
 | |
| 			printk(KERN_INFO "IDENTIFIED SG segment as being %08x in slot %p, cmd %p, slot->resume_offset=%08x\n", SG, &hostdata->slots[i], hostdata->slots[i].cmnd, hostdata->slots[i].resume_offset);
 | |
| 			SCp =  hostdata->slots[i].cmnd;
 | |
| 		}
 | |
| 
 | |
| 		if(SCp != NULL) {
 | |
| 			slot = (struct NCR_700_command_slot *)SCp->host_scribble;
 | |
| 			/* change slot from busy to queued to redo command */
 | |
| 			slot->state = NCR_700_SLOT_QUEUED;
 | |
| 		}
 | |
| 		hostdata->cmd = NULL;
 | |
| 		
 | |
| 		if(reselection_id == 0) {
 | |
| 			if(hostdata->reselection_id == 0xff) {
 | |
| 				printk(KERN_ERR "scsi%d: Invalid reselection during selection!!\n", host->host_no);
 | |
| 				return 0;
 | |
| 			} else {
 | |
| 				printk(KERN_ERR "scsi%d: script reselected and we took a selection interrupt\n",
 | |
| 				       host->host_no);
 | |
| 				reselection_id = hostdata->reselection_id;
 | |
| 			}
 | |
| 		} else {
 | |
| 			
 | |
| 			/* convert to real ID */
 | |
| 			reselection_id = bitmap_to_number(reselection_id);
 | |
| 		}
 | |
| 		hostdata->reselection_id = reselection_id;
 | |
| 		/* just in case we have a stale simple tag message, clear it */
 | |
| 		hostdata->msgin[1] = 0;
 | |
| 		dma_sync_to_dev(hostdata, hostdata->msgin, MSG_ARRAY_SIZE);
 | |
| 		if(hostdata->tag_negotiated & (1<<reselection_id)) {
 | |
| 			resume_offset = hostdata->pScript + Ent_GetReselectionWithTag;
 | |
| 		} else {
 | |
| 			resume_offset = hostdata->pScript + Ent_GetReselectionData;
 | |
| 		}
 | |
| 	} else if(dsps == A_COMPLETED_SELECTION_AS_TARGET) {
 | |
| 		/* we've just disconnected from the bus, do nothing since
 | |
| 		 * a return here will re-run the queued command slot
 | |
| 		 * that may have been interrupted by the initial selection */
 | |
| 		DEBUG((" SELECTION COMPLETED\n"));
 | |
| 	} else if((dsps & 0xfffff0f0) == A_MSG_IN) { 
 | |
| 		resume_offset = process_message(host, hostdata, SCp,
 | |
| 						dsp, dsps);
 | |
| 	} else if((dsps &  0xfffff000) == 0) {
 | |
| 		__u8 i = (dsps & 0xf0) >> 4, j = (dsps & 0xf00) >> 8;
 | |
| 		printk(KERN_ERR "scsi%d: (%d:%d), unhandled script condition %s %s at %04x\n",
 | |
| 		       host->host_no, pun, lun, NCR_700_condition[i],
 | |
| 		       NCR_700_phase[j], dsp - hostdata->pScript);
 | |
| 		if(SCp != NULL) {
 | |
| 			struct scatterlist *sg;
 | |
| 
 | |
| 			scsi_print_command(SCp);
 | |
| 			scsi_for_each_sg(SCp, sg, scsi_sg_count(SCp) + 1, i) {
 | |
| 				printk(KERN_INFO " SG[%d].length = %d, move_insn=%08x, addr %08x\n", i, sg->length, ((struct NCR_700_command_slot *)SCp->host_scribble)->SG[i].ins, ((struct NCR_700_command_slot *)SCp->host_scribble)->SG[i].pAddr);
 | |
| 			}
 | |
| 		}
 | |
| 		NCR_700_internal_bus_reset(host);
 | |
| 	} else if((dsps & 0xfffff000) == A_DEBUG_INTERRUPT) {
 | |
| 		printk(KERN_NOTICE "scsi%d (%d:%d) DEBUG INTERRUPT %d AT %08x[%04x], continuing\n",
 | |
| 		       host->host_no, pun, lun, dsps & 0xfff, dsp, dsp - hostdata->pScript);
 | |
| 		resume_offset = dsp;
 | |
| 	} else {
 | |
| 		printk(KERN_ERR "scsi%d: (%d:%d), unidentified script interrupt 0x%x at %04x\n",
 | |
| 		       host->host_no, pun, lun, dsps, dsp - hostdata->pScript);
 | |
| 		NCR_700_internal_bus_reset(host);
 | |
| 	}
 | |
| 	return resume_offset;
 | |
| }
 | |
| 
 | |
| /* We run the 53c700 with selection interrupts always enabled.  This
 | |
|  * means that the chip may be selected as soon as the bus frees.  On a
 | |
|  * busy bus, this can be before the scripts engine finishes its
 | |
|  * processing.  Therefore, part of the selection processing has to be
 | |
|  * to find out what the scripts engine is doing and complete the
 | |
|  * function if necessary (i.e. process the pending disconnect or save
 | |
|  * the interrupted initial selection */
 | |
| STATIC inline __u32
 | |
| process_selection(struct Scsi_Host *host, __u32 dsp)
 | |
| {
 | |
| 	__u8 id = 0;	/* Squash compiler warning */
 | |
| 	int count = 0;
 | |
| 	__u32 resume_offset = 0;
 | |
| 	struct NCR_700_Host_Parameters *hostdata =
 | |
| 		(struct NCR_700_Host_Parameters *)host->hostdata[0];
 | |
| 	struct scsi_cmnd *SCp = hostdata->cmd;
 | |
| 	__u8 sbcl;
 | |
| 
 | |
| 	for(count = 0; count < 5; count++) {
 | |
| 		id = NCR_700_readb(host, hostdata->chip710 ?
 | |
| 				   CTEST9_REG : SFBR_REG);
 | |
| 
 | |
| 		/* Take out our own ID */
 | |
| 		id &= ~(1<<host->this_id);
 | |
| 		if(id != 0) 
 | |
| 			break;
 | |
| 		udelay(5);
 | |
| 	}
 | |
| 	sbcl = NCR_700_readb(host, SBCL_REG);
 | |
| 	if((sbcl & SBCL_IO) == 0) {
 | |
| 		/* mark as having been selected rather than reselected */
 | |
| 		id = 0xff;
 | |
| 	} else {
 | |
| 		/* convert to real ID */
 | |
| 		hostdata->reselection_id = id = bitmap_to_number(id);
 | |
| 		DEBUG(("scsi%d:  Reselected by %d\n",
 | |
| 		       host->host_no, id));
 | |
| 	}
 | |
| 	if(hostdata->state == NCR_700_HOST_BUSY && SCp != NULL) {
 | |
| 		struct NCR_700_command_slot *slot =
 | |
| 			(struct NCR_700_command_slot *)SCp->host_scribble;
 | |
| 		DEBUG(("  ID %d WARNING: RESELECTION OF BUSY HOST, saving cmd %p, slot %p, addr %x [%04x], resume %x!\n", id, hostdata->cmd, slot, dsp, dsp - hostdata->pScript, resume_offset));
 | |
| 		
 | |
| 		switch(dsp - hostdata->pScript) {
 | |
| 		case Ent_Disconnect1:
 | |
| 		case Ent_Disconnect2:
 | |
| 			save_for_reselection(hostdata, SCp, Ent_Disconnect2 + hostdata->pScript);
 | |
| 			break;
 | |
| 		case Ent_Disconnect3:
 | |
| 		case Ent_Disconnect4:
 | |
| 			save_for_reselection(hostdata, SCp, Ent_Disconnect4 + hostdata->pScript);
 | |
| 			break;
 | |
| 		case Ent_Disconnect5:
 | |
| 		case Ent_Disconnect6:
 | |
| 			save_for_reselection(hostdata, SCp, Ent_Disconnect6 + hostdata->pScript);
 | |
| 			break;
 | |
| 		case Ent_Disconnect7:
 | |
| 		case Ent_Disconnect8:
 | |
| 			save_for_reselection(hostdata, SCp, Ent_Disconnect8 + hostdata->pScript);
 | |
| 			break;
 | |
| 		case Ent_Finish1:
 | |
| 		case Ent_Finish2:
 | |
| 			process_script_interrupt(A_GOOD_STATUS_AFTER_STATUS, dsp, SCp, host, hostdata);
 | |
| 			break;
 | |
| 			
 | |
| 		default:
 | |
| 			slot->state = NCR_700_SLOT_QUEUED;
 | |
| 			break;
 | |
| 			}
 | |
| 	}
 | |
| 	hostdata->state = NCR_700_HOST_BUSY;
 | |
| 	hostdata->cmd = NULL;
 | |
| 	/* clear any stale simple tag message */
 | |
| 	hostdata->msgin[1] = 0;
 | |
| 	dma_sync_to_dev(hostdata, hostdata->msgin, MSG_ARRAY_SIZE);
 | |
| 
 | |
| 	if(id == 0xff) {
 | |
| 		/* Selected as target, Ignore */
 | |
| 		resume_offset = hostdata->pScript + Ent_SelectedAsTarget;
 | |
| 	} else if(hostdata->tag_negotiated & (1<<id)) {
 | |
| 		resume_offset = hostdata->pScript + Ent_GetReselectionWithTag;
 | |
| 	} else {
 | |
| 		resume_offset = hostdata->pScript + Ent_GetReselectionData;
 | |
| 	}
 | |
| 	return resume_offset;
 | |
| }
 | |
| 
 | |
| static inline void
 | |
| NCR_700_clear_fifo(struct Scsi_Host *host) {
 | |
| 	const struct NCR_700_Host_Parameters *hostdata
 | |
| 		= (struct NCR_700_Host_Parameters *)host->hostdata[0];
 | |
| 	if(hostdata->chip710) {
 | |
| 		NCR_700_writeb(CLR_FIFO_710, host, CTEST8_REG);
 | |
| 	} else {
 | |
| 		NCR_700_writeb(CLR_FIFO, host, DFIFO_REG);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static inline void
 | |
| NCR_700_flush_fifo(struct Scsi_Host *host) {
 | |
| 	const struct NCR_700_Host_Parameters *hostdata
 | |
| 		= (struct NCR_700_Host_Parameters *)host->hostdata[0];
 | |
| 	if(hostdata->chip710) {
 | |
| 		NCR_700_writeb(FLUSH_DMA_FIFO_710, host, CTEST8_REG);
 | |
| 		udelay(10);
 | |
| 		NCR_700_writeb(0, host, CTEST8_REG);
 | |
| 	} else {
 | |
| 		NCR_700_writeb(FLUSH_DMA_FIFO, host, DFIFO_REG);
 | |
| 		udelay(10);
 | |
| 		NCR_700_writeb(0, host, DFIFO_REG);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| 
 | |
| /* The queue lock with interrupts disabled must be held on entry to
 | |
|  * this function */
 | |
| STATIC int
 | |
| NCR_700_start_command(struct scsi_cmnd *SCp)
 | |
| {
 | |
| 	struct NCR_700_command_slot *slot =
 | |
| 		(struct NCR_700_command_slot *)SCp->host_scribble;
 | |
| 	struct NCR_700_Host_Parameters *hostdata =
 | |
| 		(struct NCR_700_Host_Parameters *)SCp->device->host->hostdata[0];
 | |
| 	__u16 count = 1;	/* for IDENTIFY message */
 | |
| 	u8 lun = SCp->device->lun;
 | |
| 
 | |
| 	if(hostdata->state != NCR_700_HOST_FREE) {
 | |
| 		/* keep this inside the lock to close the race window where
 | |
| 		 * the running command finishes on another CPU while we don't
 | |
| 		 * change the state to queued on this one */
 | |
| 		slot->state = NCR_700_SLOT_QUEUED;
 | |
| 
 | |
| 		DEBUG(("scsi%d: host busy, queueing command %p, slot %p\n",
 | |
| 		       SCp->device->host->host_no, slot->cmnd, slot));
 | |
| 		return 0;
 | |
| 	}
 | |
| 	hostdata->state = NCR_700_HOST_BUSY;
 | |
| 	hostdata->cmd = SCp;
 | |
| 	slot->state = NCR_700_SLOT_BUSY;
 | |
| 	/* keep interrupts disabled until we have the command correctly
 | |
| 	 * set up so we cannot take a selection interrupt */
 | |
| 
 | |
| 	hostdata->msgout[0] = NCR_700_identify((SCp->cmnd[0] != REQUEST_SENSE &&
 | |
| 						slot->flags != NCR_700_FLAG_AUTOSENSE),
 | |
| 					       lun);
 | |
| 	/* for INQUIRY or REQUEST_SENSE commands, we cannot be sure
 | |
| 	 * if the negotiated transfer parameters still hold, so
 | |
| 	 * always renegotiate them */
 | |
| 	if(SCp->cmnd[0] == INQUIRY || SCp->cmnd[0] == REQUEST_SENSE ||
 | |
| 	   slot->flags == NCR_700_FLAG_AUTOSENSE) {
 | |
| 		NCR_700_clear_flag(SCp->device, NCR_700_DEV_NEGOTIATED_SYNC);
 | |
| 	}
 | |
| 
 | |
| 	/* REQUEST_SENSE is asking for contingent I_T_L(_Q) status.
 | |
| 	 * If a contingent allegiance condition exists, the device
 | |
| 	 * will refuse all tags, so send the request sense as untagged
 | |
| 	 * */
 | |
| 	if((hostdata->tag_negotiated & (1<<scmd_id(SCp)))
 | |
| 	   && (slot->tag != SCSI_NO_TAG && SCp->cmnd[0] != REQUEST_SENSE &&
 | |
| 	       slot->flags != NCR_700_FLAG_AUTOSENSE)) {
 | |
| 		count += spi_populate_tag_msg(&hostdata->msgout[count], SCp);
 | |
| 	}
 | |
| 
 | |
| 	if(hostdata->fast &&
 | |
| 	   NCR_700_is_flag_clear(SCp->device, NCR_700_DEV_NEGOTIATED_SYNC)) {
 | |
| 		count += spi_populate_sync_msg(&hostdata->msgout[count],
 | |
| 				spi_period(SCp->device->sdev_target),
 | |
| 				spi_offset(SCp->device->sdev_target));
 | |
| 		NCR_700_set_flag(SCp->device, NCR_700_DEV_BEGIN_SYNC_NEGOTIATION);
 | |
| 	}
 | |
| 
 | |
| 	script_patch_16(hostdata, hostdata->script, MessageCount, count);
 | |
| 
 | |
| 	script_patch_ID(hostdata, hostdata->script, Device_ID, 1<<scmd_id(SCp));
 | |
| 
 | |
| 	script_patch_32_abs(hostdata, hostdata->script, CommandAddress,
 | |
| 			    slot->pCmd);
 | |
| 	script_patch_16(hostdata, hostdata->script, CommandCount, SCp->cmd_len);
 | |
| 	/* finally plumb the beginning of the SG list into the script
 | |
| 	 * */
 | |
| 	script_patch_32_abs(hostdata, hostdata->script,
 | |
| 	                    SGScriptStartAddress, to32bit(&slot->pSG[0].ins));
 | |
| 	NCR_700_clear_fifo(SCp->device->host);
 | |
| 
 | |
| 	if(slot->resume_offset == 0)
 | |
| 		slot->resume_offset = hostdata->pScript;
 | |
| 	/* now perform all the writebacks and invalidates */
 | |
| 	dma_sync_to_dev(hostdata, hostdata->msgout, count);
 | |
| 	dma_sync_from_dev(hostdata, hostdata->msgin, MSG_ARRAY_SIZE);
 | |
| 	dma_sync_to_dev(hostdata, SCp->cmnd, SCp->cmd_len);
 | |
| 	dma_sync_from_dev(hostdata, hostdata->status, 1);
 | |
| 
 | |
| 	/* set the synchronous period/offset */
 | |
| 	NCR_700_writeb(NCR_700_get_SXFER(SCp->device),
 | |
| 		       SCp->device->host, SXFER_REG);
 | |
| 	NCR_700_writel(slot->temp, SCp->device->host, TEMP_REG);
 | |
| 	NCR_700_writel(slot->resume_offset, SCp->device->host, DSP_REG);
 | |
| 
 | |
| 	return 1;
 | |
| }
 | |
| 
 | |
| irqreturn_t
 | |
| NCR_700_intr(int irq, void *dev_id)
 | |
| {
 | |
| 	struct Scsi_Host *host = (struct Scsi_Host *)dev_id;
 | |
| 	struct NCR_700_Host_Parameters *hostdata =
 | |
| 		(struct NCR_700_Host_Parameters *)host->hostdata[0];
 | |
| 	__u8 istat;
 | |
| 	__u32 resume_offset = 0;
 | |
| 	__u8 pun = 0xff, lun = 0xff;
 | |
| 	unsigned long flags;
 | |
| 	int handled = 0;
 | |
| 
 | |
| 	/* Use the host lock to serialise access to the 53c700
 | |
| 	 * hardware.  Note: In future, we may need to take the queue
 | |
| 	 * lock to enter the done routines.  When that happens, we
 | |
| 	 * need to ensure that for this driver, the host lock and the
 | |
| 	 * queue lock point to the same thing. */
 | |
| 	spin_lock_irqsave(host->host_lock, flags);
 | |
| 	if((istat = NCR_700_readb(host, ISTAT_REG))
 | |
| 	      & (SCSI_INT_PENDING | DMA_INT_PENDING)) {
 | |
| 		__u32 dsps;
 | |
| 		__u8 sstat0 = 0, dstat = 0;
 | |
| 		__u32 dsp;
 | |
| 		struct scsi_cmnd *SCp = hostdata->cmd;
 | |
| 
 | |
| 		handled = 1;
 | |
| 		SCp = hostdata->cmd;
 | |
| 
 | |
| 		if(istat & SCSI_INT_PENDING) {
 | |
| 			udelay(10);
 | |
| 
 | |
| 			sstat0 = NCR_700_readb(host, SSTAT0_REG);
 | |
| 		}
 | |
| 
 | |
| 		if(istat & DMA_INT_PENDING) {
 | |
| 			udelay(10);
 | |
| 
 | |
| 			dstat = NCR_700_readb(host, DSTAT_REG);
 | |
| 		}
 | |
| 
 | |
| 		dsps = NCR_700_readl(host, DSPS_REG);
 | |
| 		dsp = NCR_700_readl(host, DSP_REG);
 | |
| 
 | |
| 		DEBUG(("scsi%d: istat %02x sstat0 %02x dstat %02x dsp %04x[%08x] dsps 0x%x\n",
 | |
| 		       host->host_no, istat, sstat0, dstat,
 | |
| 		       (dsp - (__u32)(hostdata->pScript))/4,
 | |
| 		       dsp, dsps));
 | |
| 
 | |
| 		if(SCp != NULL) {
 | |
| 			pun = SCp->device->id;
 | |
| 			lun = SCp->device->lun;
 | |
| 		}
 | |
| 
 | |
| 		if(sstat0 & SCSI_RESET_DETECTED) {
 | |
| 			struct scsi_device *SDp;
 | |
| 			int i;
 | |
| 
 | |
| 			hostdata->state = NCR_700_HOST_BUSY;
 | |
| 
 | |
| 			printk(KERN_ERR "scsi%d: Bus Reset detected, executing command %p, slot %p, dsp %08x[%04x]\n",
 | |
| 			       host->host_no, SCp, SCp == NULL ? NULL : SCp->host_scribble, dsp, dsp - hostdata->pScript);
 | |
| 
 | |
| 			scsi_report_bus_reset(host, 0);
 | |
| 
 | |
| 			/* clear all the negotiated parameters */
 | |
| 			__shost_for_each_device(SDp, host)
 | |
| 				NCR_700_clear_flag(SDp, ~0);
 | |
| 			
 | |
| 			/* clear all the slots and their pending commands */
 | |
| 			for(i = 0; i < NCR_700_COMMAND_SLOTS_PER_HOST; i++) {
 | |
| 				struct scsi_cmnd *SCp;
 | |
| 				struct NCR_700_command_slot *slot =
 | |
| 					&hostdata->slots[i];
 | |
| 
 | |
| 				if(slot->state == NCR_700_SLOT_FREE)
 | |
| 					continue;
 | |
| 				
 | |
| 				SCp = slot->cmnd;
 | |
| 				printk(KERN_ERR " failing command because of reset, slot %p, cmnd %p\n",
 | |
| 				       slot, SCp);
 | |
| 				free_slot(slot, hostdata);
 | |
| 				SCp->host_scribble = NULL;
 | |
| 				NCR_700_set_depth(SCp->device, 0);
 | |
| 				/* NOTE: deadlock potential here: we
 | |
| 				 * rely on mid-layer guarantees that
 | |
| 				 * scsi_done won't try to issue the
 | |
| 				 * command again otherwise we'll
 | |
| 				 * deadlock on the
 | |
| 				 * hostdata->state_lock */
 | |
| 				SCp->result = DID_RESET << 16;
 | |
| 				SCp->scsi_done(SCp);
 | |
| 			}
 | |
| 			mdelay(25);
 | |
| 			NCR_700_chip_setup(host);
 | |
| 
 | |
| 			hostdata->state = NCR_700_HOST_FREE;
 | |
| 			hostdata->cmd = NULL;
 | |
| 			/* signal back if this was an eh induced reset */
 | |
| 			if(hostdata->eh_complete != NULL)
 | |
| 				complete(hostdata->eh_complete);
 | |
| 			goto out_unlock;
 | |
| 		} else if(sstat0 & SELECTION_TIMEOUT) {
 | |
| 			DEBUG(("scsi%d: (%d:%d) selection timeout\n",
 | |
| 			       host->host_no, pun, lun));
 | |
| 			NCR_700_scsi_done(hostdata, SCp, DID_NO_CONNECT<<16);
 | |
| 		} else if(sstat0 & PHASE_MISMATCH) {
 | |
| 			struct NCR_700_command_slot *slot = (SCp == NULL) ? NULL :
 | |
| 				(struct NCR_700_command_slot *)SCp->host_scribble;
 | |
| 
 | |
| 			if(dsp == Ent_SendMessage + 8 + hostdata->pScript) {
 | |
| 				/* It wants to reply to some part of
 | |
| 				 * our message */
 | |
| #ifdef NCR_700_DEBUG
 | |
| 				__u32 temp = NCR_700_readl(host, TEMP_REG);
 | |
| 				int count = (hostdata->script[Ent_SendMessage/4] & 0xffffff) - ((NCR_700_readl(host, DBC_REG) & 0xffffff) + NCR_700_data_residual(host));
 | |
| 				printk("scsi%d (%d:%d) PHASE MISMATCH IN SEND MESSAGE %d remain, return %p[%04x], phase %s\n", host->host_no, pun, lun, count, (void *)temp, temp - hostdata->pScript, sbcl_to_string(NCR_700_readb(host, SBCL_REG)));
 | |
| #endif
 | |
| 				resume_offset = hostdata->pScript + Ent_SendMessagePhaseMismatch;
 | |
| 			} else if(dsp >= to32bit(&slot->pSG[0].ins) &&
 | |
| 				  dsp <= to32bit(&slot->pSG[NCR_700_SG_SEGMENTS].ins)) {
 | |
| 				int data_transfer = NCR_700_readl(host, DBC_REG) & 0xffffff;
 | |
| 				int SGcount = (dsp - to32bit(&slot->pSG[0].ins))/sizeof(struct NCR_700_SG_List);
 | |
| 				int residual = NCR_700_data_residual(host);
 | |
| 				int i;
 | |
| #ifdef NCR_700_DEBUG
 | |
| 				__u32 naddr = NCR_700_readl(host, DNAD_REG);
 | |
| 
 | |
| 				printk("scsi%d: (%d:%d) Expected phase mismatch in slot->SG[%d], transferred 0x%x\n",
 | |
| 				       host->host_no, pun, lun,
 | |
| 				       SGcount, data_transfer);
 | |
| 				scsi_print_command(SCp);
 | |
| 				if(residual) {
 | |
| 					printk("scsi%d: (%d:%d) Expected phase mismatch in slot->SG[%d], transferred 0x%x, residual %d\n",
 | |
| 				       host->host_no, pun, lun,
 | |
| 				       SGcount, data_transfer, residual);
 | |
| 				}
 | |
| #endif
 | |
| 				data_transfer += residual;
 | |
| 
 | |
| 				if(data_transfer != 0) {
 | |
| 					int count; 
 | |
| 					__u32 pAddr;
 | |
| 
 | |
| 					SGcount--;
 | |
| 
 | |
| 					count = (bS_to_cpu(slot->SG[SGcount].ins) & 0x00ffffff);
 | |
| 					DEBUG(("DATA TRANSFER MISMATCH, count = %d, transferred %d\n", count, count-data_transfer));
 | |
| 					slot->SG[SGcount].ins &= bS_to_host(0xff000000);
 | |
| 					slot->SG[SGcount].ins |= bS_to_host(data_transfer);
 | |
| 					pAddr = bS_to_cpu(slot->SG[SGcount].pAddr);
 | |
| 					pAddr += (count - data_transfer);
 | |
| #ifdef NCR_700_DEBUG
 | |
| 					if(pAddr != naddr) {
 | |
| 						printk("scsi%d (%d:%d) transfer mismatch pAddr=%lx, naddr=%lx, data_transfer=%d, residual=%d\n", host->host_no, pun, lun, (unsigned long)pAddr, (unsigned long)naddr, data_transfer, residual);
 | |
| 					}
 | |
| #endif
 | |
| 					slot->SG[SGcount].pAddr = bS_to_host(pAddr);
 | |
| 				}
 | |
| 				/* set the executed moves to nops */
 | |
| 				for(i=0; i<SGcount; i++) {
 | |
| 					slot->SG[i].ins = bS_to_host(SCRIPT_NOP);
 | |
| 					slot->SG[i].pAddr = 0;
 | |
| 				}
 | |
| 				dma_sync_to_dev(hostdata, slot->SG, sizeof(slot->SG));
 | |
| 				/* and pretend we disconnected after
 | |
| 				 * the command phase */
 | |
| 				resume_offset = hostdata->pScript + Ent_MsgInDuringData;
 | |
| 				/* make sure all the data is flushed */
 | |
| 				NCR_700_flush_fifo(host);
 | |
| 			} else {
 | |
| 				__u8 sbcl = NCR_700_readb(host, SBCL_REG);
 | |
| 				printk(KERN_ERR "scsi%d: (%d:%d) phase mismatch at %04x, phase %s\n",
 | |
| 				       host->host_no, pun, lun, dsp - hostdata->pScript, sbcl_to_string(sbcl));
 | |
| 				NCR_700_internal_bus_reset(host);
 | |
| 			}
 | |
| 
 | |
| 		} else if(sstat0 & SCSI_GROSS_ERROR) {
 | |
| 			printk(KERN_ERR "scsi%d: (%d:%d) GROSS ERROR\n",
 | |
| 			       host->host_no, pun, lun);
 | |
| 			NCR_700_scsi_done(hostdata, SCp, DID_ERROR<<16);
 | |
| 		} else if(sstat0 & PARITY_ERROR) {
 | |
| 			printk(KERN_ERR "scsi%d: (%d:%d) PARITY ERROR\n",
 | |
| 			       host->host_no, pun, lun);
 | |
| 			NCR_700_scsi_done(hostdata, SCp, DID_ERROR<<16);
 | |
| 		} else if(dstat & SCRIPT_INT_RECEIVED) {
 | |
| 			DEBUG(("scsi%d: (%d:%d) ====>SCRIPT INTERRUPT<====\n",
 | |
| 			       host->host_no, pun, lun));
 | |
| 			resume_offset = process_script_interrupt(dsps, dsp, SCp, host, hostdata);
 | |
| 		} else if(dstat & (ILGL_INST_DETECTED)) {
 | |
| 			printk(KERN_ERR "scsi%d: (%d:%d) Illegal Instruction detected at 0x%08x[0x%x]!!!\n"
 | |
| 			       "         Please email James.Bottomley@HansenPartnership.com with the details\n",
 | |
| 			       host->host_no, pun, lun,
 | |
| 			       dsp, dsp - hostdata->pScript);
 | |
| 			NCR_700_scsi_done(hostdata, SCp, DID_ERROR<<16);
 | |
| 		} else if(dstat & (WATCH_DOG_INTERRUPT|ABORTED)) {
 | |
| 			printk(KERN_ERR "scsi%d: (%d:%d) serious DMA problem, dstat=%02x\n",
 | |
| 			       host->host_no, pun, lun, dstat);
 | |
| 			NCR_700_scsi_done(hostdata, SCp, DID_ERROR<<16);
 | |
| 		}
 | |
| 
 | |
| 		
 | |
| 		/* NOTE: selection interrupt processing MUST occur
 | |
| 		 * after script interrupt processing to correctly cope
 | |
| 		 * with the case where we process a disconnect and
 | |
| 		 * then get reselected before we process the
 | |
| 		 * disconnection */
 | |
| 		if(sstat0 & SELECTED) {
 | |
| 			/* FIXME: It currently takes at least FOUR
 | |
| 			 * interrupts to complete a command that
 | |
| 			 * disconnects: one for the disconnect, one
 | |
| 			 * for the reselection, one to get the
 | |
| 			 * reselection data and one to complete the
 | |
| 			 * command.  If we guess the reselected
 | |
| 			 * command here and prepare it, we only need
 | |
| 			 * to get a reselection data interrupt if we
 | |
| 			 * guessed wrongly.  Since the interrupt
 | |
| 			 * overhead is much greater than the command
 | |
| 			 * setup, this would be an efficient
 | |
| 			 * optimisation particularly as we probably
 | |
| 			 * only have one outstanding command on a
 | |
| 			 * target most of the time */
 | |
| 
 | |
| 			resume_offset = process_selection(host, dsp);
 | |
| 
 | |
| 		}
 | |
| 
 | |
| 	}
 | |
| 
 | |
| 	if(resume_offset) {
 | |
| 		if(hostdata->state != NCR_700_HOST_BUSY) {
 | |
| 			printk(KERN_ERR "scsi%d: Driver error: resume at 0x%08x [0x%04x] with non busy host!\n",
 | |
| 			       host->host_no, resume_offset, resume_offset - hostdata->pScript);
 | |
| 			hostdata->state = NCR_700_HOST_BUSY;
 | |
| 		}
 | |
| 
 | |
| 		DEBUG(("Attempting to resume at %x\n", resume_offset));
 | |
| 		NCR_700_clear_fifo(host);
 | |
| 		NCR_700_writel(resume_offset, host, DSP_REG);
 | |
| 	} 
 | |
| 	/* There is probably a technical no-no about this: If we're a
 | |
| 	 * shared interrupt and we got this interrupt because the
 | |
| 	 * other device needs servicing not us, we're still going to
 | |
| 	 * check our queued commands here---of course, there shouldn't
 | |
| 	 * be any outstanding.... */
 | |
| 	if(hostdata->state == NCR_700_HOST_FREE) {
 | |
| 		int i;
 | |
| 
 | |
| 		for(i = 0; i < NCR_700_COMMAND_SLOTS_PER_HOST; i++) {
 | |
| 			/* fairness: always run the queue from the last
 | |
| 			 * position we left off */
 | |
| 			int j = (i + hostdata->saved_slot_position)
 | |
| 				% NCR_700_COMMAND_SLOTS_PER_HOST;
 | |
| 			
 | |
| 			if(hostdata->slots[j].state != NCR_700_SLOT_QUEUED)
 | |
| 				continue;
 | |
| 			if(NCR_700_start_command(hostdata->slots[j].cmnd)) {
 | |
| 				DEBUG(("scsi%d: Issuing saved command slot %p, cmd %p\t\n",
 | |
| 				       host->host_no, &hostdata->slots[j],
 | |
| 				       hostdata->slots[j].cmnd));
 | |
| 				hostdata->saved_slot_position = j + 1;
 | |
| 			}
 | |
| 
 | |
| 			break;
 | |
| 		}
 | |
| 	}
 | |
|  out_unlock:
 | |
| 	spin_unlock_irqrestore(host->host_lock, flags);
 | |
| 	return IRQ_RETVAL(handled);
 | |
| }
 | |
| 
 | |
| static int
 | |
| NCR_700_queuecommand_lck(struct scsi_cmnd *SCp, void (*done)(struct scsi_cmnd *))
 | |
| {
 | |
| 	struct NCR_700_Host_Parameters *hostdata = 
 | |
| 		(struct NCR_700_Host_Parameters *)SCp->device->host->hostdata[0];
 | |
| 	__u32 move_ins;
 | |
| 	struct NCR_700_command_slot *slot;
 | |
| 
 | |
| 	if(hostdata->command_slot_count >= NCR_700_COMMAND_SLOTS_PER_HOST) {
 | |
| 		/* We're over our allocation, this should never happen
 | |
| 		 * since we report the max allocation to the mid layer */
 | |
| 		printk(KERN_WARNING "scsi%d: Command depth has gone over queue depth\n", SCp->device->host->host_no);
 | |
| 		return 1;
 | |
| 	}
 | |
| 	/* check for untagged commands.  We cannot have any outstanding
 | |
| 	 * commands if we accept them.  Commands could be untagged because:
 | |
| 	 *
 | |
| 	 * - The tag negotiated bitmap is clear
 | |
| 	 * - The blk layer sent and untagged command
 | |
| 	 */
 | |
| 	if(NCR_700_get_depth(SCp->device) != 0
 | |
| 	   && (!(hostdata->tag_negotiated & (1<<scmd_id(SCp)))
 | |
| 	       || !(SCp->flags & SCMD_TAGGED))) {
 | |
| 		CDEBUG(KERN_ERR, SCp, "has non zero depth %d\n",
 | |
| 		       NCR_700_get_depth(SCp->device));
 | |
| 		return SCSI_MLQUEUE_DEVICE_BUSY;
 | |
| 	}
 | |
| 	if(NCR_700_get_depth(SCp->device) >= SCp->device->queue_depth) {
 | |
| 		CDEBUG(KERN_ERR, SCp, "has max tag depth %d\n",
 | |
| 		       NCR_700_get_depth(SCp->device));
 | |
| 		return SCSI_MLQUEUE_DEVICE_BUSY;
 | |
| 	}
 | |
| 	NCR_700_set_depth(SCp->device, NCR_700_get_depth(SCp->device) + 1);
 | |
| 
 | |
| 	/* begin the command here */
 | |
| 	/* no need to check for NULL, test for command_slot_count above
 | |
| 	 * ensures a slot is free */
 | |
| 	slot = find_empty_slot(hostdata);
 | |
| 
 | |
| 	slot->cmnd = SCp;
 | |
| 
 | |
| 	SCp->scsi_done = done;
 | |
| 	SCp->host_scribble = (unsigned char *)slot;
 | |
| 	SCp->SCp.ptr = NULL;
 | |
| 	SCp->SCp.buffer = NULL;
 | |
| 
 | |
| #ifdef NCR_700_DEBUG
 | |
| 	printk("53c700: scsi%d, command ", SCp->device->host->host_no);
 | |
| 	scsi_print_command(SCp);
 | |
| #endif
 | |
| 	if ((SCp->flags & SCMD_TAGGED)
 | |
| 	   && (hostdata->tag_negotiated &(1<<scmd_id(SCp))) == 0
 | |
| 	   && NCR_700_get_tag_neg_state(SCp->device) == NCR_700_START_TAG_NEGOTIATION) {
 | |
| 		scmd_printk(KERN_ERR, SCp, "Enabling Tag Command Queuing\n");
 | |
| 		hostdata->tag_negotiated |= (1<<scmd_id(SCp));
 | |
| 		NCR_700_set_tag_neg_state(SCp->device, NCR_700_DURING_TAG_NEGOTIATION);
 | |
| 	}
 | |
| 
 | |
| 	/* here we may have to process an untagged command.  The gate
 | |
| 	 * above ensures that this will be the only one outstanding,
 | |
| 	 * so clear the tag negotiated bit.
 | |
| 	 *
 | |
| 	 * FIXME: This will royally screw up on multiple LUN devices
 | |
| 	 * */
 | |
| 	if (!(SCp->flags & SCMD_TAGGED)
 | |
| 	   && (hostdata->tag_negotiated &(1<<scmd_id(SCp)))) {
 | |
| 		scmd_printk(KERN_INFO, SCp, "Disabling Tag Command Queuing\n");
 | |
| 		hostdata->tag_negotiated &= ~(1<<scmd_id(SCp));
 | |
| 	}
 | |
| 
 | |
| 	if ((hostdata->tag_negotiated & (1<<scmd_id(SCp))) &&
 | |
| 	    SCp->device->simple_tags) {
 | |
| 		slot->tag = SCp->request->tag;
 | |
| 		CDEBUG(KERN_DEBUG, SCp, "sending out tag %d, slot %p\n",
 | |
| 		       slot->tag, slot);
 | |
| 	} else {
 | |
| 		struct NCR_700_Device_Parameters *p = SCp->device->hostdata;
 | |
| 
 | |
| 		slot->tag = SCSI_NO_TAG;
 | |
| 		/* save current command for reselection */
 | |
| 		p->current_cmnd = SCp;
 | |
| 	}
 | |
| 	/* sanity check: some of the commands generated by the mid-layer
 | |
| 	 * have an eccentric idea of their sc_data_direction */
 | |
| 	if(!scsi_sg_count(SCp) && !scsi_bufflen(SCp) &&
 | |
| 	   SCp->sc_data_direction != DMA_NONE) {
 | |
| #ifdef NCR_700_DEBUG
 | |
| 		printk("53c700: Command");
 | |
| 		scsi_print_command(SCp);
 | |
| 		printk("Has wrong data direction %d\n", SCp->sc_data_direction);
 | |
| #endif
 | |
| 		SCp->sc_data_direction = DMA_NONE;
 | |
| 	}
 | |
| 
 | |
| 	switch (SCp->cmnd[0]) {
 | |
| 	case REQUEST_SENSE:
 | |
| 		/* clear the internal sense magic */
 | |
| 		SCp->cmnd[6] = 0;
 | |
| 		fallthrough;
 | |
| 	default:
 | |
| 		/* OK, get it from the command */
 | |
| 		switch(SCp->sc_data_direction) {
 | |
| 		case DMA_BIDIRECTIONAL:
 | |
| 		default:
 | |
| 			printk(KERN_ERR "53c700: Unknown command for data direction ");
 | |
| 			scsi_print_command(SCp);
 | |
| 			
 | |
| 			move_ins = 0;
 | |
| 			break;
 | |
| 		case DMA_NONE:
 | |
| 			move_ins = 0;
 | |
| 			break;
 | |
| 		case DMA_FROM_DEVICE:
 | |
| 			move_ins = SCRIPT_MOVE_DATA_IN;
 | |
| 			break;
 | |
| 		case DMA_TO_DEVICE:
 | |
| 			move_ins = SCRIPT_MOVE_DATA_OUT;
 | |
| 			break;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	/* now build the scatter gather list */
 | |
| 	if(move_ins != 0) {
 | |
| 		int i;
 | |
| 		int sg_count;
 | |
| 		dma_addr_t vPtr = 0;
 | |
| 		struct scatterlist *sg;
 | |
| 		__u32 count = 0;
 | |
| 
 | |
| 		sg_count = scsi_dma_map(SCp);
 | |
| 		BUG_ON(sg_count < 0);
 | |
| 
 | |
| 		scsi_for_each_sg(SCp, sg, sg_count, i) {
 | |
| 			vPtr = sg_dma_address(sg);
 | |
| 			count = sg_dma_len(sg);
 | |
| 
 | |
| 			slot->SG[i].ins = bS_to_host(move_ins | count);
 | |
| 			DEBUG((" scatter block %d: move %d[%08x] from 0x%lx\n",
 | |
| 			       i, count, slot->SG[i].ins, (unsigned long)vPtr));
 | |
| 			slot->SG[i].pAddr = bS_to_host(vPtr);
 | |
| 		}
 | |
| 		slot->SG[i].ins = bS_to_host(SCRIPT_RETURN);
 | |
| 		slot->SG[i].pAddr = 0;
 | |
| 		dma_sync_to_dev(hostdata, slot->SG, sizeof(slot->SG));
 | |
| 		DEBUG((" SETTING %p to %x\n",
 | |
| 		       (&slot->pSG[i].ins),
 | |
| 		       slot->SG[i].ins));
 | |
| 	}
 | |
| 	slot->resume_offset = 0;
 | |
| 	slot->pCmd = dma_map_single(hostdata->dev, SCp->cmnd,
 | |
| 				    MAX_COMMAND_SIZE, DMA_TO_DEVICE);
 | |
| 	NCR_700_start_command(SCp);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| STATIC DEF_SCSI_QCMD(NCR_700_queuecommand)
 | |
| 
 | |
| STATIC int
 | |
| NCR_700_abort(struct scsi_cmnd * SCp)
 | |
| {
 | |
| 	struct NCR_700_command_slot *slot;
 | |
| 
 | |
| 	scmd_printk(KERN_INFO, SCp, "abort command\n");
 | |
| 
 | |
| 	slot = (struct NCR_700_command_slot *)SCp->host_scribble;
 | |
| 
 | |
| 	if(slot == NULL)
 | |
| 		/* no outstanding command to abort */
 | |
| 		return SUCCESS;
 | |
| 	if(SCp->cmnd[0] == TEST_UNIT_READY) {
 | |
| 		/* FIXME: This is because of a problem in the new
 | |
| 		 * error handler.  When it is in error recovery, it
 | |
| 		 * will send a TUR to a device it thinks may still be
 | |
| 		 * showing a problem.  If the TUR isn't responded to,
 | |
| 		 * it will abort it and mark the device off line.
 | |
| 		 * Unfortunately, it does no other error recovery, so
 | |
| 		 * this would leave us with an outstanding command
 | |
| 		 * occupying a slot.  Rather than allow this to
 | |
| 		 * happen, we issue a bus reset to force all
 | |
| 		 * outstanding commands to terminate here. */
 | |
| 		NCR_700_internal_bus_reset(SCp->device->host);
 | |
| 		/* still drop through and return failed */
 | |
| 	}
 | |
| 	return FAILED;
 | |
| 
 | |
| }
 | |
| 
 | |
| STATIC int
 | |
| NCR_700_host_reset(struct scsi_cmnd * SCp)
 | |
| {
 | |
| 	DECLARE_COMPLETION_ONSTACK(complete);
 | |
| 	struct NCR_700_Host_Parameters *hostdata = 
 | |
| 		(struct NCR_700_Host_Parameters *)SCp->device->host->hostdata[0];
 | |
| 
 | |
| 	scmd_printk(KERN_INFO, SCp,
 | |
| 		"New error handler wants HOST reset, cmd %p\n\t", SCp);
 | |
| 	scsi_print_command(SCp);
 | |
| 
 | |
| 	/* In theory, eh_complete should always be null because the
 | |
| 	 * eh is single threaded, but just in case we're handling a
 | |
| 	 * reset via sg or something */
 | |
| 	spin_lock_irq(SCp->device->host->host_lock);
 | |
| 	while (hostdata->eh_complete != NULL) {
 | |
| 		spin_unlock_irq(SCp->device->host->host_lock);
 | |
| 		msleep_interruptible(100);
 | |
| 		spin_lock_irq(SCp->device->host->host_lock);
 | |
| 	}
 | |
| 
 | |
| 	hostdata->eh_complete = &complete;
 | |
| 	NCR_700_internal_bus_reset(SCp->device->host);
 | |
| 	NCR_700_chip_reset(SCp->device->host);
 | |
| 
 | |
| 	spin_unlock_irq(SCp->device->host->host_lock);
 | |
| 	wait_for_completion(&complete);
 | |
| 	spin_lock_irq(SCp->device->host->host_lock);
 | |
| 
 | |
| 	hostdata->eh_complete = NULL;
 | |
| 	/* Revalidate the transport parameters of the failing device */
 | |
| 	if(hostdata->fast)
 | |
| 		spi_schedule_dv_device(SCp->device);
 | |
| 
 | |
| 	spin_unlock_irq(SCp->device->host->host_lock);
 | |
| 	return SUCCESS;
 | |
| }
 | |
| 
 | |
| STATIC void
 | |
| NCR_700_set_period(struct scsi_target *STp, int period)
 | |
| {
 | |
| 	struct Scsi_Host *SHp = dev_to_shost(STp->dev.parent);
 | |
| 	struct NCR_700_Host_Parameters *hostdata = 
 | |
| 		(struct NCR_700_Host_Parameters *)SHp->hostdata[0];
 | |
| 	
 | |
| 	if(!hostdata->fast)
 | |
| 		return;
 | |
| 
 | |
| 	if(period < hostdata->min_period)
 | |
| 		period = hostdata->min_period;
 | |
| 
 | |
| 	spi_period(STp) = period;
 | |
| 	spi_flags(STp) &= ~(NCR_700_DEV_NEGOTIATED_SYNC |
 | |
| 			    NCR_700_DEV_BEGIN_SYNC_NEGOTIATION);
 | |
| 	spi_flags(STp) |= NCR_700_DEV_PRINT_SYNC_NEGOTIATION;
 | |
| }
 | |
| 
 | |
| STATIC void
 | |
| NCR_700_set_offset(struct scsi_target *STp, int offset)
 | |
| {
 | |
| 	struct Scsi_Host *SHp = dev_to_shost(STp->dev.parent);
 | |
| 	struct NCR_700_Host_Parameters *hostdata = 
 | |
| 		(struct NCR_700_Host_Parameters *)SHp->hostdata[0];
 | |
| 	int max_offset = hostdata->chip710
 | |
| 		? NCR_710_MAX_OFFSET : NCR_700_MAX_OFFSET;
 | |
| 	
 | |
| 	if(!hostdata->fast)
 | |
| 		return;
 | |
| 
 | |
| 	if(offset > max_offset)
 | |
| 		offset = max_offset;
 | |
| 
 | |
| 	/* if we're currently async, make sure the period is reasonable */
 | |
| 	if(spi_offset(STp) == 0 && (spi_period(STp) < hostdata->min_period ||
 | |
| 				    spi_period(STp) > 0xff))
 | |
| 		spi_period(STp) = hostdata->min_period;
 | |
| 
 | |
| 	spi_offset(STp) = offset;
 | |
| 	spi_flags(STp) &= ~(NCR_700_DEV_NEGOTIATED_SYNC |
 | |
| 			    NCR_700_DEV_BEGIN_SYNC_NEGOTIATION);
 | |
| 	spi_flags(STp) |= NCR_700_DEV_PRINT_SYNC_NEGOTIATION;
 | |
| }
 | |
| 
 | |
| STATIC int
 | |
| NCR_700_slave_alloc(struct scsi_device *SDp)
 | |
| {
 | |
| 	SDp->hostdata = kzalloc(sizeof(struct NCR_700_Device_Parameters),
 | |
| 				GFP_KERNEL);
 | |
| 
 | |
| 	if (!SDp->hostdata)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| STATIC int
 | |
| NCR_700_slave_configure(struct scsi_device *SDp)
 | |
| {
 | |
| 	struct NCR_700_Host_Parameters *hostdata = 
 | |
| 		(struct NCR_700_Host_Parameters *)SDp->host->hostdata[0];
 | |
| 
 | |
| 	/* to do here: allocate memory; build a queue_full list */
 | |
| 	if(SDp->tagged_supported) {
 | |
| 		scsi_change_queue_depth(SDp, NCR_700_DEFAULT_TAGS);
 | |
| 		NCR_700_set_tag_neg_state(SDp, NCR_700_START_TAG_NEGOTIATION);
 | |
| 	}
 | |
| 
 | |
| 	if(hostdata->fast) {
 | |
| 		/* Find the correct offset and period via domain validation */
 | |
| 		if (!spi_initial_dv(SDp->sdev_target))
 | |
| 			spi_dv_device(SDp);
 | |
| 	} else {
 | |
| 		spi_offset(SDp->sdev_target) = 0;
 | |
| 		spi_period(SDp->sdev_target) = 0;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| STATIC void
 | |
| NCR_700_slave_destroy(struct scsi_device *SDp)
 | |
| {
 | |
| 	kfree(SDp->hostdata);
 | |
| 	SDp->hostdata = NULL;
 | |
| }
 | |
| 
 | |
| static int
 | |
| NCR_700_change_queue_depth(struct scsi_device *SDp, int depth)
 | |
| {
 | |
| 	if (depth > NCR_700_MAX_TAGS)
 | |
| 		depth = NCR_700_MAX_TAGS;
 | |
| 	return scsi_change_queue_depth(SDp, depth);
 | |
| }
 | |
| 
 | |
| static ssize_t
 | |
| NCR_700_show_active_tags(struct device *dev, struct device_attribute *attr, char *buf)
 | |
| {
 | |
| 	struct scsi_device *SDp = to_scsi_device(dev);
 | |
| 
 | |
| 	return snprintf(buf, 20, "%d\n", NCR_700_get_depth(SDp));
 | |
| }
 | |
| 
 | |
| static struct device_attribute NCR_700_active_tags_attr = {
 | |
| 	.attr = {
 | |
| 		.name =		"active_tags",
 | |
| 		.mode =		S_IRUGO,
 | |
| 	},
 | |
| 	.show = NCR_700_show_active_tags,
 | |
| };
 | |
| 
 | |
| STATIC struct device_attribute *NCR_700_dev_attrs[] = {
 | |
| 	&NCR_700_active_tags_attr,
 | |
| 	NULL,
 | |
| };
 | |
| 
 | |
| EXPORT_SYMBOL(NCR_700_detect);
 | |
| EXPORT_SYMBOL(NCR_700_release);
 | |
| EXPORT_SYMBOL(NCR_700_intr);
 | |
| 
 | |
| static struct spi_function_template NCR_700_transport_functions =  {
 | |
| 	.set_period	= NCR_700_set_period,
 | |
| 	.show_period	= 1,
 | |
| 	.set_offset	= NCR_700_set_offset,
 | |
| 	.show_offset	= 1,
 | |
| };
 | |
| 
 | |
| static int __init NCR_700_init(void)
 | |
| {
 | |
| 	NCR_700_transport_template = spi_attach_transport(&NCR_700_transport_functions);
 | |
| 	if(!NCR_700_transport_template)
 | |
| 		return -ENODEV;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void __exit NCR_700_exit(void)
 | |
| {
 | |
| 	spi_release_transport(NCR_700_transport_template);
 | |
| }
 | |
| 
 | |
| module_init(NCR_700_init);
 | |
| module_exit(NCR_700_exit);
 | |
| 
 |