SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/scsi/3w-9xxx.c

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