drivers/message/fusion/mptsas.c

   1 /*
   2  *  linux/drivers/message/fusion/mptsas.c
   3  *      For use with LSI PCI chip/adapter(s)
   4  *      running LSI Fusion MPT (Message Passing Technology) firmware.
   5  *
   6  *  Copyright (c) 1999-2008 LSI Corporation
   7  *  (mailto:DL-MPTFusionLinux@lsi.com)
   8  */
   9 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
  10 /*
  11     This program is free software; you can redistribute it and/or modify
  12     it under the terms of the GNU General Public License as published by
  13     the Free Software Foundation; version 2 of the License.
  14
  15     This program is distributed in the hope that it will be useful,
  16     but WITHOUT ANY WARRANTY; without even the implied warranty of
  17     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18     GNU General Public License for more details.
  19
  20     NO WARRANTY
  21     THE PROGRAM IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OR
  22     CONDITIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED INCLUDING, WITHOUT
  23     LIMITATION, ANY WARRANTIES OR CONDITIONS OF TITLE, NON-INFRINGEMENT,
  24     MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE. Each Recipient is
  25     solely responsible for determining the appropriateness of using and
  26     distributing the Program and assumes all risks associated with its
  27     exercise of rights under this Agreement, including but not limited to
  28     the risks and costs of program errors, damage to or loss of data,
  29     programs or equipment, and unavailability or interruption of operations.
  30
  31     DISCLAIMER OF LIABILITY
  32     NEITHER RECIPIENT NOR ANY CONTRIBUTORS SHALL HAVE ANY LIABILITY FOR ANY
  33     DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  34     DAMAGES (INCLUDING WITHOUT LIMITATION LOST PROFITS), HOWEVER CAUSED AND
  35     ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR
  36     TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE
  37     USE OR DISTRIBUTION OF THE PROGRAM OR THE EXERCISE OF ANY RIGHTS GRANTED
  38     HEREUNDER, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGES
  39
  40     You should have received a copy of the GNU General Public License
  41     along with this program; if not, write to the Free Software
  42     Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  43 */
  44 /*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
  45
  46 #include <linux/module.h>
  47 #include <linux/kernel.h>
  48 #include <linux/slab.h>
  49 #include <linux/init.h>
  50 #include <linux/errno.h>
  51 #include <linux/jiffies.h>
  52 #include <linux/workqueue.h>
  53 #include <linux/delay.h>        /* for mdelay */
  54
  55 #include <scsi/scsi.h>
  56 #include <scsi/scsi_cmnd.h>
  57 #include <scsi/scsi_device.h>
  58 #include <scsi/scsi_host.h>
  59 #include <scsi/scsi_transport_sas.h>
  60 #include <scsi/scsi_transport.h>
  61 #include <scsi/scsi_dbg.h>
  62
  63 #include "mptbase.h"
  64 #include "mptscsih.h"
  65 #include "mptsas.h"
  66
  67
  68 #define my_NAME         "Fusion MPT SAS Host driver"
  69 #define my_VERSION      MPT_LINUX_VERSION_COMMON
  70 #define MYNAM           "mptsas"
  71
  72 /*
  73  * Reserved channel for integrated raid
  74  */
  75 #define MPTSAS_RAID_CHANNEL     1
  76
  77 #define SAS_CONFIG_PAGE_TIMEOUT         30
  78 MODULE_AUTHOR(MODULEAUTHOR);
  79 MODULE_DESCRIPTION(my_NAME);
  80 MODULE_LICENSE("GPL");
  81 MODULE_VERSION(my_VERSION);
  82
  83 static int mpt_pt_clear;
  84 module_param(mpt_pt_clear, int, 0);
  85 MODULE_PARM_DESC(mpt_pt_clear,
  86                 " Clear persistency table: enable=1  "
  87                 "(default=MPTSCSIH_PT_CLEAR=0)");
  88
  89 /* scsi-mid layer global parmeter is max_report_luns, which is 511 */
  90 #define MPTSAS_MAX_LUN (16895)
  91 static int max_lun = MPTSAS_MAX_LUN;
  92 module_param(max_lun, int, 0);
  93 MODULE_PARM_DESC(max_lun, " max lun, default=16895 ");
  94
  95 static int mpt_loadtime_max_sectors = 8192;
  96 module_param(mpt_loadtime_max_sectors, int, 0);
  97 MODULE_PARM_DESC(mpt_loadtime_max_sectors,
  98                 " Maximum sector define for Host Bus Adaptor.Range 64 to 8192 default=8192");
  99
 100 static u8       mptsasDoneCtx = MPT_MAX_PROTOCOL_DRIVERS;
 101 static u8       mptsasTaskCtx = MPT_MAX_PROTOCOL_DRIVERS;
 102 static u8       mptsasInternalCtx = MPT_MAX_PROTOCOL_DRIVERS; /* Used only for internal commands */
 103 static u8       mptsasMgmtCtx = MPT_MAX_PROTOCOL_DRIVERS;
 104 static u8       mptsasDeviceResetCtx = MPT_MAX_PROTOCOL_DRIVERS;
 105
 106 static void mptsas_firmware_event_work(struct work_struct *work);
 107 static void mptsas_send_sas_event(struct fw_event_work *fw_event);
 108 static void mptsas_send_raid_event(struct fw_event_work *fw_event);
 109 static void mptsas_send_ir2_event(struct fw_event_work *fw_event);
 110 static void mptsas_parse_device_info(struct sas_identify *identify,
 111                 struct mptsas_devinfo *device_info);
 112 static inline void mptsas_set_rphy(MPT_ADAPTER *ioc,
 113                 struct mptsas_phyinfo *phy_info, struct sas_rphy *rphy);
 114 static struct mptsas_phyinfo    *mptsas_find_phyinfo_by_sas_address
 115                 (MPT_ADAPTER *ioc, u64 sas_address);
 116 static int mptsas_sas_device_pg0(MPT_ADAPTER *ioc,
 117         struct mptsas_devinfo *device_info, u32 form, u32 form_specific);
 118 static int mptsas_sas_enclosure_pg0(MPT_ADAPTER *ioc,
 119         struct mptsas_enclosure *enclosure, u32 form, u32 form_specific);
 120 static int mptsas_add_end_device(MPT_ADAPTER *ioc,
 121         struct mptsas_phyinfo *phy_info);
 122 static void mptsas_del_end_device(MPT_ADAPTER *ioc,
 123         struct mptsas_phyinfo *phy_info);
 124 static void mptsas_send_link_status_event(struct fw_event_work *fw_event);
 125 static struct mptsas_portinfo   *mptsas_find_portinfo_by_sas_address
 126                 (MPT_ADAPTER *ioc, u64 sas_address);
 127 static void mptsas_expander_delete(MPT_ADAPTER *ioc,
 128                 struct mptsas_portinfo *port_info, u8 force);
 129 static void mptsas_send_expander_event(struct fw_event_work *fw_event);
 130 static void mptsas_not_responding_devices(MPT_ADAPTER *ioc);
 131 static void mptsas_scan_sas_topology(MPT_ADAPTER *ioc);
 132 static void mptsas_broadcast_primative_work(struct fw_event_work *fw_event);
 133 static void mptsas_handle_queue_full_event(struct fw_event_work *fw_event);
 134 static void mptsas_volume_delete(MPT_ADAPTER *ioc, u8 id);
 135 void    mptsas_schedule_target_reset(void *ioc);
 136
 137 static void mptsas_print_phy_data(MPT_ADAPTER *ioc,
 138                                         MPI_SAS_IO_UNIT0_PHY_DATA *phy_data)
 139 {
 140         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
 141             "---- IO UNIT PAGE 0 ------------\n", ioc->name));
 142         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Handle=0x%X\n",
 143             ioc->name, le16_to_cpu(phy_data->AttachedDeviceHandle)));
 144         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Controller Handle=0x%X\n",
 145             ioc->name, le16_to_cpu(phy_data->ControllerDevHandle)));
 146         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Port=0x%X\n",
 147             ioc->name, phy_data->Port));
 148         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Port Flags=0x%X\n",
 149             ioc->name, phy_data->PortFlags));
 150         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "PHY Flags=0x%X\n",
 151             ioc->name, phy_data->PhyFlags));
 152         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Negotiated Link Rate=0x%X\n",
 153             ioc->name, phy_data->NegotiatedLinkRate));
 154         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
 155             "Controller PHY Device Info=0x%X\n", ioc->name,
 156             le32_to_cpu(phy_data->ControllerPhyDeviceInfo)));
 157         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "DiscoveryStatus=0x%X\n\n",
 158             ioc->name, le32_to_cpu(phy_data->DiscoveryStatus)));
 159 }
 160
 161 static void mptsas_print_phy_pg0(MPT_ADAPTER *ioc, SasPhyPage0_t *pg0)
 162 {
 163         __le64 sas_address;
 164
 165         memcpy(&sas_address, &pg0->SASAddress, sizeof(__le64));
 166
 167         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
 168             "---- SAS PHY PAGE 0 ------------\n", ioc->name));
 169         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
 170             "Attached Device Handle=0x%X\n", ioc->name,
 171             le16_to_cpu(pg0->AttachedDevHandle)));
 172         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "SAS Address=0x%llX\n",
 173             ioc->name, (unsigned long long)le64_to_cpu(sas_address)));
 174         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
 175             "Attached PHY Identifier=0x%X\n", ioc->name,
 176             pg0->AttachedPhyIdentifier));
 177         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Attached Device Info=0x%X\n",
 178             ioc->name, le32_to_cpu(pg0->AttachedDeviceInfo)));
 179         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Programmed Link Rate=0x%X\n",
 180             ioc->name,  pg0->ProgrammedLinkRate));
 181         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Change Count=0x%X\n",
 182             ioc->name, pg0->ChangeCount));
 183         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "PHY Info=0x%X\n\n",
 184             ioc->name, le32_to_cpu(pg0->PhyInfo)));
 185 }
 186
 187 static void mptsas_print_phy_pg1(MPT_ADAPTER *ioc, SasPhyPage1_t *pg1)
 188 {
 189         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
 190             "---- SAS PHY PAGE 1 ------------\n", ioc->name));
 191         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Invalid Dword Count=0x%x\n",
 192             ioc->name,  pg1->InvalidDwordCount));
 193         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
 194             "Running Disparity Error Count=0x%x\n", ioc->name,
 195             pg1->RunningDisparityErrorCount));
 196         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
 197             "Loss Dword Synch Count=0x%x\n", ioc->name,
 198             pg1->LossDwordSynchCount));
 199         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
 200             "PHY Reset Problem Count=0x%x\n\n", ioc->name,
 201             pg1->PhyResetProblemCount));
 202 }
 203
 204 static void mptsas_print_device_pg0(MPT_ADAPTER *ioc, SasDevicePage0_t *pg0)
 205 {
 206         __le64 sas_address;
 207
 208         memcpy(&sas_address, &pg0->SASAddress, sizeof(__le64));
 209
 210         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
 211             "---- SAS DEVICE PAGE 0 ---------\n", ioc->name));
 212         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Handle=0x%X\n",
 213             ioc->name, le16_to_cpu(pg0->DevHandle)));
 214         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Parent Handle=0x%X\n",
 215             ioc->name, le16_to_cpu(pg0->ParentDevHandle)));
 216         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Enclosure Handle=0x%X\n",
 217             ioc->name, le16_to_cpu(pg0->EnclosureHandle)));
 218         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Slot=0x%X\n",
 219             ioc->name, le16_to_cpu(pg0->Slot)));
 220         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "SAS Address=0x%llX\n",
 221             ioc->name, (unsigned long long)le64_to_cpu(sas_address)));
 222         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Target ID=0x%X\n",
 223             ioc->name, pg0->TargetID));
 224         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Bus=0x%X\n",
 225             ioc->name, pg0->Bus));
 226         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Parent Phy Num=0x%X\n",
 227             ioc->name, pg0->PhyNum));
 228         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Access Status=0x%X\n",
 229             ioc->name, le16_to_cpu(pg0->AccessStatus)));
 230         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Device Info=0x%X\n",
 231             ioc->name, le32_to_cpu(pg0->DeviceInfo)));
 232         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Flags=0x%X\n",
 233             ioc->name, le16_to_cpu(pg0->Flags)));
 234         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Physical Port=0x%X\n\n",
 235             ioc->name, pg0->PhysicalPort));
 236 }
 237
 238 static void mptsas_print_expander_pg1(MPT_ADAPTER *ioc, SasExpanderPage1_t *pg1)
 239 {
 240         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
 241             "---- SAS EXPANDER PAGE 1 ------------\n", ioc->name));
 242         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Physical Port=0x%X\n",
 243             ioc->name, pg1->PhysicalPort));
 244         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "PHY Identifier=0x%X\n",
 245             ioc->name, pg1->PhyIdentifier));
 246         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Negotiated Link Rate=0x%X\n",
 247             ioc->name, pg1->NegotiatedLinkRate));
 248         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Programmed Link Rate=0x%X\n",
 249             ioc->name, pg1->ProgrammedLinkRate));
 250         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Hardware Link Rate=0x%X\n",
 251             ioc->name, pg1->HwLinkRate));
 252         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Owner Device Handle=0x%X\n",
 253             ioc->name, le16_to_cpu(pg1->OwnerDevHandle)));
 254         dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
 255             "Attached Device Handle=0x%X\n\n", ioc->name,
 256             le16_to_cpu(pg1->AttachedDevHandle)));
 257 }
 258
 259 /* inhibit sas firmware event handling */
 260 static void
 261 mptsas_fw_event_off(MPT_ADAPTER *ioc)
 262 {
 263         unsigned long flags;
 264
 265         spin_lock_irqsave(&ioc->fw_event_lock, flags);
 266         ioc->fw_events_off = 1;
 267         ioc->sas_discovery_quiesce_io = 0;
 268         spin_unlock_irqrestore(&ioc->fw_event_lock, flags);
 269
 270 }
 271
 272 /* enable sas firmware event handling */
 273 static void
 274 mptsas_fw_event_on(MPT_ADAPTER *ioc)
 275 {
 276         unsigned long flags;
 277
 278         spin_lock_irqsave(&ioc->fw_event_lock, flags);
 279         ioc->fw_events_off = 0;
 280         spin_unlock_irqrestore(&ioc->fw_event_lock, flags);
 281 }
 282
 283 /* queue a sas firmware event */
 284 static void
 285 mptsas_add_fw_event(MPT_ADAPTER *ioc, struct fw_event_work *fw_event,
 286     unsigned long delay)
 287 {
 288         unsigned long flags;
 289
 290         spin_lock_irqsave(&ioc->fw_event_lock, flags);
 291         list_add_tail(&fw_event->list, &ioc->fw_event_list);
 292         INIT_DELAYED_WORK(&fw_event->work, mptsas_firmware_event_work);
 293         devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT "%s: add (fw_event=0x%p)"
 294                 "on cpuid %d\n", ioc->name, __func__,
 295                 fw_event, smp_processor_id()));
 296         queue_delayed_work_on(smp_processor_id(), ioc->fw_event_q,
 297             &fw_event->work, delay);
 298         spin_unlock_irqrestore(&ioc->fw_event_lock, flags);
 299 }
 300
 301 /* requeue a sas firmware event */
 302 static void
 303 mptsas_requeue_fw_event(MPT_ADAPTER *ioc, struct fw_event_work *fw_event,
 304     unsigned long delay)
 305 {
 306         unsigned long flags;
 307         spin_lock_irqsave(&ioc->fw_event_lock, flags);
 308         devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT "%s: reschedule task "
 309             "(fw_event=0x%p)on cpuid %d\n", ioc->name, __func__,
 310                 fw_event, smp_processor_id()));
 311         fw_event->retries++;
 312         queue_delayed_work_on(smp_processor_id(), ioc->fw_event_q,
 313             &fw_event->work, msecs_to_jiffies(delay));
 314         spin_unlock_irqrestore(&ioc->fw_event_lock, flags);
 315 }
 316
 317 /* free memory associated to a sas firmware event */
 318 static void
 319 mptsas_free_fw_event(MPT_ADAPTER *ioc, struct fw_event_work *fw_event)
 320 {
 321         unsigned long flags;
 322
 323         spin_lock_irqsave(&ioc->fw_event_lock, flags);
 324         devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT "%s: kfree (fw_event=0x%p)\n",
 325             ioc->name, __func__, fw_event));
 326         list_del(&fw_event->list);
 327         kfree(fw_event);
 328         spin_unlock_irqrestore(&ioc->fw_event_lock, flags);
 329 }
 330
 331 /* walk the firmware event queue, and either stop or wait for
 332  * outstanding events to complete */
 333 static void
 334 mptsas_cleanup_fw_event_q(MPT_ADAPTER *ioc)
 335 {
 336         struct fw_event_work *fw_event, *next;
 337         struct mptsas_target_reset_event *target_reset_list, *n;
 338         MPT_SCSI_HOST   *hd = shost_priv(ioc->sh);
 339
 340         /* flush the target_reset_list */
 341         if (!list_empty(&hd->target_reset_list)) {
 342                 list_for_each_entry_safe(target_reset_list, n,
 343                     &hd->target_reset_list, list) {
 344                         dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
 345                             "%s: removing target reset for id=%d\n",
 346                             ioc->name, __func__,
 347                            target_reset_list->sas_event_data.TargetID));
 348                         list_del(&target_reset_list->list);
 349                         kfree(target_reset_list);
 350                 }
 351         }
 352
 353         if (list_empty(&ioc->fw_event_list) ||
 354              !ioc->fw_event_q || in_interrupt())
 355                 return;
 356
 357         list_for_each_entry_safe(fw_event, next, &ioc->fw_event_list, list) {
 358                 if (cancel_delayed_work(&fw_event->work))
 359                         mptsas_free_fw_event(ioc, fw_event);
 360         }
 361 }
 362
 363
 364 static inline MPT_ADAPTER *phy_to_ioc(struct sas_phy *phy)
 365 {
 366         struct Scsi_Host *shost = dev_to_shost(phy->dev.parent);
 367         return ((MPT_SCSI_HOST *)shost->hostdata)->ioc;
 368 }
 369
 370 static inline MPT_ADAPTER *rphy_to_ioc(struct sas_rphy *rphy)
 371 {
 372         struct Scsi_Host *shost = dev_to_shost(rphy->dev.parent->parent);
 373         return ((MPT_SCSI_HOST *)shost->hostdata)->ioc;
 374 }
 375
 376 /*
 377  * mptsas_find_portinfo_by_handle
 378  *
 379  * This function should be called with the sas_topology_mutex already held
 380  */
 381 static struct mptsas_portinfo *
 382 mptsas_find_portinfo_by_handle(MPT_ADAPTER *ioc, u16 handle)
 383 {
 384         struct mptsas_portinfo *port_info, *rc=NULL;
 385         int i;
 386
 387         list_for_each_entry(port_info, &ioc->sas_topology, list)
 388                 for (i = 0; i < port_info->num_phys; i++)
 389                         if (port_info->phy_info[i].identify.handle == handle) {
 390                                 rc = port_info;
 391                                 goto out;
 392                         }
 393  out:
 394         return rc;
 395 }
 396
 397 /**
 398  *      mptsas_find_portinfo_by_sas_address -
 399  *      @ioc: Pointer to MPT_ADAPTER structure
 400  *      @handle:
 401  *
 402  *      This function should be called with the sas_topology_mutex already held
 403  *
 404  **/
 405 static struct mptsas_portinfo *
 406 mptsas_find_portinfo_by_sas_address(MPT_ADAPTER *ioc, u64 sas_address)
 407 {
 408         struct mptsas_portinfo *port_info, *rc = NULL;
 409         int i;
 410
 411         if (sas_address >= ioc->hba_port_sas_addr &&
 412             sas_address < (ioc->hba_port_sas_addr +
 413             ioc->hba_port_num_phy))
 414                 return ioc->hba_port_info;
 415
 416         mutex_lock(&ioc->sas_topology_mutex);
 417         list_for_each_entry(port_info, &ioc->sas_topology, list)
 418                 for (i = 0; i < port_info->num_phys; i++)
 419                         if (port_info->phy_info[i].identify.sas_address ==
 420                             sas_address) {
 421                                 rc = port_info;
 422                                 goto out;
 423                         }
 424  out:
 425         mutex_unlock(&ioc->sas_topology_mutex);
 426         return rc;
 427 }
 428
 429 /*
 430  * Returns true if there is a scsi end device
 431  */
 432 static inline int
 433 mptsas_is_end_device(struct mptsas_devinfo * attached)
 434 {
 435         if ((attached->sas_address) &&
 436             (attached->device_info &
 437             MPI_SAS_DEVICE_INFO_END_DEVICE) &&
 438             ((attached->device_info &
 439             MPI_SAS_DEVICE_INFO_SSP_TARGET) |
 440             (attached->device_info &
 441             MPI_SAS_DEVICE_INFO_STP_TARGET) |
 442             (attached->device_info &
 443             MPI_SAS_DEVICE_INFO_SATA_DEVICE)))
 444                 return 1;
 445         else
 446                 return 0;
 447 }
 448
 449 /* no mutex */
 450 static void
 451 mptsas_port_delete(MPT_ADAPTER *ioc, struct mptsas_portinfo_details * port_details)
 452 {
 453         struct mptsas_portinfo *port_info;
 454         struct mptsas_phyinfo *phy_info;
 455         u8      i;
 456
 457         if (!port_details)
 458                 return;
 459
 460         port_info = port_details->port_info;
 461         phy_info = port_info->phy_info;
 462
 463         dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "%s: [%p]: num_phys=%02d "
 464             "bitmask=0x%016llX\n", ioc->name, __func__, port_details,
 465             port_details->num_phys, (unsigned long long)
 466             port_details->phy_bitmask));
 467
 468         for (i = 0; i < port_info->num_phys; i++, phy_info++) {
 469                 if(phy_info->port_details != port_details)
 470                         continue;
 471                 memset(&phy_info->attached, 0, sizeof(struct mptsas_devinfo));
 472                 mptsas_set_rphy(ioc, phy_info, NULL);
 473                 phy_info->port_details = NULL;
 474         }
 475         kfree(port_details);
 476 }
 477
 478 static inline struct sas_rphy *
 479 mptsas_get_rphy(struct mptsas_phyinfo *phy_info)
 480 {
 481         if (phy_info->port_details)
 482                 return phy_info->port_details->rphy;
 483         else
 484                 return NULL;
 485 }
 486
 487 static inline void
 488 mptsas_set_rphy(MPT_ADAPTER *ioc, struct mptsas_phyinfo *phy_info, struct sas_rphy *rphy)
 489 {
 490         if (phy_info->port_details) {
 491                 phy_info->port_details->rphy = rphy;
 492                 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "sas_rphy_add: rphy=%p\n",
 493                     ioc->name, rphy));
 494         }
 495
 496         if (rphy) {
 497                 dsaswideprintk(ioc, dev_printk(KERN_DEBUG,
 498                     &rphy->dev, MYIOC_s_FMT "add:", ioc->name));
 499                 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "rphy=%p release=%p\n",
 500                     ioc->name, rphy, rphy->dev.release));
 501         }
 502 }
 503
 504 static inline struct sas_port *
 505 mptsas_get_port(struct mptsas_phyinfo *phy_info)
 506 {
 507         if (phy_info->port_details)
 508                 return phy_info->port_details->port;
 509         else
 510                 return NULL;
 511 }
 512
 513 static inline void
 514 mptsas_set_port(MPT_ADAPTER *ioc, struct mptsas_phyinfo *phy_info, struct sas_port *port)
 515 {
 516         if (phy_info->port_details)
 517                 phy_info->port_details->port = port;
 518
 519         if (port) {
 520                 dsaswideprintk(ioc, dev_printk(KERN_DEBUG,
 521                     &port->dev, MYIOC_s_FMT "add:", ioc->name));
 522                 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "port=%p release=%p\n",
 523                     ioc->name, port, port->dev.release));
 524         }
 525 }
 526
 527 static inline struct scsi_target *
 528 mptsas_get_starget(struct mptsas_phyinfo *phy_info)
 529 {
 530         if (phy_info->port_details)
 531                 return phy_info->port_details->starget;
 532         else
 533                 return NULL;
 534 }
 535
 536 static inline void
 537 mptsas_set_starget(struct mptsas_phyinfo *phy_info, struct scsi_target *
 538 starget)
 539 {
 540         if (phy_info->port_details)
 541                 phy_info->port_details->starget = starget;
 542 }
 543
 544 /**
 545  *      mptsas_add_device_component -
 546  *      @ioc: Pointer to MPT_ADAPTER structure
 547  *      @channel: fw mapped id's
 548  *      @id:
 549  *      @sas_address:
 550  *      @device_info:
 551  *
 552  **/
 553 static void
 554 mptsas_add_device_component(MPT_ADAPTER *ioc, u8 channel, u8 id,
 555         u64 sas_address, u32 device_info, u16 slot, u64 enclosure_logical_id)
 556 {
 557         struct mptsas_device_info       *sas_info, *next;
 558         struct scsi_device      *sdev;
 559         struct scsi_target      *starget;
 560         struct sas_rphy *rphy;
 561
 562         /*
 563          * Delete all matching devices out of the list
 564          */
 565         mutex_lock(&ioc->sas_device_info_mutex);
 566         list_for_each_entry_safe(sas_info, next, &ioc->sas_device_info_list,
 567             list) {
 568                 if (!sas_info->is_logical_volume &&
 569                     (sas_info->sas_address == sas_address ||
 570                     (sas_info->fw.channel == channel &&
 571                      sas_info->fw.id == id))) {
 572                         list_del(&sas_info->list);
 573                         kfree(sas_info);
 574                 }
 575         }
 576
 577         sas_info = kzalloc(sizeof(struct mptsas_device_info), GFP_KERNEL);
 578         if (!sas_info)
 579                 goto out;
 580
 581         /*
 582          * Set Firmware mapping
 583          */
 584         sas_info->fw.id = id;
 585         sas_info->fw.channel = channel;
 586
 587         sas_info->sas_address = sas_address;
 588         sas_info->device_info = device_info;
 589         sas_info->slot = slot;
 590         sas_info->enclosure_logical_id = enclosure_logical_id;
 591         INIT_LIST_HEAD(&sas_info->list);
 592         list_add_tail(&sas_info->list, &ioc->sas_device_info_list);
 593
 594         /*
 595          * Set OS mapping
 596          */
 597         shost_for_each_device(sdev, ioc->sh) {
 598                 starget = scsi_target(sdev);
 599                 rphy = dev_to_rphy(starget->dev.parent);
 600                 if (rphy->identify.sas_address == sas_address) {
 601                         sas_info->os.id = starget->id;
 602                         sas_info->os.channel = starget->channel;
 603                 }
 604         }
 605
 606  out:
 607         mutex_unlock(&ioc->sas_device_info_mutex);
 608         return;
 609 }
 610
 611 /**
 612  *      mptsas_add_device_component_by_fw -
 613  *      @ioc: Pointer to MPT_ADAPTER structure
 614  *      @channel:  fw mapped id's
 615  *      @id:
 616  *
 617  **/
 618 static void
 619 mptsas_add_device_component_by_fw(MPT_ADAPTER *ioc, u8 channel, u8 id)
 620 {
 621         struct mptsas_devinfo sas_device;
 622         struct mptsas_enclosure enclosure_info;
 623         int rc;
 624
 625         rc = mptsas_sas_device_pg0(ioc, &sas_device,
 626             (MPI_SAS_DEVICE_PGAD_FORM_BUS_TARGET_ID <<
 627              MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
 628             (channel << 8) + id);
 629         if (rc)
 630                 return;
 631
 632         memset(&enclosure_info, 0, sizeof(struct mptsas_enclosure));
 633         mptsas_sas_enclosure_pg0(ioc, &enclosure_info,
 634             (MPI_SAS_ENCLOS_PGAD_FORM_HANDLE <<
 635              MPI_SAS_ENCLOS_PGAD_FORM_SHIFT),
 636              sas_device.handle_enclosure);
 637
 638         mptsas_add_device_component(ioc, sas_device.channel,
 639             sas_device.id, sas_device.sas_address, sas_device.device_info,
 640             sas_device.slot, enclosure_info.enclosure_logical_id);
 641 }
 642
 643 /**
 644  *      mptsas_add_device_component_starget_ir - Handle Integrated RAID, adding each individual device to list
 645  *      @ioc: Pointer to MPT_ADAPTER structure
 646  *      @channel: fw mapped id's
 647  *      @id:
 648  *
 649  **/
 650 static void
 651 mptsas_add_device_component_starget_ir(MPT_ADAPTER *ioc,
 652                 struct scsi_target *starget)
 653 {
 654         CONFIGPARMS                     cfg;
 655         ConfigPageHeader_t              hdr;
 656         dma_addr_t                      dma_handle;
 657         pRaidVolumePage0_t              buffer = NULL;
 658         int                             i;
 659         RaidPhysDiskPage0_t             phys_disk;
 660         struct mptsas_device_info       *sas_info, *next;
 661
 662         memset(&cfg, 0 , sizeof(CONFIGPARMS));
 663         memset(&hdr, 0 , sizeof(ConfigPageHeader_t));
 664         hdr.PageType = MPI_CONFIG_PAGETYPE_RAID_VOLUME;
 665         /* assumption that all volumes on channel = 0 */
 666         cfg.pageAddr = starget->id;
 667         cfg.cfghdr.hdr = &hdr;
 668         cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
 669         cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
 670
 671         if (mpt_config(ioc, &cfg) != 0)
 672                 goto out;
 673
 674         if (!hdr.PageLength)
 675                 goto out;
 676
 677         buffer = pci_alloc_consistent(ioc->pcidev, hdr.PageLength * 4,
 678             &dma_handle);
 679
 680         if (!buffer)
 681                 goto out;
 682
 683         cfg.physAddr = dma_handle;
 684         cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
 685
 686         if (mpt_config(ioc, &cfg) != 0)
 687                 goto out;
 688
 689         if (!buffer->NumPhysDisks)
 690                 goto out;
 691
 692         /*
 693          * Adding entry for hidden components
 694          */
 695         for (i = 0; i < buffer->NumPhysDisks; i++) {
 696
 697                 if (mpt_raid_phys_disk_pg0(ioc,
 698                     buffer->PhysDisk[i].PhysDiskNum, &phys_disk) != 0)
 699                         continue;
 700
 701                 mptsas_add_device_component_by_fw(ioc, phys_disk.PhysDiskBus,
 702                     phys_disk.PhysDiskID);
 703
 704                 mutex_lock(&ioc->sas_device_info_mutex);
 705                 list_for_each_entry(sas_info, &ioc->sas_device_info_list,
 706                     list) {
 707                         if (!sas_info->is_logical_volume &&
 708                             (sas_info->fw.channel == phys_disk.PhysDiskBus &&
 709                             sas_info->fw.id == phys_disk.PhysDiskID)) {
 710                                 sas_info->is_hidden_raid_component = 1;
 711                                 sas_info->volume_id = starget->id;
 712                         }
 713                 }
 714                 mutex_unlock(&ioc->sas_device_info_mutex);
 715
 716         }
 717
 718         /*
 719          * Delete all matching devices out of the list
 720          */
 721         mutex_lock(&ioc->sas_device_info_mutex);
 722         list_for_each_entry_safe(sas_info, next, &ioc->sas_device_info_list,
 723             list) {
 724                 if (sas_info->is_logical_volume && sas_info->fw.id ==
 725                     starget->id) {
 726                         list_del(&sas_info->list);
 727                         kfree(sas_info);
 728                 }
 729         }
 730
 731         sas_info = kzalloc(sizeof(struct mptsas_device_info), GFP_KERNEL);
 732         if (sas_info) {
 733                 sas_info->fw.id = starget->id;
 734                 sas_info->os.id = starget->id;
 735                 sas_info->os.channel = starget->channel;
 736                 sas_info->is_logical_volume = 1;
 737                 INIT_LIST_HEAD(&sas_info->list);
 738                 list_add_tail(&sas_info->list, &ioc->sas_device_info_list);
 739         }
 740         mutex_unlock(&ioc->sas_device_info_mutex);
 741
 742  out:
 743         if (buffer)
 744                 pci_free_consistent(ioc->pcidev, hdr.PageLength * 4, buffer,
 745                     dma_handle);
 746 }
 747
 748 /**
 749  *      mptsas_add_device_component_starget -
 750  *      @ioc: Pointer to MPT_ADAPTER structure
 751  *      @starget:
 752  *
 753  **/
 754 static void
 755 mptsas_add_device_component_starget(MPT_ADAPTER *ioc,
 756         struct scsi_target *starget)
 757 {
 758         VirtTarget      *vtarget;
 759         struct sas_rphy *rphy;
 760         struct mptsas_phyinfo   *phy_info = NULL;
 761         struct mptsas_enclosure enclosure_info;
 762
 763         rphy = dev_to_rphy(starget->dev.parent);
 764         vtarget = starget->hostdata;
 765         phy_info = mptsas_find_phyinfo_by_sas_address(ioc,
 766                         rphy->identify.sas_address);
 767         if (!phy_info)
 768                 return;
 769
 770         memset(&enclosure_info, 0, sizeof(struct mptsas_enclosure));
 771         mptsas_sas_enclosure_pg0(ioc, &enclosure_info,
 772                 (MPI_SAS_ENCLOS_PGAD_FORM_HANDLE <<
 773                 MPI_SAS_ENCLOS_PGAD_FORM_SHIFT),
 774                 phy_info->attached.handle_enclosure);
 775
 776         mptsas_add_device_component(ioc, phy_info->attached.channel,
 777                 phy_info->attached.id, phy_info->attached.sas_address,
 778                 phy_info->attached.device_info,
 779                 phy_info->attached.slot, enclosure_info.enclosure_logical_id);
 780 }
 781
 782 /**
 783  *      mptsas_del_device_component_by_os - Once a device has been removed, we mark the entry in the list as being cached
 784  *      @ioc: Pointer to MPT_ADAPTER structure
 785  *      @channel: os mapped id's
 786  *      @id:
 787  *
 788  **/
 789 static void
 790 mptsas_del_device_component_by_os(MPT_ADAPTER *ioc, u8 channel, u8 id)
 791 {
 792         struct mptsas_device_info       *sas_info, *next;
 793
 794         /*
 795          * Set is_cached flag
 796          */
 797         list_for_each_entry_safe(sas_info, next, &ioc->sas_device_info_list,
 798                 list) {
 799                 if (sas_info->os.channel == channel && sas_info->os.id == id)
 800                         sas_info->is_cached = 1;
 801         }
 802 }
 803
 804 /**
 805  *      mptsas_del_device_components - Cleaning the list
 806  *      @ioc: Pointer to MPT_ADAPTER structure
 807  *
 808  **/
 809 static void
 810 mptsas_del_device_components(MPT_ADAPTER *ioc)
 811 {
 812         struct mptsas_device_info       *sas_info, *next;
 813
 814         mutex_lock(&ioc->sas_device_info_mutex);
 815         list_for_each_entry_safe(sas_info, next, &ioc->sas_device_info_list,
 816                 list) {
 817                 list_del(&sas_info->list);
 818                 kfree(sas_info);
 819         }
 820         mutex_unlock(&ioc->sas_device_info_mutex);
 821 }
 822
 823
 824 /*
 825  * mptsas_setup_wide_ports
 826  *
 827  * Updates for new and existing narrow/wide port configuration
 828  * in the sas_topology
 829  */
 830 static void
 831 mptsas_setup_wide_ports(MPT_ADAPTER *ioc, struct mptsas_portinfo *port_info)
 832 {
 833         struct mptsas_portinfo_details * port_details;
 834         struct mptsas_phyinfo *phy_info, *phy_info_cmp;
 835         u64     sas_address;
 836         int     i, j;
 837
 838         mutex_lock(&ioc->sas_topology_mutex);
 839
 840         phy_info = port_info->phy_info;
 841         for (i = 0 ; i < port_info->num_phys ; i++, phy_info++) {
 842                 if (phy_info->attached.handle)
 843                         continue;
 844                 port_details = phy_info->port_details;
 845                 if (!port_details)
 846                         continue;
 847                 if (port_details->num_phys < 2)
 848                         continue;
 849                 /*
 850                  * Removing a phy from a port, letting the last
 851                  * phy be removed by firmware events.
 852                  */
 853                 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT
 854                     "%s: [%p]: deleting phy = %d\n",
 855                     ioc->name, __func__, port_details, i));
 856                 port_details->num_phys--;
 857                 port_details->phy_bitmask &= ~ (1 << phy_info->phy_id);
 858                 memset(&phy_info->attached, 0, sizeof(struct mptsas_devinfo));
 859                 if (phy_info->phy) {
 860                         devtprintk(ioc, dev_printk(KERN_DEBUG,
 861                                 &phy_info->phy->dev, MYIOC_s_FMT
 862                                 "delete phy %d, phy-obj (0x%p)\n", ioc->name,
 863                                 phy_info->phy_id, phy_info->phy));
 864                         sas_port_delete_phy(port_details->port, phy_info->phy);
 865                 }
 866                 phy_info->port_details = NULL;
 867         }
 868
 869         /*
 870          * Populate and refresh the tree
 871          */
 872         phy_info = port_info->phy_info;
 873         for (i = 0 ; i < port_info->num_phys ; i++, phy_info++) {
 874                 sas_address = phy_info->attached.sas_address;
 875                 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "phy_id=%d sas_address=0x%018llX\n",
 876                     ioc->name, i, (unsigned long long)sas_address));
 877                 if (!sas_address)
 878                         continue;
 879                 port_details = phy_info->port_details;
 880                 /*
 881                  * Forming a port
 882                  */
 883                 if (!port_details) {
 884                         port_details = kzalloc(sizeof(struct
 885                                 mptsas_portinfo_details), GFP_KERNEL);
 886                         if (!port_details)
 887                                 goto out;
 888                         port_details->num_phys = 1;
 889                         port_details->port_info = port_info;
 890                         if (phy_info->phy_id < 64 )
 891                                 port_details->phy_bitmask |=
 892                                     (1 << phy_info->phy_id);
 893                         phy_info->sas_port_add_phy=1;
 894                         dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "\t\tForming port\n\t\t"
 895                             "phy_id=%d sas_address=0x%018llX\n",
 896                             ioc->name, i, (unsigned long long)sas_address));
 897                         phy_info->port_details = port_details;
 898                 }
 899
 900                 if (i == port_info->num_phys - 1)
 901                         continue;
 902                 phy_info_cmp = &port_info->phy_info[i + 1];
 903                 for (j = i + 1 ; j < port_info->num_phys ; j++,
 904                     phy_info_cmp++) {
 905                         if (!phy_info_cmp->attached.sas_address)
 906                                 continue;
 907                         if (sas_address != phy_info_cmp->attached.sas_address)
 908                                 continue;
 909                         if (phy_info_cmp->port_details == port_details )
 910                                 continue;
 911                         dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT
 912                             "\t\tphy_id=%d sas_address=0x%018llX\n",
 913                             ioc->name, j, (unsigned long long)
 914                             phy_info_cmp->attached.sas_address));
 915                         if (phy_info_cmp->port_details) {
 916                                 port_details->rphy =
 917                                     mptsas_get_rphy(phy_info_cmp);
 918                                 port_details->port =
 919                                     mptsas_get_port(phy_info_cmp);
 920                                 port_details->starget =
 921                                     mptsas_get_starget(phy_info_cmp);
 922                                 port_details->num_phys =
 923                                         phy_info_cmp->port_details->num_phys;
 924                                 if (!phy_info_cmp->port_details->num_phys)
 925                                         kfree(phy_info_cmp->port_details);
 926                         } else
 927                                 phy_info_cmp->sas_port_add_phy=1;
 928                         /*
 929                          * Adding a phy to a port
 930                          */
 931                         phy_info_cmp->port_details = port_details;
 932                         if (phy_info_cmp->phy_id < 64 )
 933                                 port_details->phy_bitmask |=
 934                                 (1 << phy_info_cmp->phy_id);
 935                         port_details->num_phys++;
 936                 }
 937         }
 938
 939  out:
 940
 941         for (i = 0; i < port_info->num_phys; i++) {
 942                 port_details = port_info->phy_info[i].port_details;
 943                 if (!port_details)
 944                         continue;
 945                 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT
 946                     "%s: [%p]: phy_id=%02d num_phys=%02d "
 947                     "bitmask=0x%016llX\n", ioc->name, __func__,
 948                     port_details, i, port_details->num_phys,
 949                     (unsigned long long)port_details->phy_bitmask));
 950                 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "\t\tport = %p rphy=%p\n",
 951                     ioc->name, port_details->port, port_details->rphy));
 952         }
 953         dsaswideprintk(ioc, printk("\n"));
 954         mutex_unlock(&ioc->sas_topology_mutex);
 955 }
 956
 957 /**
 958  * csmisas_find_vtarget
 959  *
 960  * @ioc
 961  * @volume_id
 962  * @volume_bus
 963  *
 964  **/
 965 static VirtTarget *
 966 mptsas_find_vtarget(MPT_ADAPTER *ioc, u8 channel, u8 id)
 967 {
 968         struct scsi_device              *sdev;
 969         VirtDevice                      *vdevice;
 970         VirtTarget                      *vtarget = NULL;
 971
 972         shost_for_each_device(sdev, ioc->sh) {
 973                 vdevice = sdev->hostdata;
 974                 if ((vdevice == NULL) ||
 975                         (vdevice->vtarget == NULL))
 976                         continue;
 977                 if ((vdevice->vtarget->tflags &
 978                     MPT_TARGET_FLAGS_RAID_COMPONENT ||
 979                     vdevice->vtarget->raidVolume))
 980                         continue;
 981                 if (vdevice->vtarget->id == id &&
 982                         vdevice->vtarget->channel == channel)
 983                         vtarget = vdevice->vtarget;
 984         }
 985         return vtarget;
 986 }
 987
 988 static void
 989 mptsas_queue_device_delete(MPT_ADAPTER *ioc,
 990         MpiEventDataSasDeviceStatusChange_t *sas_event_data)
 991 {
 992         struct fw_event_work *fw_event;
 993         int sz;
 994
 995         sz = offsetof(struct fw_event_work, event_data) +
 996             sizeof(MpiEventDataSasDeviceStatusChange_t);
 997         fw_event = kzalloc(sz, GFP_ATOMIC);
 998         if (!fw_event) {
 999                 printk(MYIOC_s_WARN_FMT "%s: failed at (line=%d)\n",
1000                     ioc->name, __func__, __LINE__);
1001                 return;
1002         }
1003         memcpy(fw_event->event_data, sas_event_data,
1004             sizeof(MpiEventDataSasDeviceStatusChange_t));
1005         fw_event->event = MPI_EVENT_SAS_DEVICE_STATUS_CHANGE;
1006         fw_event->ioc = ioc;
1007         mptsas_add_fw_event(ioc, fw_event, msecs_to_jiffies(1));
1008 }
1009
1010 static void
1011 mptsas_queue_rescan(MPT_ADAPTER *ioc)
1012 {
1013         struct fw_event_work *fw_event;
1014         int sz;
1015
1016         sz = offsetof(struct fw_event_work, event_data);
1017         fw_event = kzalloc(sz, GFP_ATOMIC);
1018         if (!fw_event) {
1019                 printk(MYIOC_s_WARN_FMT "%s: failed at (line=%d)\n",
1020                     ioc->name, __func__, __LINE__);
1021                 return;
1022         }
1023         fw_event->event = -1;
1024         fw_event->ioc = ioc;
1025         mptsas_add_fw_event(ioc, fw_event, msecs_to_jiffies(1));
1026 }
1027
1028
1029 /**
1030  * mptsas_target_reset
1031  *
1032  * Issues TARGET_RESET to end device using handshaking method
1033  *
1034  * @ioc
1035  * @channel
1036  * @id
1037  *
1038  * Returns (1) success
1039  *         (0) failure
1040  *
1041  **/
1042 static int
1043 mptsas_target_reset(MPT_ADAPTER *ioc, u8 channel, u8 id)
1044 {
1045         MPT_FRAME_HDR   *mf;
1046         SCSITaskMgmt_t  *pScsiTm;
1047         if (mpt_set_taskmgmt_in_progress_flag(ioc) != 0)
1048                 return 0;
1049
1050
1051         mf = mpt_get_msg_frame(mptsasDeviceResetCtx, ioc);
1052         if (mf == NULL) {
1053                 dfailprintk(ioc, printk(MYIOC_s_WARN_FMT
1054                         "%s, no msg frames @%d!!\n", ioc->name,
1055                         __func__, __LINE__));
1056                 goto out_fail;
1057         }
1058
1059         dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT "TaskMgmt request (mf=%p)\n",
1060                 ioc->name, mf));
1061
1062         /* Format the Request
1063          */
1064         pScsiTm = (SCSITaskMgmt_t *) mf;
1065         memset (pScsiTm, 0, sizeof(SCSITaskMgmt_t));
1066         pScsiTm->TargetID = id;
1067         pScsiTm->Bus = channel;
1068         pScsiTm->Function = MPI_FUNCTION_SCSI_TASK_MGMT;
1069         pScsiTm->TaskType = MPI_SCSITASKMGMT_TASKTYPE_TARGET_RESET;
1070         pScsiTm->MsgFlags = MPI_SCSITASKMGMT_MSGFLAGS_LIPRESET_RESET_OPTION;
1071
1072         DBG_DUMP_TM_REQUEST_FRAME(ioc, (u32 *)mf);
1073
1074         dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
1075            "TaskMgmt type=%d (sas device delete) fw_channel = %d fw_id = %d)\n",
1076            ioc->name, MPI_SCSITASKMGMT_TASKTYPE_TARGET_RESET, channel, id));
1077
1078         mpt_put_msg_frame_hi_pri(mptsasDeviceResetCtx, ioc, mf);
1079
1080         return 1;
1081
1082  out_fail:
1083
1084         mpt_clear_taskmgmt_in_progress_flag(ioc);
1085         return 0;
1086 }
1087
1088 static void
1089 mptsas_block_io_sdev(struct scsi_device *sdev, void *data)
1090 {
1091         scsi_device_set_state(sdev, SDEV_BLOCK);
1092 }
1093
1094 static void
1095 mptsas_block_io_starget(struct scsi_target *starget)
1096 {
1097         if (starget)
1098                 starget_for_each_device(starget, NULL, mptsas_block_io_sdev);
1099 }
1100
1101 /**
1102  * mptsas_target_reset_queue
1103  *
1104  * Receive request for TARGET_RESET after receiving an firmware
1105  * event NOT_RESPONDING_EVENT, then put command in link list
1106  * and queue if task_queue already in use.
1107  *
1108  * @ioc
1109  * @sas_event_data
1110  *
1111  **/
1112 static void
1113 mptsas_target_reset_queue(MPT_ADAPTER *ioc,
1114     EVENT_DATA_SAS_DEVICE_STATUS_CHANGE *sas_event_data)
1115 {
1116         MPT_SCSI_HOST   *hd = shost_priv(ioc->sh);
1117         VirtTarget *vtarget = NULL;
1118         struct mptsas_target_reset_event *target_reset_list;
1119         u8              id, channel;
1120
1121         id = sas_event_data->TargetID;
1122         channel = sas_event_data->Bus;
1123
1124         vtarget = mptsas_find_vtarget(ioc, channel, id);
1125         if (vtarget) {
1126                 mptsas_block_io_starget(vtarget->starget);
1127                 vtarget->deleted = 1; /* block IO */
1128         }
1129
1130         target_reset_list = kzalloc(sizeof(struct mptsas_target_reset_event),
1131             GFP_ATOMIC);
1132         if (!target_reset_list) {
1133                 dfailprintk(ioc, printk(MYIOC_s_WARN_FMT
1134                         "%s, failed to allocate mem @%d..!!\n",
1135                         ioc->name, __func__, __LINE__));
1136                 return;
1137         }
1138
1139         memcpy(&target_reset_list->sas_event_data, sas_event_data,
1140                 sizeof(*sas_event_data));
1141         list_add_tail(&target_reset_list->list, &hd->target_reset_list);
1142
1143         target_reset_list->time_count = jiffies;
1144
1145         if (mptsas_target_reset(ioc, channel, id)) {
1146                 target_reset_list->target_reset_issued = 1;
1147         }
1148 }
1149
1150 /**
1151  * mptsas_schedule_target_reset- send pending target reset
1152  * @iocp: per adapter object
1153  *
1154  * This function will delete scheduled target reset from the list and
1155  * try to send next target reset. This will be called from completion
1156  * context of any Task management command.
1157  */
1158
1159 void
1160 mptsas_schedule_target_reset(void *iocp)
1161 {
1162         MPT_ADAPTER *ioc = (MPT_ADAPTER *)(iocp);
1163         MPT_SCSI_HOST   *hd = shost_priv(ioc->sh);
1164         struct list_head *head = &hd->target_reset_list;
1165         struct mptsas_target_reset_event        *target_reset_list;
1166         u8              id, channel;
1167         /*
1168          * issue target reset to next device in the queue
1169          */
1170
1171         head = &hd->target_reset_list;
1172         if (list_empty(head))
1173                 return;
1174
1175         target_reset_list = list_entry(head->next,
1176                 struct mptsas_target_reset_event, list);
1177
1178         id = target_reset_list->sas_event_data.TargetID;
1179         channel = target_reset_list->sas_event_data.Bus;
1180         target_reset_list->time_count = jiffies;
1181
1182         if (mptsas_target_reset(ioc, channel, id))
1183                 target_reset_list->target_reset_issued = 1;
1184         return;
1185 }
1186
1187
1188 /**
1189  *      mptsas_taskmgmt_complete - complete SAS task management function
1190  *      @ioc: Pointer to MPT_ADAPTER structure
1191  *
1192  *      Completion for TARGET_RESET after NOT_RESPONDING_EVENT, enable work
1193  *      queue to finish off removing device from upper layers. then send next
1194  *      TARGET_RESET in the queue.
1195  **/
1196 static int
1197 mptsas_taskmgmt_complete(MPT_ADAPTER *ioc, MPT_FRAME_HDR *mf, MPT_FRAME_HDR *mr)
1198 {
1199         MPT_SCSI_HOST   *hd = shost_priv(ioc->sh);
1200         struct list_head *head = &hd->target_reset_list;
1201         u8              id, channel;
1202         struct mptsas_target_reset_event        *target_reset_list;
1203         SCSITaskMgmtReply_t *pScsiTmReply;
1204
1205         dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT "TaskMgmt completed: "
1206             "(mf = %p, mr = %p)\n", ioc->name, mf, mr));
1207
1208         pScsiTmReply = (SCSITaskMgmtReply_t *)mr;
1209         if (pScsiTmReply) {
1210                 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
1211                     "\tTaskMgmt completed: fw_channel = %d, fw_id = %d,\n"
1212                     "\ttask_type = 0x%02X, iocstatus = 0x%04X "
1213                     "loginfo = 0x%08X,\n\tresponse_code = 0x%02X, "
1214                     "term_cmnds = %d\n", ioc->name,
1215                     pScsiTmReply->Bus, pScsiTmReply->TargetID,
1216                     pScsiTmReply->TaskType,
1217                     le16_to_cpu(pScsiTmReply->IOCStatus),
1218                     le32_to_cpu(pScsiTmReply->IOCLogInfo),
1219                     pScsiTmReply->ResponseCode,
1220                     le32_to_cpu(pScsiTmReply->TerminationCount)));
1221
1222                 if (pScsiTmReply->ResponseCode)
1223                         mptscsih_taskmgmt_response_code(ioc,
1224                         pScsiTmReply->ResponseCode);
1225         }
1226
1227         if (pScsiTmReply && (pScsiTmReply->TaskType ==
1228             MPI_SCSITASKMGMT_TASKTYPE_QUERY_TASK || pScsiTmReply->TaskType ==
1229              MPI_SCSITASKMGMT_TASKTYPE_ABRT_TASK_SET)) {
1230                 ioc->taskmgmt_cmds.status |= MPT_MGMT_STATUS_COMMAND_GOOD;
1231                 ioc->taskmgmt_cmds.status |= MPT_MGMT_STATUS_RF_VALID;
1232                 memcpy(ioc->taskmgmt_cmds.reply, mr,
1233                     min(MPT_DEFAULT_FRAME_SIZE, 4 * mr->u.reply.MsgLength));
1234                 if (ioc->taskmgmt_cmds.status & MPT_MGMT_STATUS_PENDING) {
1235                         ioc->taskmgmt_cmds.status &= ~MPT_MGMT_STATUS_PENDING;
1236                         complete(&ioc->taskmgmt_cmds.done);
1237                         return 1;
1238                 }
1239                 return 0;
1240         }
1241
1242         mpt_clear_taskmgmt_in_progress_flag(ioc);
1243
1244         if (list_empty(head))
1245                 return 1;
1246
1247         target_reset_list = list_entry(head->next,
1248             struct mptsas_target_reset_event, list);
1249
1250         dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
1251             "TaskMgmt: completed (%d seconds)\n",
1252             ioc->name, jiffies_to_msecs(jiffies -
1253             target_reset_list->time_count)/1000));
1254
1255         id = pScsiTmReply->TargetID;
1256         channel = pScsiTmReply->Bus;
1257         target_reset_list->time_count = jiffies;
1258
1259         /*
1260          * retry target reset
1261          */
1262         if (!target_reset_list->target_reset_issued) {
1263                 if (mptsas_target_reset(ioc, channel, id))
1264                         target_reset_list->target_reset_issued = 1;
1265                 return 1;
1266         }
1267
1268         /*
1269          * enable work queue to remove device from upper layers
1270          */
1271         list_del(&target_reset_list->list);
1272         if (!ioc->fw_events_off)
1273                 mptsas_queue_device_delete(ioc,
1274                         &target_reset_list->sas_event_data);
1275
1276
1277         ioc->schedule_target_reset(ioc);
1278
1279         return 1;
1280 }
1281
1282 /**
1283  * mptscsih_ioc_reset
1284  *
1285  * @ioc
1286  * @reset_phase
1287  *
1288  **/
1289 static int
1290 mptsas_ioc_reset(MPT_ADAPTER *ioc, int reset_phase)
1291 {
1292         MPT_SCSI_HOST   *hd;
1293         int rc;
1294
1295         rc = mptscsih_ioc_reset(ioc, reset_phase);
1296         if ((ioc->bus_type != SAS) || (!rc))
1297                 return rc;
1298
1299         hd = shost_priv(ioc->sh);
1300         if (!hd->ioc)
1301                 goto out;
1302
1303         switch (reset_phase) {
1304         case MPT_IOC_SETUP_RESET:
1305                 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
1306                     "%s: MPT_IOC_SETUP_RESET\n", ioc->name, __func__));
1307                 mptsas_fw_event_off(ioc);
1308                 break;
1309         case MPT_IOC_PRE_RESET:
1310                 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
1311                     "%s: MPT_IOC_PRE_RESET\n", ioc->name, __func__));
1312                 break;
1313         case MPT_IOC_POST_RESET:
1314                 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
1315                     "%s: MPT_IOC_POST_RESET\n", ioc->name, __func__));
1316                 if (ioc->sas_mgmt.status & MPT_MGMT_STATUS_PENDING) {
1317                         ioc->sas_mgmt.status |= MPT_MGMT_STATUS_DID_IOCRESET;
1318                         complete(&ioc->sas_mgmt.done);
1319                 }
1320                 mptsas_cleanup_fw_event_q(ioc);
1321                 mptsas_queue_rescan(ioc);
1322                 break;
1323         default:
1324                 break;
1325         }
1326
1327  out:
1328         return rc;
1329 }
1330
1331
1332 /**
1333  * enum device_state -
1334  * @DEVICE_RETRY: need to retry the TUR
1335  * @DEVICE_ERROR: TUR return error, don't add device
1336  * @DEVICE_READY: device can be added
1337  *
1338  */
1339 enum device_state{
1340         DEVICE_RETRY,
1341         DEVICE_ERROR,
1342         DEVICE_READY,
1343 };
1344
1345 static int
1346 mptsas_sas_enclosure_pg0(MPT_ADAPTER *ioc, struct mptsas_enclosure *enclosure,
1347                 u32 form, u32 form_specific)
1348 {
1349         ConfigExtendedPageHeader_t hdr;
1350         CONFIGPARMS cfg;
1351         SasEnclosurePage0_t *buffer;
1352         dma_addr_t dma_handle;
1353         int error;
1354         __le64 le_identifier;
1355
1356         memset(&hdr, 0, sizeof(hdr));
1357         hdr.PageVersion = MPI_SASENCLOSURE0_PAGEVERSION;
1358         hdr.PageNumber = 0;
1359         hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
1360         hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_ENCLOSURE;
1361
1362         cfg.cfghdr.ehdr = &hdr;
1363         cfg.physAddr = -1;
1364         cfg.pageAddr = form + form_specific;
1365         cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
1366         cfg.dir = 0;    /* read */
1367         cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
1368
1369         error = mpt_config(ioc, &cfg);
1370         if (error)
1371                 goto out;
1372         if (!hdr.ExtPageLength) {
1373                 error = -ENXIO;
1374                 goto out;
1375         }
1376
1377         buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
1378                         &dma_handle);
1379         if (!buffer) {
1380                 error = -ENOMEM;
1381                 goto out;
1382         }
1383
1384         cfg.physAddr = dma_handle;
1385         cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
1386
1387         error = mpt_config(ioc, &cfg);
1388         if (error)
1389                 goto out_free_consistent;
1390
1391         /* save config data */
1392         memcpy(&le_identifier, &buffer->EnclosureLogicalID, sizeof(__le64));
1393         enclosure->enclosure_logical_id = le64_to_cpu(le_identifier);
1394         enclosure->enclosure_handle = le16_to_cpu(buffer->EnclosureHandle);
1395         enclosure->flags = le16_to_cpu(buffer->Flags);
1396         enclosure->num_slot = le16_to_cpu(buffer->NumSlots);
1397         enclosure->start_slot = le16_to_cpu(buffer->StartSlot);
1398         enclosure->start_id = buffer->StartTargetID;
1399         enclosure->start_channel = buffer->StartBus;
1400         enclosure->sep_id = buffer->SEPTargetID;
1401         enclosure->sep_channel = buffer->SEPBus;
1402
1403  out_free_consistent:
1404         pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
1405                             buffer, dma_handle);
1406  out:
1407         return error;
1408 }
1409
1410 /**
1411  *      mptsas_add_end_device - report a new end device to sas transport layer
1412  *      @ioc: Pointer to MPT_ADAPTER structure
1413  *      @phy_info: describes attached device
1414  *
1415  *      return (0) success (1) failure
1416  *
1417  **/
1418 static int
1419 mptsas_add_end_device(MPT_ADAPTER *ioc, struct mptsas_phyinfo *phy_info)
1420 {
1421         struct sas_rphy *rphy;
1422         struct sas_port *port;
1423         struct sas_identify identify;
1424         char *ds = NULL;
1425         u8 fw_id;
1426
1427         if (!phy_info) {
1428                 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
1429                         "%s: exit at line=%d\n", ioc->name,
1430                          __func__, __LINE__));
1431                 return 1;
1432         }
1433
1434         fw_id = phy_info->attached.id;
1435
1436         if (mptsas_get_rphy(phy_info)) {
1437                 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
1438                         "%s: fw_id=%d exit at line=%d\n", ioc->name,
1439                          __func__, fw_id, __LINE__));
1440                 return 2;
1441         }
1442
1443         port = mptsas_get_port(phy_info);
1444         if (!port) {
1445                 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
1446                         "%s: fw_id=%d exit at line=%d\n", ioc->name,
1447                          __func__, fw_id, __LINE__));
1448                 return 3;
1449         }
1450
1451         if (phy_info->attached.device_info &
1452             MPI_SAS_DEVICE_INFO_SSP_TARGET)
1453                 ds = "ssp";
1454         if (phy_info->attached.device_info &
1455             MPI_SAS_DEVICE_INFO_STP_TARGET)
1456                 ds = "stp";
1457         if (phy_info->attached.device_info &
1458             MPI_SAS_DEVICE_INFO_SATA_DEVICE)
1459                 ds = "sata";
1460
1461         printk(MYIOC_s_INFO_FMT "attaching %s device: fw_channel %d, fw_id %d,"
1462             " phy %d, sas_addr 0x%llx\n", ioc->name, ds,
1463             phy_info->attached.channel, phy_info->attached.id,
1464             phy_info->attached.phy_id, (unsigned long long)
1465             phy_info->attached.sas_address);
1466
1467         mptsas_parse_device_info(&identify, &phy_info->attached);
1468         rphy = sas_end_device_alloc(port);
1469         if (!rphy) {
1470                 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
1471                         "%s: fw_id=%d exit at line=%d\n", ioc->name,
1472                          __func__, fw_id, __LINE__));
1473                 return 5; /* non-fatal: an rphy can be added later */
1474         }
1475
1476         rphy->identify = identify;
1477         if (sas_rphy_add(rphy)) {
1478                 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
1479                         "%s: fw_id=%d exit at line=%d\n", ioc->name,
1480                          __func__, fw_id, __LINE__));
1481                 sas_rphy_free(rphy);
1482                 return 6;
1483         }
1484         mptsas_set_rphy(ioc, phy_info, rphy);
1485         return 0;
1486 }
1487
1488 /**
1489  *      mptsas_del_end_device - report a deleted end device to sas transport layer
1490  *      @ioc: Pointer to MPT_ADAPTER structure
1491  *      @phy_info: describes attached device
1492  *
1493  **/
1494 static void
1495 mptsas_del_end_device(MPT_ADAPTER *ioc, struct mptsas_phyinfo *phy_info)
1496 {
1497         struct sas_rphy *rphy;
1498         struct sas_port *port;
1499         struct mptsas_portinfo *port_info;
1500         struct mptsas_phyinfo *phy_info_parent;
1501         int i;
1502         char *ds = NULL;
1503         u8 fw_id;
1504         u64 sas_address;
1505
1506         if (!phy_info)
1507                 return;
1508
1509         fw_id = phy_info->attached.id;
1510         sas_address = phy_info->attached.sas_address;
1511
1512         if (!phy_info->port_details) {
1513                 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
1514                         "%s: fw_id=%d exit at line=%d\n", ioc->name,
1515                          __func__, fw_id, __LINE__));
1516                 return;
1517         }
1518         rphy = mptsas_get_rphy(phy_info);
1519         if (!rphy) {
1520                 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
1521                         "%s: fw_id=%d exit at line=%d\n", ioc->name,
1522                          __func__, fw_id, __LINE__));
1523                 return;
1524         }
1525
1526         if (phy_info->attached.device_info & MPI_SAS_DEVICE_INFO_SSP_INITIATOR
1527                 || phy_info->attached.device_info
1528                         & MPI_SAS_DEVICE_INFO_SMP_INITIATOR
1529                 || phy_info->attached.device_info
1530                         & MPI_SAS_DEVICE_INFO_STP_INITIATOR)
1531                 ds = "initiator";
1532         if (phy_info->attached.device_info &
1533             MPI_SAS_DEVICE_INFO_SSP_TARGET)
1534                 ds = "ssp";
1535         if (phy_info->attached.device_info &
1536             MPI_SAS_DEVICE_INFO_STP_TARGET)
1537                 ds = "stp";
1538         if (phy_info->attached.device_info &
1539             MPI_SAS_DEVICE_INFO_SATA_DEVICE)
1540                 ds = "sata";
1541
1542         dev_printk(KERN_DEBUG, &rphy->dev, MYIOC_s_FMT
1543             "removing %s device: fw_channel %d, fw_id %d, phy %d,"
1544             "sas_addr 0x%llx\n", ioc->name, ds, phy_info->attached.channel,
1545             phy_info->attached.id, phy_info->attached.phy_id,
1546             (unsigned long long) sas_address);
1547
1548         port = mptsas_get_port(phy_info);
1549         if (!port) {
1550                 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
1551                         "%s: fw_id=%d exit at line=%d\n", ioc->name,
1552                          __func__, fw_id, __LINE__));
1553                 return;
1554         }
1555         port_info = phy_info->portinfo;
1556         phy_info_parent = port_info->phy_info;
1557         for (i = 0; i < port_info->num_phys; i++, phy_info_parent++) {
1558                 if (!phy_info_parent->phy)
1559                         continue;
1560                 if (phy_info_parent->attached.sas_address !=
1561                     sas_address)
1562                         continue;
1563                 dev_printk(KERN_DEBUG, &phy_info_parent->phy->dev,
1564                     MYIOC_s_FMT "delete phy %d, phy-obj (0x%p)\n",
1565                     ioc->name, phy_info_parent->phy_id,
1566                     phy_info_parent->phy);
1567                 sas_port_delete_phy(port, phy_info_parent->phy);
1568         }
1569
1570         dev_printk(KERN_DEBUG, &port->dev, MYIOC_s_FMT
1571             "delete port %d, sas_addr (0x%llx)\n", ioc->name,
1572              port->port_identifier, (unsigned long long)sas_address);
1573         sas_port_delete(port);
1574         mptsas_set_port(ioc, phy_info, NULL);
1575         mptsas_port_delete(ioc, phy_info->port_details);
1576 }
1577
1578 struct mptsas_phyinfo *
1579 mptsas_refreshing_device_handles(MPT_ADAPTER *ioc,
1580         struct mptsas_devinfo *sas_device)
1581 {
1582         struct mptsas_phyinfo *phy_info;
1583         struct mptsas_portinfo *port_info;
1584         int i;
1585
1586         phy_info = mptsas_find_phyinfo_by_sas_address(ioc,
1587             sas_device->sas_address);
1588         if (!phy_info)
1589                 goto out;
1590         port_info = phy_info->portinfo;
1591         if (!port_info)
1592                 goto out;
1593         mutex_lock(&ioc->sas_topology_mutex);
1594         for (i = 0; i < port_info->num_phys; i++) {
1595                 if (port_info->phy_info[i].attached.sas_address !=
1596                         sas_device->sas_address)
1597                         continue;
1598                 port_info->phy_info[i].attached.channel = sas_device->channel;
1599                 port_info->phy_info[i].attached.id = sas_device->id;
1600                 port_info->phy_info[i].attached.sas_address =
1601                     sas_device->sas_address;
1602                 port_info->phy_info[i].attached.handle = sas_device->handle;
1603                 port_info->phy_info[i].attached.handle_parent =
1604                     sas_device->handle_parent;
1605                 port_info->phy_info[i].attached.handle_enclosure =
1606                     sas_device->handle_enclosure;
1607         }
1608         mutex_unlock(&ioc->sas_topology_mutex);
1609  out:
1610         return phy_info;
1611 }
1612
1613 /**
1614  * mptsas_firmware_event_work - work thread for processing fw events
1615  * @work: work queue payload containing info describing the event
1616  * Context: user
1617  *
1618  */
1619 static void
1620 mptsas_firmware_event_work(struct work_struct *work)
1621 {
1622         struct fw_event_work *fw_event =
1623                 container_of(work, struct fw_event_work, work.work);
1624         MPT_ADAPTER *ioc = fw_event->ioc;
1625
1626         /* special rescan topology handling */
1627         if (fw_event->event == -1) {
1628                 if (ioc->in_rescan) {
1629                         devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT
1630                                 "%s: rescan ignored as it is in progress\n",
1631                                 ioc->name, __func__));
1632                         return;
1633                 }
1634                 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT "%s: rescan after "
1635                     "reset\n", ioc->name, __func__));
1636                 ioc->in_rescan = 1;
1637                 mptsas_not_responding_devices(ioc);
1638                 mptsas_scan_sas_topology(ioc);
1639                 ioc->in_rescan = 0;
1640                 mptsas_free_fw_event(ioc, fw_event);
1641                 mptsas_fw_event_on(ioc);
1642                 return;
1643         }
1644
1645         /* events handling turned off during host reset */
1646         if (ioc->fw_events_off) {
1647                 mptsas_free_fw_event(ioc, fw_event);
1648                 return;
1649         }
1650
1651         devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT "%s: fw_event=(0x%p), "
1652             "event = (0x%02x)\n", ioc->name, __func__, fw_event,
1653             (fw_event->event & 0xFF)));
1654
1655         switch (fw_event->event) {
1656         case MPI_EVENT_SAS_DEVICE_STATUS_CHANGE:
1657                 mptsas_send_sas_event(fw_event);
1658                 break;
1659         case MPI_EVENT_INTEGRATED_RAID:
1660                 mptsas_send_raid_event(fw_event);
1661                 break;
1662         case MPI_EVENT_IR2:
1663                 mptsas_send_ir2_event(fw_event);
1664                 break;
1665         case MPI_EVENT_PERSISTENT_TABLE_FULL:
1666                 mptbase_sas_persist_operation(ioc,
1667                     MPI_SAS_OP_CLEAR_NOT_PRESENT);
1668                 mptsas_free_fw_event(ioc, fw_event);
1669                 break;
1670         case MPI_EVENT_SAS_BROADCAST_PRIMITIVE:
1671                 mptsas_broadcast_primative_work(fw_event);
1672                 break;
1673         case MPI_EVENT_SAS_EXPANDER_STATUS_CHANGE:
1674                 mptsas_send_expander_event(fw_event);
1675                 break;
1676         case MPI_EVENT_SAS_PHY_LINK_STATUS:
1677                 mptsas_send_link_status_event(fw_event);
1678                 break;
1679         case MPI_EVENT_QUEUE_FULL:
1680                 mptsas_handle_queue_full_event(fw_event);
1681                 break;
1682         }
1683 }
1684
1685
1686
1687 static int
1688 mptsas_slave_configure(struct scsi_device *sdev)
1689 {
1690         struct Scsi_Host        *host = sdev->host;
1691         MPT_SCSI_HOST   *hd = shost_priv(host);
1692         MPT_ADAPTER     *ioc = hd->ioc;
1693         VirtDevice      *vdevice = sdev->hostdata;
1694
1695         if (vdevice->vtarget->deleted) {
1696                 sdev_printk(KERN_INFO, sdev, "clearing deleted flag\n");
1697                 vdevice->vtarget->deleted = 0;
1698         }
1699
1700         /*
1701          * RAID volumes placed beyond the last expected port.
1702          * Ignore sending sas mode pages in that case..
1703          */
1704         if (sdev->channel == MPTSAS_RAID_CHANNEL) {
1705                 mptsas_add_device_component_starget_ir(ioc, scsi_target(sdev));
1706                 goto out;
1707         }
1708
1709         sas_read_port_mode_page(sdev);
1710
1711         mptsas_add_device_component_starget(ioc, scsi_target(sdev));
1712
1713  out:
1714         return mptscsih_slave_configure(sdev);
1715 }
1716
1717 static int
1718 mptsas_target_alloc(struct scsi_target *starget)
1719 {
1720         struct Scsi_Host *host = dev_to_shost(&starget->dev);
1721         MPT_SCSI_HOST           *hd = shost_priv(host);
1722         VirtTarget              *vtarget;
1723         u8                      id, channel;
1724         struct sas_rphy         *rphy;
1725         struct mptsas_portinfo  *p;
1726         int                      i;
1727         MPT_ADAPTER             *ioc = hd->ioc;
1728
1729         vtarget = kzalloc(sizeof(VirtTarget), GFP_KERNEL);
1730         if (!vtarget)
1731                 return -ENOMEM;
1732
1733         vtarget->starget = starget;
1734         vtarget->ioc_id = ioc->id;
1735         vtarget->tflags = MPT_TARGET_FLAGS_Q_YES;
1736         id = starget->id;
1737         channel = 0;
1738
1739         /*
1740          * RAID volumes placed beyond the last expected port.
1741          */
1742         if (starget->channel == MPTSAS_RAID_CHANNEL) {
1743                 if (!ioc->raid_data.pIocPg2) {
1744                         kfree(vtarget);
1745                         return -ENXIO;
1746                 }
1747                 for (i = 0; i < ioc->raid_data.pIocPg2->NumActiveVolumes; i++) {
1748                         if (id == ioc->raid_data.pIocPg2->
1749                                         RaidVolume[i].VolumeID) {
1750                                 channel = ioc->raid_data.pIocPg2->
1751                                         RaidVolume[i].VolumeBus;
1752                         }
1753                 }
1754                 vtarget->raidVolume = 1;
1755                 goto out;
1756         }
1757
1758         rphy = dev_to_rphy(starget->dev.parent);
1759         mutex_lock(&ioc->sas_topology_mutex);
1760         list_for_each_entry(p, &ioc->sas_topology, list) {
1761                 for (i = 0; i < p->num_phys; i++) {
1762                         if (p->phy_info[i].attached.sas_address !=
1763                                         rphy->identify.sas_address)
1764                                 continue;
1765                         id = p->phy_info[i].attached.id;
1766                         channel = p->phy_info[i].attached.channel;
1767                         mptsas_set_starget(&p->phy_info[i], starget);
1768
1769                         /*
1770                          * Exposing hidden raid components
1771                          */
1772                         if (mptscsih_is_phys_disk(ioc, channel, id)) {
1773                                 id = mptscsih_raid_id_to_num(ioc,
1774                                                 channel, id);
1775                                 vtarget->tflags |=
1776                                     MPT_TARGET_FLAGS_RAID_COMPONENT;
1777                                 p->phy_info[i].attached.phys_disk_num = id;
1778                         }
1779                         mutex_unlock(&ioc->sas_topology_mutex);
1780                         goto out;
1781                 }
1782         }
1783         mutex_unlock(&ioc->sas_topology_mutex);
1784
1785         kfree(vtarget);
1786         return -ENXIO;
1787
1788  out:
1789         vtarget->id = id;
1790         vtarget->channel = channel;
1791         starget->hostdata = vtarget;
1792         return 0;
1793 }
1794
1795 static void
1796 mptsas_target_destroy(struct scsi_target *starget)
1797 {
1798         struct Scsi_Host *host = dev_to_shost(&starget->dev);
1799         MPT_SCSI_HOST           *hd = shost_priv(host);
1800         struct sas_rphy         *rphy;
1801         struct mptsas_portinfo  *p;
1802         int                      i;
1803         MPT_ADAPTER     *ioc = hd->ioc;
1804         VirtTarget      *vtarget;
1805
1806         if (!starget->hostdata)
1807                 return;
1808
1809         vtarget = starget->hostdata;
1810
1811         mptsas_del_device_component_by_os(ioc, starget->channel,
1812             starget->id);
1813
1814
1815         if (starget->channel == MPTSAS_RAID_CHANNEL)
1816                 goto out;
1817
1818         rphy = dev_to_rphy(starget->dev.parent);
1819         list_for_each_entry(p, &ioc->sas_topology, list) {
1820                 for (i = 0; i < p->num_phys; i++) {
1821                         if (p->phy_info[i].attached.sas_address !=
1822                                         rphy->identify.sas_address)
1823                                 continue;
1824
1825                         starget_printk(KERN_INFO, starget, MYIOC_s_FMT
1826                         "delete device: fw_channel %d, fw_id %d, phy %d, "
1827                         "sas_addr 0x%llx\n", ioc->name,
1828                         p->phy_info[i].attached.channel,
1829                         p->phy_info[i].attached.id,
1830                         p->phy_info[i].attached.phy_id, (unsigned long long)
1831                         p->phy_info[i].attached.sas_address);
1832
1833                         mptsas_set_starget(&p->phy_info[i], NULL);
1834                 }
1835         }
1836
1837  out:
1838         vtarget->starget = NULL;
1839         kfree(starget->hostdata);
1840         starget->hostdata = NULL;
1841 }
1842
1843
1844 static int
1845 mptsas_slave_alloc(struct scsi_device *sdev)
1846 {
1847         struct Scsi_Host        *host = sdev->host;
1848         MPT_SCSI_HOST           *hd = shost_priv(host);
1849         struct sas_rphy         *rphy;
1850         struct mptsas_portinfo  *p;
1851         VirtDevice              *vdevice;
1852         struct scsi_target      *starget;
1853         int                     i;
1854         MPT_ADAPTER *ioc = hd->ioc;
1855
1856         vdevice = kzalloc(sizeof(VirtDevice), GFP_KERNEL);
1857         if (!vdevice) {
1858                 printk(MYIOC_s_ERR_FMT "slave_alloc kzalloc(%zd) FAILED!\n",
1859                                 ioc->name, sizeof(VirtDevice));
1860                 return -ENOMEM;
1861         }
1862         starget = scsi_target(sdev);
1863         vdevice->vtarget = starget->hostdata;
1864
1865         if (sdev->channel == MPTSAS_RAID_CHANNEL)
1866                 goto out;
1867
1868         rphy = dev_to_rphy(sdev->sdev_target->dev.parent);
1869         mutex_lock(&ioc->sas_topology_mutex);
1870         list_for_each_entry(p, &ioc->sas_topology, list) {
1871                 for (i = 0; i < p->num_phys; i++) {
1872                         if (p->phy_info[i].attached.sas_address !=
1873                                         rphy->identify.sas_address)
1874                                 continue;
1875                         vdevice->lun = sdev->lun;
1876                         /*
1877                          * Exposing hidden raid components
1878                          */
1879                         if (mptscsih_is_phys_disk(ioc,
1880                             p->phy_info[i].attached.channel,
1881                             p->phy_info[i].attached.id))
1882                                 sdev->no_uld_attach = 1;
1883                         mutex_unlock(&ioc->sas_topology_mutex);
1884                         goto out;
1885                 }
1886         }
1887         mutex_unlock(&ioc->sas_topology_mutex);
1888
1889         kfree(vdevice);
1890         return -ENXIO;
1891
1892  out:
1893         vdevice->vtarget->num_luns++;
1894         sdev->hostdata = vdevice;
1895         return 0;
1896 }
1897
1898 static int
1899 mptsas_qcmd_lck(struct scsi_cmnd *SCpnt, void (*done)(struct scsi_cmnd *))
1900 {
1901         MPT_SCSI_HOST   *hd;
1902         MPT_ADAPTER     *ioc;
1903         VirtDevice      *vdevice = SCpnt->device->hostdata;
1904
1905         if (!vdevice || !vdevice->vtarget || vdevice->vtarget->deleted) {
1906                 SCpnt->result = DID_NO_CONNECT << 16;
1907                 done(SCpnt);
1908                 return 0;
1909         }
1910
1911         hd = shost_priv(SCpnt->device->host);
1912         ioc = hd->ioc;
1913
1914         if (ioc->sas_discovery_quiesce_io)
1915                 return SCSI_MLQUEUE_HOST_BUSY;
1916
1917         if (ioc->debug_level & MPT_DEBUG_SCSI)
1918                 scsi_print_command(SCpnt);
1919
1920         return mptscsih_qcmd(SCpnt,done);
1921 }
1922
1923 static DEF_SCSI_QCMD(mptsas_qcmd)
1924
1925 /**
1926  *      mptsas_mptsas_eh_timed_out - resets the scsi_cmnd timeout
1927  *              if the device under question is currently in the
1928  *              device removal delay.
1929  *      @sc: scsi command that the midlayer is about to time out
1930  *
1931  **/
1932 static enum blk_eh_timer_return mptsas_eh_timed_out(struct scsi_cmnd *sc)
1933 {
1934         MPT_SCSI_HOST *hd;
1935         MPT_ADAPTER   *ioc;
1936         VirtDevice    *vdevice;
1937         enum blk_eh_timer_return rc = BLK_EH_NOT_HANDLED;
1938
1939         hd = shost_priv(sc->device->host);
1940         if (hd == NULL) {
1941                 printk(KERN_ERR MYNAM ": %s: Can't locate host! (sc=%p)\n",
1942                     __func__, sc);
1943                 goto done;
1944         }
1945
1946         ioc = hd->ioc;
1947         if (ioc->bus_type != SAS) {
1948                 printk(KERN_ERR MYNAM ": %s: Wrong bus type (sc=%p)\n",
1949                     __func__, sc);
1950                 goto done;
1951         }
1952
1953         /* In case if IOC is in reset from internal context.
1954         *  Do not execute EEH for the same IOC. SML should to reset timer.
1955         */
1956         if (ioc->ioc_reset_in_progress) {
1957                 dtmprintk(ioc, printk(MYIOC_s_WARN_FMT ": %s: ioc is in reset,"
1958                     "SML need to reset the timer (sc=%p)\n",
1959                     ioc->name, __func__, sc));
1960                 rc = BLK_EH_RESET_TIMER;
1961         }
1962         vdevice = sc->device->hostdata;
1963         if (vdevice && vdevice->vtarget && (vdevice->vtarget->inDMD
1964                 || vdevice->vtarget->deleted)) {
1965                 dtmprintk(ioc, printk(MYIOC_s_WARN_FMT ": %s: target removed "
1966                     "or in device removal delay (sc=%p)\n",
1967                     ioc->name, __func__, sc));
1968                 rc = BLK_EH_RESET_TIMER;
1969                 goto done;
1970         }
1971
1972 done:
1973         return rc;
1974 }
1975
1976
1977 static struct scsi_host_template mptsas_driver_template = {
1978         .module                         = THIS_MODULE,
1979         .proc_name                      = "mptsas",
1980         .show_info                      = mptscsih_show_info,
1981         .name                           = "MPT SAS Host",
1982         .info                           = mptscsih_info,
1983         .queuecommand                   = mptsas_qcmd,
1984         .target_alloc                   = mptsas_target_alloc,
1985         .slave_alloc                    = mptsas_slave_alloc,
1986         .slave_configure                = mptsas_slave_configure,
1987         .target_destroy                 = mptsas_target_destroy,
1988         .slave_destroy                  = mptscsih_slave_destroy,
1989         .change_queue_depth             = mptscsih_change_queue_depth,
1990         .eh_abort_handler               = mptscsih_abort,
1991         .eh_device_reset_handler        = mptscsih_dev_reset,
1992         .eh_host_reset_handler          = mptscsih_host_reset,
1993         .bios_param                     = mptscsih_bios_param,
1994         .can_queue                      = MPT_SAS_CAN_QUEUE,
1995         .this_id                        = -1,
1996         .sg_tablesize                   = MPT_SCSI_SG_DEPTH,
1997         .max_sectors                    = 8192,
1998         .cmd_per_lun                    = 7,
1999         .use_clustering                 = ENABLE_CLUSTERING,
2000         .shost_attrs                    = mptscsih_host_attrs,
2001 };
2002
2003 static int mptsas_get_linkerrors(struct sas_phy *phy)
2004 {
2005         MPT_ADAPTER *ioc = phy_to_ioc(phy);
2006         ConfigExtendedPageHeader_t hdr;
2007         CONFIGPARMS cfg;
2008         SasPhyPage1_t *buffer;
2009         dma_addr_t dma_handle;
2010         int error;
2011
2012         /* FIXME: only have link errors on local phys */
2013         if (!scsi_is_sas_phy_local(phy))
2014                 return -EINVAL;
2015
2016         hdr.PageVersion = MPI_SASPHY1_PAGEVERSION;
2017         hdr.ExtPageLength = 0;
2018         hdr.PageNumber = 1 /* page number 1*/;
2019         hdr.Reserved1 = 0;
2020         hdr.Reserved2 = 0;
2021         hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
2022         hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_PHY;
2023
2024         cfg.cfghdr.ehdr = &hdr;
2025         cfg.physAddr = -1;
2026         cfg.pageAddr = phy->identify.phy_identifier;
2027         cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
2028         cfg.dir = 0;    /* read */
2029         cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
2030
2031         error = mpt_config(ioc, &cfg);
2032         if (error)
2033                 return error;
2034         if (!hdr.ExtPageLength)
2035                 return -ENXIO;
2036
2037         buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2038                                       &dma_handle);
2039         if (!buffer)
2040                 return -ENOMEM;
2041
2042         cfg.physAddr = dma_handle;
2043         cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
2044
2045         error = mpt_config(ioc, &cfg);
2046         if (error)
2047                 goto out_free_consistent;
2048
2049         mptsas_print_phy_pg1(ioc, buffer);
2050
2051         phy->invalid_dword_count = le32_to_cpu(buffer->InvalidDwordCount);
2052         phy->running_disparity_error_count =
2053                 le32_to_cpu(buffer->RunningDisparityErrorCount);
2054         phy->loss_of_dword_sync_count =
2055                 le32_to_cpu(buffer->LossDwordSynchCount);
2056         phy->phy_reset_problem_count =
2057                 le32_to_cpu(buffer->PhyResetProblemCount);
2058
2059  out_free_consistent:
2060         pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2061                             buffer, dma_handle);
2062         return error;
2063 }
2064
2065 static int mptsas_mgmt_done(MPT_ADAPTER *ioc, MPT_FRAME_HDR *req,
2066                 MPT_FRAME_HDR *reply)
2067 {
2068         ioc->sas_mgmt.status |= MPT_MGMT_STATUS_COMMAND_GOOD;
2069         if (reply != NULL) {
2070                 ioc->sas_mgmt.status |= MPT_MGMT_STATUS_RF_VALID;
2071                 memcpy(ioc->sas_mgmt.reply, reply,
2072                     min(ioc->reply_sz, 4 * reply->u.reply.MsgLength));
2073         }
2074
2075         if (ioc->sas_mgmt.status & MPT_MGMT_STATUS_PENDING) {
2076                 ioc->sas_mgmt.status &= ~MPT_MGMT_STATUS_PENDING;
2077                 complete(&ioc->sas_mgmt.done);
2078                 return 1;
2079         }
2080         return 0;
2081 }
2082
2083 static int mptsas_phy_reset(struct sas_phy *phy, int hard_reset)
2084 {
2085         MPT_ADAPTER *ioc = phy_to_ioc(phy);
2086         SasIoUnitControlRequest_t *req;
2087         SasIoUnitControlReply_t *reply;
2088         MPT_FRAME_HDR *mf;
2089         MPIHeader_t *hdr;
2090         unsigned long timeleft;
2091         int error = -ERESTARTSYS;
2092
2093         /* FIXME: fusion doesn't allow non-local phy reset */
2094         if (!scsi_is_sas_phy_local(phy))
2095                 return -EINVAL;
2096
2097         /* not implemented for expanders */
2098         if (phy->identify.target_port_protocols & SAS_PROTOCOL_SMP)
2099                 return -ENXIO;
2100
2101         if (mutex_lock_interruptible(&ioc->sas_mgmt.mutex))
2102                 goto out;
2103
2104         mf = mpt_get_msg_frame(mptsasMgmtCtx, ioc);
2105         if (!mf) {
2106                 error = -ENOMEM;
2107                 goto out_unlock;
2108         }
2109
2110         hdr = (MPIHeader_t *) mf;
2111         req = (SasIoUnitControlRequest_t *)mf;
2112         memset(req, 0, sizeof(SasIoUnitControlRequest_t));
2113         req->Function = MPI_FUNCTION_SAS_IO_UNIT_CONTROL;
2114         req->MsgContext = hdr->MsgContext;
2115         req->Operation = hard_reset ?
2116                 MPI_SAS_OP_PHY_HARD_RESET : MPI_SAS_OP_PHY_LINK_RESET;
2117         req->PhyNum = phy->identify.phy_identifier;
2118
2119         INITIALIZE_MGMT_STATUS(ioc->sas_mgmt.status)
2120         mpt_put_msg_frame(mptsasMgmtCtx, ioc, mf);
2121
2122         timeleft = wait_for_completion_timeout(&ioc->sas_mgmt.done,
2123                         10 * HZ);
2124         if (!(ioc->sas_mgmt.status & MPT_MGMT_STATUS_COMMAND_GOOD)) {
2125                 error = -ETIME;
2126                 mpt_free_msg_frame(ioc, mf);
2127                 if (ioc->sas_mgmt.status & MPT_MGMT_STATUS_DID_IOCRESET)
2128                         goto out_unlock;
2129                 if (!timeleft)
2130                         mpt_Soft_Hard_ResetHandler(ioc, CAN_SLEEP);
2131                 goto out_unlock;
2132         }
2133
2134         /* a reply frame is expected */
2135         if ((ioc->sas_mgmt.status &
2136             MPT_MGMT_STATUS_RF_VALID) == 0) {
2137                 error = -ENXIO;
2138                 goto out_unlock;
2139         }
2140
2141         /* process the completed Reply Message Frame */
2142         reply = (SasIoUnitControlReply_t *)ioc->sas_mgmt.reply;
2143         if (reply->IOCStatus != MPI_IOCSTATUS_SUCCESS) {
2144                 printk(MYIOC_s_INFO_FMT "%s: IOCStatus=0x%X IOCLogInfo=0x%X\n",
2145                     ioc->name, __func__, reply->IOCStatus, reply->IOCLogInfo);
2146                 error = -ENXIO;
2147                 goto out_unlock;
2148         }
2149
2150         error = 0;
2151
2152  out_unlock:
2153         CLEAR_MGMT_STATUS(ioc->sas_mgmt.status)
2154         mutex_unlock(&ioc->sas_mgmt.mutex);
2155  out:
2156         return error;
2157 }
2158
2159 static int
2160 mptsas_get_enclosure_identifier(struct sas_rphy *rphy, u64 *identifier)
2161 {
2162         MPT_ADAPTER *ioc = rphy_to_ioc(rphy);
2163         int i, error;
2164         struct mptsas_portinfo *p;
2165         struct mptsas_enclosure enclosure_info;
2166         u64 enclosure_handle;
2167
2168         mutex_lock(&ioc->sas_topology_mutex);
2169         list_for_each_entry(p, &ioc->sas_topology, list) {
2170                 for (i = 0; i < p->num_phys; i++) {
2171                         if (p->phy_info[i].attached.sas_address ==
2172                             rphy->identify.sas_address) {
2173                                 enclosure_handle = p->phy_info[i].
2174                                         attached.handle_enclosure;
2175                                 goto found_info;
2176                         }
2177                 }
2178         }
2179         mutex_unlock(&ioc->sas_topology_mutex);
2180         return -ENXIO;
2181
2182  found_info:
2183         mutex_unlock(&ioc->sas_topology_mutex);
2184         memset(&enclosure_info, 0, sizeof(struct mptsas_enclosure));
2185         error = mptsas_sas_enclosure_pg0(ioc, &enclosure_info,
2186                         (MPI_SAS_ENCLOS_PGAD_FORM_HANDLE <<
2187                          MPI_SAS_ENCLOS_PGAD_FORM_SHIFT), enclosure_handle);
2188         if (!error)
2189                 *identifier = enclosure_info.enclosure_logical_id;
2190         return error;
2191 }
2192
2193 static int
2194 mptsas_get_bay_identifier(struct sas_rphy *rphy)
2195 {
2196         MPT_ADAPTER *ioc = rphy_to_ioc(rphy);
2197         struct mptsas_portinfo *p;
2198         int i, rc;
2199
2200         mutex_lock(&ioc->sas_topology_mutex);
2201         list_for_each_entry(p, &ioc->sas_topology, list) {
2202                 for (i = 0; i < p->num_phys; i++) {
2203                         if (p->phy_info[i].attached.sas_address ==
2204                             rphy->identify.sas_address) {
2205                                 rc = p->phy_info[i].attached.slot;
2206                                 goto out;
2207                         }
2208                 }
2209         }
2210         rc = -ENXIO;
2211  out:
2212         mutex_unlock(&ioc->sas_topology_mutex);
2213         return rc;
2214 }
2215
2216 static int mptsas_smp_handler(struct Scsi_Host *shost, struct sas_rphy *rphy,
2217                               struct request *req)
2218 {
2219         MPT_ADAPTER *ioc = ((MPT_SCSI_HOST *) shost->hostdata)->ioc;
2220         MPT_FRAME_HDR *mf;
2221         SmpPassthroughRequest_t *smpreq;
2222         struct request *rsp = req->next_rq;
2223         int ret;
2224         int flagsLength;
2225         unsigned long timeleft;
2226         char *psge;
2227         dma_addr_t dma_addr_in = 0;
2228         dma_addr_t dma_addr_out = 0;
2229         u64 sas_address = 0;
2230
2231         if (!rsp) {
2232                 printk(MYIOC_s_ERR_FMT "%s: the smp response space is missing\n",
2233                     ioc->name, __func__);
2234                 return -EINVAL;
2235         }
2236
2237         /* do we need to support multiple segments? */
2238         if (req->bio->bi_vcnt > 1 || rsp->bio->bi_vcnt > 1) {
2239                 printk(MYIOC_s_ERR_FMT "%s: multiple segments req %u %u, rsp %u %u\n",
2240                     ioc->name, __func__, req->bio->bi_vcnt, blk_rq_bytes(req),
2241                     rsp->bio->bi_vcnt, blk_rq_bytes(rsp));
2242                 return -EINVAL;
2243         }
2244
2245         ret = mutex_lock_interruptible(&ioc->sas_mgmt.mutex);
2246         if (ret)
2247                 goto out;
2248
2249         mf = mpt_get_msg_frame(mptsasMgmtCtx, ioc);
2250         if (!mf) {
2251                 ret = -ENOMEM;
2252                 goto out_unlock;
2253         }
2254
2255         smpreq = (SmpPassthroughRequest_t *)mf;
2256         memset(smpreq, 0, sizeof(*smpreq));
2257
2258         smpreq->RequestDataLength = cpu_to_le16(blk_rq_bytes(req) - 4);
2259         smpreq->Function = MPI_FUNCTION_SMP_PASSTHROUGH;
2260
2261         if (rphy)
2262                 sas_address = rphy->identify.sas_address;
2263         else {
2264                 struct mptsas_portinfo *port_info;
2265
2266                 mutex_lock(&ioc->sas_topology_mutex);
2267                 port_info = ioc->hba_port_info;
2268                 if (port_info && port_info->phy_info)
2269                         sas_address =
2270                                 port_info->phy_info[0].phy->identify.sas_address;
2271                 mutex_unlock(&ioc->sas_topology_mutex);
2272         }
2273
2274         *((u64 *)&smpreq->SASAddress) = cpu_to_le64(sas_address);
2275
2276         psge = (char *)
2277                 (((int *) mf) + (offsetof(SmpPassthroughRequest_t, SGL) / 4));
2278
2279         /* request */
2280         flagsLength = (MPI_SGE_FLAGS_SIMPLE_ELEMENT |
2281                        MPI_SGE_FLAGS_END_OF_BUFFER |
2282                        MPI_SGE_FLAGS_DIRECTION)
2283                        << MPI_SGE_FLAGS_SHIFT;
2284         flagsLength |= (blk_rq_bytes(req) - 4);
2285
2286         dma_addr_out = pci_map_single(ioc->pcidev, bio_data(req->bio),
2287                                       blk_rq_bytes(req), PCI_DMA_BIDIRECTIONAL);
2288         if (!dma_addr_out)
2289                 goto put_mf;
2290         ioc->add_sge(psge, flagsLength, dma_addr_out);
2291         psge += ioc->SGE_size;
2292
2293         /* response */
2294         flagsLength = MPI_SGE_FLAGS_SIMPLE_ELEMENT |
2295                 MPI_SGE_FLAGS_SYSTEM_ADDRESS |
2296                 MPI_SGE_FLAGS_IOC_TO_HOST |
2297                 MPI_SGE_FLAGS_END_OF_BUFFER;
2298
2299         flagsLength = flagsLength << MPI_SGE_FLAGS_SHIFT;
2300         flagsLength |= blk_rq_bytes(rsp) + 4;
2301         dma_addr_in =  pci_map_single(ioc->pcidev, bio_data(rsp->bio),
2302                                       blk_rq_bytes(rsp), PCI_DMA_BIDIRECTIONAL);
2303         if (!dma_addr_in)
2304                 goto unmap;
2305         ioc->add_sge(psge, flagsLength, dma_addr_in);
2306
2307         INITIALIZE_MGMT_STATUS(ioc->sas_mgmt.status)
2308         mpt_put_msg_frame(mptsasMgmtCtx, ioc, mf);
2309
2310         timeleft = wait_for_completion_timeout(&ioc->sas_mgmt.done, 10 * HZ);
2311         if (!(ioc->sas_mgmt.status & MPT_MGMT_STATUS_COMMAND_GOOD)) {
2312                 ret = -ETIME;
2313                 mpt_free_msg_frame(ioc, mf);
2314                 mf = NULL;
2315                 if (ioc->sas_mgmt.status & MPT_MGMT_STATUS_DID_IOCRESET)
2316                         goto unmap;
2317                 if (!timeleft)
2318                         mpt_Soft_Hard_ResetHandler(ioc, CAN_SLEEP);
2319                 goto unmap;
2320         }
2321         mf = NULL;
2322
2323         if (ioc->sas_mgmt.status & MPT_MGMT_STATUS_RF_VALID) {
2324                 SmpPassthroughReply_t *smprep;
2325
2326                 smprep = (SmpPassthroughReply_t *)ioc->sas_mgmt.reply;
2327                 memcpy(req->sense, smprep, sizeof(*smprep));
2328                 req->sense_len = sizeof(*smprep);
2329                 req->resid_len = 0;
2330                 rsp->resid_len -= smprep->ResponseDataLength;
2331         } else {
2332                 printk(MYIOC_s_ERR_FMT
2333                     "%s: smp passthru reply failed to be returned\n",
2334                     ioc->name, __func__);
2335                 ret = -ENXIO;
2336         }
2337 unmap:
2338         if (dma_addr_out)
2339                 pci_unmap_single(ioc->pcidev, dma_addr_out, blk_rq_bytes(req),
2340                                  PCI_DMA_BIDIRECTIONAL);
2341         if (dma_addr_in)
2342                 pci_unmap_single(ioc->pcidev, dma_addr_in, blk_rq_bytes(rsp),
2343                                  PCI_DMA_BIDIRECTIONAL);
2344 put_mf:
2345         if (mf)
2346                 mpt_free_msg_frame(ioc, mf);
2347 out_unlock:
2348         CLEAR_MGMT_STATUS(ioc->sas_mgmt.status)
2349         mutex_unlock(&ioc->sas_mgmt.mutex);
2350 out:
2351         return ret;
2352 }
2353
2354 static struct sas_function_template mptsas_transport_functions = {
2355         .get_linkerrors         = mptsas_get_linkerrors,
2356         .get_enclosure_identifier = mptsas_get_enclosure_identifier,
2357         .get_bay_identifier     = mptsas_get_bay_identifier,
2358         .phy_reset              = mptsas_phy_reset,
2359         .smp_handler            = mptsas_smp_handler,
2360 };
2361
2362 static struct scsi_transport_template *mptsas_transport_template;
2363
2364 static int
2365 mptsas_sas_io_unit_pg0(MPT_ADAPTER *ioc, struct mptsas_portinfo *port_info)
2366 {
2367         ConfigExtendedPageHeader_t hdr;
2368         CONFIGPARMS cfg;
2369         SasIOUnitPage0_t *buffer;
2370         dma_addr_t dma_handle;
2371         int error, i;
2372
2373         hdr.PageVersion = MPI_SASIOUNITPAGE0_PAGEVERSION;
2374         hdr.ExtPageLength = 0;
2375         hdr.PageNumber = 0;
2376         hdr.Reserved1 = 0;
2377         hdr.Reserved2 = 0;
2378         hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
2379         hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_IO_UNIT;
2380
2381         cfg.cfghdr.ehdr = &hdr;
2382         cfg.physAddr = -1;
2383         cfg.pageAddr = 0;
2384         cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
2385         cfg.dir = 0;    /* read */
2386         cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
2387
2388         error = mpt_config(ioc, &cfg);
2389         if (error)
2390                 goto out;
2391         if (!hdr.ExtPageLength) {
2392                 error = -ENXIO;
2393                 goto out;
2394         }
2395
2396         buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2397                                             &dma_handle);
2398         if (!buffer) {
2399                 error = -ENOMEM;
2400                 goto out;
2401         }
2402
2403         cfg.physAddr = dma_handle;
2404         cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
2405
2406         error = mpt_config(ioc, &cfg);
2407         if (error)
2408                 goto out_free_consistent;
2409
2410         port_info->num_phys = buffer->NumPhys;
2411         port_info->phy_info = kcalloc(port_info->num_phys,
2412                 sizeof(struct mptsas_phyinfo), GFP_KERNEL);
2413         if (!port_info->phy_info) {
2414                 error = -ENOMEM;
2415                 goto out_free_consistent;
2416         }
2417
2418         ioc->nvdata_version_persistent =
2419             le16_to_cpu(buffer->NvdataVersionPersistent);
2420         ioc->nvdata_version_default =
2421             le16_to_cpu(buffer->NvdataVersionDefault);
2422
2423         for (i = 0; i < port_info->num_phys; i++) {
2424                 mptsas_print_phy_data(ioc, &buffer->PhyData[i]);
2425                 port_info->phy_info[i].phy_id = i;
2426                 port_info->phy_info[i].port_id =
2427                     buffer->PhyData[i].Port;
2428                 port_info->phy_info[i].negotiated_link_rate =
2429                     buffer->PhyData[i].NegotiatedLinkRate;
2430                 port_info->phy_info[i].portinfo = port_info;
2431                 port_info->phy_info[i].handle =
2432                     le16_to_cpu(buffer->PhyData[i].ControllerDevHandle);
2433         }
2434
2435  out_free_consistent:
2436         pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2437                             buffer, dma_handle);
2438  out:
2439         return error;
2440 }
2441
2442 static int
2443 mptsas_sas_io_unit_pg1(MPT_ADAPTER *ioc)
2444 {
2445         ConfigExtendedPageHeader_t hdr;
2446         CONFIGPARMS cfg;
2447         SasIOUnitPage1_t *buffer;
2448         dma_addr_t dma_handle;
2449         int error;
2450         u8 device_missing_delay;
2451
2452         memset(&hdr, 0, sizeof(ConfigExtendedPageHeader_t));
2453         memset(&cfg, 0, sizeof(CONFIGPARMS));
2454
2455         cfg.cfghdr.ehdr = &hdr;
2456         cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
2457         cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
2458         cfg.cfghdr.ehdr->PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
2459         cfg.cfghdr.ehdr->ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_IO_UNIT;
2460         cfg.cfghdr.ehdr->PageVersion = MPI_SASIOUNITPAGE1_PAGEVERSION;
2461         cfg.cfghdr.ehdr->PageNumber = 1;
2462
2463         error = mpt_config(ioc, &cfg);
2464         if (error)
2465                 goto out;
2466         if (!hdr.ExtPageLength) {
2467                 error = -ENXIO;
2468                 goto out;
2469         }
2470
2471         buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2472                                             &dma_handle);
2473         if (!buffer) {
2474                 error = -ENOMEM;
2475                 goto out;
2476         }
2477
2478         cfg.physAddr = dma_handle;
2479         cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
2480
2481         error = mpt_config(ioc, &cfg);
2482         if (error)
2483                 goto out_free_consistent;
2484
2485         ioc->io_missing_delay  =
2486             le16_to_cpu(buffer->IODeviceMissingDelay);
2487         device_missing_delay = buffer->ReportDeviceMissingDelay;
2488         ioc->device_missing_delay = (device_missing_delay & MPI_SAS_IOUNIT1_REPORT_MISSING_UNIT_16) ?
2489             (device_missing_delay & MPI_SAS_IOUNIT1_REPORT_MISSING_TIMEOUT_MASK) * 16 :
2490             device_missing_delay & MPI_SAS_IOUNIT1_REPORT_MISSING_TIMEOUT_MASK;
2491
2492  out_free_consistent:
2493         pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2494                             buffer, dma_handle);
2495  out:
2496         return error;
2497 }
2498
2499 static int
2500 mptsas_sas_phy_pg0(MPT_ADAPTER *ioc, struct mptsas_phyinfo *phy_info,
2501                 u32 form, u32 form_specific)
2502 {
2503         ConfigExtendedPageHeader_t hdr;
2504         CONFIGPARMS cfg;
2505         SasPhyPage0_t *buffer;
2506         dma_addr_t dma_handle;
2507         int error;
2508
2509         hdr.PageVersion = MPI_SASPHY0_PAGEVERSION;
2510         hdr.ExtPageLength = 0;
2511         hdr.PageNumber = 0;
2512         hdr.Reserved1 = 0;
2513         hdr.Reserved2 = 0;
2514         hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
2515         hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_PHY;
2516
2517         cfg.cfghdr.ehdr = &hdr;
2518         cfg.dir = 0;    /* read */
2519         cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
2520
2521         /* Get Phy Pg 0 for each Phy. */
2522         cfg.physAddr = -1;
2523         cfg.pageAddr = form + form_specific;
2524         cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
2525
2526         error = mpt_config(ioc, &cfg);
2527         if (error)
2528                 goto out;
2529
2530         if (!hdr.ExtPageLength) {
2531                 error = -ENXIO;
2532                 goto out;
2533         }
2534
2535         buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2536                                       &dma_handle);
2537         if (!buffer) {
2538                 error = -ENOMEM;
2539                 goto out;
2540         }
2541
2542         cfg.physAddr = dma_handle;
2543         cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
2544
2545         error = mpt_config(ioc, &cfg);
2546         if (error)
2547                 goto out_free_consistent;
2548
2549         mptsas_print_phy_pg0(ioc, buffer);
2550
2551         phy_info->hw_link_rate = buffer->HwLinkRate;
2552         phy_info->programmed_link_rate = buffer->ProgrammedLinkRate;
2553         phy_info->identify.handle = le16_to_cpu(buffer->OwnerDevHandle);
2554         phy_info->attached.handle = le16_to_cpu(buffer->AttachedDevHandle);
2555
2556  out_free_consistent:
2557         pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2558                             buffer, dma_handle);
2559  out:
2560         return error;
2561 }
2562
2563 static int
2564 mptsas_sas_device_pg0(MPT_ADAPTER *ioc, struct mptsas_devinfo *device_info,
2565                 u32 form, u32 form_specific)
2566 {
2567         ConfigExtendedPageHeader_t hdr;
2568         CONFIGPARMS cfg;
2569         SasDevicePage0_t *buffer;
2570         dma_addr_t dma_handle;
2571         __le64 sas_address;
2572         int error=0;
2573
2574         hdr.PageVersion = MPI_SASDEVICE0_PAGEVERSION;
2575         hdr.ExtPageLength = 0;
2576         hdr.PageNumber = 0;
2577         hdr.Reserved1 = 0;
2578         hdr.Reserved2 = 0;
2579         hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
2580         hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_DEVICE;
2581
2582         cfg.cfghdr.ehdr = &hdr;
2583         cfg.pageAddr = form + form_specific;
2584         cfg.physAddr = -1;
2585         cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
2586         cfg.dir = 0;    /* read */
2587         cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
2588
2589         memset(device_info, 0, sizeof(struct mptsas_devinfo));
2590         error = mpt_config(ioc, &cfg);
2591         if (error)
2592                 goto out;
2593         if (!hdr.ExtPageLength) {
2594                 error = -ENXIO;
2595                 goto out;
2596         }
2597
2598         buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2599                                       &dma_handle);
2600         if (!buffer) {
2601                 error = -ENOMEM;
2602                 goto out;
2603         }
2604
2605         cfg.physAddr = dma_handle;
2606         cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
2607
2608         error = mpt_config(ioc, &cfg);
2609
2610         if (error == MPI_IOCSTATUS_CONFIG_INVALID_PAGE) {
2611                 error = -ENODEV;
2612                 goto out_free_consistent;
2613         }
2614
2615         if (error)
2616                 goto out_free_consistent;
2617
2618         mptsas_print_device_pg0(ioc, buffer);
2619
2620         memset(device_info, 0, sizeof(struct mptsas_devinfo));
2621         device_info->handle = le16_to_cpu(buffer->DevHandle);
2622         device_info->handle_parent = le16_to_cpu(buffer->ParentDevHandle);
2623         device_info->handle_enclosure =
2624             le16_to_cpu(buffer->EnclosureHandle);
2625         device_info->slot = le16_to_cpu(buffer->Slot);
2626         device_info->phy_id = buffer->PhyNum;
2627         device_info->port_id = buffer->PhysicalPort;
2628         device_info->id = buffer->TargetID;
2629         device_info->phys_disk_num = ~0;
2630         device_info->channel = buffer->Bus;
2631         memcpy(&sas_address, &buffer->SASAddress, sizeof(__le64));
2632         device_info->sas_address = le64_to_cpu(sas_address);
2633         device_info->device_info =
2634             le32_to_cpu(buffer->DeviceInfo);
2635         device_info->flags = le16_to_cpu(buffer->Flags);
2636
2637  out_free_consistent:
2638         pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2639                             buffer, dma_handle);
2640  out:
2641         return error;
2642 }
2643
2644 static int
2645 mptsas_sas_expander_pg0(MPT_ADAPTER *ioc, struct mptsas_portinfo *port_info,
2646                 u32 form, u32 form_specific)
2647 {
2648         ConfigExtendedPageHeader_t hdr;
2649         CONFIGPARMS cfg;
2650         SasExpanderPage0_t *buffer;
2651         dma_addr_t dma_handle;
2652         int i, error;
2653         __le64 sas_address;
2654
2655         memset(port_info, 0, sizeof(struct mptsas_portinfo));
2656         hdr.PageVersion = MPI_SASEXPANDER0_PAGEVERSION;
2657         hdr.ExtPageLength = 0;
2658         hdr.PageNumber = 0;
2659         hdr.Reserved1 = 0;
2660         hdr.Reserved2 = 0;
2661         hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
2662         hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_EXPANDER;
2663
2664         cfg.cfghdr.ehdr = &hdr;
2665         cfg.physAddr = -1;
2666         cfg.pageAddr = form + form_specific;
2667         cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
2668         cfg.dir = 0;    /* read */
2669         cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
2670
2671         memset(port_info, 0, sizeof(struct mptsas_portinfo));
2672         error = mpt_config(ioc, &cfg);
2673         if (error)
2674                 goto out;
2675
2676         if (!hdr.ExtPageLength) {
2677                 error = -ENXIO;
2678                 goto out;
2679         }
2680
2681         buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2682                                       &dma_handle);
2683         if (!buffer) {
2684                 error = -ENOMEM;
2685                 goto out;
2686         }
2687
2688         cfg.physAddr = dma_handle;
2689         cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
2690
2691         error = mpt_config(ioc, &cfg);
2692         if (error == MPI_IOCSTATUS_CONFIG_INVALID_PAGE) {
2693                 error = -ENODEV;
2694                 goto out_free_consistent;
2695         }
2696
2697         if (error)
2698                 goto out_free_consistent;
2699
2700         /* save config data */
2701         port_info->num_phys = (buffer->NumPhys) ? buffer->NumPhys : 1;
2702         port_info->phy_info = kcalloc(port_info->num_phys,
2703                 sizeof(struct mptsas_phyinfo), GFP_KERNEL);
2704         if (!port_info->phy_info) {
2705                 error = -ENOMEM;
2706                 goto out_free_consistent;
2707         }
2708
2709         memcpy(&sas_address, &buffer->SASAddress, sizeof(__le64));
2710         for (i = 0; i < port_info->num_phys; i++) {
2711                 port_info->phy_info[i].portinfo = port_info;
2712                 port_info->phy_info[i].handle =
2713                     le16_to_cpu(buffer->DevHandle);
2714                 port_info->phy_info[i].identify.sas_address =
2715                     le64_to_cpu(sas_address);
2716                 port_info->phy_info[i].identify.handle_parent =
2717                     le16_to_cpu(buffer->ParentDevHandle);
2718         }
2719
2720  out_free_consistent:
2721         pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2722                             buffer, dma_handle);
2723  out:
2724         return error;
2725 }
2726
2727 static int
2728 mptsas_sas_expander_pg1(MPT_ADAPTER *ioc, struct mptsas_phyinfo *phy_info,
2729                 u32 form, u32 form_specific)
2730 {
2731         ConfigExtendedPageHeader_t hdr;
2732         CONFIGPARMS cfg;
2733         SasExpanderPage1_t *buffer;
2734         dma_addr_t dma_handle;
2735         int error=0;
2736
2737         hdr.PageVersion = MPI_SASEXPANDER1_PAGEVERSION;
2738         hdr.ExtPageLength = 0;
2739         hdr.PageNumber = 1;
2740         hdr.Reserved1 = 0;
2741         hdr.Reserved2 = 0;
2742         hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
2743         hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_EXPANDER;
2744
2745         cfg.cfghdr.ehdr = &hdr;
2746         cfg.physAddr = -1;
2747         cfg.pageAddr = form + form_specific;
2748         cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
2749         cfg.dir = 0;    /* read */
2750         cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
2751
2752         error = mpt_config(ioc, &cfg);
2753         if (error)
2754                 goto out;
2755
2756         if (!hdr.ExtPageLength) {
2757                 error = -ENXIO;
2758                 goto out;
2759         }
2760
2761         buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2762                                       &dma_handle);
2763         if (!buffer) {
2764                 error = -ENOMEM;
2765                 goto out;
2766         }
2767
2768         cfg.physAddr = dma_handle;
2769         cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
2770
2771         error = mpt_config(ioc, &cfg);
2772
2773         if (error == MPI_IOCSTATUS_CONFIG_INVALID_PAGE) {
2774                 error = -ENODEV;
2775                 goto out_free_consistent;
2776         }
2777
2778         if (error)
2779                 goto out_free_consistent;
2780
2781
2782         mptsas_print_expander_pg1(ioc, buffer);
2783
2784         /* save config data */
2785         phy_info->phy_id = buffer->PhyIdentifier;
2786         phy_info->port_id = buffer->PhysicalPort;
2787         phy_info->negotiated_link_rate = buffer->NegotiatedLinkRate;
2788         phy_info->programmed_link_rate = buffer->ProgrammedLinkRate;
2789         phy_info->hw_link_rate = buffer->HwLinkRate;
2790         phy_info->identify.handle = le16_to_cpu(buffer->OwnerDevHandle);
2791         phy_info->attached.handle = le16_to_cpu(buffer->AttachedDevHandle);
2792
2793  out_free_consistent:
2794         pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2795                             buffer, dma_handle);
2796  out:
2797         return error;
2798 }
2799
2800 struct rep_manu_request{
2801         u8 smp_frame_type;
2802         u8 function;
2803         u8 reserved;
2804         u8 request_length;
2805 };
2806
2807 struct rep_manu_reply{
2808         u8 smp_frame_type; /* 0x41 */
2809         u8 function; /* 0x01 */
2810         u8 function_result;
2811         u8 response_length;
2812         u16 expander_change_count;
2813         u8 reserved0[2];
2814         u8 sas_format:1;
2815         u8 reserved1:7;
2816         u8 reserved2[3];
2817         u8 vendor_id[SAS_EXPANDER_VENDOR_ID_LEN];
2818         u8 product_id[SAS_EXPANDER_PRODUCT_ID_LEN];
2819         u8 product_rev[SAS_EXPANDER_PRODUCT_REV_LEN];
2820         u8 component_vendor_id[SAS_EXPANDER_COMPONENT_VENDOR_ID_LEN];
2821         u16 component_id;
2822         u8 component_revision_id;
2823         u8 reserved3;
2824         u8 vendor_specific[8];
2825 };
2826
2827 /**
2828   * mptsas_exp_repmanufacture_info -
2829   * @ioc: per adapter object
2830   * @sas_address: expander sas address
2831   * @edev: the sas_expander_device object
2832   *
2833   * Fills in the sas_expander_device object when SMP port is created.
2834   *
2835   * Returns 0 for success, non-zero for failure.
2836   */
2837 static int
2838 mptsas_exp_repmanufacture_info(MPT_ADAPTER *ioc,
2839         u64 sas_address, struct sas_expander_device *edev)
2840 {
2841         MPT_FRAME_HDR *mf;
2842         SmpPassthroughRequest_t *smpreq;
2843         SmpPassthroughReply_t *smprep;
2844         struct rep_manu_reply *manufacture_reply;
2845         struct rep_manu_request *manufacture_request;
2846         int ret;
2847         int flagsLength;
2848         unsigned long timeleft;
2849         char *psge;
2850         unsigned long flags;
2851         void *data_out = NULL;
2852         dma_addr_t data_out_dma = 0;
2853         u32 sz;
2854
2855         spin_lock_irqsave(&ioc->taskmgmt_lock, flags);
2856         if (ioc->ioc_reset_in_progress) {
2857                 spin_unlock_irqrestore(&ioc->taskmgmt_lock, flags);
2858                 printk(MYIOC_s_INFO_FMT "%s: host reset in progress!\n",
2859                         __func__, ioc->name);
2860                 return -EFAULT;
2861         }
2862         spin_unlock_irqrestore(&ioc->taskmgmt_lock, flags);
2863
2864         ret = mutex_lock_interruptible(&ioc->sas_mgmt.mutex);
2865         if (ret)
2866                 goto out;
2867
2868         mf = mpt_get_msg_frame(mptsasMgmtCtx, ioc);
2869         if (!mf) {
2870                 ret = -ENOMEM;
2871                 goto out_unlock;
2872         }
2873
2874         smpreq = (SmpPassthroughRequest_t *)mf;
2875         memset(smpreq, 0, sizeof(*smpreq));
2876
2877         sz = sizeof(struct rep_manu_request) + sizeof(struct rep_manu_reply);
2878
2879         data_out = pci_alloc_consistent(ioc->pcidev, sz, &data_out_dma);
2880         if (!data_out) {
2881                 printk(KERN_ERR "Memory allocation failure at %s:%d/%s()!\n",
2882                         __FILE__, __LINE__, __func__);
2883                 ret = -ENOMEM;
2884                 goto put_mf;
2885         }
2886
2887         manufacture_request = data_out;
2888         manufacture_request->smp_frame_type = 0x40;
2889         manufacture_request->function = 1;
2890         manufacture_request->reserved = 0;
2891         manufacture_request->request_length = 0;
2892
2893         smpreq->Function = MPI_FUNCTION_SMP_PASSTHROUGH;
2894         smpreq->PhysicalPort = 0xFF;
2895         *((u64 *)&smpreq->SASAddress) = cpu_to_le64(sas_address);
2896         smpreq->RequestDataLength = sizeof(struct rep_manu_request);
2897
2898         psge = (char *)
2899                 (((int *) mf) + (offsetof(SmpPassthroughRequest_t, SGL) / 4));
2900
2901         flagsLength = MPI_SGE_FLAGS_SIMPLE_ELEMENT |
2902                 MPI_SGE_FLAGS_SYSTEM_ADDRESS |
2903                 MPI_SGE_FLAGS_HOST_TO_IOC |
2904                 MPI_SGE_FLAGS_END_OF_BUFFER;
2905         flagsLength = flagsLength << MPI_SGE_FLAGS_SHIFT;
2906         flagsLength |= sizeof(struct rep_manu_request);
2907
2908         ioc->add_sge(psge, flagsLength, data_out_dma);
2909         psge += ioc->SGE_size;
2910
2911         flagsLength = MPI_SGE_FLAGS_SIMPLE_ELEMENT |
2912                 MPI_SGE_FLAGS_SYSTEM_ADDRESS |
2913                 MPI_SGE_FLAGS_IOC_TO_HOST |
2914                 MPI_SGE_FLAGS_END_OF_BUFFER;
2915         flagsLength = flagsLength << MPI_SGE_FLAGS_SHIFT;
2916         flagsLength |= sizeof(struct rep_manu_reply);
2917         ioc->add_sge(psge, flagsLength, data_out_dma +
2918         sizeof(struct rep_manu_request));
2919
2920         INITIALIZE_MGMT_STATUS(ioc->sas_mgmt.status)
2921         mpt_put_msg_frame(mptsasMgmtCtx, ioc, mf);
2922
2923         timeleft = wait_for_completion_timeout(&ioc->sas_mgmt.done, 10 * HZ);
2924         if (!(ioc->sas_mgmt.status & MPT_MGMT_STATUS_COMMAND_GOOD)) {
2925                 ret = -ETIME;
2926                 mpt_free_msg_frame(ioc, mf);
2927                 mf = NULL;
2928                 if (ioc->sas_mgmt.status & MPT_MGMT_STATUS_DID_IOCRESET)
2929                         goto out_free;
2930                 if (!timeleft)
2931                         mpt_Soft_Hard_ResetHandler(ioc, CAN_SLEEP);
2932                 goto out_free;
2933         }
2934
2935         mf = NULL;
2936
2937         if (ioc->sas_mgmt.status & MPT_MGMT_STATUS_RF_VALID) {
2938                 u8 *tmp;
2939
2940         smprep = (SmpPassthroughReply_t *)ioc->sas_mgmt.reply;
2941         if (le16_to_cpu(smprep->ResponseDataLength) !=
2942                 sizeof(struct rep_manu_reply))
2943                         goto out_free;
2944
2945         manufacture_reply = data_out + sizeof(struct rep_manu_request);
2946         strncpy(edev->vendor_id, manufacture_reply->vendor_id,
2947                 SAS_EXPANDER_VENDOR_ID_LEN);
2948         strncpy(edev->product_id, manufacture_reply->product_id,
2949                 SAS_EXPANDER_PRODUCT_ID_LEN);
2950         strncpy(edev->product_rev, manufacture_reply->product_rev,
2951                 SAS_EXPANDER_PRODUCT_REV_LEN);
2952         edev->level = manufacture_reply->sas_format;
2953         if (manufacture_reply->sas_format) {
2954                 strncpy(edev->component_vendor_id,
2955                         manufacture_reply->component_vendor_id,
2956                                 SAS_EXPANDER_COMPONENT_VENDOR_ID_LEN);
2957                 tmp = (u8 *)&manufacture_reply->component_id;
2958                 edev->component_id = tmp[0] << 8 | tmp[1];
2959                 edev->component_revision_id =
2960                         manufacture_reply->component_revision_id;
2961                 }
2962         } else {
2963                 printk(MYIOC_s_ERR_FMT
2964                         "%s: smp passthru reply failed to be returned\n",
2965                         ioc->name, __func__);
2966                 ret = -ENXIO;
2967         }
2968 out_free:
2969         if (data_out_dma)
2970                 pci_free_consistent(ioc->pcidev, sz, data_out, data_out_dma);
2971 put_mf:
2972         if (mf)
2973                 mpt_free_msg_frame(ioc, mf);
2974 out_unlock:
2975         CLEAR_MGMT_STATUS(ioc->sas_mgmt.status)
2976         mutex_unlock(&ioc->sas_mgmt.mutex);
2977 out:
2978         return ret;
2979  }
2980
2981 static void
2982 mptsas_parse_device_info(struct sas_identify *identify,
2983                 struct mptsas_devinfo *device_info)
2984 {
2985         u16 protocols;
2986
2987         identify->sas_address = device_info->sas_address;
2988         identify->phy_identifier = device_info->phy_id;
2989
2990         /*
2991          * Fill in Phy Initiator Port Protocol.
2992          * Bits 6:3, more than one bit can be set, fall through cases.
2993          */
2994         protocols = device_info->device_info & 0x78;
2995         identify->initiator_port_protocols = 0;
2996         if (protocols & MPI_SAS_DEVICE_INFO_SSP_INITIATOR)
2997                 identify->initiator_port_protocols |= SAS_PROTOCOL_SSP;
2998         if (protocols & MPI_SAS_DEVICE_INFO_STP_INITIATOR)
2999                 identify->initiator_port_protocols |= SAS_PROTOCOL_STP;
3000         if (protocols & MPI_SAS_DEVICE_INFO_SMP_INITIATOR)
3001                 identify->initiator_port_protocols |= SAS_PROTOCOL_SMP;
3002         if (protocols & MPI_SAS_DEVICE_INFO_SATA_HOST)
3003                 identify->initiator_port_protocols |= SAS_PROTOCOL_SATA;
3004
3005         /*
3006          * Fill in Phy Target Port Protocol.
3007          * Bits 10:7, more than one bit can be set, fall through cases.
3008          */
3009         protocols = device_info->device_info & 0x780;
3010         identify->target_port_protocols = 0;
3011         if (protocols & MPI_SAS_DEVICE_INFO_SSP_TARGET)
3012                 identify->target_port_protocols |= SAS_PROTOCOL_SSP;
3013         if (protocols & MPI_SAS_DEVICE_INFO_STP_TARGET)
3014                 identify->target_port_protocols |= SAS_PROTOCOL_STP;
3015         if (protocols & MPI_SAS_DEVICE_INFO_SMP_TARGET)
3016                 identify->target_port_protocols |= SAS_PROTOCOL_SMP;
3017         if (protocols & MPI_SAS_DEVICE_INFO_SATA_DEVICE)
3018                 identify->target_port_protocols |= SAS_PROTOCOL_SATA;
3019
3020         /*
3021          * Fill in Attached device type.
3022          */
3023         switch (device_info->device_info &
3024                         MPI_SAS_DEVICE_INFO_MASK_DEVICE_TYPE) {
3025         case MPI_SAS_DEVICE_INFO_NO_DEVICE:
3026                 identify->device_type = SAS_PHY_UNUSED;
3027                 break;
3028         case MPI_SAS_DEVICE_INFO_END_DEVICE:
3029                 identify->device_type = SAS_END_DEVICE;
3030                 break;
3031         case MPI_SAS_DEVICE_INFO_EDGE_EXPANDER:
3032                 identify->device_type = SAS_EDGE_EXPANDER_DEVICE;
3033                 break;
3034         case MPI_SAS_DEVICE_INFO_FANOUT_EXPANDER:
3035                 identify->device_type = SAS_FANOUT_EXPANDER_DEVICE;
3036                 break;
3037         }
3038 }
3039
3040 static int mptsas_probe_one_phy(struct device *dev,
3041                 struct mptsas_phyinfo *phy_info, int index, int local)
3042 {
3043         MPT_ADAPTER *ioc;
3044         struct sas_phy *phy;
3045         struct sas_port *port;
3046         int error = 0;
3047         VirtTarget *vtarget;
3048
3049         if (!dev) {
3050                 error = -ENODEV;
3051                 goto out;
3052         }
3053
3054         if (!phy_info->phy) {
3055                 phy = sas_phy_alloc(dev, index);
3056                 if (!phy) {
3057                         error = -ENOMEM;
3058                         goto out;
3059                 }
3060         } else
3061                 phy = phy_info->phy;
3062
3063         mptsas_parse_device_info(&phy->identify, &phy_info->identify);
3064
3065         /*
3066          * Set Negotiated link rate.
3067          */
3068         switch (phy_info->negotiated_link_rate) {
3069         case MPI_SAS_IOUNIT0_RATE_PHY_DISABLED:
3070                 phy->negotiated_linkrate = SAS_PHY_DISABLED;
3071                 break;
3072         case MPI_SAS_IOUNIT0_RATE_FAILED_SPEED_NEGOTIATION:
3073                 phy->negotiated_linkrate = SAS_LINK_RATE_FAILED;
3074                 break;
3075         case MPI_SAS_IOUNIT0_RATE_1_5:
3076                 phy->negotiated_linkrate = SAS_LINK_RATE_1_5_GBPS;
3077                 break;
3078         case MPI_SAS_IOUNIT0_RATE_3_0:
3079                 phy->negotiated_linkrate = SAS_LINK_RATE_3_0_GBPS;
3080                 break;
3081         case MPI_SAS_IOUNIT0_RATE_6_0:
3082                 phy->negotiated_linkrate = SAS_LINK_RATE_6_0_GBPS;
3083                 break;
3084         case MPI_SAS_IOUNIT0_RATE_SATA_OOB_COMPLETE:
3085         case MPI_SAS_IOUNIT0_RATE_UNKNOWN:
3086         default:
3087                 phy->negotiated_linkrate = SAS_LINK_RATE_UNKNOWN;
3088                 break;
3089         }
3090
3091         /*
3092          * Set Max hardware link rate.
3093          */
3094         switch (phy_info->hw_link_rate & MPI_SAS_PHY0_PRATE_MAX_RATE_MASK) {
3095         case MPI_SAS_PHY0_HWRATE_MAX_RATE_1_5:
3096                 phy->maximum_linkrate_hw = SAS_LINK_RATE_1_5_GBPS;
3097                 break;
3098         case MPI_SAS_PHY0_PRATE_MAX_RATE_3_0:
3099                 phy->maximum_linkrate_hw = SAS_LINK_RATE_3_0_GBPS;
3100                 break;
3101         default:
3102                 break;
3103         }
3104
3105         /*
3106          * Set Max programmed link rate.
3107          */
3108         switch (phy_info->programmed_link_rate &
3109                         MPI_SAS_PHY0_PRATE_MAX_RATE_MASK) {
3110         case MPI_SAS_PHY0_PRATE_MAX_RATE_1_5:
3111                 phy->maximum_linkrate = SAS_LINK_RATE_1_5_GBPS;
3112                 break;
3113         case MPI_SAS_PHY0_PRATE_MAX_RATE_3_0:
3114                 phy->maximum_linkrate = SAS_LINK_RATE_3_0_GBPS;
3115                 break;
3116         default:
3117                 break;
3118         }
3119
3120         /*
3121          * Set Min hardware link rate.
3122          */
3123         switch (phy_info->hw_link_rate & MPI_SAS_PHY0_HWRATE_MIN_RATE_MASK) {
3124         case MPI_SAS_PHY0_HWRATE_MIN_RATE_1_5:
3125                 phy->minimum_linkrate_hw = SAS_LINK_RATE_1_5_GBPS;
3126                 break;
3127         case MPI_SAS_PHY0_PRATE_MIN_RATE_3_0:
3128                 phy->minimum_linkrate_hw = SAS_LINK_RATE_3_0_GBPS;
3129                 break;
3130         default:
3131                 break;
3132         }
3133
3134         /*
3135          * Set Min programmed link rate.
3136          */
3137         switch (phy_info->programmed_link_rate &
3138                         MPI_SAS_PHY0_PRATE_MIN_RATE_MASK) {
3139         case MPI_SAS_PHY0_PRATE_MIN_RATE_1_5:
3140                 phy->minimum_linkrate = SAS_LINK_RATE_1_5_GBPS;
3141                 break;
3142         case MPI_SAS_PHY0_PRATE_MIN_RATE_3_0:
3143                 phy->minimum_linkrate = SAS_LINK_RATE_3_0_GBPS;
3144                 break;
3145         default:
3146                 break;
3147         }
3148
3149         if (!phy_info->phy) {
3150
3151                 error = sas_phy_add(phy);
3152                 if (error) {
3153                         sas_phy_free(phy);
3154                         goto out;
3155                 }
3156                 phy_info->phy = phy;
3157         }
3158
3159         if (!phy_info->attached.handle ||
3160                         !phy_info->port_details)
3161                 goto out;
3162
3163         port = mptsas_get_port(phy_info);
3164         ioc = phy_to_ioc(phy_info->phy);
3165
3166         if (phy_info->sas_port_add_phy) {
3167
3168                 if (!port) {
3169                         port = sas_port_alloc_num(dev);
3170                         if (!port) {
3171                                 error = -ENOMEM;
3172                                 goto out;
3173                         }
3174                         error = sas_port_add(port);
3175                         if (error) {
3176                                 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
3177                                         "%s: exit at line=%d\n", ioc->name,
3178                                         __func__, __LINE__));
3179                                 goto out;
3180                         }
3181                         mptsas_set_port(ioc, phy_info, port);
3182                         devtprintk(ioc, dev_printk(KERN_DEBUG, &port->dev,
3183                             MYIOC_s_FMT "add port %d, sas_addr (0x%llx)\n",
3184                             ioc->name, port->port_identifier,
3185                             (unsigned long long)phy_info->
3186                             attached.sas_address));
3187                 }
3188                 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT
3189                         "sas_port_add_phy: phy_id=%d\n",
3190                         ioc->name, phy_info->phy_id));
3191                 sas_port_add_phy(port, phy_info->phy);
3192                 phy_info->sas_port_add_phy = 0;
3193                 devtprintk(ioc, dev_printk(KERN_DEBUG, &phy_info->phy->dev,
3194                     MYIOC_s_FMT "add phy %d, phy-obj (0x%p)\n", ioc->name,
3195                      phy_info->phy_id, phy_info->phy));
3196         }
3197         if (!mptsas_get_rphy(phy_info) && port && !port->rphy) {
3198
3199                 struct sas_rphy *rphy;
3200                 struct device *parent;
3201                 struct sas_identify identify;
3202
3203                 parent = dev->parent->parent;
3204                 /*
3205                  * Let the hotplug_work thread handle processing
3206                  * the adding/removing of devices that occur
3207                  * after start of day.
3208                  */
3209                 if (mptsas_is_end_device(&phy_info->attached) &&
3210                     phy_info->attached.handle_parent) {
3211                         goto out;
3212                 }
3213
3214                 mptsas_parse_device_info(&identify, &phy_info->attached);
3215                 if (scsi_is_host_device(parent)) {
3216                         struct mptsas_portinfo *port_info;
3217                         int i;
3218
3219                         port_info = ioc->hba_port_info;
3220
3221                         for (i = 0; i < port_info->num_phys; i++)
3222                                 if (port_info->phy_info[i].identify.sas_address ==
3223                                     identify.sas_address) {
3224                                         sas_port_mark_backlink(port);
3225                                         goto out;
3226                                 }
3227
3228                 } else if (scsi_is_sas_rphy(parent)) {
3229                         struct sas_rphy *parent_rphy = dev_to_rphy(parent);
3230                         if (identify.sas_address ==
3231                             parent_rphy->identify.sas_address) {
3232                                 sas_port_mark_backlink(port);
3233                                 goto out;
3234                         }
3235                 }
3236
3237                 switch (identify.device_type) {
3238                 case SAS_END_DEVICE:
3239                         rphy = sas_end_device_alloc(port);
3240                         break;
3241                 case SAS_EDGE_EXPANDER_DEVICE:
3242                 case SAS_FANOUT_EXPANDER_DEVICE:
3243                         rphy = sas_expander_alloc(port, identify.device_type);
3244                         break;
3245                 default:
3246                         rphy = NULL;
3247                         break;
3248                 }
3249                 if (!rphy) {
3250                         dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
3251                                 "%s: exit at line=%d\n", ioc->name,
3252                                 __func__, __LINE__));
3253                         goto out;
3254                 }
3255
3256                 rphy->identify = identify;
3257                 error = sas_rphy_add(rphy);
3258                 if (error) {
3259                         dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
3260                                 "%s: exit at line=%d\n", ioc->name,
3261                                 __func__, __LINE__));
3262                         sas_rphy_free(rphy);
3263                         goto out;
3264                 }
3265                 mptsas_set_rphy(ioc, phy_info, rphy);
3266                 if (identify.device_type == SAS_EDGE_EXPANDER_DEVICE ||
3267                         identify.device_type == SAS_FANOUT_EXPANDER_DEVICE)
3268                                 mptsas_exp_repmanufacture_info(ioc,
3269                                         identify.sas_address,
3270                                         rphy_to_expander_device(rphy));
3271         }
3272
3273         /* If the device exists,verify it wasn't previously flagged
3274         as a missing device.  If so, clear it */
3275         vtarget = mptsas_find_vtarget(ioc,
3276             phy_info->attached.channel,
3277             phy_info->attached.id);
3278         if (vtarget && vtarget->inDMD) {
3279                 printk(KERN_INFO "Device returned, unsetting inDMD\n");
3280                 vtarget->inDMD = 0;
3281         }
3282
3283  out:
3284         return error;
3285 }
3286
3287 static int
3288 mptsas_probe_hba_phys(MPT_ADAPTER *ioc)
3289 {
3290         struct mptsas_portinfo *port_info, *hba;
3291         int error = -ENOMEM, i;
3292
3293         hba = kzalloc(sizeof(struct mptsas_portinfo), GFP_KERNEL);
3294         if (! hba)
3295                 goto out;
3296
3297         error = mptsas_sas_io_unit_pg0(ioc, hba);
3298         if (error)
3299                 goto out_free_port_info;
3300
3301         mptsas_sas_io_unit_pg1(ioc);
3302         mutex_lock(&ioc->sas_topology_mutex);
3303         port_info = ioc->hba_port_info;
3304         if (!port_info) {
3305                 ioc->hba_port_info = port_info = hba;
3306                 ioc->hba_port_num_phy = port_info->num_phys;
3307                 list_add_tail(&port_info->list, &ioc->sas_topology);
3308         } else {
3309                 for (i = 0; i < hba->num_phys; i++) {
3310                         port_info->phy_info[i].negotiated_link_rate =
3311                                 hba->phy_info[i].negotiated_link_rate;
3312                         port_info->phy_info[i].handle =
3313                                 hba->phy_info[i].handle;
3314                         port_info->phy_info[i].port_id =
3315                                 hba->phy_info[i].port_id;
3316                 }
3317                 kfree(hba->phy_info);
3318                 kfree(hba);
3319                 hba = NULL;
3320         }
3321         mutex_unlock(&ioc->sas_topology_mutex);
3322 #if defined(CPQ_CIM)
3323         ioc->num_ports = port_info->num_phys;
3324 #endif
3325         for (i = 0; i < port_info->num_phys; i++) {
3326                 mptsas_sas_phy_pg0(ioc, &port_info->phy_info[i],
3327                         (MPI_SAS_PHY_PGAD_FORM_PHY_NUMBER <<
3328                          MPI_SAS_PHY_PGAD_FORM_SHIFT), i);
3329                 port_info->phy_info[i].identify.handle =
3330                     port_info->phy_info[i].handle;
3331                 mptsas_sas_device_pg0(ioc, &port_info->phy_info[i].identify,
3332                         (MPI_SAS_DEVICE_PGAD_FORM_HANDLE <<
3333                          MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
3334                          port_info->phy_info[i].identify.handle);
3335                 if (!ioc->hba_port_sas_addr)
3336                         ioc->hba_port_sas_addr =
3337                             port_info->phy_info[i].identify.sas_address;
3338                 port_info->phy_info[i].identify.phy_id =
3339                     port_info->phy_info[i].phy_id = i;
3340                 if (port_info->phy_info[i].attached.handle)
3341                         mptsas_sas_device_pg0(ioc,
3342                                 &port_info->phy_info[i].attached,
3343                                 (MPI_SAS_DEVICE_PGAD_FORM_HANDLE <<
3344                                  MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
3345                                 port_info->phy_info[i].attached.handle);
3346         }
3347
3348         mptsas_setup_wide_ports(ioc, port_info);
3349
3350         for (i = 0; i < port_info->num_phys; i++, ioc->sas_index++)
3351                 mptsas_probe_one_phy(&ioc->sh->shost_gendev,
3352                     &port_info->phy_info[i], ioc->sas_index, 1);
3353
3354         return 0;
3355
3356  out_free_port_info:
3357         kfree(hba);
3358  out:
3359         return error;
3360 }
3361
3362 static void
3363 mptsas_expander_refresh(MPT_ADAPTER *ioc, struct mptsas_portinfo *port_info)
3364 {
3365         struct mptsas_portinfo *parent;
3366         struct device *parent_dev;
3367         struct sas_rphy *rphy;
3368         int             i;
3369         u64             sas_address; /* expander sas address */
3370         u32             handle;
3371
3372         handle = port_info->phy_info[0].handle;
3373         sas_address = port_info->phy_info[0].identify.sas_address;
3374         for (i = 0; i < port_info->num_phys; i++) {
3375                 mptsas_sas_expander_pg1(ioc, &port_info->phy_info[i],
3376                     (MPI_SAS_EXPAND_PGAD_FORM_HANDLE_PHY_NUM <<
3377                     MPI_SAS_EXPAND_PGAD_FORM_SHIFT), (i << 16) + handle);
3378
3379                 mptsas_sas_device_pg0(ioc,
3380                     &port_info->phy_info[i].identify,
3381                     (MPI_SAS_DEVICE_PGAD_FORM_HANDLE <<
3382                     MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
3383                     port_info->phy_info[i].identify.handle);
3384                 port_info->phy_info[i].identify.phy_id =
3385                     port_info->phy_info[i].phy_id;
3386
3387                 if (port_info->phy_info[i].attached.handle) {
3388                         mptsas_sas_device_pg0(ioc,
3389                             &port_info->phy_info[i].attached,
3390                             (MPI_SAS_DEVICE_PGAD_FORM_HANDLE <<
3391                              MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
3392                             port_info->phy_info[i].attached.handle);
3393                         port_info->phy_info[i].attached.phy_id =
3394                             port_info->phy_info[i].phy_id;
3395                 }
3396         }
3397
3398         mutex_lock(&ioc->sas_topology_mutex);
3399         parent = mptsas_find_portinfo_by_handle(ioc,
3400             port_info->phy_info[0].identify.handle_parent);
3401         if (!parent) {
3402                 mutex_unlock(&ioc->sas_topology_mutex);
3403                 return;
3404         }
3405         for (i = 0, parent_dev = NULL; i < parent->num_phys && !parent_dev;
3406             i++) {
3407                 if (parent->phy_info[i].attached.sas_address == sas_address) {
3408                         rphy = mptsas_get_rphy(&parent->phy_info[i]);
3409                         parent_dev = &rphy->dev;
3410                 }
3411         }
3412         mutex_unlock(&ioc->sas_topology_mutex);
3413
3414         mptsas_setup_wide_ports(ioc, port_info);
3415         for (i = 0; i < port_info->num_phys; i++, ioc->sas_index++)
3416                 mptsas_probe_one_phy(parent_dev, &port_info->phy_info[i],
3417                     ioc->sas_index, 0);
3418 }
3419
3420 static void
3421 mptsas_expander_event_add(MPT_ADAPTER *ioc,
3422     MpiEventDataSasExpanderStatusChange_t *expander_data)
3423 {
3424         struct mptsas_portinfo *port_info;
3425         int i;
3426         __le64 sas_address;
3427
3428         port_info = kzalloc(sizeof(struct mptsas_portinfo), GFP_KERNEL);
3429         if (!port_info)
3430                 BUG();
3431         port_info->num_phys = (expander_data->NumPhys) ?
3432             expander_data->NumPhys : 1;
3433         port_info->phy_info = kcalloc(port_info->num_phys,
3434             sizeof(struct mptsas_phyinfo), GFP_KERNEL);
3435         if (!port_info->phy_info)
3436                 BUG();
3437         memcpy(&sas_address, &expander_data->SASAddress, sizeof(__le64));
3438         for (i = 0; i < port_info->num_phys; i++) {
3439                 port_info->phy_info[i].portinfo = port_info;
3440                 port_info->phy_info[i].handle =
3441                     le16_to_cpu(expander_data->DevHandle);
3442                 port_info->phy_info[i].identify.sas_address =
3443                     le64_to_cpu(sas_address);
3444                 port_info->phy_info[i].identify.handle_parent =
3445                     le16_to_cpu(expander_data->ParentDevHandle);
3446         }
3447
3448         mutex_lock(&ioc->sas_topology_mutex);
3449         list_add_tail(&port_info->list, &ioc->sas_topology);
3450         mutex_unlock(&ioc->sas_topology_mutex);
3451
3452         printk(MYIOC_s_INFO_FMT "add expander: num_phys %d, "
3453             "sas_addr (0x%llx)\n", ioc->name, port_info->num_phys,
3454             (unsigned long long)sas_address);
3455
3456         mptsas_expander_refresh(ioc, port_info);
3457 }
3458
3459 /**
3460  * mptsas_delete_expander_siblings - remove siblings attached to expander
3461  * @ioc: Pointer to MPT_ADAPTER structure
3462  * @parent: the parent port_info object
3463  * @expander: the expander port_info object
3464  **/
3465 static void
3466 mptsas_delete_expander_siblings(MPT_ADAPTER *ioc, struct mptsas_portinfo
3467     *parent, struct mptsas_portinfo *expander)
3468 {
3469         struct mptsas_phyinfo *phy_info;
3470         struct mptsas_portinfo *port_info;
3471         struct sas_rphy *rphy;
3472         int i;
3473
3474         phy_info = expander->phy_info;
3475         for (i = 0; i < expander->num_phys; i++, phy_info++) {
3476                 rphy = mptsas_get_rphy(phy_info);
3477                 if (!rphy)
3478                         continue;
3479                 if (rphy->identify.device_type == SAS_END_DEVICE)
3480                         mptsas_del_end_device(ioc, phy_info);
3481         }
3482
3483         phy_info = expander->phy_info;
3484         for (i = 0; i < expander->num_phys; i++, phy_info++) {
3485                 rphy = mptsas_get_rphy(phy_info);
3486                 if (!rphy)
3487                         continue;
3488                 if (rphy->identify.device_type ==
3489                     MPI_SAS_DEVICE_INFO_EDGE_EXPANDER ||
3490                     rphy->identify.device_type ==
3491                     MPI_SAS_DEVICE_INFO_FANOUT_EXPANDER) {
3492                         port_info = mptsas_find_portinfo_by_sas_address(ioc,
3493                             rphy->identify.sas_address);
3494                         if (!port_info)
3495                                 continue;
3496                         if (port_info == parent) /* backlink rphy */
3497                                 continue;
3498                         /*
3499                         Delete this expander even if the expdevpage is exists
3500                         because the parent expander is already deleted
3501                         */
3502                         mptsas_expander_delete(ioc, port_info, 1);
3503                 }
3504         }
3505 }
3506
3507
3508 /**
3509  *      mptsas_expander_delete - remove this expander
3510  *      @ioc: Pointer to MPT_ADAPTER structure
3511  *      @port_info: expander port_info struct
3512  *      @force: Flag to forcefully delete the expander
3513  *
3514  **/
3515
3516 static void mptsas_expander_delete(MPT_ADAPTER *ioc,
3517                 struct mptsas_portinfo *port_info, u8 force)
3518 {
3519
3520         struct mptsas_portinfo *parent;
3521         int             i;
3522         u64             expander_sas_address;
3523         struct mptsas_phyinfo *phy_info;
3524         struct mptsas_portinfo buffer;
3525         struct mptsas_portinfo_details *port_details;
3526         struct sas_port *port;
3527
3528         if (!port_info)
3529                 return;
3530
3531         /* see if expander is still there before deleting */
3532         mptsas_sas_expander_pg0(ioc, &buffer,
3533             (MPI_SAS_EXPAND_PGAD_FORM_HANDLE <<
3534             MPI_SAS_EXPAND_PGAD_FORM_SHIFT),
3535             port_info->phy_info[0].identify.handle);
3536
3537         if (buffer.num_phys) {
3538                 kfree(buffer.phy_info);
3539                 if (!force)
3540                         return;
3541         }
3542
3543
3544         /*
3545          * Obtain the port_info instance to the parent port
3546          */
3547         port_details = NULL;
3548         expander_sas_address =
3549             port_info->phy_info[0].identify.sas_address;
3550         parent = mptsas_find_portinfo_by_handle(ioc,
3551             port_info->phy_info[0].identify.handle_parent);
3552         mptsas_delete_expander_siblings(ioc, parent, port_info);
3553         if (!parent)
3554                 goto out;
3555
3556         /*
3557          * Delete rphys in the parent that point
3558          * to this expander.
3559          */
3560         phy_info = parent->phy_info;
3561         port = NULL;
3562         for (i = 0; i < parent->num_phys; i++, phy_info++) {
3563                 if (!phy_info->phy)
3564                         continue;
3565                 if (phy_info->attached.sas_address !=
3566                     expander_sas_address)
3567                         continue;
3568                 if (!port) {
3569                         port = mptsas_get_port(phy_info);
3570                         port_details = phy_info->port_details;
3571                 }
3572                 dev_printk(KERN_DEBUG, &phy_info->phy->dev,
3573                     MYIOC_s_FMT "delete phy %d, phy-obj (0x%p)\n", ioc->name,
3574                     phy_info->phy_id, phy_info->phy);
3575                 sas_port_delete_phy(port, phy_info->phy);
3576         }
3577         if (port) {
3578                 dev_printk(KERN_DEBUG, &port->dev,
3579                     MYIOC_s_FMT "delete port %d, sas_addr (0x%llx)\n",
3580                     ioc->name, port->port_identifier,
3581                     (unsigned long long)expander_sas_address);
3582                 sas_port_delete(port);
3583                 mptsas_port_delete(ioc, port_details);
3584         }
3585  out:
3586
3587         printk(MYIOC_s_INFO_FMT "delete expander: num_phys %d, "
3588             "sas_addr (0x%llx)\n",  ioc->name, port_info->num_phys,
3589             (unsigned long long)expander_sas_address);
3590
3591         /*
3592          * free link
3593          */
3594         list_del(&port_info->list);
3595         kfree(port_info->phy_info);
3596         kfree(port_info);
3597 }
3598
3599
3600 /**
3601  * mptsas_send_expander_event - expanders events
3602  * @ioc: Pointer to MPT_ADAPTER structure
3603  * @expander_data: event data
3604  *
3605  *
3606  * This function handles adding, removing, and refreshing
3607  * device handles within the expander objects.
3608  */
3609 static void
3610 mptsas_send_expander_event(struct fw_event_work *fw_event)
3611 {
3612         MPT_ADAPTER *ioc;
3613         MpiEventDataSasExpanderStatusChange_t *expander_data;
3614         struct mptsas_portinfo *port_info;
3615         __le64 sas_address;
3616         int i;
3617
3618         ioc = fw_event->ioc;
3619         expander_data = (MpiEventDataSasExpanderStatusChange_t *)
3620             fw_event->event_data;
3621         memcpy(&sas_address, &expander_data->SASAddress, sizeof(__le64));
3622         sas_address = le64_to_cpu(sas_address);
3623         port_info = mptsas_find_portinfo_by_sas_address(ioc, sas_address);
3624
3625         if (expander_data->ReasonCode == MPI_EVENT_SAS_EXP_RC_ADDED) {
3626                 if (port_info) {
3627                         for (i = 0; i < port_info->num_phys; i++) {
3628                                 port_info->phy_info[i].portinfo = port_info;
3629                                 port_info->phy_info[i].handle =
3630                                     le16_to_cpu(expander_data->DevHandle);
3631                                 port_info->phy_info[i].identify.sas_address =
3632                                     le64_to_cpu(sas_address);
3633                                 port_info->phy_info[i].identify.handle_parent =
3634                                     le16_to_cpu(expander_data->ParentDevHandle);
3635                         }
3636                         mptsas_expander_refresh(ioc, port_info);
3637                 } else if (!port_info && expander_data->NumPhys)
3638                         mptsas_expander_event_add(ioc, expander_data);
3639         } else if (expander_data->ReasonCode ==
3640             MPI_EVENT_SAS_EXP_RC_NOT_RESPONDING)
3641                 mptsas_expander_delete(ioc, port_info, 0);
3642
3643         mptsas_free_fw_event(ioc, fw_event);
3644 }
3645
3646
3647 /**
3648  * mptsas_expander_add -
3649  * @ioc: Pointer to MPT_ADAPTER structure
3650  * @handle:
3651  *
3652  */
3653 struct mptsas_portinfo *
3654 mptsas_expander_add(MPT_ADAPTER *ioc, u16 handle)
3655 {
3656         struct mptsas_portinfo buffer, *port_info;
3657         int i;
3658
3659         if ((mptsas_sas_expander_pg0(ioc, &buffer,
3660             (MPI_SAS_EXPAND_PGAD_FORM_HANDLE <<
3661             MPI_SAS_EXPAND_PGAD_FORM_SHIFT), handle)))
3662                 return NULL;
3663
3664         port_info = kzalloc(sizeof(struct mptsas_portinfo), GFP_ATOMIC);
3665         if (!port_info) {
3666                 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
3667                 "%s: exit at line=%d\n", ioc->name,
3668                 __func__, __LINE__));
3669                 return NULL;
3670         }
3671         port_info->num_phys = buffer.num_phys;
3672         port_info->phy_info = buffer.phy_info;
3673         for (i = 0; i < port_info->num_phys; i++)
3674                 port_info->phy_info[i].portinfo = port_info;
3675         mutex_lock(&ioc->sas_topology_mutex);
3676         list_add_tail(&port_info->list, &ioc->sas_topology);
3677         mutex_unlock(&ioc->sas_topology_mutex);
3678         printk(MYIOC_s_INFO_FMT "add expander: num_phys %d, "
3679             "sas_addr (0x%llx)\n", ioc->name, port_info->num_phys,
3680             (unsigned long long)buffer.phy_info[0].identify.sas_address);
3681         mptsas_expander_refresh(ioc, port_info);
3682         return port_info;
3683 }
3684
3685 static void
3686 mptsas_send_link_status_event(struct fw_event_work *fw_event)
3687 {
3688         MPT_ADAPTER *ioc;
3689         MpiEventDataSasPhyLinkStatus_t *link_data;
3690         struct mptsas_portinfo *port_info;
3691         struct mptsas_phyinfo *phy_info = NULL;
3692         __le64 sas_address;
3693         u8 phy_num;
3694         u8 link_rate;
3695
3696         ioc = fw_event->ioc;
3697         link_data = (MpiEventDataSasPhyLinkStatus_t *)fw_event->event_data;
3698
3699         memcpy(&sas_address, &link_data->SASAddress, sizeof(__le64));
3700         sas_address = le64_to_cpu(sas_address);
3701         link_rate = link_data->LinkRates >> 4;
3702         phy_num = link_data->PhyNum;
3703
3704         port_info = mptsas_find_portinfo_by_sas_address(ioc, sas_address);
3705         if (port_info) {
3706                 phy_info = &port_info->phy_info[phy_num];
3707                 if (phy_info)
3708                         phy_info->negotiated_link_rate = link_rate;
3709         }
3710
3711         if (link_rate == MPI_SAS_IOUNIT0_RATE_1_5 ||
3712             link_rate == MPI_SAS_IOUNIT0_RATE_3_0 ||
3713             link_rate == MPI_SAS_IOUNIT0_RATE_6_0) {
3714
3715                 if (!port_info) {
3716                         if (ioc->old_sas_discovery_protocal) {
3717                                 port_info = mptsas_expander_add(ioc,
3718                                         le16_to_cpu(link_data->DevHandle));
3719                                 if (port_info)
3720                                         goto out;
3721                         }
3722                         goto out;
3723                 }
3724
3725                 if (port_info == ioc->hba_port_info)
3726                         mptsas_probe_hba_phys(ioc);
3727                 else
3728                         mptsas_expander_refresh(ioc, port_info);
3729         } else if (phy_info && phy_info->phy) {
3730                 if (link_rate ==  MPI_SAS_IOUNIT0_RATE_PHY_DISABLED)
3731                         phy_info->phy->negotiated_linkrate =
3732                             SAS_PHY_DISABLED;
3733                 else if (link_rate ==
3734                     MPI_SAS_IOUNIT0_RATE_FAILED_SPEED_NEGOTIATION)
3735                         phy_info->phy->negotiated_linkrate =
3736                             SAS_LINK_RATE_FAILED;
3737                 else {
3738                         phy_info->phy->negotiated_linkrate =
3739                             SAS_LINK_RATE_UNKNOWN;
3740                         if (ioc->device_missing_delay &&
3741                             mptsas_is_end_device(&phy_info->attached)) {
3742                                 struct scsi_device              *sdev;
3743                                 VirtDevice                      *vdevice;
3744                                 u8      channel, id;
3745                                 id = phy_info->attached.id;
3746                                 channel = phy_info->attached.channel;
3747                                 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT
3748                                 "Link down for fw_id %d:fw_channel %d\n",
3749                                     ioc->name, phy_info->attached.id,
3750                                     phy_info->attached.channel));
3751
3752                                 shost_for_each_device(sdev, ioc->sh) {
3753                                         vdevice = sdev->hostdata;
3754                                         if ((vdevice == NULL) ||
3755                                                 (vdevice->vtarget == NULL))
3756                                                 continue;
3757                                         if ((vdevice->vtarget->tflags &
3758                                             MPT_TARGET_FLAGS_RAID_COMPONENT ||
3759                                             vdevice->vtarget->raidVolume))
3760                                                 continue;
3761                                         if (vdevice->vtarget->id == id &&
3762                                                 vdevice->vtarget->channel ==
3763                                                 channel)
3764                                                 devtprintk(ioc,
3765                                                 printk(MYIOC_s_DEBUG_FMT
3766                                                 "SDEV OUTSTANDING CMDS"
3767                                                 "%d\n", ioc->name,
3768                                                 sdev->device_busy));
3769                                 }
3770
3771                         }
3772                 }
3773         }
3774  out:
3775         mptsas_free_fw_event(ioc, fw_event);
3776 }
3777
3778 static void
3779 mptsas_not_responding_devices(MPT_ADAPTER *ioc)
3780 {
3781         struct mptsas_portinfo buffer, *port_info;
3782         struct mptsas_device_info       *sas_info;
3783         struct mptsas_devinfo sas_device;
3784         u32     handle;
3785         VirtTarget *vtarget = NULL;
3786         struct mptsas_phyinfo *phy_info;
3787         u8 found_expander;
3788         int retval, retry_count;
3789         unsigned long flags;
3790
3791         mpt_findImVolumes(ioc);
3792
3793         spin_lock_irqsave(&ioc->taskmgmt_lock, flags);
3794         if (ioc->ioc_reset_in_progress) {
3795                 dfailprintk(ioc, printk(MYIOC_s_DEBUG_FMT
3796                    "%s: exiting due to a parallel reset \n", ioc->name,
3797                     __func__));
3798                 spin_unlock_irqrestore(&ioc->taskmgmt_lock, flags);
3799                 return;
3800         }
3801         spin_unlock_irqrestore(&ioc->taskmgmt_lock, flags);
3802
3803         /* devices, logical volumes */
3804         mutex_lock(&ioc->sas_device_info_mutex);
3805  redo_device_scan:
3806         list_for_each_entry(sas_info, &ioc->sas_device_info_list, list) {
3807                 if (sas_info->is_cached)
3808                         continue;
3809                 if (!sas_info->is_logical_volume) {
3810                         sas_device.handle = 0;
3811                         retry_count = 0;
3812 retry_page:
3813                         retval = mptsas_sas_device_pg0(ioc, &sas_device,
3814                                 (MPI_SAS_DEVICE_PGAD_FORM_BUS_TARGET_ID
3815                                 << MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
3816                                 (sas_info->fw.channel << 8) +
3817                                 sas_info->fw.id);
3818
3819                         if (sas_device.handle)
3820                                 continue;
3821                         if (retval == -EBUSY) {
3822                                 spin_lock_irqsave(&ioc->taskmgmt_lock, flags);
3823                                 if (ioc->ioc_reset_in_progress) {
3824                                         dfailprintk(ioc,
3825                                         printk(MYIOC_s_DEBUG_FMT
3826                                         "%s: exiting due to reset\n",
3827                                         ioc->name, __func__));
3828                                         spin_unlock_irqrestore
3829                                         (&ioc->taskmgmt_lock, flags);
3830                                         mutex_unlock(&ioc->
3831                                         sas_device_info_mutex);
3832                                         return;
3833                                 }
3834                                 spin_unlock_irqrestore(&ioc->taskmgmt_lock,
3835                                 flags);
3836                         }
3837
3838                         if (retval && (retval != -ENODEV)) {
3839                                 if (retry_count < 10) {
3840                                         retry_count++;
3841                                         goto retry_page;
3842                                 } else {
3843                                         devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT
3844                                         "%s: Config page retry exceeded retry "
3845                                         "count deleting device 0x%llx\n",
3846                                         ioc->name, __func__,
3847                                         sas_info->sas_address));
3848                                 }
3849                         }
3850
3851                         /* delete device */
3852                         vtarget = mptsas_find_vtarget(ioc,
3853                                 sas_info->fw.channel, sas_info->fw.id);
3854
3855                         if (vtarget)
3856                                 vtarget->deleted = 1;
3857
3858                         phy_info = mptsas_find_phyinfo_by_sas_address(ioc,
3859                                         sas_info->sas_address);
3860
3861                         if (phy_info) {
3862                                 mptsas_del_end_device(ioc, phy_info);
3863                                 goto redo_device_scan;
3864                         }
3865                 } else
3866                         mptsas_volume_delete(ioc, sas_info->fw.id);
3867         }
3868         mutex_unlock(&ioc->sas_device_info_mutex);
3869
3870         /* expanders */
3871         mutex_lock(&ioc->sas_topology_mutex);
3872  redo_expander_scan:
3873         list_for_each_entry(port_info, &ioc->sas_topology, list) {
3874
3875                 if (port_info->phy_info &&
3876                     (!(port_info->phy_info[0].identify.device_info &
3877                     MPI_SAS_DEVICE_INFO_SMP_TARGET)))
3878                         continue;
3879                 found_expander = 0;
3880                 handle = 0xFFFF;
3881                 while (!mptsas_sas_expander_pg0(ioc, &buffer,
3882                     (MPI_SAS_EXPAND_PGAD_FORM_GET_NEXT_HANDLE <<
3883                      MPI_SAS_EXPAND_PGAD_FORM_SHIFT), handle) &&
3884                     !found_expander) {
3885
3886                         handle = buffer.phy_info[0].handle;
3887                         if (buffer.phy_info[0].identify.sas_address ==
3888                             port_info->phy_info[0].identify.sas_address) {
3889                                 found_expander = 1;
3890                         }
3891                         kfree(buffer.phy_info);
3892                 }
3893
3894                 if (!found_expander) {
3895                         mptsas_expander_delete(ioc, port_info, 0);
3896                         goto redo_expander_scan;
3897                 }
3898         }
3899         mutex_unlock(&ioc->sas_topology_mutex);
3900 }
3901
3902 /**
3903  *      mptsas_probe_expanders - adding expanders
3904  *      @ioc: Pointer to MPT_ADAPTER structure
3905  *
3906  **/
3907 static void
3908 mptsas_probe_expanders(MPT_ADAPTER *ioc)
3909 {
3910         struct mptsas_portinfo buffer, *port_info;
3911         u32                     handle;
3912         int i;
3913
3914         handle = 0xFFFF;
3915         while (!mptsas_sas_expander_pg0(ioc, &buffer,
3916             (MPI_SAS_EXPAND_PGAD_FORM_GET_NEXT_HANDLE <<
3917              MPI_SAS_EXPAND_PGAD_FORM_SHIFT), handle)) {
3918
3919                 handle = buffer.phy_info[0].handle;
3920                 port_info = mptsas_find_portinfo_by_sas_address(ioc,
3921                     buffer.phy_info[0].identify.sas_address);
3922
3923                 if (port_info) {
3924                         /* refreshing handles */
3925                         for (i = 0; i < buffer.num_phys; i++) {
3926                                 port_info->phy_info[i].handle = handle;
3927                                 port_info->phy_info[i].identify.handle_parent =
3928                                     buffer.phy_info[0].identify.handle_parent;
3929                         }
3930                         mptsas_expander_refresh(ioc, port_info);
3931                         kfree(buffer.phy_info);
3932                         continue;
3933                 }
3934
3935                 port_info = kzalloc(sizeof(struct mptsas_portinfo), GFP_KERNEL);
3936                 if (!port_info) {
3937                         dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
3938                         "%s: exit at line=%d\n", ioc->name,
3939                         __func__, __LINE__));
3940                         return;
3941                 }
3942                 port_info->num_phys = buffer.num_phys;
3943                 port_info->phy_info = buffer.phy_info;
3944                 for (i = 0; i < port_info->num_phys; i++)
3945                         port_info->phy_info[i].portinfo = port_info;
3946                 mutex_lock(&ioc->sas_topology_mutex);
3947                 list_add_tail(&port_info->list, &ioc->sas_topology);
3948                 mutex_unlock(&ioc->sas_topology_mutex);
3949                 printk(MYIOC_s_INFO_FMT "add expander: num_phys %d, "
3950                     "sas_addr (0x%llx)\n", ioc->name, port_info->num_phys,
3951             (unsigned long long)buffer.phy_info[0].identify.sas_address);
3952                 mptsas_expander_refresh(ioc, port_info);
3953         }
3954 }
3955
3956 static void
3957 mptsas_probe_devices(MPT_ADAPTER *ioc)
3958 {
3959         u16 handle;
3960         struct mptsas_devinfo sas_device;
3961         struct mptsas_phyinfo *phy_info;
3962
3963         handle = 0xFFFF;
3964         while (!(mptsas_sas_device_pg0(ioc, &sas_device,
3965             MPI_SAS_DEVICE_PGAD_FORM_GET_NEXT_HANDLE, handle))) {
3966
3967                 handle = sas_device.handle;
3968
3969                 if ((sas_device.device_info &
3970                      (MPI_SAS_DEVICE_INFO_SSP_TARGET |
3971                       MPI_SAS_DEVICE_INFO_STP_TARGET |
3972                       MPI_SAS_DEVICE_INFO_SATA_DEVICE)) == 0)
3973                         continue;
3974
3975                 /* If there is no FW B_T mapping for this device then continue
3976                  * */
3977                 if (!(sas_device.flags & MPI_SAS_DEVICE0_FLAGS_DEVICE_PRESENT)
3978                         || !(sas_device.flags &
3979                         MPI_SAS_DEVICE0_FLAGS_DEVICE_MAPPED))
3980                         continue;
3981
3982                 phy_info = mptsas_refreshing_device_handles(ioc, &sas_device);
3983                 if (!phy_info)
3984                         continue;
3985
3986                 if (mptsas_get_rphy(phy_info))
3987                         continue;
3988
3989                 mptsas_add_end_device(ioc, phy_info);
3990         }
3991 }
3992
3993 /**
3994  *      mptsas_scan_sas_topology -
3995  *      @ioc: Pointer to MPT_ADAPTER structure
3996  *      @sas_address:
3997  *
3998  **/
3999 static void
4000 mptsas_scan_sas_topology(MPT_ADAPTER *ioc)
4001 {
4002         struct scsi_device *sdev;
4003         int i;
4004
4005         mptsas_probe_hba_phys(ioc);
4006         mptsas_probe_expanders(ioc);
4007         mptsas_probe_devices(ioc);
4008
4009         /*
4010           Reporting RAID volumes.
4011         */
4012         if (!ioc->ir_firmware || !ioc->raid_data.pIocPg2 ||
4013             !ioc->raid_data.pIocPg2->NumActiveVolumes)
4014                 return;
4015         for (i = 0; i < ioc->raid_data.pIocPg2->NumActiveVolumes; i++) {
4016                 sdev = scsi_device_lookup(ioc->sh, MPTSAS_RAID_CHANNEL,
4017                     ioc->raid_data.pIocPg2->RaidVolume[i].VolumeID, 0);
4018                 if (sdev) {
4019                         scsi_device_put(sdev);
4020                         continue;
4021                 }
4022                 printk(MYIOC_s_INFO_FMT "attaching raid volume, channel %d, "
4023                     "id %d\n", ioc->name, MPTSAS_RAID_CHANNEL,
4024                     ioc->raid_data.pIocPg2->RaidVolume[i].VolumeID);
4025                 scsi_add_device(ioc->sh, MPTSAS_RAID_CHANNEL,
4026                     ioc->raid_data.pIocPg2->RaidVolume[i].VolumeID, 0);
4027         }
4028 }
4029
4030
4031 static void
4032 mptsas_handle_queue_full_event(struct fw_event_work *fw_event)
4033 {
4034         MPT_ADAPTER *ioc;
4035         EventDataQueueFull_t *qfull_data;
4036         struct mptsas_device_info *sas_info;
4037         struct scsi_device      *sdev;
4038         int depth;
4039         int id = -1;
4040         int channel = -1;
4041         int fw_id, fw_channel;
4042         u16 current_depth;
4043
4044
4045         ioc = fw_event->ioc;
4046         qfull_data = (EventDataQueueFull_t *)fw_event->event_data;
4047         fw_id = qfull_data->TargetID;
4048         fw_channel = qfull_data->Bus;
4049         current_depth = le16_to_cpu(qfull_data->CurrentDepth);
4050
4051         /* if hidden raid component, look for the volume id */
4052         mutex_lock(&ioc->sas_device_info_mutex);
4053         if (mptscsih_is_phys_disk(ioc, fw_channel, fw_id)) {
4054                 list_for_each_entry(sas_info, &ioc->sas_device_info_list,
4055                     list) {
4056                         if (sas_info->is_cached ||
4057                             sas_info->is_logical_volume)
4058                                 continue;
4059                         if (sas_info->is_hidden_raid_component &&
4060                             (sas_info->fw.channel == fw_channel &&
4061                             sas_info->fw.id == fw_id)) {
4062                                 id = sas_info->volume_id;
4063                                 channel = MPTSAS_RAID_CHANNEL;
4064                                 goto out;
4065                         }
4066                 }
4067         } else {
4068                 list_for_each_entry(sas_info, &ioc->sas_device_info_list,
4069                     list) {
4070                         if (sas_info->is_cached ||
4071                             sas_info->is_hidden_raid_component ||
4072                             sas_info->is_logical_volume)
4073                                 continue;
4074                         if (sas_info->fw.channel == fw_channel &&
4075                             sas_info->fw.id == fw_id) {
4076                                 id = sas_info->os.id;
4077                                 channel = sas_info->os.channel;
4078                                 goto out;
4079                         }
4080                 }
4081
4082         }
4083
4084  out:
4085         mutex_unlock(&ioc->sas_device_info_mutex);
4086
4087         if (id != -1) {
4088                 shost_for_each_device(sdev, ioc->sh) {
4089                         if (sdev->id == id && sdev->channel == channel) {
4090                                 if (current_depth > sdev->queue_depth) {
4091                                         sdev_printk(KERN_INFO, sdev,
4092                                             "strange observation, the queue "
4093                                             "depth is (%d) meanwhile fw queue "
4094                                             "depth (%d)\n", sdev->queue_depth,
4095                                             current_depth);
4096                                         continue;
4097                                 }
4098                                 depth = scsi_track_queue_full(sdev,
4099                                     current_depth - 1);
4100                                 if (depth > 0)
4101                                         sdev_printk(KERN_INFO, sdev,
4102                                         "Queue depth reduced to (%d)\n",
4103                                            depth);
4104                                 else if (depth < 0)
4105                                         sdev_printk(KERN_INFO, sdev,
4106                                         "Tagged Command Queueing is being "
4107                                         "disabled\n");
4108                                 else if (depth == 0)
4109                                         sdev_printk(KERN_INFO, sdev,
4110                                         "Queue depth not changed yet\n");
4111                         }
4112                 }
4113         }
4114
4115         mptsas_free_fw_event(ioc, fw_event);
4116 }
4117
4118
4119 static struct mptsas_phyinfo *
4120 mptsas_find_phyinfo_by_sas_address(MPT_ADAPTER *ioc, u64 sas_address)
4121 {
4122         struct mptsas_portinfo *port_info;
4123         struct mptsas_phyinfo *phy_info = NULL;
4124         int i;
4125
4126         mutex_lock(&ioc->sas_topology_mutex);
4127         list_for_each_entry(port_info, &ioc->sas_topology, list) {
4128                 for (i = 0; i < port_info->num_phys; i++) {
4129                         if (!mptsas_is_end_device(
4130                                 &port_info->phy_info[i].attached))
4131                                 continue;
4132                         if (port_info->phy_info[i].attached.sas_address
4133                             != sas_address)
4134                                 continue;
4135                         phy_info = &port_info->phy_info[i];
4136                         break;
4137                 }
4138         }
4139         mutex_unlock(&ioc->sas_topology_mutex);
4140         return phy_info;
4141 }
4142
4143 /**
4144  *      mptsas_find_phyinfo_by_phys_disk_num -
4145  *      @ioc: Pointer to MPT_ADAPTER structure
4146  *      @phys_disk_num:
4147  *      @channel:
4148  *      @id:
4149  *
4150  **/
4151 static struct mptsas_phyinfo *
4152 mptsas_find_phyinfo_by_phys_disk_num(MPT_ADAPTER *ioc, u8 phys_disk_num,
4153         u8 channel, u8 id)
4154 {
4155         struct mptsas_phyinfo *phy_info = NULL;
4156         struct mptsas_portinfo *port_info;
4157         RaidPhysDiskPage1_t *phys_disk = NULL;
4158         int num_paths;
4159         u64 sas_address = 0;
4160         int i;
4161
4162         phy_info = NULL;
4163         if (!ioc->raid_data.pIocPg3)
4164                 return NULL;
4165         /* dual port support */
4166         num_paths = mpt_raid_phys_disk_get_num_paths(ioc, phys_disk_num);
4167         if (!num_paths)
4168                 goto out;
4169         phys_disk = kzalloc(offsetof(RaidPhysDiskPage1_t, Path) +
4170            (num_paths * sizeof(RAID_PHYS_DISK1_PATH)), GFP_KERNEL);
4171         if (!phys_disk)
4172                 goto out;
4173         mpt_raid_phys_disk_pg1(ioc, phys_disk_num, phys_disk);
4174         for (i = 0; i < num_paths; i++) {
4175                 if ((phys_disk->Path[i].Flags & 1) != 0)
4176                         /* entry no longer valid */
4177                         continue;
4178                 if ((id == phys_disk->Path[i].PhysDiskID) &&
4179                     (channel == phys_disk->Path[i].PhysDiskBus)) {
4180                         memcpy(&sas_address, &phys_disk->Path[i].WWID,
4181                                 sizeof(u64));
4182                         phy_info = mptsas_find_phyinfo_by_sas_address(ioc,
4183                                         sas_address);
4184                         goto out;
4185                 }
4186         }
4187
4188  out:
4189         kfree(phys_disk);
4190         if (phy_info)
4191                 return phy_info;
4192
4193         /*
4194          * Extra code to handle RAID0 case, where the sas_address is not updated
4195          * in phys_disk_page_1 when hotswapped
4196          */
4197         mutex_lock(&ioc->sas_topology_mutex);
4198         list_for_each_entry(port_info, &ioc->sas_topology, list) {
4199                 for (i = 0; i < port_info->num_phys && !phy_info; i++) {
4200                         if (!mptsas_is_end_device(
4201                                 &port_info->phy_info[i].attached))
4202                                 continue;
4203                         if (port_info->phy_info[i].attached.phys_disk_num == ~0)
4204                                 continue;
4205                         if ((port_info->phy_info[i].attached.phys_disk_num ==
4206                             phys_disk_num) &&
4207                             (port_info->phy_info[i].attached.id == id) &&
4208                             (port_info->phy_info[i].attached.channel ==
4209                              channel))
4210                                 phy_info = &port_info->phy_info[i];
4211                 }
4212         }
4213         mutex_unlock(&ioc->sas_topology_mutex);
4214         return phy_info;
4215 }
4216
4217 static void
4218 mptsas_reprobe_lun(struct scsi_device *sdev, void *data)
4219 {
4220         int rc;
4221
4222         sdev->no_uld_attach = data ? 1 : 0;
4223         rc = scsi_device_reprobe(sdev);
4224 }
4225
4226 static void
4227 mptsas_reprobe_target(struct scsi_target *starget, int uld_attach)
4228 {
4229         starget_for_each_device(starget, uld_attach ? (void *)1 : NULL,
4230                         mptsas_reprobe_lun);
4231 }
4232
4233 static void
4234 mptsas_adding_inactive_raid_components(MPT_ADAPTER *ioc, u8 channel, u8 id)
4235 {
4236         CONFIGPARMS                     cfg;
4237         ConfigPageHeader_t              hdr;
4238         dma_addr_t                      dma_handle;
4239         pRaidVolumePage0_t              buffer = NULL;
4240         RaidPhysDiskPage0_t             phys_disk;
4241         int                             i;
4242         struct mptsas_phyinfo   *phy_info;
4243         struct mptsas_devinfo           sas_device;
4244
4245         memset(&cfg, 0 , sizeof(CONFIGPARMS));
4246         memset(&hdr, 0 , sizeof(ConfigPageHeader_t));
4247         hdr.PageType = MPI_CONFIG_PAGETYPE_RAID_VOLUME;
4248         cfg.pageAddr = (channel << 8) + id;
4249         cfg.cfghdr.hdr = &hdr;
4250         cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
4251         cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
4252
4253         if (mpt_config(ioc, &cfg) != 0)
4254                 goto out;
4255
4256         if (!hdr.PageLength)
4257                 goto out;
4258
4259         buffer = pci_alloc_consistent(ioc->pcidev, hdr.PageLength * 4,
4260             &dma_handle);
4261
4262         if (!buffer)
4263                 goto out;
4264
4265         cfg.physAddr = dma_handle;
4266         cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
4267
4268         if (mpt_config(ioc, &cfg) != 0)
4269                 goto out;
4270
4271         if (!(buffer->VolumeStatus.Flags &
4272             MPI_RAIDVOL0_STATUS_FLAG_VOLUME_INACTIVE))
4273                 goto out;
4274
4275         if (!buffer->NumPhysDisks)
4276                 goto out;
4277
4278         for (i = 0; i < buffer->NumPhysDisks; i++) {
4279
4280                 if (mpt_raid_phys_disk_pg0(ioc,
4281                     buffer->PhysDisk[i].PhysDiskNum, &phys_disk) != 0)
4282                         continue;
4283
4284                 if (mptsas_sas_device_pg0(ioc, &sas_device,
4285                     (MPI_SAS_DEVICE_PGAD_FORM_BUS_TARGET_ID <<
4286                      MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
4287                         (phys_disk.PhysDiskBus << 8) +
4288                         phys_disk.PhysDiskID))
4289                         continue;
4290
4291                 /* If there is no FW B_T mapping for this device then continue
4292                  * */
4293                 if (!(sas_device.flags & MPI_SAS_DEVICE0_FLAGS_DEVICE_PRESENT)
4294                         || !(sas_device.flags &
4295                         MPI_SAS_DEVICE0_FLAGS_DEVICE_MAPPED))
4296                         continue;
4297
4298
4299                 phy_info = mptsas_find_phyinfo_by_sas_address(ioc,
4300                     sas_device.sas_address);
4301                 mptsas_add_end_device(ioc, phy_info);
4302         }
4303
4304  out:
4305         if (buffer)
4306                 pci_free_consistent(ioc->pcidev, hdr.PageLength * 4, buffer,
4307                     dma_handle);
4308 }
4309 /*
4310  * Work queue thread to handle SAS hotplug events
4311  */
4312 static void
4313 mptsas_hotplug_work(MPT_ADAPTER *ioc, struct fw_event_work *fw_event,
4314     struct mptsas_hotplug_event *hot_plug_info)
4315 {
4316         struct mptsas_phyinfo *phy_info;
4317         struct scsi_target * starget;
4318         struct mptsas_devinfo sas_device;
4319         VirtTarget *vtarget;
4320         int i;
4321         struct mptsas_portinfo *port_info;
4322
4323         switch (hot_plug_info->event_type) {
4324
4325         case MPTSAS_ADD_PHYSDISK:
4326
4327                 if (!ioc->raid_data.pIocPg2)
4328                         break;
4329
4330                 for (i = 0; i < ioc->raid_data.pIocPg2->NumActiveVolumes; i++) {
4331                         if (ioc->raid_data.pIocPg2->RaidVolume[i].VolumeID ==
4332                             hot_plug_info->id) {
4333                                 printk(MYIOC_s_WARN_FMT "firmware bug: unable "
4334                                     "to add hidden disk - target_id matchs "
4335                                     "volume_id\n", ioc->name);
4336                                 mptsas_free_fw_event(ioc, fw_event);
4337                                 return;
4338                         }
4339                 }
4340                 mpt_findImVolumes(ioc);
4341
4342         case MPTSAS_ADD_DEVICE:
4343                 memset(&sas_device, 0, sizeof(struct mptsas_devinfo));
4344                 mptsas_sas_device_pg0(ioc, &sas_device,
4345                     (MPI_SAS_DEVICE_PGAD_FORM_BUS_TARGET_ID <<
4346                     MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
4347                     (hot_plug_info->channel << 8) +
4348                     hot_plug_info->id);
4349
4350                 /* If there is no FW B_T mapping for this device then break
4351                  * */
4352                 if (!(sas_device.flags & MPI_SAS_DEVICE0_FLAGS_DEVICE_PRESENT)
4353                         || !(sas_device.flags &
4354                         MPI_SAS_DEVICE0_FLAGS_DEVICE_MAPPED))
4355                         break;
4356
4357                 if (!sas_device.handle)
4358                         return;
4359
4360                 phy_info = mptsas_refreshing_device_handles(ioc, &sas_device);
4361                 /* Only For SATA Device ADD */
4362                 if (!phy_info && (sas_device.device_info &
4363                                 MPI_SAS_DEVICE_INFO_SATA_DEVICE)) {
4364                         devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT
4365                                 "%s %d SATA HOT PLUG: "
4366                                 "parent handle of device %x\n", ioc->name,
4367                                 __func__, __LINE__, sas_device.handle_parent));
4368                         port_info = mptsas_find_portinfo_by_handle(ioc,
4369                                 sas_device.handle_parent);
4370
4371                         if (port_info == ioc->hba_port_info)
4372                                 mptsas_probe_hba_phys(ioc);
4373                         else if (port_info)
4374                                 mptsas_expander_refresh(ioc, port_info);
4375                         else {
4376                                 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4377                                         "%s %d port info is NULL\n",
4378                                         ioc->name, __func__, __LINE__));
4379                                 break;
4380                         }
4381                         phy_info = mptsas_refreshing_device_handles
4382                                 (ioc, &sas_device);
4383                 }
4384
4385                 if (!phy_info) {
4386                         dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4387                                 "%s %d phy info is NULL\n",
4388                                 ioc->name, __func__, __LINE__));
4389                         break;
4390                 }
4391
4392                 if (mptsas_get_rphy(phy_info))
4393                         break;
4394
4395                 mptsas_add_end_device(ioc, phy_info);
4396                 break;
4397
4398         case MPTSAS_DEL_DEVICE:
4399                 phy_info = mptsas_find_phyinfo_by_sas_address(ioc,
4400                     hot_plug_info->sas_address);
4401                 mptsas_del_end_device(ioc, phy_info);
4402                 break;
4403
4404         case MPTSAS_DEL_PHYSDISK:
4405
4406                 mpt_findImVolumes(ioc);
4407
4408                 phy_info = mptsas_find_phyinfo_by_phys_disk_num(
4409                                 ioc, hot_plug_info->phys_disk_num,
4410                                 hot_plug_info->channel,
4411                                 hot_plug_info->id);
4412                 mptsas_del_end_device(ioc, phy_info);
4413                 break;
4414
4415         case MPTSAS_ADD_PHYSDISK_REPROBE:
4416
4417                 if (mptsas_sas_device_pg0(ioc, &sas_device,
4418                     (MPI_SAS_DEVICE_PGAD_FORM_BUS_TARGET_ID <<
4419                      MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
4420                     (hot_plug_info->channel << 8) + hot_plug_info->id)) {
4421                         dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4422                         "%s: fw_id=%d exit at line=%d\n", ioc->name,
4423                                  __func__, hot_plug_info->id, __LINE__));
4424                         break;
4425                 }
4426
4427                 /* If there is no FW B_T mapping for this device then break
4428                  * */
4429                 if (!(sas_device.flags & MPI_SAS_DEVICE0_FLAGS_DEVICE_PRESENT)
4430                         || !(sas_device.flags &
4431                         MPI_SAS_DEVICE0_FLAGS_DEVICE_MAPPED))
4432                         break;
4433
4434                 phy_info = mptsas_find_phyinfo_by_sas_address(
4435                     ioc, sas_device.sas_address);
4436
4437                 if (!phy_info) {
4438                         dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4439                                 "%s: fw_id=%d exit at line=%d\n", ioc->name,
4440                                  __func__, hot_plug_info->id, __LINE__));
4441                         break;
4442                 }
4443
4444                 starget = mptsas_get_starget(phy_info);
4445                 if (!starget) {
4446                         dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4447                                 "%s: fw_id=%d exit at line=%d\n", ioc->name,
4448                                  __func__, hot_plug_info->id, __LINE__));
4449                         break;
4450                 }
4451
4452                 vtarget = starget->hostdata;
4453                 if (!vtarget) {
4454                         dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4455                                 "%s: fw_id=%d exit at line=%d\n", ioc->name,
4456                                  __func__, hot_plug_info->id, __LINE__));
4457                         break;
4458                 }
4459
4460                 mpt_findImVolumes(ioc);
4461
4462                 starget_printk(KERN_INFO, starget, MYIOC_s_FMT "RAID Hidding: "
4463                     "fw_channel=%d, fw_id=%d, physdsk %d, sas_addr 0x%llx\n",
4464                     ioc->name, hot_plug_info->channel, hot_plug_info->id,
4465                     hot_plug_info->phys_disk_num, (unsigned long long)
4466                     sas_device.sas_address);
4467
4468                 vtarget->id = hot_plug_info->phys_disk_num;
4469                 vtarget->tflags |= MPT_TARGET_FLAGS_RAID_COMPONENT;
4470                 phy_info->attached.phys_disk_num = hot_plug_info->phys_disk_num;
4471                 mptsas_reprobe_target(starget, 1);
4472                 break;
4473
4474         case MPTSAS_DEL_PHYSDISK_REPROBE:
4475
4476                 if (mptsas_sas_device_pg0(ioc, &sas_device,
4477                     (MPI_SAS_DEVICE_PGAD_FORM_BUS_TARGET_ID <<
4478                      MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
4479                         (hot_plug_info->channel << 8) + hot_plug_info->id)) {
4480                                 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4481                                     "%s: fw_id=%d exit at line=%d\n",
4482                                     ioc->name, __func__,
4483                                     hot_plug_info->id, __LINE__));
4484                         break;
4485                 }
4486
4487                 /* If there is no FW B_T mapping for this device then break
4488                  * */
4489                 if (!(sas_device.flags & MPI_SAS_DEVICE0_FLAGS_DEVICE_PRESENT)
4490                         || !(sas_device.flags &
4491                         MPI_SAS_DEVICE0_FLAGS_DEVICE_MAPPED))
4492                         break;
4493
4494                 phy_info = mptsas_find_phyinfo_by_sas_address(ioc,
4495                                 sas_device.sas_address);
4496                 if (!phy_info) {
4497                         dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4498                             "%s: fw_id=%d exit at line=%d\n", ioc->name,
4499                          __func__, hot_plug_info->id, __LINE__));
4500                         break;
4501                 }
4502
4503                 starget = mptsas_get_starget(phy_info);
4504                 if (!starget) {
4505                         dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4506                             "%s: fw_id=%d exit at line=%d\n", ioc->name,
4507                          __func__, hot_plug_info->id, __LINE__));
4508                         break;
4509                 }
4510
4511                 vtarget = starget->hostdata;
4512                 if (!vtarget) {
4513                         dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4514                             "%s: fw_id=%d exit at line=%d\n", ioc->name,
4515                          __func__, hot_plug_info->id, __LINE__));
4516                         break;
4517                 }
4518
4519                 if (!(vtarget->tflags & MPT_TARGET_FLAGS_RAID_COMPONENT)) {
4520                         dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4521                             "%s: fw_id=%d exit at line=%d\n", ioc->name,
4522                          __func__, hot_plug_info->id, __LINE__));
4523                         break;
4524                 }
4525
4526                 mpt_findImVolumes(ioc);
4527
4528                 starget_printk(KERN_INFO, starget, MYIOC_s_FMT "RAID Exposing:"
4529                     " fw_channel=%d, fw_id=%d, physdsk %d, sas_addr 0x%llx\n",
4530                     ioc->name, hot_plug_info->channel, hot_plug_info->id,
4531                     hot_plug_info->phys_disk_num, (unsigned long long)
4532                     sas_device.sas_address);
4533
4534                 vtarget->tflags &= ~MPT_TARGET_FLAGS_RAID_COMPONENT;
4535                 vtarget->id = hot_plug_info->id;
4536                 phy_info->attached.phys_disk_num = ~0;
4537                 mptsas_reprobe_target(starget, 0);
4538                 mptsas_add_device_component_by_fw(ioc,
4539                     hot_plug_info->channel, hot_plug_info->id);
4540                 break;
4541
4542         case MPTSAS_ADD_RAID:
4543
4544                 mpt_findImVolumes(ioc);
4545                 printk(MYIOC_s_INFO_FMT "attaching raid volume, channel %d, "
4546                     "id %d\n", ioc->name, MPTSAS_RAID_CHANNEL,
4547                     hot_plug_info->id);
4548                 scsi_add_device(ioc->sh, MPTSAS_RAID_CHANNEL,
4549                     hot_plug_info->id, 0);
4550                 break;
4551
4552         case MPTSAS_DEL_RAID:
4553
4554                 mpt_findImVolumes(ioc);
4555                 printk(MYIOC_s_INFO_FMT "removing raid volume, channel %d, "
4556                     "id %d\n", ioc->name, MPTSAS_RAID_CHANNEL,
4557                     hot_plug_info->id);
4558                 scsi_remove_device(hot_plug_info->sdev);
4559                 scsi_device_put(hot_plug_info->sdev);
4560                 break;
4561
4562         case MPTSAS_ADD_INACTIVE_VOLUME:
4563
4564                 mpt_findImVolumes(ioc);
4565                 mptsas_adding_inactive_raid_components(ioc,
4566                     hot_plug_info->channel, hot_plug_info->id);
4567                 break;
4568
4569         default:
4570                 break;
4571         }
4572
4573         mptsas_free_fw_event(ioc, fw_event);
4574 }
4575
4576 static void
4577 mptsas_send_sas_event(struct fw_event_work *fw_event)
4578 {
4579         MPT_ADAPTER *ioc;
4580         struct mptsas_hotplug_event hot_plug_info;
4581         EVENT_DATA_SAS_DEVICE_STATUS_CHANGE *sas_event_data;
4582         u32 device_info;
4583         u64 sas_address;
4584
4585         ioc = fw_event->ioc;
4586         sas_event_data = (EVENT_DATA_SAS_DEVICE_STATUS_CHANGE *)
4587             fw_event->event_data;
4588         device_info = le32_to_cpu(sas_event_data->DeviceInfo);
4589
4590         if ((device_info &
4591                 (MPI_SAS_DEVICE_INFO_SSP_TARGET |
4592                 MPI_SAS_DEVICE_INFO_STP_TARGET |
4593                 MPI_SAS_DEVICE_INFO_SATA_DEVICE)) == 0) {
4594                 mptsas_free_fw_event(ioc, fw_event);
4595                 return;
4596         }
4597
4598         if (sas_event_data->ReasonCode ==
4599                 MPI_EVENT_SAS_DEV_STAT_RC_NO_PERSIST_ADDED) {
4600                 mptbase_sas_persist_operation(ioc,
4601                 MPI_SAS_OP_CLEAR_NOT_PRESENT);
4602                 mptsas_free_fw_event(ioc, fw_event);
4603                 return;
4604         }
4605
4606         switch (sas_event_data->ReasonCode) {
4607         case MPI_EVENT_SAS_DEV_STAT_RC_NOT_RESPONDING:
4608         case MPI_EVENT_SAS_DEV_STAT_RC_ADDED:
4609                 memset(&hot_plug_info, 0, sizeof(struct mptsas_hotplug_event));
4610                 hot_plug_info.handle = le16_to_cpu(sas_event_data->DevHandle);
4611                 hot_plug_info.channel = sas_event_data->Bus;
4612                 hot_plug_info.id = sas_event_data->TargetID;
4613                 hot_plug_info.phy_id = sas_event_data->PhyNum;
4614                 memcpy(&sas_address, &sas_event_data->SASAddress,
4615                     sizeof(u64));
4616                 hot_plug_info.sas_address = le64_to_cpu(sas_address);
4617                 hot_plug_info.device_info = device_info;
4618                 if (sas_event_data->ReasonCode &
4619                     MPI_EVENT_SAS_DEV_STAT_RC_ADDED)
4620                         hot_plug_info.event_type = MPTSAS_ADD_DEVICE;
4621                 else
4622                         hot_plug_info.event_type = MPTSAS_DEL_DEVICE;
4623                 mptsas_hotplug_work(ioc, fw_event, &hot_plug_info);
4624                 break;
4625
4626         case MPI_EVENT_SAS_DEV_STAT_RC_NO_PERSIST_ADDED:
4627                 mptbase_sas_persist_operation(ioc,
4628                     MPI_SAS_OP_CLEAR_NOT_PRESENT);
4629                 mptsas_free_fw_event(ioc, fw_event);
4630                 break;
4631
4632         case MPI_EVENT_SAS_DEV_STAT_RC_SMART_DATA:
4633         /* TODO */
4634         case MPI_EVENT_SAS_DEV_STAT_RC_INTERNAL_DEVICE_RESET:
4635         /* TODO */
4636         default:
4637                 mptsas_free_fw_event(ioc, fw_event);
4638                 break;
4639         }
4640 }
4641
4642 static void
4643 mptsas_send_raid_event(struct fw_event_work *fw_event)
4644 {
4645         MPT_ADAPTER *ioc;
4646         EVENT_DATA_RAID *raid_event_data;
4647         struct mptsas_hotplug_event hot_plug_info;
4648         int status;
4649         int state;
4650         struct scsi_device *sdev = NULL;
4651         VirtDevice *vdevice = NULL;
4652         RaidPhysDiskPage0_t phys_disk;
4653
4654         ioc = fw_event->ioc;
4655         raid_event_data = (EVENT_DATA_RAID *)fw_event->event_data;
4656         status = le32_to_cpu(raid_event_data->SettingsStatus);
4657         state = (status >> 8) & 0xff;
4658
4659         memset(&hot_plug_info, 0, sizeof(struct mptsas_hotplug_event));
4660         hot_plug_info.id = raid_event_data->VolumeID;
4661         hot_plug_info.channel = raid_event_data->VolumeBus;
4662         hot_plug_info.phys_disk_num = raid_event_data->PhysDiskNum;
4663
4664         if (raid_event_data->ReasonCode == MPI_EVENT_RAID_RC_VOLUME_DELETED ||
4665             raid_event_data->ReasonCode == MPI_EVENT_RAID_RC_VOLUME_CREATED ||
4666             raid_event_data->ReasonCode ==
4667             MPI_EVENT_RAID_RC_VOLUME_STATUS_CHANGED) {
4668                 sdev = scsi_device_lookup(ioc->sh, MPTSAS_RAID_CHANNEL,
4669                     hot_plug_info.id, 0);
4670                 hot_plug_info.sdev = sdev;
4671                 if (sdev)
4672                         vdevice = sdev->hostdata;
4673         }
4674
4675         devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Entering %s: "
4676             "ReasonCode=%02x\n", ioc->name, __func__,
4677             raid_event_data->ReasonCode));
4678
4679         switch (raid_event_data->ReasonCode) {
4680         case MPI_EVENT_RAID_RC_PHYSDISK_DELETED:
4681                 hot_plug_info.event_type = MPTSAS_DEL_PHYSDISK_REPROBE;
4682                 break;
4683         case MPI_EVENT_RAID_RC_PHYSDISK_CREATED:
4684                 hot_plug_info.event_type = MPTSAS_ADD_PHYSDISK_REPROBE;
4685                 break;
4686         case MPI_EVENT_RAID_RC_PHYSDISK_STATUS_CHANGED:
4687                 switch (state) {
4688                 case MPI_PD_STATE_ONLINE:
4689                 case MPI_PD_STATE_NOT_COMPATIBLE:
4690                         mpt_raid_phys_disk_pg0(ioc,
4691                             raid_event_data->PhysDiskNum, &phys_disk);
4692                         hot_plug_info.id = phys_disk.PhysDiskID;
4693                         hot_plug_info.channel = phys_disk.PhysDiskBus;
4694                         hot_plug_info.event_type = MPTSAS_ADD_PHYSDISK;
4695                         break;
4696                 case MPI_PD_STATE_FAILED:
4697                 case MPI_PD_STATE_MISSING:
4698                 case MPI_PD_STATE_OFFLINE_AT_HOST_REQUEST:
4699                 case MPI_PD_STATE_FAILED_AT_HOST_REQUEST:
4700                 case MPI_PD_STATE_OFFLINE_FOR_ANOTHER_REASON:
4701                         hot_plug_info.event_type = MPTSAS_DEL_PHYSDISK;
4702                         break;
4703                 default:
4704                         break;
4705                 }
4706                 break;
4707         case MPI_EVENT_RAID_RC_VOLUME_DELETED:
4708                 if (!sdev)
4709                         break;
4710                 vdevice->vtarget->deleted = 1; /* block IO */
4711                 hot_plug_info.event_type = MPTSAS_DEL_RAID;
4712                 break;
4713         case MPI_EVENT_RAID_RC_VOLUME_CREATED:
4714                 if (sdev) {
4715                         scsi_device_put(sdev);
4716                         break;
4717                 }
4718                 hot_plug_info.event_type = MPTSAS_ADD_RAID;
4719                 break;
4720         case MPI_EVENT_RAID_RC_VOLUME_STATUS_CHANGED:
4721                 if (!(status & MPI_RAIDVOL0_STATUS_FLAG_ENABLED)) {
4722                         if (!sdev)
4723                                 break;
4724                         vdevice->vtarget->deleted = 1; /* block IO */
4725                         hot_plug_info.event_type = MPTSAS_DEL_RAID;
4726                         break;
4727                 }
4728                 switch (state) {
4729                 case MPI_RAIDVOL0_STATUS_STATE_FAILED:
4730                 case MPI_RAIDVOL0_STATUS_STATE_MISSING:
4731                         if (!sdev)
4732                                 break;
4733                         vdevice->vtarget->deleted = 1; /* block IO */
4734                         hot_plug_info.event_type = MPTSAS_DEL_RAID;
4735                         break;
4736                 case MPI_RAIDVOL0_STATUS_STATE_OPTIMAL:
4737                 case MPI_RAIDVOL0_STATUS_STATE_DEGRADED:
4738                         if (sdev) {
4739                                 scsi_device_put(sdev);
4740                                 break;
4741                         }
4742                         hot_plug_info.event_type = MPTSAS_ADD_RAID;
4743                         break;
4744                 default:
4745                         break;
4746                 }
4747                 break;
4748         default:
4749                 break;
4750         }
4751
4752         if (hot_plug_info.event_type != MPTSAS_IGNORE_EVENT)
4753                 mptsas_hotplug_work(ioc, fw_event, &hot_plug_info);
4754         else
4755                 mptsas_free_fw_event(ioc, fw_event);
4756 }
4757
4758 /**
4759  *      mptsas_issue_tm - send mptsas internal tm request
4760  *      @ioc: Pointer to MPT_ADAPTER structure
4761  *      @type: Task Management type
4762  *      @channel: channel number for task management
4763  *      @id: Logical Target ID for reset (if appropriate)
4764  *      @lun: Logical unit for reset (if appropriate)
4765  *      @task_context: Context for the task to be aborted
4766  *      @timeout: timeout for task management control
4767  *
4768  *      return 0 on success and -1 on failure:
4769  *
4770  */
4771 static int
4772 mptsas_issue_tm(MPT_ADAPTER *ioc, u8 type, u8 channel, u8 id, u64 lun,
4773         int task_context, ulong timeout, u8 *issue_reset)
4774 {
4775         MPT_FRAME_HDR   *mf;
4776         SCSITaskMgmt_t  *pScsiTm;
4777         int              retval;
4778         unsigned long    timeleft;
4779
4780         *issue_reset = 0;
4781         mf = mpt_get_msg_frame(mptsasDeviceResetCtx, ioc);
4782         if (mf == NULL) {
4783                 retval = -1; /* return failure */
4784                 dtmprintk(ioc, printk(MYIOC_s_WARN_FMT "TaskMgmt request: no "
4785                     "msg frames!!\n", ioc->name));
4786                 goto out;
4787         }
4788
4789         dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT "TaskMgmt request: mr = %p, "
4790             "task_type = 0x%02X,\n\t timeout = %ld, fw_channel = %d, "
4791             "fw_id = %d, lun = %lld,\n\t task_context = 0x%x\n", ioc->name, mf,
4792              type, timeout, channel, id, (unsigned long long)lun,
4793              task_context));
4794
4795         pScsiTm = (SCSITaskMgmt_t *) mf;
4796         memset(pScsiTm, 0, sizeof(SCSITaskMgmt_t));
4797         pScsiTm->Function = MPI_FUNCTION_SCSI_TASK_MGMT;
4798         pScsiTm->TaskType = type;
4799         pScsiTm->MsgFlags = 0;
4800         pScsiTm->TargetID = id;
4801         pScsiTm->Bus = channel;
4802         pScsiTm->ChainOffset = 0;
4803         pScsiTm->Reserved = 0;
4804         pScsiTm->Reserved1 = 0;
4805         pScsiTm->TaskMsgContext = task_context;
4806         int_to_scsilun(lun, (struct scsi_lun *)pScsiTm->LUN);
4807
4808         INITIALIZE_MGMT_STATUS(ioc->taskmgmt_cmds.status)
4809         CLEAR_MGMT_STATUS(ioc->internal_cmds.status)
4810         retval = 0;
4811         mpt_put_msg_frame_hi_pri(mptsasDeviceResetCtx, ioc, mf);
4812
4813         /* Now wait for the command to complete */
4814         timeleft = wait_for_completion_timeout(&ioc->taskmgmt_cmds.done,
4815             timeout*HZ);
4816         if (!(ioc->taskmgmt_cmds.status & MPT_MGMT_STATUS_COMMAND_GOOD)) {
4817                 retval = -1; /* return failure */
4818                 dtmprintk(ioc, printk(MYIOC_s_ERR_FMT
4819                     "TaskMgmt request: TIMED OUT!(mr=%p)\n", ioc->name, mf));
4820                 mpt_free_msg_frame(ioc, mf);
4821                 if (ioc->taskmgmt_cmds.status & MPT_MGMT_STATUS_DID_IOCRESET)
4822                         goto out;
4823                 *issue_reset = 1;
4824                 goto out;
4825         }
4826
4827         if (!(ioc->taskmgmt_cmds.status & MPT_MGMT_STATUS_RF_VALID)) {
4828                 retval = -1; /* return failure */
4829                 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
4830                     "TaskMgmt request: failed with no reply\n", ioc->name));
4831                 goto out;
4832         }
4833
4834  out:
4835         CLEAR_MGMT_STATUS(ioc->taskmgmt_cmds.status)
4836         return retval;
4837 }
4838
4839 /**
4840  *      mptsas_broadcast_primative_work - Handle broadcast primitives
4841  *      @work: work queue payload containing info describing the event
4842  *
4843  *      this will be handled in workqueue context.
4844  */
4845 static void
4846 mptsas_broadcast_primative_work(struct fw_event_work *fw_event)
4847 {
4848         MPT_ADAPTER *ioc = fw_event->ioc;
4849         MPT_FRAME_HDR   *mf;
4850         VirtDevice      *vdevice;
4851         int                     ii;
4852         struct scsi_cmnd        *sc;
4853         SCSITaskMgmtReply_t     *pScsiTmReply;
4854         u8                      issue_reset;
4855         int                     task_context;
4856         u8                      channel, id;
4857         int                      lun;
4858         u32                      termination_count;
4859         u32                      query_count;
4860
4861         dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
4862             "%s - enter\n", ioc->name, __func__));
4863
4864         mutex_lock(&ioc->taskmgmt_cmds.mutex);
4865         if (mpt_set_taskmgmt_in_progress_flag(ioc) != 0) {
4866                 mutex_unlock(&ioc->taskmgmt_cmds.mutex);
4867                 mptsas_requeue_fw_event(ioc, fw_event, 1000);
4868                 return;
4869         }
4870
4871         issue_reset = 0;
4872         termination_count = 0;
4873         query_count = 0;
4874         mpt_findImVolumes(ioc);
4875         pScsiTmReply = (SCSITaskMgmtReply_t *) ioc->taskmgmt_cmds.reply;
4876
4877         for (ii = 0; ii < ioc->req_depth; ii++) {
4878                 if (ioc->fw_events_off)
4879                         goto out;
4880                 sc = mptscsih_get_scsi_lookup(ioc, ii);
4881                 if (!sc)
4882                         continue;
4883                 mf = MPT_INDEX_2_MFPTR(ioc, ii);
4884                 if (!mf)
4885                         continue;
4886                 task_context = mf->u.frame.hwhdr.msgctxu.MsgContext;
4887                 vdevice = sc->device->hostdata;
4888                 if (!vdevice || !vdevice->vtarget)
4889                         continue;
4890                 if (vdevice->vtarget->tflags & MPT_TARGET_FLAGS_RAID_COMPONENT)
4891                         continue; /* skip hidden raid components */
4892                 if (vdevice->vtarget->raidVolume)
4893                         continue; /* skip hidden raid components */
4894                 channel = vdevice->vtarget->channel;
4895                 id = vdevice->vtarget->id;
4896                 lun = vdevice->lun;
4897                 if (mptsas_issue_tm(ioc, MPI_SCSITASKMGMT_TASKTYPE_QUERY_TASK,
4898                     channel, id, (u64)lun, task_context, 30, &issue_reset))
4899                         goto out;
4900                 query_count++;
4901                 termination_count +=
4902                     le32_to_cpu(pScsiTmReply->TerminationCount);
4903                 if ((pScsiTmReply->IOCStatus == MPI_IOCSTATUS_SUCCESS) &&
4904                     (pScsiTmReply->ResponseCode ==
4905                     MPI_SCSITASKMGMT_RSP_TM_SUCCEEDED ||
4906                     pScsiTmReply->ResponseCode ==
4907                     MPI_SCSITASKMGMT_RSP_IO_QUEUED_ON_IOC))
4908                         continue;
4909                 if (mptsas_issue_tm(ioc,
4910                     MPI_SCSITASKMGMT_TASKTYPE_ABRT_TASK_SET,
4911                     channel, id, (u64)lun, 0, 30, &issue_reset))
4912                         goto out;
4913                 termination_count +=
4914                     le32_to_cpu(pScsiTmReply->TerminationCount);
4915         }
4916
4917  out:
4918         dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
4919             "%s - exit, query_count = %d termination_count = %d\n",
4920             ioc->name, __func__, query_count, termination_count));
4921
4922         ioc->broadcast_aen_busy = 0;
4923         mpt_clear_taskmgmt_in_progress_flag(ioc);
4924         mutex_unlock(&ioc->taskmgmt_cmds.mutex);
4925
4926         if (issue_reset) {
4927                 printk(MYIOC_s_WARN_FMT
4928                        "Issuing Reset from %s!! doorbell=0x%08x\n",
4929                        ioc->name, __func__, mpt_GetIocState(ioc, 0));
4930                 mpt_Soft_Hard_ResetHandler(ioc, CAN_SLEEP);
4931         }
4932         mptsas_free_fw_event(ioc, fw_event);
4933 }
4934
4935 /*
4936  * mptsas_send_ir2_event - handle exposing hidden disk when
4937  * an inactive raid volume is added
4938  *
4939  * @ioc: Pointer to MPT_ADAPTER structure
4940  * @ir2_data
4941  *
4942  */
4943 static void
4944 mptsas_send_ir2_event(struct fw_event_work *fw_event)
4945 {
4946         MPT_ADAPTER     *ioc;
4947         struct mptsas_hotplug_event hot_plug_info;
4948         MPI_EVENT_DATA_IR2      *ir2_data;
4949         u8 reasonCode;
4950         RaidPhysDiskPage0_t phys_disk;
4951
4952         ioc = fw_event->ioc;
4953         ir2_data = (MPI_EVENT_DATA_IR2 *)fw_event->event_data;
4954         reasonCode = ir2_data->ReasonCode;
4955
4956         devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Entering %s: "
4957             "ReasonCode=%02x\n", ioc->name, __func__, reasonCode));
4958
4959         memset(&hot_plug_info, 0, sizeof(struct mptsas_hotplug_event));
4960         hot_plug_info.id = ir2_data->TargetID;
4961         hot_plug_info.channel = ir2_data->Bus;
4962         switch (reasonCode) {
4963         case MPI_EVENT_IR2_RC_FOREIGN_CFG_DETECTED:
4964                 hot_plug_info.event_type = MPTSAS_ADD_INACTIVE_VOLUME;
4965                 break;
4966         case MPI_EVENT_IR2_RC_DUAL_PORT_REMOVED:
4967                 hot_plug_info.phys_disk_num = ir2_data->PhysDiskNum;
4968                 hot_plug_info.event_type = MPTSAS_DEL_PHYSDISK;
4969                 break;
4970         case MPI_EVENT_IR2_RC_DUAL_PORT_ADDED:
4971                 hot_plug_info.phys_disk_num = ir2_data->PhysDiskNum;
4972                 mpt_raid_phys_disk_pg0(ioc,
4973                     ir2_data->PhysDiskNum, &phys_disk);
4974                 hot_plug_info.id = phys_disk.PhysDiskID;
4975                 hot_plug_info.event_type = MPTSAS_ADD_PHYSDISK;
4976                 break;
4977         default:
4978                 mptsas_free_fw_event(ioc, fw_event);
4979                 return;
4980         }
4981         mptsas_hotplug_work(ioc, fw_event, &hot_plug_info);
4982 }
4983
4984 static int
4985 mptsas_event_process(MPT_ADAPTER *ioc, EventNotificationReply_t *reply)
4986 {
4987         u32 event = le32_to_cpu(reply->Event);
4988         int sz, event_data_sz;
4989         struct fw_event_work *fw_event;
4990         unsigned long delay;
4991
4992         if (ioc->bus_type != SAS)
4993                 return 0;
4994
4995         /* events turned off due to host reset or driver unloading */
4996         if (ioc->fw_events_off)
4997                 return 0;
4998
4999         delay = msecs_to_jiffies(1);
5000         switch (event) {
5001         case MPI_EVENT_SAS_BROADCAST_PRIMITIVE:
5002         {
5003                 EVENT_DATA_SAS_BROADCAST_PRIMITIVE *broadcast_event_data =
5004                     (EVENT_DATA_SAS_BROADCAST_PRIMITIVE *)reply->Data;
5005                 if (broadcast_event_data->Primitive !=
5006                     MPI_EVENT_PRIMITIVE_ASYNCHRONOUS_EVENT)
5007                         return 0;
5008                 if (ioc->broadcast_aen_busy)
5009                         return 0;
5010                 ioc->broadcast_aen_busy = 1;
5011                 break;
5012         }
5013         case MPI_EVENT_SAS_DEVICE_STATUS_CHANGE:
5014         {
5015                 EVENT_DATA_SAS_DEVICE_STATUS_CHANGE *sas_event_data =
5016                     (EVENT_DATA_SAS_DEVICE_STATUS_CHANGE *)reply->Data;
5017                 u16     ioc_stat;
5018                 ioc_stat = le16_to_cpu(reply->IOCStatus);
5019
5020                 if (sas_event_data->ReasonCode ==
5021                     MPI_EVENT_SAS_DEV_STAT_RC_NOT_RESPONDING) {
5022                         mptsas_target_reset_queue(ioc, sas_event_data);
5023                         return 0;
5024                 }
5025                 if (sas_event_data->ReasonCode ==
5026                         MPI_EVENT_SAS_DEV_STAT_RC_INTERNAL_DEVICE_RESET &&
5027                         ioc->device_missing_delay &&
5028                         (ioc_stat & MPI_IOCSTATUS_FLAG_LOG_INFO_AVAILABLE)) {
5029                         VirtTarget *vtarget = NULL;
5030                         u8              id, channel;
5031
5032                         id = sas_event_data->TargetID;
5033                         channel = sas_event_data->Bus;
5034
5035                         vtarget = mptsas_find_vtarget(ioc, channel, id);
5036                         if (vtarget) {
5037                                 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT
5038                                     "LogInfo (0x%x) available for "
5039                                    "INTERNAL_DEVICE_RESET"
5040                                    "fw_id %d fw_channel %d\n", ioc->name,
5041                                    le32_to_cpu(reply->IOCLogInfo),
5042                                    id, channel));
5043                                 if (vtarget->raidVolume) {
5044                                         devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT
5045                                         "Skipping Raid Volume for inDMD\n",
5046                                         ioc->name));
5047                                 } else {
5048                                         devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT
5049                                         "Setting device flag inDMD\n",
5050                                         ioc->name));
5051                                         vtarget->inDMD = 1;
5052                                 }
5053
5054                         }
5055
5056                 }
5057
5058                 break;
5059         }
5060         case MPI_EVENT_SAS_EXPANDER_STATUS_CHANGE:
5061         {
5062                 MpiEventDataSasExpanderStatusChange_t *expander_data =
5063                     (MpiEventDataSasExpanderStatusChange_t *)reply->Data;
5064
5065                 if (ioc->old_sas_discovery_protocal)
5066                         return 0;
5067
5068                 if (expander_data->ReasonCode ==
5069                     MPI_EVENT_SAS_EXP_RC_NOT_RESPONDING &&
5070                     ioc->device_missing_delay)
5071                         delay = HZ * ioc->device_missing_delay;
5072                 break;
5073         }
5074         case MPI_EVENT_SAS_DISCOVERY:
5075         {
5076                 u32 discovery_status;
5077                 EventDataSasDiscovery_t *discovery_data =
5078                     (EventDataSasDiscovery_t *)reply->Data;
5079
5080                 discovery_status = le32_to_cpu(discovery_data->DiscoveryStatus);
5081                 ioc->sas_discovery_quiesce_io = discovery_status ? 1 : 0;
5082                 if (ioc->old_sas_discovery_protocal && !discovery_status)
5083                         mptsas_queue_rescan(ioc);
5084                 return 0;
5085         }
5086         case MPI_EVENT_INTEGRATED_RAID:
5087         case MPI_EVENT_PERSISTENT_TABLE_FULL:
5088         case MPI_EVENT_IR2:
5089         case MPI_EVENT_SAS_PHY_LINK_STATUS:
5090         case MPI_EVENT_QUEUE_FULL:
5091                 break;
5092         default:
5093                 return 0;
5094         }
5095
5096         event_data_sz = ((reply->MsgLength * 4) -
5097             offsetof(EventNotificationReply_t, Data));
5098         sz = offsetof(struct fw_event_work, event_data) + event_data_sz;
5099         fw_event = kzalloc(sz, GFP_ATOMIC);
5100         if (!fw_event) {
5101                 printk(MYIOC_s_WARN_FMT "%s: failed at (line=%d)\n", ioc->name,
5102                  __func__, __LINE__);
5103                 return 0;
5104         }
5105         memcpy(fw_event->event_data, reply->Data, event_data_sz);
5106         fw_event->event = event;
5107         fw_event->ioc = ioc;
5108         mptsas_add_fw_event(ioc, fw_event, delay);
5109         return 0;
5110 }
5111
5112 /* Delete a volume when no longer listed in ioc pg2
5113  */
5114 static void mptsas_volume_delete(MPT_ADAPTER *ioc, u8 id)
5115 {
5116         struct scsi_device *sdev;
5117         int i;
5118
5119         sdev = scsi_device_lookup(ioc->sh, MPTSAS_RAID_CHANNEL, id, 0);
5120         if (!sdev)
5121                 return;
5122         if (!ioc->raid_data.pIocPg2)
5123                 goto out;
5124         if (!ioc->raid_data.pIocPg2->NumActiveVolumes)
5125                 goto out;
5126         for (i = 0; i < ioc->raid_data.pIocPg2->NumActiveVolumes; i++)
5127                 if (ioc->raid_data.pIocPg2->RaidVolume[i].VolumeID == id)
5128                         goto release_sdev;
5129  out:
5130         printk(MYIOC_s_INFO_FMT "removing raid volume, channel %d, "
5131             "id %d\n", ioc->name, MPTSAS_RAID_CHANNEL, id);
5132         scsi_remove_device(sdev);
5133  release_sdev:
5134         scsi_device_put(sdev);
5135 }
5136
5137 static int
5138 mptsas_probe(struct pci_dev *pdev, const struct pci_device_id *id)
5139 {
5140         struct Scsi_Host        *sh;
5141         MPT_SCSI_HOST           *hd;
5142         MPT_ADAPTER             *ioc;
5143         unsigned long            flags;
5144         int                      ii;
5145         int                      numSGE = 0;
5146         int                      scale;
5147         int                      ioc_cap;
5148         int                     error=0;
5149         int                     r;
5150
5151         r = mpt_attach(pdev,id);
5152         if (r)
5153                 return r;
5154
5155         ioc = pci_get_drvdata(pdev);
5156         mptsas_fw_event_off(ioc);
5157         ioc->DoneCtx = mptsasDoneCtx;
5158         ioc->TaskCtx = mptsasTaskCtx;
5159         ioc->InternalCtx = mptsasInternalCtx;
5160         ioc->schedule_target_reset = &mptsas_schedule_target_reset;
5161         ioc->schedule_dead_ioc_flush_running_cmds =
5162                                 &mptscsih_flush_running_cmds;
5163         /*  Added sanity check on readiness of the MPT adapter.
5164          */
5165         if (ioc->last_state != MPI_IOC_STATE_OPERATIONAL) {
5166                 printk(MYIOC_s_WARN_FMT
5167                   "Skipping because it's not operational!\n",
5168                   ioc->name);
5169                 error = -ENODEV;
5170                 goto out_mptsas_probe;
5171         }
5172
5173         if (!ioc->active) {
5174                 printk(MYIOC_s_WARN_FMT "Skipping because it's disabled!\n",
5175                   ioc->name);
5176                 error = -ENODEV;
5177                 goto out_mptsas_probe;
5178         }
5179
5180         /*  Sanity check - ensure at least 1 port is INITIATOR capable
5181          */
5182         ioc_cap = 0;
5183         for (ii = 0; ii < ioc->facts.NumberOfPorts; ii++) {
5184                 if (ioc->pfacts[ii].ProtocolFlags &
5185                                 MPI_PORTFACTS_PROTOCOL_INITIATOR)
5186                         ioc_cap++;
5187         }
5188
5189         if (!ioc_cap) {
5190                 printk(MYIOC_s_WARN_FMT
5191                         "Skipping ioc=%p because SCSI Initiator mode "
5192                         "is NOT enabled!\n", ioc->name, ioc);
5193                 return 0;
5194         }
5195
5196         sh = scsi_host_alloc(&mptsas_driver_template, sizeof(MPT_SCSI_HOST));
5197         if (!sh) {
5198                 printk(MYIOC_s_WARN_FMT
5199                         "Unable to register controller with SCSI subsystem\n",
5200                         ioc->name);
5201                 error = -1;
5202                 goto out_mptsas_probe;
5203         }
5204
5205         spin_lock_irqsave(&ioc->FreeQlock, flags);
5206
5207         /* Attach the SCSI Host to the IOC structure
5208          */
5209         ioc->sh = sh;
5210
5211         sh->io_port = 0;
5212         sh->n_io_port = 0;
5213         sh->irq = 0;
5214
5215         /* set 16 byte cdb's */
5216         sh->max_cmd_len = 16;
5217         sh->can_queue = min_t(int, ioc->req_depth - 10, sh->can_queue);
5218         sh->max_id = -1;
5219         sh->max_lun = max_lun;
5220         sh->transportt = mptsas_transport_template;
5221
5222         /* Required entry.
5223          */
5224         sh->unique_id = ioc->id;
5225
5226         INIT_LIST_HEAD(&ioc->sas_topology);
5227         mutex_init(&ioc->sas_topology_mutex);
5228         mutex_init(&ioc->sas_discovery_mutex);
5229         mutex_init(&ioc->sas_mgmt.mutex);
5230         init_completion(&ioc->sas_mgmt.done);
5231
5232         /* Verify that we won't exceed the maximum
5233          * number of chain buffers
5234          * We can optimize:  ZZ = req_sz/sizeof(SGE)
5235          * For 32bit SGE's:
5236          *  numSGE = 1 + (ZZ-1)*(maxChain -1) + ZZ
5237          *               + (req_sz - 64)/sizeof(SGE)
5238          * A slightly different algorithm is required for
5239          * 64bit SGEs.
5240          */
5241         scale = ioc->req_sz/ioc->SGE_size;
5242         if (ioc->sg_addr_size == sizeof(u64)) {
5243                 numSGE = (scale - 1) *
5244                   (ioc->facts.MaxChainDepth-1) + scale +
5245                   (ioc->req_sz - 60) / ioc->SGE_size;
5246         } else {
5247                 numSGE = 1 + (scale - 1) *
5248                   (ioc->facts.MaxChainDepth-1) + scale +
5249                   (ioc->req_sz - 64) / ioc->SGE_size;
5250         }
5251
5252         if (numSGE < sh->sg_tablesize) {
5253                 /* Reset this value */
5254                 dprintk(ioc, printk(MYIOC_s_DEBUG_FMT
5255                   "Resetting sg_tablesize to %d from %d\n",
5256                   ioc->name, numSGE, sh->sg_tablesize));
5257                 sh->sg_tablesize = numSGE;
5258         }
5259
5260         if (mpt_loadtime_max_sectors) {
5261                 if (mpt_loadtime_max_sectors < 64 ||
5262                         mpt_loadtime_max_sectors > 8192) {
5263                         printk(MYIOC_s_INFO_FMT "Invalid value passed for"
5264                                 "mpt_loadtime_max_sectors %d."
5265                                 "Range from 64 to 8192\n", ioc->name,
5266                                 mpt_loadtime_max_sectors);
5267                 }
5268                 mpt_loadtime_max_sectors &=  0xFFFFFFFE;
5269                 dprintk(ioc, printk(MYIOC_s_DEBUG_FMT
5270                         "Resetting max sector to %d from %d\n",
5271                   ioc->name, mpt_loadtime_max_sectors, sh->max_sectors));
5272                 sh->max_sectors = mpt_loadtime_max_sectors;
5273         }
5274
5275         hd = shost_priv(sh);
5276         hd->ioc = ioc;
5277
5278         /* SCSI needs scsi_cmnd lookup table!
5279          * (with size equal to req_depth*PtrSz!)
5280          */
5281         ioc->ScsiLookup = kcalloc(ioc->req_depth, sizeof(void *), GFP_ATOMIC);
5282         if (!ioc->ScsiLookup) {
5283                 error = -ENOMEM;
5284                 spin_unlock_irqrestore(&ioc->FreeQlock, flags);
5285                 goto out_mptsas_probe;
5286         }
5287         spin_lock_init(&ioc->scsi_lookup_lock);
5288
5289         dprintk(ioc, printk(MYIOC_s_DEBUG_FMT "ScsiLookup @ %p\n",
5290                  ioc->name, ioc->ScsiLookup));
5291
5292         ioc->sas_data.ptClear = mpt_pt_clear;
5293
5294         hd->last_queue_full = 0;
5295         INIT_LIST_HEAD(&hd->target_reset_list);
5296         INIT_LIST_HEAD(&ioc->sas_device_info_list);
5297         mutex_init(&ioc->sas_device_info_mutex);
5298
5299         spin_unlock_irqrestore(&ioc->FreeQlock, flags);
5300
5301         if (ioc->sas_data.ptClear==1) {
5302                 mptbase_sas_persist_operation(
5303                     ioc, MPI_SAS_OP_CLEAR_ALL_PERSISTENT);
5304         }
5305
5306         error = scsi_add_host(sh, &ioc->pcidev->dev);
5307         if (error) {
5308                 dprintk(ioc, printk(MYIOC_s_ERR_FMT
5309                   "scsi_add_host failed\n", ioc->name));
5310                 goto out_mptsas_probe;
5311         }
5312
5313         /* older firmware doesn't support expander events */
5314         if ((ioc->facts.HeaderVersion >> 8) < 0xE)
5315                 ioc->old_sas_discovery_protocal = 1;
5316         mptsas_scan_sas_topology(ioc);
5317         mptsas_fw_event_on(ioc);
5318         return 0;
5319
5320  out_mptsas_probe:
5321
5322         mptscsih_remove(pdev);
5323         return error;
5324 }
5325
5326 void
5327 mptsas_shutdown(struct pci_dev *pdev)
5328 {
5329         MPT_ADAPTER *ioc = pci_get_drvdata(pdev);
5330
5331         mptsas_fw_event_off(ioc);
5332         mptsas_cleanup_fw_event_q(ioc);
5333 }
5334
5335 static void mptsas_remove(struct pci_dev *pdev)
5336 {
5337         MPT_ADAPTER *ioc = pci_get_drvdata(pdev);
5338         struct mptsas_portinfo *p, *n;
5339         int i;
5340
5341         if (!ioc->sh) {
5342                 printk(MYIOC_s_INFO_FMT "IOC is in Target mode\n", ioc->name);
5343                 mpt_detach(pdev);
5344                 return;
5345         }
5346
5347         mptsas_shutdown(pdev);
5348
5349         mptsas_del_device_components(ioc);
5350
5351         ioc->sas_discovery_ignore_events = 1;
5352         sas_remove_host(ioc->sh);
5353
5354         mutex_lock(&ioc->sas_topology_mutex);
5355         list_for_each_entry_safe(p, n, &ioc->sas_topology, list) {
5356                 list_del(&p->list);
5357                 for (i = 0 ; i < p->num_phys ; i++)
5358                         mptsas_port_delete(ioc, p->phy_info[i].port_details);
5359
5360                 kfree(p->phy_info);
5361                 kfree(p);
5362         }
5363         mutex_unlock(&ioc->sas_topology_mutex);
5364         ioc->hba_port_info = NULL;
5365         mptscsih_remove(pdev);
5366 }
5367
5368 static struct pci_device_id mptsas_pci_table[] = {
5369         { PCI_VENDOR_ID_LSI_LOGIC, MPI_MANUFACTPAGE_DEVID_SAS1064,
5370                 PCI_ANY_ID, PCI_ANY_ID },
5371         { PCI_VENDOR_ID_LSI_LOGIC, MPI_MANUFACTPAGE_DEVID_SAS1068,
5372                 PCI_ANY_ID, PCI_ANY_ID },
5373         { PCI_VENDOR_ID_LSI_LOGIC, MPI_MANUFACTPAGE_DEVID_SAS1064E,
5374                 PCI_ANY_ID, PCI_ANY_ID },
5375         { PCI_VENDOR_ID_LSI_LOGIC, MPI_MANUFACTPAGE_DEVID_SAS1068E,
5376                 PCI_ANY_ID, PCI_ANY_ID },
5377         { PCI_VENDOR_ID_LSI_LOGIC, MPI_MANUFACTPAGE_DEVID_SAS1078,
5378                 PCI_ANY_ID, PCI_ANY_ID },
5379         { PCI_VENDOR_ID_LSI_LOGIC, MPI_MANUFACTPAGE_DEVID_SAS1068_820XELP,
5380                 PCI_ANY_ID, PCI_ANY_ID },
5381         {0}     /* Terminating entry */
5382 };
5383 MODULE_DEVICE_TABLE(pci, mptsas_pci_table);
5384
5385
5386 static struct pci_driver mptsas_driver = {
5387         .name           = "mptsas",
5388         .id_table       = mptsas_pci_table,
5389         .probe          = mptsas_probe,
5390         .remove         = mptsas_remove,
5391         .shutdown       = mptsas_shutdown,
5392 #ifdef CONFIG_PM
5393         .suspend        = mptscsih_suspend,
5394         .resume         = mptscsih_resume,
5395 #endif
5396 };
5397
5398 static int __init
5399 mptsas_init(void)
5400 {
5401         int error;
5402
5403         show_mptmod_ver(my_NAME, my_VERSION);
5404
5405         mptsas_transport_template =
5406             sas_attach_transport(&mptsas_transport_functions);
5407         if (!mptsas_transport_template)
5408                 return -ENODEV;
5409         mptsas_transport_template->eh_timed_out = mptsas_eh_timed_out;
5410
5411         mptsasDoneCtx = mpt_register(mptscsih_io_done, MPTSAS_DRIVER,
5412             "mptscsih_io_done");
5413         mptsasTaskCtx = mpt_register(mptscsih_taskmgmt_complete, MPTSAS_DRIVER,
5414             "mptscsih_taskmgmt_complete");
5415         mptsasInternalCtx =
5416                 mpt_register(mptscsih_scandv_complete, MPTSAS_DRIVER,
5417                     "mptscsih_scandv_complete");
5418         mptsasMgmtCtx = mpt_register(mptsas_mgmt_done, MPTSAS_DRIVER,
5419             "mptsas_mgmt_done");
5420         mptsasDeviceResetCtx =
5421                 mpt_register(mptsas_taskmgmt_complete, MPTSAS_DRIVER,
5422                     "mptsas_taskmgmt_complete");
5423
5424         mpt_event_register(mptsasDoneCtx, mptsas_event_process);
5425         mpt_reset_register(mptsasDoneCtx, mptsas_ioc_reset);
5426
5427         error = pci_register_driver(&mptsas_driver);
5428         if (error)
5429                 sas_release_transport(mptsas_transport_template);
5430
5431         return error;
5432 }
5433
5434 static void __exit
5435 mptsas_exit(void)
5436 {
5437         pci_unregister_driver(&mptsas_driver);
5438         sas_release_transport(mptsas_transport_template);
5439
5440         mpt_reset_deregister(mptsasDoneCtx);
5441         mpt_event_deregister(mptsasDoneCtx);
5442
5443         mpt_deregister(mptsasMgmtCtx);
5444         mpt_deregister(mptsasInternalCtx);
5445         mpt_deregister(mptsasTaskCtx);
5446         mpt_deregister(mptsasDoneCtx);
5447         mpt_deregister(mptsasDeviceResetCtx);
5448 }
5449
5450 module_init(mptsas_init);
5451 module_exit(mptsas_exit);