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