xref: /OK3568_Linux_fs/kernel/drivers/scsi/3w-9xxx.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun    3w-9xxx.c -- 3ware 9000 Storage Controller device driver for Linux.
3*4882a593Smuzhiyun 
4*4882a593Smuzhiyun    Written By: Adam Radford <aradford@gmail.com>
5*4882a593Smuzhiyun    Modifications By: Tom Couch
6*4882a593Smuzhiyun 
7*4882a593Smuzhiyun    Copyright (C) 2004-2009 Applied Micro Circuits Corporation.
8*4882a593Smuzhiyun    Copyright (C) 2010 LSI Corporation.
9*4882a593Smuzhiyun 
10*4882a593Smuzhiyun    This program is free software; you can redistribute it and/or modify
11*4882a593Smuzhiyun    it under the terms of the GNU General Public License as published by
12*4882a593Smuzhiyun    the Free Software Foundation; version 2 of the License.
13*4882a593Smuzhiyun 
14*4882a593Smuzhiyun    This program is distributed in the hope that it will be useful,
15*4882a593Smuzhiyun    but WITHOUT ANY WARRANTY; without even the implied warranty of
16*4882a593Smuzhiyun    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
17*4882a593Smuzhiyun    GNU General Public License for more details.
18*4882a593Smuzhiyun 
19*4882a593Smuzhiyun    NO WARRANTY
20*4882a593Smuzhiyun    THE PROGRAM IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OR
21*4882a593Smuzhiyun    CONDITIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED INCLUDING, WITHOUT
22*4882a593Smuzhiyun    LIMITATION, ANY WARRANTIES OR CONDITIONS OF TITLE, NON-INFRINGEMENT,
23*4882a593Smuzhiyun    MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE. Each Recipient is
24*4882a593Smuzhiyun    solely responsible for determining the appropriateness of using and
25*4882a593Smuzhiyun    distributing the Program and assumes all risks associated with its
26*4882a593Smuzhiyun    exercise of rights under this Agreement, including but not limited to
27*4882a593Smuzhiyun    the risks and costs of program errors, damage to or loss of data,
28*4882a593Smuzhiyun    programs or equipment, and unavailability or interruption of operations.
29*4882a593Smuzhiyun 
30*4882a593Smuzhiyun    DISCLAIMER OF LIABILITY
31*4882a593Smuzhiyun    NEITHER RECIPIENT NOR ANY CONTRIBUTORS SHALL HAVE ANY LIABILITY FOR ANY
32*4882a593Smuzhiyun    DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
33*4882a593Smuzhiyun    DAMAGES (INCLUDING WITHOUT LIMITATION LOST PROFITS), HOWEVER CAUSED AND
34*4882a593Smuzhiyun    ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR
35*4882a593Smuzhiyun    TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE
36*4882a593Smuzhiyun    USE OR DISTRIBUTION OF THE PROGRAM OR THE EXERCISE OF ANY RIGHTS GRANTED
37*4882a593Smuzhiyun    HEREUNDER, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGES
38*4882a593Smuzhiyun 
39*4882a593Smuzhiyun    You should have received a copy of the GNU General Public License
40*4882a593Smuzhiyun    along with this program; if not, write to the Free Software
41*4882a593Smuzhiyun    Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
42*4882a593Smuzhiyun 
43*4882a593Smuzhiyun    Bugs/Comments/Suggestions should be mailed to:
44*4882a593Smuzhiyun    aradford@gmail.com
45*4882a593Smuzhiyun 
46*4882a593Smuzhiyun    Note: This version of the driver does not contain a bundled firmware
47*4882a593Smuzhiyun          image.
48*4882a593Smuzhiyun 
49*4882a593Smuzhiyun    History
50*4882a593Smuzhiyun    -------
51*4882a593Smuzhiyun    2.26.02.000 - Driver cleanup for kernel submission.
52*4882a593Smuzhiyun    2.26.02.001 - Replace schedule_timeout() calls with msleep().
53*4882a593Smuzhiyun    2.26.02.002 - Add support for PAE mode.
54*4882a593Smuzhiyun                  Add lun support.
55*4882a593Smuzhiyun                  Fix twa_remove() to free irq handler/unregister_chrdev()
56*4882a593Smuzhiyun                  before shutting down card.
57*4882a593Smuzhiyun                  Change to new 'change_queue_depth' api.
58*4882a593Smuzhiyun                  Fix 'handled=1' ISR usage, remove bogus IRQ check.
59*4882a593Smuzhiyun                  Remove un-needed eh_abort handler.
60*4882a593Smuzhiyun                  Add support for embedded firmware error strings.
61*4882a593Smuzhiyun    2.26.02.003 - Correctly handle single sgl's with use_sg=1.
62*4882a593Smuzhiyun    2.26.02.004 - Add support for 9550SX controllers.
63*4882a593Smuzhiyun    2.26.02.005 - Fix use_sg == 0 mapping on systems with 4GB or higher.
64*4882a593Smuzhiyun    2.26.02.006 - Fix 9550SX pchip reset timeout.
65*4882a593Smuzhiyun                  Add big endian support.
66*4882a593Smuzhiyun    2.26.02.007 - Disable local interrupts during kmap/unmap_atomic().
67*4882a593Smuzhiyun    2.26.02.008 - Free irq handler in __twa_shutdown().
68*4882a593Smuzhiyun                  Serialize reset code.
69*4882a593Smuzhiyun                  Add support for 9650SE controllers.
70*4882a593Smuzhiyun    2.26.02.009 - Fix dma mask setting to fallback to 32-bit if 64-bit fails.
71*4882a593Smuzhiyun    2.26.02.010 - Add support for 9690SA controllers.
72*4882a593Smuzhiyun    2.26.02.011 - Increase max AENs drained to 256.
73*4882a593Smuzhiyun                  Add MSI support and "use_msi" module parameter.
74*4882a593Smuzhiyun                  Fix bug in twa_get_param() on 4GB+.
75*4882a593Smuzhiyun                  Use pci_resource_len() for ioremap().
76*4882a593Smuzhiyun    2.26.02.012 - Add power management support.
77*4882a593Smuzhiyun    2.26.02.013 - Fix bug in twa_load_sgl().
78*4882a593Smuzhiyun    2.26.02.014 - Force 60 second timeout default.
79*4882a593Smuzhiyun */
80*4882a593Smuzhiyun 
81*4882a593Smuzhiyun #include <linux/module.h>
82*4882a593Smuzhiyun #include <linux/reboot.h>
83*4882a593Smuzhiyun #include <linux/spinlock.h>
84*4882a593Smuzhiyun #include <linux/interrupt.h>
85*4882a593Smuzhiyun #include <linux/moduleparam.h>
86*4882a593Smuzhiyun #include <linux/errno.h>
87*4882a593Smuzhiyun #include <linux/types.h>
88*4882a593Smuzhiyun #include <linux/delay.h>
89*4882a593Smuzhiyun #include <linux/pci.h>
90*4882a593Smuzhiyun #include <linux/time.h>
91*4882a593Smuzhiyun #include <linux/mutex.h>
92*4882a593Smuzhiyun #include <linux/slab.h>
93*4882a593Smuzhiyun #include <asm/io.h>
94*4882a593Smuzhiyun #include <asm/irq.h>
95*4882a593Smuzhiyun #include <linux/uaccess.h>
96*4882a593Smuzhiyun #include <scsi/scsi.h>
97*4882a593Smuzhiyun #include <scsi/scsi_host.h>
98*4882a593Smuzhiyun #include <scsi/scsi_tcq.h>
99*4882a593Smuzhiyun #include <scsi/scsi_cmnd.h>
100*4882a593Smuzhiyun #include "3w-9xxx.h"
101*4882a593Smuzhiyun 
102*4882a593Smuzhiyun /* Globals */
103*4882a593Smuzhiyun #define TW_DRIVER_VERSION "2.26.02.014"
104*4882a593Smuzhiyun static DEFINE_MUTEX(twa_chrdev_mutex);
105*4882a593Smuzhiyun static TW_Device_Extension *twa_device_extension_list[TW_MAX_SLOT];
106*4882a593Smuzhiyun static unsigned int twa_device_extension_count;
107*4882a593Smuzhiyun static int twa_major = -1;
108*4882a593Smuzhiyun extern struct timezone sys_tz;
109*4882a593Smuzhiyun 
110*4882a593Smuzhiyun /* Module parameters */
111*4882a593Smuzhiyun MODULE_AUTHOR ("LSI");
112*4882a593Smuzhiyun MODULE_DESCRIPTION ("3ware 9000 Storage Controller Linux Driver");
113*4882a593Smuzhiyun MODULE_LICENSE("GPL");
114*4882a593Smuzhiyun MODULE_VERSION(TW_DRIVER_VERSION);
115*4882a593Smuzhiyun 
116*4882a593Smuzhiyun static int use_msi = 0;
117*4882a593Smuzhiyun module_param(use_msi, int, S_IRUGO);
118*4882a593Smuzhiyun MODULE_PARM_DESC(use_msi, "Use Message Signaled Interrupts.  Default: 0");
119*4882a593Smuzhiyun 
120*4882a593Smuzhiyun /* Function prototypes */
121*4882a593Smuzhiyun static void twa_aen_queue_event(TW_Device_Extension *tw_dev, TW_Command_Apache_Header *header);
122*4882a593Smuzhiyun static int twa_aen_read_queue(TW_Device_Extension *tw_dev, int request_id);
123*4882a593Smuzhiyun static char *twa_aen_severity_lookup(unsigned char severity_code);
124*4882a593Smuzhiyun static void twa_aen_sync_time(TW_Device_Extension *tw_dev, int request_id);
125*4882a593Smuzhiyun static long twa_chrdev_ioctl(struct file *file, unsigned int cmd, unsigned long arg);
126*4882a593Smuzhiyun static int twa_chrdev_open(struct inode *inode, struct file *file);
127*4882a593Smuzhiyun static int twa_fill_sense(TW_Device_Extension *tw_dev, int request_id, int copy_sense, int print_host);
128*4882a593Smuzhiyun static void twa_free_request_id(TW_Device_Extension *tw_dev,int request_id);
129*4882a593Smuzhiyun static void twa_get_request_id(TW_Device_Extension *tw_dev, int *request_id);
130*4882a593Smuzhiyun static int twa_initconnection(TW_Device_Extension *tw_dev, int message_credits,
131*4882a593Smuzhiyun  			      u32 set_features, unsigned short current_fw_srl,
132*4882a593Smuzhiyun 			      unsigned short current_fw_arch_id,
133*4882a593Smuzhiyun 			      unsigned short current_fw_branch,
134*4882a593Smuzhiyun 			      unsigned short current_fw_build,
135*4882a593Smuzhiyun 			      unsigned short *fw_on_ctlr_srl,
136*4882a593Smuzhiyun 			      unsigned short *fw_on_ctlr_arch_id,
137*4882a593Smuzhiyun 			      unsigned short *fw_on_ctlr_branch,
138*4882a593Smuzhiyun 			      unsigned short *fw_on_ctlr_build,
139*4882a593Smuzhiyun 			      u32 *init_connect_result);
140*4882a593Smuzhiyun static void twa_load_sgl(TW_Device_Extension *tw_dev, TW_Command_Full *full_command_packet, int request_id, dma_addr_t dma_handle, int length);
141*4882a593Smuzhiyun static int twa_poll_response(TW_Device_Extension *tw_dev, int request_id, int seconds);
142*4882a593Smuzhiyun static int twa_poll_status_gone(TW_Device_Extension *tw_dev, u32 flag, int seconds);
143*4882a593Smuzhiyun static int twa_post_command_packet(TW_Device_Extension *tw_dev, int request_id, char internal);
144*4882a593Smuzhiyun static int twa_reset_device_extension(TW_Device_Extension *tw_dev);
145*4882a593Smuzhiyun static int twa_reset_sequence(TW_Device_Extension *tw_dev, int soft_reset);
146*4882a593Smuzhiyun static int twa_scsiop_execute_scsi(TW_Device_Extension *tw_dev, int request_id,
147*4882a593Smuzhiyun 				   unsigned char *cdb, int use_sg,
148*4882a593Smuzhiyun 				   TW_SG_Entry *sglistarg);
149*4882a593Smuzhiyun static void twa_scsiop_execute_scsi_complete(TW_Device_Extension *tw_dev, int request_id);
150*4882a593Smuzhiyun static char *twa_string_lookup(twa_message_type *table, unsigned int aen_code);
151*4882a593Smuzhiyun 
152*4882a593Smuzhiyun /* Functions */
153*4882a593Smuzhiyun 
154*4882a593Smuzhiyun /* Show some statistics about the card */
twa_show_stats(struct device * dev,struct device_attribute * attr,char * buf)155*4882a593Smuzhiyun static ssize_t twa_show_stats(struct device *dev,
156*4882a593Smuzhiyun 			      struct device_attribute *attr, char *buf)
157*4882a593Smuzhiyun {
158*4882a593Smuzhiyun 	struct Scsi_Host *host = class_to_shost(dev);
159*4882a593Smuzhiyun 	TW_Device_Extension *tw_dev = (TW_Device_Extension *)host->hostdata;
160*4882a593Smuzhiyun 	unsigned long flags = 0;
161*4882a593Smuzhiyun 	ssize_t len;
162*4882a593Smuzhiyun 
163*4882a593Smuzhiyun 	spin_lock_irqsave(tw_dev->host->host_lock, flags);
164*4882a593Smuzhiyun 	len = snprintf(buf, PAGE_SIZE, "3w-9xxx Driver version: %s\n"
165*4882a593Smuzhiyun 		       "Current commands posted:   %4d\n"
166*4882a593Smuzhiyun 		       "Max commands posted:       %4d\n"
167*4882a593Smuzhiyun 		       "Current pending commands:  %4d\n"
168*4882a593Smuzhiyun 		       "Max pending commands:      %4d\n"
169*4882a593Smuzhiyun 		       "Last sgl length:           %4d\n"
170*4882a593Smuzhiyun 		       "Max sgl length:            %4d\n"
171*4882a593Smuzhiyun 		       "Last sector count:         %4d\n"
172*4882a593Smuzhiyun 		       "Max sector count:          %4d\n"
173*4882a593Smuzhiyun 		       "SCSI Host Resets:          %4d\n"
174*4882a593Smuzhiyun 		       "AEN's:                     %4d\n",
175*4882a593Smuzhiyun 		       TW_DRIVER_VERSION,
176*4882a593Smuzhiyun 		       tw_dev->posted_request_count,
177*4882a593Smuzhiyun 		       tw_dev->max_posted_request_count,
178*4882a593Smuzhiyun 		       tw_dev->pending_request_count,
179*4882a593Smuzhiyun 		       tw_dev->max_pending_request_count,
180*4882a593Smuzhiyun 		       tw_dev->sgl_entries,
181*4882a593Smuzhiyun 		       tw_dev->max_sgl_entries,
182*4882a593Smuzhiyun 		       tw_dev->sector_count,
183*4882a593Smuzhiyun 		       tw_dev->max_sector_count,
184*4882a593Smuzhiyun 		       tw_dev->num_resets,
185*4882a593Smuzhiyun 		       tw_dev->aen_count);
186*4882a593Smuzhiyun 	spin_unlock_irqrestore(tw_dev->host->host_lock, flags);
187*4882a593Smuzhiyun 	return len;
188*4882a593Smuzhiyun } /* End twa_show_stats() */
189*4882a593Smuzhiyun 
190*4882a593Smuzhiyun /* Create sysfs 'stats' entry */
191*4882a593Smuzhiyun static struct device_attribute twa_host_stats_attr = {
192*4882a593Smuzhiyun 	.attr = {
193*4882a593Smuzhiyun 		.name = 	"stats",
194*4882a593Smuzhiyun 		.mode =		S_IRUGO,
195*4882a593Smuzhiyun 	},
196*4882a593Smuzhiyun 	.show = twa_show_stats
197*4882a593Smuzhiyun };
198*4882a593Smuzhiyun 
199*4882a593Smuzhiyun /* Host attributes initializer */
200*4882a593Smuzhiyun static struct device_attribute *twa_host_attrs[] = {
201*4882a593Smuzhiyun 	&twa_host_stats_attr,
202*4882a593Smuzhiyun 	NULL,
203*4882a593Smuzhiyun };
204*4882a593Smuzhiyun 
205*4882a593Smuzhiyun /* File operations struct for character device */
206*4882a593Smuzhiyun static const struct file_operations twa_fops = {
207*4882a593Smuzhiyun 	.owner		= THIS_MODULE,
208*4882a593Smuzhiyun 	.unlocked_ioctl	= twa_chrdev_ioctl,
209*4882a593Smuzhiyun 	.open		= twa_chrdev_open,
210*4882a593Smuzhiyun 	.release	= NULL,
211*4882a593Smuzhiyun 	.llseek		= noop_llseek,
212*4882a593Smuzhiyun };
213*4882a593Smuzhiyun 
214*4882a593Smuzhiyun /*
215*4882a593Smuzhiyun  * The controllers use an inline buffer instead of a mapped SGL for small,
216*4882a593Smuzhiyun  * single entry buffers.  Note that we treat a zero-length transfer like
217*4882a593Smuzhiyun  * a mapped SGL.
218*4882a593Smuzhiyun  */
twa_command_mapped(struct scsi_cmnd * cmd)219*4882a593Smuzhiyun static bool twa_command_mapped(struct scsi_cmnd *cmd)
220*4882a593Smuzhiyun {
221*4882a593Smuzhiyun 	return scsi_sg_count(cmd) != 1 ||
222*4882a593Smuzhiyun 		scsi_bufflen(cmd) >= TW_MIN_SGL_LENGTH;
223*4882a593Smuzhiyun }
224*4882a593Smuzhiyun 
225*4882a593Smuzhiyun /* This function will complete an aen request from the isr */
twa_aen_complete(TW_Device_Extension * tw_dev,int request_id)226*4882a593Smuzhiyun static int twa_aen_complete(TW_Device_Extension *tw_dev, int request_id)
227*4882a593Smuzhiyun {
228*4882a593Smuzhiyun 	TW_Command_Full *full_command_packet;
229*4882a593Smuzhiyun 	TW_Command *command_packet;
230*4882a593Smuzhiyun 	TW_Command_Apache_Header *header;
231*4882a593Smuzhiyun 	unsigned short aen;
232*4882a593Smuzhiyun 	int retval = 1;
233*4882a593Smuzhiyun 
234*4882a593Smuzhiyun 	header = (TW_Command_Apache_Header *)tw_dev->generic_buffer_virt[request_id];
235*4882a593Smuzhiyun 	tw_dev->posted_request_count--;
236*4882a593Smuzhiyun 	aen = le16_to_cpu(header->status_block.error);
237*4882a593Smuzhiyun 	full_command_packet = tw_dev->command_packet_virt[request_id];
238*4882a593Smuzhiyun 	command_packet = &full_command_packet->command.oldcommand;
239*4882a593Smuzhiyun 
240*4882a593Smuzhiyun 	/* First check for internal completion of set param for time sync */
241*4882a593Smuzhiyun 	if (TW_OP_OUT(command_packet->opcode__sgloffset) == TW_OP_SET_PARAM) {
242*4882a593Smuzhiyun 		/* Keep reading the queue in case there are more aen's */
243*4882a593Smuzhiyun 		if (twa_aen_read_queue(tw_dev, request_id))
244*4882a593Smuzhiyun 			goto out2;
245*4882a593Smuzhiyun 	        else {
246*4882a593Smuzhiyun 			retval = 0;
247*4882a593Smuzhiyun 			goto out;
248*4882a593Smuzhiyun 		}
249*4882a593Smuzhiyun 	}
250*4882a593Smuzhiyun 
251*4882a593Smuzhiyun 	switch (aen) {
252*4882a593Smuzhiyun 	case TW_AEN_QUEUE_EMPTY:
253*4882a593Smuzhiyun 		/* Quit reading the queue if this is the last one */
254*4882a593Smuzhiyun 		break;
255*4882a593Smuzhiyun 	case TW_AEN_SYNC_TIME_WITH_HOST:
256*4882a593Smuzhiyun 		twa_aen_sync_time(tw_dev, request_id);
257*4882a593Smuzhiyun 		retval = 0;
258*4882a593Smuzhiyun 		goto out;
259*4882a593Smuzhiyun 	default:
260*4882a593Smuzhiyun 		twa_aen_queue_event(tw_dev, header);
261*4882a593Smuzhiyun 
262*4882a593Smuzhiyun 		/* If there are more aen's, keep reading the queue */
263*4882a593Smuzhiyun 		if (twa_aen_read_queue(tw_dev, request_id))
264*4882a593Smuzhiyun 			goto out2;
265*4882a593Smuzhiyun 		else {
266*4882a593Smuzhiyun 			retval = 0;
267*4882a593Smuzhiyun 			goto out;
268*4882a593Smuzhiyun 		}
269*4882a593Smuzhiyun 	}
270*4882a593Smuzhiyun 	retval = 0;
271*4882a593Smuzhiyun out2:
272*4882a593Smuzhiyun 	tw_dev->state[request_id] = TW_S_COMPLETED;
273*4882a593Smuzhiyun 	twa_free_request_id(tw_dev, request_id);
274*4882a593Smuzhiyun 	clear_bit(TW_IN_ATTENTION_LOOP, &tw_dev->flags);
275*4882a593Smuzhiyun out:
276*4882a593Smuzhiyun 	return retval;
277*4882a593Smuzhiyun } /* End twa_aen_complete() */
278*4882a593Smuzhiyun 
279*4882a593Smuzhiyun /* This function will drain aen queue */
twa_aen_drain_queue(TW_Device_Extension * tw_dev,int no_check_reset)280*4882a593Smuzhiyun static int twa_aen_drain_queue(TW_Device_Extension *tw_dev, int no_check_reset)
281*4882a593Smuzhiyun {
282*4882a593Smuzhiyun 	int request_id = 0;
283*4882a593Smuzhiyun 	unsigned char cdb[TW_MAX_CDB_LEN];
284*4882a593Smuzhiyun 	TW_SG_Entry sglist[1];
285*4882a593Smuzhiyun 	int finished = 0, count = 0;
286*4882a593Smuzhiyun 	TW_Command_Full *full_command_packet;
287*4882a593Smuzhiyun 	TW_Command_Apache_Header *header;
288*4882a593Smuzhiyun 	unsigned short aen;
289*4882a593Smuzhiyun 	int first_reset = 0, queue = 0, retval = 1;
290*4882a593Smuzhiyun 
291*4882a593Smuzhiyun 	if (no_check_reset)
292*4882a593Smuzhiyun 		first_reset = 0;
293*4882a593Smuzhiyun 	else
294*4882a593Smuzhiyun 		first_reset = 1;
295*4882a593Smuzhiyun 
296*4882a593Smuzhiyun 	full_command_packet = tw_dev->command_packet_virt[request_id];
297*4882a593Smuzhiyun 	memset(full_command_packet, 0, sizeof(TW_Command_Full));
298*4882a593Smuzhiyun 
299*4882a593Smuzhiyun 	/* Initialize cdb */
300*4882a593Smuzhiyun 	memset(&cdb, 0, TW_MAX_CDB_LEN);
301*4882a593Smuzhiyun 	cdb[0] = REQUEST_SENSE; /* opcode */
302*4882a593Smuzhiyun 	cdb[4] = TW_ALLOCATION_LENGTH; /* allocation length */
303*4882a593Smuzhiyun 
304*4882a593Smuzhiyun 	/* Initialize sglist */
305*4882a593Smuzhiyun 	memset(&sglist, 0, sizeof(TW_SG_Entry));
306*4882a593Smuzhiyun 	sglist[0].length = TW_SECTOR_SIZE;
307*4882a593Smuzhiyun 	sglist[0].address = tw_dev->generic_buffer_phys[request_id];
308*4882a593Smuzhiyun 
309*4882a593Smuzhiyun 	if (sglist[0].address & TW_ALIGNMENT_9000_SGL) {
310*4882a593Smuzhiyun 		TW_PRINTK(tw_dev->host, TW_DRIVER, 0x1, "Found unaligned address during AEN drain");
311*4882a593Smuzhiyun 		goto out;
312*4882a593Smuzhiyun 	}
313*4882a593Smuzhiyun 
314*4882a593Smuzhiyun 	/* Mark internal command */
315*4882a593Smuzhiyun 	tw_dev->srb[request_id] = NULL;
316*4882a593Smuzhiyun 
317*4882a593Smuzhiyun 	do {
318*4882a593Smuzhiyun 		/* Send command to the board */
319*4882a593Smuzhiyun 		if (twa_scsiop_execute_scsi(tw_dev, request_id, cdb, 1, sglist)) {
320*4882a593Smuzhiyun 			TW_PRINTK(tw_dev->host, TW_DRIVER, 0x2, "Error posting request sense");
321*4882a593Smuzhiyun 			goto out;
322*4882a593Smuzhiyun 		}
323*4882a593Smuzhiyun 
324*4882a593Smuzhiyun 		/* Now poll for completion */
325*4882a593Smuzhiyun 		if (twa_poll_response(tw_dev, request_id, 30)) {
326*4882a593Smuzhiyun 			TW_PRINTK(tw_dev->host, TW_DRIVER, 0x3, "No valid response while draining AEN queue");
327*4882a593Smuzhiyun 			tw_dev->posted_request_count--;
328*4882a593Smuzhiyun 			goto out;
329*4882a593Smuzhiyun 		}
330*4882a593Smuzhiyun 
331*4882a593Smuzhiyun 		tw_dev->posted_request_count--;
332*4882a593Smuzhiyun 		header = (TW_Command_Apache_Header *)tw_dev->generic_buffer_virt[request_id];
333*4882a593Smuzhiyun 		aen = le16_to_cpu(header->status_block.error);
334*4882a593Smuzhiyun 		queue = 0;
335*4882a593Smuzhiyun 		count++;
336*4882a593Smuzhiyun 
337*4882a593Smuzhiyun 		switch (aen) {
338*4882a593Smuzhiyun 		case TW_AEN_QUEUE_EMPTY:
339*4882a593Smuzhiyun 			if (first_reset != 1)
340*4882a593Smuzhiyun 				goto out;
341*4882a593Smuzhiyun 			else
342*4882a593Smuzhiyun 				finished = 1;
343*4882a593Smuzhiyun 			break;
344*4882a593Smuzhiyun 		case TW_AEN_SOFT_RESET:
345*4882a593Smuzhiyun 			if (first_reset == 0)
346*4882a593Smuzhiyun 				first_reset = 1;
347*4882a593Smuzhiyun 			else
348*4882a593Smuzhiyun 				queue = 1;
349*4882a593Smuzhiyun 			break;
350*4882a593Smuzhiyun 		case TW_AEN_SYNC_TIME_WITH_HOST:
351*4882a593Smuzhiyun 			break;
352*4882a593Smuzhiyun 		default:
353*4882a593Smuzhiyun 			queue = 1;
354*4882a593Smuzhiyun 		}
355*4882a593Smuzhiyun 
356*4882a593Smuzhiyun 		/* Now queue an event info */
357*4882a593Smuzhiyun 		if (queue)
358*4882a593Smuzhiyun 			twa_aen_queue_event(tw_dev, header);
359*4882a593Smuzhiyun 	} while ((finished == 0) && (count < TW_MAX_AEN_DRAIN));
360*4882a593Smuzhiyun 
361*4882a593Smuzhiyun 	if (count == TW_MAX_AEN_DRAIN)
362*4882a593Smuzhiyun 		goto out;
363*4882a593Smuzhiyun 
364*4882a593Smuzhiyun 	retval = 0;
365*4882a593Smuzhiyun out:
366*4882a593Smuzhiyun 	tw_dev->state[request_id] = TW_S_INITIAL;
367*4882a593Smuzhiyun 	return retval;
368*4882a593Smuzhiyun } /* End twa_aen_drain_queue() */
369*4882a593Smuzhiyun 
370*4882a593Smuzhiyun /* This function will queue an event */
twa_aen_queue_event(TW_Device_Extension * tw_dev,TW_Command_Apache_Header * header)371*4882a593Smuzhiyun static void twa_aen_queue_event(TW_Device_Extension *tw_dev, TW_Command_Apache_Header *header)
372*4882a593Smuzhiyun {
373*4882a593Smuzhiyun 	u32 local_time;
374*4882a593Smuzhiyun 	TW_Event *event;
375*4882a593Smuzhiyun 	unsigned short aen;
376*4882a593Smuzhiyun 	char host[16];
377*4882a593Smuzhiyun 	char *error_str;
378*4882a593Smuzhiyun 
379*4882a593Smuzhiyun 	tw_dev->aen_count++;
380*4882a593Smuzhiyun 
381*4882a593Smuzhiyun 	/* Fill out event info */
382*4882a593Smuzhiyun 	event = tw_dev->event_queue[tw_dev->error_index];
383*4882a593Smuzhiyun 
384*4882a593Smuzhiyun 	/* Check for clobber */
385*4882a593Smuzhiyun 	host[0] = '\0';
386*4882a593Smuzhiyun 	if (tw_dev->host) {
387*4882a593Smuzhiyun 		sprintf(host, " scsi%d:", tw_dev->host->host_no);
388*4882a593Smuzhiyun 		if (event->retrieved == TW_AEN_NOT_RETRIEVED)
389*4882a593Smuzhiyun 			tw_dev->aen_clobber = 1;
390*4882a593Smuzhiyun 	}
391*4882a593Smuzhiyun 
392*4882a593Smuzhiyun 	aen = le16_to_cpu(header->status_block.error);
393*4882a593Smuzhiyun 	memset(event, 0, sizeof(TW_Event));
394*4882a593Smuzhiyun 
395*4882a593Smuzhiyun 	event->severity = TW_SEV_OUT(header->status_block.severity__reserved);
396*4882a593Smuzhiyun 	/* event->time_stamp_sec overflows in y2106 */
397*4882a593Smuzhiyun 	local_time = (u32)(ktime_get_real_seconds() - (sys_tz.tz_minuteswest * 60));
398*4882a593Smuzhiyun 	event->time_stamp_sec = local_time;
399*4882a593Smuzhiyun 	event->aen_code = aen;
400*4882a593Smuzhiyun 	event->retrieved = TW_AEN_NOT_RETRIEVED;
401*4882a593Smuzhiyun 	event->sequence_id = tw_dev->error_sequence_id;
402*4882a593Smuzhiyun 	tw_dev->error_sequence_id++;
403*4882a593Smuzhiyun 
404*4882a593Smuzhiyun 	/* Check for embedded error string */
405*4882a593Smuzhiyun 	error_str = &(header->err_specific_desc[strlen(header->err_specific_desc)+1]);
406*4882a593Smuzhiyun 
407*4882a593Smuzhiyun 	header->err_specific_desc[sizeof(header->err_specific_desc) - 1] = '\0';
408*4882a593Smuzhiyun 	event->parameter_len = strlen(header->err_specific_desc);
409*4882a593Smuzhiyun 	memcpy(event->parameter_data, header->err_specific_desc, event->parameter_len + (error_str[0] == '\0' ? 0 : (1 + strlen(error_str))));
410*4882a593Smuzhiyun 	if (event->severity != TW_AEN_SEVERITY_DEBUG)
411*4882a593Smuzhiyun 		printk(KERN_WARNING "3w-9xxx:%s AEN: %s (0x%02X:0x%04X): %s:%s.\n",
412*4882a593Smuzhiyun 		       host,
413*4882a593Smuzhiyun 		       twa_aen_severity_lookup(TW_SEV_OUT(header->status_block.severity__reserved)),
414*4882a593Smuzhiyun 		       TW_MESSAGE_SOURCE_CONTROLLER_EVENT, aen,
415*4882a593Smuzhiyun 		       error_str[0] == '\0' ? twa_string_lookup(twa_aen_table, aen) : error_str,
416*4882a593Smuzhiyun 		       header->err_specific_desc);
417*4882a593Smuzhiyun 	else
418*4882a593Smuzhiyun 		tw_dev->aen_count--;
419*4882a593Smuzhiyun 
420*4882a593Smuzhiyun 	if ((tw_dev->error_index + 1) == TW_Q_LENGTH)
421*4882a593Smuzhiyun 		tw_dev->event_queue_wrapped = 1;
422*4882a593Smuzhiyun 	tw_dev->error_index = (tw_dev->error_index + 1 ) % TW_Q_LENGTH;
423*4882a593Smuzhiyun } /* End twa_aen_queue_event() */
424*4882a593Smuzhiyun 
425*4882a593Smuzhiyun /* This function will read the aen queue from the isr */
twa_aen_read_queue(TW_Device_Extension * tw_dev,int request_id)426*4882a593Smuzhiyun static int twa_aen_read_queue(TW_Device_Extension *tw_dev, int request_id)
427*4882a593Smuzhiyun {
428*4882a593Smuzhiyun 	unsigned char cdb[TW_MAX_CDB_LEN];
429*4882a593Smuzhiyun 	TW_SG_Entry sglist[1];
430*4882a593Smuzhiyun 	TW_Command_Full *full_command_packet;
431*4882a593Smuzhiyun 	int retval = 1;
432*4882a593Smuzhiyun 
433*4882a593Smuzhiyun 	full_command_packet = tw_dev->command_packet_virt[request_id];
434*4882a593Smuzhiyun 	memset(full_command_packet, 0, sizeof(TW_Command_Full));
435*4882a593Smuzhiyun 
436*4882a593Smuzhiyun 	/* Initialize cdb */
437*4882a593Smuzhiyun 	memset(&cdb, 0, TW_MAX_CDB_LEN);
438*4882a593Smuzhiyun 	cdb[0] = REQUEST_SENSE; /* opcode */
439*4882a593Smuzhiyun 	cdb[4] = TW_ALLOCATION_LENGTH; /* allocation length */
440*4882a593Smuzhiyun 
441*4882a593Smuzhiyun 	/* Initialize sglist */
442*4882a593Smuzhiyun 	memset(&sglist, 0, sizeof(TW_SG_Entry));
443*4882a593Smuzhiyun 	sglist[0].length = TW_SECTOR_SIZE;
444*4882a593Smuzhiyun 	sglist[0].address = tw_dev->generic_buffer_phys[request_id];
445*4882a593Smuzhiyun 
446*4882a593Smuzhiyun 	/* Mark internal command */
447*4882a593Smuzhiyun 	tw_dev->srb[request_id] = NULL;
448*4882a593Smuzhiyun 
449*4882a593Smuzhiyun 	/* Now post the command packet */
450*4882a593Smuzhiyun 	if (twa_scsiop_execute_scsi(tw_dev, request_id, cdb, 1, sglist)) {
451*4882a593Smuzhiyun 		TW_PRINTK(tw_dev->host, TW_DRIVER, 0x4, "Post failed while reading AEN queue");
452*4882a593Smuzhiyun 		goto out;
453*4882a593Smuzhiyun 	}
454*4882a593Smuzhiyun 	retval = 0;
455*4882a593Smuzhiyun out:
456*4882a593Smuzhiyun 	return retval;
457*4882a593Smuzhiyun } /* End twa_aen_read_queue() */
458*4882a593Smuzhiyun 
459*4882a593Smuzhiyun /* This function will look up an AEN severity string */
twa_aen_severity_lookup(unsigned char severity_code)460*4882a593Smuzhiyun static char *twa_aen_severity_lookup(unsigned char severity_code)
461*4882a593Smuzhiyun {
462*4882a593Smuzhiyun 	char *retval = NULL;
463*4882a593Smuzhiyun 
464*4882a593Smuzhiyun 	if ((severity_code < (unsigned char) TW_AEN_SEVERITY_ERROR) ||
465*4882a593Smuzhiyun 	    (severity_code > (unsigned char) TW_AEN_SEVERITY_DEBUG))
466*4882a593Smuzhiyun 		goto out;
467*4882a593Smuzhiyun 
468*4882a593Smuzhiyun 	retval = twa_aen_severity_table[severity_code];
469*4882a593Smuzhiyun out:
470*4882a593Smuzhiyun 	return retval;
471*4882a593Smuzhiyun } /* End twa_aen_severity_lookup() */
472*4882a593Smuzhiyun 
473*4882a593Smuzhiyun /* This function will sync firmware time with the host time */
twa_aen_sync_time(TW_Device_Extension * tw_dev,int request_id)474*4882a593Smuzhiyun static void twa_aen_sync_time(TW_Device_Extension *tw_dev, int request_id)
475*4882a593Smuzhiyun {
476*4882a593Smuzhiyun 	u32 schedulertime;
477*4882a593Smuzhiyun 	TW_Command_Full *full_command_packet;
478*4882a593Smuzhiyun 	TW_Command *command_packet;
479*4882a593Smuzhiyun 	TW_Param_Apache *param;
480*4882a593Smuzhiyun 	time64_t local_time;
481*4882a593Smuzhiyun 
482*4882a593Smuzhiyun 	/* Fill out the command packet */
483*4882a593Smuzhiyun 	full_command_packet = tw_dev->command_packet_virt[request_id];
484*4882a593Smuzhiyun 	memset(full_command_packet, 0, sizeof(TW_Command_Full));
485*4882a593Smuzhiyun 	command_packet = &full_command_packet->command.oldcommand;
486*4882a593Smuzhiyun 	command_packet->opcode__sgloffset = TW_OPSGL_IN(2, TW_OP_SET_PARAM);
487*4882a593Smuzhiyun 	command_packet->request_id = request_id;
488*4882a593Smuzhiyun 	command_packet->byte8_offset.param.sgl[0].address = TW_CPU_TO_SGL(tw_dev->generic_buffer_phys[request_id]);
489*4882a593Smuzhiyun 	command_packet->byte8_offset.param.sgl[0].length = cpu_to_le32(TW_SECTOR_SIZE);
490*4882a593Smuzhiyun 	command_packet->size = TW_COMMAND_SIZE;
491*4882a593Smuzhiyun 	command_packet->byte6_offset.parameter_count = cpu_to_le16(1);
492*4882a593Smuzhiyun 
493*4882a593Smuzhiyun 	/* Setup the param */
494*4882a593Smuzhiyun 	param = (TW_Param_Apache *)tw_dev->generic_buffer_virt[request_id];
495*4882a593Smuzhiyun 	memset(param, 0, TW_SECTOR_SIZE);
496*4882a593Smuzhiyun 	param->table_id = cpu_to_le16(TW_TIMEKEEP_TABLE | 0x8000); /* Controller time keep table */
497*4882a593Smuzhiyun 	param->parameter_id = cpu_to_le16(0x3); /* SchedulerTime */
498*4882a593Smuzhiyun 	param->parameter_size_bytes = cpu_to_le16(4);
499*4882a593Smuzhiyun 
500*4882a593Smuzhiyun 	/* Convert system time in UTC to local time seconds since last
501*4882a593Smuzhiyun            Sunday 12:00AM */
502*4882a593Smuzhiyun 	local_time = (ktime_get_real_seconds() - (sys_tz.tz_minuteswest * 60));
503*4882a593Smuzhiyun 	div_u64_rem(local_time - (3 * 86400), 604800, &schedulertime);
504*4882a593Smuzhiyun 	schedulertime = cpu_to_le32(schedulertime % 604800);
505*4882a593Smuzhiyun 
506*4882a593Smuzhiyun 	memcpy(param->data, &schedulertime, sizeof(u32));
507*4882a593Smuzhiyun 
508*4882a593Smuzhiyun 	/* Mark internal command */
509*4882a593Smuzhiyun 	tw_dev->srb[request_id] = NULL;
510*4882a593Smuzhiyun 
511*4882a593Smuzhiyun 	/* Now post the command */
512*4882a593Smuzhiyun 	twa_post_command_packet(tw_dev, request_id, 1);
513*4882a593Smuzhiyun } /* End twa_aen_sync_time() */
514*4882a593Smuzhiyun 
515*4882a593Smuzhiyun /* This function will allocate memory and check if it is correctly aligned */
twa_allocate_memory(TW_Device_Extension * tw_dev,int size,int which)516*4882a593Smuzhiyun static int twa_allocate_memory(TW_Device_Extension *tw_dev, int size, int which)
517*4882a593Smuzhiyun {
518*4882a593Smuzhiyun 	int i;
519*4882a593Smuzhiyun 	dma_addr_t dma_handle;
520*4882a593Smuzhiyun 	unsigned long *cpu_addr;
521*4882a593Smuzhiyun 	int retval = 1;
522*4882a593Smuzhiyun 
523*4882a593Smuzhiyun 	cpu_addr = dma_alloc_coherent(&tw_dev->tw_pci_dev->dev,
524*4882a593Smuzhiyun 			size * TW_Q_LENGTH, &dma_handle, GFP_KERNEL);
525*4882a593Smuzhiyun 	if (!cpu_addr) {
526*4882a593Smuzhiyun 		TW_PRINTK(tw_dev->host, TW_DRIVER, 0x5, "Memory allocation failed");
527*4882a593Smuzhiyun 		goto out;
528*4882a593Smuzhiyun 	}
529*4882a593Smuzhiyun 
530*4882a593Smuzhiyun 	if ((unsigned long)cpu_addr % (TW_ALIGNMENT_9000)) {
531*4882a593Smuzhiyun 		TW_PRINTK(tw_dev->host, TW_DRIVER, 0x6, "Failed to allocate correctly aligned memory");
532*4882a593Smuzhiyun 		dma_free_coherent(&tw_dev->tw_pci_dev->dev, size * TW_Q_LENGTH,
533*4882a593Smuzhiyun 				cpu_addr, dma_handle);
534*4882a593Smuzhiyun 		goto out;
535*4882a593Smuzhiyun 	}
536*4882a593Smuzhiyun 
537*4882a593Smuzhiyun 	memset(cpu_addr, 0, size*TW_Q_LENGTH);
538*4882a593Smuzhiyun 
539*4882a593Smuzhiyun 	for (i = 0; i < TW_Q_LENGTH; i++) {
540*4882a593Smuzhiyun 		switch(which) {
541*4882a593Smuzhiyun 		case 0:
542*4882a593Smuzhiyun 			tw_dev->command_packet_phys[i] = dma_handle+(i*size);
543*4882a593Smuzhiyun 			tw_dev->command_packet_virt[i] = (TW_Command_Full *)((unsigned char *)cpu_addr + (i*size));
544*4882a593Smuzhiyun 			break;
545*4882a593Smuzhiyun 		case 1:
546*4882a593Smuzhiyun 			tw_dev->generic_buffer_phys[i] = dma_handle+(i*size);
547*4882a593Smuzhiyun 			tw_dev->generic_buffer_virt[i] = (unsigned long *)((unsigned char *)cpu_addr + (i*size));
548*4882a593Smuzhiyun 			break;
549*4882a593Smuzhiyun 		}
550*4882a593Smuzhiyun 	}
551*4882a593Smuzhiyun 	retval = 0;
552*4882a593Smuzhiyun out:
553*4882a593Smuzhiyun 	return retval;
554*4882a593Smuzhiyun } /* End twa_allocate_memory() */
555*4882a593Smuzhiyun 
556*4882a593Smuzhiyun /* This function will check the status register for unexpected bits */
twa_check_bits(u32 status_reg_value)557*4882a593Smuzhiyun static int twa_check_bits(u32 status_reg_value)
558*4882a593Smuzhiyun {
559*4882a593Smuzhiyun 	int retval = 1;
560*4882a593Smuzhiyun 
561*4882a593Smuzhiyun 	if ((status_reg_value & TW_STATUS_EXPECTED_BITS) != TW_STATUS_EXPECTED_BITS)
562*4882a593Smuzhiyun 		goto out;
563*4882a593Smuzhiyun 	if ((status_reg_value & TW_STATUS_UNEXPECTED_BITS) != 0)
564*4882a593Smuzhiyun 		goto out;
565*4882a593Smuzhiyun 
566*4882a593Smuzhiyun 	retval = 0;
567*4882a593Smuzhiyun out:
568*4882a593Smuzhiyun 	return retval;
569*4882a593Smuzhiyun } /* End twa_check_bits() */
570*4882a593Smuzhiyun 
571*4882a593Smuzhiyun /* This function will check the srl and decide if we are compatible  */
twa_check_srl(TW_Device_Extension * tw_dev,int * flashed)572*4882a593Smuzhiyun static int twa_check_srl(TW_Device_Extension *tw_dev, int *flashed)
573*4882a593Smuzhiyun {
574*4882a593Smuzhiyun 	int retval = 1;
575*4882a593Smuzhiyun 	unsigned short fw_on_ctlr_srl = 0, fw_on_ctlr_arch_id = 0;
576*4882a593Smuzhiyun 	unsigned short fw_on_ctlr_branch = 0, fw_on_ctlr_build = 0;
577*4882a593Smuzhiyun 	u32 init_connect_result = 0;
578*4882a593Smuzhiyun 
579*4882a593Smuzhiyun 	if (twa_initconnection(tw_dev, TW_INIT_MESSAGE_CREDITS,
580*4882a593Smuzhiyun 			       TW_EXTENDED_INIT_CONNECT, TW_CURRENT_DRIVER_SRL,
581*4882a593Smuzhiyun 			       TW_9000_ARCH_ID, TW_CURRENT_DRIVER_BRANCH,
582*4882a593Smuzhiyun 			       TW_CURRENT_DRIVER_BUILD, &fw_on_ctlr_srl,
583*4882a593Smuzhiyun 			       &fw_on_ctlr_arch_id, &fw_on_ctlr_branch,
584*4882a593Smuzhiyun 			       &fw_on_ctlr_build, &init_connect_result)) {
585*4882a593Smuzhiyun 		TW_PRINTK(tw_dev->host, TW_DRIVER, 0x7, "Initconnection failed while checking SRL");
586*4882a593Smuzhiyun 		goto out;
587*4882a593Smuzhiyun 	}
588*4882a593Smuzhiyun 
589*4882a593Smuzhiyun 	tw_dev->tw_compat_info.working_srl = fw_on_ctlr_srl;
590*4882a593Smuzhiyun 	tw_dev->tw_compat_info.working_branch = fw_on_ctlr_branch;
591*4882a593Smuzhiyun 	tw_dev->tw_compat_info.working_build = fw_on_ctlr_build;
592*4882a593Smuzhiyun 
593*4882a593Smuzhiyun 	/* Try base mode compatibility */
594*4882a593Smuzhiyun 	if (!(init_connect_result & TW_CTLR_FW_COMPATIBLE)) {
595*4882a593Smuzhiyun 		if (twa_initconnection(tw_dev, TW_INIT_MESSAGE_CREDITS,
596*4882a593Smuzhiyun 				       TW_EXTENDED_INIT_CONNECT,
597*4882a593Smuzhiyun 				       TW_BASE_FW_SRL, TW_9000_ARCH_ID,
598*4882a593Smuzhiyun 				       TW_BASE_FW_BRANCH, TW_BASE_FW_BUILD,
599*4882a593Smuzhiyun 				       &fw_on_ctlr_srl, &fw_on_ctlr_arch_id,
600*4882a593Smuzhiyun 				       &fw_on_ctlr_branch, &fw_on_ctlr_build,
601*4882a593Smuzhiyun 				       &init_connect_result)) {
602*4882a593Smuzhiyun 			TW_PRINTK(tw_dev->host, TW_DRIVER, 0xa, "Initconnection (base mode) failed while checking SRL");
603*4882a593Smuzhiyun 			goto out;
604*4882a593Smuzhiyun 		}
605*4882a593Smuzhiyun 		if (!(init_connect_result & TW_CTLR_FW_COMPATIBLE)) {
606*4882a593Smuzhiyun 			if (TW_CURRENT_DRIVER_SRL > fw_on_ctlr_srl) {
607*4882a593Smuzhiyun 				TW_PRINTK(tw_dev->host, TW_DRIVER, 0x32, "Firmware and driver incompatibility: please upgrade firmware");
608*4882a593Smuzhiyun 			} else {
609*4882a593Smuzhiyun 				TW_PRINTK(tw_dev->host, TW_DRIVER, 0x33, "Firmware and driver incompatibility: please upgrade driver");
610*4882a593Smuzhiyun 			}
611*4882a593Smuzhiyun 			goto out;
612*4882a593Smuzhiyun 		}
613*4882a593Smuzhiyun 		tw_dev->tw_compat_info.working_srl = TW_BASE_FW_SRL;
614*4882a593Smuzhiyun 		tw_dev->tw_compat_info.working_branch = TW_BASE_FW_BRANCH;
615*4882a593Smuzhiyun 		tw_dev->tw_compat_info.working_build = TW_BASE_FW_BUILD;
616*4882a593Smuzhiyun 	}
617*4882a593Smuzhiyun 
618*4882a593Smuzhiyun 	/* Load rest of compatibility struct */
619*4882a593Smuzhiyun 	strlcpy(tw_dev->tw_compat_info.driver_version, TW_DRIVER_VERSION,
620*4882a593Smuzhiyun 		sizeof(tw_dev->tw_compat_info.driver_version));
621*4882a593Smuzhiyun 	tw_dev->tw_compat_info.driver_srl_high = TW_CURRENT_DRIVER_SRL;
622*4882a593Smuzhiyun 	tw_dev->tw_compat_info.driver_branch_high = TW_CURRENT_DRIVER_BRANCH;
623*4882a593Smuzhiyun 	tw_dev->tw_compat_info.driver_build_high = TW_CURRENT_DRIVER_BUILD;
624*4882a593Smuzhiyun 	tw_dev->tw_compat_info.driver_srl_low = TW_BASE_FW_SRL;
625*4882a593Smuzhiyun 	tw_dev->tw_compat_info.driver_branch_low = TW_BASE_FW_BRANCH;
626*4882a593Smuzhiyun 	tw_dev->tw_compat_info.driver_build_low = TW_BASE_FW_BUILD;
627*4882a593Smuzhiyun 	tw_dev->tw_compat_info.fw_on_ctlr_srl = fw_on_ctlr_srl;
628*4882a593Smuzhiyun 	tw_dev->tw_compat_info.fw_on_ctlr_branch = fw_on_ctlr_branch;
629*4882a593Smuzhiyun 	tw_dev->tw_compat_info.fw_on_ctlr_build = fw_on_ctlr_build;
630*4882a593Smuzhiyun 
631*4882a593Smuzhiyun 	retval = 0;
632*4882a593Smuzhiyun out:
633*4882a593Smuzhiyun 	return retval;
634*4882a593Smuzhiyun } /* End twa_check_srl() */
635*4882a593Smuzhiyun 
636*4882a593Smuzhiyun /* This function handles ioctl for the character device */
twa_chrdev_ioctl(struct file * file,unsigned int cmd,unsigned long arg)637*4882a593Smuzhiyun static long twa_chrdev_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
638*4882a593Smuzhiyun {
639*4882a593Smuzhiyun 	struct inode *inode = file_inode(file);
640*4882a593Smuzhiyun 	long timeout;
641*4882a593Smuzhiyun 	unsigned long *cpu_addr, data_buffer_length_adjusted = 0, flags = 0;
642*4882a593Smuzhiyun 	dma_addr_t dma_handle;
643*4882a593Smuzhiyun 	int request_id = 0;
644*4882a593Smuzhiyun 	unsigned int sequence_id = 0;
645*4882a593Smuzhiyun 	unsigned char event_index, start_index;
646*4882a593Smuzhiyun 	TW_Ioctl_Driver_Command driver_command;
647*4882a593Smuzhiyun 	TW_Ioctl_Buf_Apache *tw_ioctl;
648*4882a593Smuzhiyun 	TW_Lock *tw_lock;
649*4882a593Smuzhiyun 	TW_Command_Full *full_command_packet;
650*4882a593Smuzhiyun 	TW_Compatibility_Info *tw_compat_info;
651*4882a593Smuzhiyun 	TW_Event *event;
652*4882a593Smuzhiyun 	ktime_t current_time;
653*4882a593Smuzhiyun 	TW_Device_Extension *tw_dev = twa_device_extension_list[iminor(inode)];
654*4882a593Smuzhiyun 	int retval = TW_IOCTL_ERROR_OS_EFAULT;
655*4882a593Smuzhiyun 	void __user *argp = (void __user *)arg;
656*4882a593Smuzhiyun 
657*4882a593Smuzhiyun 	mutex_lock(&twa_chrdev_mutex);
658*4882a593Smuzhiyun 
659*4882a593Smuzhiyun 	/* Only let one of these through at a time */
660*4882a593Smuzhiyun 	if (mutex_lock_interruptible(&tw_dev->ioctl_lock)) {
661*4882a593Smuzhiyun 		retval = TW_IOCTL_ERROR_OS_EINTR;
662*4882a593Smuzhiyun 		goto out;
663*4882a593Smuzhiyun 	}
664*4882a593Smuzhiyun 
665*4882a593Smuzhiyun 	/* First copy down the driver command */
666*4882a593Smuzhiyun 	if (copy_from_user(&driver_command, argp, sizeof(TW_Ioctl_Driver_Command)))
667*4882a593Smuzhiyun 		goto out2;
668*4882a593Smuzhiyun 
669*4882a593Smuzhiyun 	/* Check data buffer size */
670*4882a593Smuzhiyun 	if (driver_command.buffer_length > TW_MAX_SECTORS * 2048) {
671*4882a593Smuzhiyun 		retval = TW_IOCTL_ERROR_OS_EINVAL;
672*4882a593Smuzhiyun 		goto out2;
673*4882a593Smuzhiyun 	}
674*4882a593Smuzhiyun 
675*4882a593Smuzhiyun 	/* Hardware can only do multiple of 512 byte transfers */
676*4882a593Smuzhiyun 	data_buffer_length_adjusted = (driver_command.buffer_length + 511) & ~511;
677*4882a593Smuzhiyun 
678*4882a593Smuzhiyun 	/* Now allocate ioctl buf memory */
679*4882a593Smuzhiyun 	cpu_addr = dma_alloc_coherent(&tw_dev->tw_pci_dev->dev, data_buffer_length_adjusted+sizeof(TW_Ioctl_Buf_Apache) - 1, &dma_handle, GFP_KERNEL);
680*4882a593Smuzhiyun 	if (!cpu_addr) {
681*4882a593Smuzhiyun 		retval = TW_IOCTL_ERROR_OS_ENOMEM;
682*4882a593Smuzhiyun 		goto out2;
683*4882a593Smuzhiyun 	}
684*4882a593Smuzhiyun 
685*4882a593Smuzhiyun 	tw_ioctl = (TW_Ioctl_Buf_Apache *)cpu_addr;
686*4882a593Smuzhiyun 
687*4882a593Smuzhiyun 	/* Now copy down the entire ioctl */
688*4882a593Smuzhiyun 	if (copy_from_user(tw_ioctl, argp, driver_command.buffer_length + sizeof(TW_Ioctl_Buf_Apache) - 1))
689*4882a593Smuzhiyun 		goto out3;
690*4882a593Smuzhiyun 
691*4882a593Smuzhiyun 	/* See which ioctl we are doing */
692*4882a593Smuzhiyun 	switch (cmd) {
693*4882a593Smuzhiyun 	case TW_IOCTL_FIRMWARE_PASS_THROUGH:
694*4882a593Smuzhiyun 		spin_lock_irqsave(tw_dev->host->host_lock, flags);
695*4882a593Smuzhiyun 		twa_get_request_id(tw_dev, &request_id);
696*4882a593Smuzhiyun 
697*4882a593Smuzhiyun 		/* Flag internal command */
698*4882a593Smuzhiyun 		tw_dev->srb[request_id] = NULL;
699*4882a593Smuzhiyun 
700*4882a593Smuzhiyun 		/* Flag chrdev ioctl */
701*4882a593Smuzhiyun 		tw_dev->chrdev_request_id = request_id;
702*4882a593Smuzhiyun 
703*4882a593Smuzhiyun 		full_command_packet = &tw_ioctl->firmware_command;
704*4882a593Smuzhiyun 
705*4882a593Smuzhiyun 		/* Load request id and sglist for both command types */
706*4882a593Smuzhiyun 		twa_load_sgl(tw_dev, full_command_packet, request_id, dma_handle, data_buffer_length_adjusted);
707*4882a593Smuzhiyun 
708*4882a593Smuzhiyun 		memcpy(tw_dev->command_packet_virt[request_id], &(tw_ioctl->firmware_command), sizeof(TW_Command_Full));
709*4882a593Smuzhiyun 
710*4882a593Smuzhiyun 		/* Now post the command packet to the controller */
711*4882a593Smuzhiyun 		twa_post_command_packet(tw_dev, request_id, 1);
712*4882a593Smuzhiyun 		spin_unlock_irqrestore(tw_dev->host->host_lock, flags);
713*4882a593Smuzhiyun 
714*4882a593Smuzhiyun 		timeout = TW_IOCTL_CHRDEV_TIMEOUT*HZ;
715*4882a593Smuzhiyun 
716*4882a593Smuzhiyun 		/* Now wait for command to complete */
717*4882a593Smuzhiyun 		timeout = wait_event_timeout(tw_dev->ioctl_wqueue, tw_dev->chrdev_request_id == TW_IOCTL_CHRDEV_FREE, timeout);
718*4882a593Smuzhiyun 
719*4882a593Smuzhiyun 		/* We timed out, and didn't get an interrupt */
720*4882a593Smuzhiyun 		if (tw_dev->chrdev_request_id != TW_IOCTL_CHRDEV_FREE) {
721*4882a593Smuzhiyun 			/* Now we need to reset the board */
722*4882a593Smuzhiyun 			printk(KERN_WARNING "3w-9xxx: scsi%d: WARNING: (0x%02X:0x%04X): Character ioctl (0x%x) timed out, resetting card.\n",
723*4882a593Smuzhiyun 			       tw_dev->host->host_no, TW_DRIVER, 0x37,
724*4882a593Smuzhiyun 			       cmd);
725*4882a593Smuzhiyun 			retval = TW_IOCTL_ERROR_OS_EIO;
726*4882a593Smuzhiyun 			twa_reset_device_extension(tw_dev);
727*4882a593Smuzhiyun 			goto out3;
728*4882a593Smuzhiyun 		}
729*4882a593Smuzhiyun 
730*4882a593Smuzhiyun 		/* Now copy in the command packet response */
731*4882a593Smuzhiyun 		memcpy(&(tw_ioctl->firmware_command), tw_dev->command_packet_virt[request_id], sizeof(TW_Command_Full));
732*4882a593Smuzhiyun 
733*4882a593Smuzhiyun 		/* Now complete the io */
734*4882a593Smuzhiyun 		spin_lock_irqsave(tw_dev->host->host_lock, flags);
735*4882a593Smuzhiyun 		tw_dev->posted_request_count--;
736*4882a593Smuzhiyun 		tw_dev->state[request_id] = TW_S_COMPLETED;
737*4882a593Smuzhiyun 		twa_free_request_id(tw_dev, request_id);
738*4882a593Smuzhiyun 		spin_unlock_irqrestore(tw_dev->host->host_lock, flags);
739*4882a593Smuzhiyun 		break;
740*4882a593Smuzhiyun 	case TW_IOCTL_GET_COMPATIBILITY_INFO:
741*4882a593Smuzhiyun 		tw_ioctl->driver_command.status = 0;
742*4882a593Smuzhiyun 		/* Copy compatibility struct into ioctl data buffer */
743*4882a593Smuzhiyun 		tw_compat_info = (TW_Compatibility_Info *)tw_ioctl->data_buffer;
744*4882a593Smuzhiyun 		memcpy(tw_compat_info, &tw_dev->tw_compat_info, sizeof(TW_Compatibility_Info));
745*4882a593Smuzhiyun 		break;
746*4882a593Smuzhiyun 	case TW_IOCTL_GET_LAST_EVENT:
747*4882a593Smuzhiyun 		if (tw_dev->event_queue_wrapped) {
748*4882a593Smuzhiyun 			if (tw_dev->aen_clobber) {
749*4882a593Smuzhiyun 				tw_ioctl->driver_command.status = TW_IOCTL_ERROR_STATUS_AEN_CLOBBER;
750*4882a593Smuzhiyun 				tw_dev->aen_clobber = 0;
751*4882a593Smuzhiyun 			} else
752*4882a593Smuzhiyun 				tw_ioctl->driver_command.status = 0;
753*4882a593Smuzhiyun 		} else {
754*4882a593Smuzhiyun 			if (!tw_dev->error_index) {
755*4882a593Smuzhiyun 				tw_ioctl->driver_command.status = TW_IOCTL_ERROR_STATUS_NO_MORE_EVENTS;
756*4882a593Smuzhiyun 				break;
757*4882a593Smuzhiyun 			}
758*4882a593Smuzhiyun 			tw_ioctl->driver_command.status = 0;
759*4882a593Smuzhiyun 		}
760*4882a593Smuzhiyun 		event_index = (tw_dev->error_index - 1 + TW_Q_LENGTH) % TW_Q_LENGTH;
761*4882a593Smuzhiyun 		memcpy(tw_ioctl->data_buffer, tw_dev->event_queue[event_index], sizeof(TW_Event));
762*4882a593Smuzhiyun 		tw_dev->event_queue[event_index]->retrieved = TW_AEN_RETRIEVED;
763*4882a593Smuzhiyun 		break;
764*4882a593Smuzhiyun 	case TW_IOCTL_GET_FIRST_EVENT:
765*4882a593Smuzhiyun 		if (tw_dev->event_queue_wrapped) {
766*4882a593Smuzhiyun 			if (tw_dev->aen_clobber) {
767*4882a593Smuzhiyun 				tw_ioctl->driver_command.status = TW_IOCTL_ERROR_STATUS_AEN_CLOBBER;
768*4882a593Smuzhiyun 				tw_dev->aen_clobber = 0;
769*4882a593Smuzhiyun 			} else
770*4882a593Smuzhiyun 				tw_ioctl->driver_command.status = 0;
771*4882a593Smuzhiyun 			event_index = tw_dev->error_index;
772*4882a593Smuzhiyun 		} else {
773*4882a593Smuzhiyun 			if (!tw_dev->error_index) {
774*4882a593Smuzhiyun 				tw_ioctl->driver_command.status = TW_IOCTL_ERROR_STATUS_NO_MORE_EVENTS;
775*4882a593Smuzhiyun 				break;
776*4882a593Smuzhiyun 			}
777*4882a593Smuzhiyun 			tw_ioctl->driver_command.status = 0;
778*4882a593Smuzhiyun 			event_index = 0;
779*4882a593Smuzhiyun 		}
780*4882a593Smuzhiyun 		memcpy(tw_ioctl->data_buffer, tw_dev->event_queue[event_index], sizeof(TW_Event));
781*4882a593Smuzhiyun 		tw_dev->event_queue[event_index]->retrieved = TW_AEN_RETRIEVED;
782*4882a593Smuzhiyun 		break;
783*4882a593Smuzhiyun 	case TW_IOCTL_GET_NEXT_EVENT:
784*4882a593Smuzhiyun 		event = (TW_Event *)tw_ioctl->data_buffer;
785*4882a593Smuzhiyun 		sequence_id = event->sequence_id;
786*4882a593Smuzhiyun 		tw_ioctl->driver_command.status = 0;
787*4882a593Smuzhiyun 
788*4882a593Smuzhiyun 		if (tw_dev->event_queue_wrapped) {
789*4882a593Smuzhiyun 			if (tw_dev->aen_clobber) {
790*4882a593Smuzhiyun 				tw_ioctl->driver_command.status = TW_IOCTL_ERROR_STATUS_AEN_CLOBBER;
791*4882a593Smuzhiyun 				tw_dev->aen_clobber = 0;
792*4882a593Smuzhiyun 			}
793*4882a593Smuzhiyun 			start_index = tw_dev->error_index;
794*4882a593Smuzhiyun 		} else {
795*4882a593Smuzhiyun 			if (!tw_dev->error_index) {
796*4882a593Smuzhiyun 				tw_ioctl->driver_command.status = TW_IOCTL_ERROR_STATUS_NO_MORE_EVENTS;
797*4882a593Smuzhiyun 				break;
798*4882a593Smuzhiyun 			}
799*4882a593Smuzhiyun 			start_index = 0;
800*4882a593Smuzhiyun 		}
801*4882a593Smuzhiyun 		event_index = (start_index + sequence_id - tw_dev->event_queue[start_index]->sequence_id + 1) % TW_Q_LENGTH;
802*4882a593Smuzhiyun 
803*4882a593Smuzhiyun 		if (!(tw_dev->event_queue[event_index]->sequence_id > sequence_id)) {
804*4882a593Smuzhiyun 			if (tw_ioctl->driver_command.status == TW_IOCTL_ERROR_STATUS_AEN_CLOBBER)
805*4882a593Smuzhiyun 				tw_dev->aen_clobber = 1;
806*4882a593Smuzhiyun 			tw_ioctl->driver_command.status = TW_IOCTL_ERROR_STATUS_NO_MORE_EVENTS;
807*4882a593Smuzhiyun 			break;
808*4882a593Smuzhiyun 		}
809*4882a593Smuzhiyun 		memcpy(tw_ioctl->data_buffer, tw_dev->event_queue[event_index], sizeof(TW_Event));
810*4882a593Smuzhiyun 		tw_dev->event_queue[event_index]->retrieved = TW_AEN_RETRIEVED;
811*4882a593Smuzhiyun 		break;
812*4882a593Smuzhiyun 	case TW_IOCTL_GET_PREVIOUS_EVENT:
813*4882a593Smuzhiyun 		event = (TW_Event *)tw_ioctl->data_buffer;
814*4882a593Smuzhiyun 		sequence_id = event->sequence_id;
815*4882a593Smuzhiyun 		tw_ioctl->driver_command.status = 0;
816*4882a593Smuzhiyun 
817*4882a593Smuzhiyun 		if (tw_dev->event_queue_wrapped) {
818*4882a593Smuzhiyun 			if (tw_dev->aen_clobber) {
819*4882a593Smuzhiyun 				tw_ioctl->driver_command.status = TW_IOCTL_ERROR_STATUS_AEN_CLOBBER;
820*4882a593Smuzhiyun 				tw_dev->aen_clobber = 0;
821*4882a593Smuzhiyun 			}
822*4882a593Smuzhiyun 			start_index = tw_dev->error_index;
823*4882a593Smuzhiyun 		} else {
824*4882a593Smuzhiyun 			if (!tw_dev->error_index) {
825*4882a593Smuzhiyun 				tw_ioctl->driver_command.status = TW_IOCTL_ERROR_STATUS_NO_MORE_EVENTS;
826*4882a593Smuzhiyun 				break;
827*4882a593Smuzhiyun 			}
828*4882a593Smuzhiyun 			start_index = 0;
829*4882a593Smuzhiyun 		}
830*4882a593Smuzhiyun 		event_index = (start_index + sequence_id - tw_dev->event_queue[start_index]->sequence_id - 1) % TW_Q_LENGTH;
831*4882a593Smuzhiyun 
832*4882a593Smuzhiyun 		if (!(tw_dev->event_queue[event_index]->sequence_id < sequence_id)) {
833*4882a593Smuzhiyun 			if (tw_ioctl->driver_command.status == TW_IOCTL_ERROR_STATUS_AEN_CLOBBER)
834*4882a593Smuzhiyun 				tw_dev->aen_clobber = 1;
835*4882a593Smuzhiyun 			tw_ioctl->driver_command.status = TW_IOCTL_ERROR_STATUS_NO_MORE_EVENTS;
836*4882a593Smuzhiyun 			break;
837*4882a593Smuzhiyun 		}
838*4882a593Smuzhiyun 		memcpy(tw_ioctl->data_buffer, tw_dev->event_queue[event_index], sizeof(TW_Event));
839*4882a593Smuzhiyun 		tw_dev->event_queue[event_index]->retrieved = TW_AEN_RETRIEVED;
840*4882a593Smuzhiyun 		break;
841*4882a593Smuzhiyun 	case TW_IOCTL_GET_LOCK:
842*4882a593Smuzhiyun 		tw_lock = (TW_Lock *)tw_ioctl->data_buffer;
843*4882a593Smuzhiyun 		current_time = ktime_get();
844*4882a593Smuzhiyun 
845*4882a593Smuzhiyun 		if ((tw_lock->force_flag == 1) || (tw_dev->ioctl_sem_lock == 0) ||
846*4882a593Smuzhiyun 		    ktime_after(current_time, tw_dev->ioctl_time)) {
847*4882a593Smuzhiyun 			tw_dev->ioctl_sem_lock = 1;
848*4882a593Smuzhiyun 			tw_dev->ioctl_time = ktime_add_ms(current_time, tw_lock->timeout_msec);
849*4882a593Smuzhiyun 			tw_ioctl->driver_command.status = 0;
850*4882a593Smuzhiyun 			tw_lock->time_remaining_msec = tw_lock->timeout_msec;
851*4882a593Smuzhiyun 		} else {
852*4882a593Smuzhiyun 			tw_ioctl->driver_command.status = TW_IOCTL_ERROR_STATUS_LOCKED;
853*4882a593Smuzhiyun 			tw_lock->time_remaining_msec = ktime_ms_delta(tw_dev->ioctl_time, current_time);
854*4882a593Smuzhiyun 		}
855*4882a593Smuzhiyun 		break;
856*4882a593Smuzhiyun 	case TW_IOCTL_RELEASE_LOCK:
857*4882a593Smuzhiyun 		if (tw_dev->ioctl_sem_lock == 1) {
858*4882a593Smuzhiyun 			tw_dev->ioctl_sem_lock = 0;
859*4882a593Smuzhiyun 			tw_ioctl->driver_command.status = 0;
860*4882a593Smuzhiyun 		} else {
861*4882a593Smuzhiyun 			tw_ioctl->driver_command.status = TW_IOCTL_ERROR_STATUS_NOT_LOCKED;
862*4882a593Smuzhiyun 		}
863*4882a593Smuzhiyun 		break;
864*4882a593Smuzhiyun 	default:
865*4882a593Smuzhiyun 		retval = TW_IOCTL_ERROR_OS_ENOTTY;
866*4882a593Smuzhiyun 		goto out3;
867*4882a593Smuzhiyun 	}
868*4882a593Smuzhiyun 
869*4882a593Smuzhiyun 	/* Now copy the entire response to userspace */
870*4882a593Smuzhiyun 	if (copy_to_user(argp, tw_ioctl, sizeof(TW_Ioctl_Buf_Apache) + driver_command.buffer_length - 1) == 0)
871*4882a593Smuzhiyun 		retval = 0;
872*4882a593Smuzhiyun out3:
873*4882a593Smuzhiyun 	/* Now free ioctl buf memory */
874*4882a593Smuzhiyun 	dma_free_coherent(&tw_dev->tw_pci_dev->dev, data_buffer_length_adjusted+sizeof(TW_Ioctl_Buf_Apache) - 1, cpu_addr, dma_handle);
875*4882a593Smuzhiyun out2:
876*4882a593Smuzhiyun 	mutex_unlock(&tw_dev->ioctl_lock);
877*4882a593Smuzhiyun out:
878*4882a593Smuzhiyun 	mutex_unlock(&twa_chrdev_mutex);
879*4882a593Smuzhiyun 	return retval;
880*4882a593Smuzhiyun } /* End twa_chrdev_ioctl() */
881*4882a593Smuzhiyun 
882*4882a593Smuzhiyun /* This function handles open for the character device */
883*4882a593Smuzhiyun /* NOTE that this function will race with remove. */
twa_chrdev_open(struct inode * inode,struct file * file)884*4882a593Smuzhiyun static int twa_chrdev_open(struct inode *inode, struct file *file)
885*4882a593Smuzhiyun {
886*4882a593Smuzhiyun 	unsigned int minor_number;
887*4882a593Smuzhiyun 	int retval = TW_IOCTL_ERROR_OS_ENODEV;
888*4882a593Smuzhiyun 
889*4882a593Smuzhiyun 	if (!capable(CAP_SYS_ADMIN)) {
890*4882a593Smuzhiyun 		retval = -EACCES;
891*4882a593Smuzhiyun 		goto out;
892*4882a593Smuzhiyun 	}
893*4882a593Smuzhiyun 
894*4882a593Smuzhiyun 	minor_number = iminor(inode);
895*4882a593Smuzhiyun 	if (minor_number >= twa_device_extension_count)
896*4882a593Smuzhiyun 		goto out;
897*4882a593Smuzhiyun 	retval = 0;
898*4882a593Smuzhiyun out:
899*4882a593Smuzhiyun 	return retval;
900*4882a593Smuzhiyun } /* End twa_chrdev_open() */
901*4882a593Smuzhiyun 
902*4882a593Smuzhiyun /* This function will print readable messages from status register errors */
twa_decode_bits(TW_Device_Extension * tw_dev,u32 status_reg_value)903*4882a593Smuzhiyun static int twa_decode_bits(TW_Device_Extension *tw_dev, u32 status_reg_value)
904*4882a593Smuzhiyun {
905*4882a593Smuzhiyun 	int retval = 1;
906*4882a593Smuzhiyun 
907*4882a593Smuzhiyun 	/* Check for various error conditions and handle them appropriately */
908*4882a593Smuzhiyun 	if (status_reg_value & TW_STATUS_PCI_PARITY_ERROR) {
909*4882a593Smuzhiyun 		TW_PRINTK(tw_dev->host, TW_DRIVER, 0xc, "PCI Parity Error: clearing");
910*4882a593Smuzhiyun 		writel(TW_CONTROL_CLEAR_PARITY_ERROR, TW_CONTROL_REG_ADDR(tw_dev));
911*4882a593Smuzhiyun 	}
912*4882a593Smuzhiyun 
913*4882a593Smuzhiyun 	if (status_reg_value & TW_STATUS_PCI_ABORT) {
914*4882a593Smuzhiyun 		TW_PRINTK(tw_dev->host, TW_DRIVER, 0xd, "PCI Abort: clearing");
915*4882a593Smuzhiyun 		writel(TW_CONTROL_CLEAR_PCI_ABORT, TW_CONTROL_REG_ADDR(tw_dev));
916*4882a593Smuzhiyun 		pci_write_config_word(tw_dev->tw_pci_dev, PCI_STATUS, TW_PCI_CLEAR_PCI_ABORT);
917*4882a593Smuzhiyun 	}
918*4882a593Smuzhiyun 
919*4882a593Smuzhiyun 	if (status_reg_value & TW_STATUS_QUEUE_ERROR) {
920*4882a593Smuzhiyun 		if (((tw_dev->tw_pci_dev->device != PCI_DEVICE_ID_3WARE_9650SE) &&
921*4882a593Smuzhiyun 		     (tw_dev->tw_pci_dev->device != PCI_DEVICE_ID_3WARE_9690SA)) ||
922*4882a593Smuzhiyun 		    (!test_bit(TW_IN_RESET, &tw_dev->flags)))
923*4882a593Smuzhiyun 			TW_PRINTK(tw_dev->host, TW_DRIVER, 0xe, "Controller Queue Error: clearing");
924*4882a593Smuzhiyun 		writel(TW_CONTROL_CLEAR_QUEUE_ERROR, TW_CONTROL_REG_ADDR(tw_dev));
925*4882a593Smuzhiyun 	}
926*4882a593Smuzhiyun 
927*4882a593Smuzhiyun 	if (status_reg_value & TW_STATUS_MICROCONTROLLER_ERROR) {
928*4882a593Smuzhiyun 		if (tw_dev->reset_print == 0) {
929*4882a593Smuzhiyun 			TW_PRINTK(tw_dev->host, TW_DRIVER, 0x10, "Microcontroller Error: clearing");
930*4882a593Smuzhiyun 			tw_dev->reset_print = 1;
931*4882a593Smuzhiyun 		}
932*4882a593Smuzhiyun 		goto out;
933*4882a593Smuzhiyun 	}
934*4882a593Smuzhiyun 	retval = 0;
935*4882a593Smuzhiyun out:
936*4882a593Smuzhiyun 	return retval;
937*4882a593Smuzhiyun } /* End twa_decode_bits() */
938*4882a593Smuzhiyun 
939*4882a593Smuzhiyun /* This function will empty the response queue */
twa_empty_response_queue(TW_Device_Extension * tw_dev)940*4882a593Smuzhiyun static int twa_empty_response_queue(TW_Device_Extension *tw_dev)
941*4882a593Smuzhiyun {
942*4882a593Smuzhiyun 	u32 status_reg_value, response_que_value;
943*4882a593Smuzhiyun 	int count = 0, retval = 1;
944*4882a593Smuzhiyun 
945*4882a593Smuzhiyun 	status_reg_value = readl(TW_STATUS_REG_ADDR(tw_dev));
946*4882a593Smuzhiyun 
947*4882a593Smuzhiyun 	while (((status_reg_value & TW_STATUS_RESPONSE_QUEUE_EMPTY) == 0) && (count < TW_MAX_RESPONSE_DRAIN)) {
948*4882a593Smuzhiyun 		response_que_value = readl(TW_RESPONSE_QUEUE_REG_ADDR(tw_dev));
949*4882a593Smuzhiyun 		status_reg_value = readl(TW_STATUS_REG_ADDR(tw_dev));
950*4882a593Smuzhiyun 		count++;
951*4882a593Smuzhiyun 	}
952*4882a593Smuzhiyun 	if (count == TW_MAX_RESPONSE_DRAIN)
953*4882a593Smuzhiyun 		goto out;
954*4882a593Smuzhiyun 
955*4882a593Smuzhiyun 	retval = 0;
956*4882a593Smuzhiyun out:
957*4882a593Smuzhiyun 	return retval;
958*4882a593Smuzhiyun } /* End twa_empty_response_queue() */
959*4882a593Smuzhiyun 
960*4882a593Smuzhiyun /* This function will clear the pchip/response queue on 9550SX */
twa_empty_response_queue_large(TW_Device_Extension * tw_dev)961*4882a593Smuzhiyun static int twa_empty_response_queue_large(TW_Device_Extension *tw_dev)
962*4882a593Smuzhiyun {
963*4882a593Smuzhiyun 	u32 response_que_value = 0;
964*4882a593Smuzhiyun 	unsigned long before;
965*4882a593Smuzhiyun 	int retval = 1;
966*4882a593Smuzhiyun 
967*4882a593Smuzhiyun 	if (tw_dev->tw_pci_dev->device != PCI_DEVICE_ID_3WARE_9000) {
968*4882a593Smuzhiyun 		before = jiffies;
969*4882a593Smuzhiyun 		while ((response_que_value & TW_9550SX_DRAIN_COMPLETED) != TW_9550SX_DRAIN_COMPLETED) {
970*4882a593Smuzhiyun 			response_que_value = readl(TW_RESPONSE_QUEUE_REG_ADDR_LARGE(tw_dev));
971*4882a593Smuzhiyun 			msleep(1);
972*4882a593Smuzhiyun 			if (time_after(jiffies, before + HZ * 30))
973*4882a593Smuzhiyun 				goto out;
974*4882a593Smuzhiyun 		}
975*4882a593Smuzhiyun 		/* P-chip settle time */
976*4882a593Smuzhiyun 		msleep(500);
977*4882a593Smuzhiyun 		retval = 0;
978*4882a593Smuzhiyun 	} else
979*4882a593Smuzhiyun 		retval = 0;
980*4882a593Smuzhiyun out:
981*4882a593Smuzhiyun 	return retval;
982*4882a593Smuzhiyun } /* End twa_empty_response_queue_large() */
983*4882a593Smuzhiyun 
984*4882a593Smuzhiyun /* This function passes sense keys from firmware to scsi layer */
twa_fill_sense(TW_Device_Extension * tw_dev,int request_id,int copy_sense,int print_host)985*4882a593Smuzhiyun static int twa_fill_sense(TW_Device_Extension *tw_dev, int request_id, int copy_sense, int print_host)
986*4882a593Smuzhiyun {
987*4882a593Smuzhiyun 	TW_Command_Full *full_command_packet;
988*4882a593Smuzhiyun 	unsigned short error;
989*4882a593Smuzhiyun 	int retval = 1;
990*4882a593Smuzhiyun 	char *error_str;
991*4882a593Smuzhiyun 
992*4882a593Smuzhiyun 	full_command_packet = tw_dev->command_packet_virt[request_id];
993*4882a593Smuzhiyun 
994*4882a593Smuzhiyun 	/* Check for embedded error string */
995*4882a593Smuzhiyun 	error_str = &(full_command_packet->header.err_specific_desc[strlen(full_command_packet->header.err_specific_desc) + 1]);
996*4882a593Smuzhiyun 
997*4882a593Smuzhiyun 	/* Don't print error for Logical unit not supported during rollcall */
998*4882a593Smuzhiyun 	error = le16_to_cpu(full_command_packet->header.status_block.error);
999*4882a593Smuzhiyun 	if ((error != TW_ERROR_LOGICAL_UNIT_NOT_SUPPORTED) && (error != TW_ERROR_UNIT_OFFLINE)) {
1000*4882a593Smuzhiyun 		if (print_host)
1001*4882a593Smuzhiyun 			printk(KERN_WARNING "3w-9xxx: scsi%d: ERROR: (0x%02X:0x%04X): %s:%s.\n",
1002*4882a593Smuzhiyun 			       tw_dev->host->host_no,
1003*4882a593Smuzhiyun 			       TW_MESSAGE_SOURCE_CONTROLLER_ERROR,
1004*4882a593Smuzhiyun 			       full_command_packet->header.status_block.error,
1005*4882a593Smuzhiyun 			       error_str[0] == '\0' ?
1006*4882a593Smuzhiyun 			       twa_string_lookup(twa_error_table,
1007*4882a593Smuzhiyun 						 full_command_packet->header.status_block.error) : error_str,
1008*4882a593Smuzhiyun 			       full_command_packet->header.err_specific_desc);
1009*4882a593Smuzhiyun 		else
1010*4882a593Smuzhiyun 			printk(KERN_WARNING "3w-9xxx: ERROR: (0x%02X:0x%04X): %s:%s.\n",
1011*4882a593Smuzhiyun 			       TW_MESSAGE_SOURCE_CONTROLLER_ERROR,
1012*4882a593Smuzhiyun 			       full_command_packet->header.status_block.error,
1013*4882a593Smuzhiyun 			       error_str[0] == '\0' ?
1014*4882a593Smuzhiyun 			       twa_string_lookup(twa_error_table,
1015*4882a593Smuzhiyun 						 full_command_packet->header.status_block.error) : error_str,
1016*4882a593Smuzhiyun 			       full_command_packet->header.err_specific_desc);
1017*4882a593Smuzhiyun 	}
1018*4882a593Smuzhiyun 
1019*4882a593Smuzhiyun 	if (copy_sense) {
1020*4882a593Smuzhiyun 		memcpy(tw_dev->srb[request_id]->sense_buffer, full_command_packet->header.sense_data, TW_SENSE_DATA_LENGTH);
1021*4882a593Smuzhiyun 		tw_dev->srb[request_id]->result = (full_command_packet->command.newcommand.status << 1);
1022*4882a593Smuzhiyun 		retval = TW_ISR_DONT_RESULT;
1023*4882a593Smuzhiyun 		goto out;
1024*4882a593Smuzhiyun 	}
1025*4882a593Smuzhiyun 	retval = 0;
1026*4882a593Smuzhiyun out:
1027*4882a593Smuzhiyun 	return retval;
1028*4882a593Smuzhiyun } /* End twa_fill_sense() */
1029*4882a593Smuzhiyun 
1030*4882a593Smuzhiyun /* This function will free up device extension resources */
twa_free_device_extension(TW_Device_Extension * tw_dev)1031*4882a593Smuzhiyun static void twa_free_device_extension(TW_Device_Extension *tw_dev)
1032*4882a593Smuzhiyun {
1033*4882a593Smuzhiyun 	if (tw_dev->command_packet_virt[0])
1034*4882a593Smuzhiyun 		dma_free_coherent(&tw_dev->tw_pci_dev->dev,
1035*4882a593Smuzhiyun 				sizeof(TW_Command_Full) * TW_Q_LENGTH,
1036*4882a593Smuzhiyun 				tw_dev->command_packet_virt[0],
1037*4882a593Smuzhiyun 				tw_dev->command_packet_phys[0]);
1038*4882a593Smuzhiyun 
1039*4882a593Smuzhiyun 	if (tw_dev->generic_buffer_virt[0])
1040*4882a593Smuzhiyun 		dma_free_coherent(&tw_dev->tw_pci_dev->dev,
1041*4882a593Smuzhiyun 				TW_SECTOR_SIZE * TW_Q_LENGTH,
1042*4882a593Smuzhiyun 				tw_dev->generic_buffer_virt[0],
1043*4882a593Smuzhiyun 				tw_dev->generic_buffer_phys[0]);
1044*4882a593Smuzhiyun 
1045*4882a593Smuzhiyun 	kfree(tw_dev->event_queue[0]);
1046*4882a593Smuzhiyun } /* End twa_free_device_extension() */
1047*4882a593Smuzhiyun 
1048*4882a593Smuzhiyun /* This function will free a request id */
twa_free_request_id(TW_Device_Extension * tw_dev,int request_id)1049*4882a593Smuzhiyun static void twa_free_request_id(TW_Device_Extension *tw_dev, int request_id)
1050*4882a593Smuzhiyun {
1051*4882a593Smuzhiyun 	tw_dev->free_queue[tw_dev->free_tail] = request_id;
1052*4882a593Smuzhiyun 	tw_dev->state[request_id] = TW_S_FINISHED;
1053*4882a593Smuzhiyun 	tw_dev->free_tail = (tw_dev->free_tail + 1) % TW_Q_LENGTH;
1054*4882a593Smuzhiyun } /* End twa_free_request_id() */
1055*4882a593Smuzhiyun 
1056*4882a593Smuzhiyun /* This function will get parameter table entries from the firmware */
twa_get_param(TW_Device_Extension * tw_dev,int request_id,int table_id,int parameter_id,int parameter_size_bytes)1057*4882a593Smuzhiyun static void *twa_get_param(TW_Device_Extension *tw_dev, int request_id, int table_id, int parameter_id, int parameter_size_bytes)
1058*4882a593Smuzhiyun {
1059*4882a593Smuzhiyun 	TW_Command_Full *full_command_packet;
1060*4882a593Smuzhiyun 	TW_Command *command_packet;
1061*4882a593Smuzhiyun 	TW_Param_Apache *param;
1062*4882a593Smuzhiyun 	void *retval = NULL;
1063*4882a593Smuzhiyun 
1064*4882a593Smuzhiyun 	/* Setup the command packet */
1065*4882a593Smuzhiyun 	full_command_packet = tw_dev->command_packet_virt[request_id];
1066*4882a593Smuzhiyun 	memset(full_command_packet, 0, sizeof(TW_Command_Full));
1067*4882a593Smuzhiyun 	command_packet = &full_command_packet->command.oldcommand;
1068*4882a593Smuzhiyun 
1069*4882a593Smuzhiyun 	command_packet->opcode__sgloffset = TW_OPSGL_IN(2, TW_OP_GET_PARAM);
1070*4882a593Smuzhiyun 	command_packet->size              = TW_COMMAND_SIZE;
1071*4882a593Smuzhiyun 	command_packet->request_id        = request_id;
1072*4882a593Smuzhiyun 	command_packet->byte6_offset.block_count = cpu_to_le16(1);
1073*4882a593Smuzhiyun 
1074*4882a593Smuzhiyun 	/* Now setup the param */
1075*4882a593Smuzhiyun 	param = (TW_Param_Apache *)tw_dev->generic_buffer_virt[request_id];
1076*4882a593Smuzhiyun 	memset(param, 0, TW_SECTOR_SIZE);
1077*4882a593Smuzhiyun 	param->table_id = cpu_to_le16(table_id | 0x8000);
1078*4882a593Smuzhiyun 	param->parameter_id = cpu_to_le16(parameter_id);
1079*4882a593Smuzhiyun 	param->parameter_size_bytes = cpu_to_le16(parameter_size_bytes);
1080*4882a593Smuzhiyun 
1081*4882a593Smuzhiyun 	command_packet->byte8_offset.param.sgl[0].address = TW_CPU_TO_SGL(tw_dev->generic_buffer_phys[request_id]);
1082*4882a593Smuzhiyun 	command_packet->byte8_offset.param.sgl[0].length = cpu_to_le32(TW_SECTOR_SIZE);
1083*4882a593Smuzhiyun 
1084*4882a593Smuzhiyun 	/* Post the command packet to the board */
1085*4882a593Smuzhiyun 	twa_post_command_packet(tw_dev, request_id, 1);
1086*4882a593Smuzhiyun 
1087*4882a593Smuzhiyun 	/* Poll for completion */
1088*4882a593Smuzhiyun 	if (twa_poll_response(tw_dev, request_id, 30))
1089*4882a593Smuzhiyun 		TW_PRINTK(tw_dev->host, TW_DRIVER, 0x13, "No valid response during get param")
1090*4882a593Smuzhiyun 	else
1091*4882a593Smuzhiyun 		retval = (void *)&(param->data[0]);
1092*4882a593Smuzhiyun 
1093*4882a593Smuzhiyun 	tw_dev->posted_request_count--;
1094*4882a593Smuzhiyun 	tw_dev->state[request_id] = TW_S_INITIAL;
1095*4882a593Smuzhiyun 
1096*4882a593Smuzhiyun 	return retval;
1097*4882a593Smuzhiyun } /* End twa_get_param() */
1098*4882a593Smuzhiyun 
1099*4882a593Smuzhiyun /* This function will assign an available request id */
twa_get_request_id(TW_Device_Extension * tw_dev,int * request_id)1100*4882a593Smuzhiyun static void twa_get_request_id(TW_Device_Extension *tw_dev, int *request_id)
1101*4882a593Smuzhiyun {
1102*4882a593Smuzhiyun 	*request_id = tw_dev->free_queue[tw_dev->free_head];
1103*4882a593Smuzhiyun 	tw_dev->free_head = (tw_dev->free_head + 1) % TW_Q_LENGTH;
1104*4882a593Smuzhiyun 	tw_dev->state[*request_id] = TW_S_STARTED;
1105*4882a593Smuzhiyun } /* End twa_get_request_id() */
1106*4882a593Smuzhiyun 
1107*4882a593Smuzhiyun /* This function will send an initconnection command to controller */
twa_initconnection(TW_Device_Extension * tw_dev,int message_credits,u32 set_features,unsigned short current_fw_srl,unsigned short current_fw_arch_id,unsigned short current_fw_branch,unsigned short current_fw_build,unsigned short * fw_on_ctlr_srl,unsigned short * fw_on_ctlr_arch_id,unsigned short * fw_on_ctlr_branch,unsigned short * fw_on_ctlr_build,u32 * init_connect_result)1108*4882a593Smuzhiyun static int twa_initconnection(TW_Device_Extension *tw_dev, int message_credits,
1109*4882a593Smuzhiyun  			      u32 set_features, unsigned short current_fw_srl,
1110*4882a593Smuzhiyun 			      unsigned short current_fw_arch_id,
1111*4882a593Smuzhiyun 			      unsigned short current_fw_branch,
1112*4882a593Smuzhiyun 			      unsigned short current_fw_build,
1113*4882a593Smuzhiyun 			      unsigned short *fw_on_ctlr_srl,
1114*4882a593Smuzhiyun 			      unsigned short *fw_on_ctlr_arch_id,
1115*4882a593Smuzhiyun 			      unsigned short *fw_on_ctlr_branch,
1116*4882a593Smuzhiyun 			      unsigned short *fw_on_ctlr_build,
1117*4882a593Smuzhiyun 			      u32 *init_connect_result)
1118*4882a593Smuzhiyun {
1119*4882a593Smuzhiyun 	TW_Command_Full *full_command_packet;
1120*4882a593Smuzhiyun 	TW_Initconnect *tw_initconnect;
1121*4882a593Smuzhiyun 	int request_id = 0, retval = 1;
1122*4882a593Smuzhiyun 
1123*4882a593Smuzhiyun 	/* Initialize InitConnection command packet */
1124*4882a593Smuzhiyun 	full_command_packet = tw_dev->command_packet_virt[request_id];
1125*4882a593Smuzhiyun 	memset(full_command_packet, 0, sizeof(TW_Command_Full));
1126*4882a593Smuzhiyun 	full_command_packet->header.header_desc.size_header = 128;
1127*4882a593Smuzhiyun 
1128*4882a593Smuzhiyun 	tw_initconnect = (TW_Initconnect *)&full_command_packet->command.oldcommand;
1129*4882a593Smuzhiyun 	tw_initconnect->opcode__reserved = TW_OPRES_IN(0, TW_OP_INIT_CONNECTION);
1130*4882a593Smuzhiyun 	tw_initconnect->request_id = request_id;
1131*4882a593Smuzhiyun 	tw_initconnect->message_credits = cpu_to_le16(message_credits);
1132*4882a593Smuzhiyun 	tw_initconnect->features = set_features;
1133*4882a593Smuzhiyun 
1134*4882a593Smuzhiyun 	/* Turn on 64-bit sgl support if we need to */
1135*4882a593Smuzhiyun 	tw_initconnect->features |= sizeof(dma_addr_t) > 4 ? 1 : 0;
1136*4882a593Smuzhiyun 
1137*4882a593Smuzhiyun 	tw_initconnect->features = cpu_to_le32(tw_initconnect->features);
1138*4882a593Smuzhiyun 
1139*4882a593Smuzhiyun 	if (set_features & TW_EXTENDED_INIT_CONNECT) {
1140*4882a593Smuzhiyun 		tw_initconnect->size = TW_INIT_COMMAND_PACKET_SIZE_EXTENDED;
1141*4882a593Smuzhiyun 		tw_initconnect->fw_srl = cpu_to_le16(current_fw_srl);
1142*4882a593Smuzhiyun 		tw_initconnect->fw_arch_id = cpu_to_le16(current_fw_arch_id);
1143*4882a593Smuzhiyun 		tw_initconnect->fw_branch = cpu_to_le16(current_fw_branch);
1144*4882a593Smuzhiyun 		tw_initconnect->fw_build = cpu_to_le16(current_fw_build);
1145*4882a593Smuzhiyun 	} else
1146*4882a593Smuzhiyun 		tw_initconnect->size = TW_INIT_COMMAND_PACKET_SIZE;
1147*4882a593Smuzhiyun 
1148*4882a593Smuzhiyun 	/* Send command packet to the board */
1149*4882a593Smuzhiyun 	twa_post_command_packet(tw_dev, request_id, 1);
1150*4882a593Smuzhiyun 
1151*4882a593Smuzhiyun 	/* Poll for completion */
1152*4882a593Smuzhiyun 	if (twa_poll_response(tw_dev, request_id, 30)) {
1153*4882a593Smuzhiyun 		TW_PRINTK(tw_dev->host, TW_DRIVER, 0x15, "No valid response during init connection");
1154*4882a593Smuzhiyun 	} else {
1155*4882a593Smuzhiyun 		if (set_features & TW_EXTENDED_INIT_CONNECT) {
1156*4882a593Smuzhiyun 			*fw_on_ctlr_srl = le16_to_cpu(tw_initconnect->fw_srl);
1157*4882a593Smuzhiyun 			*fw_on_ctlr_arch_id = le16_to_cpu(tw_initconnect->fw_arch_id);
1158*4882a593Smuzhiyun 			*fw_on_ctlr_branch = le16_to_cpu(tw_initconnect->fw_branch);
1159*4882a593Smuzhiyun 			*fw_on_ctlr_build = le16_to_cpu(tw_initconnect->fw_build);
1160*4882a593Smuzhiyun 			*init_connect_result = le32_to_cpu(tw_initconnect->result);
1161*4882a593Smuzhiyun 		}
1162*4882a593Smuzhiyun 		retval = 0;
1163*4882a593Smuzhiyun 	}
1164*4882a593Smuzhiyun 
1165*4882a593Smuzhiyun 	tw_dev->posted_request_count--;
1166*4882a593Smuzhiyun 	tw_dev->state[request_id] = TW_S_INITIAL;
1167*4882a593Smuzhiyun 
1168*4882a593Smuzhiyun 	return retval;
1169*4882a593Smuzhiyun } /* End twa_initconnection() */
1170*4882a593Smuzhiyun 
1171*4882a593Smuzhiyun /* This function will initialize the fields of a device extension */
twa_initialize_device_extension(TW_Device_Extension * tw_dev)1172*4882a593Smuzhiyun static int twa_initialize_device_extension(TW_Device_Extension *tw_dev)
1173*4882a593Smuzhiyun {
1174*4882a593Smuzhiyun 	int i, retval = 1;
1175*4882a593Smuzhiyun 
1176*4882a593Smuzhiyun 	/* Initialize command packet buffers */
1177*4882a593Smuzhiyun 	if (twa_allocate_memory(tw_dev, sizeof(TW_Command_Full), 0)) {
1178*4882a593Smuzhiyun 		TW_PRINTK(tw_dev->host, TW_DRIVER, 0x16, "Command packet memory allocation failed");
1179*4882a593Smuzhiyun 		goto out;
1180*4882a593Smuzhiyun 	}
1181*4882a593Smuzhiyun 
1182*4882a593Smuzhiyun 	/* Initialize generic buffer */
1183*4882a593Smuzhiyun 	if (twa_allocate_memory(tw_dev, TW_SECTOR_SIZE, 1)) {
1184*4882a593Smuzhiyun 		TW_PRINTK(tw_dev->host, TW_DRIVER, 0x17, "Generic memory allocation failed");
1185*4882a593Smuzhiyun 		goto out;
1186*4882a593Smuzhiyun 	}
1187*4882a593Smuzhiyun 
1188*4882a593Smuzhiyun 	/* Allocate event info space */
1189*4882a593Smuzhiyun 	tw_dev->event_queue[0] = kcalloc(TW_Q_LENGTH, sizeof(TW_Event), GFP_KERNEL);
1190*4882a593Smuzhiyun 	if (!tw_dev->event_queue[0]) {
1191*4882a593Smuzhiyun 		TW_PRINTK(tw_dev->host, TW_DRIVER, 0x18, "Event info memory allocation failed");
1192*4882a593Smuzhiyun 		goto out;
1193*4882a593Smuzhiyun 	}
1194*4882a593Smuzhiyun 
1195*4882a593Smuzhiyun 
1196*4882a593Smuzhiyun 	for (i = 0; i < TW_Q_LENGTH; i++) {
1197*4882a593Smuzhiyun 		tw_dev->event_queue[i] = (TW_Event *)((unsigned char *)tw_dev->event_queue[0] + (i * sizeof(TW_Event)));
1198*4882a593Smuzhiyun 		tw_dev->free_queue[i] = i;
1199*4882a593Smuzhiyun 		tw_dev->state[i] = TW_S_INITIAL;
1200*4882a593Smuzhiyun 	}
1201*4882a593Smuzhiyun 
1202*4882a593Smuzhiyun 	tw_dev->pending_head = TW_Q_START;
1203*4882a593Smuzhiyun 	tw_dev->pending_tail = TW_Q_START;
1204*4882a593Smuzhiyun 	tw_dev->free_head = TW_Q_START;
1205*4882a593Smuzhiyun 	tw_dev->free_tail = TW_Q_START;
1206*4882a593Smuzhiyun 	tw_dev->error_sequence_id = 1;
1207*4882a593Smuzhiyun 	tw_dev->chrdev_request_id = TW_IOCTL_CHRDEV_FREE;
1208*4882a593Smuzhiyun 
1209*4882a593Smuzhiyun 	mutex_init(&tw_dev->ioctl_lock);
1210*4882a593Smuzhiyun 	init_waitqueue_head(&tw_dev->ioctl_wqueue);
1211*4882a593Smuzhiyun 
1212*4882a593Smuzhiyun 	retval = 0;
1213*4882a593Smuzhiyun out:
1214*4882a593Smuzhiyun 	return retval;
1215*4882a593Smuzhiyun } /* End twa_initialize_device_extension() */
1216*4882a593Smuzhiyun 
1217*4882a593Smuzhiyun /* This function is the interrupt service routine */
twa_interrupt(int irq,void * dev_instance)1218*4882a593Smuzhiyun static irqreturn_t twa_interrupt(int irq, void *dev_instance)
1219*4882a593Smuzhiyun {
1220*4882a593Smuzhiyun 	int request_id, error = 0;
1221*4882a593Smuzhiyun 	u32 status_reg_value;
1222*4882a593Smuzhiyun 	TW_Response_Queue response_que;
1223*4882a593Smuzhiyun 	TW_Command_Full *full_command_packet;
1224*4882a593Smuzhiyun 	TW_Device_Extension *tw_dev = (TW_Device_Extension *)dev_instance;
1225*4882a593Smuzhiyun 	int handled = 0;
1226*4882a593Smuzhiyun 
1227*4882a593Smuzhiyun 	/* Get the per adapter lock */
1228*4882a593Smuzhiyun 	spin_lock(tw_dev->host->host_lock);
1229*4882a593Smuzhiyun 
1230*4882a593Smuzhiyun 	/* Read the registers */
1231*4882a593Smuzhiyun 	status_reg_value = readl(TW_STATUS_REG_ADDR(tw_dev));
1232*4882a593Smuzhiyun 
1233*4882a593Smuzhiyun 	/* Check if this is our interrupt, otherwise bail */
1234*4882a593Smuzhiyun 	if (!(status_reg_value & TW_STATUS_VALID_INTERRUPT))
1235*4882a593Smuzhiyun 		goto twa_interrupt_bail;
1236*4882a593Smuzhiyun 
1237*4882a593Smuzhiyun 	handled = 1;
1238*4882a593Smuzhiyun 
1239*4882a593Smuzhiyun 	/* If we are resetting, bail */
1240*4882a593Smuzhiyun 	if (test_bit(TW_IN_RESET, &tw_dev->flags))
1241*4882a593Smuzhiyun 		goto twa_interrupt_bail;
1242*4882a593Smuzhiyun 
1243*4882a593Smuzhiyun 	/* Check controller for errors */
1244*4882a593Smuzhiyun 	if (twa_check_bits(status_reg_value)) {
1245*4882a593Smuzhiyun 		if (twa_decode_bits(tw_dev, status_reg_value)) {
1246*4882a593Smuzhiyun 			TW_CLEAR_ALL_INTERRUPTS(tw_dev);
1247*4882a593Smuzhiyun 			goto twa_interrupt_bail;
1248*4882a593Smuzhiyun 		}
1249*4882a593Smuzhiyun 	}
1250*4882a593Smuzhiyun 
1251*4882a593Smuzhiyun 	/* Handle host interrupt */
1252*4882a593Smuzhiyun 	if (status_reg_value & TW_STATUS_HOST_INTERRUPT)
1253*4882a593Smuzhiyun 		TW_CLEAR_HOST_INTERRUPT(tw_dev);
1254*4882a593Smuzhiyun 
1255*4882a593Smuzhiyun 	/* Handle attention interrupt */
1256*4882a593Smuzhiyun 	if (status_reg_value & TW_STATUS_ATTENTION_INTERRUPT) {
1257*4882a593Smuzhiyun 		TW_CLEAR_ATTENTION_INTERRUPT(tw_dev);
1258*4882a593Smuzhiyun 		if (!(test_and_set_bit(TW_IN_ATTENTION_LOOP, &tw_dev->flags))) {
1259*4882a593Smuzhiyun 			twa_get_request_id(tw_dev, &request_id);
1260*4882a593Smuzhiyun 
1261*4882a593Smuzhiyun 			error = twa_aen_read_queue(tw_dev, request_id);
1262*4882a593Smuzhiyun 			if (error) {
1263*4882a593Smuzhiyun 				tw_dev->state[request_id] = TW_S_COMPLETED;
1264*4882a593Smuzhiyun 				twa_free_request_id(tw_dev, request_id);
1265*4882a593Smuzhiyun 				clear_bit(TW_IN_ATTENTION_LOOP, &tw_dev->flags);
1266*4882a593Smuzhiyun 			}
1267*4882a593Smuzhiyun 		}
1268*4882a593Smuzhiyun 	}
1269*4882a593Smuzhiyun 
1270*4882a593Smuzhiyun 	/* Handle command interrupt */
1271*4882a593Smuzhiyun 	if (status_reg_value & TW_STATUS_COMMAND_INTERRUPT) {
1272*4882a593Smuzhiyun 		TW_MASK_COMMAND_INTERRUPT(tw_dev);
1273*4882a593Smuzhiyun 		/* Drain as many pending commands as we can */
1274*4882a593Smuzhiyun 		while (tw_dev->pending_request_count > 0) {
1275*4882a593Smuzhiyun 			request_id = tw_dev->pending_queue[tw_dev->pending_head];
1276*4882a593Smuzhiyun 			if (tw_dev->state[request_id] != TW_S_PENDING) {
1277*4882a593Smuzhiyun 				TW_PRINTK(tw_dev->host, TW_DRIVER, 0x19, "Found request id that wasn't pending");
1278*4882a593Smuzhiyun 				TW_CLEAR_ALL_INTERRUPTS(tw_dev);
1279*4882a593Smuzhiyun 				goto twa_interrupt_bail;
1280*4882a593Smuzhiyun 			}
1281*4882a593Smuzhiyun 			if (twa_post_command_packet(tw_dev, request_id, 1)==0) {
1282*4882a593Smuzhiyun 				tw_dev->pending_head = (tw_dev->pending_head + 1) % TW_Q_LENGTH;
1283*4882a593Smuzhiyun 				tw_dev->pending_request_count--;
1284*4882a593Smuzhiyun 			} else {
1285*4882a593Smuzhiyun 				/* If we get here, we will continue re-posting on the next command interrupt */
1286*4882a593Smuzhiyun 				break;
1287*4882a593Smuzhiyun 			}
1288*4882a593Smuzhiyun 		}
1289*4882a593Smuzhiyun 	}
1290*4882a593Smuzhiyun 
1291*4882a593Smuzhiyun 	/* Handle response interrupt */
1292*4882a593Smuzhiyun 	if (status_reg_value & TW_STATUS_RESPONSE_INTERRUPT) {
1293*4882a593Smuzhiyun 
1294*4882a593Smuzhiyun 		/* Drain the response queue from the board */
1295*4882a593Smuzhiyun 		while ((status_reg_value & TW_STATUS_RESPONSE_QUEUE_EMPTY) == 0) {
1296*4882a593Smuzhiyun 			/* Complete the response */
1297*4882a593Smuzhiyun 			response_que.value = readl(TW_RESPONSE_QUEUE_REG_ADDR(tw_dev));
1298*4882a593Smuzhiyun 			request_id = TW_RESID_OUT(response_que.response_id);
1299*4882a593Smuzhiyun 			full_command_packet = tw_dev->command_packet_virt[request_id];
1300*4882a593Smuzhiyun 			error = 0;
1301*4882a593Smuzhiyun 			/* Check for command packet errors */
1302*4882a593Smuzhiyun 			if (full_command_packet->command.newcommand.status != 0) {
1303*4882a593Smuzhiyun 				if (tw_dev->srb[request_id] != NULL) {
1304*4882a593Smuzhiyun 					error = twa_fill_sense(tw_dev, request_id, 1, 1);
1305*4882a593Smuzhiyun 				} else {
1306*4882a593Smuzhiyun 					/* Skip ioctl error prints */
1307*4882a593Smuzhiyun 					if (request_id != tw_dev->chrdev_request_id) {
1308*4882a593Smuzhiyun 						error = twa_fill_sense(tw_dev, request_id, 0, 1);
1309*4882a593Smuzhiyun 					}
1310*4882a593Smuzhiyun 				}
1311*4882a593Smuzhiyun 			}
1312*4882a593Smuzhiyun 
1313*4882a593Smuzhiyun 			/* Check for correct state */
1314*4882a593Smuzhiyun 			if (tw_dev->state[request_id] != TW_S_POSTED) {
1315*4882a593Smuzhiyun 				if (tw_dev->srb[request_id] != NULL) {
1316*4882a593Smuzhiyun 					TW_PRINTK(tw_dev->host, TW_DRIVER, 0x1a, "Received a request id that wasn't posted");
1317*4882a593Smuzhiyun 					TW_CLEAR_ALL_INTERRUPTS(tw_dev);
1318*4882a593Smuzhiyun 					goto twa_interrupt_bail;
1319*4882a593Smuzhiyun 				}
1320*4882a593Smuzhiyun 			}
1321*4882a593Smuzhiyun 
1322*4882a593Smuzhiyun 			/* Check for internal command completion */
1323*4882a593Smuzhiyun 			if (tw_dev->srb[request_id] == NULL) {
1324*4882a593Smuzhiyun 				if (request_id != tw_dev->chrdev_request_id) {
1325*4882a593Smuzhiyun 					if (twa_aen_complete(tw_dev, request_id))
1326*4882a593Smuzhiyun 						TW_PRINTK(tw_dev->host, TW_DRIVER, 0x1b, "Error completing AEN during attention interrupt");
1327*4882a593Smuzhiyun 				} else {
1328*4882a593Smuzhiyun 					tw_dev->chrdev_request_id = TW_IOCTL_CHRDEV_FREE;
1329*4882a593Smuzhiyun 					wake_up(&tw_dev->ioctl_wqueue);
1330*4882a593Smuzhiyun 				}
1331*4882a593Smuzhiyun 			} else {
1332*4882a593Smuzhiyun 				struct scsi_cmnd *cmd;
1333*4882a593Smuzhiyun 
1334*4882a593Smuzhiyun 				cmd = tw_dev->srb[request_id];
1335*4882a593Smuzhiyun 
1336*4882a593Smuzhiyun 				twa_scsiop_execute_scsi_complete(tw_dev, request_id);
1337*4882a593Smuzhiyun 				/* If no error command was a success */
1338*4882a593Smuzhiyun 				if (error == 0) {
1339*4882a593Smuzhiyun 					cmd->result = (DID_OK << 16);
1340*4882a593Smuzhiyun 				}
1341*4882a593Smuzhiyun 
1342*4882a593Smuzhiyun 				/* If error, command failed */
1343*4882a593Smuzhiyun 				if (error == 1) {
1344*4882a593Smuzhiyun 					/* Ask for a host reset */
1345*4882a593Smuzhiyun 					cmd->result = (DID_OK << 16) | (CHECK_CONDITION << 1);
1346*4882a593Smuzhiyun 				}
1347*4882a593Smuzhiyun 
1348*4882a593Smuzhiyun 				/* Report residual bytes for single sgl */
1349*4882a593Smuzhiyun 				if ((scsi_sg_count(cmd) <= 1) && (full_command_packet->command.newcommand.status == 0)) {
1350*4882a593Smuzhiyun 					if (full_command_packet->command.newcommand.sg_list[0].length < scsi_bufflen(tw_dev->srb[request_id]))
1351*4882a593Smuzhiyun 						scsi_set_resid(cmd, scsi_bufflen(cmd) - full_command_packet->command.newcommand.sg_list[0].length);
1352*4882a593Smuzhiyun 				}
1353*4882a593Smuzhiyun 
1354*4882a593Smuzhiyun 				/* Now complete the io */
1355*4882a593Smuzhiyun 				if (twa_command_mapped(cmd))
1356*4882a593Smuzhiyun 					scsi_dma_unmap(cmd);
1357*4882a593Smuzhiyun 				cmd->scsi_done(cmd);
1358*4882a593Smuzhiyun 				tw_dev->state[request_id] = TW_S_COMPLETED;
1359*4882a593Smuzhiyun 				twa_free_request_id(tw_dev, request_id);
1360*4882a593Smuzhiyun 				tw_dev->posted_request_count--;
1361*4882a593Smuzhiyun 			}
1362*4882a593Smuzhiyun 
1363*4882a593Smuzhiyun 			/* Check for valid status after each drain */
1364*4882a593Smuzhiyun 			status_reg_value = readl(TW_STATUS_REG_ADDR(tw_dev));
1365*4882a593Smuzhiyun 			if (twa_check_bits(status_reg_value)) {
1366*4882a593Smuzhiyun 				if (twa_decode_bits(tw_dev, status_reg_value)) {
1367*4882a593Smuzhiyun 					TW_CLEAR_ALL_INTERRUPTS(tw_dev);
1368*4882a593Smuzhiyun 					goto twa_interrupt_bail;
1369*4882a593Smuzhiyun 				}
1370*4882a593Smuzhiyun 			}
1371*4882a593Smuzhiyun 		}
1372*4882a593Smuzhiyun 	}
1373*4882a593Smuzhiyun 
1374*4882a593Smuzhiyun twa_interrupt_bail:
1375*4882a593Smuzhiyun 	spin_unlock(tw_dev->host->host_lock);
1376*4882a593Smuzhiyun 	return IRQ_RETVAL(handled);
1377*4882a593Smuzhiyun } /* End twa_interrupt() */
1378*4882a593Smuzhiyun 
1379*4882a593Smuzhiyun /* This function will load the request id and various sgls for ioctls */
twa_load_sgl(TW_Device_Extension * tw_dev,TW_Command_Full * full_command_packet,int request_id,dma_addr_t dma_handle,int length)1380*4882a593Smuzhiyun static void twa_load_sgl(TW_Device_Extension *tw_dev, TW_Command_Full *full_command_packet, int request_id, dma_addr_t dma_handle, int length)
1381*4882a593Smuzhiyun {
1382*4882a593Smuzhiyun 	TW_Command *oldcommand;
1383*4882a593Smuzhiyun 	TW_Command_Apache *newcommand;
1384*4882a593Smuzhiyun 	TW_SG_Entry *sgl;
1385*4882a593Smuzhiyun 	unsigned int pae = 0;
1386*4882a593Smuzhiyun 
1387*4882a593Smuzhiyun 	if ((sizeof(long) < 8) && (sizeof(dma_addr_t) > 4))
1388*4882a593Smuzhiyun 		pae = 1;
1389*4882a593Smuzhiyun 
1390*4882a593Smuzhiyun 	if (TW_OP_OUT(full_command_packet->command.newcommand.opcode__reserved) == TW_OP_EXECUTE_SCSI) {
1391*4882a593Smuzhiyun 		newcommand = &full_command_packet->command.newcommand;
1392*4882a593Smuzhiyun 		newcommand->request_id__lunl =
1393*4882a593Smuzhiyun 			cpu_to_le16(TW_REQ_LUN_IN(TW_LUN_OUT(newcommand->request_id__lunl), request_id));
1394*4882a593Smuzhiyun 		if (length) {
1395*4882a593Smuzhiyun 			newcommand->sg_list[0].address = TW_CPU_TO_SGL(dma_handle + sizeof(TW_Ioctl_Buf_Apache) - 1);
1396*4882a593Smuzhiyun 			newcommand->sg_list[0].length = cpu_to_le32(length);
1397*4882a593Smuzhiyun 		}
1398*4882a593Smuzhiyun 		newcommand->sgl_entries__lunh =
1399*4882a593Smuzhiyun 			cpu_to_le16(TW_REQ_LUN_IN(TW_LUN_OUT(newcommand->sgl_entries__lunh), length ? 1 : 0));
1400*4882a593Smuzhiyun 	} else {
1401*4882a593Smuzhiyun 		oldcommand = &full_command_packet->command.oldcommand;
1402*4882a593Smuzhiyun 		oldcommand->request_id = request_id;
1403*4882a593Smuzhiyun 
1404*4882a593Smuzhiyun 		if (TW_SGL_OUT(oldcommand->opcode__sgloffset)) {
1405*4882a593Smuzhiyun 			/* Load the sg list */
1406*4882a593Smuzhiyun 			if (tw_dev->tw_pci_dev->device == PCI_DEVICE_ID_3WARE_9690SA)
1407*4882a593Smuzhiyun 				sgl = (TW_SG_Entry *)((u32 *)oldcommand+oldcommand->size - (sizeof(TW_SG_Entry)/4) + pae);
1408*4882a593Smuzhiyun 			else
1409*4882a593Smuzhiyun 				sgl = (TW_SG_Entry *)((u32 *)oldcommand+TW_SGL_OUT(oldcommand->opcode__sgloffset));
1410*4882a593Smuzhiyun 			sgl->address = TW_CPU_TO_SGL(dma_handle + sizeof(TW_Ioctl_Buf_Apache) - 1);
1411*4882a593Smuzhiyun 			sgl->length = cpu_to_le32(length);
1412*4882a593Smuzhiyun 
1413*4882a593Smuzhiyun 			oldcommand->size += pae;
1414*4882a593Smuzhiyun 		}
1415*4882a593Smuzhiyun 	}
1416*4882a593Smuzhiyun } /* End twa_load_sgl() */
1417*4882a593Smuzhiyun 
1418*4882a593Smuzhiyun /* This function will poll for a response interrupt of a request */
twa_poll_response(TW_Device_Extension * tw_dev,int request_id,int seconds)1419*4882a593Smuzhiyun static int twa_poll_response(TW_Device_Extension *tw_dev, int request_id, int seconds)
1420*4882a593Smuzhiyun {
1421*4882a593Smuzhiyun 	int retval = 1, found = 0, response_request_id;
1422*4882a593Smuzhiyun 	TW_Response_Queue response_queue;
1423*4882a593Smuzhiyun 	TW_Command_Full *full_command_packet = tw_dev->command_packet_virt[request_id];
1424*4882a593Smuzhiyun 
1425*4882a593Smuzhiyun 	if (twa_poll_status_gone(tw_dev, TW_STATUS_RESPONSE_QUEUE_EMPTY, seconds) == 0) {
1426*4882a593Smuzhiyun 		response_queue.value = readl(TW_RESPONSE_QUEUE_REG_ADDR(tw_dev));
1427*4882a593Smuzhiyun 		response_request_id = TW_RESID_OUT(response_queue.response_id);
1428*4882a593Smuzhiyun 		if (request_id != response_request_id) {
1429*4882a593Smuzhiyun 			TW_PRINTK(tw_dev->host, TW_DRIVER, 0x1e, "Found unexpected request id while polling for response");
1430*4882a593Smuzhiyun 			goto out;
1431*4882a593Smuzhiyun 		}
1432*4882a593Smuzhiyun 		if (TW_OP_OUT(full_command_packet->command.newcommand.opcode__reserved) == TW_OP_EXECUTE_SCSI) {
1433*4882a593Smuzhiyun 			if (full_command_packet->command.newcommand.status != 0) {
1434*4882a593Smuzhiyun 				/* bad response */
1435*4882a593Smuzhiyun 				twa_fill_sense(tw_dev, request_id, 0, 0);
1436*4882a593Smuzhiyun 				goto out;
1437*4882a593Smuzhiyun 			}
1438*4882a593Smuzhiyun 			found = 1;
1439*4882a593Smuzhiyun 		} else {
1440*4882a593Smuzhiyun 			if (full_command_packet->command.oldcommand.status != 0) {
1441*4882a593Smuzhiyun 				/* bad response */
1442*4882a593Smuzhiyun 				twa_fill_sense(tw_dev, request_id, 0, 0);
1443*4882a593Smuzhiyun 				goto out;
1444*4882a593Smuzhiyun 			}
1445*4882a593Smuzhiyun 			found = 1;
1446*4882a593Smuzhiyun 		}
1447*4882a593Smuzhiyun 	}
1448*4882a593Smuzhiyun 
1449*4882a593Smuzhiyun 	if (found)
1450*4882a593Smuzhiyun 		retval = 0;
1451*4882a593Smuzhiyun out:
1452*4882a593Smuzhiyun 	return retval;
1453*4882a593Smuzhiyun } /* End twa_poll_response() */
1454*4882a593Smuzhiyun 
1455*4882a593Smuzhiyun /* This function will poll the status register for a flag */
twa_poll_status(TW_Device_Extension * tw_dev,u32 flag,int seconds)1456*4882a593Smuzhiyun static int twa_poll_status(TW_Device_Extension *tw_dev, u32 flag, int seconds)
1457*4882a593Smuzhiyun {
1458*4882a593Smuzhiyun 	u32 status_reg_value;
1459*4882a593Smuzhiyun 	unsigned long before;
1460*4882a593Smuzhiyun 	int retval = 1;
1461*4882a593Smuzhiyun 
1462*4882a593Smuzhiyun 	status_reg_value = readl(TW_STATUS_REG_ADDR(tw_dev));
1463*4882a593Smuzhiyun 	before = jiffies;
1464*4882a593Smuzhiyun 
1465*4882a593Smuzhiyun 	if (twa_check_bits(status_reg_value))
1466*4882a593Smuzhiyun 		twa_decode_bits(tw_dev, status_reg_value);
1467*4882a593Smuzhiyun 
1468*4882a593Smuzhiyun 	while ((status_reg_value & flag) != flag) {
1469*4882a593Smuzhiyun 		status_reg_value = readl(TW_STATUS_REG_ADDR(tw_dev));
1470*4882a593Smuzhiyun 
1471*4882a593Smuzhiyun 		if (twa_check_bits(status_reg_value))
1472*4882a593Smuzhiyun 			twa_decode_bits(tw_dev, status_reg_value);
1473*4882a593Smuzhiyun 
1474*4882a593Smuzhiyun 		if (time_after(jiffies, before + HZ * seconds))
1475*4882a593Smuzhiyun 			goto out;
1476*4882a593Smuzhiyun 
1477*4882a593Smuzhiyun 		msleep(50);
1478*4882a593Smuzhiyun 	}
1479*4882a593Smuzhiyun 	retval = 0;
1480*4882a593Smuzhiyun out:
1481*4882a593Smuzhiyun 	return retval;
1482*4882a593Smuzhiyun } /* End twa_poll_status() */
1483*4882a593Smuzhiyun 
1484*4882a593Smuzhiyun /* This function will poll the status register for disappearance of a flag */
twa_poll_status_gone(TW_Device_Extension * tw_dev,u32 flag,int seconds)1485*4882a593Smuzhiyun static int twa_poll_status_gone(TW_Device_Extension *tw_dev, u32 flag, int seconds)
1486*4882a593Smuzhiyun {
1487*4882a593Smuzhiyun 	u32 status_reg_value;
1488*4882a593Smuzhiyun 	unsigned long before;
1489*4882a593Smuzhiyun 	int retval = 1;
1490*4882a593Smuzhiyun 
1491*4882a593Smuzhiyun 	status_reg_value = readl(TW_STATUS_REG_ADDR(tw_dev));
1492*4882a593Smuzhiyun 	before = jiffies;
1493*4882a593Smuzhiyun 
1494*4882a593Smuzhiyun 	if (twa_check_bits(status_reg_value))
1495*4882a593Smuzhiyun 		twa_decode_bits(tw_dev, status_reg_value);
1496*4882a593Smuzhiyun 
1497*4882a593Smuzhiyun 	while ((status_reg_value & flag) != 0) {
1498*4882a593Smuzhiyun 		status_reg_value = readl(TW_STATUS_REG_ADDR(tw_dev));
1499*4882a593Smuzhiyun 		if (twa_check_bits(status_reg_value))
1500*4882a593Smuzhiyun 			twa_decode_bits(tw_dev, status_reg_value);
1501*4882a593Smuzhiyun 
1502*4882a593Smuzhiyun 		if (time_after(jiffies, before + HZ * seconds))
1503*4882a593Smuzhiyun 			goto out;
1504*4882a593Smuzhiyun 
1505*4882a593Smuzhiyun 		msleep(50);
1506*4882a593Smuzhiyun 	}
1507*4882a593Smuzhiyun 	retval = 0;
1508*4882a593Smuzhiyun out:
1509*4882a593Smuzhiyun 	return retval;
1510*4882a593Smuzhiyun } /* End twa_poll_status_gone() */
1511*4882a593Smuzhiyun 
1512*4882a593Smuzhiyun /* This function will attempt to post a command packet to the board */
twa_post_command_packet(TW_Device_Extension * tw_dev,int request_id,char internal)1513*4882a593Smuzhiyun static int twa_post_command_packet(TW_Device_Extension *tw_dev, int request_id, char internal)
1514*4882a593Smuzhiyun {
1515*4882a593Smuzhiyun 	u32 status_reg_value;
1516*4882a593Smuzhiyun 	dma_addr_t command_que_value;
1517*4882a593Smuzhiyun 	int retval = 1;
1518*4882a593Smuzhiyun 
1519*4882a593Smuzhiyun 	command_que_value = tw_dev->command_packet_phys[request_id];
1520*4882a593Smuzhiyun 
1521*4882a593Smuzhiyun 	/* For 9650SE write low 4 bytes first */
1522*4882a593Smuzhiyun 	if ((tw_dev->tw_pci_dev->device == PCI_DEVICE_ID_3WARE_9650SE) ||
1523*4882a593Smuzhiyun 	    (tw_dev->tw_pci_dev->device == PCI_DEVICE_ID_3WARE_9690SA)) {
1524*4882a593Smuzhiyun 		command_que_value += TW_COMMAND_OFFSET;
1525*4882a593Smuzhiyun 		writel((u32)command_que_value, TW_COMMAND_QUEUE_REG_ADDR_LARGE(tw_dev));
1526*4882a593Smuzhiyun 	}
1527*4882a593Smuzhiyun 
1528*4882a593Smuzhiyun 	status_reg_value = readl(TW_STATUS_REG_ADDR(tw_dev));
1529*4882a593Smuzhiyun 
1530*4882a593Smuzhiyun 	if (twa_check_bits(status_reg_value))
1531*4882a593Smuzhiyun 		twa_decode_bits(tw_dev, status_reg_value);
1532*4882a593Smuzhiyun 
1533*4882a593Smuzhiyun 	if (((tw_dev->pending_request_count > 0) && (tw_dev->state[request_id] != TW_S_PENDING)) || (status_reg_value & TW_STATUS_COMMAND_QUEUE_FULL)) {
1534*4882a593Smuzhiyun 
1535*4882a593Smuzhiyun 		/* Only pend internal driver commands */
1536*4882a593Smuzhiyun 		if (!internal) {
1537*4882a593Smuzhiyun 			retval = SCSI_MLQUEUE_HOST_BUSY;
1538*4882a593Smuzhiyun 			goto out;
1539*4882a593Smuzhiyun 		}
1540*4882a593Smuzhiyun 
1541*4882a593Smuzhiyun 		/* Couldn't post the command packet, so we do it later */
1542*4882a593Smuzhiyun 		if (tw_dev->state[request_id] != TW_S_PENDING) {
1543*4882a593Smuzhiyun 			tw_dev->state[request_id] = TW_S_PENDING;
1544*4882a593Smuzhiyun 			tw_dev->pending_request_count++;
1545*4882a593Smuzhiyun 			if (tw_dev->pending_request_count > tw_dev->max_pending_request_count) {
1546*4882a593Smuzhiyun 				tw_dev->max_pending_request_count = tw_dev->pending_request_count;
1547*4882a593Smuzhiyun 			}
1548*4882a593Smuzhiyun 			tw_dev->pending_queue[tw_dev->pending_tail] = request_id;
1549*4882a593Smuzhiyun 			tw_dev->pending_tail = (tw_dev->pending_tail + 1) % TW_Q_LENGTH;
1550*4882a593Smuzhiyun 		}
1551*4882a593Smuzhiyun 		TW_UNMASK_COMMAND_INTERRUPT(tw_dev);
1552*4882a593Smuzhiyun 		goto out;
1553*4882a593Smuzhiyun 	} else {
1554*4882a593Smuzhiyun 		if ((tw_dev->tw_pci_dev->device == PCI_DEVICE_ID_3WARE_9650SE) ||
1555*4882a593Smuzhiyun 		    (tw_dev->tw_pci_dev->device == PCI_DEVICE_ID_3WARE_9690SA)) {
1556*4882a593Smuzhiyun 			/* Now write upper 4 bytes */
1557*4882a593Smuzhiyun 			writel((u32)((u64)command_que_value >> 32), TW_COMMAND_QUEUE_REG_ADDR_LARGE(tw_dev) + 0x4);
1558*4882a593Smuzhiyun 		} else {
1559*4882a593Smuzhiyun 			if (sizeof(dma_addr_t) > 4) {
1560*4882a593Smuzhiyun 				command_que_value += TW_COMMAND_OFFSET;
1561*4882a593Smuzhiyun 				writel((u32)command_que_value, TW_COMMAND_QUEUE_REG_ADDR(tw_dev));
1562*4882a593Smuzhiyun 				writel((u32)((u64)command_que_value >> 32), TW_COMMAND_QUEUE_REG_ADDR(tw_dev) + 0x4);
1563*4882a593Smuzhiyun 			} else {
1564*4882a593Smuzhiyun 				writel(TW_COMMAND_OFFSET + command_que_value, TW_COMMAND_QUEUE_REG_ADDR(tw_dev));
1565*4882a593Smuzhiyun 			}
1566*4882a593Smuzhiyun 		}
1567*4882a593Smuzhiyun 		tw_dev->state[request_id] = TW_S_POSTED;
1568*4882a593Smuzhiyun 		tw_dev->posted_request_count++;
1569*4882a593Smuzhiyun 		if (tw_dev->posted_request_count > tw_dev->max_posted_request_count) {
1570*4882a593Smuzhiyun 			tw_dev->max_posted_request_count = tw_dev->posted_request_count;
1571*4882a593Smuzhiyun 		}
1572*4882a593Smuzhiyun 	}
1573*4882a593Smuzhiyun 	retval = 0;
1574*4882a593Smuzhiyun out:
1575*4882a593Smuzhiyun 	return retval;
1576*4882a593Smuzhiyun } /* End twa_post_command_packet() */
1577*4882a593Smuzhiyun 
1578*4882a593Smuzhiyun /* This function will reset a device extension */
twa_reset_device_extension(TW_Device_Extension * tw_dev)1579*4882a593Smuzhiyun static int twa_reset_device_extension(TW_Device_Extension *tw_dev)
1580*4882a593Smuzhiyun {
1581*4882a593Smuzhiyun 	int i = 0;
1582*4882a593Smuzhiyun 	int retval = 1;
1583*4882a593Smuzhiyun 	unsigned long flags = 0;
1584*4882a593Smuzhiyun 
1585*4882a593Smuzhiyun 	set_bit(TW_IN_RESET, &tw_dev->flags);
1586*4882a593Smuzhiyun 	TW_DISABLE_INTERRUPTS(tw_dev);
1587*4882a593Smuzhiyun 	TW_MASK_COMMAND_INTERRUPT(tw_dev);
1588*4882a593Smuzhiyun 	spin_lock_irqsave(tw_dev->host->host_lock, flags);
1589*4882a593Smuzhiyun 
1590*4882a593Smuzhiyun 	/* Abort all requests that are in progress */
1591*4882a593Smuzhiyun 	for (i = 0; i < TW_Q_LENGTH; i++) {
1592*4882a593Smuzhiyun 		if ((tw_dev->state[i] != TW_S_FINISHED) &&
1593*4882a593Smuzhiyun 		    (tw_dev->state[i] != TW_S_INITIAL) &&
1594*4882a593Smuzhiyun 		    (tw_dev->state[i] != TW_S_COMPLETED)) {
1595*4882a593Smuzhiyun 			if (tw_dev->srb[i]) {
1596*4882a593Smuzhiyun 				struct scsi_cmnd *cmd = tw_dev->srb[i];
1597*4882a593Smuzhiyun 
1598*4882a593Smuzhiyun 				cmd->result = (DID_RESET << 16);
1599*4882a593Smuzhiyun 				if (twa_command_mapped(cmd))
1600*4882a593Smuzhiyun 					scsi_dma_unmap(cmd);
1601*4882a593Smuzhiyun 				cmd->scsi_done(cmd);
1602*4882a593Smuzhiyun 			}
1603*4882a593Smuzhiyun 		}
1604*4882a593Smuzhiyun 	}
1605*4882a593Smuzhiyun 
1606*4882a593Smuzhiyun 	/* Reset queues and counts */
1607*4882a593Smuzhiyun 	for (i = 0; i < TW_Q_LENGTH; i++) {
1608*4882a593Smuzhiyun 		tw_dev->free_queue[i] = i;
1609*4882a593Smuzhiyun 		tw_dev->state[i] = TW_S_INITIAL;
1610*4882a593Smuzhiyun 	}
1611*4882a593Smuzhiyun 	tw_dev->free_head = TW_Q_START;
1612*4882a593Smuzhiyun 	tw_dev->free_tail = TW_Q_START;
1613*4882a593Smuzhiyun 	tw_dev->posted_request_count = 0;
1614*4882a593Smuzhiyun 	tw_dev->pending_request_count = 0;
1615*4882a593Smuzhiyun 	tw_dev->pending_head = TW_Q_START;
1616*4882a593Smuzhiyun 	tw_dev->pending_tail = TW_Q_START;
1617*4882a593Smuzhiyun 	tw_dev->reset_print = 0;
1618*4882a593Smuzhiyun 
1619*4882a593Smuzhiyun 	spin_unlock_irqrestore(tw_dev->host->host_lock, flags);
1620*4882a593Smuzhiyun 
1621*4882a593Smuzhiyun 	if (twa_reset_sequence(tw_dev, 1))
1622*4882a593Smuzhiyun 		goto out;
1623*4882a593Smuzhiyun 
1624*4882a593Smuzhiyun 	TW_ENABLE_AND_CLEAR_INTERRUPTS(tw_dev);
1625*4882a593Smuzhiyun 	clear_bit(TW_IN_RESET, &tw_dev->flags);
1626*4882a593Smuzhiyun 	tw_dev->chrdev_request_id = TW_IOCTL_CHRDEV_FREE;
1627*4882a593Smuzhiyun 
1628*4882a593Smuzhiyun 	retval = 0;
1629*4882a593Smuzhiyun out:
1630*4882a593Smuzhiyun 	return retval;
1631*4882a593Smuzhiyun } /* End twa_reset_device_extension() */
1632*4882a593Smuzhiyun 
1633*4882a593Smuzhiyun /* This function will reset a controller */
twa_reset_sequence(TW_Device_Extension * tw_dev,int soft_reset)1634*4882a593Smuzhiyun static int twa_reset_sequence(TW_Device_Extension *tw_dev, int soft_reset)
1635*4882a593Smuzhiyun {
1636*4882a593Smuzhiyun 	int tries = 0, retval = 1, flashed = 0, do_soft_reset = soft_reset;
1637*4882a593Smuzhiyun 
1638*4882a593Smuzhiyun 	while (tries < TW_MAX_RESET_TRIES) {
1639*4882a593Smuzhiyun 		if (do_soft_reset) {
1640*4882a593Smuzhiyun 			TW_SOFT_RESET(tw_dev);
1641*4882a593Smuzhiyun 			/* Clear pchip/response queue on 9550SX */
1642*4882a593Smuzhiyun 			if (twa_empty_response_queue_large(tw_dev)) {
1643*4882a593Smuzhiyun 				TW_PRINTK(tw_dev->host, TW_DRIVER, 0x36, "Response queue (large) empty failed during reset sequence");
1644*4882a593Smuzhiyun 				do_soft_reset = 1;
1645*4882a593Smuzhiyun 				tries++;
1646*4882a593Smuzhiyun 				continue;
1647*4882a593Smuzhiyun 			}
1648*4882a593Smuzhiyun 		}
1649*4882a593Smuzhiyun 
1650*4882a593Smuzhiyun 		/* Make sure controller is in a good state */
1651*4882a593Smuzhiyun 		if (twa_poll_status(tw_dev, TW_STATUS_MICROCONTROLLER_READY | (do_soft_reset == 1 ? TW_STATUS_ATTENTION_INTERRUPT : 0), 60)) {
1652*4882a593Smuzhiyun 			TW_PRINTK(tw_dev->host, TW_DRIVER, 0x1f, "Microcontroller not ready during reset sequence");
1653*4882a593Smuzhiyun 			do_soft_reset = 1;
1654*4882a593Smuzhiyun 			tries++;
1655*4882a593Smuzhiyun 			continue;
1656*4882a593Smuzhiyun 		}
1657*4882a593Smuzhiyun 
1658*4882a593Smuzhiyun 		/* Empty response queue */
1659*4882a593Smuzhiyun 		if (twa_empty_response_queue(tw_dev)) {
1660*4882a593Smuzhiyun 			TW_PRINTK(tw_dev->host, TW_DRIVER, 0x20, "Response queue empty failed during reset sequence");
1661*4882a593Smuzhiyun 			do_soft_reset = 1;
1662*4882a593Smuzhiyun 			tries++;
1663*4882a593Smuzhiyun 			continue;
1664*4882a593Smuzhiyun 		}
1665*4882a593Smuzhiyun 
1666*4882a593Smuzhiyun 		flashed = 0;
1667*4882a593Smuzhiyun 
1668*4882a593Smuzhiyun 		/* Check for compatibility/flash */
1669*4882a593Smuzhiyun 		if (twa_check_srl(tw_dev, &flashed)) {
1670*4882a593Smuzhiyun 			TW_PRINTK(tw_dev->host, TW_DRIVER, 0x21, "Compatibility check failed during reset sequence");
1671*4882a593Smuzhiyun 			do_soft_reset = 1;
1672*4882a593Smuzhiyun 			tries++;
1673*4882a593Smuzhiyun 			continue;
1674*4882a593Smuzhiyun 		} else {
1675*4882a593Smuzhiyun 			if (flashed) {
1676*4882a593Smuzhiyun 				tries++;
1677*4882a593Smuzhiyun 				continue;
1678*4882a593Smuzhiyun 			}
1679*4882a593Smuzhiyun 		}
1680*4882a593Smuzhiyun 
1681*4882a593Smuzhiyun 		/* Drain the AEN queue */
1682*4882a593Smuzhiyun 		if (twa_aen_drain_queue(tw_dev, soft_reset)) {
1683*4882a593Smuzhiyun 			TW_PRINTK(tw_dev->host, TW_DRIVER, 0x22, "AEN drain failed during reset sequence");
1684*4882a593Smuzhiyun 			do_soft_reset = 1;
1685*4882a593Smuzhiyun 			tries++;
1686*4882a593Smuzhiyun 			continue;
1687*4882a593Smuzhiyun 		}
1688*4882a593Smuzhiyun 
1689*4882a593Smuzhiyun 		/* If we got here, controller is in a good state */
1690*4882a593Smuzhiyun 		retval = 0;
1691*4882a593Smuzhiyun 		goto out;
1692*4882a593Smuzhiyun 	}
1693*4882a593Smuzhiyun out:
1694*4882a593Smuzhiyun 	return retval;
1695*4882a593Smuzhiyun } /* End twa_reset_sequence() */
1696*4882a593Smuzhiyun 
1697*4882a593Smuzhiyun /* This funciton returns unit geometry in cylinders/heads/sectors */
twa_scsi_biosparam(struct scsi_device * sdev,struct block_device * bdev,sector_t capacity,int geom[])1698*4882a593Smuzhiyun static int twa_scsi_biosparam(struct scsi_device *sdev, struct block_device *bdev, sector_t capacity, int geom[])
1699*4882a593Smuzhiyun {
1700*4882a593Smuzhiyun 	int heads, sectors, cylinders;
1701*4882a593Smuzhiyun 	TW_Device_Extension *tw_dev;
1702*4882a593Smuzhiyun 
1703*4882a593Smuzhiyun 	tw_dev = (TW_Device_Extension *)sdev->host->hostdata;
1704*4882a593Smuzhiyun 
1705*4882a593Smuzhiyun 	if (capacity >= 0x200000) {
1706*4882a593Smuzhiyun 		heads = 255;
1707*4882a593Smuzhiyun 		sectors = 63;
1708*4882a593Smuzhiyun 		cylinders = sector_div(capacity, heads * sectors);
1709*4882a593Smuzhiyun 	} else {
1710*4882a593Smuzhiyun 		heads = 64;
1711*4882a593Smuzhiyun 		sectors = 32;
1712*4882a593Smuzhiyun 		cylinders = sector_div(capacity, heads * sectors);
1713*4882a593Smuzhiyun 	}
1714*4882a593Smuzhiyun 
1715*4882a593Smuzhiyun 	geom[0] = heads;
1716*4882a593Smuzhiyun 	geom[1] = sectors;
1717*4882a593Smuzhiyun 	geom[2] = cylinders;
1718*4882a593Smuzhiyun 
1719*4882a593Smuzhiyun 	return 0;
1720*4882a593Smuzhiyun } /* End twa_scsi_biosparam() */
1721*4882a593Smuzhiyun 
1722*4882a593Smuzhiyun /* This is the new scsi eh reset function */
twa_scsi_eh_reset(struct scsi_cmnd * SCpnt)1723*4882a593Smuzhiyun static int twa_scsi_eh_reset(struct scsi_cmnd *SCpnt)
1724*4882a593Smuzhiyun {
1725*4882a593Smuzhiyun 	TW_Device_Extension *tw_dev = NULL;
1726*4882a593Smuzhiyun 	int retval = FAILED;
1727*4882a593Smuzhiyun 
1728*4882a593Smuzhiyun 	tw_dev = (TW_Device_Extension *)SCpnt->device->host->hostdata;
1729*4882a593Smuzhiyun 
1730*4882a593Smuzhiyun 	tw_dev->num_resets++;
1731*4882a593Smuzhiyun 
1732*4882a593Smuzhiyun 	sdev_printk(KERN_WARNING, SCpnt->device,
1733*4882a593Smuzhiyun 		"WARNING: (0x%02X:0x%04X): Command (0x%x) timed out, resetting card.\n",
1734*4882a593Smuzhiyun 		TW_DRIVER, 0x2c, SCpnt->cmnd[0]);
1735*4882a593Smuzhiyun 
1736*4882a593Smuzhiyun 	/* Make sure we are not issuing an ioctl or resetting from ioctl */
1737*4882a593Smuzhiyun 	mutex_lock(&tw_dev->ioctl_lock);
1738*4882a593Smuzhiyun 
1739*4882a593Smuzhiyun 	/* Now reset the card and some of the device extension data */
1740*4882a593Smuzhiyun 	if (twa_reset_device_extension(tw_dev)) {
1741*4882a593Smuzhiyun 		TW_PRINTK(tw_dev->host, TW_DRIVER, 0x2b, "Controller reset failed during scsi host reset");
1742*4882a593Smuzhiyun 		goto out;
1743*4882a593Smuzhiyun 	}
1744*4882a593Smuzhiyun 
1745*4882a593Smuzhiyun 	retval = SUCCESS;
1746*4882a593Smuzhiyun out:
1747*4882a593Smuzhiyun 	mutex_unlock(&tw_dev->ioctl_lock);
1748*4882a593Smuzhiyun 	return retval;
1749*4882a593Smuzhiyun } /* End twa_scsi_eh_reset() */
1750*4882a593Smuzhiyun 
1751*4882a593Smuzhiyun /* This is the main scsi queue function to handle scsi opcodes */
twa_scsi_queue_lck(struct scsi_cmnd * SCpnt,void (* done)(struct scsi_cmnd *))1752*4882a593Smuzhiyun static int twa_scsi_queue_lck(struct scsi_cmnd *SCpnt, void (*done)(struct scsi_cmnd *))
1753*4882a593Smuzhiyun {
1754*4882a593Smuzhiyun 	int request_id, retval;
1755*4882a593Smuzhiyun 	TW_Device_Extension *tw_dev = (TW_Device_Extension *)SCpnt->device->host->hostdata;
1756*4882a593Smuzhiyun 
1757*4882a593Smuzhiyun 	/* If we are resetting due to timed out ioctl, report as busy */
1758*4882a593Smuzhiyun 	if (test_bit(TW_IN_RESET, &tw_dev->flags)) {
1759*4882a593Smuzhiyun 		retval = SCSI_MLQUEUE_HOST_BUSY;
1760*4882a593Smuzhiyun 		goto out;
1761*4882a593Smuzhiyun 	}
1762*4882a593Smuzhiyun 
1763*4882a593Smuzhiyun 	/* Check if this FW supports luns */
1764*4882a593Smuzhiyun 	if ((SCpnt->device->lun != 0) && (tw_dev->tw_compat_info.working_srl < TW_FW_SRL_LUNS_SUPPORTED)) {
1765*4882a593Smuzhiyun 		SCpnt->result = (DID_BAD_TARGET << 16);
1766*4882a593Smuzhiyun 		done(SCpnt);
1767*4882a593Smuzhiyun 		retval = 0;
1768*4882a593Smuzhiyun 		goto out;
1769*4882a593Smuzhiyun 	}
1770*4882a593Smuzhiyun 
1771*4882a593Smuzhiyun 	/* Save done function into scsi_cmnd struct */
1772*4882a593Smuzhiyun 	SCpnt->scsi_done = done;
1773*4882a593Smuzhiyun 
1774*4882a593Smuzhiyun 	/* Get a free request id */
1775*4882a593Smuzhiyun 	twa_get_request_id(tw_dev, &request_id);
1776*4882a593Smuzhiyun 
1777*4882a593Smuzhiyun 	/* Save the scsi command for use by the ISR */
1778*4882a593Smuzhiyun 	tw_dev->srb[request_id] = SCpnt;
1779*4882a593Smuzhiyun 
1780*4882a593Smuzhiyun 	retval = twa_scsiop_execute_scsi(tw_dev, request_id, NULL, 0, NULL);
1781*4882a593Smuzhiyun 	switch (retval) {
1782*4882a593Smuzhiyun 	case SCSI_MLQUEUE_HOST_BUSY:
1783*4882a593Smuzhiyun 		if (twa_command_mapped(SCpnt))
1784*4882a593Smuzhiyun 			scsi_dma_unmap(SCpnt);
1785*4882a593Smuzhiyun 		twa_free_request_id(tw_dev, request_id);
1786*4882a593Smuzhiyun 		break;
1787*4882a593Smuzhiyun 	case 1:
1788*4882a593Smuzhiyun 		SCpnt->result = (DID_ERROR << 16);
1789*4882a593Smuzhiyun 		if (twa_command_mapped(SCpnt))
1790*4882a593Smuzhiyun 			scsi_dma_unmap(SCpnt);
1791*4882a593Smuzhiyun 		done(SCpnt);
1792*4882a593Smuzhiyun 		tw_dev->state[request_id] = TW_S_COMPLETED;
1793*4882a593Smuzhiyun 		twa_free_request_id(tw_dev, request_id);
1794*4882a593Smuzhiyun 		retval = 0;
1795*4882a593Smuzhiyun 	}
1796*4882a593Smuzhiyun out:
1797*4882a593Smuzhiyun 	return retval;
1798*4882a593Smuzhiyun } /* End twa_scsi_queue() */
1799*4882a593Smuzhiyun 
DEF_SCSI_QCMD(twa_scsi_queue)1800*4882a593Smuzhiyun static DEF_SCSI_QCMD(twa_scsi_queue)
1801*4882a593Smuzhiyun 
1802*4882a593Smuzhiyun /* This function hands scsi cdb's to the firmware */
1803*4882a593Smuzhiyun static int twa_scsiop_execute_scsi(TW_Device_Extension *tw_dev, int request_id,
1804*4882a593Smuzhiyun 				   unsigned char *cdb, int use_sg,
1805*4882a593Smuzhiyun 				   TW_SG_Entry *sglistarg)
1806*4882a593Smuzhiyun {
1807*4882a593Smuzhiyun 	TW_Command_Full *full_command_packet;
1808*4882a593Smuzhiyun 	TW_Command_Apache *command_packet;
1809*4882a593Smuzhiyun 	u32 num_sectors = 0x0;
1810*4882a593Smuzhiyun 	int i, sg_count;
1811*4882a593Smuzhiyun 	struct scsi_cmnd *srb = NULL;
1812*4882a593Smuzhiyun 	struct scatterlist *sglist = NULL, *sg;
1813*4882a593Smuzhiyun 	int retval = 1;
1814*4882a593Smuzhiyun 
1815*4882a593Smuzhiyun 	if (tw_dev->srb[request_id]) {
1816*4882a593Smuzhiyun 		srb = tw_dev->srb[request_id];
1817*4882a593Smuzhiyun 		if (scsi_sglist(srb))
1818*4882a593Smuzhiyun 			sglist = scsi_sglist(srb);
1819*4882a593Smuzhiyun 	}
1820*4882a593Smuzhiyun 
1821*4882a593Smuzhiyun 	/* Initialize command packet */
1822*4882a593Smuzhiyun 	full_command_packet = tw_dev->command_packet_virt[request_id];
1823*4882a593Smuzhiyun 	full_command_packet->header.header_desc.size_header = 128;
1824*4882a593Smuzhiyun 	full_command_packet->header.status_block.error = 0;
1825*4882a593Smuzhiyun 	full_command_packet->header.status_block.severity__reserved = 0;
1826*4882a593Smuzhiyun 
1827*4882a593Smuzhiyun 	command_packet = &full_command_packet->command.newcommand;
1828*4882a593Smuzhiyun 	command_packet->status = 0;
1829*4882a593Smuzhiyun 	command_packet->opcode__reserved = TW_OPRES_IN(0, TW_OP_EXECUTE_SCSI);
1830*4882a593Smuzhiyun 
1831*4882a593Smuzhiyun 	/* We forced 16 byte cdb use earlier */
1832*4882a593Smuzhiyun 	if (!cdb)
1833*4882a593Smuzhiyun 		memcpy(command_packet->cdb, srb->cmnd, TW_MAX_CDB_LEN);
1834*4882a593Smuzhiyun 	else
1835*4882a593Smuzhiyun 		memcpy(command_packet->cdb, cdb, TW_MAX_CDB_LEN);
1836*4882a593Smuzhiyun 
1837*4882a593Smuzhiyun 	if (srb) {
1838*4882a593Smuzhiyun 		command_packet->unit = srb->device->id;
1839*4882a593Smuzhiyun 		command_packet->request_id__lunl =
1840*4882a593Smuzhiyun 			cpu_to_le16(TW_REQ_LUN_IN(srb->device->lun, request_id));
1841*4882a593Smuzhiyun 	} else {
1842*4882a593Smuzhiyun 		command_packet->request_id__lunl =
1843*4882a593Smuzhiyun 			cpu_to_le16(TW_REQ_LUN_IN(0, request_id));
1844*4882a593Smuzhiyun 		command_packet->unit = 0;
1845*4882a593Smuzhiyun 	}
1846*4882a593Smuzhiyun 
1847*4882a593Smuzhiyun 	command_packet->sgl_offset = 16;
1848*4882a593Smuzhiyun 
1849*4882a593Smuzhiyun 	if (!sglistarg) {
1850*4882a593Smuzhiyun 		/* Map sglist from scsi layer to cmd packet */
1851*4882a593Smuzhiyun 
1852*4882a593Smuzhiyun 		if (scsi_sg_count(srb)) {
1853*4882a593Smuzhiyun 			if (!twa_command_mapped(srb)) {
1854*4882a593Smuzhiyun 				if (srb->sc_data_direction == DMA_TO_DEVICE ||
1855*4882a593Smuzhiyun 				    srb->sc_data_direction == DMA_BIDIRECTIONAL)
1856*4882a593Smuzhiyun 					scsi_sg_copy_to_buffer(srb,
1857*4882a593Smuzhiyun 							       tw_dev->generic_buffer_virt[request_id],
1858*4882a593Smuzhiyun 							       TW_SECTOR_SIZE);
1859*4882a593Smuzhiyun 				command_packet->sg_list[0].address = TW_CPU_TO_SGL(tw_dev->generic_buffer_phys[request_id]);
1860*4882a593Smuzhiyun 				command_packet->sg_list[0].length = cpu_to_le32(TW_MIN_SGL_LENGTH);
1861*4882a593Smuzhiyun 			} else {
1862*4882a593Smuzhiyun 				sg_count = scsi_dma_map(srb);
1863*4882a593Smuzhiyun 				if (sg_count < 0)
1864*4882a593Smuzhiyun 					goto out;
1865*4882a593Smuzhiyun 
1866*4882a593Smuzhiyun 				scsi_for_each_sg(srb, sg, sg_count, i) {
1867*4882a593Smuzhiyun 					command_packet->sg_list[i].address = TW_CPU_TO_SGL(sg_dma_address(sg));
1868*4882a593Smuzhiyun 					command_packet->sg_list[i].length = cpu_to_le32(sg_dma_len(sg));
1869*4882a593Smuzhiyun 					if (command_packet->sg_list[i].address & TW_CPU_TO_SGL(TW_ALIGNMENT_9000_SGL)) {
1870*4882a593Smuzhiyun 						TW_PRINTK(tw_dev->host, TW_DRIVER, 0x2e, "Found unaligned sgl address during execute scsi");
1871*4882a593Smuzhiyun 						goto out;
1872*4882a593Smuzhiyun 					}
1873*4882a593Smuzhiyun 				}
1874*4882a593Smuzhiyun 			}
1875*4882a593Smuzhiyun 			command_packet->sgl_entries__lunh = cpu_to_le16(TW_REQ_LUN_IN((srb->device->lun >> 4), scsi_sg_count(tw_dev->srb[request_id])));
1876*4882a593Smuzhiyun 		}
1877*4882a593Smuzhiyun 	} else {
1878*4882a593Smuzhiyun 		/* Internal cdb post */
1879*4882a593Smuzhiyun 		for (i = 0; i < use_sg; i++) {
1880*4882a593Smuzhiyun 			command_packet->sg_list[i].address = TW_CPU_TO_SGL(sglistarg[i].address);
1881*4882a593Smuzhiyun 			command_packet->sg_list[i].length = cpu_to_le32(sglistarg[i].length);
1882*4882a593Smuzhiyun 			if (command_packet->sg_list[i].address & TW_CPU_TO_SGL(TW_ALIGNMENT_9000_SGL)) {
1883*4882a593Smuzhiyun 				TW_PRINTK(tw_dev->host, TW_DRIVER, 0x2f, "Found unaligned sgl address during internal post");
1884*4882a593Smuzhiyun 				goto out;
1885*4882a593Smuzhiyun 			}
1886*4882a593Smuzhiyun 		}
1887*4882a593Smuzhiyun 		command_packet->sgl_entries__lunh = cpu_to_le16(TW_REQ_LUN_IN(0, use_sg));
1888*4882a593Smuzhiyun 	}
1889*4882a593Smuzhiyun 
1890*4882a593Smuzhiyun 	if (srb) {
1891*4882a593Smuzhiyun 		if (srb->cmnd[0] == READ_6 || srb->cmnd[0] == WRITE_6)
1892*4882a593Smuzhiyun 			num_sectors = (u32)srb->cmnd[4];
1893*4882a593Smuzhiyun 
1894*4882a593Smuzhiyun 		if (srb->cmnd[0] == READ_10 || srb->cmnd[0] == WRITE_10)
1895*4882a593Smuzhiyun 			num_sectors = (u32)srb->cmnd[8] | ((u32)srb->cmnd[7] << 8);
1896*4882a593Smuzhiyun 	}
1897*4882a593Smuzhiyun 
1898*4882a593Smuzhiyun 	/* Update sector statistic */
1899*4882a593Smuzhiyun 	tw_dev->sector_count = num_sectors;
1900*4882a593Smuzhiyun 	if (tw_dev->sector_count > tw_dev->max_sector_count)
1901*4882a593Smuzhiyun 		tw_dev->max_sector_count = tw_dev->sector_count;
1902*4882a593Smuzhiyun 
1903*4882a593Smuzhiyun 	/* Update SG statistics */
1904*4882a593Smuzhiyun 	if (srb) {
1905*4882a593Smuzhiyun 		tw_dev->sgl_entries = scsi_sg_count(tw_dev->srb[request_id]);
1906*4882a593Smuzhiyun 		if (tw_dev->sgl_entries > tw_dev->max_sgl_entries)
1907*4882a593Smuzhiyun 			tw_dev->max_sgl_entries = tw_dev->sgl_entries;
1908*4882a593Smuzhiyun 	}
1909*4882a593Smuzhiyun 
1910*4882a593Smuzhiyun 	/* Now post the command to the board */
1911*4882a593Smuzhiyun 	if (srb) {
1912*4882a593Smuzhiyun 		retval = twa_post_command_packet(tw_dev, request_id, 0);
1913*4882a593Smuzhiyun 	} else {
1914*4882a593Smuzhiyun 		twa_post_command_packet(tw_dev, request_id, 1);
1915*4882a593Smuzhiyun 		retval = 0;
1916*4882a593Smuzhiyun 	}
1917*4882a593Smuzhiyun out:
1918*4882a593Smuzhiyun 	return retval;
1919*4882a593Smuzhiyun } /* End twa_scsiop_execute_scsi() */
1920*4882a593Smuzhiyun 
1921*4882a593Smuzhiyun /* This function completes an execute scsi operation */
twa_scsiop_execute_scsi_complete(TW_Device_Extension * tw_dev,int request_id)1922*4882a593Smuzhiyun static void twa_scsiop_execute_scsi_complete(TW_Device_Extension *tw_dev, int request_id)
1923*4882a593Smuzhiyun {
1924*4882a593Smuzhiyun 	struct scsi_cmnd *cmd = tw_dev->srb[request_id];
1925*4882a593Smuzhiyun 
1926*4882a593Smuzhiyun 	if (!twa_command_mapped(cmd) &&
1927*4882a593Smuzhiyun 	    (cmd->sc_data_direction == DMA_FROM_DEVICE ||
1928*4882a593Smuzhiyun 	     cmd->sc_data_direction == DMA_BIDIRECTIONAL)) {
1929*4882a593Smuzhiyun 		if (scsi_sg_count(cmd) == 1) {
1930*4882a593Smuzhiyun 			void *buf = tw_dev->generic_buffer_virt[request_id];
1931*4882a593Smuzhiyun 
1932*4882a593Smuzhiyun 			scsi_sg_copy_from_buffer(cmd, buf, TW_SECTOR_SIZE);
1933*4882a593Smuzhiyun 		}
1934*4882a593Smuzhiyun 	}
1935*4882a593Smuzhiyun } /* End twa_scsiop_execute_scsi_complete() */
1936*4882a593Smuzhiyun 
1937*4882a593Smuzhiyun /* This function tells the controller to shut down */
__twa_shutdown(TW_Device_Extension * tw_dev)1938*4882a593Smuzhiyun static void __twa_shutdown(TW_Device_Extension *tw_dev)
1939*4882a593Smuzhiyun {
1940*4882a593Smuzhiyun 	/* Disable interrupts */
1941*4882a593Smuzhiyun 	TW_DISABLE_INTERRUPTS(tw_dev);
1942*4882a593Smuzhiyun 
1943*4882a593Smuzhiyun 	/* Free up the IRQ */
1944*4882a593Smuzhiyun 	free_irq(tw_dev->tw_pci_dev->irq, tw_dev);
1945*4882a593Smuzhiyun 
1946*4882a593Smuzhiyun 	printk(KERN_WARNING "3w-9xxx: Shutting down host %d.\n", tw_dev->host->host_no);
1947*4882a593Smuzhiyun 
1948*4882a593Smuzhiyun 	/* Tell the card we are shutting down */
1949*4882a593Smuzhiyun 	if (twa_initconnection(tw_dev, 1, 0, 0, 0, 0, 0, NULL, NULL, NULL, NULL, NULL)) {
1950*4882a593Smuzhiyun 		TW_PRINTK(tw_dev->host, TW_DRIVER, 0x31, "Connection shutdown failed");
1951*4882a593Smuzhiyun 	} else {
1952*4882a593Smuzhiyun 		printk(KERN_WARNING "3w-9xxx: Shutdown complete.\n");
1953*4882a593Smuzhiyun 	}
1954*4882a593Smuzhiyun 
1955*4882a593Smuzhiyun 	/* Clear all interrupts just before exit */
1956*4882a593Smuzhiyun 	TW_CLEAR_ALL_INTERRUPTS(tw_dev);
1957*4882a593Smuzhiyun } /* End __twa_shutdown() */
1958*4882a593Smuzhiyun 
1959*4882a593Smuzhiyun /* Wrapper for __twa_shutdown */
twa_shutdown(struct pci_dev * pdev)1960*4882a593Smuzhiyun static void twa_shutdown(struct pci_dev *pdev)
1961*4882a593Smuzhiyun {
1962*4882a593Smuzhiyun 	struct Scsi_Host *host = pci_get_drvdata(pdev);
1963*4882a593Smuzhiyun 	TW_Device_Extension *tw_dev = (TW_Device_Extension *)host->hostdata;
1964*4882a593Smuzhiyun 
1965*4882a593Smuzhiyun 	__twa_shutdown(tw_dev);
1966*4882a593Smuzhiyun } /* End twa_shutdown() */
1967*4882a593Smuzhiyun 
1968*4882a593Smuzhiyun /* This function will look up a string */
twa_string_lookup(twa_message_type * table,unsigned int code)1969*4882a593Smuzhiyun static char *twa_string_lookup(twa_message_type *table, unsigned int code)
1970*4882a593Smuzhiyun {
1971*4882a593Smuzhiyun 	int index;
1972*4882a593Smuzhiyun 
1973*4882a593Smuzhiyun 	for (index = 0; ((code != table[index].code) &&
1974*4882a593Smuzhiyun 		      (table[index].text != (char *)0)); index++);
1975*4882a593Smuzhiyun 	return(table[index].text);
1976*4882a593Smuzhiyun } /* End twa_string_lookup() */
1977*4882a593Smuzhiyun 
1978*4882a593Smuzhiyun /* This function gets called when a disk is coming on-line */
twa_slave_configure(struct scsi_device * sdev)1979*4882a593Smuzhiyun static int twa_slave_configure(struct scsi_device *sdev)
1980*4882a593Smuzhiyun {
1981*4882a593Smuzhiyun 	/* Force 60 second timeout */
1982*4882a593Smuzhiyun 	blk_queue_rq_timeout(sdev->request_queue, 60 * HZ);
1983*4882a593Smuzhiyun 
1984*4882a593Smuzhiyun 	return 0;
1985*4882a593Smuzhiyun } /* End twa_slave_configure() */
1986*4882a593Smuzhiyun 
1987*4882a593Smuzhiyun /* scsi_host_template initializer */
1988*4882a593Smuzhiyun static struct scsi_host_template driver_template = {
1989*4882a593Smuzhiyun 	.module			= THIS_MODULE,
1990*4882a593Smuzhiyun 	.name			= "3ware 9000 Storage Controller",
1991*4882a593Smuzhiyun 	.queuecommand		= twa_scsi_queue,
1992*4882a593Smuzhiyun 	.eh_host_reset_handler	= twa_scsi_eh_reset,
1993*4882a593Smuzhiyun 	.bios_param		= twa_scsi_biosparam,
1994*4882a593Smuzhiyun 	.change_queue_depth	= scsi_change_queue_depth,
1995*4882a593Smuzhiyun 	.can_queue		= TW_Q_LENGTH-2,
1996*4882a593Smuzhiyun 	.slave_configure	= twa_slave_configure,
1997*4882a593Smuzhiyun 	.this_id		= -1,
1998*4882a593Smuzhiyun 	.sg_tablesize		= TW_APACHE_MAX_SGL_LENGTH,
1999*4882a593Smuzhiyun 	.max_sectors		= TW_MAX_SECTORS,
2000*4882a593Smuzhiyun 	.cmd_per_lun		= TW_MAX_CMDS_PER_LUN,
2001*4882a593Smuzhiyun 	.shost_attrs		= twa_host_attrs,
2002*4882a593Smuzhiyun 	.emulated		= 1,
2003*4882a593Smuzhiyun 	.no_write_same		= 1,
2004*4882a593Smuzhiyun };
2005*4882a593Smuzhiyun 
2006*4882a593Smuzhiyun /* This function will probe and initialize a card */
twa_probe(struct pci_dev * pdev,const struct pci_device_id * dev_id)2007*4882a593Smuzhiyun static int twa_probe(struct pci_dev *pdev, const struct pci_device_id *dev_id)
2008*4882a593Smuzhiyun {
2009*4882a593Smuzhiyun 	struct Scsi_Host *host = NULL;
2010*4882a593Smuzhiyun 	TW_Device_Extension *tw_dev;
2011*4882a593Smuzhiyun 	unsigned long mem_addr, mem_len;
2012*4882a593Smuzhiyun 	int retval;
2013*4882a593Smuzhiyun 
2014*4882a593Smuzhiyun 	retval = pci_enable_device(pdev);
2015*4882a593Smuzhiyun 	if (retval) {
2016*4882a593Smuzhiyun 		TW_PRINTK(host, TW_DRIVER, 0x34, "Failed to enable pci device");
2017*4882a593Smuzhiyun 		return -ENODEV;
2018*4882a593Smuzhiyun 	}
2019*4882a593Smuzhiyun 
2020*4882a593Smuzhiyun 	pci_set_master(pdev);
2021*4882a593Smuzhiyun 	pci_try_set_mwi(pdev);
2022*4882a593Smuzhiyun 
2023*4882a593Smuzhiyun 	retval = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64));
2024*4882a593Smuzhiyun 	if (retval)
2025*4882a593Smuzhiyun 		retval = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32));
2026*4882a593Smuzhiyun 	if (retval) {
2027*4882a593Smuzhiyun 		TW_PRINTK(host, TW_DRIVER, 0x23, "Failed to set dma mask");
2028*4882a593Smuzhiyun 		retval = -ENODEV;
2029*4882a593Smuzhiyun 		goto out_disable_device;
2030*4882a593Smuzhiyun 	}
2031*4882a593Smuzhiyun 
2032*4882a593Smuzhiyun 	host = scsi_host_alloc(&driver_template, sizeof(TW_Device_Extension));
2033*4882a593Smuzhiyun 	if (!host) {
2034*4882a593Smuzhiyun 		TW_PRINTK(host, TW_DRIVER, 0x24, "Failed to allocate memory for device extension");
2035*4882a593Smuzhiyun 		retval = -ENOMEM;
2036*4882a593Smuzhiyun 		goto out_disable_device;
2037*4882a593Smuzhiyun 	}
2038*4882a593Smuzhiyun 	tw_dev = (TW_Device_Extension *)host->hostdata;
2039*4882a593Smuzhiyun 
2040*4882a593Smuzhiyun 	/* Save values to device extension */
2041*4882a593Smuzhiyun 	tw_dev->host = host;
2042*4882a593Smuzhiyun 	tw_dev->tw_pci_dev = pdev;
2043*4882a593Smuzhiyun 
2044*4882a593Smuzhiyun 	if (twa_initialize_device_extension(tw_dev)) {
2045*4882a593Smuzhiyun 		TW_PRINTK(tw_dev->host, TW_DRIVER, 0x25, "Failed to initialize device extension");
2046*4882a593Smuzhiyun 		retval = -ENOMEM;
2047*4882a593Smuzhiyun 		goto out_free_device_extension;
2048*4882a593Smuzhiyun 	}
2049*4882a593Smuzhiyun 
2050*4882a593Smuzhiyun 	/* Request IO regions */
2051*4882a593Smuzhiyun 	retval = pci_request_regions(pdev, "3w-9xxx");
2052*4882a593Smuzhiyun 	if (retval) {
2053*4882a593Smuzhiyun 		TW_PRINTK(tw_dev->host, TW_DRIVER, 0x26, "Failed to get mem region");
2054*4882a593Smuzhiyun 		goto out_free_device_extension;
2055*4882a593Smuzhiyun 	}
2056*4882a593Smuzhiyun 
2057*4882a593Smuzhiyun 	if (pdev->device == PCI_DEVICE_ID_3WARE_9000) {
2058*4882a593Smuzhiyun 		mem_addr = pci_resource_start(pdev, 1);
2059*4882a593Smuzhiyun 		mem_len = pci_resource_len(pdev, 1);
2060*4882a593Smuzhiyun 	} else {
2061*4882a593Smuzhiyun 		mem_addr = pci_resource_start(pdev, 2);
2062*4882a593Smuzhiyun 		mem_len = pci_resource_len(pdev, 2);
2063*4882a593Smuzhiyun 	}
2064*4882a593Smuzhiyun 
2065*4882a593Smuzhiyun 	/* Save base address */
2066*4882a593Smuzhiyun 	tw_dev->base_addr = ioremap(mem_addr, mem_len);
2067*4882a593Smuzhiyun 	if (!tw_dev->base_addr) {
2068*4882a593Smuzhiyun 		TW_PRINTK(tw_dev->host, TW_DRIVER, 0x35, "Failed to ioremap");
2069*4882a593Smuzhiyun 		retval = -ENOMEM;
2070*4882a593Smuzhiyun 		goto out_release_mem_region;
2071*4882a593Smuzhiyun 	}
2072*4882a593Smuzhiyun 
2073*4882a593Smuzhiyun 	/* Disable interrupts on the card */
2074*4882a593Smuzhiyun 	TW_DISABLE_INTERRUPTS(tw_dev);
2075*4882a593Smuzhiyun 
2076*4882a593Smuzhiyun 	/* Initialize the card */
2077*4882a593Smuzhiyun 	if (twa_reset_sequence(tw_dev, 0)) {
2078*4882a593Smuzhiyun 		retval = -ENOMEM;
2079*4882a593Smuzhiyun 		goto out_iounmap;
2080*4882a593Smuzhiyun 	}
2081*4882a593Smuzhiyun 
2082*4882a593Smuzhiyun 	/* Set host specific parameters */
2083*4882a593Smuzhiyun 	if ((pdev->device == PCI_DEVICE_ID_3WARE_9650SE) ||
2084*4882a593Smuzhiyun 	    (pdev->device == PCI_DEVICE_ID_3WARE_9690SA))
2085*4882a593Smuzhiyun 		host->max_id = TW_MAX_UNITS_9650SE;
2086*4882a593Smuzhiyun 	else
2087*4882a593Smuzhiyun 		host->max_id = TW_MAX_UNITS;
2088*4882a593Smuzhiyun 
2089*4882a593Smuzhiyun 	host->max_cmd_len = TW_MAX_CDB_LEN;
2090*4882a593Smuzhiyun 
2091*4882a593Smuzhiyun 	/* Channels aren't supported by adapter */
2092*4882a593Smuzhiyun 	host->max_lun = TW_MAX_LUNS(tw_dev->tw_compat_info.working_srl);
2093*4882a593Smuzhiyun 	host->max_channel = 0;
2094*4882a593Smuzhiyun 
2095*4882a593Smuzhiyun 	/* Register the card with the kernel SCSI layer */
2096*4882a593Smuzhiyun 	retval = scsi_add_host(host, &pdev->dev);
2097*4882a593Smuzhiyun 	if (retval) {
2098*4882a593Smuzhiyun 		TW_PRINTK(tw_dev->host, TW_DRIVER, 0x27, "scsi add host failed");
2099*4882a593Smuzhiyun 		goto out_iounmap;
2100*4882a593Smuzhiyun 	}
2101*4882a593Smuzhiyun 
2102*4882a593Smuzhiyun 	pci_set_drvdata(pdev, host);
2103*4882a593Smuzhiyun 
2104*4882a593Smuzhiyun 	printk(KERN_WARNING "3w-9xxx: scsi%d: Found a 3ware 9000 Storage Controller at 0x%lx, IRQ: %d.\n",
2105*4882a593Smuzhiyun 	       host->host_no, mem_addr, pdev->irq);
2106*4882a593Smuzhiyun 	printk(KERN_WARNING "3w-9xxx: scsi%d: Firmware %s, BIOS %s, Ports: %d.\n",
2107*4882a593Smuzhiyun 	       host->host_no,
2108*4882a593Smuzhiyun 	       (char *)twa_get_param(tw_dev, 0, TW_VERSION_TABLE,
2109*4882a593Smuzhiyun 				     TW_PARAM_FWVER, TW_PARAM_FWVER_LENGTH),
2110*4882a593Smuzhiyun 	       (char *)twa_get_param(tw_dev, 1, TW_VERSION_TABLE,
2111*4882a593Smuzhiyun 				     TW_PARAM_BIOSVER, TW_PARAM_BIOSVER_LENGTH),
2112*4882a593Smuzhiyun 	       le32_to_cpu(*(int *)twa_get_param(tw_dev, 2, TW_INFORMATION_TABLE,
2113*4882a593Smuzhiyun 				     TW_PARAM_PORTCOUNT, TW_PARAM_PORTCOUNT_LENGTH)));
2114*4882a593Smuzhiyun 
2115*4882a593Smuzhiyun 	/* Try to enable MSI */
2116*4882a593Smuzhiyun 	if (use_msi && (pdev->device != PCI_DEVICE_ID_3WARE_9000) &&
2117*4882a593Smuzhiyun 	    !pci_enable_msi(pdev))
2118*4882a593Smuzhiyun 		set_bit(TW_USING_MSI, &tw_dev->flags);
2119*4882a593Smuzhiyun 
2120*4882a593Smuzhiyun 	/* Now setup the interrupt handler */
2121*4882a593Smuzhiyun 	retval = request_irq(pdev->irq, twa_interrupt, IRQF_SHARED, "3w-9xxx", tw_dev);
2122*4882a593Smuzhiyun 	if (retval) {
2123*4882a593Smuzhiyun 		TW_PRINTK(tw_dev->host, TW_DRIVER, 0x30, "Error requesting IRQ");
2124*4882a593Smuzhiyun 		goto out_remove_host;
2125*4882a593Smuzhiyun 	}
2126*4882a593Smuzhiyun 
2127*4882a593Smuzhiyun 	twa_device_extension_list[twa_device_extension_count] = tw_dev;
2128*4882a593Smuzhiyun 	twa_device_extension_count++;
2129*4882a593Smuzhiyun 
2130*4882a593Smuzhiyun 	/* Re-enable interrupts on the card */
2131*4882a593Smuzhiyun 	TW_ENABLE_AND_CLEAR_INTERRUPTS(tw_dev);
2132*4882a593Smuzhiyun 
2133*4882a593Smuzhiyun 	/* Finally, scan the host */
2134*4882a593Smuzhiyun 	scsi_scan_host(host);
2135*4882a593Smuzhiyun 
2136*4882a593Smuzhiyun 	if (twa_major == -1) {
2137*4882a593Smuzhiyun 		if ((twa_major = register_chrdev (0, "twa", &twa_fops)) < 0)
2138*4882a593Smuzhiyun 			TW_PRINTK(host, TW_DRIVER, 0x29, "Failed to register character device");
2139*4882a593Smuzhiyun 	}
2140*4882a593Smuzhiyun 	return 0;
2141*4882a593Smuzhiyun 
2142*4882a593Smuzhiyun out_remove_host:
2143*4882a593Smuzhiyun 	if (test_bit(TW_USING_MSI, &tw_dev->flags))
2144*4882a593Smuzhiyun 		pci_disable_msi(pdev);
2145*4882a593Smuzhiyun 	scsi_remove_host(host);
2146*4882a593Smuzhiyun out_iounmap:
2147*4882a593Smuzhiyun 	iounmap(tw_dev->base_addr);
2148*4882a593Smuzhiyun out_release_mem_region:
2149*4882a593Smuzhiyun 	pci_release_regions(pdev);
2150*4882a593Smuzhiyun out_free_device_extension:
2151*4882a593Smuzhiyun 	twa_free_device_extension(tw_dev);
2152*4882a593Smuzhiyun 	scsi_host_put(host);
2153*4882a593Smuzhiyun out_disable_device:
2154*4882a593Smuzhiyun 	pci_disable_device(pdev);
2155*4882a593Smuzhiyun 
2156*4882a593Smuzhiyun 	return retval;
2157*4882a593Smuzhiyun } /* End twa_probe() */
2158*4882a593Smuzhiyun 
2159*4882a593Smuzhiyun /* This function is called to remove a device */
twa_remove(struct pci_dev * pdev)2160*4882a593Smuzhiyun static void twa_remove(struct pci_dev *pdev)
2161*4882a593Smuzhiyun {
2162*4882a593Smuzhiyun 	struct Scsi_Host *host = pci_get_drvdata(pdev);
2163*4882a593Smuzhiyun 	TW_Device_Extension *tw_dev = (TW_Device_Extension *)host->hostdata;
2164*4882a593Smuzhiyun 
2165*4882a593Smuzhiyun 	scsi_remove_host(tw_dev->host);
2166*4882a593Smuzhiyun 
2167*4882a593Smuzhiyun 	/* Unregister character device */
2168*4882a593Smuzhiyun 	if (twa_major >= 0) {
2169*4882a593Smuzhiyun 		unregister_chrdev(twa_major, "twa");
2170*4882a593Smuzhiyun 		twa_major = -1;
2171*4882a593Smuzhiyun 	}
2172*4882a593Smuzhiyun 
2173*4882a593Smuzhiyun 	/* Shutdown the card */
2174*4882a593Smuzhiyun 	__twa_shutdown(tw_dev);
2175*4882a593Smuzhiyun 
2176*4882a593Smuzhiyun 	/* Disable MSI if enabled */
2177*4882a593Smuzhiyun 	if (test_bit(TW_USING_MSI, &tw_dev->flags))
2178*4882a593Smuzhiyun 		pci_disable_msi(pdev);
2179*4882a593Smuzhiyun 
2180*4882a593Smuzhiyun 	/* Free IO remapping */
2181*4882a593Smuzhiyun 	iounmap(tw_dev->base_addr);
2182*4882a593Smuzhiyun 
2183*4882a593Smuzhiyun 	/* Free up the mem region */
2184*4882a593Smuzhiyun 	pci_release_regions(pdev);
2185*4882a593Smuzhiyun 
2186*4882a593Smuzhiyun 	/* Free up device extension resources */
2187*4882a593Smuzhiyun 	twa_free_device_extension(tw_dev);
2188*4882a593Smuzhiyun 
2189*4882a593Smuzhiyun 	scsi_host_put(tw_dev->host);
2190*4882a593Smuzhiyun 	pci_disable_device(pdev);
2191*4882a593Smuzhiyun 	twa_device_extension_count--;
2192*4882a593Smuzhiyun } /* End twa_remove() */
2193*4882a593Smuzhiyun 
2194*4882a593Smuzhiyun #ifdef CONFIG_PM
2195*4882a593Smuzhiyun /* This function is called on PCI suspend */
twa_suspend(struct pci_dev * pdev,pm_message_t state)2196*4882a593Smuzhiyun static int twa_suspend(struct pci_dev *pdev, pm_message_t state)
2197*4882a593Smuzhiyun {
2198*4882a593Smuzhiyun 	struct Scsi_Host *host = pci_get_drvdata(pdev);
2199*4882a593Smuzhiyun 	TW_Device_Extension *tw_dev = (TW_Device_Extension *)host->hostdata;
2200*4882a593Smuzhiyun 
2201*4882a593Smuzhiyun 	printk(KERN_WARNING "3w-9xxx: Suspending host %d.\n", tw_dev->host->host_no);
2202*4882a593Smuzhiyun 
2203*4882a593Smuzhiyun 	TW_DISABLE_INTERRUPTS(tw_dev);
2204*4882a593Smuzhiyun 	free_irq(tw_dev->tw_pci_dev->irq, tw_dev);
2205*4882a593Smuzhiyun 
2206*4882a593Smuzhiyun 	if (test_bit(TW_USING_MSI, &tw_dev->flags))
2207*4882a593Smuzhiyun 		pci_disable_msi(pdev);
2208*4882a593Smuzhiyun 
2209*4882a593Smuzhiyun 	/* Tell the card we are shutting down */
2210*4882a593Smuzhiyun 	if (twa_initconnection(tw_dev, 1, 0, 0, 0, 0, 0, NULL, NULL, NULL, NULL, NULL)) {
2211*4882a593Smuzhiyun 		TW_PRINTK(tw_dev->host, TW_DRIVER, 0x38, "Connection shutdown failed during suspend");
2212*4882a593Smuzhiyun 	} else {
2213*4882a593Smuzhiyun 		printk(KERN_WARNING "3w-9xxx: Suspend complete.\n");
2214*4882a593Smuzhiyun 	}
2215*4882a593Smuzhiyun 	TW_CLEAR_ALL_INTERRUPTS(tw_dev);
2216*4882a593Smuzhiyun 
2217*4882a593Smuzhiyun 	pci_save_state(pdev);
2218*4882a593Smuzhiyun 	pci_disable_device(pdev);
2219*4882a593Smuzhiyun 	pci_set_power_state(pdev, pci_choose_state(pdev, state));
2220*4882a593Smuzhiyun 
2221*4882a593Smuzhiyun 	return 0;
2222*4882a593Smuzhiyun } /* End twa_suspend() */
2223*4882a593Smuzhiyun 
2224*4882a593Smuzhiyun /* This function is called on PCI resume */
twa_resume(struct pci_dev * pdev)2225*4882a593Smuzhiyun static int twa_resume(struct pci_dev *pdev)
2226*4882a593Smuzhiyun {
2227*4882a593Smuzhiyun 	int retval = 0;
2228*4882a593Smuzhiyun 	struct Scsi_Host *host = pci_get_drvdata(pdev);
2229*4882a593Smuzhiyun 	TW_Device_Extension *tw_dev = (TW_Device_Extension *)host->hostdata;
2230*4882a593Smuzhiyun 
2231*4882a593Smuzhiyun 	printk(KERN_WARNING "3w-9xxx: Resuming host %d.\n", tw_dev->host->host_no);
2232*4882a593Smuzhiyun 	pci_set_power_state(pdev, PCI_D0);
2233*4882a593Smuzhiyun 	pci_enable_wake(pdev, PCI_D0, 0);
2234*4882a593Smuzhiyun 	pci_restore_state(pdev);
2235*4882a593Smuzhiyun 
2236*4882a593Smuzhiyun 	retval = pci_enable_device(pdev);
2237*4882a593Smuzhiyun 	if (retval) {
2238*4882a593Smuzhiyun 		TW_PRINTK(tw_dev->host, TW_DRIVER, 0x39, "Enable device failed during resume");
2239*4882a593Smuzhiyun 		return retval;
2240*4882a593Smuzhiyun 	}
2241*4882a593Smuzhiyun 
2242*4882a593Smuzhiyun 	pci_set_master(pdev);
2243*4882a593Smuzhiyun 	pci_try_set_mwi(pdev);
2244*4882a593Smuzhiyun 
2245*4882a593Smuzhiyun 	retval = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64));
2246*4882a593Smuzhiyun 	if (retval)
2247*4882a593Smuzhiyun 		retval = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32));
2248*4882a593Smuzhiyun 	if (retval) {
2249*4882a593Smuzhiyun 		TW_PRINTK(host, TW_DRIVER, 0x40, "Failed to set dma mask during resume");
2250*4882a593Smuzhiyun 		retval = -ENODEV;
2251*4882a593Smuzhiyun 		goto out_disable_device;
2252*4882a593Smuzhiyun 	}
2253*4882a593Smuzhiyun 
2254*4882a593Smuzhiyun 	/* Initialize the card */
2255*4882a593Smuzhiyun 	if (twa_reset_sequence(tw_dev, 0)) {
2256*4882a593Smuzhiyun 		retval = -ENODEV;
2257*4882a593Smuzhiyun 		goto out_disable_device;
2258*4882a593Smuzhiyun 	}
2259*4882a593Smuzhiyun 
2260*4882a593Smuzhiyun 	/* Now setup the interrupt handler */
2261*4882a593Smuzhiyun 	retval = request_irq(pdev->irq, twa_interrupt, IRQF_SHARED, "3w-9xxx", tw_dev);
2262*4882a593Smuzhiyun 	if (retval) {
2263*4882a593Smuzhiyun 		TW_PRINTK(tw_dev->host, TW_DRIVER, 0x42, "Error requesting IRQ during resume");
2264*4882a593Smuzhiyun 		retval = -ENODEV;
2265*4882a593Smuzhiyun 		goto out_disable_device;
2266*4882a593Smuzhiyun 	}
2267*4882a593Smuzhiyun 
2268*4882a593Smuzhiyun 	/* Now enable MSI if enabled */
2269*4882a593Smuzhiyun 	if (test_bit(TW_USING_MSI, &tw_dev->flags))
2270*4882a593Smuzhiyun 		pci_enable_msi(pdev);
2271*4882a593Smuzhiyun 
2272*4882a593Smuzhiyun 	/* Re-enable interrupts on the card */
2273*4882a593Smuzhiyun 	TW_ENABLE_AND_CLEAR_INTERRUPTS(tw_dev);
2274*4882a593Smuzhiyun 
2275*4882a593Smuzhiyun 	printk(KERN_WARNING "3w-9xxx: Resume complete.\n");
2276*4882a593Smuzhiyun 	return 0;
2277*4882a593Smuzhiyun 
2278*4882a593Smuzhiyun out_disable_device:
2279*4882a593Smuzhiyun 	scsi_remove_host(host);
2280*4882a593Smuzhiyun 	pci_disable_device(pdev);
2281*4882a593Smuzhiyun 
2282*4882a593Smuzhiyun 	return retval;
2283*4882a593Smuzhiyun } /* End twa_resume() */
2284*4882a593Smuzhiyun #endif
2285*4882a593Smuzhiyun 
2286*4882a593Smuzhiyun /* PCI Devices supported by this driver */
2287*4882a593Smuzhiyun static struct pci_device_id twa_pci_tbl[] = {
2288*4882a593Smuzhiyun 	{ PCI_VENDOR_ID_3WARE, PCI_DEVICE_ID_3WARE_9000,
2289*4882a593Smuzhiyun 	  PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
2290*4882a593Smuzhiyun 	{ PCI_VENDOR_ID_3WARE, PCI_DEVICE_ID_3WARE_9550SX,
2291*4882a593Smuzhiyun 	  PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
2292*4882a593Smuzhiyun 	{ PCI_VENDOR_ID_3WARE, PCI_DEVICE_ID_3WARE_9650SE,
2293*4882a593Smuzhiyun 	  PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
2294*4882a593Smuzhiyun 	{ PCI_VENDOR_ID_3WARE, PCI_DEVICE_ID_3WARE_9690SA,
2295*4882a593Smuzhiyun 	  PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
2296*4882a593Smuzhiyun 	{ }
2297*4882a593Smuzhiyun };
2298*4882a593Smuzhiyun MODULE_DEVICE_TABLE(pci, twa_pci_tbl);
2299*4882a593Smuzhiyun 
2300*4882a593Smuzhiyun /* pci_driver initializer */
2301*4882a593Smuzhiyun static struct pci_driver twa_driver = {
2302*4882a593Smuzhiyun 	.name		= "3w-9xxx",
2303*4882a593Smuzhiyun 	.id_table	= twa_pci_tbl,
2304*4882a593Smuzhiyun 	.probe		= twa_probe,
2305*4882a593Smuzhiyun 	.remove		= twa_remove,
2306*4882a593Smuzhiyun #ifdef CONFIG_PM
2307*4882a593Smuzhiyun 	.suspend	= twa_suspend,
2308*4882a593Smuzhiyun 	.resume		= twa_resume,
2309*4882a593Smuzhiyun #endif
2310*4882a593Smuzhiyun 	.shutdown	= twa_shutdown
2311*4882a593Smuzhiyun };
2312*4882a593Smuzhiyun 
2313*4882a593Smuzhiyun /* This function is called on driver initialization */
twa_init(void)2314*4882a593Smuzhiyun static int __init twa_init(void)
2315*4882a593Smuzhiyun {
2316*4882a593Smuzhiyun 	printk(KERN_WARNING "3ware 9000 Storage Controller device driver for Linux v%s.\n", TW_DRIVER_VERSION);
2317*4882a593Smuzhiyun 
2318*4882a593Smuzhiyun 	return pci_register_driver(&twa_driver);
2319*4882a593Smuzhiyun } /* End twa_init() */
2320*4882a593Smuzhiyun 
2321*4882a593Smuzhiyun /* This function is called on driver exit */
twa_exit(void)2322*4882a593Smuzhiyun static void __exit twa_exit(void)
2323*4882a593Smuzhiyun {
2324*4882a593Smuzhiyun 	pci_unregister_driver(&twa_driver);
2325*4882a593Smuzhiyun } /* End twa_exit() */
2326*4882a593Smuzhiyun 
2327*4882a593Smuzhiyun module_init(twa_init);
2328*4882a593Smuzhiyun module_exit(twa_exit);
2329*4882a593Smuzhiyun 
2330