drivers/scsi/mpt3sas/mpt3sas_scsih.c

   1 /*
   2  * Scsi Host Layer for MPT (Message Passing Technology) based controllers
   3  *
   4  * This code is based on drivers/scsi/mpt3sas/mpt3sas_scsih.c
   5  * Copyright (C) 2012-2014  LSI Corporation
   6  * Copyright (C) 2013-2014 Avago Technologies
   7  *  (mailto: MPT-FusionLinux.pdl@avagotech.com)
   8  *
   9  * This program is free software; you can redistribute it and/or
  10  * modify it under the terms of the GNU General Public License
  11  * as published by the Free Software Foundation; either version 2
  12  * of the License, or (at your option) any later version.
  13  *
  14  * This program is distributed in the hope that it will be useful,
  15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17  * GNU General Public License for more details.
  18  *
  19  * NO WARRANTY
  20  * THE PROGRAM IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OR
  21  * CONDITIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED INCLUDING, WITHOUT
  22  * LIMITATION, ANY WARRANTIES OR CONDITIONS OF TITLE, NON-INFRINGEMENT,
  23  * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE. Each Recipient is
  24  * solely responsible for determining the appropriateness of using and
  25  * distributing the Program and assumes all risks associated with its
  26  * exercise of rights under this Agreement, including but not limited to
  27  * the risks and costs of program errors, damage to or loss of data,
  28  * programs or equipment, and unavailability or interruption of operations.
  29
  30  * DISCLAIMER OF LIABILITY
  31  * NEITHER RECIPIENT NOR ANY CONTRIBUTORS SHALL HAVE ANY LIABILITY FOR ANY
  32  * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  33  * DAMAGES (INCLUDING WITHOUT LIMITATION LOST PROFITS), HOWEVER CAUSED AND
  34  * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR
  35  * TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE
  36  * USE OR DISTRIBUTION OF THE PROGRAM OR THE EXERCISE OF ANY RIGHTS GRANTED
  37  * HEREUNDER, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGES
  38
  39  * You should have received a copy of the GNU General Public License
  40  * along with this program; if not, write to the Free Software
  41  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301,
  42  * USA.
  43  */
  44
  45 #include <linux/module.h>
  46 #include <linux/kernel.h>
  47 #include <linux/init.h>
  48 #include <linux/errno.h>
  49 #include <linux/blkdev.h>
  50 #include <linux/sched.h>
  51 #include <linux/workqueue.h>
  52 #include <linux/delay.h>
  53 #include <linux/pci.h>
  54 #include <linux/pci-aspm.h>
  55 #include <linux/interrupt.h>
  56 #include <linux/aer.h>
  57 #include <linux/raid_class.h>
  58 #include <asm/unaligned.h>
  59
  60 #include "mpt3sas_base.h"
  61
  62 #define RAID_CHANNEL 1
  63 /* forward proto's */
  64 static void _scsih_expander_node_remove(struct MPT3SAS_ADAPTER *ioc,
  65         struct _sas_node *sas_expander);
  66 static void _firmware_event_work(struct work_struct *work);
  67
  68 static void _scsih_remove_device(struct MPT3SAS_ADAPTER *ioc,
  69         struct _sas_device *sas_device);
  70 static int _scsih_add_device(struct MPT3SAS_ADAPTER *ioc, u16 handle,
  71         u8 retry_count, u8 is_pd);
  72
  73 static u8 _scsih_check_for_pending_tm(struct MPT3SAS_ADAPTER *ioc, u16 smid);
  74
  75 /* global parameters */
  76 LIST_HEAD(mpt3sas_ioc_list);
  77 /* global ioc lock for list operations */
  78 DEFINE_SPINLOCK(gioc_lock);
  79
  80 MODULE_AUTHOR(MPT3SAS_AUTHOR);
  81 MODULE_DESCRIPTION(MPT3SAS_DESCRIPTION);
  82 MODULE_LICENSE("GPL");
  83 MODULE_VERSION(MPT3SAS_DRIVER_VERSION);
  84 MODULE_ALIAS("mpt2sas");
  85
  86 /* local parameters */
  87 static u8 scsi_io_cb_idx = -1;
  88 static u8 tm_cb_idx = -1;
  89 static u8 ctl_cb_idx = -1;
  90 static u8 base_cb_idx = -1;
  91 static u8 port_enable_cb_idx = -1;
  92 static u8 transport_cb_idx = -1;
  93 static u8 scsih_cb_idx = -1;
  94 static u8 config_cb_idx = -1;
  95 static int mpt2_ids;
  96 static int mpt3_ids;
  97
  98 static u8 tm_tr_cb_idx = -1 ;
  99 static u8 tm_tr_volume_cb_idx = -1 ;
 100 static u8 tm_sas_control_cb_idx = -1;
 101
 102 /* command line options */
 103 static u32 logging_level;
 104 MODULE_PARM_DESC(logging_level,
 105         " bits for enabling additional logging info (default=0)");
 106
 107
 108 static ushort max_sectors = 0xFFFF;
 109 module_param(max_sectors, ushort, 0);
 110 MODULE_PARM_DESC(max_sectors, "max sectors, range 64 to 32767  default=32767");
 111
 112
 113 static int missing_delay[2] = {-1, -1};
 114 module_param_array(missing_delay, int, NULL, 0);
 115 MODULE_PARM_DESC(missing_delay, " device missing delay , io missing delay");
 116
 117 /* scsi-mid layer global parmeter is max_report_luns, which is 511 */
 118 #define MPT3SAS_MAX_LUN (16895)
 119 static u64 max_lun = MPT3SAS_MAX_LUN;
 120 module_param(max_lun, ullong, 0);
 121 MODULE_PARM_DESC(max_lun, " max lun, default=16895 ");
 122
 123 static ushort hbas_to_enumerate;
 124 module_param(hbas_to_enumerate, ushort, 0);
 125 MODULE_PARM_DESC(hbas_to_enumerate,
 126                 " 0 - enumerates both SAS 2.0 & SAS 3.0 generation HBAs\n \
 127                   1 - enumerates only SAS 2.0 generation HBAs\n \
 128                   2 - enumerates only SAS 3.0 generation HBAs (default=0)");
 129
 130 /* diag_buffer_enable is bitwise
 131  * bit 0 set = TRACE
 132  * bit 1 set = SNAPSHOT
 133  * bit 2 set = EXTENDED
 134  *
 135  * Either bit can be set, or both
 136  */
 137 static int diag_buffer_enable = -1;
 138 module_param(diag_buffer_enable, int, 0);
 139 MODULE_PARM_DESC(diag_buffer_enable,
 140         " post diag buffers (TRACE=1/SNAPSHOT=2/EXTENDED=4/default=0)");
 141 static int disable_discovery = -1;
 142 module_param(disable_discovery, int, 0);
 143 MODULE_PARM_DESC(disable_discovery, " disable discovery ");
 144
 145
 146 /* permit overriding the host protection capabilities mask (EEDP/T10 PI) */
 147 static int prot_mask = -1;
 148 module_param(prot_mask, int, 0);
 149 MODULE_PARM_DESC(prot_mask, " host protection capabilities mask, def=7 ");
 150
 151
 152 /* raid transport support */
 153 struct raid_template *mpt3sas_raid_template;
 154 struct raid_template *mpt2sas_raid_template;
 155
 156
 157 /**
 158  * struct sense_info - common structure for obtaining sense keys
 159  * @skey: sense key
 160  * @asc: additional sense code
 161  * @ascq: additional sense code qualifier
 162  */
 163 struct sense_info {
 164         u8 skey;
 165         u8 asc;
 166         u8 ascq;
 167 };
 168
 169 #define MPT3SAS_PROCESS_TRIGGER_DIAG (0xFFFB)
 170 #define MPT3SAS_TURN_ON_PFA_LED (0xFFFC)
 171 #define MPT3SAS_PORT_ENABLE_COMPLETE (0xFFFD)
 172 #define MPT3SAS_ABRT_TASK_SET (0xFFFE)
 173 #define MPT3SAS_REMOVE_UNRESPONDING_DEVICES (0xFFFF)
 174 /**
 175  * struct fw_event_work - firmware event struct
 176  * @list: link list framework
 177  * @work: work object (ioc->fault_reset_work_q)
 178  * @ioc: per adapter object
 179  * @device_handle: device handle
 180  * @VF_ID: virtual function id
 181  * @VP_ID: virtual port id
 182  * @ignore: flag meaning this event has been marked to ignore
 183  * @event: firmware event MPI2_EVENT_XXX defined in mpi2_ioc.h
 184  * @refcount: kref for this event
 185  * @event_data: reply event data payload follows
 186  *
 187  * This object stored on ioc->fw_event_list.
 188  */
 189 struct fw_event_work {
 190         struct list_head        list;
 191         struct work_struct      work;
 192
 193         struct MPT3SAS_ADAPTER *ioc;
 194         u16                     device_handle;
 195         u8                      VF_ID;
 196         u8                      VP_ID;
 197         u8                      ignore;
 198         u16                     event;
 199         struct kref             refcount;
 200         char                    event_data[0] __aligned(4);
 201 };
 202
 203 static void fw_event_work_free(struct kref *r)
 204 {
 205         kfree(container_of(r, struct fw_event_work, refcount));
 206 }
 207
 208 static void fw_event_work_get(struct fw_event_work *fw_work)
 209 {
 210         kref_get(&fw_work->refcount);
 211 }
 212
 213 static void fw_event_work_put(struct fw_event_work *fw_work)
 214 {
 215         kref_put(&fw_work->refcount, fw_event_work_free);
 216 }
 217
 218 static struct fw_event_work *alloc_fw_event_work(int len)
 219 {
 220         struct fw_event_work *fw_event;
 221
 222         fw_event = kzalloc(sizeof(*fw_event) + len, GFP_ATOMIC);
 223         if (!fw_event)
 224                 return NULL;
 225
 226         kref_init(&fw_event->refcount);
 227         return fw_event;
 228 }
 229
 230 /**
 231  * struct _scsi_io_transfer - scsi io transfer
 232  * @handle: sas device handle (assigned by firmware)
 233  * @is_raid: flag set for hidden raid components
 234  * @dir: DMA_TO_DEVICE, DMA_FROM_DEVICE,
 235  * @data_length: data transfer length
 236  * @data_dma: dma pointer to data
 237  * @sense: sense data
 238  * @lun: lun number
 239  * @cdb_length: cdb length
 240  * @cdb: cdb contents
 241  * @timeout: timeout for this command
 242  * @VF_ID: virtual function id
 243  * @VP_ID: virtual port id
 244  * @valid_reply: flag set for reply message
 245  * @sense_length: sense length
 246  * @ioc_status: ioc status
 247  * @scsi_state: scsi state
 248  * @scsi_status: scsi staus
 249  * @log_info: log information
 250  * @transfer_length: data length transfer when there is a reply message
 251  *
 252  * Used for sending internal scsi commands to devices within this module.
 253  * Refer to _scsi_send_scsi_io().
 254  */
 255 struct _scsi_io_transfer {
 256         u16     handle;
 257         u8      is_raid;
 258         enum dma_data_direction dir;
 259         u32     data_length;
 260         dma_addr_t data_dma;
 261         u8      sense[SCSI_SENSE_BUFFERSIZE];
 262         u32     lun;
 263         u8      cdb_length;
 264         u8      cdb[32];
 265         u8      timeout;
 266         u8      VF_ID;
 267         u8      VP_ID;
 268         u8      valid_reply;
 269   /* the following bits are only valid when 'valid_reply = 1' */
 270         u32     sense_length;
 271         u16     ioc_status;
 272         u8      scsi_state;
 273         u8      scsi_status;
 274         u32     log_info;
 275         u32     transfer_length;
 276 };
 277
 278 /**
 279  * _scsih_set_debug_level - global setting of ioc->logging_level.
 280  *
 281  * Note: The logging levels are defined in mpt3sas_debug.h.
 282  */
 283 static int
 284 _scsih_set_debug_level(const char *val, struct kernel_param *kp)
 285 {
 286         int ret = param_set_int(val, kp);
 287         struct MPT3SAS_ADAPTER *ioc;
 288
 289         if (ret)
 290                 return ret;
 291
 292         pr_info("setting logging_level(0x%08x)\n", logging_level);
 293         spin_lock(&gioc_lock);
 294         list_for_each_entry(ioc, &mpt3sas_ioc_list, list)
 295                 ioc->logging_level = logging_level;
 296         spin_unlock(&gioc_lock);
 297         return 0;
 298 }
 299 module_param_call(logging_level, _scsih_set_debug_level, param_get_int,
 300         &logging_level, 0644);
 301
 302 /**
 303  * _scsih_srch_boot_sas_address - search based on sas_address
 304  * @sas_address: sas address
 305  * @boot_device: boot device object from bios page 2
 306  *
 307  * Returns 1 when there's a match, 0 means no match.
 308  */
 309 static inline int
 310 _scsih_srch_boot_sas_address(u64 sas_address,
 311         Mpi2BootDeviceSasWwid_t *boot_device)
 312 {
 313         return (sas_address == le64_to_cpu(boot_device->SASAddress)) ?  1 : 0;
 314 }
 315
 316 /**
 317  * _scsih_srch_boot_device_name - search based on device name
 318  * @device_name: device name specified in INDENTIFY fram
 319  * @boot_device: boot device object from bios page 2
 320  *
 321  * Returns 1 when there's a match, 0 means no match.
 322  */
 323 static inline int
 324 _scsih_srch_boot_device_name(u64 device_name,
 325         Mpi2BootDeviceDeviceName_t *boot_device)
 326 {
 327         return (device_name == le64_to_cpu(boot_device->DeviceName)) ? 1 : 0;
 328 }
 329
 330 /**
 331  * _scsih_srch_boot_encl_slot - search based on enclosure_logical_id/slot
 332  * @enclosure_logical_id: enclosure logical id
 333  * @slot_number: slot number
 334  * @boot_device: boot device object from bios page 2
 335  *
 336  * Returns 1 when there's a match, 0 means no match.
 337  */
 338 static inline int
 339 _scsih_srch_boot_encl_slot(u64 enclosure_logical_id, u16 slot_number,
 340         Mpi2BootDeviceEnclosureSlot_t *boot_device)
 341 {
 342         return (enclosure_logical_id == le64_to_cpu(boot_device->
 343             EnclosureLogicalID) && slot_number == le16_to_cpu(boot_device->
 344             SlotNumber)) ? 1 : 0;
 345 }
 346
 347 /**
 348  * _scsih_is_boot_device - search for matching boot device.
 349  * @sas_address: sas address
 350  * @device_name: device name specified in INDENTIFY fram
 351  * @enclosure_logical_id: enclosure logical id
 352  * @slot_number: slot number
 353  * @form: specifies boot device form
 354  * @boot_device: boot device object from bios page 2
 355  *
 356  * Returns 1 when there's a match, 0 means no match.
 357  */
 358 static int
 359 _scsih_is_boot_device(u64 sas_address, u64 device_name,
 360         u64 enclosure_logical_id, u16 slot, u8 form,
 361         Mpi2BiosPage2BootDevice_t *boot_device)
 362 {
 363         int rc = 0;
 364
 365         switch (form) {
 366         case MPI2_BIOSPAGE2_FORM_SAS_WWID:
 367                 if (!sas_address)
 368                         break;
 369                 rc = _scsih_srch_boot_sas_address(
 370                     sas_address, &boot_device->SasWwid);
 371                 break;
 372         case MPI2_BIOSPAGE2_FORM_ENCLOSURE_SLOT:
 373                 if (!enclosure_logical_id)
 374                         break;
 375                 rc = _scsih_srch_boot_encl_slot(
 376                     enclosure_logical_id,
 377                     slot, &boot_device->EnclosureSlot);
 378                 break;
 379         case MPI2_BIOSPAGE2_FORM_DEVICE_NAME:
 380                 if (!device_name)
 381                         break;
 382                 rc = _scsih_srch_boot_device_name(
 383                     device_name, &boot_device->DeviceName);
 384                 break;
 385         case MPI2_BIOSPAGE2_FORM_NO_DEVICE_SPECIFIED:
 386                 break;
 387         }
 388
 389         return rc;
 390 }
 391
 392 /**
 393  * _scsih_get_sas_address - set the sas_address for given device handle
 394  * @handle: device handle
 395  * @sas_address: sas address
 396  *
 397  * Returns 0 success, non-zero when failure
 398  */
 399 static int
 400 _scsih_get_sas_address(struct MPT3SAS_ADAPTER *ioc, u16 handle,
 401         u64 *sas_address)
 402 {
 403         Mpi2SasDevicePage0_t sas_device_pg0;
 404         Mpi2ConfigReply_t mpi_reply;
 405         u32 ioc_status;
 406
 407         *sas_address = 0;
 408
 409         if (handle <= ioc->sas_hba.num_phys) {
 410                 *sas_address = ioc->sas_hba.sas_address;
 411                 return 0;
 412         }
 413
 414         if ((mpt3sas_config_get_sas_device_pg0(ioc, &mpi_reply, &sas_device_pg0,
 415             MPI2_SAS_DEVICE_PGAD_FORM_HANDLE, handle))) {
 416                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n", ioc->name,
 417                 __FILE__, __LINE__, __func__);
 418                 return -ENXIO;
 419         }
 420
 421         ioc_status = le16_to_cpu(mpi_reply.IOCStatus) & MPI2_IOCSTATUS_MASK;
 422         if (ioc_status == MPI2_IOCSTATUS_SUCCESS) {
 423                 *sas_address = le64_to_cpu(sas_device_pg0.SASAddress);
 424                 return 0;
 425         }
 426
 427         /* we hit this because the given parent handle doesn't exist */
 428         if (ioc_status == MPI2_IOCSTATUS_CONFIG_INVALID_PAGE)
 429                 return -ENXIO;
 430
 431         /* else error case */
 432         pr_err(MPT3SAS_FMT
 433                 "handle(0x%04x), ioc_status(0x%04x), failure at %s:%d/%s()!\n",
 434                 ioc->name, handle, ioc_status,
 435              __FILE__, __LINE__, __func__);
 436         return -EIO;
 437 }
 438
 439 /**
 440  * _scsih_determine_boot_device - determine boot device.
 441  * @ioc: per adapter object
 442  * @device: either sas_device or raid_device object
 443  * @is_raid: [flag] 1 = raid object, 0 = sas object
 444  *
 445  * Determines whether this device should be first reported device to
 446  * to scsi-ml or sas transport, this purpose is for persistent boot device.
 447  * There are primary, alternate, and current entries in bios page 2. The order
 448  * priority is primary, alternate, then current.  This routine saves
 449  * the corresponding device object and is_raid flag in the ioc object.
 450  * The saved data to be used later in _scsih_probe_boot_devices().
 451  */
 452 static void
 453 _scsih_determine_boot_device(struct MPT3SAS_ADAPTER *ioc,
 454         void *device, u8 is_raid)
 455 {
 456         struct _sas_device *sas_device;
 457         struct _raid_device *raid_device;
 458         u64 sas_address;
 459         u64 device_name;
 460         u64 enclosure_logical_id;
 461         u16 slot;
 462
 463          /* only process this function when driver loads */
 464         if (!ioc->is_driver_loading)
 465                 return;
 466
 467          /* no Bios, return immediately */
 468         if (!ioc->bios_pg3.BiosVersion)
 469                 return;
 470
 471         if (!is_raid) {
 472                 sas_device = device;
 473                 sas_address = sas_device->sas_address;
 474                 device_name = sas_device->device_name;
 475                 enclosure_logical_id = sas_device->enclosure_logical_id;
 476                 slot = sas_device->slot;
 477         } else {
 478                 raid_device = device;
 479                 sas_address = raid_device->wwid;
 480                 device_name = 0;
 481                 enclosure_logical_id = 0;
 482                 slot = 0;
 483         }
 484
 485         if (!ioc->req_boot_device.device) {
 486                 if (_scsih_is_boot_device(sas_address, device_name,
 487                     enclosure_logical_id, slot,
 488                     (ioc->bios_pg2.ReqBootDeviceForm &
 489                     MPI2_BIOSPAGE2_FORM_MASK),
 490                     &ioc->bios_pg2.RequestedBootDevice)) {
 491                         dinitprintk(ioc, pr_info(MPT3SAS_FMT
 492                            "%s: req_boot_device(0x%016llx)\n",
 493                             ioc->name, __func__,
 494                             (unsigned long long)sas_address));
 495                         ioc->req_boot_device.device = device;
 496                         ioc->req_boot_device.is_raid = is_raid;
 497                 }
 498         }
 499
 500         if (!ioc->req_alt_boot_device.device) {
 501                 if (_scsih_is_boot_device(sas_address, device_name,
 502                     enclosure_logical_id, slot,
 503                     (ioc->bios_pg2.ReqAltBootDeviceForm &
 504                     MPI2_BIOSPAGE2_FORM_MASK),
 505                     &ioc->bios_pg2.RequestedAltBootDevice)) {
 506                         dinitprintk(ioc, pr_info(MPT3SAS_FMT
 507                            "%s: req_alt_boot_device(0x%016llx)\n",
 508                             ioc->name, __func__,
 509                             (unsigned long long)sas_address));
 510                         ioc->req_alt_boot_device.device = device;
 511                         ioc->req_alt_boot_device.is_raid = is_raid;
 512                 }
 513         }
 514
 515         if (!ioc->current_boot_device.device) {
 516                 if (_scsih_is_boot_device(sas_address, device_name,
 517                     enclosure_logical_id, slot,
 518                     (ioc->bios_pg2.CurrentBootDeviceForm &
 519                     MPI2_BIOSPAGE2_FORM_MASK),
 520                     &ioc->bios_pg2.CurrentBootDevice)) {
 521                         dinitprintk(ioc, pr_info(MPT3SAS_FMT
 522                            "%s: current_boot_device(0x%016llx)\n",
 523                             ioc->name, __func__,
 524                             (unsigned long long)sas_address));
 525                         ioc->current_boot_device.device = device;
 526                         ioc->current_boot_device.is_raid = is_raid;
 527                 }
 528         }
 529 }
 530
 531 static struct _sas_device *
 532 __mpt3sas_get_sdev_from_target(struct MPT3SAS_ADAPTER *ioc,
 533                 struct MPT3SAS_TARGET *tgt_priv)
 534 {
 535         struct _sas_device *ret;
 536
 537         assert_spin_locked(&ioc->sas_device_lock);
 538
 539         ret = tgt_priv->sdev;
 540         if (ret)
 541                 sas_device_get(ret);
 542
 543         return ret;
 544 }
 545
 546 static struct _sas_device *
 547 mpt3sas_get_sdev_from_target(struct MPT3SAS_ADAPTER *ioc,
 548                 struct MPT3SAS_TARGET *tgt_priv)
 549 {
 550         struct _sas_device *ret;
 551         unsigned long flags;
 552
 553         spin_lock_irqsave(&ioc->sas_device_lock, flags);
 554         ret = __mpt3sas_get_sdev_from_target(ioc, tgt_priv);
 555         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
 556
 557         return ret;
 558 }
 559
 560
 561 struct _sas_device *
 562 __mpt3sas_get_sdev_by_addr(struct MPT3SAS_ADAPTER *ioc,
 563                                         u64 sas_address)
 564 {
 565         struct _sas_device *sas_device;
 566
 567         assert_spin_locked(&ioc->sas_device_lock);
 568
 569         list_for_each_entry(sas_device, &ioc->sas_device_list, list)
 570                 if (sas_device->sas_address == sas_address)
 571                         goto found_device;
 572
 573         list_for_each_entry(sas_device, &ioc->sas_device_init_list, list)
 574                 if (sas_device->sas_address == sas_address)
 575                         goto found_device;
 576
 577         return NULL;
 578
 579 found_device:
 580         sas_device_get(sas_device);
 581         return sas_device;
 582 }
 583
 584 /**
 585  * mpt3sas_get_sdev_by_addr - sas device search
 586  * @ioc: per adapter object
 587  * @sas_address: sas address
 588  * Context: Calling function should acquire ioc->sas_device_lock
 589  *
 590  * This searches for sas_device based on sas_address, then return sas_device
 591  * object.
 592  */
 593 struct _sas_device *
 594 mpt3sas_get_sdev_by_addr(struct MPT3SAS_ADAPTER *ioc,
 595         u64 sas_address)
 596 {
 597         struct _sas_device *sas_device;
 598         unsigned long flags;
 599
 600         spin_lock_irqsave(&ioc->sas_device_lock, flags);
 601         sas_device = __mpt3sas_get_sdev_by_addr(ioc,
 602                         sas_address);
 603         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
 604
 605         return sas_device;
 606 }
 607
 608 static struct _sas_device *
 609 __mpt3sas_get_sdev_by_handle(struct MPT3SAS_ADAPTER *ioc, u16 handle)
 610 {
 611         struct _sas_device *sas_device;
 612
 613         assert_spin_locked(&ioc->sas_device_lock);
 614
 615         list_for_each_entry(sas_device, &ioc->sas_device_list, list)
 616                 if (sas_device->handle == handle)
 617                         goto found_device;
 618
 619         list_for_each_entry(sas_device, &ioc->sas_device_init_list, list)
 620                 if (sas_device->handle == handle)
 621                         goto found_device;
 622
 623         return NULL;
 624
 625 found_device:
 626         sas_device_get(sas_device);
 627         return sas_device;
 628 }
 629
 630 /**
 631  * mpt3sas_get_sdev_by_handle - sas device search
 632  * @ioc: per adapter object
 633  * @handle: sas device handle (assigned by firmware)
 634  * Context: Calling function should acquire ioc->sas_device_lock
 635  *
 636  * This searches for sas_device based on sas_address, then return sas_device
 637  * object.
 638  */
 639 static struct _sas_device *
 640 mpt3sas_get_sdev_by_handle(struct MPT3SAS_ADAPTER *ioc, u16 handle)
 641 {
 642         struct _sas_device *sas_device;
 643         unsigned long flags;
 644
 645         spin_lock_irqsave(&ioc->sas_device_lock, flags);
 646         sas_device = __mpt3sas_get_sdev_by_handle(ioc, handle);
 647         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
 648
 649         return sas_device;
 650 }
 651
 652 /**
 653  * _scsih_sas_device_remove - remove sas_device from list.
 654  * @ioc: per adapter object
 655  * @sas_device: the sas_device object
 656  * Context: This function will acquire ioc->sas_device_lock.
 657  *
 658  * If sas_device is on the list, remove it and decrement its reference count.
 659  */
 660 static void
 661 _scsih_sas_device_remove(struct MPT3SAS_ADAPTER *ioc,
 662         struct _sas_device *sas_device)
 663 {
 664         unsigned long flags;
 665
 666         if (!sas_device)
 667                 return;
 668         pr_info(MPT3SAS_FMT
 669             "removing handle(0x%04x), sas_addr(0x%016llx)\n",
 670             ioc->name, sas_device->handle,
 671             (unsigned long long) sas_device->sas_address);
 672
 673         if (sas_device->enclosure_handle != 0)
 674                 pr_info(MPT3SAS_FMT
 675                    "removing enclosure logical id(0x%016llx), slot(%d)\n",
 676                    ioc->name, (unsigned long long)
 677                    sas_device->enclosure_logical_id, sas_device->slot);
 678
 679         if (sas_device->connector_name[0] != '\0')
 680                 pr_info(MPT3SAS_FMT
 681                    "removing enclosure level(0x%04x), connector name( %s)\n",
 682                    ioc->name, sas_device->enclosure_level,
 683                    sas_device->connector_name);
 684
 685         /*
 686          * The lock serializes access to the list, but we still need to verify
 687          * that nobody removed the entry while we were waiting on the lock.
 688          */
 689         spin_lock_irqsave(&ioc->sas_device_lock, flags);
 690         if (!list_empty(&sas_device->list)) {
 691                 list_del_init(&sas_device->list);
 692                 sas_device_put(sas_device);
 693         }
 694         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
 695 }
 696
 697 /**
 698  * _scsih_device_remove_by_handle - removing device object by handle
 699  * @ioc: per adapter object
 700  * @handle: device handle
 701  *
 702  * Return nothing.
 703  */
 704 static void
 705 _scsih_device_remove_by_handle(struct MPT3SAS_ADAPTER *ioc, u16 handle)
 706 {
 707         struct _sas_device *sas_device;
 708         unsigned long flags;
 709
 710         if (ioc->shost_recovery)
 711                 return;
 712
 713         spin_lock_irqsave(&ioc->sas_device_lock, flags);
 714         sas_device = __mpt3sas_get_sdev_by_handle(ioc, handle);
 715         if (sas_device) {
 716                 list_del_init(&sas_device->list);
 717                 sas_device_put(sas_device);
 718         }
 719         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
 720         if (sas_device) {
 721                 _scsih_remove_device(ioc, sas_device);
 722                 sas_device_put(sas_device);
 723         }
 724 }
 725
 726 /**
 727  * mpt3sas_device_remove_by_sas_address - removing device object by sas address
 728  * @ioc: per adapter object
 729  * @sas_address: device sas_address
 730  *
 731  * Return nothing.
 732  */
 733 void
 734 mpt3sas_device_remove_by_sas_address(struct MPT3SAS_ADAPTER *ioc,
 735         u64 sas_address)
 736 {
 737         struct _sas_device *sas_device;
 738         unsigned long flags;
 739
 740         if (ioc->shost_recovery)
 741                 return;
 742
 743         spin_lock_irqsave(&ioc->sas_device_lock, flags);
 744         sas_device = __mpt3sas_get_sdev_by_addr(ioc, sas_address);
 745         if (sas_device) {
 746                 list_del_init(&sas_device->list);
 747                 sas_device_put(sas_device);
 748         }
 749         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
 750         if (sas_device) {
 751                 _scsih_remove_device(ioc, sas_device);
 752                 sas_device_put(sas_device);
 753         }
 754 }
 755
 756 /**
 757  * _scsih_sas_device_add - insert sas_device to the list.
 758  * @ioc: per adapter object
 759  * @sas_device: the sas_device object
 760  * Context: This function will acquire ioc->sas_device_lock.
 761  *
 762  * Adding new object to the ioc->sas_device_list.
 763  */
 764 static void
 765 _scsih_sas_device_add(struct MPT3SAS_ADAPTER *ioc,
 766         struct _sas_device *sas_device)
 767 {
 768         unsigned long flags;
 769
 770         dewtprintk(ioc, pr_info(MPT3SAS_FMT
 771                 "%s: handle(0x%04x), sas_addr(0x%016llx)\n",
 772                 ioc->name, __func__, sas_device->handle,
 773                 (unsigned long long)sas_device->sas_address));
 774
 775         if (sas_device->enclosure_handle != 0)
 776                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
 777                     "%s: enclosure logical id(0x%016llx), slot( %d)\n",
 778                     ioc->name, __func__, (unsigned long long)
 779                     sas_device->enclosure_logical_id, sas_device->slot));
 780
 781         if (sas_device->connector_name[0] != '\0')
 782                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
 783                     "%s: enclosure level(0x%04x), connector name( %s)\n",
 784                     ioc->name, __func__,
 785                     sas_device->enclosure_level, sas_device->connector_name));
 786
 787         spin_lock_irqsave(&ioc->sas_device_lock, flags);
 788         sas_device_get(sas_device);
 789         list_add_tail(&sas_device->list, &ioc->sas_device_list);
 790         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
 791
 792         if (ioc->hide_drives) {
 793                 clear_bit(sas_device->handle, ioc->pend_os_device_add);
 794                 return;
 795         }
 796
 797         if (!mpt3sas_transport_port_add(ioc, sas_device->handle,
 798              sas_device->sas_address_parent)) {
 799                 _scsih_sas_device_remove(ioc, sas_device);
 800         } else if (!sas_device->starget) {
 801                 /*
 802                  * When asyn scanning is enabled, its not possible to remove
 803                  * devices while scanning is turned on due to an oops in
 804                  * scsi_sysfs_add_sdev()->add_device()->sysfs_addrm_start()
 805                  */
 806                 if (!ioc->is_driver_loading) {
 807                         mpt3sas_transport_port_remove(ioc,
 808                             sas_device->sas_address,
 809                             sas_device->sas_address_parent);
 810                         _scsih_sas_device_remove(ioc, sas_device);
 811                 }
 812         } else
 813                 clear_bit(sas_device->handle, ioc->pend_os_device_add);
 814 }
 815
 816 /**
 817  * _scsih_sas_device_init_add - insert sas_device to the list.
 818  * @ioc: per adapter object
 819  * @sas_device: the sas_device object
 820  * Context: This function will acquire ioc->sas_device_lock.
 821  *
 822  * Adding new object at driver load time to the ioc->sas_device_init_list.
 823  */
 824 static void
 825 _scsih_sas_device_init_add(struct MPT3SAS_ADAPTER *ioc,
 826         struct _sas_device *sas_device)
 827 {
 828         unsigned long flags;
 829
 830         dewtprintk(ioc, pr_info(MPT3SAS_FMT
 831                 "%s: handle(0x%04x), sas_addr(0x%016llx)\n", ioc->name,
 832                 __func__, sas_device->handle,
 833                 (unsigned long long)sas_device->sas_address));
 834
 835         if (sas_device->enclosure_handle != 0)
 836                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
 837                     "%s: enclosure logical id(0x%016llx), slot( %d)\n",
 838                     ioc->name, __func__, (unsigned long long)
 839                     sas_device->enclosure_logical_id, sas_device->slot));
 840
 841         if (sas_device->connector_name[0] != '\0')
 842                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
 843                     "%s: enclosure level(0x%04x), connector name( %s)\n",
 844                     ioc->name, __func__, sas_device->enclosure_level,
 845                     sas_device->connector_name));
 846
 847         spin_lock_irqsave(&ioc->sas_device_lock, flags);
 848         sas_device_get(sas_device);
 849         list_add_tail(&sas_device->list, &ioc->sas_device_init_list);
 850         _scsih_determine_boot_device(ioc, sas_device, 0);
 851         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
 852 }
 853
 854 /**
 855  * _scsih_raid_device_find_by_id - raid device search
 856  * @ioc: per adapter object
 857  * @id: sas device target id
 858  * @channel: sas device channel
 859  * Context: Calling function should acquire ioc->raid_device_lock
 860  *
 861  * This searches for raid_device based on target id, then return raid_device
 862  * object.
 863  */
 864 static struct _raid_device *
 865 _scsih_raid_device_find_by_id(struct MPT3SAS_ADAPTER *ioc, int id, int channel)
 866 {
 867         struct _raid_device *raid_device, *r;
 868
 869         r = NULL;
 870         list_for_each_entry(raid_device, &ioc->raid_device_list, list) {
 871                 if (raid_device->id == id && raid_device->channel == channel) {
 872                         r = raid_device;
 873                         goto out;
 874                 }
 875         }
 876
 877  out:
 878         return r;
 879 }
 880
 881 /**
 882  * mpt3sas_raid_device_find_by_handle - raid device search
 883  * @ioc: per adapter object
 884  * @handle: sas device handle (assigned by firmware)
 885  * Context: Calling function should acquire ioc->raid_device_lock
 886  *
 887  * This searches for raid_device based on handle, then return raid_device
 888  * object.
 889  */
 890 struct _raid_device *
 891 mpt3sas_raid_device_find_by_handle(struct MPT3SAS_ADAPTER *ioc, u16 handle)
 892 {
 893         struct _raid_device *raid_device, *r;
 894
 895         r = NULL;
 896         list_for_each_entry(raid_device, &ioc->raid_device_list, list) {
 897                 if (raid_device->handle != handle)
 898                         continue;
 899                 r = raid_device;
 900                 goto out;
 901         }
 902
 903  out:
 904         return r;
 905 }
 906
 907 /**
 908  * _scsih_raid_device_find_by_wwid - raid device search
 909  * @ioc: per adapter object
 910  * @handle: sas device handle (assigned by firmware)
 911  * Context: Calling function should acquire ioc->raid_device_lock
 912  *
 913  * This searches for raid_device based on wwid, then return raid_device
 914  * object.
 915  */
 916 static struct _raid_device *
 917 _scsih_raid_device_find_by_wwid(struct MPT3SAS_ADAPTER *ioc, u64 wwid)
 918 {
 919         struct _raid_device *raid_device, *r;
 920
 921         r = NULL;
 922         list_for_each_entry(raid_device, &ioc->raid_device_list, list) {
 923                 if (raid_device->wwid != wwid)
 924                         continue;
 925                 r = raid_device;
 926                 goto out;
 927         }
 928
 929  out:
 930         return r;
 931 }
 932
 933 /**
 934  * _scsih_raid_device_add - add raid_device object
 935  * @ioc: per adapter object
 936  * @raid_device: raid_device object
 937  *
 938  * This is added to the raid_device_list link list.
 939  */
 940 static void
 941 _scsih_raid_device_add(struct MPT3SAS_ADAPTER *ioc,
 942         struct _raid_device *raid_device)
 943 {
 944         unsigned long flags;
 945
 946         dewtprintk(ioc, pr_info(MPT3SAS_FMT
 947                 "%s: handle(0x%04x), wwid(0x%016llx)\n", ioc->name, __func__,
 948             raid_device->handle, (unsigned long long)raid_device->wwid));
 949
 950         spin_lock_irqsave(&ioc->raid_device_lock, flags);
 951         list_add_tail(&raid_device->list, &ioc->raid_device_list);
 952         spin_unlock_irqrestore(&ioc->raid_device_lock, flags);
 953 }
 954
 955 /**
 956  * _scsih_raid_device_remove - delete raid_device object
 957  * @ioc: per adapter object
 958  * @raid_device: raid_device object
 959  *
 960  */
 961 static void
 962 _scsih_raid_device_remove(struct MPT3SAS_ADAPTER *ioc,
 963         struct _raid_device *raid_device)
 964 {
 965         unsigned long flags;
 966
 967         spin_lock_irqsave(&ioc->raid_device_lock, flags);
 968         list_del(&raid_device->list);
 969         kfree(raid_device);
 970         spin_unlock_irqrestore(&ioc->raid_device_lock, flags);
 971 }
 972
 973 /**
 974  * mpt3sas_scsih_expander_find_by_handle - expander device search
 975  * @ioc: per adapter object
 976  * @handle: expander handle (assigned by firmware)
 977  * Context: Calling function should acquire ioc->sas_device_lock
 978  *
 979  * This searches for expander device based on handle, then returns the
 980  * sas_node object.
 981  */
 982 struct _sas_node *
 983 mpt3sas_scsih_expander_find_by_handle(struct MPT3SAS_ADAPTER *ioc, u16 handle)
 984 {
 985         struct _sas_node *sas_expander, *r;
 986
 987         r = NULL;
 988         list_for_each_entry(sas_expander, &ioc->sas_expander_list, list) {
 989                 if (sas_expander->handle != handle)
 990                         continue;
 991                 r = sas_expander;
 992                 goto out;
 993         }
 994  out:
 995         return r;
 996 }
 997
 998 /**
 999  * mpt3sas_scsih_expander_find_by_sas_address - expander device search
1000  * @ioc: per adapter object
1001  * @sas_address: sas address
1002  * Context: Calling function should acquire ioc->sas_node_lock.
1003  *
1004  * This searches for expander device based on sas_address, then returns the
1005  * sas_node object.
1006  */
1007 struct _sas_node *
1008 mpt3sas_scsih_expander_find_by_sas_address(struct MPT3SAS_ADAPTER *ioc,
1009         u64 sas_address)
1010 {
1011         struct _sas_node *sas_expander, *r;
1012
1013         r = NULL;
1014         list_for_each_entry(sas_expander, &ioc->sas_expander_list, list) {
1015                 if (sas_expander->sas_address != sas_address)
1016                         continue;
1017                 r = sas_expander;
1018                 goto out;
1019         }
1020  out:
1021         return r;
1022 }
1023
1024 /**
1025  * _scsih_expander_node_add - insert expander device to the list.
1026  * @ioc: per adapter object
1027  * @sas_expander: the sas_device object
1028  * Context: This function will acquire ioc->sas_node_lock.
1029  *
1030  * Adding new object to the ioc->sas_expander_list.
1031  *
1032  * Return nothing.
1033  */
1034 static void
1035 _scsih_expander_node_add(struct MPT3SAS_ADAPTER *ioc,
1036         struct _sas_node *sas_expander)
1037 {
1038         unsigned long flags;
1039
1040         spin_lock_irqsave(&ioc->sas_node_lock, flags);
1041         list_add_tail(&sas_expander->list, &ioc->sas_expander_list);
1042         spin_unlock_irqrestore(&ioc->sas_node_lock, flags);
1043 }
1044
1045 /**
1046  * _scsih_is_end_device - determines if device is an end device
1047  * @device_info: bitfield providing information about the device.
1048  * Context: none
1049  *
1050  * Returns 1 if end device.
1051  */
1052 static int
1053 _scsih_is_end_device(u32 device_info)
1054 {
1055         if (device_info & MPI2_SAS_DEVICE_INFO_END_DEVICE &&
1056                 ((device_info & MPI2_SAS_DEVICE_INFO_SSP_TARGET) |
1057                 (device_info & MPI2_SAS_DEVICE_INFO_STP_TARGET) |
1058                 (device_info & MPI2_SAS_DEVICE_INFO_SATA_DEVICE)))
1059                 return 1;
1060         else
1061                 return 0;
1062 }
1063
1064 /**
1065  * _scsih_scsi_lookup_get - returns scmd entry
1066  * @ioc: per adapter object
1067  * @smid: system request message index
1068  *
1069  * Returns the smid stored scmd pointer.
1070  */
1071 static struct scsi_cmnd *
1072 _scsih_scsi_lookup_get(struct MPT3SAS_ADAPTER *ioc, u16 smid)
1073 {
1074         return ioc->scsi_lookup[smid - 1].scmd;
1075 }
1076
1077 /**
1078  * __scsih_scsi_lookup_get_clear - returns scmd entry without
1079  *                                              holding any lock.
1080  * @ioc: per adapter object
1081  * @smid: system request message index
1082  *
1083  * Returns the smid stored scmd pointer.
1084  * Then will dereference the stored scmd pointer.
1085  */
1086 static inline struct scsi_cmnd *
1087 __scsih_scsi_lookup_get_clear(struct MPT3SAS_ADAPTER *ioc,
1088                 u16 smid)
1089 {
1090         struct scsi_cmnd *scmd = NULL;
1091
1092         swap(scmd, ioc->scsi_lookup[smid - 1].scmd);
1093
1094         return scmd;
1095 }
1096
1097 /**
1098  * _scsih_scsi_lookup_get_clear - returns scmd entry
1099  * @ioc: per adapter object
1100  * @smid: system request message index
1101  *
1102  * Returns the smid stored scmd pointer.
1103  * Then will derefrence the stored scmd pointer.
1104  */
1105 static inline struct scsi_cmnd *
1106 _scsih_scsi_lookup_get_clear(struct MPT3SAS_ADAPTER *ioc, u16 smid)
1107 {
1108         unsigned long flags;
1109         struct scsi_cmnd *scmd;
1110
1111         spin_lock_irqsave(&ioc->scsi_lookup_lock, flags);
1112         scmd = __scsih_scsi_lookup_get_clear(ioc, smid);
1113         spin_unlock_irqrestore(&ioc->scsi_lookup_lock, flags);
1114
1115         return scmd;
1116 }
1117
1118 /**
1119  * _scsih_scsi_lookup_find_by_scmd - scmd lookup
1120  * @ioc: per adapter object
1121  * @smid: system request message index
1122  * @scmd: pointer to scsi command object
1123  * Context: This function will acquire ioc->scsi_lookup_lock.
1124  *
1125  * This will search for a scmd pointer in the scsi_lookup array,
1126  * returning the revelent smid.  A returned value of zero means invalid.
1127  */
1128 static u16
1129 _scsih_scsi_lookup_find_by_scmd(struct MPT3SAS_ADAPTER *ioc, struct scsi_cmnd
1130         *scmd)
1131 {
1132         u16 smid;
1133         unsigned long   flags;
1134         int i;
1135
1136         spin_lock_irqsave(&ioc->scsi_lookup_lock, flags);
1137         smid = 0;
1138         for (i = 0; i < ioc->scsiio_depth; i++) {
1139                 if (ioc->scsi_lookup[i].scmd == scmd) {
1140                         smid = ioc->scsi_lookup[i].smid;
1141                         goto out;
1142                 }
1143         }
1144  out:
1145         spin_unlock_irqrestore(&ioc->scsi_lookup_lock, flags);
1146         return smid;
1147 }
1148
1149 /**
1150  * _scsih_scsi_lookup_find_by_target - search for matching channel:id
1151  * @ioc: per adapter object
1152  * @id: target id
1153  * @channel: channel
1154  * Context: This function will acquire ioc->scsi_lookup_lock.
1155  *
1156  * This will search for a matching channel:id in the scsi_lookup array,
1157  * returning 1 if found.
1158  */
1159 static u8
1160 _scsih_scsi_lookup_find_by_target(struct MPT3SAS_ADAPTER *ioc, int id,
1161         int channel)
1162 {
1163         u8 found;
1164         unsigned long   flags;
1165         int i;
1166
1167         spin_lock_irqsave(&ioc->scsi_lookup_lock, flags);
1168         found = 0;
1169         for (i = 0 ; i < ioc->scsiio_depth; i++) {
1170                 if (ioc->scsi_lookup[i].scmd &&
1171                     (ioc->scsi_lookup[i].scmd->device->id == id &&
1172                     ioc->scsi_lookup[i].scmd->device->channel == channel)) {
1173                         found = 1;
1174                         goto out;
1175                 }
1176         }
1177  out:
1178         spin_unlock_irqrestore(&ioc->scsi_lookup_lock, flags);
1179         return found;
1180 }
1181
1182 /**
1183  * _scsih_scsi_lookup_find_by_lun - search for matching channel:id:lun
1184  * @ioc: per adapter object
1185  * @id: target id
1186  * @lun: lun number
1187  * @channel: channel
1188  * Context: This function will acquire ioc->scsi_lookup_lock.
1189  *
1190  * This will search for a matching channel:id:lun in the scsi_lookup array,
1191  * returning 1 if found.
1192  */
1193 static u8
1194 _scsih_scsi_lookup_find_by_lun(struct MPT3SAS_ADAPTER *ioc, int id,
1195         unsigned int lun, int channel)
1196 {
1197         u8 found;
1198         unsigned long   flags;
1199         int i;
1200
1201         spin_lock_irqsave(&ioc->scsi_lookup_lock, flags);
1202         found = 0;
1203         for (i = 0 ; i < ioc->scsiio_depth; i++) {
1204                 if (ioc->scsi_lookup[i].scmd &&
1205                     (ioc->scsi_lookup[i].scmd->device->id == id &&
1206                     ioc->scsi_lookup[i].scmd->device->channel == channel &&
1207                     ioc->scsi_lookup[i].scmd->device->lun == lun)) {
1208                         found = 1;
1209                         goto out;
1210                 }
1211         }
1212  out:
1213         spin_unlock_irqrestore(&ioc->scsi_lookup_lock, flags);
1214         return found;
1215 }
1216
1217 /**
1218  * scsih_change_queue_depth - setting device queue depth
1219  * @sdev: scsi device struct
1220  * @qdepth: requested queue depth
1221  *
1222  * Returns queue depth.
1223  */
1224 static int
1225 scsih_change_queue_depth(struct scsi_device *sdev, int qdepth)
1226 {
1227         struct Scsi_Host *shost = sdev->host;
1228         int max_depth;
1229         struct MPT3SAS_ADAPTER *ioc = shost_priv(shost);
1230         struct MPT3SAS_DEVICE *sas_device_priv_data;
1231         struct MPT3SAS_TARGET *sas_target_priv_data;
1232         struct _sas_device *sas_device;
1233         unsigned long flags;
1234
1235         max_depth = shost->can_queue;
1236
1237         /* limit max device queue for SATA to 32 */
1238         sas_device_priv_data = sdev->hostdata;
1239         if (!sas_device_priv_data)
1240                 goto not_sata;
1241         sas_target_priv_data = sas_device_priv_data->sas_target;
1242         if (!sas_target_priv_data)
1243                 goto not_sata;
1244         if ((sas_target_priv_data->flags & MPT_TARGET_FLAGS_VOLUME))
1245                 goto not_sata;
1246
1247         spin_lock_irqsave(&ioc->sas_device_lock, flags);
1248         sas_device = __mpt3sas_get_sdev_from_target(ioc, sas_target_priv_data);
1249         if (sas_device) {
1250                 if (sas_device->device_info & MPI2_SAS_DEVICE_INFO_SATA_DEVICE)
1251                         max_depth = MPT3SAS_SATA_QUEUE_DEPTH;
1252
1253                 sas_device_put(sas_device);
1254         }
1255         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
1256
1257  not_sata:
1258
1259         if (!sdev->tagged_supported)
1260                 max_depth = 1;
1261         if (qdepth > max_depth)
1262                 qdepth = max_depth;
1263         return scsi_change_queue_depth(sdev, qdepth);
1264 }
1265
1266 /**
1267  * scsih_target_alloc - target add routine
1268  * @starget: scsi target struct
1269  *
1270  * Returns 0 if ok. Any other return is assumed to be an error and
1271  * the device is ignored.
1272  */
1273 static int
1274 scsih_target_alloc(struct scsi_target *starget)
1275 {
1276         struct Scsi_Host *shost = dev_to_shost(&starget->dev);
1277         struct MPT3SAS_ADAPTER *ioc = shost_priv(shost);
1278         struct MPT3SAS_TARGET *sas_target_priv_data;
1279         struct _sas_device *sas_device;
1280         struct _raid_device *raid_device;
1281         unsigned long flags;
1282         struct sas_rphy *rphy;
1283
1284         sas_target_priv_data = kzalloc(sizeof(*sas_target_priv_data),
1285                                        GFP_KERNEL);
1286         if (!sas_target_priv_data)
1287                 return -ENOMEM;
1288
1289         starget->hostdata = sas_target_priv_data;
1290         sas_target_priv_data->starget = starget;
1291         sas_target_priv_data->handle = MPT3SAS_INVALID_DEVICE_HANDLE;
1292
1293         /* RAID volumes */
1294         if (starget->channel == RAID_CHANNEL) {
1295                 spin_lock_irqsave(&ioc->raid_device_lock, flags);
1296                 raid_device = _scsih_raid_device_find_by_id(ioc, starget->id,
1297                     starget->channel);
1298                 if (raid_device) {
1299                         sas_target_priv_data->handle = raid_device->handle;
1300                         sas_target_priv_data->sas_address = raid_device->wwid;
1301                         sas_target_priv_data->flags |= MPT_TARGET_FLAGS_VOLUME;
1302                         if (ioc->is_warpdrive)
1303                                 sas_target_priv_data->raid_device = raid_device;
1304                         raid_device->starget = starget;
1305                 }
1306                 spin_unlock_irqrestore(&ioc->raid_device_lock, flags);
1307                 return 0;
1308         }
1309
1310         /* sas/sata devices */
1311         spin_lock_irqsave(&ioc->sas_device_lock, flags);
1312         rphy = dev_to_rphy(starget->dev.parent);
1313         sas_device = __mpt3sas_get_sdev_by_addr(ioc,
1314            rphy->identify.sas_address);
1315
1316         if (sas_device) {
1317                 sas_target_priv_data->handle = sas_device->handle;
1318                 sas_target_priv_data->sas_address = sas_device->sas_address;
1319                 sas_target_priv_data->sdev = sas_device;
1320                 sas_device->starget = starget;
1321                 sas_device->id = starget->id;
1322                 sas_device->channel = starget->channel;
1323                 if (test_bit(sas_device->handle, ioc->pd_handles))
1324                         sas_target_priv_data->flags |=
1325                             MPT_TARGET_FLAGS_RAID_COMPONENT;
1326                 if (sas_device->fast_path)
1327                         sas_target_priv_data->flags |= MPT_TARGET_FASTPATH_IO;
1328         }
1329         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
1330
1331         return 0;
1332 }
1333
1334 /**
1335  * scsih_target_destroy - target destroy routine
1336  * @starget: scsi target struct
1337  *
1338  * Returns nothing.
1339  */
1340 static void
1341 scsih_target_destroy(struct scsi_target *starget)
1342 {
1343         struct Scsi_Host *shost = dev_to_shost(&starget->dev);
1344         struct MPT3SAS_ADAPTER *ioc = shost_priv(shost);
1345         struct MPT3SAS_TARGET *sas_target_priv_data;
1346         struct _sas_device *sas_device;
1347         struct _raid_device *raid_device;
1348         unsigned long flags;
1349
1350         sas_target_priv_data = starget->hostdata;
1351         if (!sas_target_priv_data)
1352                 return;
1353
1354         if (starget->channel == RAID_CHANNEL) {
1355                 spin_lock_irqsave(&ioc->raid_device_lock, flags);
1356                 raid_device = _scsih_raid_device_find_by_id(ioc, starget->id,
1357                     starget->channel);
1358                 if (raid_device) {
1359                         raid_device->starget = NULL;
1360                         raid_device->sdev = NULL;
1361                 }
1362                 spin_unlock_irqrestore(&ioc->raid_device_lock, flags);
1363                 goto out;
1364         }
1365
1366         spin_lock_irqsave(&ioc->sas_device_lock, flags);
1367         sas_device = __mpt3sas_get_sdev_from_target(ioc, sas_target_priv_data);
1368         if (sas_device && (sas_device->starget == starget) &&
1369             (sas_device->id == starget->id) &&
1370             (sas_device->channel == starget->channel))
1371                 sas_device->starget = NULL;
1372
1373         if (sas_device) {
1374                 /*
1375                  * Corresponding get() is in _scsih_target_alloc()
1376                  */
1377                 sas_target_priv_data->sdev = NULL;
1378                 sas_device_put(sas_device);
1379
1380                 sas_device_put(sas_device);
1381         }
1382         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
1383
1384  out:
1385         kfree(sas_target_priv_data);
1386         starget->hostdata = NULL;
1387 }
1388
1389 /**
1390  * scsih_slave_alloc - device add routine
1391  * @sdev: scsi device struct
1392  *
1393  * Returns 0 if ok. Any other return is assumed to be an error and
1394  * the device is ignored.
1395  */
1396 static int
1397 scsih_slave_alloc(struct scsi_device *sdev)
1398 {
1399         struct Scsi_Host *shost;
1400         struct MPT3SAS_ADAPTER *ioc;
1401         struct MPT3SAS_TARGET *sas_target_priv_data;
1402         struct MPT3SAS_DEVICE *sas_device_priv_data;
1403         struct scsi_target *starget;
1404         struct _raid_device *raid_device;
1405         struct _sas_device *sas_device;
1406         unsigned long flags;
1407
1408         sas_device_priv_data = kzalloc(sizeof(*sas_device_priv_data),
1409                                        GFP_KERNEL);
1410         if (!sas_device_priv_data)
1411                 return -ENOMEM;
1412
1413         sas_device_priv_data->lun = sdev->lun;
1414         sas_device_priv_data->flags = MPT_DEVICE_FLAGS_INIT;
1415
1416         starget = scsi_target(sdev);
1417         sas_target_priv_data = starget->hostdata;
1418         sas_target_priv_data->num_luns++;
1419         sas_device_priv_data->sas_target = sas_target_priv_data;
1420         sdev->hostdata = sas_device_priv_data;
1421         if ((sas_target_priv_data->flags & MPT_TARGET_FLAGS_RAID_COMPONENT))
1422                 sdev->no_uld_attach = 1;
1423
1424         shost = dev_to_shost(&starget->dev);
1425         ioc = shost_priv(shost);
1426         if (starget->channel == RAID_CHANNEL) {
1427                 spin_lock_irqsave(&ioc->raid_device_lock, flags);
1428                 raid_device = _scsih_raid_device_find_by_id(ioc,
1429                     starget->id, starget->channel);
1430                 if (raid_device)
1431                         raid_device->sdev = sdev; /* raid is single lun */
1432                 spin_unlock_irqrestore(&ioc->raid_device_lock, flags);
1433         }
1434
1435         if (!(sas_target_priv_data->flags & MPT_TARGET_FLAGS_VOLUME)) {
1436                 spin_lock_irqsave(&ioc->sas_device_lock, flags);
1437                 sas_device = __mpt3sas_get_sdev_by_addr(ioc,
1438                                         sas_target_priv_data->sas_address);
1439                 if (sas_device && (sas_device->starget == NULL)) {
1440                         sdev_printk(KERN_INFO, sdev,
1441                         "%s : sas_device->starget set to starget @ %d\n",
1442                              __func__, __LINE__);
1443                         sas_device->starget = starget;
1444                 }
1445
1446                 if (sas_device)
1447                         sas_device_put(sas_device);
1448
1449                 spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
1450         }
1451
1452         return 0;
1453 }
1454
1455 /**
1456  * scsih_slave_destroy - device destroy routine
1457  * @sdev: scsi device struct
1458  *
1459  * Returns nothing.
1460  */
1461 static void
1462 scsih_slave_destroy(struct scsi_device *sdev)
1463 {
1464         struct MPT3SAS_TARGET *sas_target_priv_data;
1465         struct scsi_target *starget;
1466         struct Scsi_Host *shost;
1467         struct MPT3SAS_ADAPTER *ioc;
1468         struct _sas_device *sas_device;
1469         unsigned long flags;
1470
1471         if (!sdev->hostdata)
1472                 return;
1473
1474         starget = scsi_target(sdev);
1475         sas_target_priv_data = starget->hostdata;
1476         sas_target_priv_data->num_luns--;
1477
1478         shost = dev_to_shost(&starget->dev);
1479         ioc = shost_priv(shost);
1480
1481         if (!(sas_target_priv_data->flags & MPT_TARGET_FLAGS_VOLUME)) {
1482                 spin_lock_irqsave(&ioc->sas_device_lock, flags);
1483                 sas_device = __mpt3sas_get_sdev_from_target(ioc,
1484                                 sas_target_priv_data);
1485                 if (sas_device && !sas_target_priv_data->num_luns)
1486                         sas_device->starget = NULL;
1487
1488                 if (sas_device)
1489                         sas_device_put(sas_device);
1490                 spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
1491         }
1492
1493         kfree(sdev->hostdata);
1494         sdev->hostdata = NULL;
1495 }
1496
1497 /**
1498  * _scsih_display_sata_capabilities - sata capabilities
1499  * @ioc: per adapter object
1500  * @handle: device handle
1501  * @sdev: scsi device struct
1502  */
1503 static void
1504 _scsih_display_sata_capabilities(struct MPT3SAS_ADAPTER *ioc,
1505         u16 handle, struct scsi_device *sdev)
1506 {
1507         Mpi2ConfigReply_t mpi_reply;
1508         Mpi2SasDevicePage0_t sas_device_pg0;
1509         u32 ioc_status;
1510         u16 flags;
1511         u32 device_info;
1512
1513         if ((mpt3sas_config_get_sas_device_pg0(ioc, &mpi_reply, &sas_device_pg0,
1514             MPI2_SAS_DEVICE_PGAD_FORM_HANDLE, handle))) {
1515                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
1516                     ioc->name, __FILE__, __LINE__, __func__);
1517                 return;
1518         }
1519
1520         ioc_status = le16_to_cpu(mpi_reply.IOCStatus) &
1521             MPI2_IOCSTATUS_MASK;
1522         if (ioc_status != MPI2_IOCSTATUS_SUCCESS) {
1523                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
1524                     ioc->name, __FILE__, __LINE__, __func__);
1525                 return;
1526         }
1527
1528         flags = le16_to_cpu(sas_device_pg0.Flags);
1529         device_info = le32_to_cpu(sas_device_pg0.DeviceInfo);
1530
1531         sdev_printk(KERN_INFO, sdev,
1532             "atapi(%s), ncq(%s), asyn_notify(%s), smart(%s), fua(%s), "
1533             "sw_preserve(%s)\n",
1534             (device_info & MPI2_SAS_DEVICE_INFO_ATAPI_DEVICE) ? "y" : "n",
1535             (flags & MPI2_SAS_DEVICE0_FLAGS_SATA_NCQ_SUPPORTED) ? "y" : "n",
1536             (flags & MPI2_SAS_DEVICE0_FLAGS_SATA_ASYNCHRONOUS_NOTIFY) ? "y" :
1537             "n",
1538             (flags & MPI2_SAS_DEVICE0_FLAGS_SATA_SMART_SUPPORTED) ? "y" : "n",
1539             (flags & MPI2_SAS_DEVICE0_FLAGS_SATA_FUA_SUPPORTED) ? "y" : "n",
1540             (flags & MPI2_SAS_DEVICE0_FLAGS_SATA_SW_PRESERVE) ? "y" : "n");
1541 }
1542
1543 /*
1544  * raid transport support -
1545  * Enabled for SLES11 and newer, in older kernels the driver will panic when
1546  * unloading the driver followed by a load - I believe that the subroutine
1547  * raid_class_release() is not cleaning up properly.
1548  */
1549
1550 /**
1551  * scsih_is_raid - return boolean indicating device is raid volume
1552  * @dev the device struct object
1553  */
1554 static int
1555 scsih_is_raid(struct device *dev)
1556 {
1557         struct scsi_device *sdev = to_scsi_device(dev);
1558         struct MPT3SAS_ADAPTER *ioc = shost_priv(sdev->host);
1559
1560         if (ioc->is_warpdrive)
1561                 return 0;
1562         return (sdev->channel == RAID_CHANNEL) ? 1 : 0;
1563 }
1564
1565 /**
1566  * scsih_get_resync - get raid volume resync percent complete
1567  * @dev the device struct object
1568  */
1569 static void
1570 scsih_get_resync(struct device *dev)
1571 {
1572         struct scsi_device *sdev = to_scsi_device(dev);
1573         struct MPT3SAS_ADAPTER *ioc = shost_priv(sdev->host);
1574         static struct _raid_device *raid_device;
1575         unsigned long flags;
1576         Mpi2RaidVolPage0_t vol_pg0;
1577         Mpi2ConfigReply_t mpi_reply;
1578         u32 volume_status_flags;
1579         u8 percent_complete;
1580         u16 handle;
1581
1582         percent_complete = 0;
1583         handle = 0;
1584         if (ioc->is_warpdrive)
1585                 goto out;
1586
1587         spin_lock_irqsave(&ioc->raid_device_lock, flags);
1588         raid_device = _scsih_raid_device_find_by_id(ioc, sdev->id,
1589             sdev->channel);
1590         if (raid_device) {
1591                 handle = raid_device->handle;
1592                 percent_complete = raid_device->percent_complete;
1593         }
1594         spin_unlock_irqrestore(&ioc->raid_device_lock, flags);
1595
1596         if (!handle)
1597                 goto out;
1598
1599         if (mpt3sas_config_get_raid_volume_pg0(ioc, &mpi_reply, &vol_pg0,
1600              MPI2_RAID_VOLUME_PGAD_FORM_HANDLE, handle,
1601              sizeof(Mpi2RaidVolPage0_t))) {
1602                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
1603                     ioc->name, __FILE__, __LINE__, __func__);
1604                 percent_complete = 0;
1605                 goto out;
1606         }
1607
1608         volume_status_flags = le32_to_cpu(vol_pg0.VolumeStatusFlags);
1609         if (!(volume_status_flags &
1610             MPI2_RAIDVOL0_STATUS_FLAG_RESYNC_IN_PROGRESS))
1611                 percent_complete = 0;
1612
1613  out:
1614
1615         switch (ioc->hba_mpi_version_belonged) {
1616         case MPI2_VERSION:
1617                 raid_set_resync(mpt2sas_raid_template, dev, percent_complete);
1618                 break;
1619         case MPI25_VERSION:
1620         case MPI26_VERSION:
1621                 raid_set_resync(mpt3sas_raid_template, dev, percent_complete);
1622                 break;
1623         }
1624 }
1625
1626 /**
1627  * scsih_get_state - get raid volume level
1628  * @dev the device struct object
1629  */
1630 static void
1631 scsih_get_state(struct device *dev)
1632 {
1633         struct scsi_device *sdev = to_scsi_device(dev);
1634         struct MPT3SAS_ADAPTER *ioc = shost_priv(sdev->host);
1635         static struct _raid_device *raid_device;
1636         unsigned long flags;
1637         Mpi2RaidVolPage0_t vol_pg0;
1638         Mpi2ConfigReply_t mpi_reply;
1639         u32 volstate;
1640         enum raid_state state = RAID_STATE_UNKNOWN;
1641         u16 handle = 0;
1642
1643         spin_lock_irqsave(&ioc->raid_device_lock, flags);
1644         raid_device = _scsih_raid_device_find_by_id(ioc, sdev->id,
1645             sdev->channel);
1646         if (raid_device)
1647                 handle = raid_device->handle;
1648         spin_unlock_irqrestore(&ioc->raid_device_lock, flags);
1649
1650         if (!raid_device)
1651                 goto out;
1652
1653         if (mpt3sas_config_get_raid_volume_pg0(ioc, &mpi_reply, &vol_pg0,
1654              MPI2_RAID_VOLUME_PGAD_FORM_HANDLE, handle,
1655              sizeof(Mpi2RaidVolPage0_t))) {
1656                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
1657                     ioc->name, __FILE__, __LINE__, __func__);
1658                 goto out;
1659         }
1660
1661         volstate = le32_to_cpu(vol_pg0.VolumeStatusFlags);
1662         if (volstate & MPI2_RAIDVOL0_STATUS_FLAG_RESYNC_IN_PROGRESS) {
1663                 state = RAID_STATE_RESYNCING;
1664                 goto out;
1665         }
1666
1667         switch (vol_pg0.VolumeState) {
1668         case MPI2_RAID_VOL_STATE_OPTIMAL:
1669         case MPI2_RAID_VOL_STATE_ONLINE:
1670                 state = RAID_STATE_ACTIVE;
1671                 break;
1672         case  MPI2_RAID_VOL_STATE_DEGRADED:
1673                 state = RAID_STATE_DEGRADED;
1674                 break;
1675         case MPI2_RAID_VOL_STATE_FAILED:
1676         case MPI2_RAID_VOL_STATE_MISSING:
1677                 state = RAID_STATE_OFFLINE;
1678                 break;
1679         }
1680  out:
1681         switch (ioc->hba_mpi_version_belonged) {
1682         case MPI2_VERSION:
1683                 raid_set_state(mpt2sas_raid_template, dev, state);
1684                 break;
1685         case MPI25_VERSION:
1686         case MPI26_VERSION:
1687                 raid_set_state(mpt3sas_raid_template, dev, state);
1688                 break;
1689         }
1690 }
1691
1692 /**
1693  * _scsih_set_level - set raid level
1694  * @sdev: scsi device struct
1695  * @volume_type: volume type
1696  */
1697 static void
1698 _scsih_set_level(struct MPT3SAS_ADAPTER *ioc,
1699         struct scsi_device *sdev, u8 volume_type)
1700 {
1701         enum raid_level level = RAID_LEVEL_UNKNOWN;
1702
1703         switch (volume_type) {
1704         case MPI2_RAID_VOL_TYPE_RAID0:
1705                 level = RAID_LEVEL_0;
1706                 break;
1707         case MPI2_RAID_VOL_TYPE_RAID10:
1708                 level = RAID_LEVEL_10;
1709                 break;
1710         case MPI2_RAID_VOL_TYPE_RAID1E:
1711                 level = RAID_LEVEL_1E;
1712                 break;
1713         case MPI2_RAID_VOL_TYPE_RAID1:
1714                 level = RAID_LEVEL_1;
1715                 break;
1716         }
1717
1718         switch (ioc->hba_mpi_version_belonged) {
1719         case MPI2_VERSION:
1720                 raid_set_level(mpt2sas_raid_template,
1721                         &sdev->sdev_gendev, level);
1722                 break;
1723         case MPI25_VERSION:
1724         case MPI26_VERSION:
1725                 raid_set_level(mpt3sas_raid_template,
1726                         &sdev->sdev_gendev, level);
1727                 break;
1728         }
1729 }
1730
1731
1732 /**
1733  * _scsih_get_volume_capabilities - volume capabilities
1734  * @ioc: per adapter object
1735  * @sas_device: the raid_device object
1736  *
1737  * Returns 0 for success, else 1
1738  */
1739 static int
1740 _scsih_get_volume_capabilities(struct MPT3SAS_ADAPTER *ioc,
1741         struct _raid_device *raid_device)
1742 {
1743         Mpi2RaidVolPage0_t *vol_pg0;
1744         Mpi2RaidPhysDiskPage0_t pd_pg0;
1745         Mpi2SasDevicePage0_t sas_device_pg0;
1746         Mpi2ConfigReply_t mpi_reply;
1747         u16 sz;
1748         u8 num_pds;
1749
1750         if ((mpt3sas_config_get_number_pds(ioc, raid_device->handle,
1751             &num_pds)) || !num_pds) {
1752                 dfailprintk(ioc, pr_warn(MPT3SAS_FMT
1753                     "failure at %s:%d/%s()!\n", ioc->name, __FILE__, __LINE__,
1754                     __func__));
1755                 return 1;
1756         }
1757
1758         raid_device->num_pds = num_pds;
1759         sz = offsetof(Mpi2RaidVolPage0_t, PhysDisk) + (num_pds *
1760             sizeof(Mpi2RaidVol0PhysDisk_t));
1761         vol_pg0 = kzalloc(sz, GFP_KERNEL);
1762         if (!vol_pg0) {
1763                 dfailprintk(ioc, pr_warn(MPT3SAS_FMT
1764                     "failure at %s:%d/%s()!\n", ioc->name, __FILE__, __LINE__,
1765                     __func__));
1766                 return 1;
1767         }
1768
1769         if ((mpt3sas_config_get_raid_volume_pg0(ioc, &mpi_reply, vol_pg0,
1770              MPI2_RAID_VOLUME_PGAD_FORM_HANDLE, raid_device->handle, sz))) {
1771                 dfailprintk(ioc, pr_warn(MPT3SAS_FMT
1772                     "failure at %s:%d/%s()!\n", ioc->name, __FILE__, __LINE__,
1773                     __func__));
1774                 kfree(vol_pg0);
1775                 return 1;
1776         }
1777
1778         raid_device->volume_type = vol_pg0->VolumeType;
1779
1780         /* figure out what the underlying devices are by
1781          * obtaining the device_info bits for the 1st device
1782          */
1783         if (!(mpt3sas_config_get_phys_disk_pg0(ioc, &mpi_reply,
1784             &pd_pg0, MPI2_PHYSDISK_PGAD_FORM_PHYSDISKNUM,
1785             vol_pg0->PhysDisk[0].PhysDiskNum))) {
1786                 if (!(mpt3sas_config_get_sas_device_pg0(ioc, &mpi_reply,
1787                     &sas_device_pg0, MPI2_SAS_DEVICE_PGAD_FORM_HANDLE,
1788                     le16_to_cpu(pd_pg0.DevHandle)))) {
1789                         raid_device->device_info =
1790                             le32_to_cpu(sas_device_pg0.DeviceInfo);
1791                 }
1792         }
1793
1794         kfree(vol_pg0);
1795         return 0;
1796 }
1797
1798 /**
1799  * _scsih_enable_tlr - setting TLR flags
1800  * @ioc: per adapter object
1801  * @sdev: scsi device struct
1802  *
1803  * Enabling Transaction Layer Retries for tape devices when
1804  * vpd page 0x90 is present
1805  *
1806  */
1807 static void
1808 _scsih_enable_tlr(struct MPT3SAS_ADAPTER *ioc, struct scsi_device *sdev)
1809 {
1810
1811         /* only for TAPE */
1812         if (sdev->type != TYPE_TAPE)
1813                 return;
1814
1815         if (!(ioc->facts.IOCCapabilities & MPI2_IOCFACTS_CAPABILITY_TLR))
1816                 return;
1817
1818         sas_enable_tlr(sdev);
1819         sdev_printk(KERN_INFO, sdev, "TLR %s\n",
1820             sas_is_tlr_enabled(sdev) ? "Enabled" : "Disabled");
1821         return;
1822
1823 }
1824
1825 /**
1826  * scsih_slave_configure - device configure routine.
1827  * @sdev: scsi device struct
1828  *
1829  * Returns 0 if ok. Any other return is assumed to be an error and
1830  * the device is ignored.
1831  */
1832 static int
1833 scsih_slave_configure(struct scsi_device *sdev)
1834 {
1835         struct Scsi_Host *shost = sdev->host;
1836         struct MPT3SAS_ADAPTER *ioc = shost_priv(shost);
1837         struct MPT3SAS_DEVICE *sas_device_priv_data;
1838         struct MPT3SAS_TARGET *sas_target_priv_data;
1839         struct _sas_device *sas_device;
1840         struct _raid_device *raid_device;
1841         unsigned long flags;
1842         int qdepth;
1843         u8 ssp_target = 0;
1844         char *ds = "";
1845         char *r_level = "";
1846         u16 handle, volume_handle = 0;
1847         u64 volume_wwid = 0;
1848
1849         qdepth = 1;
1850         sas_device_priv_data = sdev->hostdata;
1851         sas_device_priv_data->configured_lun = 1;
1852         sas_device_priv_data->flags &= ~MPT_DEVICE_FLAGS_INIT;
1853         sas_target_priv_data = sas_device_priv_data->sas_target;
1854         handle = sas_target_priv_data->handle;
1855
1856         /* raid volume handling */
1857         if (sas_target_priv_data->flags & MPT_TARGET_FLAGS_VOLUME) {
1858
1859                 spin_lock_irqsave(&ioc->raid_device_lock, flags);
1860                 raid_device = mpt3sas_raid_device_find_by_handle(ioc, handle);
1861                 spin_unlock_irqrestore(&ioc->raid_device_lock, flags);
1862                 if (!raid_device) {
1863                         dfailprintk(ioc, pr_warn(MPT3SAS_FMT
1864                             "failure at %s:%d/%s()!\n", ioc->name, __FILE__,
1865                             __LINE__, __func__));
1866                         return 1;
1867                 }
1868
1869                 if (_scsih_get_volume_capabilities(ioc, raid_device)) {
1870                         dfailprintk(ioc, pr_warn(MPT3SAS_FMT
1871                             "failure at %s:%d/%s()!\n", ioc->name, __FILE__,
1872                             __LINE__, __func__));
1873                         return 1;
1874                 }
1875
1876                 /*
1877                  * WARPDRIVE: Initialize the required data for Direct IO
1878                  */
1879                 mpt3sas_init_warpdrive_properties(ioc, raid_device);
1880
1881                 /* RAID Queue Depth Support
1882                  * IS volume = underlying qdepth of drive type, either
1883                  *    MPT3SAS_SAS_QUEUE_DEPTH or MPT3SAS_SATA_QUEUE_DEPTH
1884                  * IM/IME/R10 = 128 (MPT3SAS_RAID_QUEUE_DEPTH)
1885                  */
1886                 if (raid_device->device_info &
1887                     MPI2_SAS_DEVICE_INFO_SSP_TARGET) {
1888                         qdepth = MPT3SAS_SAS_QUEUE_DEPTH;
1889                         ds = "SSP";
1890                 } else {
1891                         qdepth = MPT3SAS_SATA_QUEUE_DEPTH;
1892                          if (raid_device->device_info &
1893                             MPI2_SAS_DEVICE_INFO_SATA_DEVICE)
1894                                 ds = "SATA";
1895                         else
1896                                 ds = "STP";
1897                 }
1898
1899                 switch (raid_device->volume_type) {
1900                 case MPI2_RAID_VOL_TYPE_RAID0:
1901                         r_level = "RAID0";
1902                         break;
1903                 case MPI2_RAID_VOL_TYPE_RAID1E:
1904                         qdepth = MPT3SAS_RAID_QUEUE_DEPTH;
1905                         if (ioc->manu_pg10.OEMIdentifier &&
1906                             (le32_to_cpu(ioc->manu_pg10.GenericFlags0) &
1907                             MFG10_GF0_R10_DISPLAY) &&
1908                             !(raid_device->num_pds % 2))
1909                                 r_level = "RAID10";
1910                         else
1911                                 r_level = "RAID1E";
1912                         break;
1913                 case MPI2_RAID_VOL_TYPE_RAID1:
1914                         qdepth = MPT3SAS_RAID_QUEUE_DEPTH;
1915                         r_level = "RAID1";
1916                         break;
1917                 case MPI2_RAID_VOL_TYPE_RAID10:
1918                         qdepth = MPT3SAS_RAID_QUEUE_DEPTH;
1919                         r_level = "RAID10";
1920                         break;
1921                 case MPI2_RAID_VOL_TYPE_UNKNOWN:
1922                 default:
1923                         qdepth = MPT3SAS_RAID_QUEUE_DEPTH;
1924                         r_level = "RAIDX";
1925                         break;
1926                 }
1927
1928                 if (!ioc->hide_ir_msg)
1929                         sdev_printk(KERN_INFO, sdev,
1930                            "%s: handle(0x%04x), wwid(0x%016llx),"
1931                             " pd_count(%d), type(%s)\n",
1932                             r_level, raid_device->handle,
1933                             (unsigned long long)raid_device->wwid,
1934                             raid_device->num_pds, ds);
1935
1936                 if (shost->max_sectors > MPT3SAS_RAID_MAX_SECTORS) {
1937                         blk_queue_max_hw_sectors(sdev->request_queue,
1938                                                 MPT3SAS_RAID_MAX_SECTORS);
1939                         sdev_printk(KERN_INFO, sdev,
1940                                         "Set queue's max_sector to: %u\n",
1941                                                 MPT3SAS_RAID_MAX_SECTORS);
1942                 }
1943
1944                 scsih_change_queue_depth(sdev, qdepth);
1945
1946                 /* raid transport support */
1947                 if (!ioc->is_warpdrive)
1948                         _scsih_set_level(ioc, sdev, raid_device->volume_type);
1949                 return 0;
1950         }
1951
1952         /* non-raid handling */
1953         if (sas_target_priv_data->flags & MPT_TARGET_FLAGS_RAID_COMPONENT) {
1954                 if (mpt3sas_config_get_volume_handle(ioc, handle,
1955                     &volume_handle)) {
1956                         dfailprintk(ioc, pr_warn(MPT3SAS_FMT
1957                             "failure at %s:%d/%s()!\n", ioc->name,
1958                             __FILE__, __LINE__, __func__));
1959                         return 1;
1960                 }
1961                 if (volume_handle && mpt3sas_config_get_volume_wwid(ioc,
1962                     volume_handle, &volume_wwid)) {
1963                         dfailprintk(ioc, pr_warn(MPT3SAS_FMT
1964                             "failure at %s:%d/%s()!\n", ioc->name,
1965                             __FILE__, __LINE__, __func__));
1966                         return 1;
1967                 }
1968         }
1969
1970         spin_lock_irqsave(&ioc->sas_device_lock, flags);
1971         sas_device = __mpt3sas_get_sdev_by_addr(ioc,
1972            sas_device_priv_data->sas_target->sas_address);
1973         if (!sas_device) {
1974                 spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
1975                 dfailprintk(ioc, pr_warn(MPT3SAS_FMT
1976                     "failure at %s:%d/%s()!\n", ioc->name, __FILE__, __LINE__,
1977                     __func__));
1978                 return 1;
1979         }
1980
1981         sas_device->volume_handle = volume_handle;
1982         sas_device->volume_wwid = volume_wwid;
1983         if (sas_device->device_info & MPI2_SAS_DEVICE_INFO_SSP_TARGET) {
1984                 qdepth = MPT3SAS_SAS_QUEUE_DEPTH;
1985                 ssp_target = 1;
1986                 if (sas_device->device_info &
1987                                 MPI2_SAS_DEVICE_INFO_SEP) {
1988                         sdev_printk(KERN_WARNING, sdev,
1989                         "set ignore_delay_remove for handle(0x%04x)\n",
1990                         sas_device_priv_data->sas_target->handle);
1991                         sas_device_priv_data->ignore_delay_remove = 1;
1992                         ds = "SES";
1993                 } else
1994                         ds = "SSP";
1995         } else {
1996                 qdepth = MPT3SAS_SATA_QUEUE_DEPTH;
1997                 if (sas_device->device_info & MPI2_SAS_DEVICE_INFO_STP_TARGET)
1998                         ds = "STP";
1999                 else if (sas_device->device_info &
2000                     MPI2_SAS_DEVICE_INFO_SATA_DEVICE)
2001                         ds = "SATA";
2002         }
2003
2004         sdev_printk(KERN_INFO, sdev, "%s: handle(0x%04x), " \
2005             "sas_addr(0x%016llx), phy(%d), device_name(0x%016llx)\n",
2006             ds, handle, (unsigned long long)sas_device->sas_address,
2007             sas_device->phy, (unsigned long long)sas_device->device_name);
2008         if (sas_device->enclosure_handle != 0)
2009                 sdev_printk(KERN_INFO, sdev,
2010                      "%s: enclosure_logical_id(0x%016llx), slot(%d)\n",
2011                      ds, (unsigned long long)
2012                      sas_device->enclosure_logical_id, sas_device->slot);
2013         if (sas_device->connector_name[0] != '\0')
2014                 sdev_printk(KERN_INFO, sdev,
2015                      "%s: enclosure level(0x%04x), connector name( %s)\n",
2016                      ds, sas_device->enclosure_level,
2017                      sas_device->connector_name);
2018
2019         sas_device_put(sas_device);
2020         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
2021
2022         if (!ssp_target)
2023                 _scsih_display_sata_capabilities(ioc, handle, sdev);
2024
2025
2026         scsih_change_queue_depth(sdev, qdepth);
2027
2028         if (ssp_target) {
2029                 sas_read_port_mode_page(sdev);
2030                 _scsih_enable_tlr(ioc, sdev);
2031         }
2032
2033         return 0;
2034 }
2035
2036 /**
2037  * scsih_bios_param - fetch head, sector, cylinder info for a disk
2038  * @sdev: scsi device struct
2039  * @bdev: pointer to block device context
2040  * @capacity: device size (in 512 byte sectors)
2041  * @params: three element array to place output:
2042  *              params[0] number of heads (max 255)
2043  *              params[1] number of sectors (max 63)
2044  *              params[2] number of cylinders
2045  *
2046  * Return nothing.
2047  */
2048 static int
2049 scsih_bios_param(struct scsi_device *sdev, struct block_device *bdev,
2050         sector_t capacity, int params[])
2051 {
2052         int             heads;
2053         int             sectors;
2054         sector_t        cylinders;
2055         ulong           dummy;
2056
2057         heads = 64;
2058         sectors = 32;
2059
2060         dummy = heads * sectors;
2061         cylinders = capacity;
2062         sector_div(cylinders, dummy);
2063
2064         /*
2065          * Handle extended translation size for logical drives
2066          * > 1Gb
2067          */
2068         if ((ulong)capacity >= 0x200000) {
2069                 heads = 255;
2070                 sectors = 63;
2071                 dummy = heads * sectors;
2072                 cylinders = capacity;
2073                 sector_div(cylinders, dummy);
2074         }
2075
2076         /* return result */
2077         params[0] = heads;
2078         params[1] = sectors;
2079         params[2] = cylinders;
2080
2081         return 0;
2082 }
2083
2084 /**
2085  * _scsih_response_code - translation of device response code
2086  * @ioc: per adapter object
2087  * @response_code: response code returned by the device
2088  *
2089  * Return nothing.
2090  */
2091 static void
2092 _scsih_response_code(struct MPT3SAS_ADAPTER *ioc, u8 response_code)
2093 {
2094         char *desc;
2095
2096         switch (response_code) {
2097         case MPI2_SCSITASKMGMT_RSP_TM_COMPLETE:
2098                 desc = "task management request completed";
2099                 break;
2100         case MPI2_SCSITASKMGMT_RSP_INVALID_FRAME:
2101                 desc = "invalid frame";
2102                 break;
2103         case MPI2_SCSITASKMGMT_RSP_TM_NOT_SUPPORTED:
2104                 desc = "task management request not supported";
2105                 break;
2106         case MPI2_SCSITASKMGMT_RSP_TM_FAILED:
2107                 desc = "task management request failed";
2108                 break;
2109         case MPI2_SCSITASKMGMT_RSP_TM_SUCCEEDED:
2110                 desc = "task management request succeeded";
2111                 break;
2112         case MPI2_SCSITASKMGMT_RSP_TM_INVALID_LUN:
2113                 desc = "invalid lun";
2114                 break;
2115         case 0xA:
2116                 desc = "overlapped tag attempted";
2117                 break;
2118         case MPI2_SCSITASKMGMT_RSP_IO_QUEUED_ON_IOC:
2119                 desc = "task queued, however not sent to target";
2120                 break;
2121         default:
2122                 desc = "unknown";
2123                 break;
2124         }
2125         pr_warn(MPT3SAS_FMT "response_code(0x%01x): %s\n",
2126                 ioc->name, response_code, desc);
2127 }
2128
2129 /**
2130  * _scsih_tm_done - tm completion routine
2131  * @ioc: per adapter object
2132  * @smid: system request message index
2133  * @msix_index: MSIX table index supplied by the OS
2134  * @reply: reply message frame(lower 32bit addr)
2135  * Context: none.
2136  *
2137  * The callback handler when using scsih_issue_tm.
2138  *
2139  * Return 1 meaning mf should be freed from _base_interrupt
2140  *        0 means the mf is freed from this function.
2141  */
2142 static u8
2143 _scsih_tm_done(struct MPT3SAS_ADAPTER *ioc, u16 smid, u8 msix_index, u32 reply)
2144 {
2145         MPI2DefaultReply_t *mpi_reply;
2146
2147         if (ioc->tm_cmds.status == MPT3_CMD_NOT_USED)
2148                 return 1;
2149         if (ioc->tm_cmds.smid != smid)
2150                 return 1;
2151         ioc->tm_cmds.status |= MPT3_CMD_COMPLETE;
2152         mpi_reply =  mpt3sas_base_get_reply_virt_addr(ioc, reply);
2153         if (mpi_reply) {
2154                 memcpy(ioc->tm_cmds.reply, mpi_reply, mpi_reply->MsgLength*4);
2155                 ioc->tm_cmds.status |= MPT3_CMD_REPLY_VALID;
2156         }
2157         ioc->tm_cmds.status &= ~MPT3_CMD_PENDING;
2158         complete(&ioc->tm_cmds.done);
2159         return 1;
2160 }
2161
2162 /**
2163  * mpt3sas_scsih_set_tm_flag - set per target tm_busy
2164  * @ioc: per adapter object
2165  * @handle: device handle
2166  *
2167  * During taskmangement request, we need to freeze the device queue.
2168  */
2169 void
2170 mpt3sas_scsih_set_tm_flag(struct MPT3SAS_ADAPTER *ioc, u16 handle)
2171 {
2172         struct MPT3SAS_DEVICE *sas_device_priv_data;
2173         struct scsi_device *sdev;
2174         u8 skip = 0;
2175
2176         shost_for_each_device(sdev, ioc->shost) {
2177                 if (skip)
2178                         continue;
2179                 sas_device_priv_data = sdev->hostdata;
2180                 if (!sas_device_priv_data)
2181                         continue;
2182                 if (sas_device_priv_data->sas_target->handle == handle) {
2183                         sas_device_priv_data->sas_target->tm_busy = 1;
2184                         skip = 1;
2185                         ioc->ignore_loginfos = 1;
2186                 }
2187         }
2188 }
2189
2190 /**
2191  * mpt3sas_scsih_clear_tm_flag - clear per target tm_busy
2192  * @ioc: per adapter object
2193  * @handle: device handle
2194  *
2195  * During taskmangement request, we need to freeze the device queue.
2196  */
2197 void
2198 mpt3sas_scsih_clear_tm_flag(struct MPT3SAS_ADAPTER *ioc, u16 handle)
2199 {
2200         struct MPT3SAS_DEVICE *sas_device_priv_data;
2201         struct scsi_device *sdev;
2202         u8 skip = 0;
2203
2204         shost_for_each_device(sdev, ioc->shost) {
2205                 if (skip)
2206                         continue;
2207                 sas_device_priv_data = sdev->hostdata;
2208                 if (!sas_device_priv_data)
2209                         continue;
2210                 if (sas_device_priv_data->sas_target->handle == handle) {
2211                         sas_device_priv_data->sas_target->tm_busy = 0;
2212                         skip = 1;
2213                         ioc->ignore_loginfos = 0;
2214                 }
2215         }
2216 }
2217
2218 /**
2219  * mpt3sas_scsih_issue_tm - main routine for sending tm requests
2220  * @ioc: per adapter struct
2221  * @device_handle: device handle
2222  * @channel: the channel assigned by the OS
2223  * @id: the id assigned by the OS
2224  * @lun: lun number
2225  * @type: MPI2_SCSITASKMGMT_TASKTYPE__XXX (defined in mpi2_init.h)
2226  * @smid_task: smid assigned to the task
2227  * @timeout: timeout in seconds
2228  * Context: user
2229  *
2230  * A generic API for sending task management requests to firmware.
2231  *
2232  * The callback index is set inside `ioc->tm_cb_idx`.
2233  *
2234  * Return SUCCESS or FAILED.
2235  */
2236 int
2237 mpt3sas_scsih_issue_tm(struct MPT3SAS_ADAPTER *ioc, u16 handle, uint channel,
2238         uint id, uint lun, u8 type, u16 smid_task, ulong timeout)
2239 {
2240         Mpi2SCSITaskManagementRequest_t *mpi_request;
2241         Mpi2SCSITaskManagementReply_t *mpi_reply;
2242         u16 smid = 0;
2243         u32 ioc_state;
2244         struct scsiio_tracker *scsi_lookup = NULL;
2245         int rc;
2246         u16 msix_task = 0;
2247
2248         lockdep_assert_held(&ioc->tm_cmds.mutex);
2249
2250         if (ioc->tm_cmds.status != MPT3_CMD_NOT_USED) {
2251                 pr_info(MPT3SAS_FMT "%s: tm_cmd busy!!!\n",
2252                     __func__, ioc->name);
2253                 return FAILED;
2254         }
2255
2256         if (ioc->shost_recovery || ioc->remove_host ||
2257             ioc->pci_error_recovery) {
2258                 pr_info(MPT3SAS_FMT "%s: host reset in progress!\n",
2259                     __func__, ioc->name);
2260                 return FAILED;
2261         }
2262
2263         ioc_state = mpt3sas_base_get_iocstate(ioc, 0);
2264         if (ioc_state & MPI2_DOORBELL_USED) {
2265                 dhsprintk(ioc, pr_info(MPT3SAS_FMT
2266                         "unexpected doorbell active!\n", ioc->name));
2267                 rc = mpt3sas_base_hard_reset_handler(ioc, FORCE_BIG_HAMMER);
2268                 return (!rc) ? SUCCESS : FAILED;
2269         }
2270
2271         if ((ioc_state & MPI2_IOC_STATE_MASK) == MPI2_IOC_STATE_FAULT) {
2272                 mpt3sas_base_fault_info(ioc, ioc_state &
2273                     MPI2_DOORBELL_DATA_MASK);
2274                 rc = mpt3sas_base_hard_reset_handler(ioc, FORCE_BIG_HAMMER);
2275                 return (!rc) ? SUCCESS : FAILED;
2276         }
2277
2278         smid = mpt3sas_base_get_smid_hpr(ioc, ioc->tm_cb_idx);
2279         if (!smid) {
2280                 pr_err(MPT3SAS_FMT "%s: failed obtaining a smid\n",
2281                     ioc->name, __func__);
2282                 return FAILED;
2283         }
2284
2285         if (type == MPI2_SCSITASKMGMT_TASKTYPE_ABORT_TASK)
2286                 scsi_lookup = &ioc->scsi_lookup[smid_task - 1];
2287
2288         dtmprintk(ioc, pr_info(MPT3SAS_FMT
2289                 "sending tm: handle(0x%04x), task_type(0x%02x), smid(%d)\n",
2290                 ioc->name, handle, type, smid_task));
2291         ioc->tm_cmds.status = MPT3_CMD_PENDING;
2292         mpi_request = mpt3sas_base_get_msg_frame(ioc, smid);
2293         ioc->tm_cmds.smid = smid;
2294         memset(mpi_request, 0, sizeof(Mpi2SCSITaskManagementRequest_t));
2295         memset(ioc->tm_cmds.reply, 0, sizeof(Mpi2SCSITaskManagementReply_t));
2296         mpi_request->Function = MPI2_FUNCTION_SCSI_TASK_MGMT;
2297         mpi_request->DevHandle = cpu_to_le16(handle);
2298         mpi_request->TaskType = type;
2299         mpi_request->TaskMID = cpu_to_le16(smid_task);
2300         int_to_scsilun(lun, (struct scsi_lun *)mpi_request->LUN);
2301         mpt3sas_scsih_set_tm_flag(ioc, handle);
2302         init_completion(&ioc->tm_cmds.done);
2303         if ((type == MPI2_SCSITASKMGMT_TASKTYPE_ABORT_TASK) &&
2304                         (scsi_lookup->msix_io < ioc->reply_queue_count))
2305                 msix_task = scsi_lookup->msix_io;
2306         else
2307                 msix_task = 0;
2308         ioc->put_smid_hi_priority(ioc, smid, msix_task);
2309         wait_for_completion_timeout(&ioc->tm_cmds.done, timeout*HZ);
2310         if (!(ioc->tm_cmds.status & MPT3_CMD_COMPLETE)) {
2311                 pr_err(MPT3SAS_FMT "%s: timeout\n",
2312                     ioc->name, __func__);
2313                 _debug_dump_mf(mpi_request,
2314                     sizeof(Mpi2SCSITaskManagementRequest_t)/4);
2315                 if (!(ioc->tm_cmds.status & MPT3_CMD_RESET)) {
2316                         rc = mpt3sas_base_hard_reset_handler(ioc,
2317                                         FORCE_BIG_HAMMER);
2318                         rc = (!rc) ? SUCCESS : FAILED;
2319                         goto out;
2320                 }
2321         }
2322
2323         /* sync IRQs in case those were busy during flush. */
2324         mpt3sas_base_sync_reply_irqs(ioc);
2325
2326         if (ioc->tm_cmds.status & MPT3_CMD_REPLY_VALID) {
2327                 mpt3sas_trigger_master(ioc, MASTER_TRIGGER_TASK_MANAGMENT);
2328                 mpi_reply = ioc->tm_cmds.reply;
2329                 dtmprintk(ioc, pr_info(MPT3SAS_FMT "complete tm: " \
2330                     "ioc_status(0x%04x), loginfo(0x%08x), term_count(0x%08x)\n",
2331                     ioc->name, le16_to_cpu(mpi_reply->IOCStatus),
2332                     le32_to_cpu(mpi_reply->IOCLogInfo),
2333                     le32_to_cpu(mpi_reply->TerminationCount)));
2334                 if (ioc->logging_level & MPT_DEBUG_TM) {
2335                         _scsih_response_code(ioc, mpi_reply->ResponseCode);
2336                         if (mpi_reply->IOCStatus)
2337                                 _debug_dump_mf(mpi_request,
2338                                     sizeof(Mpi2SCSITaskManagementRequest_t)/4);
2339                 }
2340         }
2341
2342         switch (type) {
2343         case MPI2_SCSITASKMGMT_TASKTYPE_ABORT_TASK:
2344                 rc = SUCCESS;
2345                 if (scsi_lookup->scmd == NULL)
2346                         break;
2347                 rc = FAILED;
2348                 break;
2349
2350         case MPI2_SCSITASKMGMT_TASKTYPE_TARGET_RESET:
2351                 if (_scsih_scsi_lookup_find_by_target(ioc, id, channel))
2352                         rc = FAILED;
2353                 else
2354                         rc = SUCCESS;
2355                 break;
2356         case MPI2_SCSITASKMGMT_TASKTYPE_ABRT_TASK_SET:
2357         case MPI2_SCSITASKMGMT_TASKTYPE_LOGICAL_UNIT_RESET:
2358                 if (_scsih_scsi_lookup_find_by_lun(ioc, id, lun, channel))
2359                         rc = FAILED;
2360                 else
2361                         rc = SUCCESS;
2362                 break;
2363         case MPI2_SCSITASKMGMT_TASKTYPE_QUERY_TASK:
2364                 rc = SUCCESS;
2365                 break;
2366         default:
2367                 rc = FAILED;
2368                 break;
2369         }
2370
2371 out:
2372         mpt3sas_scsih_clear_tm_flag(ioc, handle);
2373         ioc->tm_cmds.status = MPT3_CMD_NOT_USED;
2374         return rc;
2375 }
2376
2377 int mpt3sas_scsih_issue_locked_tm(struct MPT3SAS_ADAPTER *ioc, u16 handle,
2378         uint channel, uint id, uint lun, u8 type, u16 smid_task, ulong timeout)
2379 {
2380         int ret;
2381
2382         mutex_lock(&ioc->tm_cmds.mutex);
2383         ret = mpt3sas_scsih_issue_tm(ioc, handle, channel, id, lun, type,
2384                         smid_task, timeout);
2385         mutex_unlock(&ioc->tm_cmds.mutex);
2386
2387         return ret;
2388 }
2389
2390 /**
2391  * _scsih_tm_display_info - displays info about the device
2392  * @ioc: per adapter struct
2393  * @scmd: pointer to scsi command object
2394  *
2395  * Called by task management callback handlers.
2396  */
2397 static void
2398 _scsih_tm_display_info(struct MPT3SAS_ADAPTER *ioc, struct scsi_cmnd *scmd)
2399 {
2400         struct scsi_target *starget = scmd->device->sdev_target;
2401         struct MPT3SAS_TARGET *priv_target = starget->hostdata;
2402         struct _sas_device *sas_device = NULL;
2403         unsigned long flags;
2404         char *device_str = NULL;
2405
2406         if (!priv_target)
2407                 return;
2408         if (ioc->hide_ir_msg)
2409                 device_str = "WarpDrive";
2410         else
2411                 device_str = "volume";
2412
2413         scsi_print_command(scmd);
2414         if (priv_target->flags & MPT_TARGET_FLAGS_VOLUME) {
2415                 starget_printk(KERN_INFO, starget,
2416                         "%s handle(0x%04x), %s wwid(0x%016llx)\n",
2417                         device_str, priv_target->handle,
2418                     device_str, (unsigned long long)priv_target->sas_address);
2419         } else {
2420                 spin_lock_irqsave(&ioc->sas_device_lock, flags);
2421                 sas_device = __mpt3sas_get_sdev_from_target(ioc, priv_target);
2422                 if (sas_device) {
2423                         if (priv_target->flags &
2424                             MPT_TARGET_FLAGS_RAID_COMPONENT) {
2425                                 starget_printk(KERN_INFO, starget,
2426                                     "volume handle(0x%04x), "
2427                                     "volume wwid(0x%016llx)\n",
2428                                     sas_device->volume_handle,
2429                                    (unsigned long long)sas_device->volume_wwid);
2430                         }
2431                         starget_printk(KERN_INFO, starget,
2432                             "handle(0x%04x), sas_address(0x%016llx), phy(%d)\n",
2433                             sas_device->handle,
2434                             (unsigned long long)sas_device->sas_address,
2435                             sas_device->phy);
2436                         if (sas_device->enclosure_handle != 0)
2437                                 starget_printk(KERN_INFO, starget,
2438                                  "enclosure_logical_id(0x%016llx), slot(%d)\n",
2439                                  (unsigned long long)
2440                                  sas_device->enclosure_logical_id,
2441                                  sas_device->slot);
2442                         if (sas_device->connector_name[0] != '\0')
2443                                 starget_printk(KERN_INFO, starget,
2444                                 "enclosure level(0x%04x),connector name(%s)\n",
2445                                  sas_device->enclosure_level,
2446                                  sas_device->connector_name);
2447
2448                         sas_device_put(sas_device);
2449                 }
2450                 spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
2451         }
2452 }
2453
2454 /**
2455  * scsih_abort - eh threads main abort routine
2456  * @scmd: pointer to scsi command object
2457  *
2458  * Returns SUCCESS if command aborted else FAILED
2459  */
2460 static int
2461 scsih_abort(struct scsi_cmnd *scmd)
2462 {
2463         struct MPT3SAS_ADAPTER *ioc = shost_priv(scmd->device->host);
2464         struct MPT3SAS_DEVICE *sas_device_priv_data;
2465         u16 smid;
2466         u16 handle;
2467         int r;
2468
2469         sdev_printk(KERN_INFO, scmd->device,
2470                 "attempting task abort! scmd(%p)\n", scmd);
2471         _scsih_tm_display_info(ioc, scmd);
2472
2473         sas_device_priv_data = scmd->device->hostdata;
2474         if (!sas_device_priv_data || !sas_device_priv_data->sas_target) {
2475                 sdev_printk(KERN_INFO, scmd->device,
2476                         "device been deleted! scmd(%p)\n", scmd);
2477                 scmd->result = DID_NO_CONNECT << 16;
2478                 scmd->scsi_done(scmd);
2479                 r = SUCCESS;
2480                 goto out;
2481         }
2482
2483         /* search for the command */
2484         smid = _scsih_scsi_lookup_find_by_scmd(ioc, scmd);
2485         if (!smid) {
2486                 scmd->result = DID_RESET << 16;
2487                 r = SUCCESS;
2488                 goto out;
2489         }
2490
2491         /* for hidden raid components and volumes this is not supported */
2492         if (sas_device_priv_data->sas_target->flags &
2493             MPT_TARGET_FLAGS_RAID_COMPONENT ||
2494             sas_device_priv_data->sas_target->flags & MPT_TARGET_FLAGS_VOLUME) {
2495                 scmd->result = DID_RESET << 16;
2496                 r = FAILED;
2497                 goto out;
2498         }
2499
2500         mpt3sas_halt_firmware(ioc);
2501
2502         handle = sas_device_priv_data->sas_target->handle;
2503         r = mpt3sas_scsih_issue_locked_tm(ioc, handle, scmd->device->channel,
2504             scmd->device->id, scmd->device->lun,
2505             MPI2_SCSITASKMGMT_TASKTYPE_ABORT_TASK, smid, 30);
2506
2507  out:
2508         sdev_printk(KERN_INFO, scmd->device, "task abort: %s scmd(%p)\n",
2509             ((r == SUCCESS) ? "SUCCESS" : "FAILED"), scmd);
2510         return r;
2511 }
2512
2513 /**
2514  * scsih_dev_reset - eh threads main device reset routine
2515  * @scmd: pointer to scsi command object
2516  *
2517  * Returns SUCCESS if command aborted else FAILED
2518  */
2519 static int
2520 scsih_dev_reset(struct scsi_cmnd *scmd)
2521 {
2522         struct MPT3SAS_ADAPTER *ioc = shost_priv(scmd->device->host);
2523         struct MPT3SAS_DEVICE *sas_device_priv_data;
2524         struct _sas_device *sas_device = NULL;
2525         u16     handle;
2526         int r;
2527
2528         struct scsi_target *starget = scmd->device->sdev_target;
2529         struct MPT3SAS_TARGET *target_priv_data = starget->hostdata;
2530
2531         sdev_printk(KERN_INFO, scmd->device,
2532                 "attempting device reset! scmd(%p)\n", scmd);
2533         _scsih_tm_display_info(ioc, scmd);
2534
2535         sas_device_priv_data = scmd->device->hostdata;
2536         if (!sas_device_priv_data || !sas_device_priv_data->sas_target) {
2537                 sdev_printk(KERN_INFO, scmd->device,
2538                         "device been deleted! scmd(%p)\n", scmd);
2539                 scmd->result = DID_NO_CONNECT << 16;
2540                 scmd->scsi_done(scmd);
2541                 r = SUCCESS;
2542                 goto out;
2543         }
2544
2545         /* for hidden raid components obtain the volume_handle */
2546         handle = 0;
2547         if (sas_device_priv_data->sas_target->flags &
2548             MPT_TARGET_FLAGS_RAID_COMPONENT) {
2549                 sas_device = mpt3sas_get_sdev_from_target(ioc,
2550                                 target_priv_data);
2551                 if (sas_device)
2552                         handle = sas_device->volume_handle;
2553         } else
2554                 handle = sas_device_priv_data->sas_target->handle;
2555
2556         if (!handle) {
2557                 scmd->result = DID_RESET << 16;
2558                 r = FAILED;
2559                 goto out;
2560         }
2561
2562         r = mpt3sas_scsih_issue_locked_tm(ioc, handle, scmd->device->channel,
2563             scmd->device->id, scmd->device->lun,
2564             MPI2_SCSITASKMGMT_TASKTYPE_LOGICAL_UNIT_RESET, 0, 30);
2565
2566  out:
2567         sdev_printk(KERN_INFO, scmd->device, "device reset: %s scmd(%p)\n",
2568             ((r == SUCCESS) ? "SUCCESS" : "FAILED"), scmd);
2569
2570         if (sas_device)
2571                 sas_device_put(sas_device);
2572
2573         return r;
2574 }
2575
2576 /**
2577  * scsih_target_reset - eh threads main target reset routine
2578  * @scmd: pointer to scsi command object
2579  *
2580  * Returns SUCCESS if command aborted else FAILED
2581  */
2582 static int
2583 scsih_target_reset(struct scsi_cmnd *scmd)
2584 {
2585         struct MPT3SAS_ADAPTER *ioc = shost_priv(scmd->device->host);
2586         struct MPT3SAS_DEVICE *sas_device_priv_data;
2587         struct _sas_device *sas_device = NULL;
2588         u16     handle;
2589         int r;
2590         struct scsi_target *starget = scmd->device->sdev_target;
2591         struct MPT3SAS_TARGET *target_priv_data = starget->hostdata;
2592
2593         starget_printk(KERN_INFO, starget, "attempting target reset! scmd(%p)\n",
2594                 scmd);
2595         _scsih_tm_display_info(ioc, scmd);
2596
2597         sas_device_priv_data = scmd->device->hostdata;
2598         if (!sas_device_priv_data || !sas_device_priv_data->sas_target) {
2599                 starget_printk(KERN_INFO, starget, "target been deleted! scmd(%p)\n",
2600                         scmd);
2601                 scmd->result = DID_NO_CONNECT << 16;
2602                 scmd->scsi_done(scmd);
2603                 r = SUCCESS;
2604                 goto out;
2605         }
2606
2607         /* for hidden raid components obtain the volume_handle */
2608         handle = 0;
2609         if (sas_device_priv_data->sas_target->flags &
2610             MPT_TARGET_FLAGS_RAID_COMPONENT) {
2611                 sas_device = mpt3sas_get_sdev_from_target(ioc,
2612                                 target_priv_data);
2613                 if (sas_device)
2614                         handle = sas_device->volume_handle;
2615         } else
2616                 handle = sas_device_priv_data->sas_target->handle;
2617
2618         if (!handle) {
2619                 scmd->result = DID_RESET << 16;
2620                 r = FAILED;
2621                 goto out;
2622         }
2623
2624         r = mpt3sas_scsih_issue_locked_tm(ioc, handle, scmd->device->channel,
2625             scmd->device->id, 0, MPI2_SCSITASKMGMT_TASKTYPE_TARGET_RESET, 0,
2626             30);
2627
2628  out:
2629         starget_printk(KERN_INFO, starget, "target reset: %s scmd(%p)\n",
2630             ((r == SUCCESS) ? "SUCCESS" : "FAILED"), scmd);
2631
2632         if (sas_device)
2633                 sas_device_put(sas_device);
2634
2635         return r;
2636 }
2637
2638
2639 /**
2640  * scsih_host_reset - eh threads main host reset routine
2641  * @scmd: pointer to scsi command object
2642  *
2643  * Returns SUCCESS if command aborted else FAILED
2644  */
2645 static int
2646 scsih_host_reset(struct scsi_cmnd *scmd)
2647 {
2648         struct MPT3SAS_ADAPTER *ioc = shost_priv(scmd->device->host);
2649         int r, retval;
2650
2651         pr_info(MPT3SAS_FMT "attempting host reset! scmd(%p)\n",
2652             ioc->name, scmd);
2653         scsi_print_command(scmd);
2654
2655         if (ioc->is_driver_loading) {
2656                 pr_info(MPT3SAS_FMT "Blocking the host reset\n",
2657                     ioc->name);
2658                 r = FAILED;
2659                 goto out;
2660         }
2661
2662         retval = mpt3sas_base_hard_reset_handler(ioc, FORCE_BIG_HAMMER);
2663         r = (retval < 0) ? FAILED : SUCCESS;
2664 out:
2665         pr_info(MPT3SAS_FMT "host reset: %s scmd(%p)\n",
2666             ioc->name, ((r == SUCCESS) ? "SUCCESS" : "FAILED"), scmd);
2667
2668         return r;
2669 }
2670
2671 /**
2672  * _scsih_fw_event_add - insert and queue up fw_event
2673  * @ioc: per adapter object
2674  * @fw_event: object describing the event
2675  * Context: This function will acquire ioc->fw_event_lock.
2676  *
2677  * This adds the firmware event object into link list, then queues it up to
2678  * be processed from user context.
2679  *
2680  * Return nothing.
2681  */
2682 static void
2683 _scsih_fw_event_add(struct MPT3SAS_ADAPTER *ioc, struct fw_event_work *fw_event)
2684 {
2685         unsigned long flags;
2686
2687         if (ioc->firmware_event_thread == NULL)
2688                 return;
2689
2690         spin_lock_irqsave(&ioc->fw_event_lock, flags);
2691         fw_event_work_get(fw_event);
2692         INIT_LIST_HEAD(&fw_event->list);
2693         list_add_tail(&fw_event->list, &ioc->fw_event_list);
2694         INIT_WORK(&fw_event->work, _firmware_event_work);
2695         fw_event_work_get(fw_event);
2696         queue_work(ioc->firmware_event_thread, &fw_event->work);
2697         spin_unlock_irqrestore(&ioc->fw_event_lock, flags);
2698 }
2699
2700 /**
2701  * _scsih_fw_event_del_from_list - delete fw_event from the list
2702  * @ioc: per adapter object
2703  * @fw_event: object describing the event
2704  * Context: This function will acquire ioc->fw_event_lock.
2705  *
2706  * If the fw_event is on the fw_event_list, remove it and do a put.
2707  *
2708  * Return nothing.
2709  */
2710 static void
2711 _scsih_fw_event_del_from_list(struct MPT3SAS_ADAPTER *ioc, struct fw_event_work
2712         *fw_event)
2713 {
2714         unsigned long flags;
2715
2716         spin_lock_irqsave(&ioc->fw_event_lock, flags);
2717         if (!list_empty(&fw_event->list)) {
2718                 list_del_init(&fw_event->list);
2719                 fw_event_work_put(fw_event);
2720         }
2721         spin_unlock_irqrestore(&ioc->fw_event_lock, flags);
2722 }
2723
2724
2725  /**
2726  * mpt3sas_send_trigger_data_event - send event for processing trigger data
2727  * @ioc: per adapter object
2728  * @event_data: trigger event data
2729  *
2730  * Return nothing.
2731  */
2732 void
2733 mpt3sas_send_trigger_data_event(struct MPT3SAS_ADAPTER *ioc,
2734         struct SL_WH_TRIGGERS_EVENT_DATA_T *event_data)
2735 {
2736         struct fw_event_work *fw_event;
2737         u16 sz;
2738
2739         if (ioc->is_driver_loading)
2740                 return;
2741         sz = sizeof(*event_data);
2742         fw_event = alloc_fw_event_work(sz);
2743         if (!fw_event)
2744                 return;
2745         fw_event->event = MPT3SAS_PROCESS_TRIGGER_DIAG;
2746         fw_event->ioc = ioc;
2747         memcpy(fw_event->event_data, event_data, sizeof(*event_data));
2748         _scsih_fw_event_add(ioc, fw_event);
2749         fw_event_work_put(fw_event);
2750 }
2751
2752 /**
2753  * _scsih_error_recovery_delete_devices - remove devices not responding
2754  * @ioc: per adapter object
2755  *
2756  * Return nothing.
2757  */
2758 static void
2759 _scsih_error_recovery_delete_devices(struct MPT3SAS_ADAPTER *ioc)
2760 {
2761         struct fw_event_work *fw_event;
2762
2763         if (ioc->is_driver_loading)
2764                 return;
2765         fw_event = alloc_fw_event_work(0);
2766         if (!fw_event)
2767                 return;
2768         fw_event->event = MPT3SAS_REMOVE_UNRESPONDING_DEVICES;
2769         fw_event->ioc = ioc;
2770         _scsih_fw_event_add(ioc, fw_event);
2771         fw_event_work_put(fw_event);
2772 }
2773
2774 /**
2775  * mpt3sas_port_enable_complete - port enable completed (fake event)
2776  * @ioc: per adapter object
2777  *
2778  * Return nothing.
2779  */
2780 void
2781 mpt3sas_port_enable_complete(struct MPT3SAS_ADAPTER *ioc)
2782 {
2783         struct fw_event_work *fw_event;
2784
2785         fw_event = alloc_fw_event_work(0);
2786         if (!fw_event)
2787                 return;
2788         fw_event->event = MPT3SAS_PORT_ENABLE_COMPLETE;
2789         fw_event->ioc = ioc;
2790         _scsih_fw_event_add(ioc, fw_event);
2791         fw_event_work_put(fw_event);
2792 }
2793
2794 static struct fw_event_work *dequeue_next_fw_event(struct MPT3SAS_ADAPTER *ioc)
2795 {
2796         unsigned long flags;
2797         struct fw_event_work *fw_event = NULL;
2798
2799         spin_lock_irqsave(&ioc->fw_event_lock, flags);
2800         if (!list_empty(&ioc->fw_event_list)) {
2801                 fw_event = list_first_entry(&ioc->fw_event_list,
2802                                 struct fw_event_work, list);
2803                 list_del_init(&fw_event->list);
2804         }
2805         spin_unlock_irqrestore(&ioc->fw_event_lock, flags);
2806
2807         return fw_event;
2808 }
2809
2810 /**
2811  * _scsih_fw_event_cleanup_queue - cleanup event queue
2812  * @ioc: per adapter object
2813  *
2814  * Walk the firmware event queue, either killing timers, or waiting
2815  * for outstanding events to complete
2816  *
2817  * Return nothing.
2818  */
2819 static void
2820 _scsih_fw_event_cleanup_queue(struct MPT3SAS_ADAPTER *ioc)
2821 {
2822         struct fw_event_work *fw_event;
2823
2824         if (list_empty(&ioc->fw_event_list) ||
2825              !ioc->firmware_event_thread || in_interrupt())
2826                 return;
2827
2828         while ((fw_event = dequeue_next_fw_event(ioc))) {
2829                 /*
2830                  * Wait on the fw_event to complete. If this returns 1, then
2831                  * the event was never executed, and we need a put for the
2832                  * reference the work had on the fw_event.
2833                  *
2834                  * If it did execute, we wait for it to finish, and the put will
2835                  * happen from _firmware_event_work()
2836                  */
2837                 if (cancel_work_sync(&fw_event->work))
2838                         fw_event_work_put(fw_event);
2839
2840                 fw_event_work_put(fw_event);
2841         }
2842 }
2843
2844 /**
2845  * _scsih_internal_device_block - block the sdev device
2846  * @sdev: per device object
2847  * @sas_device_priv_data : per device driver private data
2848  *
2849  * make sure device is blocked without error, if not
2850  * print an error
2851  */
2852 static void
2853 _scsih_internal_device_block(struct scsi_device *sdev,
2854                         struct MPT3SAS_DEVICE *sas_device_priv_data)
2855 {
2856         int r = 0;
2857
2858         sdev_printk(KERN_INFO, sdev, "device_block, handle(0x%04x)\n",
2859             sas_device_priv_data->sas_target->handle);
2860         sas_device_priv_data->block = 1;
2861
2862         r = scsi_internal_device_block(sdev);
2863         if (r == -EINVAL)
2864                 sdev_printk(KERN_WARNING, sdev,
2865                     "device_block failed with return(%d) for handle(0x%04x)\n",
2866                     r, sas_device_priv_data->sas_target->handle);
2867 }
2868
2869 /**
2870  * _scsih_internal_device_unblock - unblock the sdev device
2871  * @sdev: per device object
2872  * @sas_device_priv_data : per device driver private data
2873  * make sure device is unblocked without error, if not retry
2874  * by blocking and then unblocking
2875  */
2876
2877 static void
2878 _scsih_internal_device_unblock(struct scsi_device *sdev,
2879                         struct MPT3SAS_DEVICE *sas_device_priv_data)
2880 {
2881         int r = 0;
2882
2883         sdev_printk(KERN_WARNING, sdev, "device_unblock and setting to running, "
2884             "handle(0x%04x)\n", sas_device_priv_data->sas_target->handle);
2885         sas_device_priv_data->block = 0;
2886         r = scsi_internal_device_unblock(sdev, SDEV_RUNNING);
2887         if (r == -EINVAL) {
2888                 /* The device has been set to SDEV_RUNNING by SD layer during
2889                  * device addition but the request queue is still stopped by
2890                  * our earlier block call. We need to perform a block again
2891                  * to get the device to SDEV_BLOCK and then to SDEV_RUNNING */
2892
2893                 sdev_printk(KERN_WARNING, sdev,
2894                     "device_unblock failed with return(%d) for handle(0x%04x) "
2895                     "performing a block followed by an unblock\n",
2896                     r, sas_device_priv_data->sas_target->handle);
2897                 sas_device_priv_data->block = 1;
2898                 r = scsi_internal_device_block(sdev);
2899                 if (r)
2900                         sdev_printk(KERN_WARNING, sdev, "retried device_block "
2901                             "failed with return(%d) for handle(0x%04x)\n",
2902                             r, sas_device_priv_data->sas_target->handle);
2903
2904                 sas_device_priv_data->block = 0;
2905                 r = scsi_internal_device_unblock(sdev, SDEV_RUNNING);
2906                 if (r)
2907                         sdev_printk(KERN_WARNING, sdev, "retried device_unblock"
2908                             " failed with return(%d) for handle(0x%04x)\n",
2909                             r, sas_device_priv_data->sas_target->handle);
2910         }
2911 }
2912
2913 /**
2914  * _scsih_ublock_io_all_device - unblock every device
2915  * @ioc: per adapter object
2916  *
2917  * change the device state from block to running
2918  */
2919 static void
2920 _scsih_ublock_io_all_device(struct MPT3SAS_ADAPTER *ioc)
2921 {
2922         struct MPT3SAS_DEVICE *sas_device_priv_data;
2923         struct scsi_device *sdev;
2924
2925         shost_for_each_device(sdev, ioc->shost) {
2926                 sas_device_priv_data = sdev->hostdata;
2927                 if (!sas_device_priv_data)
2928                         continue;
2929                 if (!sas_device_priv_data->block)
2930                         continue;
2931
2932                 dewtprintk(ioc, sdev_printk(KERN_INFO, sdev,
2933                         "device_running, handle(0x%04x)\n",
2934                     sas_device_priv_data->sas_target->handle));
2935                 _scsih_internal_device_unblock(sdev, sas_device_priv_data);
2936         }
2937 }
2938
2939
2940 /**
2941  * _scsih_ublock_io_device - prepare device to be deleted
2942  * @ioc: per adapter object
2943  * @sas_addr: sas address
2944  *
2945  * unblock then put device in offline state
2946  */
2947 static void
2948 _scsih_ublock_io_device(struct MPT3SAS_ADAPTER *ioc, u64 sas_address)
2949 {
2950         struct MPT3SAS_DEVICE *sas_device_priv_data;
2951         struct scsi_device *sdev;
2952
2953         shost_for_each_device(sdev, ioc->shost) {
2954                 sas_device_priv_data = sdev->hostdata;
2955                 if (!sas_device_priv_data)
2956                         continue;
2957                 if (sas_device_priv_data->sas_target->sas_address
2958                     != sas_address)
2959                         continue;
2960                 if (sas_device_priv_data->block)
2961                         _scsih_internal_device_unblock(sdev,
2962                                 sas_device_priv_data);
2963         }
2964 }
2965
2966 /**
2967  * _scsih_block_io_all_device - set the device state to SDEV_BLOCK
2968  * @ioc: per adapter object
2969  * @handle: device handle
2970  *
2971  * During device pull we need to appropriately set the sdev state.
2972  */
2973 static void
2974 _scsih_block_io_all_device(struct MPT3SAS_ADAPTER *ioc)
2975 {
2976         struct MPT3SAS_DEVICE *sas_device_priv_data;
2977         struct scsi_device *sdev;
2978
2979         shost_for_each_device(sdev, ioc->shost) {
2980                 sas_device_priv_data = sdev->hostdata;
2981                 if (!sas_device_priv_data)
2982                         continue;
2983                 if (sas_device_priv_data->block)
2984                         continue;
2985                 if (sas_device_priv_data->ignore_delay_remove) {
2986                         sdev_printk(KERN_INFO, sdev,
2987                         "%s skip device_block for SES handle(0x%04x)\n",
2988                         __func__, sas_device_priv_data->sas_target->handle);
2989                         continue;
2990                 }
2991                 _scsih_internal_device_block(sdev, sas_device_priv_data);
2992         }
2993 }
2994
2995 /**
2996  * _scsih_block_io_device - set the device state to SDEV_BLOCK
2997  * @ioc: per adapter object
2998  * @handle: device handle
2999  *
3000  * During device pull we need to appropriately set the sdev state.
3001  */
3002 static void
3003 _scsih_block_io_device(struct MPT3SAS_ADAPTER *ioc, u16 handle)
3004 {
3005         struct MPT3SAS_DEVICE *sas_device_priv_data;
3006         struct scsi_device *sdev;
3007         struct _sas_device *sas_device;
3008
3009         sas_device = mpt3sas_get_sdev_by_handle(ioc, handle);
3010         if (!sas_device)
3011                 return;
3012
3013         shost_for_each_device(sdev, ioc->shost) {
3014                 sas_device_priv_data = sdev->hostdata;
3015                 if (!sas_device_priv_data)
3016                         continue;
3017                 if (sas_device_priv_data->sas_target->handle != handle)
3018                         continue;
3019                 if (sas_device_priv_data->block)
3020                         continue;
3021                 if (sas_device->pend_sas_rphy_add)
3022                         continue;
3023                 if (sas_device_priv_data->ignore_delay_remove) {
3024                         sdev_printk(KERN_INFO, sdev,
3025                         "%s skip device_block for SES handle(0x%04x)\n",
3026                         __func__, sas_device_priv_data->sas_target->handle);
3027                         continue;
3028                 }
3029                 _scsih_internal_device_block(sdev, sas_device_priv_data);
3030         }
3031
3032         sas_device_put(sas_device);
3033 }
3034
3035 /**
3036  * _scsih_block_io_to_children_attached_to_ex
3037  * @ioc: per adapter object
3038  * @sas_expander: the sas_device object
3039  *
3040  * This routine set sdev state to SDEV_BLOCK for all devices
3041  * attached to this expander. This function called when expander is
3042  * pulled.
3043  */
3044 static void
3045 _scsih_block_io_to_children_attached_to_ex(struct MPT3SAS_ADAPTER *ioc,
3046         struct _sas_node *sas_expander)
3047 {
3048         struct _sas_port *mpt3sas_port;
3049         struct _sas_device *sas_device;
3050         struct _sas_node *expander_sibling;
3051         unsigned long flags;
3052
3053         if (!sas_expander)
3054                 return;
3055
3056         list_for_each_entry(mpt3sas_port,
3057            &sas_expander->sas_port_list, port_list) {
3058                 if (mpt3sas_port->remote_identify.device_type ==
3059                     SAS_END_DEVICE) {
3060                         spin_lock_irqsave(&ioc->sas_device_lock, flags);
3061                         sas_device = __mpt3sas_get_sdev_by_addr(ioc,
3062                             mpt3sas_port->remote_identify.sas_address);
3063                         if (sas_device) {
3064                                 set_bit(sas_device->handle,
3065                                                 ioc->blocking_handles);
3066                                 sas_device_put(sas_device);
3067                         }
3068                         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
3069                 }
3070         }
3071
3072         list_for_each_entry(mpt3sas_port,
3073            &sas_expander->sas_port_list, port_list) {
3074
3075                 if (mpt3sas_port->remote_identify.device_type ==
3076                     SAS_EDGE_EXPANDER_DEVICE ||
3077                     mpt3sas_port->remote_identify.device_type ==
3078                     SAS_FANOUT_EXPANDER_DEVICE) {
3079                         expander_sibling =
3080                             mpt3sas_scsih_expander_find_by_sas_address(
3081                             ioc, mpt3sas_port->remote_identify.sas_address);
3082                         _scsih_block_io_to_children_attached_to_ex(ioc,
3083                             expander_sibling);
3084                 }
3085         }
3086 }
3087
3088 /**
3089  * _scsih_block_io_to_children_attached_directly
3090  * @ioc: per adapter object
3091  * @event_data: topology change event data
3092  *
3093  * This routine set sdev state to SDEV_BLOCK for all devices
3094  * direct attached during device pull.
3095  */
3096 static void
3097 _scsih_block_io_to_children_attached_directly(struct MPT3SAS_ADAPTER *ioc,
3098         Mpi2EventDataSasTopologyChangeList_t *event_data)
3099 {
3100         int i;
3101         u16 handle;
3102         u16 reason_code;
3103
3104         for (i = 0; i < event_data->NumEntries; i++) {
3105                 handle = le16_to_cpu(event_data->PHY[i].AttachedDevHandle);
3106                 if (!handle)
3107                         continue;
3108                 reason_code = event_data->PHY[i].PhyStatus &
3109                     MPI2_EVENT_SAS_TOPO_RC_MASK;
3110                 if (reason_code == MPI2_EVENT_SAS_TOPO_RC_DELAY_NOT_RESPONDING)
3111                         _scsih_block_io_device(ioc, handle);
3112         }
3113 }
3114
3115 /**
3116  * _scsih_tm_tr_send - send task management request
3117  * @ioc: per adapter object
3118  * @handle: device handle
3119  * Context: interrupt time.
3120  *
3121  * This code is to initiate the device removal handshake protocol
3122  * with controller firmware.  This function will issue target reset
3123  * using high priority request queue.  It will send a sas iounit
3124  * control request (MPI2_SAS_OP_REMOVE_DEVICE) from this completion.
3125  *
3126  * This is designed to send muliple task management request at the same
3127  * time to the fifo. If the fifo is full, we will append the request,
3128  * and process it in a future completion.
3129  */
3130 static void
3131 _scsih_tm_tr_send(struct MPT3SAS_ADAPTER *ioc, u16 handle)
3132 {
3133         Mpi2SCSITaskManagementRequest_t *mpi_request;
3134         u16 smid;
3135         struct _sas_device *sas_device = NULL;
3136         struct MPT3SAS_TARGET *sas_target_priv_data = NULL;
3137         u64 sas_address = 0;
3138         unsigned long flags;
3139         struct _tr_list *delayed_tr;
3140         u32 ioc_state;
3141
3142         if (ioc->remove_host) {
3143                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
3144                         "%s: host has been removed: handle(0x%04x)\n",
3145                         __func__, ioc->name, handle));
3146                 return;
3147         } else if (ioc->pci_error_recovery) {
3148                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
3149                         "%s: host in pci error recovery: handle(0x%04x)\n",
3150                         __func__, ioc->name,
3151                     handle));
3152                 return;
3153         }
3154         ioc_state = mpt3sas_base_get_iocstate(ioc, 1);
3155         if (ioc_state != MPI2_IOC_STATE_OPERATIONAL) {
3156                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
3157                         "%s: host is not operational: handle(0x%04x)\n",
3158                         __func__, ioc->name,
3159                    handle));
3160                 return;
3161         }
3162
3163         /* if PD, then return */
3164         if (test_bit(handle, ioc->pd_handles))
3165                 return;
3166
3167         clear_bit(handle, ioc->pend_os_device_add);
3168
3169         spin_lock_irqsave(&ioc->sas_device_lock, flags);
3170         sas_device = __mpt3sas_get_sdev_by_handle(ioc, handle);
3171         if (sas_device && sas_device->starget &&
3172             sas_device->starget->hostdata) {
3173                 sas_target_priv_data = sas_device->starget->hostdata;
3174                 sas_target_priv_data->deleted = 1;
3175                 sas_address = sas_device->sas_address;
3176         }
3177         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
3178
3179         if (sas_target_priv_data) {
3180                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
3181                         "setting delete flag: handle(0x%04x), sas_addr(0x%016llx)\n",
3182                         ioc->name, handle,
3183                     (unsigned long long)sas_address));
3184                 if (sas_device->enclosure_handle != 0)
3185                         dewtprintk(ioc, pr_info(MPT3SAS_FMT
3186                          "setting delete flag:enclosure logical id(0x%016llx),"
3187                          " slot(%d)\n", ioc->name, (unsigned long long)
3188                           sas_device->enclosure_logical_id,
3189                           sas_device->slot));
3190                 if (sas_device->connector_name[0] != '\0')
3191                         dewtprintk(ioc, pr_info(MPT3SAS_FMT
3192                          "setting delete flag: enclosure level(0x%04x),"
3193                          " connector name( %s)\n", ioc->name,
3194                           sas_device->enclosure_level,
3195                           sas_device->connector_name));
3196                 _scsih_ublock_io_device(ioc, sas_address);
3197                 sas_target_priv_data->handle = MPT3SAS_INVALID_DEVICE_HANDLE;
3198         }
3199
3200         smid = mpt3sas_base_get_smid_hpr(ioc, ioc->tm_tr_cb_idx);
3201         if (!smid) {
3202                 delayed_tr = kzalloc(sizeof(*delayed_tr), GFP_ATOMIC);
3203                 if (!delayed_tr)
3204                         goto out;
3205                 INIT_LIST_HEAD(&delayed_tr->list);
3206                 delayed_tr->handle = handle;
3207                 list_add_tail(&delayed_tr->list, &ioc->delayed_tr_list);
3208                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
3209                     "DELAYED:tr:handle(0x%04x), (open)\n",
3210                     ioc->name, handle));
3211                 goto out;
3212         }
3213
3214         dewtprintk(ioc, pr_info(MPT3SAS_FMT
3215                 "tr_send:handle(0x%04x), (open), smid(%d), cb(%d)\n",
3216                 ioc->name, handle, smid,
3217             ioc->tm_tr_cb_idx));
3218         mpi_request = mpt3sas_base_get_msg_frame(ioc, smid);
3219         memset(mpi_request, 0, sizeof(Mpi2SCSITaskManagementRequest_t));
3220         mpi_request->Function = MPI2_FUNCTION_SCSI_TASK_MGMT;
3221         mpi_request->DevHandle = cpu_to_le16(handle);
3222         mpi_request->TaskType = MPI2_SCSITASKMGMT_TASKTYPE_TARGET_RESET;
3223         set_bit(handle, ioc->device_remove_in_progress);
3224         ioc->put_smid_hi_priority(ioc, smid, 0);
3225         mpt3sas_trigger_master(ioc, MASTER_TRIGGER_DEVICE_REMOVAL);
3226
3227 out:
3228         if (sas_device)
3229                 sas_device_put(sas_device);
3230 }
3231
3232 /**
3233  * _scsih_tm_tr_complete -
3234  * @ioc: per adapter object
3235  * @smid: system request message index
3236  * @msix_index: MSIX table index supplied by the OS
3237  * @reply: reply message frame(lower 32bit addr)
3238  * Context: interrupt time.
3239  *
3240  * This is the target reset completion routine.
3241  * This code is part of the code to initiate the device removal
3242  * handshake protocol with controller firmware.
3243  * It will send a sas iounit control request (MPI2_SAS_OP_REMOVE_DEVICE)
3244  *
3245  * Return 1 meaning mf should be freed from _base_interrupt
3246  *        0 means the mf is freed from this function.
3247  */
3248 static u8
3249 _scsih_tm_tr_complete(struct MPT3SAS_ADAPTER *ioc, u16 smid, u8 msix_index,
3250         u32 reply)
3251 {
3252         u16 handle;
3253         Mpi2SCSITaskManagementRequest_t *mpi_request_tm;
3254         Mpi2SCSITaskManagementReply_t *mpi_reply =
3255             mpt3sas_base_get_reply_virt_addr(ioc, reply);
3256         Mpi2SasIoUnitControlRequest_t *mpi_request;
3257         u16 smid_sas_ctrl;
3258         u32 ioc_state;
3259         struct _sc_list *delayed_sc;
3260
3261         if (ioc->remove_host) {
3262                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
3263                         "%s: host has been removed\n", __func__, ioc->name));
3264                 return 1;
3265         } else if (ioc->pci_error_recovery) {
3266                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
3267                         "%s: host in pci error recovery\n", __func__,
3268                         ioc->name));
3269                 return 1;
3270         }
3271         ioc_state = mpt3sas_base_get_iocstate(ioc, 1);
3272         if (ioc_state != MPI2_IOC_STATE_OPERATIONAL) {
3273                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
3274                         "%s: host is not operational\n", __func__, ioc->name));
3275                 return 1;
3276         }
3277         if (unlikely(!mpi_reply)) {
3278                 pr_err(MPT3SAS_FMT "mpi_reply not valid at %s:%d/%s()!\n",
3279                     ioc->name, __FILE__, __LINE__, __func__);
3280                 return 1;
3281         }
3282         mpi_request_tm = mpt3sas_base_get_msg_frame(ioc, smid);
3283         handle = le16_to_cpu(mpi_request_tm->DevHandle);
3284         if (handle != le16_to_cpu(mpi_reply->DevHandle)) {
3285                 dewtprintk(ioc, pr_err(MPT3SAS_FMT
3286                         "spurious interrupt: handle(0x%04x:0x%04x), smid(%d)!!!\n",
3287                         ioc->name, handle,
3288                     le16_to_cpu(mpi_reply->DevHandle), smid));
3289                 return 0;
3290         }
3291
3292         mpt3sas_trigger_master(ioc, MASTER_TRIGGER_TASK_MANAGMENT);
3293         dewtprintk(ioc, pr_info(MPT3SAS_FMT
3294             "tr_complete:handle(0x%04x), (open) smid(%d), ioc_status(0x%04x), "
3295             "loginfo(0x%08x), completed(%d)\n", ioc->name,
3296             handle, smid, le16_to_cpu(mpi_reply->IOCStatus),
3297             le32_to_cpu(mpi_reply->IOCLogInfo),
3298             le32_to_cpu(mpi_reply->TerminationCount)));
3299
3300         smid_sas_ctrl = mpt3sas_base_get_smid(ioc, ioc->tm_sas_control_cb_idx);
3301         if (!smid_sas_ctrl) {
3302                 delayed_sc = kzalloc(sizeof(*delayed_sc), GFP_ATOMIC);
3303                 if (!delayed_sc)
3304                         return _scsih_check_for_pending_tm(ioc, smid);
3305                 INIT_LIST_HEAD(&delayed_sc->list);
3306                 delayed_sc->handle = mpi_request_tm->DevHandle;
3307                 list_add_tail(&delayed_sc->list, &ioc->delayed_sc_list);
3308                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
3309                     "DELAYED:sc:handle(0x%04x), (open)\n",
3310                     ioc->name, handle));
3311                 return _scsih_check_for_pending_tm(ioc, smid);
3312         }
3313
3314         dewtprintk(ioc, pr_info(MPT3SAS_FMT
3315                 "sc_send:handle(0x%04x), (open), smid(%d), cb(%d)\n",
3316                 ioc->name, handle, smid_sas_ctrl,
3317             ioc->tm_sas_control_cb_idx));
3318         mpi_request = mpt3sas_base_get_msg_frame(ioc, smid_sas_ctrl);
3319         memset(mpi_request, 0, sizeof(Mpi2SasIoUnitControlRequest_t));
3320         mpi_request->Function = MPI2_FUNCTION_SAS_IO_UNIT_CONTROL;
3321         mpi_request->Operation = MPI2_SAS_OP_REMOVE_DEVICE;
3322         mpi_request->DevHandle = mpi_request_tm->DevHandle;
3323         ioc->put_smid_default(ioc, smid_sas_ctrl);
3324
3325         return _scsih_check_for_pending_tm(ioc, smid);
3326 }
3327
3328
3329 /**
3330  * _scsih_sas_control_complete - completion routine
3331  * @ioc: per adapter object
3332  * @smid: system request message index
3333  * @msix_index: MSIX table index supplied by the OS
3334  * @reply: reply message frame(lower 32bit addr)
3335  * Context: interrupt time.
3336  *
3337  * This is the sas iounit control completion routine.
3338  * This code is part of the code to initiate the device removal
3339  * handshake protocol with controller firmware.
3340  *
3341  * Return 1 meaning mf should be freed from _base_interrupt
3342  *        0 means the mf is freed from this function.
3343  */
3344 static u8
3345 _scsih_sas_control_complete(struct MPT3SAS_ADAPTER *ioc, u16 smid,
3346         u8 msix_index, u32 reply)
3347 {
3348         Mpi2SasIoUnitControlReply_t *mpi_reply =
3349             mpt3sas_base_get_reply_virt_addr(ioc, reply);
3350
3351         if (likely(mpi_reply)) {
3352                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
3353                 "sc_complete:handle(0x%04x), (open) "
3354                 "smid(%d), ioc_status(0x%04x), loginfo(0x%08x)\n",
3355                 ioc->name, le16_to_cpu(mpi_reply->DevHandle), smid,
3356                 le16_to_cpu(mpi_reply->IOCStatus),
3357                 le32_to_cpu(mpi_reply->IOCLogInfo)));
3358                 if (le16_to_cpu(mpi_reply->IOCStatus) ==
3359                      MPI2_IOCSTATUS_SUCCESS) {
3360                         clear_bit(le16_to_cpu(mpi_reply->DevHandle),
3361                             ioc->device_remove_in_progress);
3362                 }
3363         } else {
3364                 pr_err(MPT3SAS_FMT "mpi_reply not valid at %s:%d/%s()!\n",
3365                     ioc->name, __FILE__, __LINE__, __func__);
3366         }
3367         return mpt3sas_check_for_pending_internal_cmds(ioc, smid);
3368 }
3369
3370 /**
3371  * _scsih_tm_tr_volume_send - send target reset request for volumes
3372  * @ioc: per adapter object
3373  * @handle: device handle
3374  * Context: interrupt time.
3375  *
3376  * This is designed to send muliple task management request at the same
3377  * time to the fifo. If the fifo is full, we will append the request,
3378  * and process it in a future completion.
3379  */
3380 static void
3381 _scsih_tm_tr_volume_send(struct MPT3SAS_ADAPTER *ioc, u16 handle)
3382 {
3383         Mpi2SCSITaskManagementRequest_t *mpi_request;
3384         u16 smid;
3385         struct _tr_list *delayed_tr;
3386
3387         if (ioc->shost_recovery || ioc->remove_host ||
3388             ioc->pci_error_recovery) {
3389                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
3390                         "%s: host reset in progress!\n",
3391                         __func__, ioc->name));
3392                 return;
3393         }
3394
3395         smid = mpt3sas_base_get_smid_hpr(ioc, ioc->tm_tr_volume_cb_idx);
3396         if (!smid) {
3397                 delayed_tr = kzalloc(sizeof(*delayed_tr), GFP_ATOMIC);
3398                 if (!delayed_tr)
3399                         return;
3400                 INIT_LIST_HEAD(&delayed_tr->list);
3401                 delayed_tr->handle = handle;
3402                 list_add_tail(&delayed_tr->list, &ioc->delayed_tr_volume_list);
3403                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
3404                     "DELAYED:tr:handle(0x%04x), (open)\n",
3405                     ioc->name, handle));
3406                 return;
3407         }
3408
3409         dewtprintk(ioc, pr_info(MPT3SAS_FMT
3410                 "tr_send:handle(0x%04x), (open), smid(%d), cb(%d)\n",
3411                 ioc->name, handle, smid,
3412             ioc->tm_tr_volume_cb_idx));
3413         mpi_request = mpt3sas_base_get_msg_frame(ioc, smid);
3414         memset(mpi_request, 0, sizeof(Mpi2SCSITaskManagementRequest_t));
3415         mpi_request->Function = MPI2_FUNCTION_SCSI_TASK_MGMT;
3416         mpi_request->DevHandle = cpu_to_le16(handle);
3417         mpi_request->TaskType = MPI2_SCSITASKMGMT_TASKTYPE_TARGET_RESET;
3418         ioc->put_smid_hi_priority(ioc, smid, 0);
3419 }
3420
3421 /**
3422  * _scsih_tm_volume_tr_complete - target reset completion
3423  * @ioc: per adapter object
3424  * @smid: system request message index
3425  * @msix_index: MSIX table index supplied by the OS
3426  * @reply: reply message frame(lower 32bit addr)
3427  * Context: interrupt time.
3428  *
3429  * Return 1 meaning mf should be freed from _base_interrupt
3430  *        0 means the mf is freed from this function.
3431  */
3432 static u8
3433 _scsih_tm_volume_tr_complete(struct MPT3SAS_ADAPTER *ioc, u16 smid,
3434         u8 msix_index, u32 reply)
3435 {
3436         u16 handle;
3437         Mpi2SCSITaskManagementRequest_t *mpi_request_tm;
3438         Mpi2SCSITaskManagementReply_t *mpi_reply =
3439             mpt3sas_base_get_reply_virt_addr(ioc, reply);
3440
3441         if (ioc->shost_recovery || ioc->remove_host ||
3442             ioc->pci_error_recovery) {
3443                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
3444                         "%s: host reset in progress!\n",
3445                         __func__, ioc->name));
3446                 return 1;
3447         }
3448         if (unlikely(!mpi_reply)) {
3449                 pr_err(MPT3SAS_FMT "mpi_reply not valid at %s:%d/%s()!\n",
3450                     ioc->name, __FILE__, __LINE__, __func__);
3451                 return 1;
3452         }
3453
3454         mpi_request_tm = mpt3sas_base_get_msg_frame(ioc, smid);
3455         handle = le16_to_cpu(mpi_request_tm->DevHandle);
3456         if (handle != le16_to_cpu(mpi_reply->DevHandle)) {
3457                 dewtprintk(ioc, pr_err(MPT3SAS_FMT
3458                         "spurious interrupt: handle(0x%04x:0x%04x), smid(%d)!!!\n",
3459                         ioc->name, handle,
3460                     le16_to_cpu(mpi_reply->DevHandle), smid));
3461                 return 0;
3462         }
3463
3464         dewtprintk(ioc, pr_info(MPT3SAS_FMT
3465             "tr_complete:handle(0x%04x), (open) smid(%d), ioc_status(0x%04x), "
3466             "loginfo(0x%08x), completed(%d)\n", ioc->name,
3467             handle, smid, le16_to_cpu(mpi_reply->IOCStatus),
3468             le32_to_cpu(mpi_reply->IOCLogInfo),
3469             le32_to_cpu(mpi_reply->TerminationCount)));
3470
3471         return _scsih_check_for_pending_tm(ioc, smid);
3472 }
3473
3474 /**
3475  * _scsih_issue_delayed_event_ack - issue delayed Event ACK messages
3476  * @ioc: per adapter object
3477  * @smid: system request message index
3478  * @event: Event ID
3479  * @event_context: used to track events uniquely
3480  *
3481  * Context - processed in interrupt context.
3482  */
3483 static void
3484 _scsih_issue_delayed_event_ack(struct MPT3SAS_ADAPTER *ioc, u16 smid, u16 event,
3485                                 u32 event_context)
3486 {
3487         Mpi2EventAckRequest_t *ack_request;
3488         int i = smid - ioc->internal_smid;
3489         unsigned long flags;
3490
3491         /* Without releasing the smid just update the
3492          * call back index and reuse the same smid for
3493          * processing this delayed request
3494          */
3495         spin_lock_irqsave(&ioc->scsi_lookup_lock, flags);
3496         ioc->internal_lookup[i].cb_idx = ioc->base_cb_idx;
3497         spin_unlock_irqrestore(&ioc->scsi_lookup_lock, flags);
3498
3499         dewtprintk(ioc, pr_info(MPT3SAS_FMT
3500                 "EVENT ACK: event(0x%04x), smid(%d), cb(%d)\n",
3501                 ioc->name, le16_to_cpu(event), smid,
3502                 ioc->base_cb_idx));
3503         ack_request = mpt3sas_base_get_msg_frame(ioc, smid);
3504         memset(ack_request, 0, sizeof(Mpi2EventAckRequest_t));
3505         ack_request->Function = MPI2_FUNCTION_EVENT_ACK;
3506         ack_request->Event = event;
3507         ack_request->EventContext = event_context;
3508         ack_request->VF_ID = 0;  /* TODO */
3509         ack_request->VP_ID = 0;
3510         ioc->put_smid_default(ioc, smid);
3511 }
3512
3513 /**
3514  * _scsih_issue_delayed_sas_io_unit_ctrl - issue delayed
3515  *                              sas_io_unit_ctrl messages
3516  * @ioc: per adapter object
3517  * @smid: system request message index
3518  * @handle: device handle
3519  *
3520  * Context - processed in interrupt context.
3521  */
3522 static void
3523 _scsih_issue_delayed_sas_io_unit_ctrl(struct MPT3SAS_ADAPTER *ioc,
3524                                         u16 smid, u16 handle)
3525         {
3526                 Mpi2SasIoUnitControlRequest_t *mpi_request;
3527                 u32 ioc_state;
3528                 int i = smid - ioc->internal_smid;
3529                 unsigned long flags;
3530
3531                 if (ioc->remove_host) {
3532                         dewtprintk(ioc, pr_info(MPT3SAS_FMT
3533                             "%s: host has been removed\n",
3534                              __func__, ioc->name));
3535                         return;
3536                 } else if (ioc->pci_error_recovery) {
3537                         dewtprintk(ioc, pr_info(MPT3SAS_FMT
3538                             "%s: host in pci error recovery\n",
3539                             __func__, ioc->name));
3540                 return;
3541         }
3542         ioc_state = mpt3sas_base_get_iocstate(ioc, 1);
3543         if (ioc_state != MPI2_IOC_STATE_OPERATIONAL) {
3544                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
3545                     "%s: host is not operational\n",
3546                     __func__, ioc->name));
3547                 return;
3548         }
3549
3550         /* Without releasing the smid just update the
3551          * call back index and reuse the same smid for
3552          * processing this delayed request
3553          */
3554         spin_lock_irqsave(&ioc->scsi_lookup_lock, flags);
3555         ioc->internal_lookup[i].cb_idx = ioc->tm_sas_control_cb_idx;
3556         spin_unlock_irqrestore(&ioc->scsi_lookup_lock, flags);
3557
3558         dewtprintk(ioc, pr_info(MPT3SAS_FMT
3559             "sc_send:handle(0x%04x), (open), smid(%d), cb(%d)\n",
3560             ioc->name, le16_to_cpu(handle), smid,
3561             ioc->tm_sas_control_cb_idx));
3562         mpi_request = mpt3sas_base_get_msg_frame(ioc, smid);
3563         memset(mpi_request, 0, sizeof(Mpi2SasIoUnitControlRequest_t));
3564         mpi_request->Function = MPI2_FUNCTION_SAS_IO_UNIT_CONTROL;
3565         mpi_request->Operation = MPI2_SAS_OP_REMOVE_DEVICE;
3566         mpi_request->DevHandle = handle;
3567         ioc->put_smid_default(ioc, smid);
3568 }
3569
3570 /**
3571  * _scsih_check_for_pending_internal_cmds - check for pending internal messages
3572  * @ioc: per adapter object
3573  * @smid: system request message index
3574  *
3575  * Context: Executed in interrupt context
3576  *
3577  * This will check delayed internal messages list, and process the
3578  * next request.
3579  *
3580  * Return 1 meaning mf should be freed from _base_interrupt
3581  *        0 means the mf is freed from this function.
3582  */
3583 u8
3584 mpt3sas_check_for_pending_internal_cmds(struct MPT3SAS_ADAPTER *ioc, u16 smid)
3585 {
3586         struct _sc_list *delayed_sc;
3587         struct _event_ack_list *delayed_event_ack;
3588
3589         if (!list_empty(&ioc->delayed_event_ack_list)) {
3590                 delayed_event_ack = list_entry(ioc->delayed_event_ack_list.next,
3591                                                 struct _event_ack_list, list);
3592                 _scsih_issue_delayed_event_ack(ioc, smid,
3593                   delayed_event_ack->Event, delayed_event_ack->EventContext);
3594                 list_del(&delayed_event_ack->list);
3595                 kfree(delayed_event_ack);
3596                 return 0;
3597         }
3598
3599         if (!list_empty(&ioc->delayed_sc_list)) {
3600                 delayed_sc = list_entry(ioc->delayed_sc_list.next,
3601                                                 struct _sc_list, list);
3602                 _scsih_issue_delayed_sas_io_unit_ctrl(ioc, smid,
3603                                                  delayed_sc->handle);
3604                 list_del(&delayed_sc->list);
3605                 kfree(delayed_sc);
3606                 return 0;
3607         }
3608         return 1;
3609 }
3610
3611 /**
3612  * _scsih_check_for_pending_tm - check for pending task management
3613  * @ioc: per adapter object
3614  * @smid: system request message index
3615  *
3616  * This will check delayed target reset list, and feed the
3617  * next reqeust.
3618  *
3619  * Return 1 meaning mf should be freed from _base_interrupt
3620  *        0 means the mf is freed from this function.
3621  */
3622 static u8
3623 _scsih_check_for_pending_tm(struct MPT3SAS_ADAPTER *ioc, u16 smid)
3624 {
3625         struct _tr_list *delayed_tr;
3626
3627         if (!list_empty(&ioc->delayed_tr_volume_list)) {
3628                 delayed_tr = list_entry(ioc->delayed_tr_volume_list.next,
3629                     struct _tr_list, list);
3630                 mpt3sas_base_free_smid(ioc, smid);
3631                 _scsih_tm_tr_volume_send(ioc, delayed_tr->handle);
3632                 list_del(&delayed_tr->list);
3633                 kfree(delayed_tr);
3634                 return 0;
3635         }
3636
3637         if (!list_empty(&ioc->delayed_tr_list)) {
3638                 delayed_tr = list_entry(ioc->delayed_tr_list.next,
3639                     struct _tr_list, list);
3640                 mpt3sas_base_free_smid(ioc, smid);
3641                 _scsih_tm_tr_send(ioc, delayed_tr->handle);
3642                 list_del(&delayed_tr->list);
3643                 kfree(delayed_tr);
3644                 return 0;
3645         }
3646
3647         return 1;
3648 }
3649
3650 /**
3651  * _scsih_check_topo_delete_events - sanity check on topo events
3652  * @ioc: per adapter object
3653  * @event_data: the event data payload
3654  *
3655  * This routine added to better handle cable breaker.
3656  *
3657  * This handles the case where driver receives multiple expander
3658  * add and delete events in a single shot.  When there is a delete event
3659  * the routine will void any pending add events waiting in the event queue.
3660  *
3661  * Return nothing.
3662  */
3663 static void
3664 _scsih_check_topo_delete_events(struct MPT3SAS_ADAPTER *ioc,
3665         Mpi2EventDataSasTopologyChangeList_t *event_data)
3666 {
3667         struct fw_event_work *fw_event;
3668         Mpi2EventDataSasTopologyChangeList_t *local_event_data;
3669         u16 expander_handle;
3670         struct _sas_node *sas_expander;
3671         unsigned long flags;
3672         int i, reason_code;
3673         u16 handle;
3674
3675         for (i = 0 ; i < event_data->NumEntries; i++) {
3676                 handle = le16_to_cpu(event_data->PHY[i].AttachedDevHandle);
3677                 if (!handle)
3678                         continue;
3679                 reason_code = event_data->PHY[i].PhyStatus &
3680                     MPI2_EVENT_SAS_TOPO_RC_MASK;
3681                 if (reason_code == MPI2_EVENT_SAS_TOPO_RC_TARG_NOT_RESPONDING)
3682                         _scsih_tm_tr_send(ioc, handle);
3683         }
3684
3685         expander_handle = le16_to_cpu(event_data->ExpanderDevHandle);
3686         if (expander_handle < ioc->sas_hba.num_phys) {
3687                 _scsih_block_io_to_children_attached_directly(ioc, event_data);
3688                 return;
3689         }
3690         if (event_data->ExpStatus ==
3691             MPI2_EVENT_SAS_TOPO_ES_DELAY_NOT_RESPONDING) {
3692                 /* put expander attached devices into blocking state */
3693                 spin_lock_irqsave(&ioc->sas_node_lock, flags);
3694                 sas_expander = mpt3sas_scsih_expander_find_by_handle(ioc,
3695                     expander_handle);
3696                 _scsih_block_io_to_children_attached_to_ex(ioc, sas_expander);
3697                 spin_unlock_irqrestore(&ioc->sas_node_lock, flags);
3698                 do {
3699                         handle = find_first_bit(ioc->blocking_handles,
3700                             ioc->facts.MaxDevHandle);
3701                         if (handle < ioc->facts.MaxDevHandle)
3702                                 _scsih_block_io_device(ioc, handle);
3703                 } while (test_and_clear_bit(handle, ioc->blocking_handles));
3704         } else if (event_data->ExpStatus == MPI2_EVENT_SAS_TOPO_ES_RESPONDING)
3705                 _scsih_block_io_to_children_attached_directly(ioc, event_data);
3706
3707         if (event_data->ExpStatus != MPI2_EVENT_SAS_TOPO_ES_NOT_RESPONDING)
3708                 return;
3709
3710         /* mark ignore flag for pending events */
3711         spin_lock_irqsave(&ioc->fw_event_lock, flags);
3712         list_for_each_entry(fw_event, &ioc->fw_event_list, list) {
3713                 if (fw_event->event != MPI2_EVENT_SAS_TOPOLOGY_CHANGE_LIST ||
3714                     fw_event->ignore)
3715                         continue;
3716                 local_event_data = (Mpi2EventDataSasTopologyChangeList_t *)
3717                                    fw_event->event_data;
3718                 if (local_event_data->ExpStatus ==
3719                     MPI2_EVENT_SAS_TOPO_ES_ADDED ||
3720                     local_event_data->ExpStatus ==
3721                     MPI2_EVENT_SAS_TOPO_ES_RESPONDING) {
3722                         if (le16_to_cpu(local_event_data->ExpanderDevHandle) ==
3723                             expander_handle) {
3724                                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
3725                                     "setting ignoring flag\n", ioc->name));
3726                                 fw_event->ignore = 1;
3727                         }
3728                 }
3729         }
3730         spin_unlock_irqrestore(&ioc->fw_event_lock, flags);
3731 }
3732
3733 /**
3734  * _scsih_set_volume_delete_flag - setting volume delete flag
3735  * @ioc: per adapter object
3736  * @handle: device handle
3737  *
3738  * This returns nothing.
3739  */
3740 static void
3741 _scsih_set_volume_delete_flag(struct MPT3SAS_ADAPTER *ioc, u16 handle)
3742 {
3743         struct _raid_device *raid_device;
3744         struct MPT3SAS_TARGET *sas_target_priv_data;
3745         unsigned long flags;
3746
3747         spin_lock_irqsave(&ioc->raid_device_lock, flags);
3748         raid_device = mpt3sas_raid_device_find_by_handle(ioc, handle);
3749         if (raid_device && raid_device->starget &&
3750             raid_device->starget->hostdata) {
3751                 sas_target_priv_data =
3752                     raid_device->starget->hostdata;
3753                 sas_target_priv_data->deleted = 1;
3754                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
3755                     "setting delete flag: handle(0x%04x), "
3756                     "wwid(0x%016llx)\n", ioc->name, handle,
3757                     (unsigned long long) raid_device->wwid));
3758         }
3759         spin_unlock_irqrestore(&ioc->raid_device_lock, flags);
3760 }
3761
3762 /**
3763  * _scsih_set_volume_handle_for_tr - set handle for target reset to volume
3764  * @handle: input handle
3765  * @a: handle for volume a
3766  * @b: handle for volume b
3767  *
3768  * IR firmware only supports two raid volumes.  The purpose of this
3769  * routine is to set the volume handle in either a or b. When the given
3770  * input handle is non-zero, or when a and b have not been set before.
3771  */
3772 static void
3773 _scsih_set_volume_handle_for_tr(u16 handle, u16 *a, u16 *b)
3774 {
3775         if (!handle || handle == *a || handle == *b)
3776                 return;
3777         if (!*a)
3778                 *a = handle;
3779         else if (!*b)
3780                 *b = handle;
3781 }
3782
3783 /**
3784  * _scsih_check_ir_config_unhide_events - check for UNHIDE events
3785  * @ioc: per adapter object
3786  * @event_data: the event data payload
3787  * Context: interrupt time.
3788  *
3789  * This routine will send target reset to volume, followed by target
3790  * resets to the PDs. This is called when a PD has been removed, or
3791  * volume has been deleted or removed. When the target reset is sent
3792  * to volume, the PD target resets need to be queued to start upon
3793  * completion of the volume target reset.
3794  *
3795  * Return nothing.
3796  */
3797 static void
3798 _scsih_check_ir_config_unhide_events(struct MPT3SAS_ADAPTER *ioc,
3799         Mpi2EventDataIrConfigChangeList_t *event_data)
3800 {
3801         Mpi2EventIrConfigElement_t *element;
3802         int i;
3803         u16 handle, volume_handle, a, b;
3804         struct _tr_list *delayed_tr;
3805
3806         a = 0;
3807         b = 0;
3808
3809         if (ioc->is_warpdrive)
3810                 return;
3811
3812         /* Volume Resets for Deleted or Removed */
3813         element = (Mpi2EventIrConfigElement_t *)&event_data->ConfigElement[0];
3814         for (i = 0; i < event_data->NumElements; i++, element++) {
3815                 if (le32_to_cpu(event_data->Flags) &
3816                     MPI2_EVENT_IR_CHANGE_FLAGS_FOREIGN_CONFIG)
3817                         continue;
3818                 if (element->ReasonCode ==
3819                     MPI2_EVENT_IR_CHANGE_RC_VOLUME_DELETED ||
3820                     element->ReasonCode ==
3821                     MPI2_EVENT_IR_CHANGE_RC_REMOVED) {
3822                         volume_handle = le16_to_cpu(element->VolDevHandle);
3823                         _scsih_set_volume_delete_flag(ioc, volume_handle);
3824                         _scsih_set_volume_handle_for_tr(volume_handle, &a, &b);
3825                 }
3826         }
3827
3828         /* Volume Resets for UNHIDE events */
3829         element = (Mpi2EventIrConfigElement_t *)&event_data->ConfigElement[0];
3830         for (i = 0; i < event_data->NumElements; i++, element++) {
3831                 if (le32_to_cpu(event_data->Flags) &
3832                     MPI2_EVENT_IR_CHANGE_FLAGS_FOREIGN_CONFIG)
3833                         continue;
3834                 if (element->ReasonCode == MPI2_EVENT_IR_CHANGE_RC_UNHIDE) {
3835                         volume_handle = le16_to_cpu(element->VolDevHandle);
3836                         _scsih_set_volume_handle_for_tr(volume_handle, &a, &b);
3837                 }
3838         }
3839
3840         if (a)
3841                 _scsih_tm_tr_volume_send(ioc, a);
3842         if (b)
3843                 _scsih_tm_tr_volume_send(ioc, b);
3844
3845         /* PD target resets */
3846         element = (Mpi2EventIrConfigElement_t *)&event_data->ConfigElement[0];
3847         for (i = 0; i < event_data->NumElements; i++, element++) {
3848                 if (element->ReasonCode != MPI2_EVENT_IR_CHANGE_RC_UNHIDE)
3849                         continue;
3850                 handle = le16_to_cpu(element->PhysDiskDevHandle);
3851                 volume_handle = le16_to_cpu(element->VolDevHandle);
3852                 clear_bit(handle, ioc->pd_handles);
3853                 if (!volume_handle)
3854                         _scsih_tm_tr_send(ioc, handle);
3855                 else if (volume_handle == a || volume_handle == b) {
3856                         delayed_tr = kzalloc(sizeof(*delayed_tr), GFP_ATOMIC);
3857                         BUG_ON(!delayed_tr);
3858                         INIT_LIST_HEAD(&delayed_tr->list);
3859                         delayed_tr->handle = handle;
3860                         list_add_tail(&delayed_tr->list, &ioc->delayed_tr_list);
3861                         dewtprintk(ioc, pr_info(MPT3SAS_FMT
3862                             "DELAYED:tr:handle(0x%04x), (open)\n", ioc->name,
3863                             handle));
3864                 } else
3865                         _scsih_tm_tr_send(ioc, handle);
3866         }
3867 }
3868
3869
3870 /**
3871  * _scsih_check_volume_delete_events - set delete flag for volumes
3872  * @ioc: per adapter object
3873  * @event_data: the event data payload
3874  * Context: interrupt time.
3875  *
3876  * This will handle the case when the cable connected to entire volume is
3877  * pulled. We will take care of setting the deleted flag so normal IO will
3878  * not be sent.
3879  *
3880  * Return nothing.
3881  */
3882 static void
3883 _scsih_check_volume_delete_events(struct MPT3SAS_ADAPTER *ioc,
3884         Mpi2EventDataIrVolume_t *event_data)
3885 {
3886         u32 state;
3887
3888         if (event_data->ReasonCode != MPI2_EVENT_IR_VOLUME_RC_STATE_CHANGED)
3889                 return;
3890         state = le32_to_cpu(event_data->NewValue);
3891         if (state == MPI2_RAID_VOL_STATE_MISSING || state ==
3892             MPI2_RAID_VOL_STATE_FAILED)
3893                 _scsih_set_volume_delete_flag(ioc,
3894                     le16_to_cpu(event_data->VolDevHandle));
3895 }
3896
3897 /**
3898  * _scsih_temp_threshold_events - display temperature threshold exceeded events
3899  * @ioc: per adapter object
3900  * @event_data: the temp threshold event data
3901  * Context: interrupt time.
3902  *
3903  * Return nothing.
3904  */
3905 static void
3906 _scsih_temp_threshold_events(struct MPT3SAS_ADAPTER *ioc,
3907         Mpi2EventDataTemperature_t *event_data)
3908 {
3909         if (ioc->temp_sensors_count >= event_data->SensorNum) {
3910                 pr_err(MPT3SAS_FMT "Temperature Threshold flags %s%s%s%s"
3911                   " exceeded for Sensor: %d !!!\n", ioc->name,
3912                   ((le16_to_cpu(event_data->Status) & 0x1) == 1) ? "0 " : " ",
3913                   ((le16_to_cpu(event_data->Status) & 0x2) == 2) ? "1 " : " ",
3914                   ((le16_to_cpu(event_data->Status) & 0x4) == 4) ? "2 " : " ",
3915                   ((le16_to_cpu(event_data->Status) & 0x8) == 8) ? "3 " : " ",
3916                   event_data->SensorNum);
3917                 pr_err(MPT3SAS_FMT "Current Temp In Celsius: %d\n",
3918                         ioc->name, event_data->CurrentTemperature);
3919         }
3920 }
3921
3922 static int _scsih_set_satl_pending(struct scsi_cmnd *scmd, bool pending)
3923 {
3924         struct MPT3SAS_DEVICE *priv = scmd->device->hostdata;
3925
3926         if (scmd->cmnd[0] != ATA_12 && scmd->cmnd[0] != ATA_16)
3927                 return 0;
3928
3929         if (pending)
3930                 return test_and_set_bit(0, &priv->ata_command_pending);
3931
3932         clear_bit(0, &priv->ata_command_pending);
3933         return 0;
3934 }
3935
3936 /**
3937  * _scsih_flush_running_cmds - completing outstanding commands.
3938  * @ioc: per adapter object
3939  *
3940  * The flushing out of all pending scmd commands following host reset,
3941  * where all IO is dropped to the floor.
3942  *
3943  * Return nothing.
3944  */
3945 static void
3946 _scsih_flush_running_cmds(struct MPT3SAS_ADAPTER *ioc)
3947 {
3948         struct scsi_cmnd *scmd;
3949         u16 smid;
3950         u16 count = 0;
3951
3952         for (smid = 1; smid <= ioc->scsiio_depth; smid++) {
3953                 scmd = _scsih_scsi_lookup_get_clear(ioc, smid);
3954                 if (!scmd)
3955                         continue;
3956                 count++;
3957                 _scsih_set_satl_pending(scmd, false);
3958                 mpt3sas_base_free_smid(ioc, smid);
3959                 scsi_dma_unmap(scmd);
3960                 if (ioc->pci_error_recovery)
3961                         scmd->result = DID_NO_CONNECT << 16;
3962                 else
3963                         scmd->result = DID_RESET << 16;
3964                 scmd->scsi_done(scmd);
3965         }
3966         dtmprintk(ioc, pr_info(MPT3SAS_FMT "completing %d cmds\n",
3967             ioc->name, count));
3968 }
3969
3970 /**
3971  * _scsih_setup_eedp - setup MPI request for EEDP transfer
3972  * @ioc: per adapter object
3973  * @scmd: pointer to scsi command object
3974  * @mpi_request: pointer to the SCSI_IO request message frame
3975  *
3976  * Supporting protection 1 and 3.
3977  *
3978  * Returns nothing
3979  */
3980 static void
3981 _scsih_setup_eedp(struct MPT3SAS_ADAPTER *ioc, struct scsi_cmnd *scmd,
3982         Mpi2SCSIIORequest_t *mpi_request)
3983 {
3984         u16 eedp_flags;
3985         unsigned char prot_op = scsi_get_prot_op(scmd);
3986         unsigned char prot_type = scsi_get_prot_type(scmd);
3987         Mpi25SCSIIORequest_t *mpi_request_3v =
3988            (Mpi25SCSIIORequest_t *)mpi_request;
3989
3990         if (prot_type == SCSI_PROT_DIF_TYPE0 || prot_op == SCSI_PROT_NORMAL)
3991                 return;
3992
3993         if (prot_op ==  SCSI_PROT_READ_STRIP)
3994                 eedp_flags = MPI2_SCSIIO_EEDPFLAGS_CHECK_REMOVE_OP;
3995         else if (prot_op ==  SCSI_PROT_WRITE_INSERT)
3996                 eedp_flags = MPI2_SCSIIO_EEDPFLAGS_INSERT_OP;
3997         else
3998                 return;
3999
4000         switch (prot_type) {
4001         case SCSI_PROT_DIF_TYPE1:
4002         case SCSI_PROT_DIF_TYPE2:
4003
4004                 /*
4005                 * enable ref/guard checking
4006                 * auto increment ref tag
4007                 */
4008                 eedp_flags |= MPI2_SCSIIO_EEDPFLAGS_INC_PRI_REFTAG |
4009                     MPI2_SCSIIO_EEDPFLAGS_CHECK_REFTAG |
4010                     MPI2_SCSIIO_EEDPFLAGS_CHECK_GUARD;
4011                 mpi_request->CDB.EEDP32.PrimaryReferenceTag =
4012                     cpu_to_be32(scsi_prot_ref_tag(scmd));
4013                 break;
4014
4015         case SCSI_PROT_DIF_TYPE3:
4016
4017                 /*
4018                 * enable guard checking
4019                 */
4020                 eedp_flags |= MPI2_SCSIIO_EEDPFLAGS_CHECK_GUARD;
4021
4022                 break;
4023         }
4024
4025         mpi_request_3v->EEDPBlockSize =
4026             cpu_to_le16(scmd->device->sector_size);
4027
4028         if (ioc->is_gen35_ioc)
4029                 eedp_flags |= MPI25_SCSIIO_EEDPFLAGS_APPTAG_DISABLE_MODE;
4030         mpi_request->EEDPFlags = cpu_to_le16(eedp_flags);
4031 }
4032
4033 /**
4034  * _scsih_eedp_error_handling - return sense code for EEDP errors
4035  * @scmd: pointer to scsi command object
4036  * @ioc_status: ioc status
4037  *
4038  * Returns nothing
4039  */
4040 static void
4041 _scsih_eedp_error_handling(struct scsi_cmnd *scmd, u16 ioc_status)
4042 {
4043         u8 ascq;
4044
4045         switch (ioc_status) {
4046         case MPI2_IOCSTATUS_EEDP_GUARD_ERROR:
4047                 ascq = 0x01;
4048                 break;
4049         case MPI2_IOCSTATUS_EEDP_APP_TAG_ERROR:
4050                 ascq = 0x02;
4051                 break;
4052         case MPI2_IOCSTATUS_EEDP_REF_TAG_ERROR:
4053                 ascq = 0x03;
4054                 break;
4055         default:
4056                 ascq = 0x00;
4057                 break;
4058         }
4059         scsi_build_sense_buffer(0, scmd->sense_buffer, ILLEGAL_REQUEST, 0x10,
4060             ascq);
4061         scmd->result = DRIVER_SENSE << 24 | (DID_ABORT << 16) |
4062             SAM_STAT_CHECK_CONDITION;
4063 }
4064
4065 /**
4066  * scsih_qcmd - main scsi request entry point
4067  * @scmd: pointer to scsi command object
4068  * @done: function pointer to be invoked on completion
4069  *
4070  * The callback index is set inside `ioc->scsi_io_cb_idx`.
4071  *
4072  * Returns 0 on success.  If there's a failure, return either:
4073  * SCSI_MLQUEUE_DEVICE_BUSY if the device queue is full, or
4074  * SCSI_MLQUEUE_HOST_BUSY if the entire host queue is full
4075  */
4076 static int
4077 scsih_qcmd(struct Scsi_Host *shost, struct scsi_cmnd *scmd)
4078 {
4079         struct MPT3SAS_ADAPTER *ioc = shost_priv(shost);
4080         struct MPT3SAS_DEVICE *sas_device_priv_data;
4081         struct MPT3SAS_TARGET *sas_target_priv_data;
4082         struct _raid_device *raid_device;
4083         struct request *rq = scmd->request;
4084         int class;
4085         Mpi2SCSIIORequest_t *mpi_request;
4086         u32 mpi_control;
4087         u16 smid;
4088         u16 handle;
4089
4090         if (ioc->logging_level & MPT_DEBUG_SCSI)
4091                 scsi_print_command(scmd);
4092
4093         sas_device_priv_data = scmd->device->hostdata;
4094         if (!sas_device_priv_data || !sas_device_priv_data->sas_target) {
4095                 scmd->result = DID_NO_CONNECT << 16;
4096                 scmd->scsi_done(scmd);
4097                 return 0;
4098         }
4099
4100         if (ioc->pci_error_recovery || ioc->remove_host) {
4101                 scmd->result = DID_NO_CONNECT << 16;
4102                 scmd->scsi_done(scmd);
4103                 return 0;
4104         }
4105
4106         /*
4107          * Bug work around for firmware SATL handling.  The loop
4108          * is based on atomic operations and ensures consistency
4109          * since we're lockless at this point
4110          */
4111         do {
4112                 if (test_bit(0, &sas_device_priv_data->ata_command_pending)) {
4113                         scmd->result = SAM_STAT_BUSY;
4114                         scmd->scsi_done(scmd);
4115                         return 0;
4116                 }
4117         } while (_scsih_set_satl_pending(scmd, true));
4118
4119         sas_target_priv_data = sas_device_priv_data->sas_target;
4120
4121         /* invalid device handle */
4122         handle = sas_target_priv_data->handle;
4123         if (handle == MPT3SAS_INVALID_DEVICE_HANDLE) {
4124                 scmd->result = DID_NO_CONNECT << 16;
4125                 scmd->scsi_done(scmd);
4126                 return 0;
4127         }
4128
4129
4130         /* host recovery or link resets sent via IOCTLs */
4131         if (ioc->shost_recovery || ioc->ioc_link_reset_in_progress)
4132                 return SCSI_MLQUEUE_HOST_BUSY;
4133
4134         /* device has been deleted */
4135         else if (sas_target_priv_data->deleted) {
4136                 scmd->result = DID_NO_CONNECT << 16;
4137                 scmd->scsi_done(scmd);
4138                 return 0;
4139         /* device busy with task management */
4140         } else if (sas_target_priv_data->tm_busy ||
4141             sas_device_priv_data->block)
4142                 return SCSI_MLQUEUE_DEVICE_BUSY;
4143
4144         if (scmd->sc_data_direction == DMA_FROM_DEVICE)
4145                 mpi_control = MPI2_SCSIIO_CONTROL_READ;
4146         else if (scmd->sc_data_direction == DMA_TO_DEVICE)
4147                 mpi_control = MPI2_SCSIIO_CONTROL_WRITE;
4148         else
4149                 mpi_control = MPI2_SCSIIO_CONTROL_NODATATRANSFER;
4150
4151         /* set tags */
4152         mpi_control |= MPI2_SCSIIO_CONTROL_SIMPLEQ;
4153         /* NCQ Prio supported, make sure control indicated high priority */
4154         if (sas_device_priv_data->ncq_prio_enable) {
4155                 class = IOPRIO_PRIO_CLASS(req_get_ioprio(rq));
4156                 if (class == IOPRIO_CLASS_RT)
4157                         mpi_control |= 1 << MPI2_SCSIIO_CONTROL_CMDPRI_SHIFT;
4158         }
4159         /* Make sure Device is not raid volume.
4160          * We do not expose raid functionality to upper layer for warpdrive.
4161          */
4162         if (!ioc->is_warpdrive && !scsih_is_raid(&scmd->device->sdev_gendev)
4163             && sas_is_tlr_enabled(scmd->device) && scmd->cmd_len != 32)
4164                 mpi_control |= MPI2_SCSIIO_CONTROL_TLR_ON;
4165
4166         smid = mpt3sas_base_get_smid_scsiio(ioc, ioc->scsi_io_cb_idx, scmd);
4167         if (!smid) {
4168                 pr_err(MPT3SAS_FMT "%s: failed obtaining a smid\n",
4169                     ioc->name, __func__);
4170                 goto out;
4171         }
4172         mpi_request = mpt3sas_base_get_msg_frame(ioc, smid);
4173         memset(mpi_request, 0, sizeof(Mpi2SCSIIORequest_t));
4174         _scsih_setup_eedp(ioc, scmd, mpi_request);
4175
4176         if (scmd->cmd_len == 32)
4177                 mpi_control |= 4 << MPI2_SCSIIO_CONTROL_ADDCDBLEN_SHIFT;
4178         mpi_request->Function = MPI2_FUNCTION_SCSI_IO_REQUEST;
4179         if (sas_device_priv_data->sas_target->flags &
4180             MPT_TARGET_FLAGS_RAID_COMPONENT)
4181                 mpi_request->Function = MPI2_FUNCTION_RAID_SCSI_IO_PASSTHROUGH;
4182         else
4183                 mpi_request->Function = MPI2_FUNCTION_SCSI_IO_REQUEST;
4184         mpi_request->DevHandle = cpu_to_le16(handle);
4185         mpi_request->DataLength = cpu_to_le32(scsi_bufflen(scmd));
4186         mpi_request->Control = cpu_to_le32(mpi_control);
4187         mpi_request->IoFlags = cpu_to_le16(scmd->cmd_len);
4188         mpi_request->MsgFlags = MPI2_SCSIIO_MSGFLAGS_SYSTEM_SENSE_ADDR;
4189         mpi_request->SenseBufferLength = SCSI_SENSE_BUFFERSIZE;
4190         mpi_request->SenseBufferLowAddress =
4191             mpt3sas_base_get_sense_buffer_dma(ioc, smid);
4192         mpi_request->SGLOffset0 = offsetof(Mpi2SCSIIORequest_t, SGL) / 4;
4193         int_to_scsilun(sas_device_priv_data->lun, (struct scsi_lun *)
4194             mpi_request->LUN);
4195         memcpy(mpi_request->CDB.CDB32, scmd->cmnd, scmd->cmd_len);
4196
4197         if (mpi_request->DataLength) {
4198                 if (ioc->build_sg_scmd(ioc, scmd, smid)) {
4199                         mpt3sas_base_free_smid(ioc, smid);
4200                         goto out;
4201                 }
4202         } else
4203                 ioc->build_zero_len_sge(ioc, &mpi_request->SGL);
4204
4205         raid_device = sas_target_priv_data->raid_device;
4206         if (raid_device && raid_device->direct_io_enabled)
4207                 mpt3sas_setup_direct_io(ioc, scmd, raid_device, mpi_request,
4208                     smid);
4209
4210         if (likely(mpi_request->Function == MPI2_FUNCTION_SCSI_IO_REQUEST)) {
4211                 if (sas_target_priv_data->flags & MPT_TARGET_FASTPATH_IO) {
4212                         mpi_request->IoFlags = cpu_to_le16(scmd->cmd_len |
4213                             MPI25_SCSIIO_IOFLAGS_FAST_PATH);
4214                         ioc->put_smid_fast_path(ioc, smid, handle);
4215                 } else
4216                         ioc->put_smid_scsi_io(ioc, smid,
4217                             le16_to_cpu(mpi_request->DevHandle));
4218         } else
4219                 ioc->put_smid_default(ioc, smid);
4220         return 0;
4221
4222  out:
4223         return SCSI_MLQUEUE_HOST_BUSY;
4224 }
4225
4226 /**
4227  * _scsih_normalize_sense - normalize descriptor and fixed format sense data
4228  * @sense_buffer: sense data returned by target
4229  * @data: normalized skey/asc/ascq
4230  *
4231  * Return nothing.
4232  */
4233 static void
4234 _scsih_normalize_sense(char *sense_buffer, struct sense_info *data)
4235 {
4236         if ((sense_buffer[0] & 0x7F) >= 0x72) {
4237                 /* descriptor format */
4238                 data->skey = sense_buffer[1] & 0x0F;
4239                 data->asc = sense_buffer[2];
4240                 data->ascq = sense_buffer[3];
4241         } else {
4242                 /* fixed format */
4243                 data->skey = sense_buffer[2] & 0x0F;
4244                 data->asc = sense_buffer[12];
4245                 data->ascq = sense_buffer[13];
4246         }
4247 }
4248
4249 /**
4250  * _scsih_scsi_ioc_info - translated non-succesfull SCSI_IO request
4251  * @ioc: per adapter object
4252  * @scmd: pointer to scsi command object
4253  * @mpi_reply: reply mf payload returned from firmware
4254  *
4255  * scsi_status - SCSI Status code returned from target device
4256  * scsi_state - state info associated with SCSI_IO determined by ioc
4257  * ioc_status - ioc supplied status info
4258  *
4259  * Return nothing.
4260  */
4261 static void
4262 _scsih_scsi_ioc_info(struct MPT3SAS_ADAPTER *ioc, struct scsi_cmnd *scmd,
4263         Mpi2SCSIIOReply_t *mpi_reply, u16 smid)
4264 {
4265         u32 response_info;
4266         u8 *response_bytes;
4267         u16 ioc_status = le16_to_cpu(mpi_reply->IOCStatus) &
4268             MPI2_IOCSTATUS_MASK;
4269         u8 scsi_state = mpi_reply->SCSIState;
4270         u8 scsi_status = mpi_reply->SCSIStatus;
4271         char *desc_ioc_state = NULL;
4272         char *desc_scsi_status = NULL;
4273         char *desc_scsi_state = ioc->tmp_string;
4274         u32 log_info = le32_to_cpu(mpi_reply->IOCLogInfo);
4275         struct _sas_device *sas_device = NULL;
4276         struct scsi_target *starget = scmd->device->sdev_target;
4277         struct MPT3SAS_TARGET *priv_target = starget->hostdata;
4278         char *device_str = NULL;
4279
4280         if (!priv_target)
4281                 return;
4282         if (ioc->hide_ir_msg)
4283                 device_str = "WarpDrive";
4284         else
4285                 device_str = "volume";
4286
4287         if (log_info == 0x31170000)
4288                 return;
4289
4290         switch (ioc_status) {
4291         case MPI2_IOCSTATUS_SUCCESS:
4292                 desc_ioc_state = "success";
4293                 break;
4294         case MPI2_IOCSTATUS_INVALID_FUNCTION:
4295                 desc_ioc_state = "invalid function";
4296                 break;
4297         case MPI2_IOCSTATUS_SCSI_RECOVERED_ERROR:
4298                 desc_ioc_state = "scsi recovered error";
4299                 break;
4300         case MPI2_IOCSTATUS_SCSI_INVALID_DEVHANDLE:
4301                 desc_ioc_state = "scsi invalid dev handle";
4302                 break;
4303         case MPI2_IOCSTATUS_SCSI_DEVICE_NOT_THERE:
4304                 desc_ioc_state = "scsi device not there";
4305                 break;
4306         case MPI2_IOCSTATUS_SCSI_DATA_OVERRUN:
4307                 desc_ioc_state = "scsi data overrun";
4308                 break;
4309         case MPI2_IOCSTATUS_SCSI_DATA_UNDERRUN:
4310                 desc_ioc_state = "scsi data underrun";
4311                 break;
4312         case MPI2_IOCSTATUS_SCSI_IO_DATA_ERROR:
4313                 desc_ioc_state = "scsi io data error";
4314                 break;
4315         case MPI2_IOCSTATUS_SCSI_PROTOCOL_ERROR:
4316                 desc_ioc_state = "scsi protocol error";
4317                 break;
4318         case MPI2_IOCSTATUS_SCSI_TASK_TERMINATED:
4319                 desc_ioc_state = "scsi task terminated";
4320                 break;
4321         case MPI2_IOCSTATUS_SCSI_RESIDUAL_MISMATCH:
4322                 desc_ioc_state = "scsi residual mismatch";
4323                 break;
4324         case MPI2_IOCSTATUS_SCSI_TASK_MGMT_FAILED:
4325                 desc_ioc_state = "scsi task mgmt failed";
4326                 break;
4327         case MPI2_IOCSTATUS_SCSI_IOC_TERMINATED:
4328                 desc_ioc_state = "scsi ioc terminated";
4329                 break;
4330         case MPI2_IOCSTATUS_SCSI_EXT_TERMINATED:
4331                 desc_ioc_state = "scsi ext terminated";
4332                 break;
4333         case MPI2_IOCSTATUS_EEDP_GUARD_ERROR:
4334                 desc_ioc_state = "eedp guard error";
4335                 break;
4336         case MPI2_IOCSTATUS_EEDP_REF_TAG_ERROR:
4337                 desc_ioc_state = "eedp ref tag error";
4338                 break;
4339         case MPI2_IOCSTATUS_EEDP_APP_TAG_ERROR:
4340                 desc_ioc_state = "eedp app tag error";
4341                 break;
4342         case MPI2_IOCSTATUS_INSUFFICIENT_POWER:
4343                 desc_ioc_state = "insufficient power";
4344                 break;
4345         default:
4346                 desc_ioc_state = "unknown";
4347                 break;
4348         }
4349
4350         switch (scsi_status) {
4351         case MPI2_SCSI_STATUS_GOOD:
4352                 desc_scsi_status = "good";
4353                 break;
4354         case MPI2_SCSI_STATUS_CHECK_CONDITION:
4355                 desc_scsi_status = "check condition";
4356                 break;
4357         case MPI2_SCSI_STATUS_CONDITION_MET:
4358                 desc_scsi_status = "condition met";
4359                 break;
4360         case MPI2_SCSI_STATUS_BUSY:
4361                 desc_scsi_status = "busy";
4362                 break;
4363         case MPI2_SCSI_STATUS_INTERMEDIATE:
4364                 desc_scsi_status = "intermediate";
4365                 break;
4366         case MPI2_SCSI_STATUS_INTERMEDIATE_CONDMET:
4367                 desc_scsi_status = "intermediate condmet";
4368                 break;
4369         case MPI2_SCSI_STATUS_RESERVATION_CONFLICT:
4370                 desc_scsi_status = "reservation conflict";
4371                 break;
4372         case MPI2_SCSI_STATUS_COMMAND_TERMINATED:
4373                 desc_scsi_status = "command terminated";
4374                 break;
4375         case MPI2_SCSI_STATUS_TASK_SET_FULL:
4376                 desc_scsi_status = "task set full";
4377                 break;
4378         case MPI2_SCSI_STATUS_ACA_ACTIVE:
4379                 desc_scsi_status = "aca active";
4380                 break;
4381         case MPI2_SCSI_STATUS_TASK_ABORTED:
4382                 desc_scsi_status = "task aborted";
4383                 break;
4384         default:
4385                 desc_scsi_status = "unknown";
4386                 break;
4387         }
4388
4389         desc_scsi_state[0] = '\0';
4390         if (!scsi_state)
4391                 desc_scsi_state = " ";
4392         if (scsi_state & MPI2_SCSI_STATE_RESPONSE_INFO_VALID)
4393                 strcat(desc_scsi_state, "response info ");
4394         if (scsi_state & MPI2_SCSI_STATE_TERMINATED)
4395                 strcat(desc_scsi_state, "state terminated ");
4396         if (scsi_state & MPI2_SCSI_STATE_NO_SCSI_STATUS)
4397                 strcat(desc_scsi_state, "no status ");
4398         if (scsi_state & MPI2_SCSI_STATE_AUTOSENSE_FAILED)
4399                 strcat(desc_scsi_state, "autosense failed ");
4400         if (scsi_state & MPI2_SCSI_STATE_AUTOSENSE_VALID)
4401                 strcat(desc_scsi_state, "autosense valid ");
4402
4403         scsi_print_command(scmd);
4404
4405         if (priv_target->flags & MPT_TARGET_FLAGS_VOLUME) {
4406                 pr_warn(MPT3SAS_FMT "\t%s wwid(0x%016llx)\n", ioc->name,
4407                     device_str, (unsigned long long)priv_target->sas_address);
4408         } else {
4409                 sas_device = mpt3sas_get_sdev_from_target(ioc, priv_target);
4410                 if (sas_device) {
4411                         pr_warn(MPT3SAS_FMT
4412                                 "\tsas_address(0x%016llx), phy(%d)\n",
4413                                 ioc->name, (unsigned long long)
4414                             sas_device->sas_address, sas_device->phy);
4415                         if (sas_device->enclosure_handle != 0)
4416                                 pr_warn(MPT3SAS_FMT
4417                                   "\tenclosure_logical_id(0x%016llx),"
4418                                   "slot(%d)\n", ioc->name,
4419                                   (unsigned long long)
4420                                   sas_device->enclosure_logical_id,
4421                                   sas_device->slot);
4422                         if (sas_device->connector_name[0])
4423                                 pr_warn(MPT3SAS_FMT
4424                                   "\tenclosure level(0x%04x),"
4425                                   " connector name( %s)\n", ioc->name,
4426                                   sas_device->enclosure_level,
4427                                   sas_device->connector_name);
4428
4429                         sas_device_put(sas_device);
4430                 }
4431         }
4432
4433         pr_warn(MPT3SAS_FMT
4434                 "\thandle(0x%04x), ioc_status(%s)(0x%04x), smid(%d)\n",
4435                 ioc->name, le16_to_cpu(mpi_reply->DevHandle),
4436             desc_ioc_state, ioc_status, smid);
4437         pr_warn(MPT3SAS_FMT
4438                 "\trequest_len(%d), underflow(%d), resid(%d)\n",
4439                 ioc->name, scsi_bufflen(scmd), scmd->underflow,
4440             scsi_get_resid(scmd));
4441         pr_warn(MPT3SAS_FMT
4442                 "\ttag(%d), transfer_count(%d), sc->result(0x%08x)\n",
4443                 ioc->name, le16_to_cpu(mpi_reply->TaskTag),
4444             le32_to_cpu(mpi_reply->TransferCount), scmd->result);
4445         pr_warn(MPT3SAS_FMT
4446                 "\tscsi_status(%s)(0x%02x), scsi_state(%s)(0x%02x)\n",
4447                 ioc->name, desc_scsi_status,
4448             scsi_status, desc_scsi_state, scsi_state);
4449
4450         if (scsi_state & MPI2_SCSI_STATE_AUTOSENSE_VALID) {
4451                 struct sense_info data;
4452                 _scsih_normalize_sense(scmd->sense_buffer, &data);
4453                 pr_warn(MPT3SAS_FMT
4454                         "\t[sense_key,asc,ascq]: [0x%02x,0x%02x,0x%02x], count(%d)\n",
4455                         ioc->name, data.skey,
4456                     data.asc, data.ascq, le32_to_cpu(mpi_reply->SenseCount));
4457         }
4458
4459         if (scsi_state & MPI2_SCSI_STATE_RESPONSE_INFO_VALID) {
4460                 response_info = le32_to_cpu(mpi_reply->ResponseInfo);
4461                 response_bytes = (u8 *)&response_info;
4462                 _scsih_response_code(ioc, response_bytes[0]);
4463         }
4464 }
4465
4466 /**
4467  * _scsih_turn_on_pfa_led - illuminate PFA LED
4468  * @ioc: per adapter object
4469  * @handle: device handle
4470  * Context: process
4471  *
4472  * Return nothing.
4473  */
4474 static void
4475 _scsih_turn_on_pfa_led(struct MPT3SAS_ADAPTER *ioc, u16 handle)
4476 {
4477         Mpi2SepReply_t mpi_reply;
4478         Mpi2SepRequest_t mpi_request;
4479         struct _sas_device *sas_device;
4480
4481         sas_device = mpt3sas_get_sdev_by_handle(ioc, handle);
4482         if (!sas_device)
4483                 return;
4484
4485         memset(&mpi_request, 0, sizeof(Mpi2SepRequest_t));
4486         mpi_request.Function = MPI2_FUNCTION_SCSI_ENCLOSURE_PROCESSOR;
4487         mpi_request.Action = MPI2_SEP_REQ_ACTION_WRITE_STATUS;
4488         mpi_request.SlotStatus =
4489             cpu_to_le32(MPI2_SEP_REQ_SLOTSTATUS_PREDICTED_FAULT);
4490         mpi_request.DevHandle = cpu_to_le16(handle);
4491         mpi_request.Flags = MPI2_SEP_REQ_FLAGS_DEVHANDLE_ADDRESS;
4492         if ((mpt3sas_base_scsi_enclosure_processor(ioc, &mpi_reply,
4493             &mpi_request)) != 0) {
4494                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n", ioc->name,
4495                 __FILE__, __LINE__, __func__);
4496                 goto out;
4497         }
4498         sas_device->pfa_led_on = 1;
4499
4500         if (mpi_reply.IOCStatus || mpi_reply.IOCLogInfo) {
4501                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
4502                         "enclosure_processor: ioc_status (0x%04x), loginfo(0x%08x)\n",
4503                         ioc->name, le16_to_cpu(mpi_reply.IOCStatus),
4504                     le32_to_cpu(mpi_reply.IOCLogInfo)));
4505                 goto out;
4506         }
4507 out:
4508         sas_device_put(sas_device);
4509 }
4510
4511 /**
4512  * _scsih_turn_off_pfa_led - turn off Fault LED
4513  * @ioc: per adapter object
4514  * @sas_device: sas device whose PFA LED has to turned off
4515  * Context: process
4516  *
4517  * Return nothing.
4518  */
4519 static void
4520 _scsih_turn_off_pfa_led(struct MPT3SAS_ADAPTER *ioc,
4521         struct _sas_device *sas_device)
4522 {
4523         Mpi2SepReply_t mpi_reply;
4524         Mpi2SepRequest_t mpi_request;
4525
4526         memset(&mpi_request, 0, sizeof(Mpi2SepRequest_t));
4527         mpi_request.Function = MPI2_FUNCTION_SCSI_ENCLOSURE_PROCESSOR;
4528         mpi_request.Action = MPI2_SEP_REQ_ACTION_WRITE_STATUS;
4529         mpi_request.SlotStatus = 0;
4530         mpi_request.Slot = cpu_to_le16(sas_device->slot);
4531         mpi_request.DevHandle = 0;
4532         mpi_request.EnclosureHandle = cpu_to_le16(sas_device->enclosure_handle);
4533         mpi_request.Flags = MPI2_SEP_REQ_FLAGS_ENCLOSURE_SLOT_ADDRESS;
4534         if ((mpt3sas_base_scsi_enclosure_processor(ioc, &mpi_reply,
4535                 &mpi_request)) != 0) {
4536                 printk(MPT3SAS_FMT "failure at %s:%d/%s()!\n", ioc->name,
4537                 __FILE__, __LINE__, __func__);
4538                 return;
4539         }
4540
4541         if (mpi_reply.IOCStatus || mpi_reply.IOCLogInfo) {
4542                 dewtprintk(ioc, printk(MPT3SAS_FMT
4543                  "enclosure_processor: ioc_status (0x%04x), loginfo(0x%08x)\n",
4544                  ioc->name, le16_to_cpu(mpi_reply.IOCStatus),
4545                  le32_to_cpu(mpi_reply.IOCLogInfo)));
4546                 return;
4547         }
4548 }
4549
4550 /**
4551  * _scsih_send_event_to_turn_on_pfa_led - fire delayed event
4552  * @ioc: per adapter object
4553  * @handle: device handle
4554  * Context: interrupt.
4555  *
4556  * Return nothing.
4557  */
4558 static void
4559 _scsih_send_event_to_turn_on_pfa_led(struct MPT3SAS_ADAPTER *ioc, u16 handle)
4560 {
4561         struct fw_event_work *fw_event;
4562
4563         fw_event = alloc_fw_event_work(0);
4564         if (!fw_event)
4565                 return;
4566         fw_event->event = MPT3SAS_TURN_ON_PFA_LED;
4567         fw_event->device_handle = handle;
4568         fw_event->ioc = ioc;
4569         _scsih_fw_event_add(ioc, fw_event);
4570         fw_event_work_put(fw_event);
4571 }
4572
4573 /**
4574  * _scsih_smart_predicted_fault - process smart errors
4575  * @ioc: per adapter object
4576  * @handle: device handle
4577  * Context: interrupt.
4578  *
4579  * Return nothing.
4580  */
4581 static void
4582 _scsih_smart_predicted_fault(struct MPT3SAS_ADAPTER *ioc, u16 handle)
4583 {
4584         struct scsi_target *starget;
4585         struct MPT3SAS_TARGET *sas_target_priv_data;
4586         Mpi2EventNotificationReply_t *event_reply;
4587         Mpi2EventDataSasDeviceStatusChange_t *event_data;
4588         struct _sas_device *sas_device;
4589         ssize_t sz;
4590         unsigned long flags;
4591
4592         /* only handle non-raid devices */
4593         spin_lock_irqsave(&ioc->sas_device_lock, flags);
4594         sas_device = __mpt3sas_get_sdev_by_handle(ioc, handle);
4595         if (!sas_device)
4596                 goto out_unlock;
4597
4598         starget = sas_device->starget;
4599         sas_target_priv_data = starget->hostdata;
4600
4601         if ((sas_target_priv_data->flags & MPT_TARGET_FLAGS_RAID_COMPONENT) ||
4602            ((sas_target_priv_data->flags & MPT_TARGET_FLAGS_VOLUME)))
4603                 goto out_unlock;
4604
4605         if (sas_device->enclosure_handle != 0)
4606                 starget_printk(KERN_INFO, starget, "predicted fault, "
4607                         "enclosure logical id(0x%016llx), slot(%d)\n",
4608                         (unsigned long long)sas_device->enclosure_logical_id,
4609                         sas_device->slot);
4610         if (sas_device->connector_name[0] != '\0')
4611                 starget_printk(KERN_WARNING, starget, "predicted fault, "
4612                         "enclosure level(0x%04x), connector name( %s)\n",
4613                         sas_device->enclosure_level,
4614                         sas_device->connector_name);
4615         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
4616
4617         if (ioc->pdev->subsystem_vendor == PCI_VENDOR_ID_IBM)
4618                 _scsih_send_event_to_turn_on_pfa_led(ioc, handle);
4619
4620         /* insert into event log */
4621         sz = offsetof(Mpi2EventNotificationReply_t, EventData) +
4622              sizeof(Mpi2EventDataSasDeviceStatusChange_t);
4623         event_reply = kzalloc(sz, GFP_KERNEL);
4624         if (!event_reply) {
4625                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
4626                     ioc->name, __FILE__, __LINE__, __func__);
4627                 goto out;
4628         }
4629
4630         event_reply->Function = MPI2_FUNCTION_EVENT_NOTIFICATION;
4631         event_reply->Event =
4632             cpu_to_le16(MPI2_EVENT_SAS_DEVICE_STATUS_CHANGE);
4633         event_reply->MsgLength = sz/4;
4634         event_reply->EventDataLength =
4635             cpu_to_le16(sizeof(Mpi2EventDataSasDeviceStatusChange_t)/4);
4636         event_data = (Mpi2EventDataSasDeviceStatusChange_t *)
4637             event_reply->EventData;
4638         event_data->ReasonCode = MPI2_EVENT_SAS_DEV_STAT_RC_SMART_DATA;
4639         event_data->ASC = 0x5D;
4640         event_data->DevHandle = cpu_to_le16(handle);
4641         event_data->SASAddress = cpu_to_le64(sas_target_priv_data->sas_address);
4642         mpt3sas_ctl_add_to_event_log(ioc, event_reply);
4643         kfree(event_reply);
4644 out:
4645         if (sas_device)
4646                 sas_device_put(sas_device);
4647         return;
4648
4649 out_unlock:
4650         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
4651         goto out;
4652 }
4653
4654 /**
4655  * _scsih_io_done - scsi request callback
4656  * @ioc: per adapter object
4657  * @smid: system request message index
4658  * @msix_index: MSIX table index supplied by the OS
4659  * @reply: reply message frame(lower 32bit addr)
4660  *
4661  * Callback handler when using _scsih_qcmd.
4662  *
4663  * Return 1 meaning mf should be freed from _base_interrupt
4664  *        0 means the mf is freed from this function.
4665  */
4666 static u8
4667 _scsih_io_done(struct MPT3SAS_ADAPTER *ioc, u16 smid, u8 msix_index, u32 reply)
4668 {
4669         Mpi2SCSIIORequest_t *mpi_request;
4670         Mpi2SCSIIOReply_t *mpi_reply;
4671         struct scsi_cmnd *scmd;
4672         u16 ioc_status;
4673         u32 xfer_cnt;
4674         u8 scsi_state;
4675         u8 scsi_status;
4676         u32 log_info;
4677         struct MPT3SAS_DEVICE *sas_device_priv_data;
4678         u32 response_code = 0;
4679         unsigned long flags;
4680         unsigned int sector_sz;
4681
4682         mpi_reply = mpt3sas_base_get_reply_virt_addr(ioc, reply);
4683
4684         if (ioc->broadcast_aen_busy || ioc->pci_error_recovery ||
4685                         ioc->got_task_abort_from_ioctl)
4686                 scmd = _scsih_scsi_lookup_get_clear(ioc, smid);
4687         else
4688                 scmd = __scsih_scsi_lookup_get_clear(ioc, smid);
4689
4690         if (scmd == NULL)
4691                 return 1;
4692
4693         _scsih_set_satl_pending(scmd, false);
4694
4695         mpi_request = mpt3sas_base_get_msg_frame(ioc, smid);
4696
4697         if (mpi_reply == NULL) {
4698                 scmd->result = DID_OK << 16;
4699                 goto out;
4700         }
4701
4702         sas_device_priv_data = scmd->device->hostdata;
4703         if (!sas_device_priv_data || !sas_device_priv_data->sas_target ||
4704              sas_device_priv_data->sas_target->deleted) {
4705                 scmd->result = DID_NO_CONNECT << 16;
4706                 goto out;
4707         }
4708         ioc_status = le16_to_cpu(mpi_reply->IOCStatus);
4709
4710         /*
4711          * WARPDRIVE: If direct_io is set then it is directIO,
4712          * the failed direct I/O should be redirected to volume
4713          */
4714         if (mpt3sas_scsi_direct_io_get(ioc, smid) &&
4715              ((ioc_status & MPI2_IOCSTATUS_MASK)
4716               != MPI2_IOCSTATUS_SCSI_TASK_TERMINATED)) {
4717                 spin_lock_irqsave(&ioc->scsi_lookup_lock, flags);
4718                 ioc->scsi_lookup[smid - 1].scmd = scmd;
4719                 spin_unlock_irqrestore(&ioc->scsi_lookup_lock, flags);
4720                 mpt3sas_scsi_direct_io_set(ioc, smid, 0);
4721                 memcpy(mpi_request->CDB.CDB32, scmd->cmnd, scmd->cmd_len);
4722                 mpi_request->DevHandle =
4723                     cpu_to_le16(sas_device_priv_data->sas_target->handle);
4724                 ioc->put_smid_scsi_io(ioc, smid,
4725                     sas_device_priv_data->sas_target->handle);
4726                 return 0;
4727         }
4728         /* turning off TLR */
4729         scsi_state = mpi_reply->SCSIState;
4730         if (scsi_state & MPI2_SCSI_STATE_RESPONSE_INFO_VALID)
4731                 response_code =
4732                     le32_to_cpu(mpi_reply->ResponseInfo) & 0xFF;
4733         if (!sas_device_priv_data->tlr_snoop_check) {
4734                 sas_device_priv_data->tlr_snoop_check++;
4735                 if (!ioc->is_warpdrive &&
4736                     !scsih_is_raid(&scmd->device->sdev_gendev) &&
4737                     sas_is_tlr_enabled(scmd->device) &&
4738                     response_code == MPI2_SCSITASKMGMT_RSP_INVALID_FRAME) {
4739                         sas_disable_tlr(scmd->device);
4740                         sdev_printk(KERN_INFO, scmd->device, "TLR disabled\n");
4741                 }
4742         }
4743
4744         xfer_cnt = le32_to_cpu(mpi_reply->TransferCount);
4745
4746         /* In case of bogus fw or device, we could end up having
4747          * unaligned partial completion. We can force alignment here,
4748          * then scsi-ml does not need to handle this misbehavior.
4749          */
4750         sector_sz = scmd->device->sector_size;
4751         if (unlikely(!blk_rq_is_passthrough(scmd->request) && sector_sz &&
4752                      xfer_cnt % sector_sz)) {
4753                 sdev_printk(KERN_INFO, scmd->device,
4754                     "unaligned partial completion avoided (xfer_cnt=%u, sector_sz=%u)\n",
4755                             xfer_cnt, sector_sz);
4756                 xfer_cnt = round_down(xfer_cnt, sector_sz);
4757         }
4758
4759         scsi_set_resid(scmd, scsi_bufflen(scmd) - xfer_cnt);
4760         if (ioc_status & MPI2_IOCSTATUS_FLAG_LOG_INFO_AVAILABLE)
4761                 log_info =  le32_to_cpu(mpi_reply->IOCLogInfo);
4762         else
4763                 log_info = 0;
4764         ioc_status &= MPI2_IOCSTATUS_MASK;
4765         scsi_status = mpi_reply->SCSIStatus;
4766
4767         if (ioc_status == MPI2_IOCSTATUS_SCSI_DATA_UNDERRUN && xfer_cnt == 0 &&
4768             (scsi_status == MPI2_SCSI_STATUS_BUSY ||
4769              scsi_status == MPI2_SCSI_STATUS_RESERVATION_CONFLICT ||
4770              scsi_status == MPI2_SCSI_STATUS_TASK_SET_FULL)) {
4771                 ioc_status = MPI2_IOCSTATUS_SUCCESS;
4772         }
4773
4774         if (scsi_state & MPI2_SCSI_STATE_AUTOSENSE_VALID) {
4775                 struct sense_info data;
4776                 const void *sense_data = mpt3sas_base_get_sense_buffer(ioc,
4777                     smid);
4778                 u32 sz = min_t(u32, SCSI_SENSE_BUFFERSIZE,
4779                     le32_to_cpu(mpi_reply->SenseCount));
4780                 memcpy(scmd->sense_buffer, sense_data, sz);
4781                 _scsih_normalize_sense(scmd->sense_buffer, &data);
4782                 /* failure prediction threshold exceeded */
4783                 if (data.asc == 0x5D)
4784                         _scsih_smart_predicted_fault(ioc,
4785                             le16_to_cpu(mpi_reply->DevHandle));
4786                 mpt3sas_trigger_scsi(ioc, data.skey, data.asc, data.ascq);
4787
4788                 if ((ioc->logging_level & MPT_DEBUG_REPLY) &&
4789                      ((scmd->sense_buffer[2] == UNIT_ATTENTION) ||
4790                      (scmd->sense_buffer[2] == MEDIUM_ERROR) ||
4791                      (scmd->sense_buffer[2] == HARDWARE_ERROR)))
4792                         _scsih_scsi_ioc_info(ioc, scmd, mpi_reply, smid);
4793         }
4794         switch (ioc_status) {
4795         case MPI2_IOCSTATUS_BUSY:
4796         case MPI2_IOCSTATUS_INSUFFICIENT_RESOURCES:
4797                 scmd->result = SAM_STAT_BUSY;
4798                 break;
4799
4800         case MPI2_IOCSTATUS_SCSI_DEVICE_NOT_THERE:
4801                 scmd->result = DID_NO_CONNECT << 16;
4802                 break;
4803
4804         case MPI2_IOCSTATUS_SCSI_IOC_TERMINATED:
4805                 if (sas_device_priv_data->block) {
4806                         scmd->result = DID_TRANSPORT_DISRUPTED << 16;
4807                         goto out;
4808                 }
4809                 if (log_info == 0x31110630) {
4810                         if (scmd->retries > 2) {
4811                                 scmd->result = DID_NO_CONNECT << 16;
4812                                 scsi_device_set_state(scmd->device,
4813                                     SDEV_OFFLINE);
4814                         } else {
4815                                 scmd->result = DID_SOFT_ERROR << 16;
4816                                 scmd->device->expecting_cc_ua = 1;
4817                         }
4818                         break;
4819                 } else if (log_info == VIRTUAL_IO_FAILED_RETRY) {
4820                         scmd->result = DID_RESET << 16;
4821                         break;
4822                 }
4823                 scmd->result = DID_SOFT_ERROR << 16;
4824                 break;
4825         case MPI2_IOCSTATUS_SCSI_TASK_TERMINATED:
4826         case MPI2_IOCSTATUS_SCSI_EXT_TERMINATED:
4827                 scmd->result = DID_RESET << 16;
4828                 break;
4829
4830         case MPI2_IOCSTATUS_SCSI_RESIDUAL_MISMATCH:
4831                 if ((xfer_cnt == 0) || (scmd->underflow > xfer_cnt))
4832                         scmd->result = DID_SOFT_ERROR << 16;
4833                 else
4834                         scmd->result = (DID_OK << 16) | scsi_status;
4835                 break;
4836
4837         case MPI2_IOCSTATUS_SCSI_DATA_UNDERRUN:
4838                 scmd->result = (DID_OK << 16) | scsi_status;
4839
4840                 if ((scsi_state & MPI2_SCSI_STATE_AUTOSENSE_VALID))
4841                         break;
4842
4843                 if (xfer_cnt < scmd->underflow) {
4844                         if (scsi_status == SAM_STAT_BUSY)
4845                                 scmd->result = SAM_STAT_BUSY;
4846                         else
4847                                 scmd->result = DID_SOFT_ERROR << 16;
4848                 } else if (scsi_state & (MPI2_SCSI_STATE_AUTOSENSE_FAILED |
4849                      MPI2_SCSI_STATE_NO_SCSI_STATUS))
4850                         scmd->result = DID_SOFT_ERROR << 16;
4851                 else if (scsi_state & MPI2_SCSI_STATE_TERMINATED)
4852                         scmd->result = DID_RESET << 16;
4853                 else if (!xfer_cnt && scmd->cmnd[0] == REPORT_LUNS) {
4854                         mpi_reply->SCSIState = MPI2_SCSI_STATE_AUTOSENSE_VALID;
4855                         mpi_reply->SCSIStatus = SAM_STAT_CHECK_CONDITION;
4856                         scmd->result = (DRIVER_SENSE << 24) |
4857                             SAM_STAT_CHECK_CONDITION;
4858                         scmd->sense_buffer[0] = 0x70;
4859                         scmd->sense_buffer[2] = ILLEGAL_REQUEST;
4860                         scmd->sense_buffer[12] = 0x20;
4861                         scmd->sense_buffer[13] = 0;
4862                 }
4863                 break;
4864
4865         case MPI2_IOCSTATUS_SCSI_DATA_OVERRUN:
4866                 scsi_set_resid(scmd, 0);
4867         case MPI2_IOCSTATUS_SCSI_RECOVERED_ERROR:
4868         case MPI2_IOCSTATUS_SUCCESS:
4869                 scmd->result = (DID_OK << 16) | scsi_status;
4870                 if (response_code ==
4871                     MPI2_SCSITASKMGMT_RSP_INVALID_FRAME ||
4872                     (scsi_state & (MPI2_SCSI_STATE_AUTOSENSE_FAILED |
4873                      MPI2_SCSI_STATE_NO_SCSI_STATUS)))
4874                         scmd->result = DID_SOFT_ERROR << 16;
4875                 else if (scsi_state & MPI2_SCSI_STATE_TERMINATED)
4876                         scmd->result = DID_RESET << 16;
4877                 break;
4878
4879         case MPI2_IOCSTATUS_EEDP_GUARD_ERROR:
4880         case MPI2_IOCSTATUS_EEDP_REF_TAG_ERROR:
4881         case MPI2_IOCSTATUS_EEDP_APP_TAG_ERROR:
4882                 _scsih_eedp_error_handling(scmd, ioc_status);
4883                 break;
4884
4885         case MPI2_IOCSTATUS_SCSI_PROTOCOL_ERROR:
4886         case MPI2_IOCSTATUS_INVALID_FUNCTION:
4887         case MPI2_IOCSTATUS_INVALID_SGL:
4888         case MPI2_IOCSTATUS_INTERNAL_ERROR:
4889         case MPI2_IOCSTATUS_INVALID_FIELD:
4890         case MPI2_IOCSTATUS_INVALID_STATE:
4891         case MPI2_IOCSTATUS_SCSI_IO_DATA_ERROR:
4892         case MPI2_IOCSTATUS_SCSI_TASK_MGMT_FAILED:
4893         case MPI2_IOCSTATUS_INSUFFICIENT_POWER:
4894         default:
4895                 scmd->result = DID_SOFT_ERROR << 16;
4896                 break;
4897
4898         }
4899
4900         if (scmd->result && (ioc->logging_level & MPT_DEBUG_REPLY))
4901                 _scsih_scsi_ioc_info(ioc , scmd, mpi_reply, smid);
4902
4903  out:
4904
4905         scsi_dma_unmap(scmd);
4906
4907         scmd->scsi_done(scmd);
4908         return 1;
4909 }
4910
4911 /**
4912  * _scsih_sas_host_refresh - refreshing sas host object contents
4913  * @ioc: per adapter object
4914  * Context: user
4915  *
4916  * During port enable, fw will send topology events for every device. Its
4917  * possible that the handles may change from the previous setting, so this
4918  * code keeping handles updating if changed.
4919  *
4920  * Return nothing.
4921  */
4922 static void
4923 _scsih_sas_host_refresh(struct MPT3SAS_ADAPTER *ioc)
4924 {
4925         u16 sz;
4926         u16 ioc_status;
4927         int i;
4928         Mpi2ConfigReply_t mpi_reply;
4929         Mpi2SasIOUnitPage0_t *sas_iounit_pg0 = NULL;
4930         u16 attached_handle;
4931         u8 link_rate;
4932
4933         dtmprintk(ioc, pr_info(MPT3SAS_FMT
4934             "updating handles for sas_host(0x%016llx)\n",
4935             ioc->name, (unsigned long long)ioc->sas_hba.sas_address));
4936
4937         sz = offsetof(Mpi2SasIOUnitPage0_t, PhyData) + (ioc->sas_hba.num_phys
4938             * sizeof(Mpi2SasIOUnit0PhyData_t));
4939         sas_iounit_pg0 = kzalloc(sz, GFP_KERNEL);
4940         if (!sas_iounit_pg0) {
4941                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
4942                     ioc->name, __FILE__, __LINE__, __func__);
4943                 return;
4944         }
4945
4946         if ((mpt3sas_config_get_sas_iounit_pg0(ioc, &mpi_reply,
4947             sas_iounit_pg0, sz)) != 0)
4948                 goto out;
4949         ioc_status = le16_to_cpu(mpi_reply.IOCStatus) & MPI2_IOCSTATUS_MASK;
4950         if (ioc_status != MPI2_IOCSTATUS_SUCCESS)
4951                 goto out;
4952         for (i = 0; i < ioc->sas_hba.num_phys ; i++) {
4953                 link_rate = sas_iounit_pg0->PhyData[i].NegotiatedLinkRate >> 4;
4954                 if (i == 0)
4955                         ioc->sas_hba.handle = le16_to_cpu(sas_iounit_pg0->
4956                             PhyData[0].ControllerDevHandle);
4957                 ioc->sas_hba.phy[i].handle = ioc->sas_hba.handle;
4958                 attached_handle = le16_to_cpu(sas_iounit_pg0->PhyData[i].
4959                     AttachedDevHandle);
4960                 if (attached_handle && link_rate < MPI2_SAS_NEG_LINK_RATE_1_5)
4961                         link_rate = MPI2_SAS_NEG_LINK_RATE_1_5;
4962                 mpt3sas_transport_update_links(ioc, ioc->sas_hba.sas_address,
4963                     attached_handle, i, link_rate);
4964         }
4965  out:
4966         kfree(sas_iounit_pg0);
4967 }
4968
4969 /**
4970  * _scsih_sas_host_add - create sas host object
4971  * @ioc: per adapter object
4972  *
4973  * Creating host side data object, stored in ioc->sas_hba
4974  *
4975  * Return nothing.
4976  */
4977 static void
4978 _scsih_sas_host_add(struct MPT3SAS_ADAPTER *ioc)
4979 {
4980         int i;
4981         Mpi2ConfigReply_t mpi_reply;
4982         Mpi2SasIOUnitPage0_t *sas_iounit_pg0 = NULL;
4983         Mpi2SasIOUnitPage1_t *sas_iounit_pg1 = NULL;
4984         Mpi2SasPhyPage0_t phy_pg0;
4985         Mpi2SasDevicePage0_t sas_device_pg0;
4986         Mpi2SasEnclosurePage0_t enclosure_pg0;
4987         u16 ioc_status;
4988         u16 sz;
4989         u8 device_missing_delay;
4990         u8 num_phys;
4991
4992         mpt3sas_config_get_number_hba_phys(ioc, &num_phys);
4993         if (!num_phys) {
4994                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
4995                     ioc->name, __FILE__, __LINE__, __func__);
4996                 return;
4997         }
4998         ioc->sas_hba.phy = kcalloc(num_phys,
4999             sizeof(struct _sas_phy), GFP_KERNEL);
5000         if (!ioc->sas_hba.phy) {
5001                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
5002                     ioc->name, __FILE__, __LINE__, __func__);
5003                 goto out;
5004         }
5005         ioc->sas_hba.num_phys = num_phys;
5006
5007         /* sas_iounit page 0 */
5008         sz = offsetof(Mpi2SasIOUnitPage0_t, PhyData) + (ioc->sas_hba.num_phys *
5009             sizeof(Mpi2SasIOUnit0PhyData_t));
5010         sas_iounit_pg0 = kzalloc(sz, GFP_KERNEL);
5011         if (!sas_iounit_pg0) {
5012                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
5013                     ioc->name, __FILE__, __LINE__, __func__);
5014                 return;
5015         }
5016         if ((mpt3sas_config_get_sas_iounit_pg0(ioc, &mpi_reply,
5017             sas_iounit_pg0, sz))) {
5018                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
5019                     ioc->name, __FILE__, __LINE__, __func__);
5020                 goto out;
5021         }
5022         ioc_status = le16_to_cpu(mpi_reply.IOCStatus) &
5023             MPI2_IOCSTATUS_MASK;
5024         if (ioc_status != MPI2_IOCSTATUS_SUCCESS) {
5025                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
5026                     ioc->name, __FILE__, __LINE__, __func__);
5027                 goto out;
5028         }
5029
5030         /* sas_iounit page 1 */
5031         sz = offsetof(Mpi2SasIOUnitPage1_t, PhyData) + (ioc->sas_hba.num_phys *
5032             sizeof(Mpi2SasIOUnit1PhyData_t));
5033         sas_iounit_pg1 = kzalloc(sz, GFP_KERNEL);
5034         if (!sas_iounit_pg1) {
5035                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
5036                     ioc->name, __FILE__, __LINE__, __func__);
5037                 goto out;
5038         }
5039         if ((mpt3sas_config_get_sas_iounit_pg1(ioc, &mpi_reply,
5040             sas_iounit_pg1, sz))) {
5041                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
5042                     ioc->name, __FILE__, __LINE__, __func__);
5043                 goto out;
5044         }
5045         ioc_status = le16_to_cpu(mpi_reply.IOCStatus) &
5046             MPI2_IOCSTATUS_MASK;
5047         if (ioc_status != MPI2_IOCSTATUS_SUCCESS) {
5048                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
5049                     ioc->name, __FILE__, __LINE__, __func__);
5050                 goto out;
5051         }
5052
5053         ioc->io_missing_delay =
5054             sas_iounit_pg1->IODeviceMissingDelay;
5055         device_missing_delay =
5056             sas_iounit_pg1->ReportDeviceMissingDelay;
5057         if (device_missing_delay & MPI2_SASIOUNIT1_REPORT_MISSING_UNIT_16)
5058                 ioc->device_missing_delay = (device_missing_delay &
5059                     MPI2_SASIOUNIT1_REPORT_MISSING_TIMEOUT_MASK) * 16;
5060         else
5061                 ioc->device_missing_delay = device_missing_delay &
5062                     MPI2_SASIOUNIT1_REPORT_MISSING_TIMEOUT_MASK;
5063
5064         ioc->sas_hba.parent_dev = &ioc->shost->shost_gendev;
5065         for (i = 0; i < ioc->sas_hba.num_phys ; i++) {
5066                 if ((mpt3sas_config_get_phy_pg0(ioc, &mpi_reply, &phy_pg0,
5067                     i))) {
5068                         pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
5069                             ioc->name, __FILE__, __LINE__, __func__);
5070                         goto out;
5071                 }
5072                 ioc_status = le16_to_cpu(mpi_reply.IOCStatus) &
5073                     MPI2_IOCSTATUS_MASK;
5074                 if (ioc_status != MPI2_IOCSTATUS_SUCCESS) {
5075                         pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
5076                             ioc->name, __FILE__, __LINE__, __func__);
5077                         goto out;
5078                 }
5079
5080                 if (i == 0)
5081                         ioc->sas_hba.handle = le16_to_cpu(sas_iounit_pg0->
5082                             PhyData[0].ControllerDevHandle);
5083                 ioc->sas_hba.phy[i].handle = ioc->sas_hba.handle;
5084                 ioc->sas_hba.phy[i].phy_id = i;
5085                 mpt3sas_transport_add_host_phy(ioc, &ioc->sas_hba.phy[i],
5086                     phy_pg0, ioc->sas_hba.parent_dev);
5087         }
5088         if ((mpt3sas_config_get_sas_device_pg0(ioc, &mpi_reply, &sas_device_pg0,
5089             MPI2_SAS_DEVICE_PGAD_FORM_HANDLE, ioc->sas_hba.handle))) {
5090                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
5091                     ioc->name, __FILE__, __LINE__, __func__);
5092                 goto out;
5093         }
5094         ioc->sas_hba.enclosure_handle =
5095             le16_to_cpu(sas_device_pg0.EnclosureHandle);
5096         ioc->sas_hba.sas_address = le64_to_cpu(sas_device_pg0.SASAddress);
5097         pr_info(MPT3SAS_FMT
5098                 "host_add: handle(0x%04x), sas_addr(0x%016llx), phys(%d)\n",
5099                 ioc->name, ioc->sas_hba.handle,
5100             (unsigned long long) ioc->sas_hba.sas_address,
5101             ioc->sas_hba.num_phys) ;
5102
5103         if (ioc->sas_hba.enclosure_handle) {
5104                 if (!(mpt3sas_config_get_enclosure_pg0(ioc, &mpi_reply,
5105                     &enclosure_pg0, MPI2_SAS_ENCLOS_PGAD_FORM_HANDLE,
5106                    ioc->sas_hba.enclosure_handle)))
5107                         ioc->sas_hba.enclosure_logical_id =
5108                             le64_to_cpu(enclosure_pg0.EnclosureLogicalID);
5109         }
5110
5111  out:
5112         kfree(sas_iounit_pg1);
5113         kfree(sas_iounit_pg0);
5114 }
5115
5116 /**
5117  * _scsih_expander_add -  creating expander object
5118  * @ioc: per adapter object
5119  * @handle: expander handle
5120  *
5121  * Creating expander object, stored in ioc->sas_expander_list.
5122  *
5123  * Return 0 for success, else error.
5124  */
5125 static int
5126 _scsih_expander_add(struct MPT3SAS_ADAPTER *ioc, u16 handle)
5127 {
5128         struct _sas_node *sas_expander;
5129         Mpi2ConfigReply_t mpi_reply;
5130         Mpi2ExpanderPage0_t expander_pg0;
5131         Mpi2ExpanderPage1_t expander_pg1;
5132         Mpi2SasEnclosurePage0_t enclosure_pg0;
5133         u32 ioc_status;
5134         u16 parent_handle;
5135         u64 sas_address, sas_address_parent = 0;
5136         int i;
5137         unsigned long flags;
5138         struct _sas_port *mpt3sas_port = NULL;
5139
5140         int rc = 0;
5141
5142         if (!handle)
5143                 return -1;
5144
5145         if (ioc->shost_recovery || ioc->pci_error_recovery)
5146                 return -1;
5147
5148         if ((mpt3sas_config_get_expander_pg0(ioc, &mpi_reply, &expander_pg0,
5149             MPI2_SAS_EXPAND_PGAD_FORM_HNDL, handle))) {
5150                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
5151                     ioc->name, __FILE__, __LINE__, __func__);
5152                 return -1;
5153         }
5154
5155         ioc_status = le16_to_cpu(mpi_reply.IOCStatus) &
5156             MPI2_IOCSTATUS_MASK;
5157         if (ioc_status != MPI2_IOCSTATUS_SUCCESS) {
5158                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
5159                     ioc->name, __FILE__, __LINE__, __func__);
5160                 return -1;
5161         }
5162
5163         /* handle out of order topology events */
5164         parent_handle = le16_to_cpu(expander_pg0.ParentDevHandle);
5165         if (_scsih_get_sas_address(ioc, parent_handle, &sas_address_parent)
5166             != 0) {
5167                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
5168                     ioc->name, __FILE__, __LINE__, __func__);
5169                 return -1;
5170         }
5171         if (sas_address_parent != ioc->sas_hba.sas_address) {
5172                 spin_lock_irqsave(&ioc->sas_node_lock, flags);
5173                 sas_expander = mpt3sas_scsih_expander_find_by_sas_address(ioc,
5174                     sas_address_parent);
5175                 spin_unlock_irqrestore(&ioc->sas_node_lock, flags);
5176                 if (!sas_expander) {
5177                         rc = _scsih_expander_add(ioc, parent_handle);
5178                         if (rc != 0)
5179                                 return rc;
5180                 }
5181         }
5182
5183         spin_lock_irqsave(&ioc->sas_node_lock, flags);
5184         sas_address = le64_to_cpu(expander_pg0.SASAddress);
5185         sas_expander = mpt3sas_scsih_expander_find_by_sas_address(ioc,
5186             sas_address);
5187         spin_unlock_irqrestore(&ioc->sas_node_lock, flags);
5188
5189         if (sas_expander)
5190                 return 0;
5191
5192         sas_expander = kzalloc(sizeof(struct _sas_node),
5193             GFP_KERNEL);
5194         if (!sas_expander) {
5195                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
5196                     ioc->name, __FILE__, __LINE__, __func__);
5197                 return -1;
5198         }
5199
5200         sas_expander->handle = handle;
5201         sas_expander->num_phys = expander_pg0.NumPhys;
5202         sas_expander->sas_address_parent = sas_address_parent;
5203         sas_expander->sas_address = sas_address;
5204
5205         pr_info(MPT3SAS_FMT "expander_add: handle(0x%04x)," \
5206             " parent(0x%04x), sas_addr(0x%016llx), phys(%d)\n", ioc->name,
5207             handle, parent_handle, (unsigned long long)
5208             sas_expander->sas_address, sas_expander->num_phys);
5209
5210         if (!sas_expander->num_phys)
5211                 goto out_fail;
5212         sas_expander->phy = kcalloc(sas_expander->num_phys,
5213             sizeof(struct _sas_phy), GFP_KERNEL);
5214         if (!sas_expander->phy) {
5215                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
5216                     ioc->name, __FILE__, __LINE__, __func__);
5217                 rc = -1;
5218                 goto out_fail;
5219         }
5220
5221         INIT_LIST_HEAD(&sas_expander->sas_port_list);
5222         mpt3sas_port = mpt3sas_transport_port_add(ioc, handle,
5223             sas_address_parent);
5224         if (!mpt3sas_port) {
5225                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
5226                     ioc->name, __FILE__, __LINE__, __func__);
5227                 rc = -1;
5228                 goto out_fail;
5229         }
5230         sas_expander->parent_dev = &mpt3sas_port->rphy->dev;
5231
5232         for (i = 0 ; i < sas_expander->num_phys ; i++) {
5233                 if ((mpt3sas_config_get_expander_pg1(ioc, &mpi_reply,
5234                     &expander_pg1, i, handle))) {
5235                         pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
5236                             ioc->name, __FILE__, __LINE__, __func__);
5237                         rc = -1;
5238                         goto out_fail;
5239                 }
5240                 sas_expander->phy[i].handle = handle;
5241                 sas_expander->phy[i].phy_id = i;
5242
5243                 if ((mpt3sas_transport_add_expander_phy(ioc,
5244                     &sas_expander->phy[i], expander_pg1,
5245                     sas_expander->parent_dev))) {
5246                         pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
5247                             ioc->name, __FILE__, __LINE__, __func__);
5248                         rc = -1;
5249                         goto out_fail;
5250                 }
5251         }
5252
5253         if (sas_expander->enclosure_handle) {
5254                 if (!(mpt3sas_config_get_enclosure_pg0(ioc, &mpi_reply,
5255                     &enclosure_pg0, MPI2_SAS_ENCLOS_PGAD_FORM_HANDLE,
5256                    sas_expander->enclosure_handle)))
5257                         sas_expander->enclosure_logical_id =
5258                             le64_to_cpu(enclosure_pg0.EnclosureLogicalID);
5259         }
5260
5261         _scsih_expander_node_add(ioc, sas_expander);
5262          return 0;
5263
5264  out_fail:
5265
5266         if (mpt3sas_port)
5267                 mpt3sas_transport_port_remove(ioc, sas_expander->sas_address,
5268                     sas_address_parent);
5269         kfree(sas_expander);
5270         return rc;
5271 }
5272
5273 /**
5274  * mpt3sas_expander_remove - removing expander object
5275  * @ioc: per adapter object
5276  * @sas_address: expander sas_address
5277  *
5278  * Return nothing.
5279  */
5280 void
5281 mpt3sas_expander_remove(struct MPT3SAS_ADAPTER *ioc, u64 sas_address)
5282 {
5283         struct _sas_node *sas_expander;
5284         unsigned long flags;
5285
5286         if (ioc->shost_recovery)
5287                 return;
5288
5289         spin_lock_irqsave(&ioc->sas_node_lock, flags);
5290         sas_expander = mpt3sas_scsih_expander_find_by_sas_address(ioc,
5291             sas_address);
5292         if (sas_expander)
5293                 list_del(&sas_expander->list);
5294         spin_unlock_irqrestore(&ioc->sas_node_lock, flags);
5295         if (sas_expander)
5296                 _scsih_expander_node_remove(ioc, sas_expander);
5297 }
5298
5299 /**
5300  * _scsih_done -  internal SCSI_IO callback handler.
5301  * @ioc: per adapter object
5302  * @smid: system request message index
5303  * @msix_index: MSIX table index supplied by the OS
5304  * @reply: reply message frame(lower 32bit addr)
5305  *
5306  * Callback handler when sending internal generated SCSI_IO.
5307  * The callback index passed is `ioc->scsih_cb_idx`
5308  *
5309  * Return 1 meaning mf should be freed from _base_interrupt
5310  *        0 means the mf is freed from this function.
5311  */
5312 static u8
5313 _scsih_done(struct MPT3SAS_ADAPTER *ioc, u16 smid, u8 msix_index, u32 reply)
5314 {
5315         MPI2DefaultReply_t *mpi_reply;
5316
5317         mpi_reply =  mpt3sas_base_get_reply_virt_addr(ioc, reply);
5318         if (ioc->scsih_cmds.status == MPT3_CMD_NOT_USED)
5319                 return 1;
5320         if (ioc->scsih_cmds.smid != smid)
5321                 return 1;
5322         ioc->scsih_cmds.status |= MPT3_CMD_COMPLETE;
5323         if (mpi_reply) {
5324                 memcpy(ioc->scsih_cmds.reply, mpi_reply,
5325                     mpi_reply->MsgLength*4);
5326                 ioc->scsih_cmds.status |= MPT3_CMD_REPLY_VALID;
5327         }
5328         ioc->scsih_cmds.status &= ~MPT3_CMD_PENDING;
5329         complete(&ioc->scsih_cmds.done);
5330         return 1;
5331 }
5332
5333
5334
5335
5336 #define MPT3_MAX_LUNS (255)
5337
5338
5339 /**
5340  * _scsih_check_access_status - check access flags
5341  * @ioc: per adapter object
5342  * @sas_address: sas address
5343  * @handle: sas device handle
5344  * @access_flags: errors returned during discovery of the device
5345  *
5346  * Return 0 for success, else failure
5347  */
5348 static u8
5349 _scsih_check_access_status(struct MPT3SAS_ADAPTER *ioc, u64 sas_address,
5350         u16 handle, u8 access_status)
5351 {
5352         u8 rc = 1;
5353         char *desc = NULL;
5354
5355         switch (access_status) {
5356         case MPI2_SAS_DEVICE0_ASTATUS_NO_ERRORS:
5357         case MPI2_SAS_DEVICE0_ASTATUS_SATA_NEEDS_INITIALIZATION:
5358                 rc = 0;
5359                 break;
5360         case MPI2_SAS_DEVICE0_ASTATUS_SATA_CAPABILITY_FAILED:
5361                 desc = "sata capability failed";
5362                 break;
5363         case MPI2_SAS_DEVICE0_ASTATUS_SATA_AFFILIATION_CONFLICT:
5364                 desc = "sata affiliation conflict";
5365                 break;
5366         case MPI2_SAS_DEVICE0_ASTATUS_ROUTE_NOT_ADDRESSABLE:
5367                 desc = "route not addressable";
5368                 break;
5369         case MPI2_SAS_DEVICE0_ASTATUS_SMP_ERROR_NOT_ADDRESSABLE:
5370                 desc = "smp error not addressable";
5371                 break;
5372         case MPI2_SAS_DEVICE0_ASTATUS_DEVICE_BLOCKED:
5373                 desc = "device blocked";
5374                 break;
5375         case MPI2_SAS_DEVICE0_ASTATUS_SATA_INIT_FAILED:
5376         case MPI2_SAS_DEVICE0_ASTATUS_SIF_UNKNOWN:
5377         case MPI2_SAS_DEVICE0_ASTATUS_SIF_AFFILIATION_CONFLICT:
5378         case MPI2_SAS_DEVICE0_ASTATUS_SIF_DIAG:
5379         case MPI2_SAS_DEVICE0_ASTATUS_SIF_IDENTIFICATION:
5380         case MPI2_SAS_DEVICE0_ASTATUS_SIF_CHECK_POWER:
5381         case MPI2_SAS_DEVICE0_ASTATUS_SIF_PIO_SN:
5382         case MPI2_SAS_DEVICE0_ASTATUS_SIF_MDMA_SN:
5383         case MPI2_SAS_DEVICE0_ASTATUS_SIF_UDMA_SN:
5384         case MPI2_SAS_DEVICE0_ASTATUS_SIF_ZONING_VIOLATION:
5385         case MPI2_SAS_DEVICE0_ASTATUS_SIF_NOT_ADDRESSABLE:
5386         case MPI2_SAS_DEVICE0_ASTATUS_SIF_MAX:
5387                 desc = "sata initialization failed";
5388                 break;
5389         default:
5390                 desc = "unknown";
5391                 break;
5392         }
5393
5394         if (!rc)
5395                 return 0;
5396
5397         pr_err(MPT3SAS_FMT
5398                 "discovery errors(%s): sas_address(0x%016llx), handle(0x%04x)\n",
5399                 ioc->name, desc, (unsigned long long)sas_address, handle);
5400         return rc;
5401 }
5402
5403 /**
5404  * _scsih_check_device - checking device responsiveness
5405  * @ioc: per adapter object
5406  * @parent_sas_address: sas address of parent expander or sas host
5407  * @handle: attached device handle
5408  * @phy_numberv: phy number
5409  * @link_rate: new link rate
5410  *
5411  * Returns nothing.
5412  */
5413 static void
5414 _scsih_check_device(struct MPT3SAS_ADAPTER *ioc,
5415         u64 parent_sas_address, u16 handle, u8 phy_number, u8 link_rate)
5416 {
5417         Mpi2ConfigReply_t mpi_reply;
5418         Mpi2SasDevicePage0_t sas_device_pg0;
5419         struct _sas_device *sas_device;
5420         u32 ioc_status;
5421         unsigned long flags;
5422         u64 sas_address;
5423         struct scsi_target *starget;
5424         struct MPT3SAS_TARGET *sas_target_priv_data;
5425         u32 device_info;
5426
5427
5428         if ((mpt3sas_config_get_sas_device_pg0(ioc, &mpi_reply, &sas_device_pg0,
5429             MPI2_SAS_DEVICE_PGAD_FORM_HANDLE, handle)))
5430                 return;
5431
5432         ioc_status = le16_to_cpu(mpi_reply.IOCStatus) & MPI2_IOCSTATUS_MASK;
5433         if (ioc_status != MPI2_IOCSTATUS_SUCCESS)
5434                 return;
5435
5436         /* wide port handling ~ we need only handle device once for the phy that
5437          * is matched in sas device page zero
5438          */
5439         if (phy_number != sas_device_pg0.PhyNum)
5440                 return;
5441
5442         /* check if this is end device */
5443         device_info = le32_to_cpu(sas_device_pg0.DeviceInfo);
5444         if (!(_scsih_is_end_device(device_info)))
5445                 return;
5446
5447         spin_lock_irqsave(&ioc->sas_device_lock, flags);
5448         sas_address = le64_to_cpu(sas_device_pg0.SASAddress);
5449         sas_device = __mpt3sas_get_sdev_by_addr(ioc,
5450             sas_address);
5451
5452         if (!sas_device)
5453                 goto out_unlock;
5454
5455         if (unlikely(sas_device->handle != handle)) {
5456                 starget = sas_device->starget;
5457                 sas_target_priv_data = starget->hostdata;
5458                 starget_printk(KERN_INFO, starget,
5459                         "handle changed from(0x%04x) to (0x%04x)!!!\n",
5460                         sas_device->handle, handle);
5461                 sas_target_priv_data->handle = handle;
5462                 sas_device->handle = handle;
5463                 if (le16_to_cpu(sas_device_pg0.Flags) &
5464                      MPI2_SAS_DEVICE0_FLAGS_ENCL_LEVEL_VALID) {
5465                         sas_device->enclosure_level =
5466                                 sas_device_pg0.EnclosureLevel;
5467                         memcpy(sas_device->connector_name,
5468                                 sas_device_pg0.ConnectorName, 4);
5469                         sas_device->connector_name[4] = '\0';
5470                 } else {
5471                         sas_device->enclosure_level = 0;
5472                         sas_device->connector_name[0] = '\0';
5473                 }
5474         }
5475
5476         /* check if device is present */
5477         if (!(le16_to_cpu(sas_device_pg0.Flags) &
5478             MPI2_SAS_DEVICE0_FLAGS_DEVICE_PRESENT)) {
5479                 pr_err(MPT3SAS_FMT
5480                         "device is not present handle(0x%04x), flags!!!\n",
5481                         ioc->name, handle);
5482                 goto out_unlock;
5483         }
5484
5485         /* check if there were any issues with discovery */
5486         if (_scsih_check_access_status(ioc, sas_address, handle,
5487             sas_device_pg0.AccessStatus))
5488                 goto out_unlock;
5489
5490         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
5491         _scsih_ublock_io_device(ioc, sas_address);
5492
5493         if (sas_device)
5494                 sas_device_put(sas_device);
5495         return;
5496
5497 out_unlock:
5498         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
5499         if (sas_device)
5500                 sas_device_put(sas_device);
5501 }
5502
5503 /**
5504  * _scsih_add_device -  creating sas device object
5505  * @ioc: per adapter object
5506  * @handle: sas device handle
5507  * @phy_num: phy number end device attached to
5508  * @is_pd: is this hidden raid component
5509  *
5510  * Creating end device object, stored in ioc->sas_device_list.
5511  *
5512  * Returns 0 for success, non-zero for failure.
5513  */
5514 static int
5515 _scsih_add_device(struct MPT3SAS_ADAPTER *ioc, u16 handle, u8 phy_num,
5516         u8 is_pd)
5517 {
5518         Mpi2ConfigReply_t mpi_reply;
5519         Mpi2SasDevicePage0_t sas_device_pg0;
5520         Mpi2SasEnclosurePage0_t enclosure_pg0;
5521         struct _sas_device *sas_device;
5522         u32 ioc_status;
5523         u64 sas_address;
5524         u32 device_info;
5525
5526         if ((mpt3sas_config_get_sas_device_pg0(ioc, &mpi_reply, &sas_device_pg0,
5527             MPI2_SAS_DEVICE_PGAD_FORM_HANDLE, handle))) {
5528                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
5529                     ioc->name, __FILE__, __LINE__, __func__);
5530                 return -1;
5531         }
5532
5533         ioc_status = le16_to_cpu(mpi_reply.IOCStatus) &
5534             MPI2_IOCSTATUS_MASK;
5535         if (ioc_status != MPI2_IOCSTATUS_SUCCESS) {
5536                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
5537                     ioc->name, __FILE__, __LINE__, __func__);
5538                 return -1;
5539         }
5540
5541         /* check if this is end device */
5542         device_info = le32_to_cpu(sas_device_pg0.DeviceInfo);
5543         if (!(_scsih_is_end_device(device_info)))
5544                 return -1;
5545         set_bit(handle, ioc->pend_os_device_add);
5546         sas_address = le64_to_cpu(sas_device_pg0.SASAddress);
5547
5548         /* check if device is present */
5549         if (!(le16_to_cpu(sas_device_pg0.Flags) &
5550             MPI2_SAS_DEVICE0_FLAGS_DEVICE_PRESENT)) {
5551                 pr_err(MPT3SAS_FMT "device is not present handle(0x04%x)!!!\n",
5552                         ioc->name, handle);
5553                 return -1;
5554         }
5555
5556         /* check if there were any issues with discovery */
5557         if (_scsih_check_access_status(ioc, sas_address, handle,
5558             sas_device_pg0.AccessStatus))
5559                 return -1;
5560
5561         sas_device = mpt3sas_get_sdev_by_addr(ioc,
5562                                         sas_address);
5563         if (sas_device) {
5564                 clear_bit(handle, ioc->pend_os_device_add);
5565                 sas_device_put(sas_device);
5566                 return -1;
5567         }
5568
5569         sas_device = kzalloc(sizeof(struct _sas_device),
5570             GFP_KERNEL);
5571         if (!sas_device) {
5572                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
5573                     ioc->name, __FILE__, __LINE__, __func__);
5574                 return 0;
5575         }
5576
5577         kref_init(&sas_device->refcount);
5578         sas_device->handle = handle;
5579         if (_scsih_get_sas_address(ioc,
5580             le16_to_cpu(sas_device_pg0.ParentDevHandle),
5581             &sas_device->sas_address_parent) != 0)
5582                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
5583                     ioc->name, __FILE__, __LINE__, __func__);
5584         sas_device->enclosure_handle =
5585             le16_to_cpu(sas_device_pg0.EnclosureHandle);
5586         if (sas_device->enclosure_handle != 0)
5587                 sas_device->slot =
5588                     le16_to_cpu(sas_device_pg0.Slot);
5589         sas_device->device_info = device_info;
5590         sas_device->sas_address = sas_address;
5591         sas_device->phy = sas_device_pg0.PhyNum;
5592         sas_device->fast_path = (le16_to_cpu(sas_device_pg0.Flags) &
5593             MPI25_SAS_DEVICE0_FLAGS_FAST_PATH_CAPABLE) ? 1 : 0;
5594
5595         if (le16_to_cpu(sas_device_pg0.Flags)
5596                 & MPI2_SAS_DEVICE0_FLAGS_ENCL_LEVEL_VALID) {
5597                 sas_device->enclosure_level =
5598                         sas_device_pg0.EnclosureLevel;
5599                 memcpy(sas_device->connector_name,
5600                         sas_device_pg0.ConnectorName, 4);
5601                 sas_device->connector_name[4] = '\0';
5602         } else {
5603                 sas_device->enclosure_level = 0;
5604                 sas_device->connector_name[0] = '\0';
5605         }
5606         /* get enclosure_logical_id */
5607         if (sas_device->enclosure_handle && !(mpt3sas_config_get_enclosure_pg0(
5608            ioc, &mpi_reply, &enclosure_pg0, MPI2_SAS_ENCLOS_PGAD_FORM_HANDLE,
5609            sas_device->enclosure_handle)))
5610                 sas_device->enclosure_logical_id =
5611                     le64_to_cpu(enclosure_pg0.EnclosureLogicalID);
5612
5613         /* get device name */
5614         sas_device->device_name = le64_to_cpu(sas_device_pg0.DeviceName);
5615
5616         if (ioc->wait_for_discovery_to_complete)
5617                 _scsih_sas_device_init_add(ioc, sas_device);
5618         else
5619                 _scsih_sas_device_add(ioc, sas_device);
5620
5621         sas_device_put(sas_device);
5622         return 0;
5623 }
5624
5625 /**
5626  * _scsih_remove_device -  removing sas device object
5627  * @ioc: per adapter object
5628  * @sas_device_delete: the sas_device object
5629  *
5630  * Return nothing.
5631  */
5632 static void
5633 _scsih_remove_device(struct MPT3SAS_ADAPTER *ioc,
5634         struct _sas_device *sas_device)
5635 {
5636         struct MPT3SAS_TARGET *sas_target_priv_data;
5637
5638         if ((ioc->pdev->subsystem_vendor == PCI_VENDOR_ID_IBM) &&
5639              (sas_device->pfa_led_on)) {
5640                 _scsih_turn_off_pfa_led(ioc, sas_device);
5641                 sas_device->pfa_led_on = 0;
5642         }
5643         dewtprintk(ioc, pr_info(MPT3SAS_FMT
5644                 "%s: enter: handle(0x%04x), sas_addr(0x%016llx)\n",
5645                 ioc->name, __func__,
5646             sas_device->handle, (unsigned long long)
5647             sas_device->sas_address));
5648         if (sas_device->enclosure_handle != 0)
5649                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
5650                     "%s: enter: enclosure logical id(0x%016llx), slot(%d)\n",
5651                     ioc->name, __func__,
5652                     (unsigned long long)sas_device->enclosure_logical_id,
5653                     sas_device->slot));
5654         if (sas_device->connector_name[0] != '\0')
5655                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
5656                   "%s: enter: enclosure level(0x%04x), connector name( %s)\n",
5657                   ioc->name, __func__,
5658                   sas_device->enclosure_level,
5659                   sas_device->connector_name));
5660
5661         if (sas_device->starget && sas_device->starget->hostdata) {
5662                 sas_target_priv_data = sas_device->starget->hostdata;
5663                 sas_target_priv_data->deleted = 1;
5664                 _scsih_ublock_io_device(ioc, sas_device->sas_address);
5665                 sas_target_priv_data->handle =
5666                      MPT3SAS_INVALID_DEVICE_HANDLE;
5667         }
5668
5669         if (!ioc->hide_drives)
5670                 mpt3sas_transport_port_remove(ioc,
5671                     sas_device->sas_address,
5672                     sas_device->sas_address_parent);
5673
5674         pr_info(MPT3SAS_FMT
5675                 "removing handle(0x%04x), sas_addr(0x%016llx)\n",
5676                 ioc->name, sas_device->handle,
5677             (unsigned long long) sas_device->sas_address);
5678         if (sas_device->enclosure_handle != 0)
5679                 pr_info(MPT3SAS_FMT
5680                   "removing : enclosure logical id(0x%016llx), slot(%d)\n",
5681                   ioc->name,
5682                   (unsigned long long)sas_device->enclosure_logical_id,
5683                   sas_device->slot);
5684         if (sas_device->connector_name[0] != '\0')
5685                 pr_info(MPT3SAS_FMT
5686                   "removing enclosure level(0x%04x), connector name( %s)\n",
5687                   ioc->name, sas_device->enclosure_level,
5688                   sas_device->connector_name);
5689
5690         dewtprintk(ioc, pr_info(MPT3SAS_FMT
5691                 "%s: exit: handle(0x%04x), sas_addr(0x%016llx)\n",
5692                 ioc->name, __func__,
5693                 sas_device->handle, (unsigned long long)
5694                 sas_device->sas_address));
5695         if (sas_device->enclosure_handle != 0)
5696                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
5697                     "%s: exit: enclosure logical id(0x%016llx), slot(%d)\n",
5698                     ioc->name, __func__,
5699                     (unsigned long long)sas_device->enclosure_logical_id,
5700                     sas_device->slot));
5701         if (sas_device->connector_name[0] != '\0')
5702                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
5703                     "%s: exit: enclosure level(0x%04x), connector name(%s)\n",
5704                     ioc->name, __func__, sas_device->enclosure_level,
5705                     sas_device->connector_name));
5706 }
5707
5708 /**
5709  * _scsih_sas_topology_change_event_debug - debug for topology event
5710  * @ioc: per adapter object
5711  * @event_data: event data payload
5712  * Context: user.
5713  */
5714 static void
5715 _scsih_sas_topology_change_event_debug(struct MPT3SAS_ADAPTER *ioc,
5716         Mpi2EventDataSasTopologyChangeList_t *event_data)
5717 {
5718         int i;
5719         u16 handle;
5720         u16 reason_code;
5721         u8 phy_number;
5722         char *status_str = NULL;
5723         u8 link_rate, prev_link_rate;
5724
5725         switch (event_data->ExpStatus) {
5726         case MPI2_EVENT_SAS_TOPO_ES_ADDED:
5727                 status_str = "add";
5728                 break;
5729         case MPI2_EVENT_SAS_TOPO_ES_NOT_RESPONDING:
5730                 status_str = "remove";
5731                 break;
5732         case MPI2_EVENT_SAS_TOPO_ES_RESPONDING:
5733         case 0:
5734                 status_str =  "responding";
5735                 break;
5736         case MPI2_EVENT_SAS_TOPO_ES_DELAY_NOT_RESPONDING:
5737                 status_str = "remove delay";
5738                 break;
5739         default:
5740                 status_str = "unknown status";
5741                 break;
5742         }
5743         pr_info(MPT3SAS_FMT "sas topology change: (%s)\n",
5744             ioc->name, status_str);
5745         pr_info("\thandle(0x%04x), enclosure_handle(0x%04x) " \
5746             "start_phy(%02d), count(%d)\n",
5747             le16_to_cpu(event_data->ExpanderDevHandle),
5748             le16_to_cpu(event_data->EnclosureHandle),
5749             event_data->StartPhyNum, event_data->NumEntries);
5750         for (i = 0; i < event_data->NumEntries; i++) {
5751                 handle = le16_to_cpu(event_data->PHY[i].AttachedDevHandle);
5752                 if (!handle)
5753                         continue;
5754                 phy_number = event_data->StartPhyNum + i;
5755                 reason_code = event_data->PHY[i].PhyStatus &
5756                     MPI2_EVENT_SAS_TOPO_RC_MASK;
5757                 switch (reason_code) {
5758                 case MPI2_EVENT_SAS_TOPO_RC_TARG_ADDED:
5759                         status_str = "target add";
5760                         break;
5761                 case MPI2_EVENT_SAS_TOPO_RC_TARG_NOT_RESPONDING:
5762                         status_str = "target remove";
5763                         break;
5764                 case MPI2_EVENT_SAS_TOPO_RC_DELAY_NOT_RESPONDING:
5765                         status_str = "delay target remove";
5766                         break;
5767                 case MPI2_EVENT_SAS_TOPO_RC_PHY_CHANGED:
5768                         status_str = "link rate change";
5769                         break;
5770                 case MPI2_EVENT_SAS_TOPO_RC_NO_CHANGE:
5771                         status_str = "target responding";
5772                         break;
5773                 default:
5774                         status_str = "unknown";
5775                         break;
5776                 }
5777                 link_rate = event_data->PHY[i].LinkRate >> 4;
5778                 prev_link_rate = event_data->PHY[i].LinkRate & 0xF;
5779                 pr_info("\tphy(%02d), attached_handle(0x%04x): %s:" \
5780                     " link rate: new(0x%02x), old(0x%02x)\n", phy_number,
5781                     handle, status_str, link_rate, prev_link_rate);
5782
5783         }
5784 }
5785
5786 /**
5787  * _scsih_sas_topology_change_event - handle topology changes
5788  * @ioc: per adapter object
5789  * @fw_event: The fw_event_work object
5790  * Context: user.
5791  *
5792  */
5793 static int
5794 _scsih_sas_topology_change_event(struct MPT3SAS_ADAPTER *ioc,
5795         struct fw_event_work *fw_event)
5796 {
5797         int i;
5798         u16 parent_handle, handle;
5799         u16 reason_code;
5800         u8 phy_number, max_phys;
5801         struct _sas_node *sas_expander;
5802         u64 sas_address;
5803         unsigned long flags;
5804         u8 link_rate, prev_link_rate;
5805         Mpi2EventDataSasTopologyChangeList_t *event_data =
5806                 (Mpi2EventDataSasTopologyChangeList_t *)
5807                 fw_event->event_data;
5808
5809         if (ioc->logging_level & MPT_DEBUG_EVENT_WORK_TASK)
5810                 _scsih_sas_topology_change_event_debug(ioc, event_data);
5811
5812         if (ioc->shost_recovery || ioc->remove_host || ioc->pci_error_recovery)
5813                 return 0;
5814
5815         if (!ioc->sas_hba.num_phys)
5816                 _scsih_sas_host_add(ioc);
5817         else
5818                 _scsih_sas_host_refresh(ioc);
5819
5820         if (fw_event->ignore) {
5821                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
5822                         "ignoring expander event\n", ioc->name));
5823                 return 0;
5824         }
5825
5826         parent_handle = le16_to_cpu(event_data->ExpanderDevHandle);
5827
5828         /* handle expander add */
5829         if (event_data->ExpStatus == MPI2_EVENT_SAS_TOPO_ES_ADDED)
5830                 if (_scsih_expander_add(ioc, parent_handle) != 0)
5831                         return 0;
5832
5833         spin_lock_irqsave(&ioc->sas_node_lock, flags);
5834         sas_expander = mpt3sas_scsih_expander_find_by_handle(ioc,
5835             parent_handle);
5836         if (sas_expander) {
5837                 sas_address = sas_expander->sas_address;
5838                 max_phys = sas_expander->num_phys;
5839         } else if (parent_handle < ioc->sas_hba.num_phys) {
5840                 sas_address = ioc->sas_hba.sas_address;
5841                 max_phys = ioc->sas_hba.num_phys;
5842         } else {
5843                 spin_unlock_irqrestore(&ioc->sas_node_lock, flags);
5844                 return 0;
5845         }
5846         spin_unlock_irqrestore(&ioc->sas_node_lock, flags);
5847
5848         /* handle siblings events */
5849         for (i = 0; i < event_data->NumEntries; i++) {
5850                 if (fw_event->ignore) {
5851                         dewtprintk(ioc, pr_info(MPT3SAS_FMT
5852                                 "ignoring expander event\n", ioc->name));
5853                         return 0;
5854                 }
5855                 if (ioc->remove_host || ioc->pci_error_recovery)
5856                         return 0;
5857                 phy_number = event_data->StartPhyNum + i;
5858                 if (phy_number >= max_phys)
5859                         continue;
5860                 reason_code = event_data->PHY[i].PhyStatus &
5861                     MPI2_EVENT_SAS_TOPO_RC_MASK;
5862                 if ((event_data->PHY[i].PhyStatus &
5863                     MPI2_EVENT_SAS_TOPO_PHYSTATUS_VACANT) && (reason_code !=
5864                     MPI2_EVENT_SAS_TOPO_RC_TARG_NOT_RESPONDING))
5865                                 continue;
5866                 handle = le16_to_cpu(event_data->PHY[i].AttachedDevHandle);
5867                 if (!handle)
5868                         continue;
5869                 link_rate = event_data->PHY[i].LinkRate >> 4;
5870                 prev_link_rate = event_data->PHY[i].LinkRate & 0xF;
5871                 switch (reason_code) {
5872                 case MPI2_EVENT_SAS_TOPO_RC_PHY_CHANGED:
5873
5874                         if (ioc->shost_recovery)
5875                                 break;
5876
5877                         if (link_rate == prev_link_rate)
5878                                 break;
5879
5880                         mpt3sas_transport_update_links(ioc, sas_address,
5881                             handle, phy_number, link_rate);
5882
5883                         if (link_rate < MPI2_SAS_NEG_LINK_RATE_1_5)
5884                                 break;
5885
5886                         _scsih_check_device(ioc, sas_address, handle,
5887                             phy_number, link_rate);
5888
5889                         if (!test_bit(handle, ioc->pend_os_device_add))
5890                                 break;
5891
5892
5893                 case MPI2_EVENT_SAS_TOPO_RC_TARG_ADDED:
5894
5895                         if (ioc->shost_recovery)
5896                                 break;
5897
5898                         mpt3sas_transport_update_links(ioc, sas_address,
5899                             handle, phy_number, link_rate);
5900
5901                         _scsih_add_device(ioc, handle, phy_number, 0);
5902
5903                         break;
5904                 case MPI2_EVENT_SAS_TOPO_RC_TARG_NOT_RESPONDING:
5905
5906                         _scsih_device_remove_by_handle(ioc, handle);
5907                         break;
5908                 }
5909         }
5910
5911         /* handle expander removal */
5912         if (event_data->ExpStatus == MPI2_EVENT_SAS_TOPO_ES_NOT_RESPONDING &&
5913             sas_expander)
5914                 mpt3sas_expander_remove(ioc, sas_address);
5915
5916         return 0;
5917 }
5918
5919 /**
5920  * _scsih_sas_device_status_change_event_debug - debug for device event
5921  * @event_data: event data payload
5922  * Context: user.
5923  *
5924  * Return nothing.
5925  */
5926 static void
5927 _scsih_sas_device_status_change_event_debug(struct MPT3SAS_ADAPTER *ioc,
5928         Mpi2EventDataSasDeviceStatusChange_t *event_data)
5929 {
5930         char *reason_str = NULL;
5931
5932         switch (event_data->ReasonCode) {
5933         case MPI2_EVENT_SAS_DEV_STAT_RC_SMART_DATA:
5934                 reason_str = "smart data";
5935                 break;
5936         case MPI2_EVENT_SAS_DEV_STAT_RC_UNSUPPORTED:
5937                 reason_str = "unsupported device discovered";
5938                 break;
5939         case MPI2_EVENT_SAS_DEV_STAT_RC_INTERNAL_DEVICE_RESET:
5940                 reason_str = "internal device reset";
5941                 break;
5942         case MPI2_EVENT_SAS_DEV_STAT_RC_TASK_ABORT_INTERNAL:
5943                 reason_str = "internal task abort";
5944                 break;
5945         case MPI2_EVENT_SAS_DEV_STAT_RC_ABORT_TASK_SET_INTERNAL:
5946                 reason_str = "internal task abort set";
5947                 break;
5948         case MPI2_EVENT_SAS_DEV_STAT_RC_CLEAR_TASK_SET_INTERNAL:
5949                 reason_str = "internal clear task set";
5950                 break;
5951         case MPI2_EVENT_SAS_DEV_STAT_RC_QUERY_TASK_INTERNAL:
5952                 reason_str = "internal query task";
5953                 break;
5954         case MPI2_EVENT_SAS_DEV_STAT_RC_SATA_INIT_FAILURE:
5955                 reason_str = "sata init failure";
5956                 break;
5957         case MPI2_EVENT_SAS_DEV_STAT_RC_CMP_INTERNAL_DEV_RESET:
5958                 reason_str = "internal device reset complete";
5959                 break;
5960         case MPI2_EVENT_SAS_DEV_STAT_RC_CMP_TASK_ABORT_INTERNAL:
5961                 reason_str = "internal task abort complete";
5962                 break;
5963         case MPI2_EVENT_SAS_DEV_STAT_RC_ASYNC_NOTIFICATION:
5964                 reason_str = "internal async notification";
5965                 break;
5966         case MPI2_EVENT_SAS_DEV_STAT_RC_EXPANDER_REDUCED_FUNCTIONALITY:
5967                 reason_str = "expander reduced functionality";
5968                 break;
5969         case MPI2_EVENT_SAS_DEV_STAT_RC_CMP_EXPANDER_REDUCED_FUNCTIONALITY:
5970                 reason_str = "expander reduced functionality complete";
5971                 break;
5972         default:
5973                 reason_str = "unknown reason";
5974                 break;
5975         }
5976         pr_info(MPT3SAS_FMT "device status change: (%s)\n"
5977             "\thandle(0x%04x), sas address(0x%016llx), tag(%d)",
5978             ioc->name, reason_str, le16_to_cpu(event_data->DevHandle),
5979             (unsigned long long)le64_to_cpu(event_data->SASAddress),
5980             le16_to_cpu(event_data->TaskTag));
5981         if (event_data->ReasonCode == MPI2_EVENT_SAS_DEV_STAT_RC_SMART_DATA)
5982                 pr_info(MPT3SAS_FMT ", ASC(0x%x), ASCQ(0x%x)\n", ioc->name,
5983                     event_data->ASC, event_data->ASCQ);
5984         pr_info("\n");
5985 }
5986
5987 /**
5988  * _scsih_sas_device_status_change_event - handle device status change
5989  * @ioc: per adapter object
5990  * @fw_event: The fw_event_work object
5991  * Context: user.
5992  *
5993  * Return nothing.
5994  */
5995 static void
5996 _scsih_sas_device_status_change_event(struct MPT3SAS_ADAPTER *ioc,
5997         struct fw_event_work *fw_event)
5998 {
5999         struct MPT3SAS_TARGET *target_priv_data;
6000         struct _sas_device *sas_device;
6001         u64 sas_address;
6002         unsigned long flags;
6003         Mpi2EventDataSasDeviceStatusChange_t *event_data =
6004                 (Mpi2EventDataSasDeviceStatusChange_t *)
6005                 fw_event->event_data;
6006
6007         if (ioc->logging_level & MPT_DEBUG_EVENT_WORK_TASK)
6008                 _scsih_sas_device_status_change_event_debug(ioc,
6009                      event_data);
6010
6011         /* In MPI Revision K (0xC), the internal device reset complete was
6012          * implemented, so avoid setting tm_busy flag for older firmware.
6013          */
6014         if ((ioc->facts.HeaderVersion >> 8) < 0xC)
6015                 return;
6016
6017         if (event_data->ReasonCode !=
6018             MPI2_EVENT_SAS_DEV_STAT_RC_INTERNAL_DEVICE_RESET &&
6019            event_data->ReasonCode !=
6020             MPI2_EVENT_SAS_DEV_STAT_RC_CMP_INTERNAL_DEV_RESET)
6021                 return;
6022
6023         spin_lock_irqsave(&ioc->sas_device_lock, flags);
6024         sas_address = le64_to_cpu(event_data->SASAddress);
6025         sas_device = __mpt3sas_get_sdev_by_addr(ioc,
6026             sas_address);
6027
6028         if (!sas_device || !sas_device->starget)
6029                 goto out;
6030
6031         target_priv_data = sas_device->starget->hostdata;
6032         if (!target_priv_data)
6033                 goto out;
6034
6035         if (event_data->ReasonCode ==
6036             MPI2_EVENT_SAS_DEV_STAT_RC_INTERNAL_DEVICE_RESET)
6037                 target_priv_data->tm_busy = 1;
6038         else
6039                 target_priv_data->tm_busy = 0;
6040
6041 out:
6042         if (sas_device)
6043                 sas_device_put(sas_device);
6044
6045         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
6046
6047 }
6048
6049 /**
6050  * _scsih_sas_enclosure_dev_status_change_event_debug - debug for enclosure
6051  * event
6052  * @ioc: per adapter object
6053  * @event_data: event data payload
6054  * Context: user.
6055  *
6056  * Return nothing.
6057  */
6058 static void
6059 _scsih_sas_enclosure_dev_status_change_event_debug(struct MPT3SAS_ADAPTER *ioc,
6060         Mpi2EventDataSasEnclDevStatusChange_t *event_data)
6061 {
6062         char *reason_str = NULL;
6063
6064         switch (event_data->ReasonCode) {
6065         case MPI2_EVENT_SAS_ENCL_RC_ADDED:
6066                 reason_str = "enclosure add";
6067                 break;
6068         case MPI2_EVENT_SAS_ENCL_RC_NOT_RESPONDING:
6069                 reason_str = "enclosure remove";
6070                 break;
6071         default:
6072                 reason_str = "unknown reason";
6073                 break;
6074         }
6075
6076         pr_info(MPT3SAS_FMT "enclosure status change: (%s)\n"
6077             "\thandle(0x%04x), enclosure logical id(0x%016llx)"
6078             " number slots(%d)\n", ioc->name, reason_str,
6079             le16_to_cpu(event_data->EnclosureHandle),
6080             (unsigned long long)le64_to_cpu(event_data->EnclosureLogicalID),
6081             le16_to_cpu(event_data->StartSlot));
6082 }
6083
6084 /**
6085  * _scsih_sas_enclosure_dev_status_change_event - handle enclosure events
6086  * @ioc: per adapter object
6087  * @fw_event: The fw_event_work object
6088  * Context: user.
6089  *
6090  * Return nothing.
6091  */
6092 static void
6093 _scsih_sas_enclosure_dev_status_change_event(struct MPT3SAS_ADAPTER *ioc,
6094         struct fw_event_work *fw_event)
6095 {
6096         if (ioc->logging_level & MPT_DEBUG_EVENT_WORK_TASK)
6097                 _scsih_sas_enclosure_dev_status_change_event_debug(ioc,
6098                      (Mpi2EventDataSasEnclDevStatusChange_t *)
6099                      fw_event->event_data);
6100 }
6101
6102 /**
6103  * _scsih_sas_broadcast_primitive_event - handle broadcast events
6104  * @ioc: per adapter object
6105  * @fw_event: The fw_event_work object
6106  * Context: user.
6107  *
6108  * Return nothing.
6109  */
6110 static void
6111 _scsih_sas_broadcast_primitive_event(struct MPT3SAS_ADAPTER *ioc,
6112         struct fw_event_work *fw_event)
6113 {
6114         struct scsi_cmnd *scmd;
6115         struct scsi_device *sdev;
6116         u16 smid, handle;
6117         u32 lun;
6118         struct MPT3SAS_DEVICE *sas_device_priv_data;
6119         u32 termination_count;
6120         u32 query_count;
6121         Mpi2SCSITaskManagementReply_t *mpi_reply;
6122         Mpi2EventDataSasBroadcastPrimitive_t *event_data =
6123                 (Mpi2EventDataSasBroadcastPrimitive_t *)
6124                 fw_event->event_data;
6125         u16 ioc_status;
6126         unsigned long flags;
6127         int r;
6128         u8 max_retries = 0;
6129         u8 task_abort_retries;
6130
6131         mutex_lock(&ioc->tm_cmds.mutex);
6132         pr_info(MPT3SAS_FMT
6133                 "%s: enter: phy number(%d), width(%d)\n",
6134                 ioc->name, __func__, event_data->PhyNum,
6135              event_data->PortWidth);
6136
6137         _scsih_block_io_all_device(ioc);
6138
6139         spin_lock_irqsave(&ioc->scsi_lookup_lock, flags);
6140         mpi_reply = ioc->tm_cmds.reply;
6141  broadcast_aen_retry:
6142
6143         /* sanity checks for retrying this loop */
6144         if (max_retries++ == 5) {
6145                 dewtprintk(ioc, pr_info(MPT3SAS_FMT "%s: giving up\n",
6146                     ioc->name, __func__));
6147                 goto out;
6148         } else if (max_retries > 1)
6149                 dewtprintk(ioc, pr_info(MPT3SAS_FMT "%s: %d retry\n",
6150                     ioc->name, __func__, max_retries - 1));
6151
6152         termination_count = 0;
6153         query_count = 0;
6154         for (smid = 1; smid <= ioc->scsiio_depth; smid++) {
6155                 if (ioc->shost_recovery)
6156                         goto out;
6157                 scmd = _scsih_scsi_lookup_get(ioc, smid);
6158                 if (!scmd)
6159                         continue;
6160                 sdev = scmd->device;
6161                 sas_device_priv_data = sdev->hostdata;
6162                 if (!sas_device_priv_data || !sas_device_priv_data->sas_target)
6163                         continue;
6164                  /* skip hidden raid components */
6165                 if (sas_device_priv_data->sas_target->flags &
6166                     MPT_TARGET_FLAGS_RAID_COMPONENT)
6167                         continue;
6168                  /* skip volumes */
6169                 if (sas_device_priv_data->sas_target->flags &
6170                     MPT_TARGET_FLAGS_VOLUME)
6171                         continue;
6172
6173                 handle = sas_device_priv_data->sas_target->handle;
6174                 lun = sas_device_priv_data->lun;
6175                 query_count++;
6176
6177                 if (ioc->shost_recovery)
6178                         goto out;
6179
6180                 spin_unlock_irqrestore(&ioc->scsi_lookup_lock, flags);
6181                 r = mpt3sas_scsih_issue_tm(ioc, handle, 0, 0, lun,
6182                     MPI2_SCSITASKMGMT_TASKTYPE_QUERY_TASK, smid, 30);
6183                 if (r == FAILED) {
6184                         sdev_printk(KERN_WARNING, sdev,
6185                             "mpt3sas_scsih_issue_tm: FAILED when sending "
6186                             "QUERY_TASK: scmd(%p)\n", scmd);
6187                         spin_lock_irqsave(&ioc->scsi_lookup_lock, flags);
6188                         goto broadcast_aen_retry;
6189                 }
6190                 ioc_status = le16_to_cpu(mpi_reply->IOCStatus)
6191                     & MPI2_IOCSTATUS_MASK;
6192                 if (ioc_status != MPI2_IOCSTATUS_SUCCESS) {
6193                         sdev_printk(KERN_WARNING, sdev,
6194                                 "query task: FAILED with IOCSTATUS(0x%04x), scmd(%p)\n",
6195                                 ioc_status, scmd);
6196                         spin_lock_irqsave(&ioc->scsi_lookup_lock, flags);
6197                         goto broadcast_aen_retry;
6198                 }
6199
6200                 /* see if IO is still owned by IOC and target */
6201                 if (mpi_reply->ResponseCode ==
6202                      MPI2_SCSITASKMGMT_RSP_TM_SUCCEEDED ||
6203                      mpi_reply->ResponseCode ==
6204                      MPI2_SCSITASKMGMT_RSP_IO_QUEUED_ON_IOC) {
6205                         spin_lock_irqsave(&ioc->scsi_lookup_lock, flags);
6206                         continue;
6207                 }
6208                 task_abort_retries = 0;
6209  tm_retry:
6210                 if (task_abort_retries++ == 60) {
6211                         dewtprintk(ioc, pr_info(MPT3SAS_FMT
6212                             "%s: ABORT_TASK: giving up\n", ioc->name,
6213                             __func__));
6214                         spin_lock_irqsave(&ioc->scsi_lookup_lock, flags);
6215                         goto broadcast_aen_retry;
6216                 }
6217
6218                 if (ioc->shost_recovery)
6219                         goto out_no_lock;
6220
6221                 r = mpt3sas_scsih_issue_tm(ioc, handle, sdev->channel, sdev->id,
6222                     sdev->lun, MPI2_SCSITASKMGMT_TASKTYPE_ABORT_TASK, smid,
6223                     30);
6224                 if (r == FAILED) {
6225                         sdev_printk(KERN_WARNING, sdev,
6226                             "mpt3sas_scsih_issue_tm: ABORT_TASK: FAILED : "
6227                             "scmd(%p)\n", scmd);
6228                         goto tm_retry;
6229                 }
6230
6231                 if (task_abort_retries > 1)
6232                         sdev_printk(KERN_WARNING, sdev,
6233                             "mpt3sas_scsih_issue_tm: ABORT_TASK: RETRIES (%d):"
6234                             " scmd(%p)\n",
6235                             task_abort_retries - 1, scmd);
6236
6237                 termination_count += le32_to_cpu(mpi_reply->TerminationCount);
6238                 spin_lock_irqsave(&ioc->scsi_lookup_lock, flags);
6239         }
6240
6241         if (ioc->broadcast_aen_pending) {
6242                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
6243                         "%s: loop back due to pending AEN\n",
6244                         ioc->name, __func__));
6245                  ioc->broadcast_aen_pending = 0;
6246                  goto broadcast_aen_retry;
6247         }
6248
6249  out:
6250         spin_unlock_irqrestore(&ioc->scsi_lookup_lock, flags);
6251  out_no_lock:
6252
6253         dewtprintk(ioc, pr_info(MPT3SAS_FMT
6254             "%s - exit, query_count = %d termination_count = %d\n",
6255             ioc->name, __func__, query_count, termination_count));
6256
6257         ioc->broadcast_aen_busy = 0;
6258         if (!ioc->shost_recovery)
6259                 _scsih_ublock_io_all_device(ioc);
6260         mutex_unlock(&ioc->tm_cmds.mutex);
6261 }
6262
6263 /**
6264  * _scsih_sas_discovery_event - handle discovery events
6265  * @ioc: per adapter object
6266  * @fw_event: The fw_event_work object
6267  * Context: user.
6268  *
6269  * Return nothing.
6270  */
6271 static void
6272 _scsih_sas_discovery_event(struct MPT3SAS_ADAPTER *ioc,
6273         struct fw_event_work *fw_event)
6274 {
6275         Mpi2EventDataSasDiscovery_t *event_data =
6276                 (Mpi2EventDataSasDiscovery_t *) fw_event->event_data;
6277
6278         if (ioc->logging_level & MPT_DEBUG_EVENT_WORK_TASK) {
6279                 pr_info(MPT3SAS_FMT "discovery event: (%s)", ioc->name,
6280                     (event_data->ReasonCode == MPI2_EVENT_SAS_DISC_RC_STARTED) ?
6281                     "start" : "stop");
6282                 if (event_data->DiscoveryStatus)
6283                         pr_info("discovery_status(0x%08x)",
6284                             le32_to_cpu(event_data->DiscoveryStatus));
6285                 pr_info("\n");
6286         }
6287
6288         if (event_data->ReasonCode == MPI2_EVENT_SAS_DISC_RC_STARTED &&
6289             !ioc->sas_hba.num_phys) {
6290                 if (disable_discovery > 0 && ioc->shost_recovery) {
6291                         /* Wait for the reset to complete */
6292                         while (ioc->shost_recovery)
6293                                 ssleep(1);
6294                 }
6295                 _scsih_sas_host_add(ioc);
6296         }
6297 }
6298
6299 /**
6300  * _scsih_ir_fastpath - turn on fastpath for IR physdisk
6301  * @ioc: per adapter object
6302  * @handle: device handle for physical disk
6303  * @phys_disk_num: physical disk number
6304  *
6305  * Return 0 for success, else failure.
6306  */
6307 static int
6308 _scsih_ir_fastpath(struct MPT3SAS_ADAPTER *ioc, u16 handle, u8 phys_disk_num)
6309 {
6310         Mpi2RaidActionRequest_t *mpi_request;
6311         Mpi2RaidActionReply_t *mpi_reply;
6312         u16 smid;
6313         u8 issue_reset = 0;
6314         int rc = 0;
6315         u16 ioc_status;
6316         u32 log_info;
6317
6318         if (ioc->hba_mpi_version_belonged == MPI2_VERSION)
6319                 return rc;
6320
6321         mutex_lock(&ioc->scsih_cmds.mutex);
6322
6323         if (ioc->scsih_cmds.status != MPT3_CMD_NOT_USED) {
6324                 pr_err(MPT3SAS_FMT "%s: scsih_cmd in use\n",
6325                     ioc->name, __func__);
6326                 rc = -EAGAIN;
6327                 goto out;
6328         }
6329         ioc->scsih_cmds.status = MPT3_CMD_PENDING;
6330
6331         smid = mpt3sas_base_get_smid(ioc, ioc->scsih_cb_idx);
6332         if (!smid) {
6333                 pr_err(MPT3SAS_FMT "%s: failed obtaining a smid\n",
6334                     ioc->name, __func__);
6335                 ioc->scsih_cmds.status = MPT3_CMD_NOT_USED;
6336                 rc = -EAGAIN;
6337                 goto out;
6338         }
6339
6340         mpi_request = mpt3sas_base_get_msg_frame(ioc, smid);
6341         ioc->scsih_cmds.smid = smid;
6342         memset(mpi_request, 0, sizeof(Mpi2RaidActionRequest_t));
6343
6344         mpi_request->Function = MPI2_FUNCTION_RAID_ACTION;
6345         mpi_request->Action = MPI2_RAID_ACTION_PHYSDISK_HIDDEN;
6346         mpi_request->PhysDiskNum = phys_disk_num;
6347
6348         dewtprintk(ioc, pr_info(MPT3SAS_FMT "IR RAID_ACTION: turning fast "\
6349             "path on for handle(0x%04x), phys_disk_num (0x%02x)\n", ioc->name,
6350             handle, phys_disk_num));
6351
6352         init_completion(&ioc->scsih_cmds.done);
6353         ioc->put_smid_default(ioc, smid);
6354         wait_for_completion_timeout(&ioc->scsih_cmds.done, 10*HZ);
6355
6356         if (!(ioc->scsih_cmds.status & MPT3_CMD_COMPLETE)) {
6357                 pr_err(MPT3SAS_FMT "%s: timeout\n",
6358                     ioc->name, __func__);
6359                 if (!(ioc->scsih_cmds.status & MPT3_CMD_RESET))
6360                         issue_reset = 1;
6361                 rc = -EFAULT;
6362                 goto out;
6363         }
6364
6365         if (ioc->scsih_cmds.status & MPT3_CMD_REPLY_VALID) {
6366
6367                 mpi_reply = ioc->scsih_cmds.reply;
6368                 ioc_status = le16_to_cpu(mpi_reply->IOCStatus);
6369                 if (ioc_status & MPI2_IOCSTATUS_FLAG_LOG_INFO_AVAILABLE)
6370                         log_info =  le32_to_cpu(mpi_reply->IOCLogInfo);
6371                 else
6372                         log_info = 0;
6373                 ioc_status &= MPI2_IOCSTATUS_MASK;
6374                 if (ioc_status != MPI2_IOCSTATUS_SUCCESS) {
6375                         dewtprintk(ioc, pr_info(MPT3SAS_FMT
6376                             "IR RAID_ACTION: failed: ioc_status(0x%04x), "
6377                             "loginfo(0x%08x)!!!\n", ioc->name, ioc_status,
6378                             log_info));
6379                         rc = -EFAULT;
6380                 } else
6381                         dewtprintk(ioc, pr_info(MPT3SAS_FMT
6382                             "IR RAID_ACTION: completed successfully\n",
6383                             ioc->name));
6384         }
6385
6386  out:
6387         ioc->scsih_cmds.status = MPT3_CMD_NOT_USED;
6388         mutex_unlock(&ioc->scsih_cmds.mutex);
6389
6390         if (issue_reset)
6391                 mpt3sas_base_hard_reset_handler(ioc, FORCE_BIG_HAMMER);
6392         return rc;
6393 }
6394
6395 /**
6396  * _scsih_reprobe_lun - reprobing lun
6397  * @sdev: scsi device struct
6398  * @no_uld_attach: sdev->no_uld_attach flag setting
6399  *
6400  **/
6401 static void
6402 _scsih_reprobe_lun(struct scsi_device *sdev, void *no_uld_attach)
6403 {
6404         sdev->no_uld_attach = no_uld_attach ? 1 : 0;
6405         sdev_printk(KERN_INFO, sdev, "%s raid component\n",
6406             sdev->no_uld_attach ? "hiding" : "exposing");
6407         WARN_ON(scsi_device_reprobe(sdev));
6408 }
6409
6410 /**
6411  * _scsih_sas_volume_add - add new volume
6412  * @ioc: per adapter object
6413  * @element: IR config element data
6414  * Context: user.
6415  *
6416  * Return nothing.
6417  */
6418 static void
6419 _scsih_sas_volume_add(struct MPT3SAS_ADAPTER *ioc,
6420         Mpi2EventIrConfigElement_t *element)
6421 {
6422         struct _raid_device *raid_device;
6423         unsigned long flags;
6424         u64 wwid;
6425         u16 handle = le16_to_cpu(element->VolDevHandle);
6426         int rc;
6427
6428         mpt3sas_config_get_volume_wwid(ioc, handle, &wwid);
6429         if (!wwid) {
6430                 pr_err(MPT3SAS_FMT
6431                     "failure at %s:%d/%s()!\n", ioc->name,
6432                     __FILE__, __LINE__, __func__);
6433                 return;
6434         }
6435
6436         spin_lock_irqsave(&ioc->raid_device_lock, flags);
6437         raid_device = _scsih_raid_device_find_by_wwid(ioc, wwid);
6438         spin_unlock_irqrestore(&ioc->raid_device_lock, flags);
6439
6440         if (raid_device)
6441                 return;
6442
6443         raid_device = kzalloc(sizeof(struct _raid_device), GFP_KERNEL);
6444         if (!raid_device) {
6445                 pr_err(MPT3SAS_FMT
6446                     "failure at %s:%d/%s()!\n", ioc->name,
6447                     __FILE__, __LINE__, __func__);
6448                 return;
6449         }
6450
6451         raid_device->id = ioc->sas_id++;
6452         raid_device->channel = RAID_CHANNEL;
6453         raid_device->handle = handle;
6454         raid_device->wwid = wwid;
6455         _scsih_raid_device_add(ioc, raid_device);
6456         if (!ioc->wait_for_discovery_to_complete) {
6457                 rc = scsi_add_device(ioc->shost, RAID_CHANNEL,
6458                     raid_device->id, 0);
6459                 if (rc)
6460                         _scsih_raid_device_remove(ioc, raid_device);
6461         } else {
6462                 spin_lock_irqsave(&ioc->raid_device_lock, flags);
6463                 _scsih_determine_boot_device(ioc, raid_device, 1);
6464                 spin_unlock_irqrestore(&ioc->raid_device_lock, flags);
6465         }
6466 }
6467
6468 /**
6469  * _scsih_sas_volume_delete - delete volume
6470  * @ioc: per adapter object
6471  * @handle: volume device handle
6472  * Context: user.
6473  *
6474  * Return nothing.
6475  */
6476 static void
6477 _scsih_sas_volume_delete(struct MPT3SAS_ADAPTER *ioc, u16 handle)
6478 {
6479         struct _raid_device *raid_device;
6480         unsigned long flags;
6481         struct MPT3SAS_TARGET *sas_target_priv_data;
6482         struct scsi_target *starget = NULL;
6483
6484         spin_lock_irqsave(&ioc->raid_device_lock, flags);
6485         raid_device = mpt3sas_raid_device_find_by_handle(ioc, handle);
6486         if (raid_device) {
6487                 if (raid_device->starget) {
6488                         starget = raid_device->starget;
6489                         sas_target_priv_data = starget->hostdata;
6490                         sas_target_priv_data->deleted = 1;
6491                 }
6492                 pr_info(MPT3SAS_FMT "removing handle(0x%04x), wwid(0x%016llx)\n",
6493                         ioc->name,  raid_device->handle,
6494                     (unsigned long long) raid_device->wwid);
6495                 list_del(&raid_device->list);
6496                 kfree(raid_device);
6497         }
6498         spin_unlock_irqrestore(&ioc->raid_device_lock, flags);
6499         if (starget)
6500                 scsi_remove_target(&starget->dev);
6501 }
6502
6503 /**
6504  * _scsih_sas_pd_expose - expose pd component to /dev/sdX
6505  * @ioc: per adapter object
6506  * @element: IR config element data
6507  * Context: user.
6508  *
6509  * Return nothing.
6510  */
6511 static void
6512 _scsih_sas_pd_expose(struct MPT3SAS_ADAPTER *ioc,
6513         Mpi2EventIrConfigElement_t *element)
6514 {
6515         struct _sas_device *sas_device;
6516         struct scsi_target *starget = NULL;
6517         struct MPT3SAS_TARGET *sas_target_priv_data;
6518         unsigned long flags;
6519         u16 handle = le16_to_cpu(element->PhysDiskDevHandle);
6520
6521         spin_lock_irqsave(&ioc->sas_device_lock, flags);
6522         sas_device = __mpt3sas_get_sdev_by_handle(ioc, handle);
6523         if (sas_device) {
6524                 sas_device->volume_handle = 0;
6525                 sas_device->volume_wwid = 0;
6526                 clear_bit(handle, ioc->pd_handles);
6527                 if (sas_device->starget && sas_device->starget->hostdata) {
6528                         starget = sas_device->starget;
6529                         sas_target_priv_data = starget->hostdata;
6530                         sas_target_priv_data->flags &=
6531                             ~MPT_TARGET_FLAGS_RAID_COMPONENT;
6532                 }
6533         }
6534         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
6535         if (!sas_device)
6536                 return;
6537
6538         /* exposing raid component */
6539         if (starget)
6540                 starget_for_each_device(starget, NULL, _scsih_reprobe_lun);
6541
6542         sas_device_put(sas_device);
6543 }
6544
6545 /**
6546  * _scsih_sas_pd_hide - hide pd component from /dev/sdX
6547  * @ioc: per adapter object
6548  * @element: IR config element data
6549  * Context: user.
6550  *
6551  * Return nothing.
6552  */
6553 static void
6554 _scsih_sas_pd_hide(struct MPT3SAS_ADAPTER *ioc,
6555         Mpi2EventIrConfigElement_t *element)
6556 {
6557         struct _sas_device *sas_device;
6558         struct scsi_target *starget = NULL;
6559         struct MPT3SAS_TARGET *sas_target_priv_data;
6560         unsigned long flags;
6561         u16 handle = le16_to_cpu(element->PhysDiskDevHandle);
6562         u16 volume_handle = 0;
6563         u64 volume_wwid = 0;
6564
6565         mpt3sas_config_get_volume_handle(ioc, handle, &volume_handle);
6566         if (volume_handle)
6567                 mpt3sas_config_get_volume_wwid(ioc, volume_handle,
6568                     &volume_wwid);
6569
6570         spin_lock_irqsave(&ioc->sas_device_lock, flags);
6571         sas_device = __mpt3sas_get_sdev_by_handle(ioc, handle);
6572         if (sas_device) {
6573                 set_bit(handle, ioc->pd_handles);
6574                 if (sas_device->starget && sas_device->starget->hostdata) {
6575                         starget = sas_device->starget;
6576                         sas_target_priv_data = starget->hostdata;
6577                         sas_target_priv_data->flags |=
6578                             MPT_TARGET_FLAGS_RAID_COMPONENT;
6579                         sas_device->volume_handle = volume_handle;
6580                         sas_device->volume_wwid = volume_wwid;
6581                 }
6582         }
6583         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
6584         if (!sas_device)
6585                 return;
6586
6587         /* hiding raid component */
6588         _scsih_ir_fastpath(ioc, handle, element->PhysDiskNum);
6589
6590         if (starget)
6591                 starget_for_each_device(starget, (void *)1, _scsih_reprobe_lun);
6592
6593         sas_device_put(sas_device);
6594 }
6595
6596 /**
6597  * _scsih_sas_pd_delete - delete pd component
6598  * @ioc: per adapter object
6599  * @element: IR config element data
6600  * Context: user.
6601  *
6602  * Return nothing.
6603  */
6604 static void
6605 _scsih_sas_pd_delete(struct MPT3SAS_ADAPTER *ioc,
6606         Mpi2EventIrConfigElement_t *element)
6607 {
6608         u16 handle = le16_to_cpu(element->PhysDiskDevHandle);
6609
6610         _scsih_device_remove_by_handle(ioc, handle);
6611 }
6612
6613 /**
6614  * _scsih_sas_pd_add - remove pd component
6615  * @ioc: per adapter object
6616  * @element: IR config element data
6617  * Context: user.
6618  *
6619  * Return nothing.
6620  */
6621 static void
6622 _scsih_sas_pd_add(struct MPT3SAS_ADAPTER *ioc,
6623         Mpi2EventIrConfigElement_t *element)
6624 {
6625         struct _sas_device *sas_device;
6626         u16 handle = le16_to_cpu(element->PhysDiskDevHandle);
6627         Mpi2ConfigReply_t mpi_reply;
6628         Mpi2SasDevicePage0_t sas_device_pg0;
6629         u32 ioc_status;
6630         u64 sas_address;
6631         u16 parent_handle;
6632
6633         set_bit(handle, ioc->pd_handles);
6634
6635         sas_device = mpt3sas_get_sdev_by_handle(ioc, handle);
6636         if (sas_device) {
6637                 _scsih_ir_fastpath(ioc, handle, element->PhysDiskNum);
6638                 sas_device_put(sas_device);
6639                 return;
6640         }
6641
6642         if ((mpt3sas_config_get_sas_device_pg0(ioc, &mpi_reply, &sas_device_pg0,
6643             MPI2_SAS_DEVICE_PGAD_FORM_HANDLE, handle))) {
6644                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
6645                     ioc->name, __FILE__, __LINE__, __func__);
6646                 return;
6647         }
6648
6649         ioc_status = le16_to_cpu(mpi_reply.IOCStatus) &
6650             MPI2_IOCSTATUS_MASK;
6651         if (ioc_status != MPI2_IOCSTATUS_SUCCESS) {
6652                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
6653                     ioc->name, __FILE__, __LINE__, __func__);
6654                 return;
6655         }
6656
6657         parent_handle = le16_to_cpu(sas_device_pg0.ParentDevHandle);
6658         if (!_scsih_get_sas_address(ioc, parent_handle, &sas_address))
6659                 mpt3sas_transport_update_links(ioc, sas_address, handle,
6660                     sas_device_pg0.PhyNum, MPI2_SAS_NEG_LINK_RATE_1_5);
6661
6662         _scsih_ir_fastpath(ioc, handle, element->PhysDiskNum);
6663         _scsih_add_device(ioc, handle, 0, 1);
6664 }
6665
6666 /**
6667  * _scsih_sas_ir_config_change_event_debug - debug for IR Config Change events
6668  * @ioc: per adapter object
6669  * @event_data: event data payload
6670  * Context: user.
6671  *
6672  * Return nothing.
6673  */
6674 static void
6675 _scsih_sas_ir_config_change_event_debug(struct MPT3SAS_ADAPTER *ioc,
6676         Mpi2EventDataIrConfigChangeList_t *event_data)
6677 {
6678         Mpi2EventIrConfigElement_t *element;
6679         u8 element_type;
6680         int i;
6681         char *reason_str = NULL, *element_str = NULL;
6682
6683         element = (Mpi2EventIrConfigElement_t *)&event_data->ConfigElement[0];
6684
6685         pr_info(MPT3SAS_FMT "raid config change: (%s), elements(%d)\n",
6686             ioc->name, (le32_to_cpu(event_data->Flags) &
6687             MPI2_EVENT_IR_CHANGE_FLAGS_FOREIGN_CONFIG) ?
6688             "foreign" : "native", event_data->NumElements);
6689         for (i = 0; i < event_data->NumElements; i++, element++) {
6690                 switch (element->ReasonCode) {
6691                 case MPI2_EVENT_IR_CHANGE_RC_ADDED:
6692                         reason_str = "add";
6693                         break;
6694                 case MPI2_EVENT_IR_CHANGE_RC_REMOVED:
6695                         reason_str = "remove";
6696                         break;
6697                 case MPI2_EVENT_IR_CHANGE_RC_NO_CHANGE:
6698                         reason_str = "no change";
6699                         break;
6700                 case MPI2_EVENT_IR_CHANGE_RC_HIDE:
6701                         reason_str = "hide";
6702                         break;
6703                 case MPI2_EVENT_IR_CHANGE_RC_UNHIDE:
6704                         reason_str = "unhide";
6705                         break;
6706                 case MPI2_EVENT_IR_CHANGE_RC_VOLUME_CREATED:
6707                         reason_str = "volume_created";
6708                         break;
6709                 case MPI2_EVENT_IR_CHANGE_RC_VOLUME_DELETED:
6710                         reason_str = "volume_deleted";
6711                         break;
6712                 case MPI2_EVENT_IR_CHANGE_RC_PD_CREATED:
6713                         reason_str = "pd_created";
6714                         break;
6715                 case MPI2_EVENT_IR_CHANGE_RC_PD_DELETED:
6716                         reason_str = "pd_deleted";
6717                         break;
6718                 default:
6719                         reason_str = "unknown reason";
6720                         break;
6721                 }
6722                 element_type = le16_to_cpu(element->ElementFlags) &
6723                     MPI2_EVENT_IR_CHANGE_EFLAGS_ELEMENT_TYPE_MASK;
6724                 switch (element_type) {
6725                 case MPI2_EVENT_IR_CHANGE_EFLAGS_VOLUME_ELEMENT:
6726                         element_str = "volume";
6727                         break;
6728                 case MPI2_EVENT_IR_CHANGE_EFLAGS_VOLPHYSDISK_ELEMENT:
6729                         element_str = "phys disk";
6730                         break;
6731                 case MPI2_EVENT_IR_CHANGE_EFLAGS_HOTSPARE_ELEMENT:
6732                         element_str = "hot spare";
6733                         break;
6734                 default:
6735                         element_str = "unknown element";
6736                         break;
6737                 }
6738                 pr_info("\t(%s:%s), vol handle(0x%04x), " \
6739                     "pd handle(0x%04x), pd num(0x%02x)\n", element_str,
6740                     reason_str, le16_to_cpu(element->VolDevHandle),
6741                     le16_to_cpu(element->PhysDiskDevHandle),
6742                     element->PhysDiskNum);
6743         }
6744 }
6745
6746 /**
6747  * _scsih_sas_ir_config_change_event - handle ir configuration change events
6748  * @ioc: per adapter object
6749  * @fw_event: The fw_event_work object
6750  * Context: user.
6751  *
6752  * Return nothing.
6753  */
6754 static void
6755 _scsih_sas_ir_config_change_event(struct MPT3SAS_ADAPTER *ioc,
6756         struct fw_event_work *fw_event)
6757 {
6758         Mpi2EventIrConfigElement_t *element;
6759         int i;
6760         u8 foreign_config;
6761         Mpi2EventDataIrConfigChangeList_t *event_data =
6762                 (Mpi2EventDataIrConfigChangeList_t *)
6763                 fw_event->event_data;
6764
6765         if ((ioc->logging_level & MPT_DEBUG_EVENT_WORK_TASK) &&
6766              (!ioc->hide_ir_msg))
6767                 _scsih_sas_ir_config_change_event_debug(ioc, event_data);
6768
6769         foreign_config = (le32_to_cpu(event_data->Flags) &
6770             MPI2_EVENT_IR_CHANGE_FLAGS_FOREIGN_CONFIG) ? 1 : 0;
6771
6772         element = (Mpi2EventIrConfigElement_t *)&event_data->ConfigElement[0];
6773         if (ioc->shost_recovery &&
6774             ioc->hba_mpi_version_belonged != MPI2_VERSION) {
6775                 for (i = 0; i < event_data->NumElements; i++, element++) {
6776                         if (element->ReasonCode == MPI2_EVENT_IR_CHANGE_RC_HIDE)
6777                                 _scsih_ir_fastpath(ioc,
6778                                         le16_to_cpu(element->PhysDiskDevHandle),
6779                                         element->PhysDiskNum);
6780                 }
6781                 return;
6782         }
6783
6784         for (i = 0; i < event_data->NumElements; i++, element++) {
6785
6786                 switch (element->ReasonCode) {
6787                 case MPI2_EVENT_IR_CHANGE_RC_VOLUME_CREATED:
6788                 case MPI2_EVENT_IR_CHANGE_RC_ADDED:
6789                         if (!foreign_config)
6790                                 _scsih_sas_volume_add(ioc, element);
6791                         break;
6792                 case MPI2_EVENT_IR_CHANGE_RC_VOLUME_DELETED:
6793                 case MPI2_EVENT_IR_CHANGE_RC_REMOVED:
6794                         if (!foreign_config)
6795                                 _scsih_sas_volume_delete(ioc,
6796                                     le16_to_cpu(element->VolDevHandle));
6797                         break;
6798                 case MPI2_EVENT_IR_CHANGE_RC_PD_CREATED:
6799                         if (!ioc->is_warpdrive)
6800                                 _scsih_sas_pd_hide(ioc, element);
6801                         break;
6802                 case MPI2_EVENT_IR_CHANGE_RC_PD_DELETED:
6803                         if (!ioc->is_warpdrive)
6804                                 _scsih_sas_pd_expose(ioc, element);
6805                         break;
6806                 case MPI2_EVENT_IR_CHANGE_RC_HIDE:
6807                         if (!ioc->is_warpdrive)
6808                                 _scsih_sas_pd_add(ioc, element);
6809                         break;
6810                 case MPI2_EVENT_IR_CHANGE_RC_UNHIDE:
6811                         if (!ioc->is_warpdrive)
6812                                 _scsih_sas_pd_delete(ioc, element);
6813                         break;
6814                 }
6815         }
6816 }
6817
6818 /**
6819  * _scsih_sas_ir_volume_event - IR volume event
6820  * @ioc: per adapter object
6821  * @fw_event: The fw_event_work object
6822  * Context: user.
6823  *
6824  * Return nothing.
6825  */
6826 static void
6827 _scsih_sas_ir_volume_event(struct MPT3SAS_ADAPTER *ioc,
6828         struct fw_event_work *fw_event)
6829 {
6830         u64 wwid;
6831         unsigned long flags;
6832         struct _raid_device *raid_device;
6833         u16 handle;
6834         u32 state;
6835         int rc;
6836         Mpi2EventDataIrVolume_t *event_data =
6837                 (Mpi2EventDataIrVolume_t *) fw_event->event_data;
6838
6839         if (ioc->shost_recovery)
6840                 return;
6841
6842         if (event_data->ReasonCode != MPI2_EVENT_IR_VOLUME_RC_STATE_CHANGED)
6843                 return;
6844
6845         handle = le16_to_cpu(event_data->VolDevHandle);
6846         state = le32_to_cpu(event_data->NewValue);
6847         if (!ioc->hide_ir_msg)
6848                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
6849                     "%s: handle(0x%04x), old(0x%08x), new(0x%08x)\n",
6850                     ioc->name, __func__,  handle,
6851                     le32_to_cpu(event_data->PreviousValue), state));
6852         switch (state) {
6853         case MPI2_RAID_VOL_STATE_MISSING:
6854         case MPI2_RAID_VOL_STATE_FAILED:
6855                 _scsih_sas_volume_delete(ioc, handle);
6856                 break;
6857
6858         case MPI2_RAID_VOL_STATE_ONLINE:
6859         case MPI2_RAID_VOL_STATE_DEGRADED:
6860         case MPI2_RAID_VOL_STATE_OPTIMAL:
6861
6862                 spin_lock_irqsave(&ioc->raid_device_lock, flags);
6863                 raid_device = mpt3sas_raid_device_find_by_handle(ioc, handle);
6864                 spin_unlock_irqrestore(&ioc->raid_device_lock, flags);
6865
6866                 if (raid_device)
6867                         break;
6868
6869                 mpt3sas_config_get_volume_wwid(ioc, handle, &wwid);
6870                 if (!wwid) {
6871                         pr_err(MPT3SAS_FMT
6872                             "failure at %s:%d/%s()!\n", ioc->name,
6873                             __FILE__, __LINE__, __func__);
6874                         break;
6875                 }
6876
6877                 raid_device = kzalloc(sizeof(struct _raid_device), GFP_KERNEL);
6878                 if (!raid_device) {
6879                         pr_err(MPT3SAS_FMT
6880                             "failure at %s:%d/%s()!\n", ioc->name,
6881                             __FILE__, __LINE__, __func__);
6882                         break;
6883                 }
6884
6885                 raid_device->id = ioc->sas_id++;
6886                 raid_device->channel = RAID_CHANNEL;
6887                 raid_device->handle = handle;
6888                 raid_device->wwid = wwid;
6889                 _scsih_raid_device_add(ioc, raid_device);
6890                 rc = scsi_add_device(ioc->shost, RAID_CHANNEL,
6891                     raid_device->id, 0);
6892                 if (rc)
6893                         _scsih_raid_device_remove(ioc, raid_device);
6894                 break;
6895
6896         case MPI2_RAID_VOL_STATE_INITIALIZING:
6897         default:
6898                 break;
6899         }
6900 }
6901
6902 /**
6903  * _scsih_sas_ir_physical_disk_event - PD event
6904  * @ioc: per adapter object
6905  * @fw_event: The fw_event_work object
6906  * Context: user.
6907  *
6908  * Return nothing.
6909  */
6910 static void
6911 _scsih_sas_ir_physical_disk_event(struct MPT3SAS_ADAPTER *ioc,
6912         struct fw_event_work *fw_event)
6913 {
6914         u16 handle, parent_handle;
6915         u32 state;
6916         struct _sas_device *sas_device;
6917         Mpi2ConfigReply_t mpi_reply;
6918         Mpi2SasDevicePage0_t sas_device_pg0;
6919         u32 ioc_status;
6920         Mpi2EventDataIrPhysicalDisk_t *event_data =
6921                 (Mpi2EventDataIrPhysicalDisk_t *) fw_event->event_data;
6922         u64 sas_address;
6923
6924         if (ioc->shost_recovery)
6925                 return;
6926
6927         if (event_data->ReasonCode != MPI2_EVENT_IR_PHYSDISK_RC_STATE_CHANGED)
6928                 return;
6929
6930         handle = le16_to_cpu(event_data->PhysDiskDevHandle);
6931         state = le32_to_cpu(event_data->NewValue);
6932
6933         if (!ioc->hide_ir_msg)
6934                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
6935                     "%s: handle(0x%04x), old(0x%08x), new(0x%08x)\n",
6936                     ioc->name, __func__,  handle,
6937                     le32_to_cpu(event_data->PreviousValue), state));
6938
6939         switch (state) {
6940         case MPI2_RAID_PD_STATE_ONLINE:
6941         case MPI2_RAID_PD_STATE_DEGRADED:
6942         case MPI2_RAID_PD_STATE_REBUILDING:
6943         case MPI2_RAID_PD_STATE_OPTIMAL:
6944         case MPI2_RAID_PD_STATE_HOT_SPARE:
6945
6946                 if (!ioc->is_warpdrive)
6947                         set_bit(handle, ioc->pd_handles);
6948
6949                 sas_device = mpt3sas_get_sdev_by_handle(ioc, handle);
6950                 if (sas_device) {
6951                         sas_device_put(sas_device);
6952                         return;
6953                 }
6954
6955                 if ((mpt3sas_config_get_sas_device_pg0(ioc, &mpi_reply,
6956                     &sas_device_pg0, MPI2_SAS_DEVICE_PGAD_FORM_HANDLE,
6957                     handle))) {
6958                         pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
6959                             ioc->name, __FILE__, __LINE__, __func__);
6960                         return;
6961                 }
6962
6963                 ioc_status = le16_to_cpu(mpi_reply.IOCStatus) &
6964                     MPI2_IOCSTATUS_MASK;
6965                 if (ioc_status != MPI2_IOCSTATUS_SUCCESS) {
6966                         pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
6967                             ioc->name, __FILE__, __LINE__, __func__);
6968                         return;
6969                 }
6970
6971                 parent_handle = le16_to_cpu(sas_device_pg0.ParentDevHandle);
6972                 if (!_scsih_get_sas_address(ioc, parent_handle, &sas_address))
6973                         mpt3sas_transport_update_links(ioc, sas_address, handle,
6974                             sas_device_pg0.PhyNum, MPI2_SAS_NEG_LINK_RATE_1_5);
6975
6976                 _scsih_add_device(ioc, handle, 0, 1);
6977
6978                 break;
6979
6980         case MPI2_RAID_PD_STATE_OFFLINE:
6981         case MPI2_RAID_PD_STATE_NOT_CONFIGURED:
6982         case MPI2_RAID_PD_STATE_NOT_COMPATIBLE:
6983         default:
6984                 break;
6985         }
6986 }
6987
6988 /**
6989  * _scsih_sas_ir_operation_status_event_debug - debug for IR op event
6990  * @ioc: per adapter object
6991  * @event_data: event data payload
6992  * Context: user.
6993  *
6994  * Return nothing.
6995  */
6996 static void
6997 _scsih_sas_ir_operation_status_event_debug(struct MPT3SAS_ADAPTER *ioc,
6998         Mpi2EventDataIrOperationStatus_t *event_data)
6999 {
7000         char *reason_str = NULL;
7001
7002         switch (event_data->RAIDOperation) {
7003         case MPI2_EVENT_IR_RAIDOP_RESYNC:
7004                 reason_str = "resync";
7005                 break;
7006         case MPI2_EVENT_IR_RAIDOP_ONLINE_CAP_EXPANSION:
7007                 reason_str = "online capacity expansion";
7008                 break;
7009         case MPI2_EVENT_IR_RAIDOP_CONSISTENCY_CHECK:
7010                 reason_str = "consistency check";
7011                 break;
7012         case MPI2_EVENT_IR_RAIDOP_BACKGROUND_INIT:
7013                 reason_str = "background init";
7014                 break;
7015         case MPI2_EVENT_IR_RAIDOP_MAKE_DATA_CONSISTENT:
7016                 reason_str = "make data consistent";
7017                 break;
7018         }
7019
7020         if (!reason_str)
7021                 return;
7022
7023         pr_info(MPT3SAS_FMT "raid operational status: (%s)" \
7024             "\thandle(0x%04x), percent complete(%d)\n",
7025             ioc->name, reason_str,
7026             le16_to_cpu(event_data->VolDevHandle),
7027             event_data->PercentComplete);
7028 }
7029
7030 /**
7031  * _scsih_sas_ir_operation_status_event - handle RAID operation events
7032  * @ioc: per adapter object
7033  * @fw_event: The fw_event_work object
7034  * Context: user.
7035  *
7036  * Return nothing.
7037  */
7038 static void
7039 _scsih_sas_ir_operation_status_event(struct MPT3SAS_ADAPTER *ioc,
7040         struct fw_event_work *fw_event)
7041 {
7042         Mpi2EventDataIrOperationStatus_t *event_data =
7043                 (Mpi2EventDataIrOperationStatus_t *)
7044                 fw_event->event_data;
7045         static struct _raid_device *raid_device;
7046         unsigned long flags;
7047         u16 handle;
7048
7049         if ((ioc->logging_level & MPT_DEBUG_EVENT_WORK_TASK) &&
7050             (!ioc->hide_ir_msg))
7051                 _scsih_sas_ir_operation_status_event_debug(ioc,
7052                      event_data);
7053
7054         /* code added for raid transport support */
7055         if (event_data->RAIDOperation == MPI2_EVENT_IR_RAIDOP_RESYNC) {
7056
7057                 spin_lock_irqsave(&ioc->raid_device_lock, flags);
7058                 handle = le16_to_cpu(event_data->VolDevHandle);
7059                 raid_device = mpt3sas_raid_device_find_by_handle(ioc, handle);
7060                 if (raid_device)
7061                         raid_device->percent_complete =
7062                             event_data->PercentComplete;
7063                 spin_unlock_irqrestore(&ioc->raid_device_lock, flags);
7064         }
7065 }
7066
7067 /**
7068  * _scsih_prep_device_scan - initialize parameters prior to device scan
7069  * @ioc: per adapter object
7070  *
7071  * Set the deleted flag prior to device scan.  If the device is found during
7072  * the scan, then we clear the deleted flag.
7073  */
7074 static void
7075 _scsih_prep_device_scan(struct MPT3SAS_ADAPTER *ioc)
7076 {
7077         struct MPT3SAS_DEVICE *sas_device_priv_data;
7078         struct scsi_device *sdev;
7079
7080         shost_for_each_device(sdev, ioc->shost) {
7081                 sas_device_priv_data = sdev->hostdata;
7082                 if (sas_device_priv_data && sas_device_priv_data->sas_target)
7083                         sas_device_priv_data->sas_target->deleted = 1;
7084         }
7085 }
7086
7087 /**
7088  * _scsih_mark_responding_sas_device - mark a sas_devices as responding
7089  * @ioc: per adapter object
7090  * @sas_device_pg0: SAS Device page 0
7091  *
7092  * After host reset, find out whether devices are still responding.
7093  * Used in _scsih_remove_unresponsive_sas_devices.
7094  *
7095  * Return nothing.
7096  */
7097 static void
7098 _scsih_mark_responding_sas_device(struct MPT3SAS_ADAPTER *ioc,
7099 Mpi2SasDevicePage0_t *sas_device_pg0)
7100 {
7101         struct MPT3SAS_TARGET *sas_target_priv_data = NULL;
7102         struct scsi_target *starget;
7103         struct _sas_device *sas_device;
7104         unsigned long flags;
7105
7106         spin_lock_irqsave(&ioc->sas_device_lock, flags);
7107         list_for_each_entry(sas_device, &ioc->sas_device_list, list) {
7108                 if ((sas_device->sas_address == sas_device_pg0->SASAddress) &&
7109                         (sas_device->slot == sas_device_pg0->Slot)) {
7110                         sas_device->responding = 1;
7111                         starget = sas_device->starget;
7112                         if (starget && starget->hostdata) {
7113                                 sas_target_priv_data = starget->hostdata;
7114                                 sas_target_priv_data->tm_busy = 0;
7115                                 sas_target_priv_data->deleted = 0;
7116                         } else
7117                                 sas_target_priv_data = NULL;
7118                         if (starget) {
7119                                 starget_printk(KERN_INFO, starget,
7120                                     "handle(0x%04x), sas_addr(0x%016llx)\n",
7121                                     sas_device_pg0->DevHandle,
7122                                     (unsigned long long)
7123                                     sas_device->sas_address);
7124
7125                                 if (sas_device->enclosure_handle != 0)
7126                                         starget_printk(KERN_INFO, starget,
7127                                          "enclosure logical id(0x%016llx),"
7128                                          " slot(%d)\n",
7129                                          (unsigned long long)
7130                                          sas_device->enclosure_logical_id,
7131                                          sas_device->slot);
7132                         }
7133                         if (sas_device_pg0->Flags &
7134                               MPI2_SAS_DEVICE0_FLAGS_ENCL_LEVEL_VALID) {
7135                                 sas_device->enclosure_level =
7136                                    sas_device_pg0->EnclosureLevel;
7137                                 memcpy(&sas_device->connector_name[0],
7138                                         &sas_device_pg0->ConnectorName[0], 4);
7139                         } else {
7140                                 sas_device->enclosure_level = 0;
7141                                 sas_device->connector_name[0] = '\0';
7142                         }
7143
7144                         if (sas_device->handle == sas_device_pg0->DevHandle)
7145                                 goto out;
7146                         pr_info("\thandle changed from(0x%04x)!!!\n",
7147                             sas_device->handle);
7148                         sas_device->handle = sas_device_pg0->DevHandle;
7149                         if (sas_target_priv_data)
7150                                 sas_target_priv_data->handle =
7151                                         sas_device_pg0->DevHandle;
7152                         goto out;
7153                 }
7154         }
7155  out:
7156         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
7157 }
7158
7159 /**
7160  * _scsih_search_responding_sas_devices -
7161  * @ioc: per adapter object
7162  *
7163  * After host reset, find out whether devices are still responding.
7164  * If not remove.
7165  *
7166  * Return nothing.
7167  */
7168 static void
7169 _scsih_search_responding_sas_devices(struct MPT3SAS_ADAPTER *ioc)
7170 {
7171         Mpi2SasDevicePage0_t sas_device_pg0;
7172         Mpi2ConfigReply_t mpi_reply;
7173         u16 ioc_status;
7174         u16 handle;
7175         u32 device_info;
7176
7177         pr_info(MPT3SAS_FMT "search for end-devices: start\n", ioc->name);
7178
7179         if (list_empty(&ioc->sas_device_list))
7180                 goto out;
7181
7182         handle = 0xFFFF;
7183         while (!(mpt3sas_config_get_sas_device_pg0(ioc, &mpi_reply,
7184             &sas_device_pg0, MPI2_SAS_DEVICE_PGAD_FORM_GET_NEXT_HANDLE,
7185             handle))) {
7186                 ioc_status = le16_to_cpu(mpi_reply.IOCStatus) &
7187                     MPI2_IOCSTATUS_MASK;
7188                 if (ioc_status != MPI2_IOCSTATUS_SUCCESS)
7189                         break;
7190                 handle = sas_device_pg0.DevHandle =
7191                                 le16_to_cpu(sas_device_pg0.DevHandle);
7192                 device_info = le32_to_cpu(sas_device_pg0.DeviceInfo);
7193                 if (!(_scsih_is_end_device(device_info)))
7194                         continue;
7195                 sas_device_pg0.SASAddress =
7196                                 le64_to_cpu(sas_device_pg0.SASAddress);
7197                 sas_device_pg0.Slot = le16_to_cpu(sas_device_pg0.Slot);
7198                 sas_device_pg0.Flags = le16_to_cpu(sas_device_pg0.Flags);
7199                 _scsih_mark_responding_sas_device(ioc, &sas_device_pg0);
7200         }
7201
7202  out:
7203         pr_info(MPT3SAS_FMT "search for end-devices: complete\n",
7204             ioc->name);
7205 }
7206
7207 /**
7208  * _scsih_mark_responding_raid_device - mark a raid_device as responding
7209  * @ioc: per adapter object
7210  * @wwid: world wide identifier for raid volume
7211  * @handle: device handle
7212  *
7213  * After host reset, find out whether devices are still responding.
7214  * Used in _scsih_remove_unresponsive_raid_devices.
7215  *
7216  * Return nothing.
7217  */
7218 static void
7219 _scsih_mark_responding_raid_device(struct MPT3SAS_ADAPTER *ioc, u64 wwid,
7220         u16 handle)
7221 {
7222         struct MPT3SAS_TARGET *sas_target_priv_data = NULL;
7223         struct scsi_target *starget;
7224         struct _raid_device *raid_device;
7225         unsigned long flags;
7226
7227         spin_lock_irqsave(&ioc->raid_device_lock, flags);
7228         list_for_each_entry(raid_device, &ioc->raid_device_list, list) {
7229                 if (raid_device->wwid == wwid && raid_device->starget) {
7230                         starget = raid_device->starget;
7231                         if (starget && starget->hostdata) {
7232                                 sas_target_priv_data = starget->hostdata;
7233                                 sas_target_priv_data->deleted = 0;
7234                         } else
7235                                 sas_target_priv_data = NULL;
7236                         raid_device->responding = 1;
7237                         spin_unlock_irqrestore(&ioc->raid_device_lock, flags);
7238                         starget_printk(KERN_INFO, raid_device->starget,
7239                             "handle(0x%04x), wwid(0x%016llx)\n", handle,
7240                             (unsigned long long)raid_device->wwid);
7241
7242                         /*
7243                          * WARPDRIVE: The handles of the PDs might have changed
7244                          * across the host reset so re-initialize the
7245                          * required data for Direct IO
7246                          */
7247                         mpt3sas_init_warpdrive_properties(ioc, raid_device);
7248                         spin_lock_irqsave(&ioc->raid_device_lock, flags);
7249                         if (raid_device->handle == handle) {
7250                                 spin_unlock_irqrestore(&ioc->raid_device_lock,
7251                                     flags);
7252                                 return;
7253                         }
7254                         pr_info("\thandle changed from(0x%04x)!!!\n",
7255                             raid_device->handle);
7256                         raid_device->handle = handle;
7257                         if (sas_target_priv_data)
7258                                 sas_target_priv_data->handle = handle;
7259                         spin_unlock_irqrestore(&ioc->raid_device_lock, flags);
7260                         return;
7261                 }
7262         }
7263         spin_unlock_irqrestore(&ioc->raid_device_lock, flags);
7264 }
7265
7266 /**
7267  * _scsih_search_responding_raid_devices -
7268  * @ioc: per adapter object
7269  *
7270  * After host reset, find out whether devices are still responding.
7271  * If not remove.
7272  *
7273  * Return nothing.
7274  */
7275 static void
7276 _scsih_search_responding_raid_devices(struct MPT3SAS_ADAPTER *ioc)
7277 {
7278         Mpi2RaidVolPage1_t volume_pg1;
7279         Mpi2RaidVolPage0_t volume_pg0;
7280         Mpi2RaidPhysDiskPage0_t pd_pg0;
7281         Mpi2ConfigReply_t mpi_reply;
7282         u16 ioc_status;
7283         u16 handle;
7284         u8 phys_disk_num;
7285
7286         if (!ioc->ir_firmware)
7287                 return;
7288
7289         pr_info(MPT3SAS_FMT "search for raid volumes: start\n",
7290             ioc->name);
7291
7292         if (list_empty(&ioc->raid_device_list))
7293                 goto out;
7294
7295         handle = 0xFFFF;
7296         while (!(mpt3sas_config_get_raid_volume_pg1(ioc, &mpi_reply,
7297             &volume_pg1, MPI2_RAID_VOLUME_PGAD_FORM_GET_NEXT_HANDLE, handle))) {
7298                 ioc_status = le16_to_cpu(mpi_reply.IOCStatus) &
7299                     MPI2_IOCSTATUS_MASK;
7300                 if (ioc_status != MPI2_IOCSTATUS_SUCCESS)
7301                         break;
7302                 handle = le16_to_cpu(volume_pg1.DevHandle);
7303
7304                 if (mpt3sas_config_get_raid_volume_pg0(ioc, &mpi_reply,
7305                     &volume_pg0, MPI2_RAID_VOLUME_PGAD_FORM_HANDLE, handle,
7306                      sizeof(Mpi2RaidVolPage0_t)))
7307                         continue;
7308
7309                 if (volume_pg0.VolumeState == MPI2_RAID_VOL_STATE_OPTIMAL ||
7310                     volume_pg0.VolumeState == MPI2_RAID_VOL_STATE_ONLINE ||
7311                     volume_pg0.VolumeState == MPI2_RAID_VOL_STATE_DEGRADED)
7312                         _scsih_mark_responding_raid_device(ioc,
7313                             le64_to_cpu(volume_pg1.WWID), handle);
7314         }
7315
7316         /* refresh the pd_handles */
7317         if (!ioc->is_warpdrive) {
7318                 phys_disk_num = 0xFF;
7319                 memset(ioc->pd_handles, 0, ioc->pd_handles_sz);
7320                 while (!(mpt3sas_config_get_phys_disk_pg0(ioc, &mpi_reply,
7321                     &pd_pg0, MPI2_PHYSDISK_PGAD_FORM_GET_NEXT_PHYSDISKNUM,
7322                     phys_disk_num))) {
7323                         ioc_status = le16_to_cpu(mpi_reply.IOCStatus) &
7324                             MPI2_IOCSTATUS_MASK;
7325                         if (ioc_status != MPI2_IOCSTATUS_SUCCESS)
7326                                 break;
7327                         phys_disk_num = pd_pg0.PhysDiskNum;
7328                         handle = le16_to_cpu(pd_pg0.DevHandle);
7329                         set_bit(handle, ioc->pd_handles);
7330                 }
7331         }
7332  out:
7333         pr_info(MPT3SAS_FMT "search for responding raid volumes: complete\n",
7334                 ioc->name);
7335 }
7336
7337 /**
7338  * _scsih_mark_responding_expander - mark a expander as responding
7339  * @ioc: per adapter object
7340  * @sas_address: sas address
7341  * @handle:
7342  *
7343  * After host reset, find out whether devices are still responding.
7344  * Used in _scsih_remove_unresponsive_expanders.
7345  *
7346  * Return nothing.
7347  */
7348 static void
7349 _scsih_mark_responding_expander(struct MPT3SAS_ADAPTER *ioc, u64 sas_address,
7350         u16 handle)
7351 {
7352         struct _sas_node *sas_expander;
7353         unsigned long flags;
7354         int i;
7355
7356         spin_lock_irqsave(&ioc->sas_node_lock, flags);
7357         list_for_each_entry(sas_expander, &ioc->sas_expander_list, list) {
7358                 if (sas_expander->sas_address != sas_address)
7359                         continue;
7360                 sas_expander->responding = 1;
7361                 if (sas_expander->handle == handle)
7362                         goto out;
7363                 pr_info("\texpander(0x%016llx): handle changed" \
7364                     " from(0x%04x) to (0x%04x)!!!\n",
7365                     (unsigned long long)sas_expander->sas_address,
7366                     sas_expander->handle, handle);
7367                 sas_expander->handle = handle;
7368                 for (i = 0 ; i < sas_expander->num_phys ; i++)
7369                         sas_expander->phy[i].handle = handle;
7370                 goto out;
7371         }
7372  out:
7373         spin_unlock_irqrestore(&ioc->sas_node_lock, flags);
7374 }
7375
7376 /**
7377  * _scsih_search_responding_expanders -
7378  * @ioc: per adapter object
7379  *
7380  * After host reset, find out whether devices are still responding.
7381  * If not remove.
7382  *
7383  * Return nothing.
7384  */
7385 static void
7386 _scsih_search_responding_expanders(struct MPT3SAS_ADAPTER *ioc)
7387 {
7388         Mpi2ExpanderPage0_t expander_pg0;
7389         Mpi2ConfigReply_t mpi_reply;
7390         u16 ioc_status;
7391         u64 sas_address;
7392         u16 handle;
7393
7394         pr_info(MPT3SAS_FMT "search for expanders: start\n", ioc->name);
7395
7396         if (list_empty(&ioc->sas_expander_list))
7397                 goto out;
7398
7399         handle = 0xFFFF;
7400         while (!(mpt3sas_config_get_expander_pg0(ioc, &mpi_reply, &expander_pg0,
7401             MPI2_SAS_EXPAND_PGAD_FORM_GET_NEXT_HNDL, handle))) {
7402
7403                 ioc_status = le16_to_cpu(mpi_reply.IOCStatus) &
7404                     MPI2_IOCSTATUS_MASK;
7405                 if (ioc_status != MPI2_IOCSTATUS_SUCCESS)
7406                         break;
7407
7408                 handle = le16_to_cpu(expander_pg0.DevHandle);
7409                 sas_address = le64_to_cpu(expander_pg0.SASAddress);
7410                 pr_info("\texpander present: handle(0x%04x), sas_addr(0x%016llx)\n",
7411                         handle,
7412                     (unsigned long long)sas_address);
7413                 _scsih_mark_responding_expander(ioc, sas_address, handle);
7414         }
7415
7416  out:
7417         pr_info(MPT3SAS_FMT "search for expanders: complete\n", ioc->name);
7418 }
7419
7420 /**
7421  * _scsih_remove_unresponding_sas_devices - removing unresponding devices
7422  * @ioc: per adapter object
7423  *
7424  * Return nothing.
7425  */
7426 static void
7427 _scsih_remove_unresponding_sas_devices(struct MPT3SAS_ADAPTER *ioc)
7428 {
7429         struct _sas_device *sas_device, *sas_device_next;
7430         struct _sas_node *sas_expander, *sas_expander_next;
7431         struct _raid_device *raid_device, *raid_device_next;
7432         struct list_head tmp_list;
7433         unsigned long flags;
7434         LIST_HEAD(head);
7435
7436         pr_info(MPT3SAS_FMT "removing unresponding devices: start\n",
7437             ioc->name);
7438
7439         /* removing unresponding end devices */
7440         pr_info(MPT3SAS_FMT "removing unresponding devices: end-devices\n",
7441             ioc->name);
7442         /*
7443          * Iterate, pulling off devices marked as non-responding. We become the
7444          * owner for the reference the list had on any object we prune.
7445          */
7446         spin_lock_irqsave(&ioc->sas_device_lock, flags);
7447         list_for_each_entry_safe(sas_device, sas_device_next,
7448             &ioc->sas_device_list, list) {
7449                 if (!sas_device->responding)
7450                         list_move_tail(&sas_device->list, &head);
7451                 else
7452                         sas_device->responding = 0;
7453         }
7454         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
7455
7456         /*
7457          * Now, uninitialize and remove the unresponding devices we pruned.
7458          */
7459         list_for_each_entry_safe(sas_device, sas_device_next, &head, list) {
7460                 _scsih_remove_device(ioc, sas_device);
7461                 list_del_init(&sas_device->list);
7462                 sas_device_put(sas_device);
7463         }
7464
7465         /* removing unresponding volumes */
7466         if (ioc->ir_firmware) {
7467                 pr_info(MPT3SAS_FMT "removing unresponding devices: volumes\n",
7468                         ioc->name);
7469                 list_for_each_entry_safe(raid_device, raid_device_next,
7470                     &ioc->raid_device_list, list) {
7471                         if (!raid_device->responding)
7472                                 _scsih_sas_volume_delete(ioc,
7473                                     raid_device->handle);
7474                         else
7475                                 raid_device->responding = 0;
7476                 }
7477         }
7478
7479         /* removing unresponding expanders */
7480         pr_info(MPT3SAS_FMT "removing unresponding devices: expanders\n",
7481             ioc->name);
7482         spin_lock_irqsave(&ioc->sas_node_lock, flags);
7483         INIT_LIST_HEAD(&tmp_list);
7484         list_for_each_entry_safe(sas_expander, sas_expander_next,
7485             &ioc->sas_expander_list, list) {
7486                 if (!sas_expander->responding)
7487                         list_move_tail(&sas_expander->list, &tmp_list);
7488                 else
7489                         sas_expander->responding = 0;
7490         }
7491         spin_unlock_irqrestore(&ioc->sas_node_lock, flags);
7492         list_for_each_entry_safe(sas_expander, sas_expander_next, &tmp_list,
7493             list) {
7494                 list_del(&sas_expander->list);
7495                 _scsih_expander_node_remove(ioc, sas_expander);
7496         }
7497
7498         pr_info(MPT3SAS_FMT "removing unresponding devices: complete\n",
7499             ioc->name);
7500
7501         /* unblock devices */
7502         _scsih_ublock_io_all_device(ioc);
7503 }
7504
7505 static void
7506 _scsih_refresh_expander_links(struct MPT3SAS_ADAPTER *ioc,
7507         struct _sas_node *sas_expander, u16 handle)
7508 {
7509         Mpi2ExpanderPage1_t expander_pg1;
7510         Mpi2ConfigReply_t mpi_reply;
7511         int i;
7512
7513         for (i = 0 ; i < sas_expander->num_phys ; i++) {
7514                 if ((mpt3sas_config_get_expander_pg1(ioc, &mpi_reply,
7515                     &expander_pg1, i, handle))) {
7516                         pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
7517                             ioc->name, __FILE__, __LINE__, __func__);
7518                         return;
7519                 }
7520
7521                 mpt3sas_transport_update_links(ioc, sas_expander->sas_address,
7522                     le16_to_cpu(expander_pg1.AttachedDevHandle), i,
7523                     expander_pg1.NegotiatedLinkRate >> 4);
7524         }
7525 }
7526
7527 /**
7528  * _scsih_scan_for_devices_after_reset - scan for devices after host reset
7529  * @ioc: per adapter object
7530  *
7531  * Return nothing.
7532  */
7533 static void
7534 _scsih_scan_for_devices_after_reset(struct MPT3SAS_ADAPTER *ioc)
7535 {
7536         Mpi2ExpanderPage0_t expander_pg0;
7537         Mpi2SasDevicePage0_t sas_device_pg0;
7538         Mpi2RaidVolPage1_t volume_pg1;
7539         Mpi2RaidVolPage0_t volume_pg0;
7540         Mpi2RaidPhysDiskPage0_t pd_pg0;
7541         Mpi2EventIrConfigElement_t element;
7542         Mpi2ConfigReply_t mpi_reply;
7543         u8 phys_disk_num;
7544         u16 ioc_status;
7545         u16 handle, parent_handle;
7546         u64 sas_address;
7547         struct _sas_device *sas_device;
7548         struct _sas_node *expander_device;
7549         static struct _raid_device *raid_device;
7550         u8 retry_count;
7551         unsigned long flags;
7552
7553         pr_info(MPT3SAS_FMT "scan devices: start\n", ioc->name);
7554
7555         _scsih_sas_host_refresh(ioc);
7556
7557         pr_info(MPT3SAS_FMT "\tscan devices: expanders start\n", ioc->name);
7558
7559         /* expanders */
7560         handle = 0xFFFF;
7561         while (!(mpt3sas_config_get_expander_pg0(ioc, &mpi_reply, &expander_pg0,
7562             MPI2_SAS_EXPAND_PGAD_FORM_GET_NEXT_HNDL, handle))) {
7563                 ioc_status = le16_to_cpu(mpi_reply.IOCStatus) &
7564                     MPI2_IOCSTATUS_MASK;
7565                 if (ioc_status != MPI2_IOCSTATUS_SUCCESS) {
7566                         pr_info(MPT3SAS_FMT "\tbreak from expander scan: " \
7567                             "ioc_status(0x%04x), loginfo(0x%08x)\n",
7568                             ioc->name, ioc_status,
7569                             le32_to_cpu(mpi_reply.IOCLogInfo));
7570                         break;
7571                 }
7572                 handle = le16_to_cpu(expander_pg0.DevHandle);
7573                 spin_lock_irqsave(&ioc->sas_node_lock, flags);
7574                 expander_device = mpt3sas_scsih_expander_find_by_sas_address(
7575                     ioc, le64_to_cpu(expander_pg0.SASAddress));
7576                 spin_unlock_irqrestore(&ioc->sas_node_lock, flags);
7577                 if (expander_device)
7578                         _scsih_refresh_expander_links(ioc, expander_device,
7579                             handle);
7580                 else {
7581                         pr_info(MPT3SAS_FMT "\tBEFORE adding expander: " \
7582                             "handle (0x%04x), sas_addr(0x%016llx)\n", ioc->name,
7583                             handle, (unsigned long long)
7584                             le64_to_cpu(expander_pg0.SASAddress));
7585                         _scsih_expander_add(ioc, handle);
7586                         pr_info(MPT3SAS_FMT "\tAFTER adding expander: " \
7587                             "handle (0x%04x), sas_addr(0x%016llx)\n", ioc->name,
7588                             handle, (unsigned long long)
7589                             le64_to_cpu(expander_pg0.SASAddress));
7590                 }
7591         }
7592
7593         pr_info(MPT3SAS_FMT "\tscan devices: expanders complete\n",
7594             ioc->name);
7595
7596         if (!ioc->ir_firmware)
7597                 goto skip_to_sas;
7598
7599         pr_info(MPT3SAS_FMT "\tscan devices: phys disk start\n", ioc->name);
7600
7601         /* phys disk */
7602         phys_disk_num = 0xFF;
7603         while (!(mpt3sas_config_get_phys_disk_pg0(ioc, &mpi_reply,
7604             &pd_pg0, MPI2_PHYSDISK_PGAD_FORM_GET_NEXT_PHYSDISKNUM,
7605             phys_disk_num))) {
7606                 ioc_status = le16_to_cpu(mpi_reply.IOCStatus) &
7607                     MPI2_IOCSTATUS_MASK;
7608                 if (ioc_status != MPI2_IOCSTATUS_SUCCESS) {
7609                         pr_info(MPT3SAS_FMT "\tbreak from phys disk scan: "\
7610                             "ioc_status(0x%04x), loginfo(0x%08x)\n",
7611                             ioc->name, ioc_status,
7612                             le32_to_cpu(mpi_reply.IOCLogInfo));
7613                         break;
7614                 }
7615                 phys_disk_num = pd_pg0.PhysDiskNum;
7616                 handle = le16_to_cpu(pd_pg0.DevHandle);
7617                 sas_device = mpt3sas_get_sdev_by_handle(ioc, handle);
7618                 if (sas_device) {
7619                         sas_device_put(sas_device);
7620                         continue;
7621                 }
7622                 if (mpt3sas_config_get_sas_device_pg0(ioc, &mpi_reply,
7623                     &sas_device_pg0, MPI2_SAS_DEVICE_PGAD_FORM_HANDLE,
7624                     handle) != 0)
7625                         continue;
7626                 ioc_status = le16_to_cpu(mpi_reply.IOCStatus) &
7627                     MPI2_IOCSTATUS_MASK;
7628                 if (ioc_status != MPI2_IOCSTATUS_SUCCESS) {
7629                         pr_info(MPT3SAS_FMT "\tbreak from phys disk scan " \
7630                             "ioc_status(0x%04x), loginfo(0x%08x)\n",
7631                             ioc->name, ioc_status,
7632                             le32_to_cpu(mpi_reply.IOCLogInfo));
7633                         break;
7634                 }
7635                 parent_handle = le16_to_cpu(sas_device_pg0.ParentDevHandle);
7636                 if (!_scsih_get_sas_address(ioc, parent_handle,
7637                     &sas_address)) {
7638                         pr_info(MPT3SAS_FMT "\tBEFORE adding phys disk: " \
7639                             " handle (0x%04x), sas_addr(0x%016llx)\n",
7640                             ioc->name, handle, (unsigned long long)
7641                             le64_to_cpu(sas_device_pg0.SASAddress));
7642                         mpt3sas_transport_update_links(ioc, sas_address,
7643                             handle, sas_device_pg0.PhyNum,
7644                             MPI2_SAS_NEG_LINK_RATE_1_5);
7645                         set_bit(handle, ioc->pd_handles);
7646                         retry_count = 0;
7647                         /* This will retry adding the end device.
7648                          * _scsih_add_device() will decide on retries and
7649                          * return "1" when it should be retried
7650                          */
7651                         while (_scsih_add_device(ioc, handle, retry_count++,
7652                             1)) {
7653                                 ssleep(1);
7654                         }
7655                         pr_info(MPT3SAS_FMT "\tAFTER adding phys disk: " \
7656                             " handle (0x%04x), sas_addr(0x%016llx)\n",
7657                             ioc->name, handle, (unsigned long long)
7658                             le64_to_cpu(sas_device_pg0.SASAddress));
7659                 }
7660         }
7661
7662         pr_info(MPT3SAS_FMT "\tscan devices: phys disk complete\n",
7663             ioc->name);
7664
7665         pr_info(MPT3SAS_FMT "\tscan devices: volumes start\n", ioc->name);
7666
7667         /* volumes */
7668         handle = 0xFFFF;
7669         while (!(mpt3sas_config_get_raid_volume_pg1(ioc, &mpi_reply,
7670             &volume_pg1, MPI2_RAID_VOLUME_PGAD_FORM_GET_NEXT_HANDLE, handle))) {
7671                 ioc_status = le16_to_cpu(mpi_reply.IOCStatus) &
7672                     MPI2_IOCSTATUS_MASK;
7673                 if (ioc_status != MPI2_IOCSTATUS_SUCCESS) {
7674                         pr_info(MPT3SAS_FMT "\tbreak from volume scan: " \
7675                             "ioc_status(0x%04x), loginfo(0x%08x)\n",
7676                             ioc->name, ioc_status,
7677                             le32_to_cpu(mpi_reply.IOCLogInfo));
7678                         break;
7679                 }
7680                 handle = le16_to_cpu(volume_pg1.DevHandle);
7681                 spin_lock_irqsave(&ioc->raid_device_lock, flags);
7682                 raid_device = _scsih_raid_device_find_by_wwid(ioc,
7683                     le64_to_cpu(volume_pg1.WWID));
7684                 spin_unlock_irqrestore(&ioc->raid_device_lock, flags);
7685                 if (raid_device)
7686                         continue;
7687                 if (mpt3sas_config_get_raid_volume_pg0(ioc, &mpi_reply,
7688                     &volume_pg0, MPI2_RAID_VOLUME_PGAD_FORM_HANDLE, handle,
7689                      sizeof(Mpi2RaidVolPage0_t)))
7690                         continue;
7691                 ioc_status = le16_to_cpu(mpi_reply.IOCStatus) &
7692                     MPI2_IOCSTATUS_MASK;
7693                 if (ioc_status != MPI2_IOCSTATUS_SUCCESS) {
7694                         pr_info(MPT3SAS_FMT "\tbreak from volume scan: " \
7695                             "ioc_status(0x%04x), loginfo(0x%08x)\n",
7696                             ioc->name, ioc_status,
7697                             le32_to_cpu(mpi_reply.IOCLogInfo));
7698                         break;
7699                 }
7700                 if (volume_pg0.VolumeState == MPI2_RAID_VOL_STATE_OPTIMAL ||
7701                     volume_pg0.VolumeState == MPI2_RAID_VOL_STATE_ONLINE ||
7702                     volume_pg0.VolumeState == MPI2_RAID_VOL_STATE_DEGRADED) {
7703                         memset(&element, 0, sizeof(Mpi2EventIrConfigElement_t));
7704                         element.ReasonCode = MPI2_EVENT_IR_CHANGE_RC_ADDED;
7705                         element.VolDevHandle = volume_pg1.DevHandle;
7706                         pr_info(MPT3SAS_FMT
7707                                 "\tBEFORE adding volume: handle (0x%04x)\n",
7708                                 ioc->name, volume_pg1.DevHandle);
7709                         _scsih_sas_volume_add(ioc, &element);
7710                         pr_info(MPT3SAS_FMT
7711                                 "\tAFTER adding volume: handle (0x%04x)\n",
7712                                 ioc->name, volume_pg1.DevHandle);
7713                 }
7714         }
7715
7716         pr_info(MPT3SAS_FMT "\tscan devices: volumes complete\n",
7717             ioc->name);
7718
7719  skip_to_sas:
7720
7721         pr_info(MPT3SAS_FMT "\tscan devices: end devices start\n",
7722             ioc->name);
7723
7724         /* sas devices */
7725         handle = 0xFFFF;
7726         while (!(mpt3sas_config_get_sas_device_pg0(ioc, &mpi_reply,
7727             &sas_device_pg0, MPI2_SAS_DEVICE_PGAD_FORM_GET_NEXT_HANDLE,
7728             handle))) {
7729                 ioc_status = le16_to_cpu(mpi_reply.IOCStatus) &
7730                     MPI2_IOCSTATUS_MASK;
7731                 if (ioc_status != MPI2_IOCSTATUS_SUCCESS) {
7732                         pr_info(MPT3SAS_FMT "\tbreak from end device scan:"\
7733                             " ioc_status(0x%04x), loginfo(0x%08x)\n",
7734                             ioc->name, ioc_status,
7735                             le32_to_cpu(mpi_reply.IOCLogInfo));
7736                         break;
7737                 }
7738                 handle = le16_to_cpu(sas_device_pg0.DevHandle);
7739                 if (!(_scsih_is_end_device(
7740                     le32_to_cpu(sas_device_pg0.DeviceInfo))))
7741                         continue;
7742                 sas_device = mpt3sas_get_sdev_by_addr(ioc,
7743                     le64_to_cpu(sas_device_pg0.SASAddress));
7744                 if (sas_device) {
7745                         sas_device_put(sas_device);
7746                         continue;
7747                 }
7748                 parent_handle = le16_to_cpu(sas_device_pg0.ParentDevHandle);
7749                 if (!_scsih_get_sas_address(ioc, parent_handle, &sas_address)) {
7750                         pr_info(MPT3SAS_FMT "\tBEFORE adding end device: " \
7751                             "handle (0x%04x), sas_addr(0x%016llx)\n", ioc->name,
7752                             handle, (unsigned long long)
7753                             le64_to_cpu(sas_device_pg0.SASAddress));
7754                         mpt3sas_transport_update_links(ioc, sas_address, handle,
7755                             sas_device_pg0.PhyNum, MPI2_SAS_NEG_LINK_RATE_1_5);
7756                         retry_count = 0;
7757                         /* This will retry adding the end device.
7758                          * _scsih_add_device() will decide on retries and
7759                          * return "1" when it should be retried
7760                          */
7761                         while (_scsih_add_device(ioc, handle, retry_count++,
7762                             0)) {
7763                                 ssleep(1);
7764                         }
7765                         pr_info(MPT3SAS_FMT "\tAFTER adding end device: " \
7766                             "handle (0x%04x), sas_addr(0x%016llx)\n", ioc->name,
7767                             handle, (unsigned long long)
7768                             le64_to_cpu(sas_device_pg0.SASAddress));
7769                 }
7770         }
7771         pr_info(MPT3SAS_FMT "\tscan devices: end devices complete\n",
7772             ioc->name);
7773
7774         pr_info(MPT3SAS_FMT "scan devices: complete\n", ioc->name);
7775 }
7776 /**
7777  * mpt3sas_scsih_reset_handler - reset callback handler (for scsih)
7778  * @ioc: per adapter object
7779  * @reset_phase: phase
7780  *
7781  * The handler for doing any required cleanup or initialization.
7782  *
7783  * The reset phase can be MPT3_IOC_PRE_RESET, MPT3_IOC_AFTER_RESET,
7784  * MPT3_IOC_DONE_RESET
7785  *
7786  * Return nothing.
7787  */
7788 void
7789 mpt3sas_scsih_reset_handler(struct MPT3SAS_ADAPTER *ioc, int reset_phase)
7790 {
7791         switch (reset_phase) {
7792         case MPT3_IOC_PRE_RESET:
7793                 dtmprintk(ioc, pr_info(MPT3SAS_FMT
7794                         "%s: MPT3_IOC_PRE_RESET\n", ioc->name, __func__));
7795                 break;
7796         case MPT3_IOC_AFTER_RESET:
7797                 dtmprintk(ioc, pr_info(MPT3SAS_FMT
7798                         "%s: MPT3_IOC_AFTER_RESET\n", ioc->name, __func__));
7799                 if (ioc->scsih_cmds.status & MPT3_CMD_PENDING) {
7800                         ioc->scsih_cmds.status |= MPT3_CMD_RESET;
7801                         mpt3sas_base_free_smid(ioc, ioc->scsih_cmds.smid);
7802                         complete(&ioc->scsih_cmds.done);
7803                 }
7804                 if (ioc->tm_cmds.status & MPT3_CMD_PENDING) {
7805                         ioc->tm_cmds.status |= MPT3_CMD_RESET;
7806                         mpt3sas_base_free_smid(ioc, ioc->tm_cmds.smid);
7807                         complete(&ioc->tm_cmds.done);
7808                 }
7809
7810                 memset(ioc->pend_os_device_add, 0, ioc->pend_os_device_add_sz);
7811                 memset(ioc->device_remove_in_progress, 0,
7812                        ioc->device_remove_in_progress_sz);
7813                 _scsih_fw_event_cleanup_queue(ioc);
7814                 _scsih_flush_running_cmds(ioc);
7815                 break;
7816         case MPT3_IOC_DONE_RESET:
7817                 dtmprintk(ioc, pr_info(MPT3SAS_FMT
7818                         "%s: MPT3_IOC_DONE_RESET\n", ioc->name, __func__));
7819                 if ((!ioc->is_driver_loading) && !(disable_discovery > 0 &&
7820                     !ioc->sas_hba.num_phys)) {
7821                         _scsih_prep_device_scan(ioc);
7822                         _scsih_search_responding_sas_devices(ioc);
7823                         _scsih_search_responding_raid_devices(ioc);
7824                         _scsih_search_responding_expanders(ioc);
7825                         _scsih_error_recovery_delete_devices(ioc);
7826                 }
7827                 break;
7828         }
7829 }
7830
7831 /**
7832  * _mpt3sas_fw_work - delayed task for processing firmware events
7833  * @ioc: per adapter object
7834  * @fw_event: The fw_event_work object
7835  * Context: user.
7836  *
7837  * Return nothing.
7838  */
7839 static void
7840 _mpt3sas_fw_work(struct MPT3SAS_ADAPTER *ioc, struct fw_event_work *fw_event)
7841 {
7842         _scsih_fw_event_del_from_list(ioc, fw_event);
7843
7844         /* the queue is being flushed so ignore this event */
7845         if (ioc->remove_host || ioc->pci_error_recovery) {
7846                 fw_event_work_put(fw_event);
7847                 return;
7848         }
7849
7850         switch (fw_event->event) {
7851         case MPT3SAS_PROCESS_TRIGGER_DIAG:
7852                 mpt3sas_process_trigger_data(ioc,
7853                         (struct SL_WH_TRIGGERS_EVENT_DATA_T *)
7854                         fw_event->event_data);
7855                 break;
7856         case MPT3SAS_REMOVE_UNRESPONDING_DEVICES:
7857                 while (scsi_host_in_recovery(ioc->shost) ||
7858                                          ioc->shost_recovery) {
7859                         /*
7860                          * If we're unloading, bail. Otherwise, this can become
7861                          * an infinite loop.
7862                          */
7863                         if (ioc->remove_host)
7864                                 goto out;
7865                         ssleep(1);
7866                 }
7867                 _scsih_remove_unresponding_sas_devices(ioc);
7868                 _scsih_scan_for_devices_after_reset(ioc);
7869                 break;
7870         case MPT3SAS_PORT_ENABLE_COMPLETE:
7871                 ioc->start_scan = 0;
7872         if (missing_delay[0] != -1 && missing_delay[1] != -1)
7873                         mpt3sas_base_update_missing_delay(ioc, missing_delay[0],
7874                             missing_delay[1]);
7875                 dewtprintk(ioc, pr_info(MPT3SAS_FMT
7876                         "port enable: complete from worker thread\n",
7877                         ioc->name));
7878                 break;
7879         case MPT3SAS_TURN_ON_PFA_LED:
7880                 _scsih_turn_on_pfa_led(ioc, fw_event->device_handle);
7881                 break;
7882         case MPI2_EVENT_SAS_TOPOLOGY_CHANGE_LIST:
7883                 _scsih_sas_topology_change_event(ioc, fw_event);
7884                 break;
7885         case MPI2_EVENT_SAS_DEVICE_STATUS_CHANGE:
7886                 _scsih_sas_device_status_change_event(ioc, fw_event);
7887                 break;
7888         case MPI2_EVENT_SAS_DISCOVERY:
7889                 _scsih_sas_discovery_event(ioc, fw_event);
7890                 break;
7891         case MPI2_EVENT_SAS_BROADCAST_PRIMITIVE:
7892                 _scsih_sas_broadcast_primitive_event(ioc, fw_event);
7893                 break;
7894         case MPI2_EVENT_SAS_ENCL_DEVICE_STATUS_CHANGE:
7895                 _scsih_sas_enclosure_dev_status_change_event(ioc,
7896                     fw_event);
7897                 break;
7898         case MPI2_EVENT_IR_CONFIGURATION_CHANGE_LIST:
7899                 _scsih_sas_ir_config_change_event(ioc, fw_event);
7900                 break;
7901         case MPI2_EVENT_IR_VOLUME:
7902                 _scsih_sas_ir_volume_event(ioc, fw_event);
7903                 break;
7904         case MPI2_EVENT_IR_PHYSICAL_DISK:
7905                 _scsih_sas_ir_physical_disk_event(ioc, fw_event);
7906                 break;
7907         case MPI2_EVENT_IR_OPERATION_STATUS:
7908                 _scsih_sas_ir_operation_status_event(ioc, fw_event);
7909                 break;
7910         }
7911 out:
7912         fw_event_work_put(fw_event);
7913 }
7914
7915 /**
7916  * _firmware_event_work
7917  * @ioc: per adapter object
7918  * @work: The fw_event_work object
7919  * Context: user.
7920  *
7921  * wrappers for the work thread handling firmware events
7922  *
7923  * Return nothing.
7924  */
7925
7926 static void
7927 _firmware_event_work(struct work_struct *work)
7928 {
7929         struct fw_event_work *fw_event = container_of(work,
7930             struct fw_event_work, work);
7931
7932         _mpt3sas_fw_work(fw_event->ioc, fw_event);
7933 }
7934
7935 /**
7936  * mpt3sas_scsih_event_callback - firmware event handler (called at ISR time)
7937  * @ioc: per adapter object
7938  * @msix_index: MSIX table index supplied by the OS
7939  * @reply: reply message frame(lower 32bit addr)
7940  * Context: interrupt.
7941  *
7942  * This function merely adds a new work task into ioc->firmware_event_thread.
7943  * The tasks are worked from _firmware_event_work in user context.
7944  *
7945  * Return 1 meaning mf should be freed from _base_interrupt
7946  *        0 means the mf is freed from this function.
7947  */
7948 u8
7949 mpt3sas_scsih_event_callback(struct MPT3SAS_ADAPTER *ioc, u8 msix_index,
7950         u32 reply)
7951 {
7952         struct fw_event_work *fw_event;
7953         Mpi2EventNotificationReply_t *mpi_reply;
7954         u16 event;
7955         u16 sz;
7956         Mpi26EventDataActiveCableExcept_t *ActiveCableEventData;
7957
7958         /* events turned off due to host reset or driver unloading */
7959         if (ioc->remove_host || ioc->pci_error_recovery)
7960                 return 1;
7961
7962         mpi_reply = mpt3sas_base_get_reply_virt_addr(ioc, reply);
7963
7964         if (unlikely(!mpi_reply)) {
7965                 pr_err(MPT3SAS_FMT "mpi_reply not valid at %s:%d/%s()!\n",
7966                     ioc->name, __FILE__, __LINE__, __func__);
7967                 return 1;
7968         }
7969
7970         event = le16_to_cpu(mpi_reply->Event);
7971
7972         if (event != MPI2_EVENT_LOG_ENTRY_ADDED)
7973                 mpt3sas_trigger_event(ioc, event, 0);
7974
7975         switch (event) {
7976         /* handle these */
7977         case MPI2_EVENT_SAS_BROADCAST_PRIMITIVE:
7978         {
7979                 Mpi2EventDataSasBroadcastPrimitive_t *baen_data =
7980                     (Mpi2EventDataSasBroadcastPrimitive_t *)
7981                     mpi_reply->EventData;
7982
7983                 if (baen_data->Primitive !=
7984                     MPI2_EVENT_PRIMITIVE_ASYNCHRONOUS_EVENT)
7985                         return 1;
7986
7987                 if (ioc->broadcast_aen_busy) {
7988                         ioc->broadcast_aen_pending++;
7989                         return 1;
7990                 } else
7991                         ioc->broadcast_aen_busy = 1;
7992                 break;
7993         }
7994
7995         case MPI2_EVENT_SAS_TOPOLOGY_CHANGE_LIST:
7996                 _scsih_check_topo_delete_events(ioc,
7997                     (Mpi2EventDataSasTopologyChangeList_t *)
7998                     mpi_reply->EventData);
7999                 break;
8000         case MPI2_EVENT_IR_CONFIGURATION_CHANGE_LIST:
8001                 _scsih_check_ir_config_unhide_events(ioc,
8002                     (Mpi2EventDataIrConfigChangeList_t *)
8003                     mpi_reply->EventData);
8004                 break;
8005         case MPI2_EVENT_IR_VOLUME:
8006                 _scsih_check_volume_delete_events(ioc,
8007                     (Mpi2EventDataIrVolume_t *)
8008                     mpi_reply->EventData);
8009                 break;
8010         case MPI2_EVENT_LOG_ENTRY_ADDED:
8011         {
8012                 Mpi2EventDataLogEntryAdded_t *log_entry;
8013                 u32 *log_code;
8014
8015                 if (!ioc->is_warpdrive)
8016                         break;
8017
8018                 log_entry = (Mpi2EventDataLogEntryAdded_t *)
8019                     mpi_reply->EventData;
8020                 log_code = (u32 *)log_entry->LogData;
8021
8022                 if (le16_to_cpu(log_entry->LogEntryQualifier)
8023                     != MPT2_WARPDRIVE_LOGENTRY)
8024                         break;
8025
8026                 switch (le32_to_cpu(*log_code)) {
8027                 case MPT2_WARPDRIVE_LC_SSDT:
8028                         pr_warn(MPT3SAS_FMT "WarpDrive Warning: "
8029                             "IO Throttling has occurred in the WarpDrive "
8030                             "subsystem. Check WarpDrive documentation for "
8031                             "additional details.\n", ioc->name);
8032                         break;
8033                 case MPT2_WARPDRIVE_LC_SSDLW:
8034                         pr_warn(MPT3SAS_FMT "WarpDrive Warning: "
8035                             "Program/Erase Cycles for the WarpDrive subsystem "
8036                             "in degraded range. Check WarpDrive documentation "
8037                             "for additional details.\n", ioc->name);
8038                         break;
8039                 case MPT2_WARPDRIVE_LC_SSDLF:
8040                         pr_err(MPT3SAS_FMT "WarpDrive Fatal Error: "
8041                             "There are no Program/Erase Cycles for the "
8042                             "WarpDrive subsystem. The storage device will be "
8043                             "in read-only mode. Check WarpDrive documentation "
8044                             "for additional details.\n", ioc->name);
8045                         break;
8046                 case MPT2_WARPDRIVE_LC_BRMF:
8047                         pr_err(MPT3SAS_FMT "WarpDrive Fatal Error: "
8048                             "The Backup Rail Monitor has failed on the "
8049                             "WarpDrive subsystem. Check WarpDrive "
8050                             "documentation for additional details.\n",
8051                             ioc->name);
8052                         break;
8053                 }
8054
8055                 break;
8056         }
8057         case MPI2_EVENT_SAS_DEVICE_STATUS_CHANGE:
8058         case MPI2_EVENT_IR_OPERATION_STATUS:
8059         case MPI2_EVENT_SAS_DISCOVERY:
8060         case MPI2_EVENT_SAS_ENCL_DEVICE_STATUS_CHANGE:
8061         case MPI2_EVENT_IR_PHYSICAL_DISK:
8062                 break;
8063
8064         case MPI2_EVENT_TEMP_THRESHOLD:
8065                 _scsih_temp_threshold_events(ioc,
8066                         (Mpi2EventDataTemperature_t *)
8067                         mpi_reply->EventData);
8068                 break;
8069         case MPI2_EVENT_ACTIVE_CABLE_EXCEPTION:
8070                 ActiveCableEventData =
8071                     (Mpi26EventDataActiveCableExcept_t *) mpi_reply->EventData;
8072                 switch (ActiveCableEventData->ReasonCode) {
8073                 case MPI26_EVENT_ACTIVE_CABLE_INSUFFICIENT_POWER:
8074                         pr_notice(MPT3SAS_FMT "Receptacle ID %d: This active cable"
8075                                   " requires %d mW of power\n", ioc->name,
8076                              ActiveCableEventData->ReceptacleID,
8077                              ActiveCableEventData->ActiveCablePowerRequirement);
8078                         pr_notice(MPT3SAS_FMT "Receptacle ID %d: Devices connected"
8079                                   " to this active cable will not be seen\n",
8080                              ioc->name, ActiveCableEventData->ReceptacleID);
8081                         break;
8082
8083                 case MPI26_EVENT_ACTIVE_CABLE_DEGRADED:
8084                         pr_notice(MPT3SAS_FMT "ReceptacleID %d: This cable",
8085                                 ioc->name, ActiveCableEventData->ReceptacleID);
8086                         pr_notice(" is not running at an optimal speed(12 Gb/s)\n");
8087                         break;
8088                 }
8089
8090                 break;
8091
8092         default: /* ignore the rest */
8093                 return 1;
8094         }
8095
8096         sz = le16_to_cpu(mpi_reply->EventDataLength) * 4;
8097         fw_event = alloc_fw_event_work(sz);
8098         if (!fw_event) {
8099                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
8100                     ioc->name, __FILE__, __LINE__, __func__);
8101                 return 1;
8102         }
8103
8104         memcpy(fw_event->event_data, mpi_reply->EventData, sz);
8105         fw_event->ioc = ioc;
8106         fw_event->VF_ID = mpi_reply->VF_ID;
8107         fw_event->VP_ID = mpi_reply->VP_ID;
8108         fw_event->event = event;
8109         _scsih_fw_event_add(ioc, fw_event);
8110         fw_event_work_put(fw_event);
8111         return 1;
8112 }
8113
8114 /**
8115  * _scsih_expander_node_remove - removing expander device from list.
8116  * @ioc: per adapter object
8117  * @sas_expander: the sas_device object
8118  * Context: Calling function should acquire ioc->sas_node_lock.
8119  *
8120  * Removing object and freeing associated memory from the
8121  * ioc->sas_expander_list.
8122  *
8123  * Return nothing.
8124  */
8125 static void
8126 _scsih_expander_node_remove(struct MPT3SAS_ADAPTER *ioc,
8127         struct _sas_node *sas_expander)
8128 {
8129         struct _sas_port *mpt3sas_port, *next;
8130
8131         /* remove sibling ports attached to this expander */
8132         list_for_each_entry_safe(mpt3sas_port, next,
8133            &sas_expander->sas_port_list, port_list) {
8134                 if (ioc->shost_recovery)
8135                         return;
8136                 if (mpt3sas_port->remote_identify.device_type ==
8137                     SAS_END_DEVICE)
8138                         mpt3sas_device_remove_by_sas_address(ioc,
8139                             mpt3sas_port->remote_identify.sas_address);
8140                 else if (mpt3sas_port->remote_identify.device_type ==
8141                     SAS_EDGE_EXPANDER_DEVICE ||
8142                     mpt3sas_port->remote_identify.device_type ==
8143                     SAS_FANOUT_EXPANDER_DEVICE)
8144                         mpt3sas_expander_remove(ioc,
8145                             mpt3sas_port->remote_identify.sas_address);
8146         }
8147
8148         mpt3sas_transport_port_remove(ioc, sas_expander->sas_address,
8149             sas_expander->sas_address_parent);
8150
8151         pr_info(MPT3SAS_FMT
8152                 "expander_remove: handle(0x%04x), sas_addr(0x%016llx)\n",
8153                 ioc->name,
8154             sas_expander->handle, (unsigned long long)
8155             sas_expander->sas_address);
8156
8157         kfree(sas_expander->phy);
8158         kfree(sas_expander);
8159 }
8160
8161 /**
8162  * _scsih_ir_shutdown - IR shutdown notification
8163  * @ioc: per adapter object
8164  *
8165  * Sending RAID Action to alert the Integrated RAID subsystem of the IOC that
8166  * the host system is shutting down.
8167  *
8168  * Return nothing.
8169  */
8170 static void
8171 _scsih_ir_shutdown(struct MPT3SAS_ADAPTER *ioc)
8172 {
8173         Mpi2RaidActionRequest_t *mpi_request;
8174         Mpi2RaidActionReply_t *mpi_reply;
8175         u16 smid;
8176
8177         /* is IR firmware build loaded ? */
8178         if (!ioc->ir_firmware)
8179                 return;
8180
8181         /* are there any volumes ? */
8182         if (list_empty(&ioc->raid_device_list))
8183                 return;
8184
8185         mutex_lock(&ioc->scsih_cmds.mutex);
8186
8187         if (ioc->scsih_cmds.status != MPT3_CMD_NOT_USED) {
8188                 pr_err(MPT3SAS_FMT "%s: scsih_cmd in use\n",
8189                     ioc->name, __func__);
8190                 goto out;
8191         }
8192         ioc->scsih_cmds.status = MPT3_CMD_PENDING;
8193
8194         smid = mpt3sas_base_get_smid(ioc, ioc->scsih_cb_idx);
8195         if (!smid) {
8196                 pr_err(MPT3SAS_FMT "%s: failed obtaining a smid\n",
8197                     ioc->name, __func__);
8198                 ioc->scsih_cmds.status = MPT3_CMD_NOT_USED;
8199                 goto out;
8200         }
8201
8202         mpi_request = mpt3sas_base_get_msg_frame(ioc, smid);
8203         ioc->scsih_cmds.smid = smid;
8204         memset(mpi_request, 0, sizeof(Mpi2RaidActionRequest_t));
8205
8206         mpi_request->Function = MPI2_FUNCTION_RAID_ACTION;
8207         mpi_request->Action = MPI2_RAID_ACTION_SYSTEM_SHUTDOWN_INITIATED;
8208
8209         if (!ioc->hide_ir_msg)
8210                 pr_info(MPT3SAS_FMT "IR shutdown (sending)\n", ioc->name);
8211         init_completion(&ioc->scsih_cmds.done);
8212         ioc->put_smid_default(ioc, smid);
8213         wait_for_completion_timeout(&ioc->scsih_cmds.done, 10*HZ);
8214
8215         if (!(ioc->scsih_cmds.status & MPT3_CMD_COMPLETE)) {
8216                 pr_err(MPT3SAS_FMT "%s: timeout\n",
8217                     ioc->name, __func__);
8218                 goto out;
8219         }
8220
8221         if (ioc->scsih_cmds.status & MPT3_CMD_REPLY_VALID) {
8222                 mpi_reply = ioc->scsih_cmds.reply;
8223                 if (!ioc->hide_ir_msg)
8224                         pr_info(MPT3SAS_FMT "IR shutdown "
8225                            "(complete): ioc_status(0x%04x), loginfo(0x%08x)\n",
8226                             ioc->name, le16_to_cpu(mpi_reply->IOCStatus),
8227                             le32_to_cpu(mpi_reply->IOCLogInfo));
8228         }
8229
8230  out:
8231         ioc->scsih_cmds.status = MPT3_CMD_NOT_USED;
8232         mutex_unlock(&ioc->scsih_cmds.mutex);
8233 }
8234
8235 /**
8236  * scsih_remove - detach and remove add host
8237  * @pdev: PCI device struct
8238  *
8239  * Routine called when unloading the driver.
8240  * Return nothing.
8241  */
8242 static void scsih_remove(struct pci_dev *pdev)
8243 {
8244         struct Scsi_Host *shost = pci_get_drvdata(pdev);
8245         struct MPT3SAS_ADAPTER *ioc = shost_priv(shost);
8246         struct _sas_port *mpt3sas_port, *next_port;
8247         struct _raid_device *raid_device, *next;
8248         struct MPT3SAS_TARGET *sas_target_priv_data;
8249         struct workqueue_struct *wq;
8250         unsigned long flags;
8251
8252         ioc->remove_host = 1;
8253         _scsih_fw_event_cleanup_queue(ioc);
8254
8255         spin_lock_irqsave(&ioc->fw_event_lock, flags);
8256         wq = ioc->firmware_event_thread;
8257         ioc->firmware_event_thread = NULL;
8258         spin_unlock_irqrestore(&ioc->fw_event_lock, flags);
8259         if (wq)
8260                 destroy_workqueue(wq);
8261
8262         /* release all the volumes */
8263         _scsih_ir_shutdown(ioc);
8264         list_for_each_entry_safe(raid_device, next, &ioc->raid_device_list,
8265             list) {
8266                 if (raid_device->starget) {
8267                         sas_target_priv_data =
8268                             raid_device->starget->hostdata;
8269                         sas_target_priv_data->deleted = 1;
8270                         scsi_remove_target(&raid_device->starget->dev);
8271                 }
8272                 pr_info(MPT3SAS_FMT "removing handle(0x%04x), wwid(0x%016llx)\n",
8273                         ioc->name,  raid_device->handle,
8274                     (unsigned long long) raid_device->wwid);
8275                 _scsih_raid_device_remove(ioc, raid_device);
8276         }
8277
8278         /* free ports attached to the sas_host */
8279         list_for_each_entry_safe(mpt3sas_port, next_port,
8280            &ioc->sas_hba.sas_port_list, port_list) {
8281                 if (mpt3sas_port->remote_identify.device_type ==
8282                     SAS_END_DEVICE)
8283                         mpt3sas_device_remove_by_sas_address(ioc,
8284                             mpt3sas_port->remote_identify.sas_address);
8285                 else if (mpt3sas_port->remote_identify.device_type ==
8286                     SAS_EDGE_EXPANDER_DEVICE ||
8287                     mpt3sas_port->remote_identify.device_type ==
8288                     SAS_FANOUT_EXPANDER_DEVICE)
8289                         mpt3sas_expander_remove(ioc,
8290                             mpt3sas_port->remote_identify.sas_address);
8291         }
8292
8293         /* free phys attached to the sas_host */
8294         if (ioc->sas_hba.num_phys) {
8295                 kfree(ioc->sas_hba.phy);
8296                 ioc->sas_hba.phy = NULL;
8297                 ioc->sas_hba.num_phys = 0;
8298         }
8299
8300         sas_remove_host(shost);
8301         scsi_remove_host(shost);
8302         mpt3sas_base_detach(ioc);
8303         spin_lock(&gioc_lock);
8304         list_del(&ioc->list);
8305         spin_unlock(&gioc_lock);
8306         scsi_host_put(shost);
8307 }
8308
8309 /**
8310  * scsih_shutdown - routine call during system shutdown
8311  * @pdev: PCI device struct
8312  *
8313  * Return nothing.
8314  */
8315 static void
8316 scsih_shutdown(struct pci_dev *pdev)
8317 {
8318         struct Scsi_Host *shost = pci_get_drvdata(pdev);
8319         struct MPT3SAS_ADAPTER *ioc = shost_priv(shost);
8320         struct workqueue_struct *wq;
8321         unsigned long flags;
8322
8323         ioc->remove_host = 1;
8324         _scsih_fw_event_cleanup_queue(ioc);
8325
8326         spin_lock_irqsave(&ioc->fw_event_lock, flags);
8327         wq = ioc->firmware_event_thread;
8328         ioc->firmware_event_thread = NULL;
8329         spin_unlock_irqrestore(&ioc->fw_event_lock, flags);
8330         if (wq)
8331                 destroy_workqueue(wq);
8332
8333         _scsih_ir_shutdown(ioc);
8334         mpt3sas_base_detach(ioc);
8335 }
8336
8337
8338 /**
8339  * _scsih_probe_boot_devices - reports 1st device
8340  * @ioc: per adapter object
8341  *
8342  * If specified in bios page 2, this routine reports the 1st
8343  * device scsi-ml or sas transport for persistent boot device
8344  * purposes.  Please refer to function _scsih_determine_boot_device()
8345  */
8346 static void
8347 _scsih_probe_boot_devices(struct MPT3SAS_ADAPTER *ioc)
8348 {
8349         u8 is_raid;
8350         void *device;
8351         struct _sas_device *sas_device;
8352         struct _raid_device *raid_device;
8353         u16 handle;
8354         u64 sas_address_parent;
8355         u64 sas_address;
8356         unsigned long flags;
8357         int rc;
8358
8359          /* no Bios, return immediately */
8360         if (!ioc->bios_pg3.BiosVersion)
8361                 return;
8362
8363         device = NULL;
8364         is_raid = 0;
8365         if (ioc->req_boot_device.device) {
8366                 device =  ioc->req_boot_device.device;
8367                 is_raid = ioc->req_boot_device.is_raid;
8368         } else if (ioc->req_alt_boot_device.device) {
8369                 device =  ioc->req_alt_boot_device.device;
8370                 is_raid = ioc->req_alt_boot_device.is_raid;
8371         } else if (ioc->current_boot_device.device) {
8372                 device =  ioc->current_boot_device.device;
8373                 is_raid = ioc->current_boot_device.is_raid;
8374         }
8375
8376         if (!device)
8377                 return;
8378
8379         if (is_raid) {
8380                 raid_device = device;
8381                 rc = scsi_add_device(ioc->shost, RAID_CHANNEL,
8382                     raid_device->id, 0);
8383                 if (rc)
8384                         _scsih_raid_device_remove(ioc, raid_device);
8385         } else {
8386                 spin_lock_irqsave(&ioc->sas_device_lock, flags);
8387                 sas_device = device;
8388                 handle = sas_device->handle;
8389                 sas_address_parent = sas_device->sas_address_parent;
8390                 sas_address = sas_device->sas_address;
8391                 list_move_tail(&sas_device->list, &ioc->sas_device_list);
8392                 spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
8393
8394                 if (ioc->hide_drives)
8395                         return;
8396                 if (!mpt3sas_transport_port_add(ioc, handle,
8397                     sas_address_parent)) {
8398                         _scsih_sas_device_remove(ioc, sas_device);
8399                 } else if (!sas_device->starget) {
8400                         if (!ioc->is_driver_loading) {
8401                                 mpt3sas_transport_port_remove(ioc,
8402                                     sas_address,
8403                                     sas_address_parent);
8404                                 _scsih_sas_device_remove(ioc, sas_device);
8405                         }
8406                 }
8407         }
8408 }
8409
8410 /**
8411  * _scsih_probe_raid - reporting raid volumes to scsi-ml
8412  * @ioc: per adapter object
8413  *
8414  * Called during initial loading of the driver.
8415  */
8416 static void
8417 _scsih_probe_raid(struct MPT3SAS_ADAPTER *ioc)
8418 {
8419         struct _raid_device *raid_device, *raid_next;
8420         int rc;
8421
8422         list_for_each_entry_safe(raid_device, raid_next,
8423             &ioc->raid_device_list, list) {
8424                 if (raid_device->starget)
8425                         continue;
8426                 rc = scsi_add_device(ioc->shost, RAID_CHANNEL,
8427                     raid_device->id, 0);
8428                 if (rc)
8429                         _scsih_raid_device_remove(ioc, raid_device);
8430         }
8431 }
8432
8433 static struct _sas_device *get_next_sas_device(struct MPT3SAS_ADAPTER *ioc)
8434 {
8435         struct _sas_device *sas_device = NULL;
8436         unsigned long flags;
8437
8438         spin_lock_irqsave(&ioc->sas_device_lock, flags);
8439         if (!list_empty(&ioc->sas_device_init_list)) {
8440                 sas_device = list_first_entry(&ioc->sas_device_init_list,
8441                                 struct _sas_device, list);
8442                 sas_device_get(sas_device);
8443         }
8444         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
8445
8446         return sas_device;
8447 }
8448
8449 static void sas_device_make_active(struct MPT3SAS_ADAPTER *ioc,
8450                 struct _sas_device *sas_device)
8451 {
8452         unsigned long flags;
8453
8454         spin_lock_irqsave(&ioc->sas_device_lock, flags);
8455
8456         /*
8457          * Since we dropped the lock during the call to port_add(), we need to
8458          * be careful here that somebody else didn't move or delete this item
8459          * while we were busy with other things.
8460          *
8461          * If it was on the list, we need a put() for the reference the list
8462          * had. Either way, we need a get() for the destination list.
8463          */
8464         if (!list_empty(&sas_device->list)) {
8465                 list_del_init(&sas_device->list);
8466                 sas_device_put(sas_device);
8467         }
8468
8469         sas_device_get(sas_device);
8470         list_add_tail(&sas_device->list, &ioc->sas_device_list);
8471
8472         spin_unlock_irqrestore(&ioc->sas_device_lock, flags);
8473 }
8474
8475 /**
8476  * _scsih_probe_sas - reporting sas devices to sas transport
8477  * @ioc: per adapter object
8478  *
8479  * Called during initial loading of the driver.
8480  */
8481 static void
8482 _scsih_probe_sas(struct MPT3SAS_ADAPTER *ioc)
8483 {
8484         struct _sas_device *sas_device;
8485
8486         if (ioc->hide_drives)
8487                 return;
8488
8489         while ((sas_device = get_next_sas_device(ioc))) {
8490                 if (!mpt3sas_transport_port_add(ioc, sas_device->handle,
8491                     sas_device->sas_address_parent)) {
8492                         _scsih_sas_device_remove(ioc, sas_device);
8493                         sas_device_put(sas_device);
8494                         continue;
8495                 } else if (!sas_device->starget) {
8496                         /*
8497                          * When asyn scanning is enabled, its not possible to
8498                          * remove devices while scanning is turned on due to an
8499                          * oops in scsi_sysfs_add_sdev()->add_device()->
8500                          * sysfs_addrm_start()
8501                          */
8502                         if (!ioc->is_driver_loading) {
8503                                 mpt3sas_transport_port_remove(ioc,
8504                                     sas_device->sas_address,
8505                                     sas_device->sas_address_parent);
8506                                 _scsih_sas_device_remove(ioc, sas_device);
8507                                 sas_device_put(sas_device);
8508                                 continue;
8509                         }
8510                 }
8511                 sas_device_make_active(ioc, sas_device);
8512                 sas_device_put(sas_device);
8513         }
8514 }
8515
8516 /**
8517  * _scsih_probe_devices - probing for devices
8518  * @ioc: per adapter object
8519  *
8520  * Called during initial loading of the driver.
8521  */
8522 static void
8523 _scsih_probe_devices(struct MPT3SAS_ADAPTER *ioc)
8524 {
8525         u16 volume_mapping_flags;
8526
8527         if (!(ioc->facts.ProtocolFlags & MPI2_IOCFACTS_PROTOCOL_SCSI_INITIATOR))
8528                 return;  /* return when IOC doesn't support initiator mode */
8529
8530         _scsih_probe_boot_devices(ioc);
8531
8532         if (ioc->ir_firmware) {
8533                 volume_mapping_flags =
8534                     le16_to_cpu(ioc->ioc_pg8.IRVolumeMappingFlags) &
8535                     MPI2_IOCPAGE8_IRFLAGS_MASK_VOLUME_MAPPING_MODE;
8536                 if (volume_mapping_flags ==
8537                     MPI2_IOCPAGE8_IRFLAGS_LOW_VOLUME_MAPPING) {
8538                         _scsih_probe_raid(ioc);
8539                         _scsih_probe_sas(ioc);
8540                 } else {
8541                         _scsih_probe_sas(ioc);
8542                         _scsih_probe_raid(ioc);
8543                 }
8544         } else
8545                 _scsih_probe_sas(ioc);
8546 }
8547
8548 /**
8549  * scsih_scan_start - scsi lld callback for .scan_start
8550  * @shost: SCSI host pointer
8551  *
8552  * The shost has the ability to discover targets on its own instead
8553  * of scanning the entire bus.  In our implemention, we will kick off
8554  * firmware discovery.
8555  */
8556 static void
8557 scsih_scan_start(struct Scsi_Host *shost)
8558 {
8559         struct MPT3SAS_ADAPTER *ioc = shost_priv(shost);
8560         int rc;
8561         if (diag_buffer_enable != -1 && diag_buffer_enable != 0)
8562                 mpt3sas_enable_diag_buffer(ioc, diag_buffer_enable);
8563
8564         if (disable_discovery > 0)
8565                 return;
8566
8567         ioc->start_scan = 1;
8568         rc = mpt3sas_port_enable(ioc);
8569
8570         if (rc != 0)
8571                 pr_info(MPT3SAS_FMT "port enable: FAILED\n", ioc->name);
8572 }
8573
8574 /**
8575  * scsih_scan_finished - scsi lld callback for .scan_finished
8576  * @shost: SCSI host pointer
8577  * @time: elapsed time of the scan in jiffies
8578  *
8579  * This function will be called periodicallyn until it returns 1 with the
8580  * scsi_host and the elapsed time of the scan in jiffies. In our implemention,
8581  * we wait for firmware discovery to complete, then return 1.
8582  */
8583 static int
8584 scsih_scan_finished(struct Scsi_Host *shost, unsigned long time)
8585 {
8586         struct MPT3SAS_ADAPTER *ioc = shost_priv(shost);
8587
8588         if (disable_discovery > 0) {
8589                 ioc->is_driver_loading = 0;
8590                 ioc->wait_for_discovery_to_complete = 0;
8591                 return 1;
8592         }
8593
8594         if (time >= (300 * HZ)) {
8595                 ioc->base_cmds.status = MPT3_CMD_NOT_USED;
8596                 pr_info(MPT3SAS_FMT
8597                         "port enable: FAILED with timeout (timeout=300s)\n",
8598                         ioc->name);
8599                 ioc->is_driver_loading = 0;
8600                 return 1;
8601         }
8602
8603         if (ioc->start_scan)
8604                 return 0;
8605
8606         if (ioc->start_scan_failed) {
8607                 pr_info(MPT3SAS_FMT
8608                         "port enable: FAILED with (ioc_status=0x%08x)\n",
8609                         ioc->name, ioc->start_scan_failed);
8610                 ioc->is_driver_loading = 0;
8611                 ioc->wait_for_discovery_to_complete = 0;
8612                 ioc->remove_host = 1;
8613                 return 1;
8614         }
8615
8616         pr_info(MPT3SAS_FMT "port enable: SUCCESS\n", ioc->name);
8617         ioc->base_cmds.status = MPT3_CMD_NOT_USED;
8618
8619         if (ioc->wait_for_discovery_to_complete) {
8620                 ioc->wait_for_discovery_to_complete = 0;
8621                 _scsih_probe_devices(ioc);
8622         }
8623         mpt3sas_base_start_watchdog(ioc);
8624         ioc->is_driver_loading = 0;
8625         return 1;
8626 }
8627
8628 /* shost template for SAS 2.0 HBA devices */
8629 static struct scsi_host_template mpt2sas_driver_template = {
8630         .module                         = THIS_MODULE,
8631         .name                           = "Fusion MPT SAS Host",
8632         .proc_name                      = MPT2SAS_DRIVER_NAME,
8633         .queuecommand                   = scsih_qcmd,
8634         .target_alloc                   = scsih_target_alloc,
8635         .slave_alloc                    = scsih_slave_alloc,
8636         .slave_configure                = scsih_slave_configure,
8637         .target_destroy                 = scsih_target_destroy,
8638         .slave_destroy                  = scsih_slave_destroy,
8639         .scan_finished                  = scsih_scan_finished,
8640         .scan_start                     = scsih_scan_start,
8641         .change_queue_depth             = scsih_change_queue_depth,
8642         .eh_abort_handler               = scsih_abort,
8643         .eh_device_reset_handler        = scsih_dev_reset,
8644         .eh_target_reset_handler        = scsih_target_reset,
8645         .eh_host_reset_handler          = scsih_host_reset,
8646         .bios_param                     = scsih_bios_param,
8647         .can_queue                      = 1,
8648         .this_id                        = -1,
8649         .sg_tablesize                   = MPT2SAS_SG_DEPTH,
8650         .max_sectors                    = 32767,
8651         .cmd_per_lun                    = 7,
8652         .use_clustering                 = ENABLE_CLUSTERING,
8653         .shost_attrs                    = mpt3sas_host_attrs,
8654         .sdev_attrs                     = mpt3sas_dev_attrs,
8655         .track_queue_depth              = 1,
8656 };
8657
8658 /* raid transport support for SAS 2.0 HBA devices */
8659 static struct raid_function_template mpt2sas_raid_functions = {
8660         .cookie         = &mpt2sas_driver_template,
8661         .is_raid        = scsih_is_raid,
8662         .get_resync     = scsih_get_resync,
8663         .get_state      = scsih_get_state,
8664 };
8665
8666 /* shost template for SAS 3.0 HBA devices */
8667 static struct scsi_host_template mpt3sas_driver_template = {
8668         .module                         = THIS_MODULE,
8669         .name                           = "Fusion MPT SAS Host",
8670         .proc_name                      = MPT3SAS_DRIVER_NAME,
8671         .queuecommand                   = scsih_qcmd,
8672         .target_alloc                   = scsih_target_alloc,
8673         .slave_alloc                    = scsih_slave_alloc,
8674         .slave_configure                = scsih_slave_configure,
8675         .target_destroy                 = scsih_target_destroy,
8676         .slave_destroy                  = scsih_slave_destroy,
8677         .scan_finished                  = scsih_scan_finished,
8678         .scan_start                     = scsih_scan_start,
8679         .change_queue_depth             = scsih_change_queue_depth,
8680         .eh_abort_handler               = scsih_abort,
8681         .eh_device_reset_handler        = scsih_dev_reset,
8682         .eh_target_reset_handler        = scsih_target_reset,
8683         .eh_host_reset_handler          = scsih_host_reset,
8684         .bios_param                     = scsih_bios_param,
8685         .can_queue                      = 1,
8686         .this_id                        = -1,
8687         .sg_tablesize                   = MPT3SAS_SG_DEPTH,
8688         .max_sectors                    = 32767,
8689         .cmd_per_lun                    = 7,
8690         .use_clustering                 = ENABLE_CLUSTERING,
8691         .shost_attrs                    = mpt3sas_host_attrs,
8692         .sdev_attrs                     = mpt3sas_dev_attrs,
8693         .track_queue_depth              = 1,
8694 };
8695
8696 /* raid transport support for SAS 3.0 HBA devices */
8697 static struct raid_function_template mpt3sas_raid_functions = {
8698         .cookie         = &mpt3sas_driver_template,
8699         .is_raid        = scsih_is_raid,
8700         .get_resync     = scsih_get_resync,
8701         .get_state      = scsih_get_state,
8702 };
8703
8704 /**
8705  * _scsih_determine_hba_mpi_version - determine in which MPI version class
8706  *                                      this device belongs to.
8707  * @pdev: PCI device struct
8708  *
8709  * return MPI2_VERSION for SAS 2.0 HBA devices,
8710  *      MPI25_VERSION for SAS 3.0 HBA devices, and
8711  *      MPI26 VERSION for Cutlass & Invader SAS 3.0 HBA devices
8712  */
8713 static u16
8714 _scsih_determine_hba_mpi_version(struct pci_dev *pdev)
8715 {
8716
8717         switch (pdev->device) {
8718         case MPI2_MFGPAGE_DEVID_SSS6200:
8719         case MPI2_MFGPAGE_DEVID_SAS2004:
8720         case MPI2_MFGPAGE_DEVID_SAS2008:
8721         case MPI2_MFGPAGE_DEVID_SAS2108_1:
8722         case MPI2_MFGPAGE_DEVID_SAS2108_2:
8723         case MPI2_MFGPAGE_DEVID_SAS2108_3:
8724         case MPI2_MFGPAGE_DEVID_SAS2116_1:
8725         case MPI2_MFGPAGE_DEVID_SAS2116_2:
8726         case MPI2_MFGPAGE_DEVID_SAS2208_1:
8727         case MPI2_MFGPAGE_DEVID_SAS2208_2:
8728         case MPI2_MFGPAGE_DEVID_SAS2208_3:
8729         case MPI2_MFGPAGE_DEVID_SAS2208_4:
8730         case MPI2_MFGPAGE_DEVID_SAS2208_5:
8731         case MPI2_MFGPAGE_DEVID_SAS2208_6:
8732         case MPI2_MFGPAGE_DEVID_SAS2308_1:
8733         case MPI2_MFGPAGE_DEVID_SAS2308_2:
8734         case MPI2_MFGPAGE_DEVID_SAS2308_3:
8735                 return MPI2_VERSION;
8736         case MPI25_MFGPAGE_DEVID_SAS3004:
8737         case MPI25_MFGPAGE_DEVID_SAS3008:
8738         case MPI25_MFGPAGE_DEVID_SAS3108_1:
8739         case MPI25_MFGPAGE_DEVID_SAS3108_2:
8740         case MPI25_MFGPAGE_DEVID_SAS3108_5:
8741         case MPI25_MFGPAGE_DEVID_SAS3108_6:
8742                 return MPI25_VERSION;
8743         case MPI26_MFGPAGE_DEVID_SAS3216:
8744         case MPI26_MFGPAGE_DEVID_SAS3224:
8745         case MPI26_MFGPAGE_DEVID_SAS3316_1:
8746         case MPI26_MFGPAGE_DEVID_SAS3316_2:
8747         case MPI26_MFGPAGE_DEVID_SAS3316_3:
8748         case MPI26_MFGPAGE_DEVID_SAS3316_4:
8749         case MPI26_MFGPAGE_DEVID_SAS3324_1:
8750         case MPI26_MFGPAGE_DEVID_SAS3324_2:
8751         case MPI26_MFGPAGE_DEVID_SAS3324_3:
8752         case MPI26_MFGPAGE_DEVID_SAS3324_4:
8753         case MPI26_MFGPAGE_DEVID_SAS3508:
8754         case MPI26_MFGPAGE_DEVID_SAS3508_1:
8755         case MPI26_MFGPAGE_DEVID_SAS3408:
8756         case MPI26_MFGPAGE_DEVID_SAS3516:
8757         case MPI26_MFGPAGE_DEVID_SAS3516_1:
8758         case MPI26_MFGPAGE_DEVID_SAS3416:
8759                 return MPI26_VERSION;
8760         }
8761         return 0;
8762 }
8763
8764 /**
8765  * _scsih_probe - attach and add scsi host
8766  * @pdev: PCI device struct
8767  * @id: pci device id
8768  *
8769  * Returns 0 success, anything else error.
8770  */
8771 static int
8772 _scsih_probe(struct pci_dev *pdev, const struct pci_device_id *id)
8773 {
8774         struct MPT3SAS_ADAPTER *ioc;
8775         struct Scsi_Host *shost = NULL;
8776         int rv;
8777         u16 hba_mpi_version;
8778
8779         /* Determine in which MPI version class this pci device belongs */
8780         hba_mpi_version = _scsih_determine_hba_mpi_version(pdev);
8781         if (hba_mpi_version == 0)
8782                 return -ENODEV;
8783
8784         /* Enumerate only SAS 2.0 HBA's if hbas_to_enumerate is one,
8785          * for other generation HBA's return with -ENODEV
8786          */
8787         if ((hbas_to_enumerate == 1) && (hba_mpi_version !=  MPI2_VERSION))
8788                 return -ENODEV;
8789
8790         /* Enumerate only SAS 3.0 HBA's if hbas_to_enumerate is two,
8791          * for other generation HBA's return with -ENODEV
8792          */
8793         if ((hbas_to_enumerate == 2) && (!(hba_mpi_version ==  MPI25_VERSION
8794                 || hba_mpi_version ==  MPI26_VERSION)))
8795                 return -ENODEV;
8796
8797         switch (hba_mpi_version) {
8798         case MPI2_VERSION:
8799                 pci_disable_link_state(pdev, PCIE_LINK_STATE_L0S |
8800                         PCIE_LINK_STATE_L1 | PCIE_LINK_STATE_CLKPM);
8801                 /* Use mpt2sas driver host template for SAS 2.0 HBA's */
8802                 shost = scsi_host_alloc(&mpt2sas_driver_template,
8803                   sizeof(struct MPT3SAS_ADAPTER));
8804                 if (!shost)
8805                         return -ENODEV;
8806                 ioc = shost_priv(shost);
8807                 memset(ioc, 0, sizeof(struct MPT3SAS_ADAPTER));
8808                 ioc->hba_mpi_version_belonged = hba_mpi_version;
8809                 ioc->id = mpt2_ids++;
8810                 sprintf(ioc->driver_name, "%s", MPT2SAS_DRIVER_NAME);
8811                 if (pdev->device == MPI2_MFGPAGE_DEVID_SSS6200) {
8812                         ioc->is_warpdrive = 1;
8813                         ioc->hide_ir_msg = 1;
8814                 } else
8815                         ioc->mfg_pg10_hide_flag = MFG_PAGE10_EXPOSE_ALL_DISKS;
8816                 break;
8817         case MPI25_VERSION:
8818         case MPI26_VERSION:
8819                 /* Use mpt3sas driver host template for SAS 3.0 HBA's */
8820                 shost = scsi_host_alloc(&mpt3sas_driver_template,
8821                   sizeof(struct MPT3SAS_ADAPTER));
8822                 if (!shost)
8823                         return -ENODEV;
8824                 ioc = shost_priv(shost);
8825                 memset(ioc, 0, sizeof(struct MPT3SAS_ADAPTER));
8826                 ioc->hba_mpi_version_belonged = hba_mpi_version;
8827                 ioc->id = mpt3_ids++;
8828                 sprintf(ioc->driver_name, "%s", MPT3SAS_DRIVER_NAME);
8829                 switch (pdev->device) {
8830                 case MPI26_MFGPAGE_DEVID_SAS3508:
8831                 case MPI26_MFGPAGE_DEVID_SAS3508_1:
8832                 case MPI26_MFGPAGE_DEVID_SAS3408:
8833                 case MPI26_MFGPAGE_DEVID_SAS3516:
8834                 case MPI26_MFGPAGE_DEVID_SAS3516_1:
8835                 case MPI26_MFGPAGE_DEVID_SAS3416:
8836                         ioc->is_gen35_ioc = 1;
8837                         break;
8838                 default:
8839                         ioc->is_gen35_ioc = 0;
8840                 }
8841                 if ((ioc->hba_mpi_version_belonged == MPI25_VERSION &&
8842                         pdev->revision >= SAS3_PCI_DEVICE_C0_REVISION) ||
8843                         (ioc->hba_mpi_version_belonged == MPI26_VERSION)) {
8844                         ioc->combined_reply_queue = 1;
8845                         if (ioc->is_gen35_ioc)
8846                                 ioc->combined_reply_index_count =
8847                                  MPT3_SUP_REPLY_POST_HOST_INDEX_REG_COUNT_G35;
8848                         else
8849                                 ioc->combined_reply_index_count =
8850                                  MPT3_SUP_REPLY_POST_HOST_INDEX_REG_COUNT_G3;
8851                 }
8852                 break;
8853         default:
8854                 return -ENODEV;
8855         }
8856
8857         INIT_LIST_HEAD(&ioc->list);
8858         spin_lock(&gioc_lock);
8859         list_add_tail(&ioc->list, &mpt3sas_ioc_list);
8860         spin_unlock(&gioc_lock);
8861         ioc->shost = shost;
8862         ioc->pdev = pdev;
8863         ioc->scsi_io_cb_idx = scsi_io_cb_idx;
8864         ioc->tm_cb_idx = tm_cb_idx;
8865         ioc->ctl_cb_idx = ctl_cb_idx;
8866         ioc->base_cb_idx = base_cb_idx;
8867         ioc->port_enable_cb_idx = port_enable_cb_idx;
8868         ioc->transport_cb_idx = transport_cb_idx;
8869         ioc->scsih_cb_idx = scsih_cb_idx;
8870         ioc->config_cb_idx = config_cb_idx;
8871         ioc->tm_tr_cb_idx = tm_tr_cb_idx;
8872         ioc->tm_tr_volume_cb_idx = tm_tr_volume_cb_idx;
8873         ioc->tm_sas_control_cb_idx = tm_sas_control_cb_idx;
8874         ioc->logging_level = logging_level;
8875         ioc->schedule_dead_ioc_flush_running_cmds = &_scsih_flush_running_cmds;
8876         /* misc semaphores and spin locks */
8877         mutex_init(&ioc->reset_in_progress_mutex);
8878         /* initializing pci_access_mutex lock */
8879         mutex_init(&ioc->pci_access_mutex);
8880         spin_lock_init(&ioc->ioc_reset_in_progress_lock);
8881         spin_lock_init(&ioc->scsi_lookup_lock);
8882         spin_lock_init(&ioc->sas_device_lock);
8883         spin_lock_init(&ioc->sas_node_lock);
8884         spin_lock_init(&ioc->fw_event_lock);
8885         spin_lock_init(&ioc->raid_device_lock);
8886         spin_lock_init(&ioc->diag_trigger_lock);
8887
8888         INIT_LIST_HEAD(&ioc->sas_device_list);
8889         INIT_LIST_HEAD(&ioc->sas_device_init_list);
8890         INIT_LIST_HEAD(&ioc->sas_expander_list);
8891         INIT_LIST_HEAD(&ioc->fw_event_list);
8892         INIT_LIST_HEAD(&ioc->raid_device_list);
8893         INIT_LIST_HEAD(&ioc->sas_hba.sas_port_list);
8894         INIT_LIST_HEAD(&ioc->delayed_tr_list);
8895         INIT_LIST_HEAD(&ioc->delayed_sc_list);
8896         INIT_LIST_HEAD(&ioc->delayed_event_ack_list);
8897         INIT_LIST_HEAD(&ioc->delayed_tr_volume_list);
8898         INIT_LIST_HEAD(&ioc->reply_queue_list);
8899
8900         sprintf(ioc->name, "%s_cm%d", ioc->driver_name, ioc->id);
8901
8902         /* init shost parameters */
8903         shost->max_cmd_len = 32;
8904         shost->max_lun = max_lun;
8905         shost->transportt = mpt3sas_transport_template;
8906         shost->unique_id = ioc->id;
8907
8908         if (max_sectors != 0xFFFF) {
8909                 if (max_sectors < 64) {
8910                         shost->max_sectors = 64;
8911                         pr_warn(MPT3SAS_FMT "Invalid value %d passed " \
8912                             "for max_sectors, range is 64 to 32767. Assigning "
8913                             "value of 64.\n", ioc->name, max_sectors);
8914                 } else if (max_sectors > 32767) {
8915                         shost->max_sectors = 32767;
8916                         pr_warn(MPT3SAS_FMT "Invalid value %d passed " \
8917                             "for max_sectors, range is 64 to 32767. Assigning "
8918                             "default value of 32767.\n", ioc->name,
8919                             max_sectors);
8920                 } else {
8921                         shost->max_sectors = max_sectors & 0xFFFE;
8922                         pr_info(MPT3SAS_FMT
8923                                 "The max_sectors value is set to %d\n",
8924                                 ioc->name, shost->max_sectors);
8925                 }
8926         }
8927
8928         /* register EEDP capabilities with SCSI layer */
8929         if (prot_mask > 0)
8930                 scsi_host_set_prot(shost, prot_mask);
8931         else
8932                 scsi_host_set_prot(shost, SHOST_DIF_TYPE1_PROTECTION
8933                                    | SHOST_DIF_TYPE2_PROTECTION
8934                                    | SHOST_DIF_TYPE3_PROTECTION);
8935
8936         scsi_host_set_guard(shost, SHOST_DIX_GUARD_CRC);
8937
8938         /* event thread */
8939         snprintf(ioc->firmware_event_name, sizeof(ioc->firmware_event_name),
8940             "fw_event_%s%d", ioc->driver_name, ioc->id);
8941         ioc->firmware_event_thread = alloc_ordered_workqueue(
8942             ioc->firmware_event_name, WQ_MEM_RECLAIM);
8943         if (!ioc->firmware_event_thread) {
8944                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
8945                     ioc->name, __FILE__, __LINE__, __func__);
8946                 rv = -ENODEV;
8947                 goto out_thread_fail;
8948         }
8949
8950         ioc->is_driver_loading = 1;
8951         if ((mpt3sas_base_attach(ioc))) {
8952                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
8953                     ioc->name, __FILE__, __LINE__, __func__);
8954                 rv = -ENODEV;
8955                 goto out_attach_fail;
8956         }
8957
8958         if (ioc->is_warpdrive) {
8959                 if (ioc->mfg_pg10_hide_flag ==  MFG_PAGE10_EXPOSE_ALL_DISKS)
8960                         ioc->hide_drives = 0;
8961                 else if (ioc->mfg_pg10_hide_flag ==  MFG_PAGE10_HIDE_ALL_DISKS)
8962                         ioc->hide_drives = 1;
8963                 else {
8964                         if (mpt3sas_get_num_volumes(ioc))
8965                                 ioc->hide_drives = 1;
8966                         else
8967                                 ioc->hide_drives = 0;
8968                 }
8969         } else
8970                 ioc->hide_drives = 0;
8971
8972         rv = scsi_add_host(shost, &pdev->dev);
8973         if (rv) {
8974                 pr_err(MPT3SAS_FMT "failure at %s:%d/%s()!\n",
8975                     ioc->name, __FILE__, __LINE__, __func__);
8976                 goto out_add_shost_fail;
8977         }
8978
8979         scsi_scan_host(shost);
8980         return 0;
8981 out_add_shost_fail:
8982         mpt3sas_base_detach(ioc);
8983  out_attach_fail:
8984         destroy_workqueue(ioc->firmware_event_thread);
8985  out_thread_fail:
8986         spin_lock(&gioc_lock);
8987         list_del(&ioc->list);
8988         spin_unlock(&gioc_lock);
8989         scsi_host_put(shost);
8990         return rv;
8991 }
8992
8993 #ifdef CONFIG_PM
8994 /**
8995  * scsih_suspend - power management suspend main entry point
8996  * @pdev: PCI device struct
8997  * @state: PM state change to (usually PCI_D3)
8998  *
8999  * Returns 0 success, anything else error.
9000  */
9001 static int
9002 scsih_suspend(struct pci_dev *pdev, pm_message_t state)
9003 {
9004         struct Scsi_Host *shost = pci_get_drvdata(pdev);
9005         struct MPT3SAS_ADAPTER *ioc = shost_priv(shost);
9006         pci_power_t device_state;
9007
9008         mpt3sas_base_stop_watchdog(ioc);
9009         flush_scheduled_work();
9010         scsi_block_requests(shost);
9011         device_state = pci_choose_state(pdev, state);
9012         pr_info(MPT3SAS_FMT
9013                 "pdev=0x%p, slot=%s, entering operating state [D%d]\n",
9014                 ioc->name, pdev, pci_name(pdev), device_state);
9015
9016         pci_save_state(pdev);
9017         mpt3sas_base_free_resources(ioc);
9018         pci_set_power_state(pdev, device_state);
9019         return 0;
9020 }
9021
9022 /**
9023  * scsih_resume - power management resume main entry point
9024  * @pdev: PCI device struct
9025  *
9026  * Returns 0 success, anything else error.
9027  */
9028 static int
9029 scsih_resume(struct pci_dev *pdev)
9030 {
9031         struct Scsi_Host *shost = pci_get_drvdata(pdev);
9032         struct MPT3SAS_ADAPTER *ioc = shost_priv(shost);
9033         pci_power_t device_state = pdev->current_state;
9034         int r;
9035
9036         pr_info(MPT3SAS_FMT
9037                 "pdev=0x%p, slot=%s, previous operating state [D%d]\n",
9038                 ioc->name, pdev, pci_name(pdev), device_state);
9039
9040         pci_set_power_state(pdev, PCI_D0);
9041         pci_enable_wake(pdev, PCI_D0, 0);
9042         pci_restore_state(pdev);
9043         ioc->pdev = pdev;
9044         r = mpt3sas_base_map_resources(ioc);
9045         if (r)
9046                 return r;
9047
9048         mpt3sas_base_hard_reset_handler(ioc, SOFT_RESET);
9049         scsi_unblock_requests(shost);
9050         mpt3sas_base_start_watchdog(ioc);
9051         return 0;
9052 }
9053 #endif /* CONFIG_PM */
9054
9055 /**
9056  * scsih_pci_error_detected - Called when a PCI error is detected.
9057  * @pdev: PCI device struct
9058  * @state: PCI channel state
9059  *
9060  * Description: Called when a PCI error is detected.
9061  *
9062  * Return value:
9063  *      PCI_ERS_RESULT_NEED_RESET or PCI_ERS_RESULT_DISCONNECT
9064  */
9065 static pci_ers_result_t
9066 scsih_pci_error_detected(struct pci_dev *pdev, pci_channel_state_t state)
9067 {
9068         struct Scsi_Host *shost = pci_get_drvdata(pdev);
9069         struct MPT3SAS_ADAPTER *ioc = shost_priv(shost);
9070
9071         pr_info(MPT3SAS_FMT "PCI error: detected callback, state(%d)!!\n",
9072             ioc->name, state);
9073
9074         switch (state) {
9075         case pci_channel_io_normal:
9076                 return PCI_ERS_RESULT_CAN_RECOVER;
9077         case pci_channel_io_frozen:
9078                 /* Fatal error, prepare for slot reset */
9079                 ioc->pci_error_recovery = 1;
9080                 scsi_block_requests(ioc->shost);
9081                 mpt3sas_base_stop_watchdog(ioc);
9082                 mpt3sas_base_free_resources(ioc);
9083                 return PCI_ERS_RESULT_NEED_RESET;
9084         case pci_channel_io_perm_failure:
9085                 /* Permanent error, prepare for device removal */
9086                 ioc->pci_error_recovery = 1;
9087                 mpt3sas_base_stop_watchdog(ioc);
9088                 _scsih_flush_running_cmds(ioc);
9089                 return PCI_ERS_RESULT_DISCONNECT;
9090         }
9091         return PCI_ERS_RESULT_NEED_RESET;
9092 }
9093
9094 /**
9095  * scsih_pci_slot_reset - Called when PCI slot has been reset.
9096  * @pdev: PCI device struct
9097  *
9098  * Description: This routine is called by the pci error recovery
9099  * code after the PCI slot has been reset, just before we
9100  * should resume normal operations.
9101  */
9102 static pci_ers_result_t
9103 scsih_pci_slot_reset(struct pci_dev *pdev)
9104 {
9105         struct Scsi_Host *shost = pci_get_drvdata(pdev);
9106         struct MPT3SAS_ADAPTER *ioc = shost_priv(shost);
9107         int rc;
9108
9109         pr_info(MPT3SAS_FMT "PCI error: slot reset callback!!\n",
9110              ioc->name);
9111
9112         ioc->pci_error_recovery = 0;
9113         ioc->pdev = pdev;
9114         pci_restore_state(pdev);
9115         rc = mpt3sas_base_map_resources(ioc);
9116         if (rc)
9117                 return PCI_ERS_RESULT_DISCONNECT;
9118
9119         rc = mpt3sas_base_hard_reset_handler(ioc, FORCE_BIG_HAMMER);
9120
9121         pr_warn(MPT3SAS_FMT "hard reset: %s\n", ioc->name,
9122             (rc == 0) ? "success" : "failed");
9123
9124         if (!rc)
9125                 return PCI_ERS_RESULT_RECOVERED;
9126         else
9127                 return PCI_ERS_RESULT_DISCONNECT;
9128 }
9129
9130 /**
9131  * scsih_pci_resume() - resume normal ops after PCI reset
9132  * @pdev: pointer to PCI device
9133  *
9134  * Called when the error recovery driver tells us that its
9135  * OK to resume normal operation. Use completion to allow
9136  * halted scsi ops to resume.
9137  */
9138 static void
9139 scsih_pci_resume(struct pci_dev *pdev)
9140 {
9141         struct Scsi_Host *shost = pci_get_drvdata(pdev);
9142         struct MPT3SAS_ADAPTER *ioc = shost_priv(shost);
9143
9144         pr_info(MPT3SAS_FMT "PCI error: resume callback!!\n", ioc->name);
9145
9146         pci_cleanup_aer_uncorrect_error_status(pdev);
9147         mpt3sas_base_start_watchdog(ioc);
9148         scsi_unblock_requests(ioc->shost);
9149 }
9150
9151 /**
9152  * scsih_pci_mmio_enabled - Enable MMIO and dump debug registers
9153  * @pdev: pointer to PCI device
9154  */
9155 static pci_ers_result_t
9156 scsih_pci_mmio_enabled(struct pci_dev *pdev)
9157 {
9158         struct Scsi_Host *shost = pci_get_drvdata(pdev);
9159         struct MPT3SAS_ADAPTER *ioc = shost_priv(shost);
9160
9161         pr_info(MPT3SAS_FMT "PCI error: mmio enabled callback!!\n",
9162             ioc->name);
9163
9164         /* TODO - dump whatever for debugging purposes */
9165
9166         /* This called only if scsih_pci_error_detected returns
9167          * PCI_ERS_RESULT_CAN_RECOVER. Read/write to the device still
9168          * works, no need to reset slot.
9169          */
9170         return PCI_ERS_RESULT_RECOVERED;
9171 }
9172
9173 /**
9174  * scsih__ncq_prio_supp - Check for NCQ command priority support
9175  * @sdev: scsi device struct
9176  *
9177  * This is called when a user indicates they would like to enable
9178  * ncq command priorities. This works only on SATA devices.
9179  */
9180 bool scsih_ncq_prio_supp(struct scsi_device *sdev)
9181 {
9182         unsigned char *buf;
9183         bool ncq_prio_supp = false;
9184
9185         if (!scsi_device_supports_vpd(sdev))
9186                 return ncq_prio_supp;
9187
9188         buf = kmalloc(SCSI_VPD_PG_LEN, GFP_KERNEL);
9189         if (!buf)
9190                 return ncq_prio_supp;
9191
9192         if (!scsi_get_vpd_page(sdev, 0x89, buf, SCSI_VPD_PG_LEN))
9193                 ncq_prio_supp = (buf[213] >> 4) & 1;
9194
9195         kfree(buf);
9196         return ncq_prio_supp;
9197 }
9198 /*
9199  * The pci device ids are defined in mpi/mpi2_cnfg.h.
9200  */
9201 static const struct pci_device_id mpt3sas_pci_table[] = {
9202         /* Spitfire ~ 2004 */
9203         { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2004,
9204                 PCI_ANY_ID, PCI_ANY_ID },
9205         /* Falcon ~ 2008 */
9206         { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2008,
9207                 PCI_ANY_ID, PCI_ANY_ID },
9208         /* Liberator ~ 2108 */
9209         { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2108_1,
9210                 PCI_ANY_ID, PCI_ANY_ID },
9211         { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2108_2,
9212                 PCI_ANY_ID, PCI_ANY_ID },
9213         { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2108_3,
9214                 PCI_ANY_ID, PCI_ANY_ID },
9215         /* Meteor ~ 2116 */
9216         { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2116_1,
9217                 PCI_ANY_ID, PCI_ANY_ID },
9218         { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2116_2,
9219                 PCI_ANY_ID, PCI_ANY_ID },
9220         /* Thunderbolt ~ 2208 */
9221         { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2208_1,
9222                 PCI_ANY_ID, PCI_ANY_ID },
9223         { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2208_2,
9224                 PCI_ANY_ID, PCI_ANY_ID },
9225         { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2208_3,
9226                 PCI_ANY_ID, PCI_ANY_ID },
9227         { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2208_4,
9228                 PCI_ANY_ID, PCI_ANY_ID },
9229         { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2208_5,
9230                 PCI_ANY_ID, PCI_ANY_ID },
9231         { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2208_6,
9232                 PCI_ANY_ID, PCI_ANY_ID },
9233         /* Mustang ~ 2308 */
9234         { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2308_1,
9235                 PCI_ANY_ID, PCI_ANY_ID },
9236         { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2308_2,
9237                 PCI_ANY_ID, PCI_ANY_ID },
9238         { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SAS2308_3,
9239                 PCI_ANY_ID, PCI_ANY_ID },
9240         /* SSS6200 */
9241         { MPI2_MFGPAGE_VENDORID_LSI, MPI2_MFGPAGE_DEVID_SSS6200,
9242                 PCI_ANY_ID, PCI_ANY_ID },
9243         /* Fury ~ 3004 and 3008 */
9244         { MPI2_MFGPAGE_VENDORID_LSI, MPI25_MFGPAGE_DEVID_SAS3004,
9245                 PCI_ANY_ID, PCI_ANY_ID },
9246         { MPI2_MFGPAGE_VENDORID_LSI, MPI25_MFGPAGE_DEVID_SAS3008,
9247                 PCI_ANY_ID, PCI_ANY_ID },
9248         /* Invader ~ 3108 */
9249         { MPI2_MFGPAGE_VENDORID_LSI, MPI25_MFGPAGE_DEVID_SAS3108_1,
9250                 PCI_ANY_ID, PCI_ANY_ID },
9251         { MPI2_MFGPAGE_VENDORID_LSI, MPI25_MFGPAGE_DEVID_SAS3108_2,
9252                 PCI_ANY_ID, PCI_ANY_ID },
9253         { MPI2_MFGPAGE_VENDORID_LSI, MPI25_MFGPAGE_DEVID_SAS3108_5,
9254                 PCI_ANY_ID, PCI_ANY_ID },
9255         { MPI2_MFGPAGE_VENDORID_LSI, MPI25_MFGPAGE_DEVID_SAS3108_6,
9256                 PCI_ANY_ID, PCI_ANY_ID },
9257         /* Cutlass ~ 3216 and 3224 */
9258         { MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3216,
9259                 PCI_ANY_ID, PCI_ANY_ID },
9260         { MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3224,
9261                 PCI_ANY_ID, PCI_ANY_ID },
9262         /* Intruder ~ 3316 and 3324 */
9263         { MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3316_1,
9264                 PCI_ANY_ID, PCI_ANY_ID },
9265         { MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3316_2,
9266                 PCI_ANY_ID, PCI_ANY_ID },
9267         { MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3316_3,
9268                 PCI_ANY_ID, PCI_ANY_ID },
9269         { MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3316_4,
9270                 PCI_ANY_ID, PCI_ANY_ID },
9271         { MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3324_1,
9272                 PCI_ANY_ID, PCI_ANY_ID },
9273         { MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3324_2,
9274                 PCI_ANY_ID, PCI_ANY_ID },
9275         { MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3324_3,
9276                 PCI_ANY_ID, PCI_ANY_ID },
9277         { MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3324_4,
9278                 PCI_ANY_ID, PCI_ANY_ID },
9279         /* Ventura, Crusader, Harpoon & Tomcat ~ 3516, 3416, 3508 & 3408*/
9280         { MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3508,
9281                 PCI_ANY_ID, PCI_ANY_ID },
9282         { MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3508_1,
9283                 PCI_ANY_ID, PCI_ANY_ID },
9284         { MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3408,
9285                 PCI_ANY_ID, PCI_ANY_ID },
9286         { MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3516,
9287                 PCI_ANY_ID, PCI_ANY_ID },
9288         { MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3516_1,
9289                 PCI_ANY_ID, PCI_ANY_ID },
9290         { MPI2_MFGPAGE_VENDORID_LSI, MPI26_MFGPAGE_DEVID_SAS3416,
9291                 PCI_ANY_ID, PCI_ANY_ID },
9292         {0}     /* Terminating entry */
9293 };
9294 MODULE_DEVICE_TABLE(pci, mpt3sas_pci_table);
9295
9296 static struct pci_error_handlers _mpt3sas_err_handler = {
9297         .error_detected = scsih_pci_error_detected,
9298         .mmio_enabled   = scsih_pci_mmio_enabled,
9299         .slot_reset     = scsih_pci_slot_reset,
9300         .resume         = scsih_pci_resume,
9301 };
9302
9303 static struct pci_driver mpt3sas_driver = {
9304         .name           = MPT3SAS_DRIVER_NAME,
9305         .id_table       = mpt3sas_pci_table,
9306         .probe          = _scsih_probe,
9307         .remove         = scsih_remove,
9308         .shutdown       = scsih_shutdown,
9309         .err_handler    = &_mpt3sas_err_handler,
9310 #ifdef CONFIG_PM
9311         .suspend        = scsih_suspend,
9312         .resume         = scsih_resume,
9313 #endif
9314 };
9315
9316 /**
9317  * scsih_init - main entry point for this driver.
9318  *
9319  * Returns 0 success, anything else error.
9320  */
9321 static int
9322 scsih_init(void)
9323 {
9324         mpt2_ids = 0;
9325         mpt3_ids = 0;
9326
9327         mpt3sas_base_initialize_callback_handler();
9328
9329          /* queuecommand callback hander */
9330         scsi_io_cb_idx = mpt3sas_base_register_callback_handler(_scsih_io_done);
9331
9332         /* task management callback handler */
9333         tm_cb_idx = mpt3sas_base_register_callback_handler(_scsih_tm_done);
9334
9335         /* base internal commands callback handler */
9336         base_cb_idx = mpt3sas_base_register_callback_handler(mpt3sas_base_done);
9337         port_enable_cb_idx = mpt3sas_base_register_callback_handler(
9338             mpt3sas_port_enable_done);
9339
9340         /* transport internal commands callback handler */
9341         transport_cb_idx = mpt3sas_base_register_callback_handler(
9342             mpt3sas_transport_done);
9343
9344         /* scsih internal commands callback handler */
9345         scsih_cb_idx = mpt3sas_base_register_callback_handler(_scsih_done);
9346
9347         /* configuration page API internal commands callback handler */
9348         config_cb_idx = mpt3sas_base_register_callback_handler(
9349             mpt3sas_config_done);
9350
9351         /* ctl module callback handler */
9352         ctl_cb_idx = mpt3sas_base_register_callback_handler(mpt3sas_ctl_done);
9353
9354         tm_tr_cb_idx = mpt3sas_base_register_callback_handler(
9355             _scsih_tm_tr_complete);
9356
9357         tm_tr_volume_cb_idx = mpt3sas_base_register_callback_handler(
9358             _scsih_tm_volume_tr_complete);
9359
9360         tm_sas_control_cb_idx = mpt3sas_base_register_callback_handler(
9361             _scsih_sas_control_complete);
9362
9363         return 0;
9364 }
9365
9366 /**
9367  * scsih_exit - exit point for this driver (when it is a module).
9368  *
9369  * Returns 0 success, anything else error.
9370  */
9371 static void
9372 scsih_exit(void)
9373 {
9374
9375         mpt3sas_base_release_callback_handler(scsi_io_cb_idx);
9376         mpt3sas_base_release_callback_handler(tm_cb_idx);
9377         mpt3sas_base_release_callback_handler(base_cb_idx);
9378         mpt3sas_base_release_callback_handler(port_enable_cb_idx);
9379         mpt3sas_base_release_callback_handler(transport_cb_idx);
9380         mpt3sas_base_release_callback_handler(scsih_cb_idx);
9381         mpt3sas_base_release_callback_handler(config_cb_idx);
9382         mpt3sas_base_release_callback_handler(ctl_cb_idx);
9383
9384         mpt3sas_base_release_callback_handler(tm_tr_cb_idx);
9385         mpt3sas_base_release_callback_handler(tm_tr_volume_cb_idx);
9386         mpt3sas_base_release_callback_handler(tm_sas_control_cb_idx);
9387
9388 /* raid transport support */
9389         if (hbas_to_enumerate != 1)
9390                 raid_class_release(mpt3sas_raid_template);
9391         if (hbas_to_enumerate != 2)
9392                 raid_class_release(mpt2sas_raid_template);
9393         sas_release_transport(mpt3sas_transport_template);
9394 }
9395
9396 /**
9397  * _mpt3sas_init - main entry point for this driver.
9398  *
9399  * Returns 0 success, anything else error.
9400  */
9401 static int __init
9402 _mpt3sas_init(void)
9403 {
9404         int error;
9405
9406         pr_info("%s version %s loaded\n", MPT3SAS_DRIVER_NAME,
9407                                         MPT3SAS_DRIVER_VERSION);
9408
9409         mpt3sas_transport_template =
9410             sas_attach_transport(&mpt3sas_transport_functions);
9411         if (!mpt3sas_transport_template)
9412                 return -ENODEV;
9413
9414         /* No need attach mpt3sas raid functions template
9415          * if hbas_to_enumarate value is one.
9416          */
9417         if (hbas_to_enumerate != 1) {
9418                 mpt3sas_raid_template =
9419                                 raid_class_attach(&mpt3sas_raid_functions);
9420                 if (!mpt3sas_raid_template) {
9421                         sas_release_transport(mpt3sas_transport_template);
9422                         return -ENODEV;
9423                 }
9424         }
9425
9426         /* No need to attach mpt2sas raid functions template
9427          * if hbas_to_enumarate value is two
9428          */
9429         if (hbas_to_enumerate != 2) {
9430                 mpt2sas_raid_template =
9431                                 raid_class_attach(&mpt2sas_raid_functions);
9432                 if (!mpt2sas_raid_template) {
9433                         sas_release_transport(mpt3sas_transport_template);
9434                         return -ENODEV;
9435                 }
9436         }
9437
9438         error = scsih_init();
9439         if (error) {
9440                 scsih_exit();
9441                 return error;
9442         }
9443
9444         mpt3sas_ctl_init(hbas_to_enumerate);
9445
9446         error = pci_register_driver(&mpt3sas_driver);
9447         if (error)
9448                 scsih_exit();
9449
9450         return error;
9451 }
9452
9453 /**
9454  * _mpt3sas_exit - exit point for this driver (when it is a module).
9455  *
9456  */
9457 static void __exit
9458 _mpt3sas_exit(void)
9459 {
9460         pr_info("mpt3sas version %s unloading\n",
9461                                 MPT3SAS_DRIVER_VERSION);
9462
9463         pci_unregister_driver(&mpt3sas_driver);
9464
9465         mpt3sas_ctl_exit(hbas_to_enumerate);
9466
9467         scsih_exit();
9468 }
9469
9470 module_init(_mpt3sas_init);
9471 module_exit(_mpt3sas_exit);