1859 lines · c
1/*2 3w-sas.c -- LSI 3ware SAS/SATA-RAID Controller device driver for Linux.3 4 Written By: Adam Radford <aradford@gmail.com>5 6 Copyright (C) 2009 LSI Corporation.7 8 This program is free software; you can redistribute it and/or modify9 it under the terms of the GNU General Public License as published by10 the Free Software Foundation; version 2 of the License.11 12 This program is distributed in the hope that it will be useful,13 but WITHOUT ANY WARRANTY; without even the implied warranty of14 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the15 GNU General Public License for more details.16 17 NO WARRANTY18 THE PROGRAM IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OR19 CONDITIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED INCLUDING, WITHOUT20 LIMITATION, ANY WARRANTIES OR CONDITIONS OF TITLE, NON-INFRINGEMENT,21 MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE. Each Recipient is22 solely responsible for determining the appropriateness of using and23 distributing the Program and assumes all risks associated with its24 exercise of rights under this Agreement, including but not limited to25 the risks and costs of program errors, damage to or loss of data,26 programs or equipment, and unavailability or interruption of operations.27 28 DISCLAIMER OF LIABILITY29 NEITHER RECIPIENT NOR ANY CONTRIBUTORS SHALL HAVE ANY LIABILITY FOR ANY30 DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL31 DAMAGES (INCLUDING WITHOUT LIMITATION LOST PROFITS), HOWEVER CAUSED AND32 ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR33 TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE34 USE OR DISTRIBUTION OF THE PROGRAM OR THE EXERCISE OF ANY RIGHTS GRANTED35 HEREUNDER, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGES36 37 You should have received a copy of the GNU General Public License38 along with this program; if not, write to the Free Software39 Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA40 41 Controllers supported by this driver:42 43 LSI 3ware 9750 6Gb/s SAS/SATA-RAID44 45 Bugs/Comments/Suggestions should be mailed to:46 aradford@gmail.com47 48 History49 -------50 3.26.02.000 - Initial driver release.51*/52 53#include <linux/module.h>54#include <linux/reboot.h>55#include <linux/spinlock.h>56#include <linux/interrupt.h>57#include <linux/moduleparam.h>58#include <linux/errno.h>59#include <linux/types.h>60#include <linux/delay.h>61#include <linux/pci.h>62#include <linux/time.h>63#include <linux/mutex.h>64#include <linux/slab.h>65#include <asm/io.h>66#include <asm/irq.h>67#include <linux/uaccess.h>68#include <scsi/scsi.h>69#include <scsi/scsi_host.h>70#include <scsi/scsi_tcq.h>71#include <scsi/scsi_cmnd.h>72#include "3w-sas.h"73 74/* Globals */75#define TW_DRIVER_VERSION "3.26.02.000"76static DEFINE_MUTEX(twl_chrdev_mutex);77static TW_Device_Extension *twl_device_extension_list[TW_MAX_SLOT];78static unsigned int twl_device_extension_count;79static int twl_major = -1;80extern struct timezone sys_tz;81 82/* Module parameters */83MODULE_AUTHOR ("LSI");84MODULE_DESCRIPTION ("LSI 3ware SAS/SATA-RAID Linux Driver");85MODULE_LICENSE("GPL");86MODULE_VERSION(TW_DRIVER_VERSION);87 88static int use_msi;89module_param(use_msi, int, S_IRUGO);90MODULE_PARM_DESC(use_msi, "Use Message Signaled Interrupts. Default: 0");91 92/* Function prototypes */93static int twl_reset_device_extension(TW_Device_Extension *tw_dev, int ioctl_reset);94 95/* Functions */96 97/* This function returns AENs through sysfs */98static ssize_t twl_sysfs_aen_read(struct file *filp, struct kobject *kobj,99 struct bin_attribute *bin_attr,100 char *outbuf, loff_t offset, size_t count)101{102 struct device *dev = container_of(kobj, struct device, kobj);103 struct Scsi_Host *shost = class_to_shost(dev);104 TW_Device_Extension *tw_dev = (TW_Device_Extension *)shost->hostdata;105 unsigned long flags = 0;106 ssize_t ret;107 108 if (!capable(CAP_SYS_ADMIN))109 return -EACCES;110 111 spin_lock_irqsave(tw_dev->host->host_lock, flags);112 ret = memory_read_from_buffer(outbuf, count, &offset, tw_dev->event_queue[0], sizeof(TW_Event) * TW_Q_LENGTH);113 spin_unlock_irqrestore(tw_dev->host->host_lock, flags);114 115 return ret;116} /* End twl_sysfs_aen_read() */117 118/* aen_read sysfs attribute initializer */119static struct bin_attribute twl_sysfs_aen_read_attr = {120 .attr = {121 .name = "3ware_aen_read",122 .mode = S_IRUSR,123 },124 .size = 0,125 .read = twl_sysfs_aen_read126};127 128/* This function returns driver compatibility info through sysfs */129static ssize_t twl_sysfs_compat_info(struct file *filp, struct kobject *kobj,130 struct bin_attribute *bin_attr,131 char *outbuf, loff_t offset, size_t count)132{133 struct device *dev = container_of(kobj, struct device, kobj);134 struct Scsi_Host *shost = class_to_shost(dev);135 TW_Device_Extension *tw_dev = (TW_Device_Extension *)shost->hostdata;136 unsigned long flags = 0;137 ssize_t ret;138 139 if (!capable(CAP_SYS_ADMIN))140 return -EACCES;141 142 spin_lock_irqsave(tw_dev->host->host_lock, flags);143 ret = memory_read_from_buffer(outbuf, count, &offset, &tw_dev->tw_compat_info, sizeof(TW_Compatibility_Info));144 spin_unlock_irqrestore(tw_dev->host->host_lock, flags);145 146 return ret;147} /* End twl_sysfs_compat_info() */148 149/* compat_info sysfs attribute initializer */150static struct bin_attribute twl_sysfs_compat_info_attr = {151 .attr = {152 .name = "3ware_compat_info",153 .mode = S_IRUSR,154 },155 .size = 0,156 .read = twl_sysfs_compat_info157};158 159/* Show some statistics about the card */160static ssize_t twl_show_stats(struct device *dev,161 struct device_attribute *attr, char *buf)162{163 struct Scsi_Host *host = class_to_shost(dev);164 TW_Device_Extension *tw_dev = (TW_Device_Extension *)host->hostdata;165 unsigned long flags = 0;166 ssize_t len;167 168 spin_lock_irqsave(tw_dev->host->host_lock, flags);169 len = sysfs_emit(buf, "3w-sas Driver version: %s\n"170 "Current commands posted: %4d\n"171 "Max commands posted: %4d\n"172 "Last sgl length: %4d\n"173 "Max sgl length: %4d\n"174 "Last sector count: %4d\n"175 "Max sector count: %4d\n"176 "SCSI Host Resets: %4d\n"177 "AEN's: %4d\n",178 TW_DRIVER_VERSION,179 tw_dev->posted_request_count,180 tw_dev->max_posted_request_count,181 tw_dev->sgl_entries,182 tw_dev->max_sgl_entries,183 tw_dev->sector_count,184 tw_dev->max_sector_count,185 tw_dev->num_resets,186 tw_dev->aen_count);187 spin_unlock_irqrestore(tw_dev->host->host_lock, flags);188 return len;189} /* End twl_show_stats() */190 191/* stats sysfs attribute initializer */192static struct device_attribute twl_host_stats_attr = {193 .attr = {194 .name = "3ware_stats",195 .mode = S_IRUGO,196 },197 .show = twl_show_stats198};199 200/* Host attributes initializer */201static struct attribute *twl_host_attrs[] = {202 &twl_host_stats_attr.attr,203 NULL,204};205 206ATTRIBUTE_GROUPS(twl_host);207 208/* This function will look up an AEN severity string */209static char *twl_aen_severity_lookup(unsigned char severity_code)210{211 char *retval = NULL;212 213 if ((severity_code < (unsigned char) TW_AEN_SEVERITY_ERROR) ||214 (severity_code > (unsigned char) TW_AEN_SEVERITY_DEBUG))215 goto out;216 217 retval = twl_aen_severity_table[severity_code];218out:219 return retval;220} /* End twl_aen_severity_lookup() */221 222/* This function will queue an event */223static void twl_aen_queue_event(TW_Device_Extension *tw_dev, TW_Command_Apache_Header *header)224{225 u32 local_time;226 TW_Event *event;227 unsigned short aen;228 char host[16];229 char *error_str;230 231 tw_dev->aen_count++;232 233 /* Fill out event info */234 event = tw_dev->event_queue[tw_dev->error_index];235 236 host[0] = '\0';237 if (tw_dev->host)238 sprintf(host, " scsi%d:", tw_dev->host->host_no);239 240 aen = le16_to_cpu(header->status_block.error);241 memset(event, 0, sizeof(TW_Event));242 243 event->severity = TW_SEV_OUT(header->status_block.severity__reserved);244 /* event->time_stamp_sec overflows in y2106 */245 local_time = (u32)(ktime_get_real_seconds() - (sys_tz.tz_minuteswest * 60));246 event->time_stamp_sec = local_time;247 event->aen_code = aen;248 event->retrieved = TW_AEN_NOT_RETRIEVED;249 event->sequence_id = tw_dev->error_sequence_id;250 tw_dev->error_sequence_id++;251 252 /* Check for embedded error string */253 error_str = &(header->err_specific_desc[strlen(header->err_specific_desc)+1]);254 255 header->err_specific_desc[sizeof(header->err_specific_desc) - 1] = '\0';256 event->parameter_len = strlen(header->err_specific_desc);257 memcpy(event->parameter_data, header->err_specific_desc, event->parameter_len + 1 + strlen(error_str));258 if (event->severity != TW_AEN_SEVERITY_DEBUG)259 printk(KERN_WARNING "3w-sas:%s AEN: %s (0x%02X:0x%04X): %s:%s.\n",260 host,261 twl_aen_severity_lookup(TW_SEV_OUT(header->status_block.severity__reserved)),262 TW_MESSAGE_SOURCE_CONTROLLER_EVENT, aen, error_str,263 header->err_specific_desc);264 else265 tw_dev->aen_count--;266 267 tw_dev->error_index = (tw_dev->error_index + 1 ) % TW_Q_LENGTH;268} /* End twl_aen_queue_event() */269 270/* This function will attempt to post a command packet to the board */271static int twl_post_command_packet(TW_Device_Extension *tw_dev, int request_id)272{273 dma_addr_t command_que_value;274 275 command_que_value = tw_dev->command_packet_phys[request_id];276 command_que_value += TW_COMMAND_OFFSET;277 278 /* First write upper 4 bytes */279 writel((u32)((u64)command_que_value >> 32), TWL_HIBQPH_REG_ADDR(tw_dev));280 /* Then the lower 4 bytes */281 writel((u32)(command_que_value | TWL_PULL_MODE), TWL_HIBQPL_REG_ADDR(tw_dev));282 283 tw_dev->state[request_id] = TW_S_POSTED;284 tw_dev->posted_request_count++;285 if (tw_dev->posted_request_count > tw_dev->max_posted_request_count)286 tw_dev->max_posted_request_count = tw_dev->posted_request_count;287 288 return 0;289} /* End twl_post_command_packet() */290 291/* This function hands scsi cdb's to the firmware */292static int twl_scsiop_execute_scsi(TW_Device_Extension *tw_dev, int request_id,293 unsigned char *cdb, int use_sg,294 TW_SG_Entry_ISO *sglistarg)295{296 TW_Command_Full *full_command_packet;297 TW_Command_Apache *command_packet;298 int i, sg_count;299 struct scsi_cmnd *srb = NULL;300 struct scatterlist *sg;301 int retval = 1;302 303 if (tw_dev->srb[request_id])304 srb = tw_dev->srb[request_id];305 306 /* Initialize command packet */307 full_command_packet = tw_dev->command_packet_virt[request_id];308 full_command_packet->header.header_desc.size_header = 128;309 full_command_packet->header.status_block.error = 0;310 full_command_packet->header.status_block.severity__reserved = 0;311 312 command_packet = &full_command_packet->command.newcommand;313 command_packet->status = 0;314 command_packet->opcode__reserved = TW_OPRES_IN(0, TW_OP_EXECUTE_SCSI);315 316 /* We forced 16 byte cdb use earlier */317 if (!cdb)318 memcpy(command_packet->cdb, srb->cmnd, TW_MAX_CDB_LEN);319 else320 memcpy(command_packet->cdb, cdb, TW_MAX_CDB_LEN);321 322 if (srb) {323 command_packet->unit = srb->device->id;324 command_packet->request_id__lunl =325 cpu_to_le16(TW_REQ_LUN_IN(srb->device->lun, request_id));326 } else {327 command_packet->request_id__lunl =328 cpu_to_le16(TW_REQ_LUN_IN(0, request_id));329 command_packet->unit = 0;330 }331 332 command_packet->sgl_offset = 16;333 334 if (!sglistarg) {335 /* Map sglist from scsi layer to cmd packet */336 if (scsi_sg_count(srb)) {337 sg_count = scsi_dma_map(srb);338 if (sg_count <= 0)339 goto out;340 341 scsi_for_each_sg(srb, sg, sg_count, i) {342 command_packet->sg_list[i].address = TW_CPU_TO_SGL(sg_dma_address(sg));343 command_packet->sg_list[i].length = TW_CPU_TO_SGL(sg_dma_len(sg));344 }345 command_packet->sgl_entries__lunh = cpu_to_le16(TW_REQ_LUN_IN((srb->device->lun >> 4), scsi_sg_count(tw_dev->srb[request_id])));346 }347 } else {348 /* Internal cdb post */349 for (i = 0; i < use_sg; i++) {350 command_packet->sg_list[i].address = TW_CPU_TO_SGL(sglistarg[i].address);351 command_packet->sg_list[i].length = TW_CPU_TO_SGL(sglistarg[i].length);352 }353 command_packet->sgl_entries__lunh = cpu_to_le16(TW_REQ_LUN_IN(0, use_sg));354 }355 356 /* Update some stats */357 if (srb) {358 tw_dev->sector_count = scsi_bufflen(srb) / 512;359 if (tw_dev->sector_count > tw_dev->max_sector_count)360 tw_dev->max_sector_count = tw_dev->sector_count;361 tw_dev->sgl_entries = scsi_sg_count(srb);362 if (tw_dev->sgl_entries > tw_dev->max_sgl_entries)363 tw_dev->max_sgl_entries = tw_dev->sgl_entries;364 }365 366 /* Now post the command to the board */367 retval = twl_post_command_packet(tw_dev, request_id);368 369out:370 return retval;371} /* End twl_scsiop_execute_scsi() */372 373/* This function will read the aen queue from the isr */374static int twl_aen_read_queue(TW_Device_Extension *tw_dev, int request_id)375{376 unsigned char cdb[TW_MAX_CDB_LEN];377 TW_SG_Entry_ISO sglist[1];378 TW_Command_Full *full_command_packet;379 int retval = 1;380 381 full_command_packet = tw_dev->command_packet_virt[request_id];382 memset(full_command_packet, 0, sizeof(TW_Command_Full));383 384 /* Initialize cdb */385 memset(&cdb, 0, TW_MAX_CDB_LEN);386 cdb[0] = REQUEST_SENSE; /* opcode */387 cdb[4] = TW_ALLOCATION_LENGTH; /* allocation length */388 389 /* Initialize sglist */390 memset(&sglist, 0, sizeof(TW_SG_Entry_ISO));391 sglist[0].length = TW_SECTOR_SIZE;392 sglist[0].address = tw_dev->generic_buffer_phys[request_id];393 394 /* Mark internal command */395 tw_dev->srb[request_id] = NULL;396 397 /* Now post the command packet */398 if (twl_scsiop_execute_scsi(tw_dev, request_id, cdb, 1, sglist)) {399 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x2, "Post failed while reading AEN queue");400 goto out;401 }402 retval = 0;403out:404 return retval;405} /* End twl_aen_read_queue() */406 407/* This function will sync firmware time with the host time */408static void twl_aen_sync_time(TW_Device_Extension *tw_dev, int request_id)409{410 u32 schedulertime;411 TW_Command_Full *full_command_packet;412 TW_Command *command_packet;413 TW_Param_Apache *param;414 time64_t local_time;415 416 /* Fill out the command packet */417 full_command_packet = tw_dev->command_packet_virt[request_id];418 memset(full_command_packet, 0, sizeof(TW_Command_Full));419 command_packet = &full_command_packet->command.oldcommand;420 command_packet->opcode__sgloffset = TW_OPSGL_IN(2, TW_OP_SET_PARAM);421 command_packet->request_id = request_id;422 command_packet->byte8_offset.param.sgl[0].address = TW_CPU_TO_SGL(tw_dev->generic_buffer_phys[request_id]);423 command_packet->byte8_offset.param.sgl[0].length = TW_CPU_TO_SGL(TW_SECTOR_SIZE);424 command_packet->size = TW_COMMAND_SIZE;425 command_packet->byte6_offset.parameter_count = cpu_to_le16(1);426 427 /* Setup the param */428 param = (TW_Param_Apache *)tw_dev->generic_buffer_virt[request_id];429 memset(param, 0, TW_SECTOR_SIZE);430 param->table_id = cpu_to_le16(TW_TIMEKEEP_TABLE | 0x8000); /* Controller time keep table */431 param->parameter_id = cpu_to_le16(0x3); /* SchedulerTime */432 param->parameter_size_bytes = cpu_to_le16(4);433 434 /* Convert system time in UTC to local time seconds since last435 Sunday 12:00AM */436 local_time = (ktime_get_real_seconds() - (sys_tz.tz_minuteswest * 60));437 div_u64_rem(local_time - (3 * 86400), 604800, &schedulertime);438 schedulertime = cpu_to_le32(schedulertime);439 440 memcpy(param->data, &schedulertime, sizeof(u32));441 442 /* Mark internal command */443 tw_dev->srb[request_id] = NULL;444 445 /* Now post the command */446 twl_post_command_packet(tw_dev, request_id);447} /* End twl_aen_sync_time() */448 449/* This function will assign an available request id */450static void twl_get_request_id(TW_Device_Extension *tw_dev, int *request_id)451{452 *request_id = tw_dev->free_queue[tw_dev->free_head];453 tw_dev->free_head = (tw_dev->free_head + 1) % TW_Q_LENGTH;454 tw_dev->state[*request_id] = TW_S_STARTED;455} /* End twl_get_request_id() */456 457/* This function will free a request id */458static void twl_free_request_id(TW_Device_Extension *tw_dev, int request_id)459{460 tw_dev->free_queue[tw_dev->free_tail] = request_id;461 tw_dev->state[request_id] = TW_S_FINISHED;462 tw_dev->free_tail = (tw_dev->free_tail + 1) % TW_Q_LENGTH;463} /* End twl_free_request_id() */464 465/* This function will complete an aen request from the isr */466static int twl_aen_complete(TW_Device_Extension *tw_dev, int request_id)467{468 TW_Command_Full *full_command_packet;469 TW_Command *command_packet;470 TW_Command_Apache_Header *header;471 unsigned short aen;472 int retval = 1;473 474 header = (TW_Command_Apache_Header *)tw_dev->generic_buffer_virt[request_id];475 tw_dev->posted_request_count--;476 aen = le16_to_cpu(header->status_block.error);477 full_command_packet = tw_dev->command_packet_virt[request_id];478 command_packet = &full_command_packet->command.oldcommand;479 480 /* First check for internal completion of set param for time sync */481 if (TW_OP_OUT(command_packet->opcode__sgloffset) == TW_OP_SET_PARAM) {482 /* Keep reading the queue in case there are more aen's */483 if (twl_aen_read_queue(tw_dev, request_id))484 goto out2;485 else {486 retval = 0;487 goto out;488 }489 }490 491 switch (aen) {492 case TW_AEN_QUEUE_EMPTY:493 /* Quit reading the queue if this is the last one */494 break;495 case TW_AEN_SYNC_TIME_WITH_HOST:496 twl_aen_sync_time(tw_dev, request_id);497 retval = 0;498 goto out;499 default:500 twl_aen_queue_event(tw_dev, header);501 502 /* If there are more aen's, keep reading the queue */503 if (twl_aen_read_queue(tw_dev, request_id))504 goto out2;505 else {506 retval = 0;507 goto out;508 }509 }510 retval = 0;511out2:512 tw_dev->state[request_id] = TW_S_COMPLETED;513 twl_free_request_id(tw_dev, request_id);514 clear_bit(TW_IN_ATTENTION_LOOP, &tw_dev->flags);515out:516 return retval;517} /* End twl_aen_complete() */518 519/* This function will poll for a response */520static int twl_poll_response(TW_Device_Extension *tw_dev, int request_id, int seconds)521{522 unsigned long before;523 dma_addr_t mfa;524 u32 regh, regl;525 u32 response;526 int retval = 1;527 int found = 0;528 529 before = jiffies;530 531 while (!found) {532 if (sizeof(dma_addr_t) > 4) {533 regh = readl(TWL_HOBQPH_REG_ADDR(tw_dev));534 regl = readl(TWL_HOBQPL_REG_ADDR(tw_dev));535 mfa = ((u64)regh << 32) | regl;536 } else537 mfa = readl(TWL_HOBQPL_REG_ADDR(tw_dev));538 539 response = (u32)mfa;540 541 if (TW_RESID_OUT(response) == request_id)542 found = 1;543 544 if (time_after(jiffies, before + HZ * seconds))545 goto out;546 547 msleep(50);548 }549 retval = 0;550out:551 return retval;552} /* End twl_poll_response() */553 554/* This function will drain the aen queue */555static int twl_aen_drain_queue(TW_Device_Extension *tw_dev, int no_check_reset)556{557 int request_id = 0;558 unsigned char cdb[TW_MAX_CDB_LEN];559 TW_SG_Entry_ISO sglist[1];560 int finished = 0, count = 0;561 TW_Command_Full *full_command_packet;562 TW_Command_Apache_Header *header;563 unsigned short aen;564 int first_reset = 0, queue = 0, retval = 1;565 566 if (no_check_reset)567 first_reset = 0;568 else569 first_reset = 1;570 571 full_command_packet = tw_dev->command_packet_virt[request_id];572 memset(full_command_packet, 0, sizeof(TW_Command_Full));573 574 /* Initialize cdb */575 memset(&cdb, 0, TW_MAX_CDB_LEN);576 cdb[0] = REQUEST_SENSE; /* opcode */577 cdb[4] = TW_ALLOCATION_LENGTH; /* allocation length */578 579 /* Initialize sglist */580 memset(&sglist, 0, sizeof(TW_SG_Entry_ISO));581 sglist[0].length = TW_SECTOR_SIZE;582 sglist[0].address = tw_dev->generic_buffer_phys[request_id];583 584 /* Mark internal command */585 tw_dev->srb[request_id] = NULL;586 587 do {588 /* Send command to the board */589 if (twl_scsiop_execute_scsi(tw_dev, request_id, cdb, 1, sglist)) {590 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x3, "Error posting request sense");591 goto out;592 }593 594 /* Now poll for completion */595 if (twl_poll_response(tw_dev, request_id, 30)) {596 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x4, "No valid response while draining AEN queue");597 tw_dev->posted_request_count--;598 goto out;599 }600 601 tw_dev->posted_request_count--;602 header = (TW_Command_Apache_Header *)tw_dev->generic_buffer_virt[request_id];603 aen = le16_to_cpu(header->status_block.error);604 queue = 0;605 count++;606 607 switch (aen) {608 case TW_AEN_QUEUE_EMPTY:609 if (first_reset != 1)610 goto out;611 else612 finished = 1;613 break;614 case TW_AEN_SOFT_RESET:615 if (first_reset == 0)616 first_reset = 1;617 else618 queue = 1;619 break;620 case TW_AEN_SYNC_TIME_WITH_HOST:621 break;622 default:623 queue = 1;624 }625 626 /* Now queue an event info */627 if (queue)628 twl_aen_queue_event(tw_dev, header);629 } while ((finished == 0) && (count < TW_MAX_AEN_DRAIN));630 631 if (count == TW_MAX_AEN_DRAIN)632 goto out;633 634 retval = 0;635out:636 tw_dev->state[request_id] = TW_S_INITIAL;637 return retval;638} /* End twl_aen_drain_queue() */639 640/* This function will allocate memory and check if it is correctly aligned */641static int twl_allocate_memory(TW_Device_Extension *tw_dev, int size, int which)642{643 int i;644 dma_addr_t dma_handle;645 unsigned long *cpu_addr;646 int retval = 1;647 648 cpu_addr = dma_alloc_coherent(&tw_dev->tw_pci_dev->dev,649 size * TW_Q_LENGTH, &dma_handle,650 GFP_KERNEL);651 if (!cpu_addr) {652 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x5, "Memory allocation failed");653 goto out;654 }655 656 for (i = 0; i < TW_Q_LENGTH; i++) {657 switch(which) {658 case 0:659 tw_dev->command_packet_phys[i] = dma_handle+(i*size);660 tw_dev->command_packet_virt[i] = (TW_Command_Full *)((unsigned char *)cpu_addr + (i*size));661 break;662 case 1:663 tw_dev->generic_buffer_phys[i] = dma_handle+(i*size);664 tw_dev->generic_buffer_virt[i] = (unsigned long *)((unsigned char *)cpu_addr + (i*size));665 break;666 case 2:667 tw_dev->sense_buffer_phys[i] = dma_handle+(i*size);668 tw_dev->sense_buffer_virt[i] = (TW_Command_Apache_Header *)((unsigned char *)cpu_addr + (i*size));669 break;670 }671 }672 retval = 0;673out:674 return retval;675} /* End twl_allocate_memory() */676 677/* This function will load the request id and various sgls for ioctls */678static void twl_load_sgl(TW_Device_Extension *tw_dev, TW_Command_Full *full_command_packet, int request_id, dma_addr_t dma_handle, int length)679{680 TW_Command *oldcommand;681 TW_Command_Apache *newcommand;682 TW_SG_Entry_ISO *sgl;683 unsigned int pae = 0;684 685 if ((sizeof(long) < 8) && (sizeof(dma_addr_t) > 4))686 pae = 1;687 688 if (TW_OP_OUT(full_command_packet->command.newcommand.opcode__reserved) == TW_OP_EXECUTE_SCSI) {689 newcommand = &full_command_packet->command.newcommand;690 newcommand->request_id__lunl =691 cpu_to_le16(TW_REQ_LUN_IN(TW_LUN_OUT(newcommand->request_id__lunl), request_id));692 if (length) {693 newcommand->sg_list[0].address = TW_CPU_TO_SGL(dma_handle + sizeof(TW_Ioctl_Buf_Apache));694 newcommand->sg_list[0].length = TW_CPU_TO_SGL(length);695 }696 newcommand->sgl_entries__lunh =697 cpu_to_le16(TW_REQ_LUN_IN(TW_LUN_OUT(newcommand->sgl_entries__lunh), length ? 1 : 0));698 } else {699 oldcommand = &full_command_packet->command.oldcommand;700 oldcommand->request_id = request_id;701 702 if (TW_SGL_OUT(oldcommand->opcode__sgloffset)) {703 /* Load the sg list */704 sgl = (TW_SG_Entry_ISO *)((u32 *)oldcommand+oldcommand->size - (sizeof(TW_SG_Entry_ISO)/4) + pae + (sizeof(dma_addr_t) > 4 ? 1 : 0));705 sgl->address = TW_CPU_TO_SGL(dma_handle + sizeof(TW_Ioctl_Buf_Apache));706 sgl->length = TW_CPU_TO_SGL(length);707 oldcommand->size += pae;708 oldcommand->size += sizeof(dma_addr_t) > 4 ? 1 : 0;709 }710 }711} /* End twl_load_sgl() */712 713/* This function handles ioctl for the character device714 This interface is used by smartmontools open source software */715static long twl_chrdev_ioctl(struct file *file, unsigned int cmd, unsigned long arg)716{717 long timeout;718 unsigned long *cpu_addr, data_buffer_length_adjusted = 0, flags = 0;719 dma_addr_t dma_handle;720 int request_id = 0;721 TW_Ioctl_Driver_Command driver_command;722 struct inode *inode = file_inode(file);723 TW_Ioctl_Buf_Apache *tw_ioctl;724 TW_Command_Full *full_command_packet;725 TW_Device_Extension *tw_dev = twl_device_extension_list[iminor(inode)];726 int retval = -EFAULT;727 void __user *argp = (void __user *)arg;728 729 mutex_lock(&twl_chrdev_mutex);730 731 /* Only let one of these through at a time */732 if (mutex_lock_interruptible(&tw_dev->ioctl_lock)) {733 retval = -EINTR;734 goto out;735 }736 737 /* First copy down the driver command */738 if (copy_from_user(&driver_command, argp, sizeof(TW_Ioctl_Driver_Command)))739 goto out2;740 741 /* Check data buffer size */742 if (driver_command.buffer_length > TW_MAX_SECTORS * 2048) {743 retval = -EINVAL;744 goto out2;745 }746 747 /* Hardware can only do multiple of 512 byte transfers */748 data_buffer_length_adjusted = (driver_command.buffer_length + 511) & ~511;749 750 /* Now allocate ioctl buf memory */751 cpu_addr = dma_alloc_coherent(&tw_dev->tw_pci_dev->dev, data_buffer_length_adjusted + sizeof(TW_Ioctl_Buf_Apache), &dma_handle, GFP_KERNEL);752 if (!cpu_addr) {753 retval = -ENOMEM;754 goto out2;755 }756 757 tw_ioctl = (TW_Ioctl_Buf_Apache *)cpu_addr;758 759 /* Now copy down the entire ioctl */760 if (copy_from_user(tw_ioctl, argp, driver_command.buffer_length + sizeof(TW_Ioctl_Buf_Apache)))761 goto out3;762 763 /* See which ioctl we are doing */764 switch (cmd) {765 case TW_IOCTL_FIRMWARE_PASS_THROUGH:766 spin_lock_irqsave(tw_dev->host->host_lock, flags);767 twl_get_request_id(tw_dev, &request_id);768 769 /* Flag internal command */770 tw_dev->srb[request_id] = NULL;771 772 /* Flag chrdev ioctl */773 tw_dev->chrdev_request_id = request_id;774 775 full_command_packet = (TW_Command_Full *)&tw_ioctl->firmware_command;776 777 /* Load request id and sglist for both command types */778 twl_load_sgl(tw_dev, full_command_packet, request_id, dma_handle, data_buffer_length_adjusted);779 780 memcpy(tw_dev->command_packet_virt[request_id], &(tw_ioctl->firmware_command), sizeof(TW_Command_Full));781 782 /* Now post the command packet to the controller */783 twl_post_command_packet(tw_dev, request_id);784 spin_unlock_irqrestore(tw_dev->host->host_lock, flags);785 786 timeout = TW_IOCTL_CHRDEV_TIMEOUT*HZ;787 788 /* Now wait for command to complete */789 timeout = wait_event_timeout(tw_dev->ioctl_wqueue, tw_dev->chrdev_request_id == TW_IOCTL_CHRDEV_FREE, timeout);790 791 /* We timed out, and didn't get an interrupt */792 if (tw_dev->chrdev_request_id != TW_IOCTL_CHRDEV_FREE) {793 /* Now we need to reset the board */794 printk(KERN_WARNING "3w-sas: scsi%d: WARNING: (0x%02X:0x%04X): Character ioctl (0x%x) timed out, resetting card.\n",795 tw_dev->host->host_no, TW_DRIVER, 0x6,796 cmd);797 retval = -EIO;798 twl_reset_device_extension(tw_dev, 1);799 goto out3;800 }801 802 /* Now copy in the command packet response */803 memcpy(&(tw_ioctl->firmware_command), tw_dev->command_packet_virt[request_id], sizeof(TW_Command_Full));804 805 /* Now complete the io */806 spin_lock_irqsave(tw_dev->host->host_lock, flags);807 tw_dev->posted_request_count--;808 tw_dev->state[request_id] = TW_S_COMPLETED;809 twl_free_request_id(tw_dev, request_id);810 spin_unlock_irqrestore(tw_dev->host->host_lock, flags);811 break;812 default:813 retval = -ENOTTY;814 goto out3;815 }816 817 /* Now copy the entire response to userspace */818 if (copy_to_user(argp, tw_ioctl, sizeof(TW_Ioctl_Buf_Apache) + driver_command.buffer_length) == 0)819 retval = 0;820out3:821 /* Now free ioctl buf memory */822 dma_free_coherent(&tw_dev->tw_pci_dev->dev, data_buffer_length_adjusted + sizeof(TW_Ioctl_Buf_Apache), cpu_addr, dma_handle);823out2:824 mutex_unlock(&tw_dev->ioctl_lock);825out:826 mutex_unlock(&twl_chrdev_mutex);827 return retval;828} /* End twl_chrdev_ioctl() */829 830/* This function handles open for the character device */831static int twl_chrdev_open(struct inode *inode, struct file *file)832{833 unsigned int minor_number;834 int retval = -ENODEV;835 836 if (!capable(CAP_SYS_ADMIN)) {837 retval = -EACCES;838 goto out;839 }840 841 minor_number = iminor(inode);842 if (minor_number >= twl_device_extension_count)843 goto out;844 retval = 0;845out:846 return retval;847} /* End twl_chrdev_open() */848 849/* File operations struct for character device */850static const struct file_operations twl_fops = {851 .owner = THIS_MODULE,852 .unlocked_ioctl = twl_chrdev_ioctl,853 .open = twl_chrdev_open,854 .release = NULL,855 .llseek = noop_llseek,856};857 858/* This function passes sense data from firmware to scsi layer */859static int twl_fill_sense(TW_Device_Extension *tw_dev, int i, int request_id, int copy_sense, int print_host)860{861 TW_Command_Apache_Header *header;862 TW_Command_Full *full_command_packet;863 unsigned short error;864 char *error_str;865 866 header = tw_dev->sense_buffer_virt[i];867 full_command_packet = tw_dev->command_packet_virt[request_id];868 869 /* Get embedded firmware error string */870 error_str = &(header->err_specific_desc[strlen(header->err_specific_desc) + 1]);871 872 /* Don't print error for Logical unit not supported during rollcall */873 error = le16_to_cpu(header->status_block.error);874 if ((error != TW_ERROR_LOGICAL_UNIT_NOT_SUPPORTED) && (error != TW_ERROR_UNIT_OFFLINE) && (error != TW_ERROR_INVALID_FIELD_IN_CDB)) {875 if (print_host)876 printk(KERN_WARNING "3w-sas: scsi%d: ERROR: (0x%02X:0x%04X): %s:%s.\n",877 tw_dev->host->host_no,878 TW_MESSAGE_SOURCE_CONTROLLER_ERROR,879 header->status_block.error,880 error_str,881 header->err_specific_desc);882 else883 printk(KERN_WARNING "3w-sas: ERROR: (0x%02X:0x%04X): %s:%s.\n",884 TW_MESSAGE_SOURCE_CONTROLLER_ERROR,885 header->status_block.error,886 error_str,887 header->err_specific_desc);888 }889 890 if (copy_sense) {891 memcpy(tw_dev->srb[request_id]->sense_buffer, header->sense_data, TW_SENSE_DATA_LENGTH);892 tw_dev->srb[request_id]->result = (full_command_packet->command.newcommand.status << 1);893 goto out;894 }895out:896 return 1;897} /* End twl_fill_sense() */898 899/* This function will free up device extension resources */900static void twl_free_device_extension(TW_Device_Extension *tw_dev)901{902 if (tw_dev->command_packet_virt[0])903 dma_free_coherent(&tw_dev->tw_pci_dev->dev,904 sizeof(TW_Command_Full)*TW_Q_LENGTH,905 tw_dev->command_packet_virt[0],906 tw_dev->command_packet_phys[0]);907 908 if (tw_dev->generic_buffer_virt[0])909 dma_free_coherent(&tw_dev->tw_pci_dev->dev,910 TW_SECTOR_SIZE*TW_Q_LENGTH,911 tw_dev->generic_buffer_virt[0],912 tw_dev->generic_buffer_phys[0]);913 914 if (tw_dev->sense_buffer_virt[0])915 dma_free_coherent(&tw_dev->tw_pci_dev->dev,916 sizeof(TW_Command_Apache_Header)*917 TW_Q_LENGTH,918 tw_dev->sense_buffer_virt[0],919 tw_dev->sense_buffer_phys[0]);920 921 kfree(tw_dev->event_queue[0]);922} /* End twl_free_device_extension() */923 924/* This function will get parameter table entries from the firmware */925static void *twl_get_param(TW_Device_Extension *tw_dev, int request_id, int table_id, int parameter_id, int parameter_size_bytes)926{927 TW_Command_Full *full_command_packet;928 TW_Command *command_packet;929 TW_Param_Apache *param;930 void *retval = NULL;931 932 /* Setup the command packet */933 full_command_packet = tw_dev->command_packet_virt[request_id];934 memset(full_command_packet, 0, sizeof(TW_Command_Full));935 command_packet = &full_command_packet->command.oldcommand;936 937 command_packet->opcode__sgloffset = TW_OPSGL_IN(2, TW_OP_GET_PARAM);938 command_packet->size = TW_COMMAND_SIZE;939 command_packet->request_id = request_id;940 command_packet->byte6_offset.block_count = cpu_to_le16(1);941 942 /* Now setup the param */943 param = (TW_Param_Apache *)tw_dev->generic_buffer_virt[request_id];944 memset(param, 0, TW_SECTOR_SIZE);945 param->table_id = cpu_to_le16(table_id | 0x8000);946 param->parameter_id = cpu_to_le16(parameter_id);947 param->parameter_size_bytes = cpu_to_le16(parameter_size_bytes);948 949 command_packet->byte8_offset.param.sgl[0].address = TW_CPU_TO_SGL(tw_dev->generic_buffer_phys[request_id]);950 command_packet->byte8_offset.param.sgl[0].length = TW_CPU_TO_SGL(TW_SECTOR_SIZE);951 952 /* Post the command packet to the board */953 twl_post_command_packet(tw_dev, request_id);954 955 /* Poll for completion */956 if (twl_poll_response(tw_dev, request_id, 30))957 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x7, "No valid response during get param")958 else959 retval = (void *)&(param->data[0]);960 961 tw_dev->posted_request_count--;962 tw_dev->state[request_id] = TW_S_INITIAL;963 964 return retval;965} /* End twl_get_param() */966 967/* This function will send an initconnection command to controller */968static int twl_initconnection(TW_Device_Extension *tw_dev, int message_credits,969 u32 set_features, unsigned short current_fw_srl,970 unsigned short current_fw_arch_id,971 unsigned short current_fw_branch,972 unsigned short current_fw_build,973 unsigned short *fw_on_ctlr_srl,974 unsigned short *fw_on_ctlr_arch_id,975 unsigned short *fw_on_ctlr_branch,976 unsigned short *fw_on_ctlr_build,977 u32 *init_connect_result)978{979 TW_Command_Full *full_command_packet;980 TW_Initconnect *tw_initconnect;981 int request_id = 0, retval = 1;982 983 /* Initialize InitConnection command packet */984 full_command_packet = tw_dev->command_packet_virt[request_id];985 memset(full_command_packet, 0, sizeof(TW_Command_Full));986 full_command_packet->header.header_desc.size_header = 128;987 988 tw_initconnect = (TW_Initconnect *)&full_command_packet->command.oldcommand;989 tw_initconnect->opcode__reserved = TW_OPRES_IN(0, TW_OP_INIT_CONNECTION);990 tw_initconnect->request_id = request_id;991 tw_initconnect->message_credits = cpu_to_le16(message_credits);992 tw_initconnect->features = set_features;993 994 /* Turn on 64-bit sgl support if we need to */995 tw_initconnect->features |= sizeof(dma_addr_t) > 4 ? 1 : 0;996 997 tw_initconnect->features = cpu_to_le32(tw_initconnect->features);998 999 if (set_features & TW_EXTENDED_INIT_CONNECT) {1000 tw_initconnect->size = TW_INIT_COMMAND_PACKET_SIZE_EXTENDED;1001 tw_initconnect->fw_srl = cpu_to_le16(current_fw_srl);1002 tw_initconnect->fw_arch_id = cpu_to_le16(current_fw_arch_id);1003 tw_initconnect->fw_branch = cpu_to_le16(current_fw_branch);1004 tw_initconnect->fw_build = cpu_to_le16(current_fw_build);1005 } else1006 tw_initconnect->size = TW_INIT_COMMAND_PACKET_SIZE;1007 1008 /* Send command packet to the board */1009 twl_post_command_packet(tw_dev, request_id);1010 1011 /* Poll for completion */1012 if (twl_poll_response(tw_dev, request_id, 30)) {1013 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x8, "No valid response during init connection");1014 } else {1015 if (set_features & TW_EXTENDED_INIT_CONNECT) {1016 *fw_on_ctlr_srl = le16_to_cpu(tw_initconnect->fw_srl);1017 *fw_on_ctlr_arch_id = le16_to_cpu(tw_initconnect->fw_arch_id);1018 *fw_on_ctlr_branch = le16_to_cpu(tw_initconnect->fw_branch);1019 *fw_on_ctlr_build = le16_to_cpu(tw_initconnect->fw_build);1020 *init_connect_result = le32_to_cpu(tw_initconnect->result);1021 }1022 retval = 0;1023 }1024 1025 tw_dev->posted_request_count--;1026 tw_dev->state[request_id] = TW_S_INITIAL;1027 1028 return retval;1029} /* End twl_initconnection() */1030 1031/* This function will initialize the fields of a device extension */1032static int twl_initialize_device_extension(TW_Device_Extension *tw_dev)1033{1034 int i, retval = 1;1035 1036 /* Initialize command packet buffers */1037 if (twl_allocate_memory(tw_dev, sizeof(TW_Command_Full), 0)) {1038 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x9, "Command packet memory allocation failed");1039 goto out;1040 }1041 1042 /* Initialize generic buffer */1043 if (twl_allocate_memory(tw_dev, TW_SECTOR_SIZE, 1)) {1044 TW_PRINTK(tw_dev->host, TW_DRIVER, 0xa, "Generic memory allocation failed");1045 goto out;1046 }1047 1048 /* Allocate sense buffers */1049 if (twl_allocate_memory(tw_dev, sizeof(TW_Command_Apache_Header), 2)) {1050 TW_PRINTK(tw_dev->host, TW_DRIVER, 0xb, "Sense buffer allocation failed");1051 goto out;1052 }1053 1054 /* Allocate event info space */1055 tw_dev->event_queue[0] = kcalloc(TW_Q_LENGTH, sizeof(TW_Event), GFP_KERNEL);1056 if (!tw_dev->event_queue[0]) {1057 TW_PRINTK(tw_dev->host, TW_DRIVER, 0xc, "Event info memory allocation failed");1058 goto out;1059 }1060 1061 for (i = 0; i < TW_Q_LENGTH; i++) {1062 tw_dev->event_queue[i] = (TW_Event *)((unsigned char *)tw_dev->event_queue[0] + (i * sizeof(TW_Event)));1063 tw_dev->free_queue[i] = i;1064 tw_dev->state[i] = TW_S_INITIAL;1065 }1066 1067 tw_dev->free_head = TW_Q_START;1068 tw_dev->free_tail = TW_Q_START;1069 tw_dev->error_sequence_id = 1;1070 tw_dev->chrdev_request_id = TW_IOCTL_CHRDEV_FREE;1071 1072 mutex_init(&tw_dev->ioctl_lock);1073 init_waitqueue_head(&tw_dev->ioctl_wqueue);1074 1075 retval = 0;1076out:1077 return retval;1078} /* End twl_initialize_device_extension() */1079 1080/* This function will handle attention interrupts */1081static int twl_handle_attention_interrupt(TW_Device_Extension *tw_dev)1082{1083 int retval = 1;1084 u32 request_id, doorbell;1085 1086 /* Read doorbell status */1087 doorbell = readl(TWL_HOBDB_REG_ADDR(tw_dev));1088 1089 /* Check for controller errors */1090 if (doorbell & TWL_DOORBELL_CONTROLLER_ERROR) {1091 TW_PRINTK(tw_dev->host, TW_DRIVER, 0xd, "Microcontroller Error: clearing");1092 goto out;1093 }1094 1095 /* Check if we need to perform an AEN drain */1096 if (doorbell & TWL_DOORBELL_ATTENTION_INTERRUPT) {1097 if (!(test_and_set_bit(TW_IN_ATTENTION_LOOP, &tw_dev->flags))) {1098 twl_get_request_id(tw_dev, &request_id);1099 if (twl_aen_read_queue(tw_dev, request_id)) {1100 tw_dev->state[request_id] = TW_S_COMPLETED;1101 twl_free_request_id(tw_dev, request_id);1102 clear_bit(TW_IN_ATTENTION_LOOP, &tw_dev->flags);1103 }1104 }1105 }1106 1107 retval = 0;1108out:1109 /* Clear doorbell interrupt */1110 TWL_CLEAR_DB_INTERRUPT(tw_dev);1111 1112 /* Make sure the clear was flushed by reading it back */1113 readl(TWL_HOBDBC_REG_ADDR(tw_dev));1114 1115 return retval;1116} /* End twl_handle_attention_interrupt() */1117 1118/* Interrupt service routine */1119static irqreturn_t twl_interrupt(int irq, void *dev_instance)1120{1121 TW_Device_Extension *tw_dev = (TW_Device_Extension *)dev_instance;1122 int i, handled = 0, error = 0;1123 dma_addr_t mfa = 0;1124 u32 reg, regl, regh, response, request_id = 0;1125 struct scsi_cmnd *cmd;1126 TW_Command_Full *full_command_packet;1127 1128 spin_lock(tw_dev->host->host_lock);1129 1130 /* Read host interrupt status */1131 reg = readl(TWL_HISTAT_REG_ADDR(tw_dev));1132 1133 /* Check if this is our interrupt, otherwise bail */1134 if (!(reg & TWL_HISTATUS_VALID_INTERRUPT))1135 goto twl_interrupt_bail;1136 1137 handled = 1;1138 1139 /* If we are resetting, bail */1140 if (test_bit(TW_IN_RESET, &tw_dev->flags))1141 goto twl_interrupt_bail;1142 1143 /* Attention interrupt */1144 if (reg & TWL_HISTATUS_ATTENTION_INTERRUPT) {1145 if (twl_handle_attention_interrupt(tw_dev)) {1146 TWL_MASK_INTERRUPTS(tw_dev);1147 goto twl_interrupt_bail;1148 }1149 }1150 1151 /* Response interrupt */1152 while (reg & TWL_HISTATUS_RESPONSE_INTERRUPT) {1153 if (sizeof(dma_addr_t) > 4) {1154 regh = readl(TWL_HOBQPH_REG_ADDR(tw_dev));1155 regl = readl(TWL_HOBQPL_REG_ADDR(tw_dev));1156 mfa = ((u64)regh << 32) | regl;1157 } else1158 mfa = readl(TWL_HOBQPL_REG_ADDR(tw_dev));1159 1160 error = 0;1161 response = (u32)mfa;1162 1163 /* Check for command packet error */1164 if (!TW_NOTMFA_OUT(response)) {1165 for (i=0;i<TW_Q_LENGTH;i++) {1166 if (tw_dev->sense_buffer_phys[i] == mfa) {1167 request_id = le16_to_cpu(tw_dev->sense_buffer_virt[i]->header_desc.request_id);1168 if (tw_dev->srb[request_id] != NULL)1169 error = twl_fill_sense(tw_dev, i, request_id, 1, 1);1170 else {1171 /* Skip ioctl error prints */1172 if (request_id != tw_dev->chrdev_request_id)1173 error = twl_fill_sense(tw_dev, i, request_id, 0, 1);1174 else1175 memcpy(tw_dev->command_packet_virt[request_id], tw_dev->sense_buffer_virt[i], sizeof(TW_Command_Apache_Header));1176 }1177 1178 /* Now re-post the sense buffer */1179 writel((u32)((u64)tw_dev->sense_buffer_phys[i] >> 32), TWL_HOBQPH_REG_ADDR(tw_dev));1180 writel((u32)tw_dev->sense_buffer_phys[i], TWL_HOBQPL_REG_ADDR(tw_dev));1181 break;1182 }1183 }1184 } else1185 request_id = TW_RESID_OUT(response);1186 1187 full_command_packet = tw_dev->command_packet_virt[request_id];1188 1189 /* Check for correct state */1190 if (tw_dev->state[request_id] != TW_S_POSTED) {1191 if (tw_dev->srb[request_id] != NULL) {1192 TW_PRINTK(tw_dev->host, TW_DRIVER, 0xe, "Received a request id that wasn't posted");1193 TWL_MASK_INTERRUPTS(tw_dev);1194 goto twl_interrupt_bail;1195 }1196 }1197 1198 /* Check for internal command completion */1199 if (tw_dev->srb[request_id] == NULL) {1200 if (request_id != tw_dev->chrdev_request_id) {1201 if (twl_aen_complete(tw_dev, request_id))1202 TW_PRINTK(tw_dev->host, TW_DRIVER, 0xf, "Error completing AEN during attention interrupt");1203 } else {1204 tw_dev->chrdev_request_id = TW_IOCTL_CHRDEV_FREE;1205 wake_up(&tw_dev->ioctl_wqueue);1206 }1207 } else {1208 cmd = tw_dev->srb[request_id];1209 1210 if (!error)1211 cmd->result = (DID_OK << 16);1212 1213 /* Report residual bytes for single sgl */1214 if ((scsi_sg_count(cmd) <= 1) && (full_command_packet->command.newcommand.status == 0)) {1215 if (full_command_packet->command.newcommand.sg_list[0].length < scsi_bufflen(tw_dev->srb[request_id]))1216 scsi_set_resid(cmd, scsi_bufflen(cmd) - full_command_packet->command.newcommand.sg_list[0].length);1217 }1218 1219 /* Now complete the io */1220 scsi_dma_unmap(cmd);1221 scsi_done(cmd);1222 tw_dev->state[request_id] = TW_S_COMPLETED;1223 twl_free_request_id(tw_dev, request_id);1224 tw_dev->posted_request_count--;1225 }1226 1227 /* Check for another response interrupt */1228 reg = readl(TWL_HISTAT_REG_ADDR(tw_dev));1229 }1230 1231twl_interrupt_bail:1232 spin_unlock(tw_dev->host->host_lock);1233 return IRQ_RETVAL(handled);1234} /* End twl_interrupt() */1235 1236/* This function will poll for a register change */1237static int twl_poll_register(TW_Device_Extension *tw_dev, void *reg, u32 value, u32 result, int seconds)1238{1239 unsigned long before;1240 int retval = 1;1241 u32 reg_value;1242 1243 reg_value = readl(reg);1244 before = jiffies;1245 1246 while ((reg_value & value) != result) {1247 reg_value = readl(reg);1248 if (time_after(jiffies, before + HZ * seconds))1249 goto out;1250 msleep(50);1251 }1252 retval = 0;1253out:1254 return retval;1255} /* End twl_poll_register() */1256 1257/* This function will reset a controller */1258static int twl_reset_sequence(TW_Device_Extension *tw_dev, int soft_reset)1259{1260 int retval = 1;1261 int i = 0;1262 u32 status = 0;1263 unsigned short fw_on_ctlr_srl = 0, fw_on_ctlr_arch_id = 0;1264 unsigned short fw_on_ctlr_branch = 0, fw_on_ctlr_build = 0;1265 u32 init_connect_result = 0;1266 int tries = 0;1267 int do_soft_reset = soft_reset;1268 1269 while (tries < TW_MAX_RESET_TRIES) {1270 /* Do a soft reset if one is needed */1271 if (do_soft_reset) {1272 TWL_SOFT_RESET(tw_dev);1273 1274 /* Make sure controller is in a good state */1275 if (twl_poll_register(tw_dev, TWL_SCRPD3_REG_ADDR(tw_dev), TWL_CONTROLLER_READY, 0x0, 30)) {1276 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x10, "Controller never went non-ready during reset sequence");1277 tries++;1278 continue;1279 }1280 if (twl_poll_register(tw_dev, TWL_SCRPD3_REG_ADDR(tw_dev), TWL_CONTROLLER_READY, TWL_CONTROLLER_READY, 60)) {1281 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x11, "Controller not ready during reset sequence");1282 tries++;1283 continue;1284 }1285 }1286 1287 /* Initconnect */1288 if (twl_initconnection(tw_dev, TW_INIT_MESSAGE_CREDITS,1289 TW_EXTENDED_INIT_CONNECT, TW_CURRENT_DRIVER_SRL,1290 TW_9750_ARCH_ID, TW_CURRENT_DRIVER_BRANCH,1291 TW_CURRENT_DRIVER_BUILD, &fw_on_ctlr_srl,1292 &fw_on_ctlr_arch_id, &fw_on_ctlr_branch,1293 &fw_on_ctlr_build, &init_connect_result)) {1294 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x12, "Initconnection failed while checking SRL");1295 do_soft_reset = 1;1296 tries++;1297 continue;1298 }1299 1300 /* Load sense buffers */1301 while (i < TW_Q_LENGTH) {1302 writel((u32)((u64)tw_dev->sense_buffer_phys[i] >> 32), TWL_HOBQPH_REG_ADDR(tw_dev));1303 writel((u32)tw_dev->sense_buffer_phys[i], TWL_HOBQPL_REG_ADDR(tw_dev));1304 1305 /* Check status for over-run after each write */1306 status = readl(TWL_STATUS_REG_ADDR(tw_dev));1307 if (!(status & TWL_STATUS_OVERRUN_SUBMIT))1308 i++;1309 }1310 1311 /* Now check status */1312 status = readl(TWL_STATUS_REG_ADDR(tw_dev));1313 if (status) {1314 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x13, "Bad controller status after loading sense buffers");1315 do_soft_reset = 1;1316 tries++;1317 continue;1318 }1319 1320 /* Drain the AEN queue */1321 if (twl_aen_drain_queue(tw_dev, soft_reset)) {1322 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x14, "AEN drain failed during reset sequence");1323 do_soft_reset = 1;1324 tries++;1325 continue;1326 }1327 1328 /* Load rest of compatibility struct */1329 strscpy(tw_dev->tw_compat_info.driver_version, TW_DRIVER_VERSION,1330 sizeof(tw_dev->tw_compat_info.driver_version));1331 tw_dev->tw_compat_info.driver_srl_high = TW_CURRENT_DRIVER_SRL;1332 tw_dev->tw_compat_info.driver_branch_high = TW_CURRENT_DRIVER_BRANCH;1333 tw_dev->tw_compat_info.driver_build_high = TW_CURRENT_DRIVER_BUILD;1334 tw_dev->tw_compat_info.driver_srl_low = TW_BASE_FW_SRL;1335 tw_dev->tw_compat_info.driver_branch_low = TW_BASE_FW_BRANCH;1336 tw_dev->tw_compat_info.driver_build_low = TW_BASE_FW_BUILD;1337 tw_dev->tw_compat_info.fw_on_ctlr_srl = fw_on_ctlr_srl;1338 tw_dev->tw_compat_info.fw_on_ctlr_branch = fw_on_ctlr_branch;1339 tw_dev->tw_compat_info.fw_on_ctlr_build = fw_on_ctlr_build;1340 1341 /* If we got here, controller is in a good state */1342 retval = 0;1343 goto out;1344 }1345out:1346 return retval;1347} /* End twl_reset_sequence() */1348 1349/* This function will reset a device extension */1350static int twl_reset_device_extension(TW_Device_Extension *tw_dev, int ioctl_reset)1351{1352 int i = 0, retval = 1;1353 unsigned long flags = 0;1354 1355 /* Block SCSI requests while we are resetting */1356 if (ioctl_reset)1357 scsi_block_requests(tw_dev->host);1358 1359 set_bit(TW_IN_RESET, &tw_dev->flags);1360 TWL_MASK_INTERRUPTS(tw_dev);1361 TWL_CLEAR_DB_INTERRUPT(tw_dev);1362 1363 spin_lock_irqsave(tw_dev->host->host_lock, flags);1364 1365 /* Abort all requests that are in progress */1366 for (i = 0; i < TW_Q_LENGTH; i++) {1367 if ((tw_dev->state[i] != TW_S_FINISHED) &&1368 (tw_dev->state[i] != TW_S_INITIAL) &&1369 (tw_dev->state[i] != TW_S_COMPLETED)) {1370 struct scsi_cmnd *cmd = tw_dev->srb[i];1371 1372 if (cmd) {1373 cmd->result = (DID_RESET << 16);1374 scsi_dma_unmap(cmd);1375 scsi_done(cmd);1376 }1377 }1378 }1379 1380 /* Reset queues and counts */1381 for (i = 0; i < TW_Q_LENGTH; i++) {1382 tw_dev->free_queue[i] = i;1383 tw_dev->state[i] = TW_S_INITIAL;1384 }1385 tw_dev->free_head = TW_Q_START;1386 tw_dev->free_tail = TW_Q_START;1387 tw_dev->posted_request_count = 0;1388 1389 spin_unlock_irqrestore(tw_dev->host->host_lock, flags);1390 1391 if (twl_reset_sequence(tw_dev, 1))1392 goto out;1393 1394 TWL_UNMASK_INTERRUPTS(tw_dev);1395 1396 clear_bit(TW_IN_RESET, &tw_dev->flags);1397 tw_dev->chrdev_request_id = TW_IOCTL_CHRDEV_FREE;1398 1399 retval = 0;1400out:1401 if (ioctl_reset)1402 scsi_unblock_requests(tw_dev->host);1403 return retval;1404} /* End twl_reset_device_extension() */1405 1406/* This funciton returns unit geometry in cylinders/heads/sectors */1407static int twl_scsi_biosparam(struct scsi_device *sdev, struct block_device *bdev, sector_t capacity, int geom[])1408{1409 int heads, sectors;1410 1411 if (capacity >= 0x200000) {1412 heads = 255;1413 sectors = 63;1414 } else {1415 heads = 64;1416 sectors = 32;1417 }1418 1419 geom[0] = heads;1420 geom[1] = sectors;1421 geom[2] = sector_div(capacity, heads * sectors); /* cylinders */1422 1423 return 0;1424} /* End twl_scsi_biosparam() */1425 1426/* This is the new scsi eh reset function */1427static int twl_scsi_eh_reset(struct scsi_cmnd *SCpnt)1428{1429 TW_Device_Extension *tw_dev = NULL;1430 int retval = FAILED;1431 1432 tw_dev = (TW_Device_Extension *)SCpnt->device->host->hostdata;1433 1434 tw_dev->num_resets++;1435 1436 sdev_printk(KERN_WARNING, SCpnt->device,1437 "WARNING: (0x%02X:0x%04X): Command (0x%x) timed out, resetting card.\n",1438 TW_DRIVER, 0x2c, SCpnt->cmnd[0]);1439 1440 /* Make sure we are not issuing an ioctl or resetting from ioctl */1441 mutex_lock(&tw_dev->ioctl_lock);1442 1443 /* Now reset the card and some of the device extension data */1444 if (twl_reset_device_extension(tw_dev, 0)) {1445 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x15, "Controller reset failed during scsi host reset");1446 goto out;1447 }1448 1449 retval = SUCCESS;1450out:1451 mutex_unlock(&tw_dev->ioctl_lock);1452 return retval;1453} /* End twl_scsi_eh_reset() */1454 1455/* This is the main scsi queue function to handle scsi opcodes */1456static int twl_scsi_queue_lck(struct scsi_cmnd *SCpnt)1457{1458 void (*done)(struct scsi_cmnd *) = scsi_done;1459 int request_id, retval;1460 TW_Device_Extension *tw_dev = (TW_Device_Extension *)SCpnt->device->host->hostdata;1461 1462 /* If we are resetting due to timed out ioctl, report as busy */1463 if (test_bit(TW_IN_RESET, &tw_dev->flags)) {1464 retval = SCSI_MLQUEUE_HOST_BUSY;1465 goto out;1466 }1467 1468 /* Get a free request id */1469 twl_get_request_id(tw_dev, &request_id);1470 1471 /* Save the scsi command for use by the ISR */1472 tw_dev->srb[request_id] = SCpnt;1473 1474 retval = twl_scsiop_execute_scsi(tw_dev, request_id, NULL, 0, NULL);1475 if (retval) {1476 tw_dev->state[request_id] = TW_S_COMPLETED;1477 twl_free_request_id(tw_dev, request_id);1478 SCpnt->result = (DID_ERROR << 16);1479 done(SCpnt);1480 retval = 0;1481 }1482out:1483 return retval;1484} /* End twl_scsi_queue() */1485 1486static DEF_SCSI_QCMD(twl_scsi_queue)1487 1488/* This function tells the controller to shut down */1489static void __twl_shutdown(TW_Device_Extension *tw_dev)1490{1491 /* Disable interrupts */1492 TWL_MASK_INTERRUPTS(tw_dev);1493 1494 /* Free up the IRQ */1495 free_irq(tw_dev->tw_pci_dev->irq, tw_dev);1496 1497 printk(KERN_WARNING "3w-sas: Shutting down host %d.\n", tw_dev->host->host_no);1498 1499 /* Tell the card we are shutting down */1500 if (twl_initconnection(tw_dev, 1, 0, 0, 0, 0, 0, NULL, NULL, NULL, NULL, NULL)) {1501 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x16, "Connection shutdown failed");1502 } else {1503 printk(KERN_WARNING "3w-sas: Shutdown complete.\n");1504 }1505 1506 /* Clear doorbell interrupt just before exit */1507 TWL_CLEAR_DB_INTERRUPT(tw_dev);1508} /* End __twl_shutdown() */1509 1510/* Wrapper for __twl_shutdown */1511static void twl_shutdown(struct pci_dev *pdev)1512{1513 struct Scsi_Host *host = pci_get_drvdata(pdev);1514 TW_Device_Extension *tw_dev;1515 1516 if (!host)1517 return;1518 1519 tw_dev = (TW_Device_Extension *)host->hostdata;1520 1521 if (tw_dev->online)1522 __twl_shutdown(tw_dev);1523} /* End twl_shutdown() */1524 1525/* This function configures unit settings when a unit is coming on-line */1526static int twl_slave_configure(struct scsi_device *sdev)1527{1528 /* Force 60 second timeout */1529 blk_queue_rq_timeout(sdev->request_queue, 60 * HZ);1530 1531 return 0;1532} /* End twl_slave_configure() */1533 1534static const struct scsi_host_template driver_template = {1535 .module = THIS_MODULE,1536 .name = "3w-sas",1537 .queuecommand = twl_scsi_queue,1538 .eh_host_reset_handler = twl_scsi_eh_reset,1539 .bios_param = twl_scsi_biosparam,1540 .change_queue_depth = scsi_change_queue_depth,1541 .can_queue = TW_Q_LENGTH-2,1542 .slave_configure = twl_slave_configure,1543 .this_id = -1,1544 .sg_tablesize = TW_LIBERATOR_MAX_SGL_LENGTH,1545 .max_sectors = TW_MAX_SECTORS,1546 .cmd_per_lun = TW_MAX_CMDS_PER_LUN,1547 .shost_groups = twl_host_groups,1548 .emulated = 1,1549 .no_write_same = 1,1550};1551 1552/* This function will probe and initialize a card */1553static int twl_probe(struct pci_dev *pdev, const struct pci_device_id *dev_id)1554{1555 struct Scsi_Host *host = NULL;1556 TW_Device_Extension *tw_dev;1557 int retval = -ENODEV;1558 int *ptr_phycount, phycount=0;1559 1560 retval = pci_enable_device(pdev);1561 if (retval) {1562 TW_PRINTK(host, TW_DRIVER, 0x17, "Failed to enable pci device");1563 goto out_disable_device;1564 }1565 1566 pci_set_master(pdev);1567 pci_try_set_mwi(pdev);1568 1569 retval = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64));1570 if (retval) {1571 TW_PRINTK(host, TW_DRIVER, 0x18, "Failed to set dma mask");1572 retval = -ENODEV;1573 goto out_disable_device;1574 }1575 1576 host = scsi_host_alloc(&driver_template, sizeof(TW_Device_Extension));1577 if (!host) {1578 TW_PRINTK(host, TW_DRIVER, 0x19, "Failed to allocate memory for device extension");1579 retval = -ENOMEM;1580 goto out_disable_device;1581 }1582 tw_dev = shost_priv(host);1583 1584 /* Save values to device extension */1585 tw_dev->host = host;1586 tw_dev->tw_pci_dev = pdev;1587 1588 if (twl_initialize_device_extension(tw_dev)) {1589 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x1a, "Failed to initialize device extension");1590 retval = -ENOMEM;1591 goto out_free_device_extension;1592 }1593 1594 /* Request IO regions */1595 retval = pci_request_regions(pdev, "3w-sas");1596 if (retval) {1597 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x1b, "Failed to get mem region");1598 goto out_free_device_extension;1599 }1600 1601 /* Save base address, use region 1 */1602 tw_dev->base_addr = pci_iomap(pdev, 1, 0);1603 if (!tw_dev->base_addr) {1604 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x1c, "Failed to ioremap");1605 retval = -ENOMEM;1606 goto out_release_mem_region;1607 }1608 1609 /* Disable interrupts on the card */1610 TWL_MASK_INTERRUPTS(tw_dev);1611 1612 /* Initialize the card */1613 if (twl_reset_sequence(tw_dev, 0)) {1614 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x1d, "Controller reset failed during probe");1615 retval = -ENOMEM;1616 goto out_iounmap;1617 }1618 1619 /* Set host specific parameters */1620 host->max_id = TW_MAX_UNITS;1621 host->max_cmd_len = TW_MAX_CDB_LEN;1622 host->max_lun = TW_MAX_LUNS;1623 host->max_channel = 0;1624 1625 /* Register the card with the kernel SCSI layer */1626 retval = scsi_add_host(host, &pdev->dev);1627 if (retval) {1628 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x1e, "scsi add host failed");1629 goto out_iounmap;1630 }1631 1632 pci_set_drvdata(pdev, host);1633 1634 printk(KERN_WARNING "3w-sas: scsi%d: Found an LSI 3ware %s Controller at 0x%llx, IRQ: %d.\n",1635 host->host_no,1636 (char *)twl_get_param(tw_dev, 1, TW_VERSION_TABLE,1637 TW_PARAM_MODEL, TW_PARAM_MODEL_LENGTH),1638 (u64)pci_resource_start(pdev, 1), pdev->irq);1639 1640 ptr_phycount = twl_get_param(tw_dev, 2, TW_PARAM_PHY_SUMMARY_TABLE,1641 TW_PARAM_PHYCOUNT, TW_PARAM_PHYCOUNT_LENGTH);1642 if (ptr_phycount)1643 phycount = le32_to_cpu(*(int *)ptr_phycount);1644 1645 printk(KERN_WARNING "3w-sas: scsi%d: Firmware %s, BIOS %s, Phys: %d.\n",1646 host->host_no,1647 (char *)twl_get_param(tw_dev, 1, TW_VERSION_TABLE,1648 TW_PARAM_FWVER, TW_PARAM_FWVER_LENGTH),1649 (char *)twl_get_param(tw_dev, 2, TW_VERSION_TABLE,1650 TW_PARAM_BIOSVER, TW_PARAM_BIOSVER_LENGTH),1651 phycount);1652 1653 /* Try to enable MSI */1654 if (use_msi && !pci_enable_msi(pdev))1655 set_bit(TW_USING_MSI, &tw_dev->flags);1656 1657 /* Now setup the interrupt handler */1658 retval = request_irq(pdev->irq, twl_interrupt, IRQF_SHARED, "3w-sas", tw_dev);1659 if (retval) {1660 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x1f, "Error requesting IRQ");1661 goto out_remove_host;1662 }1663 1664 twl_device_extension_list[twl_device_extension_count] = tw_dev;1665 twl_device_extension_count++;1666 1667 /* Re-enable interrupts on the card */1668 TWL_UNMASK_INTERRUPTS(tw_dev);1669 1670 /* Finally, scan the host */1671 scsi_scan_host(host);1672 1673 /* Add sysfs binary files */1674 if (sysfs_create_bin_file(&host->shost_dev.kobj, &twl_sysfs_aen_read_attr))1675 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x20, "Failed to create sysfs binary file: 3ware_aen_read");1676 if (sysfs_create_bin_file(&host->shost_dev.kobj, &twl_sysfs_compat_info_attr))1677 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x21, "Failed to create sysfs binary file: 3ware_compat_info");1678 1679 if (twl_major == -1) {1680 if ((twl_major = register_chrdev (0, "twl", &twl_fops)) < 0)1681 TW_PRINTK(host, TW_DRIVER, 0x22, "Failed to register character device");1682 }1683 tw_dev->online = 1;1684 return 0;1685 1686out_remove_host:1687 if (test_bit(TW_USING_MSI, &tw_dev->flags))1688 pci_disable_msi(pdev);1689 scsi_remove_host(host);1690out_iounmap:1691 iounmap(tw_dev->base_addr);1692out_release_mem_region:1693 pci_release_regions(pdev);1694out_free_device_extension:1695 twl_free_device_extension(tw_dev);1696 scsi_host_put(host);1697out_disable_device:1698 pci_disable_device(pdev);1699 1700 return retval;1701} /* End twl_probe() */1702 1703/* This function is called to remove a device */1704static void twl_remove(struct pci_dev *pdev)1705{1706 struct Scsi_Host *host = pci_get_drvdata(pdev);1707 TW_Device_Extension *tw_dev;1708 1709 if (!host)1710 return;1711 1712 tw_dev = (TW_Device_Extension *)host->hostdata;1713 1714 if (!tw_dev->online)1715 return;1716 1717 /* Remove sysfs binary files */1718 sysfs_remove_bin_file(&host->shost_dev.kobj, &twl_sysfs_aen_read_attr);1719 sysfs_remove_bin_file(&host->shost_dev.kobj, &twl_sysfs_compat_info_attr);1720 1721 scsi_remove_host(tw_dev->host);1722 1723 /* Unregister character device */1724 if (twl_major >= 0) {1725 unregister_chrdev(twl_major, "twl");1726 twl_major = -1;1727 }1728 1729 /* Shutdown the card */1730 __twl_shutdown(tw_dev);1731 1732 /* Disable MSI if enabled */1733 if (test_bit(TW_USING_MSI, &tw_dev->flags))1734 pci_disable_msi(pdev);1735 1736 /* Free IO remapping */1737 iounmap(tw_dev->base_addr);1738 1739 /* Free up the mem region */1740 pci_release_regions(pdev);1741 1742 /* Free up device extension resources */1743 twl_free_device_extension(tw_dev);1744 1745 scsi_host_put(tw_dev->host);1746 pci_disable_device(pdev);1747 twl_device_extension_count--;1748} /* End twl_remove() */1749 1750/* This function is called on PCI suspend */1751static int __maybe_unused twl_suspend(struct device *dev)1752{1753 struct Scsi_Host *host = dev_get_drvdata(dev);1754 TW_Device_Extension *tw_dev = (TW_Device_Extension *)host->hostdata;1755 1756 printk(KERN_WARNING "3w-sas: Suspending host %d.\n", tw_dev->host->host_no);1757 /* Disable interrupts */1758 TWL_MASK_INTERRUPTS(tw_dev);1759 1760 free_irq(tw_dev->tw_pci_dev->irq, tw_dev);1761 1762 /* Tell the card we are shutting down */1763 if (twl_initconnection(tw_dev, 1, 0, 0, 0, 0, 0, NULL, NULL, NULL, NULL, NULL)) {1764 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x23, "Connection shutdown failed during suspend");1765 } else {1766 printk(KERN_WARNING "3w-sas: Suspend complete.\n");1767 }1768 1769 /* Clear doorbell interrupt */1770 TWL_CLEAR_DB_INTERRUPT(tw_dev);1771 1772 return 0;1773} /* End twl_suspend() */1774 1775/* This function is called on PCI resume */1776static int __maybe_unused twl_resume(struct device *dev)1777{1778 int retval = 0;1779 struct pci_dev *pdev = to_pci_dev(dev);1780 struct Scsi_Host *host = pci_get_drvdata(pdev);1781 TW_Device_Extension *tw_dev = (TW_Device_Extension *)host->hostdata;1782 1783 printk(KERN_WARNING "3w-sas: Resuming host %d.\n", tw_dev->host->host_no);1784 pci_try_set_mwi(pdev);1785 1786 retval = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64));1787 if (retval) {1788 TW_PRINTK(host, TW_DRIVER, 0x25, "Failed to set dma mask during resume");1789 retval = -ENODEV;1790 goto out_disable_device;1791 }1792 1793 /* Initialize the card */1794 if (twl_reset_sequence(tw_dev, 0)) {1795 retval = -ENODEV;1796 goto out_disable_device;1797 }1798 1799 /* Now setup the interrupt handler */1800 retval = request_irq(pdev->irq, twl_interrupt, IRQF_SHARED, "3w-sas", tw_dev);1801 if (retval) {1802 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x26, "Error requesting IRQ during resume");1803 retval = -ENODEV;1804 goto out_disable_device;1805 }1806 1807 /* Now enable MSI if enabled */1808 if (test_bit(TW_USING_MSI, &tw_dev->flags))1809 pci_enable_msi(pdev);1810 1811 /* Re-enable interrupts on the card */1812 TWL_UNMASK_INTERRUPTS(tw_dev);1813 1814 printk(KERN_WARNING "3w-sas: Resume complete.\n");1815 return 0;1816 1817out_disable_device:1818 scsi_remove_host(host);1819 1820 return retval;1821} /* End twl_resume() */1822 1823/* PCI Devices supported by this driver */1824static struct pci_device_id twl_pci_tbl[] = {1825 { PCI_VDEVICE(3WARE, PCI_DEVICE_ID_3WARE_9750) },1826 { }1827};1828MODULE_DEVICE_TABLE(pci, twl_pci_tbl);1829 1830static SIMPLE_DEV_PM_OPS(twl_pm_ops, twl_suspend, twl_resume);1831 1832/* pci_driver initializer */1833static struct pci_driver twl_driver = {1834 .name = "3w-sas",1835 .id_table = twl_pci_tbl,1836 .probe = twl_probe,1837 .remove = twl_remove,1838 .driver.pm = &twl_pm_ops,1839 .shutdown = twl_shutdown1840};1841 1842/* This function is called on driver initialization */1843static int __init twl_init(void)1844{1845 printk(KERN_INFO "LSI 3ware SAS/SATA-RAID Controller device driver for Linux v%s.\n", TW_DRIVER_VERSION);1846 1847 return pci_register_driver(&twl_driver);1848} /* End twl_init() */1849 1850/* This function is called on driver exit */1851static void __exit twl_exit(void)1852{1853 pci_unregister_driver(&twl_driver);1854} /* End twl_exit() */1855 1856module_init(twl_init);1857module_exit(twl_exit);1858 1859