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