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