1 /*- 2 * Copyright (c) 2011-2015 LSI Corp. 3 * Copyright (c) 2013-2016 Avago Technologies 4 * All rights reserved. 5 * 6 * Redistribution and use in source and binary forms, with or without 7 * modification, are permitted provided that the following conditions 8 * are met: 9 * 1. Redistributions of source code must retain the above copyright 10 * notice, this list of conditions and the following disclaimer. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 16 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 17 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 18 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 19 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 20 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 21 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 22 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 23 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 24 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 25 * SUCH DAMAGE. 26 * 27 * Avago Technologies (LSI) MPT-Fusion Host Adapter FreeBSD 28 */ 29 30 #include <sys/cdefs.h> 31 __FBSDID("$FreeBSD$"); 32 33 /* TODO Move headers to mprvar */ 34 #include <sys/types.h> 35 #include <sys/param.h> 36 #include <sys/lock.h> 37 #include <sys/mutex.h> 38 #include <sys/systm.h> 39 #include <sys/kernel.h> 40 #include <sys/malloc.h> 41 #include <sys/kthread.h> 42 #include <sys/taskqueue.h> 43 #include <sys/bus.h> 44 #include <sys/endian.h> 45 #include <sys/sysctl.h> 46 #include <sys/eventhandler.h> 47 #include <sys/uio.h> 48 #include <machine/bus.h> 49 #include <machine/resource.h> 50 #include <dev/mpr/mpi/mpi2_type.h> 51 #include <dev/mpr/mpi/mpi2.h> 52 #include <dev/mpr/mpi/mpi2_ioc.h> 53 #include <dev/mpr/mpi/mpi2_sas.h> 54 #include <dev/mpr/mpi/mpi2_pci.h> 55 #include <dev/mpr/mpi/mpi2_cnfg.h> 56 #include <dev/mpr/mpi/mpi2_init.h> 57 #include <dev/mpr/mpi/mpi2_tool.h> 58 #include <dev/mpr/mpr_ioctl.h> 59 #include <dev/mpr/mprvar.h> 60 #include <dev/mpr/mpr_mapping.h> 61 62 /** 63 * _mapping_clear_entry - Clear a particular mapping entry. 64 * @map_entry: map table entry 65 * 66 * Returns nothing. 67 */ 68 static inline void 69 _mapping_clear_map_entry(struct dev_mapping_table *map_entry) 70 { 71 map_entry->physical_id = 0; 72 map_entry->device_info = 0; 73 map_entry->phy_bits = 0; 74 map_entry->dpm_entry_num = MPR_DPM_BAD_IDX; 75 map_entry->dev_handle = 0; 76 map_entry->channel = -1; 77 map_entry->id = -1; 78 map_entry->missing_count = 0; 79 map_entry->init_complete = 0; 80 map_entry->TLR_bits = (u8)MPI2_SCSIIO_CONTROL_NO_TLR; 81 } 82 83 /** 84 * _mapping_clear_enc_entry - Clear a particular enclosure table entry. 85 * @enc_entry: enclosure table entry 86 * 87 * Returns nothing. 88 */ 89 static inline void 90 _mapping_clear_enc_entry(struct enc_mapping_table *enc_entry) 91 { 92 enc_entry->enclosure_id = 0; 93 enc_entry->start_index = MPR_MAPTABLE_BAD_IDX; 94 enc_entry->phy_bits = 0; 95 enc_entry->dpm_entry_num = MPR_DPM_BAD_IDX; 96 enc_entry->enc_handle = 0; 97 enc_entry->num_slots = 0; 98 enc_entry->start_slot = 0; 99 enc_entry->missing_count = 0; 100 enc_entry->removal_flag = 0; 101 enc_entry->skip_search = 0; 102 enc_entry->init_complete = 0; 103 } 104 105 /** 106 * _mapping_commit_enc_entry - write a particular enc entry in DPM page0. 107 * @sc: per adapter object 108 * @enc_entry: enclosure table entry 109 * 110 * Returns 0 for success, non-zero for failure. 111 */ 112 static int 113 _mapping_commit_enc_entry(struct mpr_softc *sc, 114 struct enc_mapping_table *et_entry) 115 { 116 Mpi2DriverMap0Entry_t *dpm_entry; 117 struct dev_mapping_table *mt_entry; 118 Mpi2ConfigReply_t mpi_reply; 119 Mpi2DriverMappingPage0_t config_page; 120 121 if (!sc->is_dpm_enable) 122 return 0; 123 124 memset(&config_page, 0, sizeof(Mpi2DriverMappingPage0_t)); 125 memcpy(&config_page.Header, (u8 *) sc->dpm_pg0, 126 sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER)); 127 dpm_entry = (Mpi2DriverMap0Entry_t *)((u8 *)sc->dpm_pg0 + 128 sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER)); 129 dpm_entry += et_entry->dpm_entry_num; 130 dpm_entry->PhysicalIdentifier.Low = 131 ( 0xFFFFFFFF & et_entry->enclosure_id); 132 dpm_entry->PhysicalIdentifier.High = 133 ( et_entry->enclosure_id >> 32); 134 mt_entry = &sc->mapping_table[et_entry->start_index]; 135 dpm_entry->DeviceIndex = htole16(mt_entry->id); 136 dpm_entry->MappingInformation = et_entry->num_slots; 137 dpm_entry->MappingInformation <<= MPI2_DRVMAP0_MAPINFO_SLOT_SHIFT; 138 dpm_entry->MappingInformation |= et_entry->missing_count; 139 dpm_entry->MappingInformation = htole16(dpm_entry->MappingInformation); 140 dpm_entry->PhysicalBitsMapping = htole32(et_entry->phy_bits); 141 dpm_entry->Reserved1 = 0; 142 143 memcpy(&config_page.Entry, (u8 *)dpm_entry, 144 sizeof(Mpi2DriverMap0Entry_t)); 145 if (mpr_config_set_dpm_pg0(sc, &mpi_reply, &config_page, 146 et_entry->dpm_entry_num)) { 147 printf("%s: write of dpm entry %d for enclosure failed\n", 148 __func__, et_entry->dpm_entry_num); 149 dpm_entry->MappingInformation = le16toh(dpm_entry-> 150 MappingInformation); 151 dpm_entry->DeviceIndex = le16toh(dpm_entry->DeviceIndex); 152 dpm_entry->PhysicalBitsMapping = 153 le32toh(dpm_entry->PhysicalBitsMapping); 154 return -1; 155 } 156 dpm_entry->MappingInformation = le16toh(dpm_entry-> 157 MappingInformation); 158 dpm_entry->DeviceIndex = le16toh(dpm_entry->DeviceIndex); 159 dpm_entry->PhysicalBitsMapping = 160 le32toh(dpm_entry->PhysicalBitsMapping); 161 return 0; 162 } 163 164 /** 165 * _mapping_commit_map_entry - write a particular map table entry in DPM page0. 166 * @sc: per adapter object 167 * @enc_entry: enclosure table entry 168 * 169 * Returns 0 for success, non-zero for failure. 170 */ 171 172 static int 173 _mapping_commit_map_entry(struct mpr_softc *sc, 174 struct dev_mapping_table *mt_entry) 175 { 176 Mpi2DriverMap0Entry_t *dpm_entry; 177 Mpi2ConfigReply_t mpi_reply; 178 Mpi2DriverMappingPage0_t config_page; 179 180 if (!sc->is_dpm_enable) 181 return 0; 182 183 memset(&config_page, 0, sizeof(Mpi2DriverMappingPage0_t)); 184 memcpy(&config_page.Header, (u8 *)sc->dpm_pg0, 185 sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER)); 186 dpm_entry = (Mpi2DriverMap0Entry_t *)((u8 *) sc->dpm_pg0 + 187 sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER)); 188 dpm_entry = dpm_entry + mt_entry->dpm_entry_num; 189 dpm_entry->PhysicalIdentifier.Low = (0xFFFFFFFF & 190 mt_entry->physical_id); 191 dpm_entry->PhysicalIdentifier.High = (mt_entry->physical_id >> 32); 192 dpm_entry->DeviceIndex = htole16(mt_entry->id); 193 dpm_entry->MappingInformation = htole16(mt_entry->missing_count); 194 dpm_entry->PhysicalBitsMapping = 0; 195 dpm_entry->Reserved1 = 0; 196 dpm_entry->MappingInformation = htole16(dpm_entry->MappingInformation); 197 memcpy(&config_page.Entry, (u8 *)dpm_entry, 198 sizeof(Mpi2DriverMap0Entry_t)); 199 if (mpr_config_set_dpm_pg0(sc, &mpi_reply, &config_page, 200 mt_entry->dpm_entry_num)) { 201 printf("%s: write of dpm entry %d for device failed\n", 202 __func__, mt_entry->dpm_entry_num); 203 dpm_entry->MappingInformation = le16toh(dpm_entry-> 204 MappingInformation); 205 dpm_entry->DeviceIndex = le16toh(dpm_entry->DeviceIndex); 206 return -1; 207 } 208 209 dpm_entry->MappingInformation = le16toh(dpm_entry->MappingInformation); 210 dpm_entry->DeviceIndex = le16toh(dpm_entry->DeviceIndex); 211 return 0; 212 } 213 214 /** 215 * _mapping_get_ir_maprange - get start and end index for IR map range. 216 * @sc: per adapter object 217 * @start_idx: place holder for start index 218 * @end_idx: place holder for end index 219 * 220 * The IR volumes can be mapped either at start or end of the mapping table 221 * this function gets the detail of where IR volume mapping starts and ends 222 * in the device mapping table 223 * 224 * Returns nothing. 225 */ 226 static void 227 _mapping_get_ir_maprange(struct mpr_softc *sc, u32 *start_idx, u32 *end_idx) 228 { 229 u16 volume_mapping_flags; 230 u16 ioc_pg8_flags = le16toh(sc->ioc_pg8.Flags); 231 232 volume_mapping_flags = le16toh(sc->ioc_pg8.IRVolumeMappingFlags) & 233 MPI2_IOCPAGE8_IRFLAGS_MASK_VOLUME_MAPPING_MODE; 234 if (volume_mapping_flags == MPI2_IOCPAGE8_IRFLAGS_LOW_VOLUME_MAPPING) { 235 *start_idx = 0; 236 if (ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_RESERVED_TARGETID_0) 237 *start_idx = 1; 238 } else 239 *start_idx = sc->max_devices - sc->max_volumes; 240 *end_idx = *start_idx + sc->max_volumes - 1; 241 } 242 243 /** 244 * _mapping_get_enc_idx_from_id - get enclosure index from enclosure ID 245 * @sc: per adapter object 246 * @enc_id: enclosure logical identifier 247 * 248 * Returns the index of enclosure entry on success or bad index. 249 */ 250 static u8 251 _mapping_get_enc_idx_from_id(struct mpr_softc *sc, u64 enc_id, 252 u64 phy_bits) 253 { 254 struct enc_mapping_table *et_entry; 255 u8 enc_idx = 0; 256 257 for (enc_idx = 0; enc_idx < sc->num_enc_table_entries; enc_idx++) { 258 et_entry = &sc->enclosure_table[enc_idx]; 259 if ((et_entry->enclosure_id == le64toh(enc_id)) && 260 (!et_entry->phy_bits || (et_entry->phy_bits & 261 le32toh(phy_bits)))) 262 return enc_idx; 263 } 264 return MPR_ENCTABLE_BAD_IDX; 265 } 266 267 /** 268 * _mapping_get_enc_idx_from_handle - get enclosure index from handle 269 * @sc: per adapter object 270 * @enc_id: enclosure handle 271 * 272 * Returns the index of enclosure entry on success or bad index. 273 */ 274 static u8 275 _mapping_get_enc_idx_from_handle(struct mpr_softc *sc, u16 handle) 276 { 277 struct enc_mapping_table *et_entry; 278 u8 enc_idx = 0; 279 280 for (enc_idx = 0; enc_idx < sc->num_enc_table_entries; enc_idx++) { 281 et_entry = &sc->enclosure_table[enc_idx]; 282 if (et_entry->missing_count) 283 continue; 284 if (et_entry->enc_handle == handle) 285 return enc_idx; 286 } 287 return MPR_ENCTABLE_BAD_IDX; 288 } 289 290 /** 291 * _mapping_get_high_missing_et_idx - get missing enclosure index 292 * @sc: per adapter object 293 * 294 * Search through the enclosure table and identifies the enclosure entry 295 * with high missing count and returns it's index 296 * 297 * Returns the index of enclosure entry on success or bad index. 298 */ 299 static u8 300 _mapping_get_high_missing_et_idx(struct mpr_softc *sc) 301 { 302 struct enc_mapping_table *et_entry; 303 u8 high_missing_count = 0; 304 u8 enc_idx, high_idx = MPR_ENCTABLE_BAD_IDX; 305 306 for (enc_idx = 0; enc_idx < sc->num_enc_table_entries; enc_idx++) { 307 et_entry = &sc->enclosure_table[enc_idx]; 308 if ((et_entry->missing_count > high_missing_count) && 309 !et_entry->skip_search) { 310 high_missing_count = et_entry->missing_count; 311 high_idx = enc_idx; 312 } 313 } 314 return high_idx; 315 } 316 317 /** 318 * _mapping_get_high_missing_mt_idx - get missing map table index 319 * @sc: per adapter object 320 * 321 * Search through the map table and identifies the device entry 322 * with high missing count and returns it's index 323 * 324 * Returns the index of map table entry on success or bad index. 325 */ 326 static u32 327 _mapping_get_high_missing_mt_idx(struct mpr_softc *sc) 328 { 329 u32 map_idx, high_idx = MPR_ENCTABLE_BAD_IDX; 330 u8 high_missing_count = 0; 331 u32 start_idx, end_idx, start_idx_ir, end_idx_ir; 332 struct dev_mapping_table *mt_entry; 333 u16 ioc_pg8_flags = le16toh(sc->ioc_pg8.Flags); 334 335 start_idx = 0; 336 start_idx_ir = 0; 337 end_idx_ir = 0; 338 end_idx = sc->max_devices; 339 if (ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_RESERVED_TARGETID_0) 340 start_idx = 1; 341 if (sc->ir_firmware) { 342 _mapping_get_ir_maprange(sc, &start_idx_ir, &end_idx_ir); 343 if (start_idx == start_idx_ir) 344 start_idx = end_idx_ir + 1; 345 else 346 end_idx = start_idx_ir; 347 } 348 mt_entry = &sc->mapping_table[start_idx]; 349 for (map_idx = start_idx; map_idx < end_idx; map_idx++, mt_entry++) { 350 if (mt_entry->missing_count > high_missing_count) { 351 high_missing_count = mt_entry->missing_count; 352 high_idx = map_idx; 353 } 354 } 355 return high_idx; 356 } 357 358 /** 359 * _mapping_get_ir_mt_idx_from_wwid - get map table index from volume WWID 360 * @sc: per adapter object 361 * @wwid: world wide unique ID of the volume 362 * 363 * Returns the index of map table entry on success or bad index. 364 */ 365 static u32 366 _mapping_get_ir_mt_idx_from_wwid(struct mpr_softc *sc, u64 wwid) 367 { 368 u32 start_idx, end_idx, map_idx; 369 struct dev_mapping_table *mt_entry; 370 371 _mapping_get_ir_maprange(sc, &start_idx, &end_idx); 372 mt_entry = &sc->mapping_table[start_idx]; 373 for (map_idx = start_idx; map_idx <= end_idx; map_idx++, mt_entry++) 374 if (mt_entry->physical_id == wwid) 375 return map_idx; 376 377 return MPR_MAPTABLE_BAD_IDX; 378 } 379 380 /** 381 * _mapping_get_mt_idx_from_id - get map table index from a device ID 382 * @sc: per adapter object 383 * @dev_id: device identifer (SAS Address) 384 * 385 * Returns the index of map table entry on success or bad index. 386 */ 387 static u32 388 _mapping_get_mt_idx_from_id(struct mpr_softc *sc, u64 dev_id) 389 { 390 u32 map_idx; 391 struct dev_mapping_table *mt_entry; 392 393 for (map_idx = 0; map_idx < sc->max_devices; map_idx++) { 394 mt_entry = &sc->mapping_table[map_idx]; 395 if (mt_entry->physical_id == dev_id) 396 return map_idx; 397 } 398 return MPR_MAPTABLE_BAD_IDX; 399 } 400 401 /** 402 * _mapping_get_ir_mt_idx_from_handle - get map table index from volume handle 403 * @sc: per adapter object 404 * @wwid: volume device handle 405 * 406 * Returns the index of map table entry on success or bad index. 407 */ 408 static u32 409 _mapping_get_ir_mt_idx_from_handle(struct mpr_softc *sc, u16 volHandle) 410 { 411 u32 start_idx, end_idx, map_idx; 412 struct dev_mapping_table *mt_entry; 413 414 _mapping_get_ir_maprange(sc, &start_idx, &end_idx); 415 mt_entry = &sc->mapping_table[start_idx]; 416 for (map_idx = start_idx; map_idx <= end_idx; map_idx++, mt_entry++) 417 if (mt_entry->dev_handle == volHandle) 418 return map_idx; 419 420 return MPR_MAPTABLE_BAD_IDX; 421 } 422 423 /** 424 * _mapping_get_mt_idx_from_handle - get map table index from handle 425 * @sc: per adapter object 426 * @dev_id: device handle 427 * 428 * Returns the index of map table entry on success or bad index. 429 */ 430 static u32 431 _mapping_get_mt_idx_from_handle(struct mpr_softc *sc, u16 handle) 432 { 433 u32 map_idx; 434 struct dev_mapping_table *mt_entry; 435 436 for (map_idx = 0; map_idx < sc->max_devices; map_idx++) { 437 mt_entry = &sc->mapping_table[map_idx]; 438 if (mt_entry->dev_handle == handle) 439 return map_idx; 440 } 441 return MPR_MAPTABLE_BAD_IDX; 442 } 443 444 /** 445 * _mapping_get_free_ir_mt_idx - get first free index for a volume 446 * @sc: per adapter object 447 * 448 * Search through mapping table for free index for a volume and if no free 449 * index then looks for a volume with high mapping index 450 * 451 * Returns the index of map table entry on success or bad index. 452 */ 453 static u32 454 _mapping_get_free_ir_mt_idx(struct mpr_softc *sc) 455 { 456 u8 high_missing_count = 0; 457 u32 start_idx, end_idx, map_idx; 458 u32 high_idx = MPR_MAPTABLE_BAD_IDX; 459 struct dev_mapping_table *mt_entry; 460 461 _mapping_get_ir_maprange(sc, &start_idx, &end_idx); 462 463 mt_entry = &sc->mapping_table[start_idx]; 464 for (map_idx = start_idx; map_idx <= end_idx; map_idx++, mt_entry++) 465 if (!(mt_entry->device_info & MPR_MAP_IN_USE)) 466 return map_idx; 467 468 mt_entry = &sc->mapping_table[start_idx]; 469 for (map_idx = start_idx; map_idx <= end_idx; map_idx++, mt_entry++) { 470 if (mt_entry->missing_count > high_missing_count) { 471 high_missing_count = mt_entry->missing_count; 472 high_idx = map_idx; 473 } 474 } 475 return high_idx; 476 } 477 478 /** 479 * _mapping_get_free_mt_idx - get first free index for a device 480 * @sc: per adapter object 481 * @start_idx: offset in the table to start search 482 * 483 * Returns the index of map table entry on success or bad index. 484 */ 485 static u32 486 _mapping_get_free_mt_idx(struct mpr_softc *sc, u32 start_idx) 487 { 488 u32 map_idx, max_idx = sc->max_devices; 489 struct dev_mapping_table *mt_entry = &sc->mapping_table[start_idx]; 490 u16 volume_mapping_flags; 491 492 volume_mapping_flags = le16toh(sc->ioc_pg8.IRVolumeMappingFlags) & 493 MPI2_IOCPAGE8_IRFLAGS_MASK_VOLUME_MAPPING_MODE; 494 if (sc->ir_firmware && (volume_mapping_flags == 495 MPI2_IOCPAGE8_IRFLAGS_HIGH_VOLUME_MAPPING)) 496 max_idx -= sc->max_volumes; 497 for (map_idx = start_idx; map_idx < max_idx; map_idx++, mt_entry++) 498 if (!(mt_entry->device_info & (MPR_MAP_IN_USE | 499 MPR_DEV_RESERVED))) 500 return map_idx; 501 502 return MPR_MAPTABLE_BAD_IDX; 503 } 504 505 /** 506 * _mapping_get_dpm_idx_from_id - get DPM index from ID 507 * @sc: per adapter object 508 * @id: volume WWID or enclosure ID or device ID 509 * 510 * Returns the index of DPM entry on success or bad index. 511 */ 512 static u16 513 _mapping_get_dpm_idx_from_id(struct mpr_softc *sc, u64 id, u32 phy_bits) 514 { 515 u16 entry_num; 516 uint64_t PhysicalIdentifier; 517 Mpi2DriverMap0Entry_t *dpm_entry; 518 519 dpm_entry = (Mpi2DriverMap0Entry_t *)((u8 *)sc->dpm_pg0 + 520 sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER)); 521 PhysicalIdentifier = dpm_entry->PhysicalIdentifier.High; 522 PhysicalIdentifier = (PhysicalIdentifier << 32) | 523 dpm_entry->PhysicalIdentifier.Low; 524 for (entry_num = 0; entry_num < sc->max_dpm_entries; entry_num++, 525 dpm_entry++) 526 if ((id == PhysicalIdentifier) && 527 (!phy_bits || !dpm_entry->PhysicalBitsMapping || 528 (phy_bits & dpm_entry->PhysicalBitsMapping))) 529 return entry_num; 530 531 return MPR_DPM_BAD_IDX; 532 } 533 534 535 /** 536 * _mapping_get_free_dpm_idx - get first available DPM index 537 * @sc: per adapter object 538 * 539 * Returns the index of DPM entry on success or bad index. 540 */ 541 static u32 542 _mapping_get_free_dpm_idx(struct mpr_softc *sc) 543 { 544 u16 entry_num; 545 546 for (entry_num = 0; entry_num < sc->max_dpm_entries; entry_num++) { 547 if (!sc->dpm_entry_used[entry_num]) 548 return entry_num; 549 } 550 return MPR_DPM_BAD_IDX; 551 } 552 553 /** 554 * _mapping_update_ir_missing_cnt - Updates missing count for a volume 555 * @sc: per adapter object 556 * @map_idx: map table index of the volume 557 * @element: IR configuration change element 558 * @wwid: IR volume ID. 559 * 560 * Updates the missing count in the map table and in the DPM entry for a volume 561 * 562 * Returns nothing. 563 */ 564 static void 565 _mapping_update_ir_missing_cnt(struct mpr_softc *sc, u32 map_idx, 566 Mpi2EventIrConfigElement_t *element, u64 wwid) 567 { 568 struct dev_mapping_table *mt_entry; 569 u8 missing_cnt, reason = element->ReasonCode; 570 u16 dpm_idx; 571 Mpi2DriverMap0Entry_t *dpm_entry; 572 573 if (!sc->is_dpm_enable) 574 return; 575 mt_entry = &sc->mapping_table[map_idx]; 576 if (reason == MPI2_EVENT_IR_CHANGE_RC_ADDED) { 577 mt_entry->missing_count = 0; 578 } else if (reason == MPI2_EVENT_IR_CHANGE_RC_VOLUME_CREATED) { 579 mt_entry->missing_count = 0; 580 mt_entry->init_complete = 0; 581 } else if ((reason == MPI2_EVENT_IR_CHANGE_RC_REMOVED) || 582 (reason == MPI2_EVENT_IR_CHANGE_RC_VOLUME_DELETED)) { 583 if (!mt_entry->init_complete) { 584 if (mt_entry->missing_count < MPR_MAX_MISSING_COUNT) 585 mt_entry->missing_count++; 586 else 587 mt_entry->init_complete = 1; 588 } 589 if (!mt_entry->missing_count) 590 mt_entry->missing_count++; 591 mt_entry->dev_handle = 0; 592 } 593 594 dpm_idx = mt_entry->dpm_entry_num; 595 if (dpm_idx == MPR_DPM_BAD_IDX) { 596 if ((reason == MPI2_EVENT_IR_CHANGE_RC_ADDED) || 597 (reason == MPI2_EVENT_IR_CHANGE_RC_REMOVED)) 598 dpm_idx = _mapping_get_dpm_idx_from_id(sc, 599 mt_entry->physical_id, 0); 600 else if (reason == MPI2_EVENT_IR_CHANGE_RC_VOLUME_DELETED) 601 return; 602 } 603 if (dpm_idx != MPR_DPM_BAD_IDX) { 604 dpm_entry = (Mpi2DriverMap0Entry_t *)((u8 *)sc->dpm_pg0 + 605 sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER)); 606 dpm_entry += dpm_idx; 607 missing_cnt = dpm_entry->MappingInformation & 608 MPI2_DRVMAP0_MAPINFO_MISSING_MASK; 609 if ((mt_entry->physical_id == 610 le64toh((u64)dpm_entry->PhysicalIdentifier.High | 611 dpm_entry->PhysicalIdentifier.Low)) && (missing_cnt == 612 mt_entry->missing_count)) 613 mt_entry->init_complete = 1; 614 } else { 615 dpm_idx = _mapping_get_free_dpm_idx(sc); 616 mt_entry->init_complete = 0; 617 } 618 619 if ((dpm_idx != MPR_DPM_BAD_IDX) && !mt_entry->init_complete) { 620 mt_entry->init_complete = 1; 621 mt_entry->dpm_entry_num = dpm_idx; 622 dpm_entry = (Mpi2DriverMap0Entry_t *)((u8 *)sc->dpm_pg0 + 623 sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER)); 624 dpm_entry += dpm_idx; 625 dpm_entry->PhysicalIdentifier.Low = 626 (0xFFFFFFFF & mt_entry->physical_id); 627 dpm_entry->PhysicalIdentifier.High = 628 (mt_entry->physical_id >> 32); 629 dpm_entry->DeviceIndex = map_idx; 630 dpm_entry->MappingInformation = mt_entry->missing_count; 631 dpm_entry->PhysicalBitsMapping = 0; 632 dpm_entry->Reserved1 = 0; 633 sc->dpm_flush_entry[dpm_idx] = 1; 634 sc->dpm_entry_used[dpm_idx] = 1; 635 } else if (dpm_idx == MPR_DPM_BAD_IDX) { 636 printf("%s: no space to add entry in DPM table\n", __func__); 637 mt_entry->init_complete = 1; 638 } 639 } 640 641 /** 642 * _mapping_add_to_removal_table - mark an entry for removal 643 * @sc: per adapter object 644 * @handle: Handle of enclosures/device/volume 645 * 646 * Adds the handle or DPM entry number in removal table. 647 * 648 * Returns nothing. 649 */ 650 static void 651 _mapping_add_to_removal_table(struct mpr_softc *sc, u16 handle, 652 u16 dpm_idx) 653 { 654 struct map_removal_table *remove_entry; 655 u32 i; 656 u16 ioc_pg8_flags = le16toh(sc->ioc_pg8.Flags); 657 658 remove_entry = sc->removal_table; 659 660 for (i = 0; i < sc->max_devices; i++, remove_entry++) { 661 if (remove_entry->dev_handle || remove_entry->dpm_entry_num != 662 MPR_DPM_BAD_IDX) 663 continue; 664 if ((ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) == 665 MPI2_IOCPAGE8_FLAGS_ENCLOSURE_SLOT_MAPPING) { 666 if (dpm_idx) 667 remove_entry->dpm_entry_num = dpm_idx; 668 if (remove_entry->dpm_entry_num == MPR_DPM_BAD_IDX) 669 remove_entry->dev_handle = handle; 670 } else if ((ioc_pg8_flags & 671 MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) == 672 MPI2_IOCPAGE8_FLAGS_DEVICE_PERSISTENCE_MAPPING) 673 remove_entry->dev_handle = handle; 674 break; 675 } 676 677 } 678 679 /** 680 * _mapping_inc_missing_count 681 * @sc: per adapter object 682 * @map_idx: index into the mapping table for the device that is missing 683 * 684 * Increment the missing count in the mapping table for a SAS, SATA, or PCIe 685 * device that is not responding. If Persitent Mapping is used, increment the 686 * DPM entry as well. Also, add this device to the removal table for possible 687 * removal if a new device is added. 688 * 689 * Returns nothing. 690 */ 691 static void 692 _mapping_inc_missing_count(struct mpr_softc *sc, u32 map_idx) 693 { 694 u16 ioc_pg8_flags = le16toh(sc->ioc_pg8.Flags); 695 struct dev_mapping_table *mt_entry; 696 Mpi2DriverMap0Entry_t *dpm_entry; 697 698 if (map_idx == MPR_MAPTABLE_BAD_IDX) { 699 mpr_dprint(sc, MPR_INFO, "%s: device is already removed from " 700 "mapping table\n", __func__); 701 return; 702 } 703 mt_entry = &sc->mapping_table[map_idx]; 704 if (!mt_entry->init_complete) { 705 if (mt_entry->missing_count < MPR_MAX_MISSING_COUNT) 706 mt_entry->missing_count++; 707 else 708 mt_entry->init_complete = 1; 709 } 710 if (!mt_entry->missing_count) 711 mt_entry->missing_count++; 712 _mapping_add_to_removal_table(sc, mt_entry->dev_handle, 0); 713 mt_entry->dev_handle = 0; 714 715 if (((ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) == 716 MPI2_IOCPAGE8_FLAGS_DEVICE_PERSISTENCE_MAPPING) && 717 sc->is_dpm_enable && !mt_entry->init_complete && 718 mt_entry->dpm_entry_num != MPR_DPM_BAD_IDX) { 719 dpm_entry = (Mpi2DriverMap0Entry_t *) ((u8 *)sc->dpm_pg0 + 720 sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER)); 721 dpm_entry += mt_entry->dpm_entry_num; 722 dpm_entry->MappingInformation = mt_entry->missing_count; 723 sc->dpm_flush_entry[mt_entry->dpm_entry_num] = 1; 724 } 725 mt_entry->init_complete = 1; 726 } 727 728 /** 729 * _mapping_update_missing_count - Update missing count for a device 730 * @sc: per adapter object 731 * @topo_change: Topology change event entry 732 * 733 * Search through the topology change list and if any device is found not 734 * responding it's associated map table entry and DPM entry is updated 735 * 736 * Returns nothing. 737 */ 738 static void 739 _mapping_update_missing_count(struct mpr_softc *sc, 740 struct _map_topology_change *topo_change) 741 { 742 u8 entry; 743 struct _map_phy_change *phy_change; 744 u32 map_idx; 745 746 for (entry = 0; entry < topo_change->num_entries; entry++) { 747 phy_change = &topo_change->phy_details[entry]; 748 if (!phy_change->dev_handle || (phy_change->reason != 749 MPI2_EVENT_SAS_TOPO_RC_TARG_NOT_RESPONDING)) 750 continue; 751 map_idx = _mapping_get_mt_idx_from_handle(sc, phy_change-> 752 dev_handle); 753 phy_change->is_processed = 1; 754 _mapping_inc_missing_count(sc, map_idx); 755 } 756 } 757 758 /** 759 * _mapping_update_pcie_missing_count - Update missing count for a PCIe device 760 * @sc: per adapter object 761 * @topo_change: Topology change event entry 762 * 763 * Search through the PCIe topology change list and if any device is found not 764 * responding it's associated map table entry and DPM entry is updated 765 * 766 * Returns nothing. 767 */ 768 static void 769 _mapping_update_pcie_missing_count(struct mpr_softc *sc, 770 struct _map_pcie_topology_change *topo_change) 771 { 772 u8 entry; 773 struct _map_port_change *port_change; 774 u32 map_idx; 775 776 for (entry = 0; entry < topo_change->num_entries; entry++) { 777 port_change = &topo_change->port_details[entry]; 778 if (!port_change->dev_handle || (port_change->reason != 779 MPI26_EVENT_PCIE_TOPO_PS_NOT_RESPONDING)) 780 continue; 781 map_idx = _mapping_get_mt_idx_from_handle(sc, port_change-> 782 dev_handle); 783 port_change->is_processed = 1; 784 _mapping_inc_missing_count(sc, map_idx); 785 } 786 } 787 788 /** 789 * _mapping_find_enc_map_space -find map table entries for enclosure 790 * @sc: per adapter object 791 * @et_entry: enclosure entry 792 * 793 * Search through the mapping table defragment it and provide contiguous 794 * space in map table for a particular enclosure entry 795 * 796 * Returns start index in map table or bad index. 797 */ 798 static u32 799 _mapping_find_enc_map_space(struct mpr_softc *sc, 800 struct enc_mapping_table *et_entry) 801 { 802 u16 vol_mapping_flags; 803 u32 skip_count, end_of_table, map_idx, enc_idx; 804 u16 num_found; 805 u32 start_idx = MPR_MAPTABLE_BAD_IDX; 806 struct dev_mapping_table *mt_entry; 807 struct enc_mapping_table *enc_entry; 808 unsigned char done_flag = 0, found_space; 809 u16 max_num_phy_ids = le16toh(sc->ioc_pg8.MaxNumPhysicalMappedIDs); 810 811 skip_count = sc->num_rsvd_entries; 812 num_found = 0; 813 814 vol_mapping_flags = le16toh(sc->ioc_pg8.IRVolumeMappingFlags) & 815 MPI2_IOCPAGE8_IRFLAGS_MASK_VOLUME_MAPPING_MODE; 816 817 if (!sc->ir_firmware) 818 end_of_table = sc->max_devices; 819 else if (vol_mapping_flags == MPI2_IOCPAGE8_IRFLAGS_LOW_VOLUME_MAPPING) 820 end_of_table = sc->max_devices; 821 else 822 end_of_table = sc->max_devices - sc->max_volumes; 823 824 for (map_idx = (max_num_phy_ids + skip_count); 825 map_idx < end_of_table; map_idx++) { 826 mt_entry = &sc->mapping_table[map_idx]; 827 if ((et_entry->enclosure_id == mt_entry->physical_id) && 828 (!mt_entry->phy_bits || (mt_entry->phy_bits & 829 et_entry->phy_bits))) { 830 num_found += 1; 831 if (num_found == et_entry->num_slots) { 832 start_idx = (map_idx - num_found) + 1; 833 return start_idx; 834 } 835 } else 836 num_found = 0; 837 } 838 for (map_idx = (max_num_phy_ids + skip_count); 839 map_idx < end_of_table; map_idx++) { 840 mt_entry = &sc->mapping_table[map_idx]; 841 if (!(mt_entry->device_info & MPR_DEV_RESERVED)) { 842 num_found += 1; 843 if (num_found == et_entry->num_slots) { 844 start_idx = (map_idx - num_found) + 1; 845 return start_idx; 846 } 847 } else 848 num_found = 0; 849 } 850 851 while (!done_flag) { 852 enc_idx = _mapping_get_high_missing_et_idx(sc); 853 if (enc_idx == MPR_ENCTABLE_BAD_IDX) 854 return MPR_MAPTABLE_BAD_IDX; 855 enc_entry = &sc->enclosure_table[enc_idx]; 856 /*VSP FIXME*/ 857 enc_entry->skip_search = 1; 858 mt_entry = &sc->mapping_table[enc_entry->start_index]; 859 for (map_idx = enc_entry->start_index; map_idx < 860 (enc_entry->start_index + enc_entry->num_slots); map_idx++, 861 mt_entry++) 862 mt_entry->device_info &= ~MPR_DEV_RESERVED; 863 found_space = 0; 864 for (map_idx = (max_num_phy_ids + 865 skip_count); map_idx < end_of_table; map_idx++) { 866 mt_entry = &sc->mapping_table[map_idx]; 867 if (!(mt_entry->device_info & MPR_DEV_RESERVED)) { 868 num_found += 1; 869 if (num_found == et_entry->num_slots) { 870 start_idx = (map_idx - num_found) + 1; 871 found_space = 1; 872 } 873 } else 874 num_found = 0; 875 } 876 877 if (!found_space) 878 continue; 879 for (map_idx = start_idx; map_idx < (start_idx + num_found); 880 map_idx++) { 881 enc_entry = sc->enclosure_table; 882 for (enc_idx = 0; enc_idx < sc->num_enc_table_entries; 883 enc_idx++, enc_entry++) { 884 if (map_idx < enc_entry->start_index || 885 map_idx > (enc_entry->start_index + 886 enc_entry->num_slots)) 887 continue; 888 if (!enc_entry->removal_flag) { 889 enc_entry->removal_flag = 1; 890 _mapping_add_to_removal_table(sc, 0, 891 enc_entry->dpm_entry_num); 892 } 893 mt_entry = &sc->mapping_table[map_idx]; 894 if (mt_entry->device_info & 895 MPR_MAP_IN_USE) { 896 _mapping_add_to_removal_table(sc, 897 mt_entry->dev_handle, 0); 898 _mapping_clear_map_entry(mt_entry); 899 } 900 if (map_idx == (enc_entry->start_index + 901 enc_entry->num_slots - 1)) 902 _mapping_clear_enc_entry(et_entry); 903 } 904 } 905 enc_entry = sc->enclosure_table; 906 for (enc_idx = 0; enc_idx < sc->num_enc_table_entries; 907 enc_idx++, enc_entry++) { 908 if (!enc_entry->removal_flag) { 909 mt_entry = &sc->mapping_table[enc_entry-> 910 start_index]; 911 for (map_idx = enc_entry->start_index; map_idx < 912 (enc_entry->start_index + 913 enc_entry->num_slots); map_idx++, 914 mt_entry++) 915 mt_entry->device_info |= 916 MPR_DEV_RESERVED; 917 et_entry->skip_search = 0; 918 } 919 } 920 done_flag = 1; 921 } 922 return start_idx; 923 } 924 925 /** 926 * _mapping_get_dev_info -get information about newly added devices 927 * @sc: per adapter object 928 * @topo_change: Topology change event entry 929 * 930 * Search through the topology change event list and issues sas device pg0 931 * requests for the newly added device and reserved entries in tables 932 * 933 * Returns nothing 934 */ 935 static void 936 _mapping_get_dev_info(struct mpr_softc *sc, 937 struct _map_topology_change *topo_change) 938 { 939 u16 ioc_pg8_flags = le16toh(sc->ioc_pg8.Flags); 940 Mpi2ConfigReply_t mpi_reply; 941 Mpi2SasDevicePage0_t sas_device_pg0; 942 u8 entry, enc_idx, phy_idx, sata_end_device; 943 u32 map_idx, index, device_info; 944 struct _map_phy_change *phy_change, *tmp_phy_change; 945 uint64_t sas_address; 946 struct enc_mapping_table *et_entry; 947 struct dev_mapping_table *mt_entry; 948 u8 add_code = MPI2_EVENT_SAS_TOPO_RC_TARG_ADDED; 949 int rc = 1; 950 951 for (entry = 0; entry < topo_change->num_entries; entry++) { 952 phy_change = &topo_change->phy_details[entry]; 953 if (phy_change->is_processed || !phy_change->dev_handle || 954 phy_change->reason != MPI2_EVENT_SAS_TOPO_RC_TARG_ADDED) 955 continue; 956 if (mpr_config_get_sas_device_pg0(sc, &mpi_reply, 957 &sas_device_pg0, MPI2_SAS_DEVICE_PGAD_FORM_HANDLE, 958 phy_change->dev_handle)) { 959 phy_change->is_processed = 1; 960 continue; 961 } 962 963 /* 964 * Always get SATA Identify information because this is used 965 * to determine if Start/Stop Unit should be sent to the drive 966 * when the system is shutdown. 967 */ 968 device_info = le32toh(sas_device_pg0.DeviceInfo); 969 sas_address = sas_device_pg0.SASAddress.High; 970 sas_address = (sas_address << 32) | 971 sas_device_pg0.SASAddress.Low; 972 sata_end_device = 0; 973 if ((device_info & MPI2_SAS_DEVICE_INFO_END_DEVICE) && 974 (device_info & MPI2_SAS_DEVICE_INFO_SATA_DEVICE)) { 975 sata_end_device = 1; 976 rc = mprsas_get_sas_address_for_sata_disk(sc, 977 &sas_address, phy_change->dev_handle, device_info, 978 &phy_change->is_SATA_SSD); 979 if (rc) { 980 mpr_dprint(sc, MPR_ERROR, "%s: failed to get " 981 "disk type (SSD or HDD) and SAS Address " 982 "for SATA device with handle 0x%04x\n", 983 __func__, phy_change->dev_handle); 984 } else { 985 mpr_dprint(sc, MPR_INFO, "SAS Address for SATA " 986 "device = %jx\n", sas_address); 987 } 988 } 989 990 phy_change->physical_id = sas_address; 991 phy_change->slot = le16toh(sas_device_pg0.Slot); 992 phy_change->device_info = device_info; 993 994 if ((ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) == 995 MPI2_IOCPAGE8_FLAGS_ENCLOSURE_SLOT_MAPPING) { 996 enc_idx = _mapping_get_enc_idx_from_handle(sc, 997 topo_change->enc_handle); 998 if (enc_idx == MPR_ENCTABLE_BAD_IDX) { 999 phy_change->is_processed = 1; 1000 mpr_dprint(sc, MPR_MAPPING, "%s: failed to add " 1001 "the device with handle 0x%04x because the " 1002 "enclosure is not in the mapping table\n", 1003 __func__, phy_change->dev_handle); 1004 continue; 1005 } 1006 if (!((phy_change->device_info & 1007 MPI2_SAS_DEVICE_INFO_END_DEVICE) && 1008 (phy_change->device_info & 1009 (MPI2_SAS_DEVICE_INFO_SSP_TARGET | 1010 MPI2_SAS_DEVICE_INFO_STP_TARGET | 1011 MPI2_SAS_DEVICE_INFO_SATA_DEVICE)))) { 1012 phy_change->is_processed = 1; 1013 continue; 1014 } 1015 et_entry = &sc->enclosure_table[enc_idx]; 1016 if (et_entry->start_index != MPR_MAPTABLE_BAD_IDX) 1017 continue; 1018 if (!topo_change->exp_handle) { 1019 map_idx = sc->num_rsvd_entries; 1020 et_entry->start_index = map_idx; 1021 } else { 1022 map_idx = _mapping_find_enc_map_space(sc, 1023 et_entry); 1024 et_entry->start_index = map_idx; 1025 if (et_entry->start_index == 1026 MPR_MAPTABLE_BAD_IDX) { 1027 phy_change->is_processed = 1; 1028 for (phy_idx = 0; phy_idx < 1029 topo_change->num_entries; 1030 phy_idx++) { 1031 tmp_phy_change = 1032 &topo_change->phy_details 1033 [phy_idx]; 1034 if (tmp_phy_change->reason == 1035 add_code) 1036 tmp_phy_change-> 1037 is_processed = 1; 1038 } 1039 break; 1040 } 1041 } 1042 1043 /* Found space in enclosure for mapping entry */ 1044 mt_entry = &sc->mapping_table[map_idx]; 1045 for (index = map_idx; index < (et_entry->num_slots 1046 + map_idx); index++, mt_entry++) { 1047 mt_entry->device_info = MPR_DEV_RESERVED; 1048 mt_entry->physical_id = et_entry->enclosure_id; 1049 mt_entry->phy_bits = et_entry->phy_bits; 1050 mt_entry->missing_count = 0; 1051 } 1052 } 1053 } 1054 } 1055 1056 /** 1057 * _mapping_get_pcie_dev_info -get information about newly added PCIe devices 1058 * @sc: per adapter object 1059 * @topo_change: Topology change event entry 1060 * 1061 * Searches through the PCIe topology change event list and issues PCIe device 1062 * pg0 requests for the newly added PCIe device. If the device is in an 1063 * enclosure, search for available space in the enclosure mapping table for the 1064 * device and reserve that space. 1065 * 1066 * Returns nothing 1067 */ 1068 static void 1069 _mapping_get_pcie_dev_info(struct mpr_softc *sc, 1070 struct _map_pcie_topology_change *topo_change) 1071 { 1072 u16 ioc_pg8_flags = le16toh(sc->ioc_pg8.Flags); 1073 Mpi2ConfigReply_t mpi_reply; 1074 Mpi26PCIeDevicePage0_t pcie_device_pg0; 1075 u8 entry, enc_idx, port_idx; 1076 u32 map_idx, index; 1077 struct _map_port_change *port_change, *tmp_port_change; 1078 uint64_t pcie_wwid; 1079 struct enc_mapping_table *et_entry; 1080 struct dev_mapping_table *mt_entry; 1081 u8 add_code = MPI26_EVENT_PCIE_TOPO_PS_DEV_ADDED; 1082 1083 for (entry = 0; entry < topo_change->num_entries; entry++) { 1084 port_change = &topo_change->port_details[entry]; 1085 if (port_change->is_processed || !port_change->dev_handle || 1086 port_change->reason != MPI26_EVENT_PCIE_TOPO_PS_DEV_ADDED) 1087 continue; 1088 if (mpr_config_get_pcie_device_pg0(sc, &mpi_reply, 1089 &pcie_device_pg0, MPI26_PCIE_DEVICE_PGAD_FORM_HANDLE, 1090 port_change->dev_handle)) { 1091 port_change->is_processed = 1; 1092 continue; 1093 } 1094 1095 pcie_wwid = pcie_device_pg0.WWID.High; 1096 pcie_wwid = (pcie_wwid << 32) | pcie_device_pg0.WWID.Low; 1097 port_change->physical_id = pcie_wwid; 1098 port_change->slot = le16toh(pcie_device_pg0.Slot); 1099 port_change->device_info = le32toh(pcie_device_pg0.DeviceInfo); 1100 1101 if ((ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) == 1102 MPI2_IOCPAGE8_FLAGS_ENCLOSURE_SLOT_MAPPING) { 1103 enc_idx = _mapping_get_enc_idx_from_handle(sc, 1104 topo_change->enc_handle); 1105 if (enc_idx == MPR_ENCTABLE_BAD_IDX) { 1106 port_change->is_processed = 1; 1107 mpr_dprint(sc, MPR_MAPPING, "%s: failed to add " 1108 "the device with handle 0x%04x because the " 1109 "enclosure is not in the mapping table\n", 1110 __func__, port_change->dev_handle); 1111 continue; 1112 } 1113 if (!(port_change->device_info & 1114 MPI26_PCIE_DEVINFO_NVME)) { 1115 port_change->is_processed = 1; 1116 continue; 1117 } 1118 et_entry = &sc->enclosure_table[enc_idx]; 1119 if (et_entry->start_index != MPR_MAPTABLE_BAD_IDX) 1120 continue; 1121 if (!topo_change->switch_dev_handle) { 1122 map_idx = sc->num_rsvd_entries; 1123 et_entry->start_index = map_idx; 1124 } else { 1125 map_idx = _mapping_find_enc_map_space(sc, 1126 et_entry); 1127 et_entry->start_index = map_idx; 1128 if (et_entry->start_index == 1129 MPR_MAPTABLE_BAD_IDX) { 1130 port_change->is_processed = 1; 1131 for (port_idx = 0; port_idx < 1132 topo_change->num_entries; 1133 port_idx++) { 1134 tmp_port_change = 1135 &topo_change->port_details 1136 [port_idx]; 1137 if (tmp_port_change->reason == 1138 add_code) 1139 tmp_port_change-> 1140 is_processed = 1; 1141 } 1142 break; 1143 } 1144 } 1145 1146 /* Found space in enclosure for mapping entry */ 1147 mt_entry = &sc->mapping_table[map_idx]; 1148 for (index = map_idx; index < (et_entry->num_slots 1149 + map_idx); index++, mt_entry++) { 1150 mt_entry->device_info = MPR_DEV_RESERVED; 1151 mt_entry->physical_id = et_entry->enclosure_id; 1152 mt_entry->phy_bits = et_entry->phy_bits; 1153 mt_entry->missing_count = 0; 1154 } 1155 } 1156 } 1157 } 1158 1159 /** 1160 * _mapping_set_mid_to_eid -set map table data from enclosure table 1161 * @sc: per adapter object 1162 * @et_entry: enclosure entry 1163 * 1164 * Returns nothing 1165 */ 1166 static inline void 1167 _mapping_set_mid_to_eid(struct mpr_softc *sc, 1168 struct enc_mapping_table *et_entry) 1169 { 1170 struct dev_mapping_table *mt_entry; 1171 u16 slots = et_entry->num_slots, map_idx; 1172 u32 start_idx = et_entry->start_index; 1173 if (start_idx != MPR_MAPTABLE_BAD_IDX) { 1174 mt_entry = &sc->mapping_table[start_idx]; 1175 for (map_idx = 0; map_idx < slots; map_idx++, mt_entry++) 1176 mt_entry->physical_id = et_entry->enclosure_id; 1177 } 1178 } 1179 1180 /** 1181 * _mapping_clear_removed_entries - mark the entries to be cleared 1182 * @sc: per adapter object 1183 * 1184 * Search through the removal table and mark the entries which needs to be 1185 * flushed to DPM and also updates the map table and enclosure table by 1186 * clearing the corresponding entries. 1187 * 1188 * Returns nothing 1189 */ 1190 static void 1191 _mapping_clear_removed_entries(struct mpr_softc *sc) 1192 { 1193 u32 remove_idx; 1194 struct map_removal_table *remove_entry; 1195 Mpi2DriverMap0Entry_t *dpm_entry; 1196 u8 done_flag = 0, num_entries, m, i; 1197 struct enc_mapping_table *et_entry, *from, *to; 1198 u16 ioc_pg8_flags = le16toh(sc->ioc_pg8.Flags); 1199 1200 if (sc->is_dpm_enable) { 1201 remove_entry = sc->removal_table; 1202 for (remove_idx = 0; remove_idx < sc->max_devices; 1203 remove_idx++, remove_entry++) { 1204 if (remove_entry->dpm_entry_num != MPR_DPM_BAD_IDX) { 1205 dpm_entry = (Mpi2DriverMap0Entry_t *) 1206 ((u8 *) sc->dpm_pg0 + 1207 sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER)); 1208 dpm_entry += remove_entry->dpm_entry_num; 1209 dpm_entry->PhysicalIdentifier.Low = 0; 1210 dpm_entry->PhysicalIdentifier.High = 0; 1211 dpm_entry->DeviceIndex = 0; 1212 dpm_entry->MappingInformation = 0; 1213 dpm_entry->PhysicalBitsMapping = 0; 1214 sc->dpm_flush_entry[remove_entry-> 1215 dpm_entry_num] = 1; 1216 sc->dpm_entry_used[remove_entry->dpm_entry_num] 1217 = 0; 1218 remove_entry->dpm_entry_num = MPR_DPM_BAD_IDX; 1219 } 1220 } 1221 } 1222 if ((ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) == 1223 MPI2_IOCPAGE8_FLAGS_ENCLOSURE_SLOT_MAPPING) { 1224 num_entries = sc->num_enc_table_entries; 1225 while (!done_flag) { 1226 done_flag = 1; 1227 et_entry = sc->enclosure_table; 1228 for (i = 0; i < num_entries; i++, et_entry++) { 1229 if (!et_entry->enc_handle && et_entry-> 1230 init_complete) { 1231 done_flag = 0; 1232 if (i != (num_entries - 1)) { 1233 from = &sc->enclosure_table 1234 [i+1]; 1235 to = &sc->enclosure_table[i]; 1236 for (m = i; m < (num_entries - 1237 1); m++, from++, to++) { 1238 _mapping_set_mid_to_eid 1239 (sc, to); 1240 *to = *from; 1241 } 1242 _mapping_clear_enc_entry(to); 1243 sc->num_enc_table_entries--; 1244 num_entries = 1245 sc->num_enc_table_entries; 1246 } else { 1247 _mapping_clear_enc_entry 1248 (et_entry); 1249 sc->num_enc_table_entries--; 1250 num_entries = 1251 sc->num_enc_table_entries; 1252 } 1253 } 1254 } 1255 } 1256 } 1257 } 1258 1259 /** 1260 * _mapping_add_new_device -Add the new device into mapping table 1261 * @sc: per adapter object 1262 * @topo_change: Topology change event entry 1263 * 1264 * Search through the topology change event list and update map table, 1265 * enclosure table and DPM pages for the newly added devices. 1266 * 1267 * Returns nothing 1268 */ 1269 static void 1270 _mapping_add_new_device(struct mpr_softc *sc, 1271 struct _map_topology_change *topo_change) 1272 { 1273 u8 enc_idx, missing_cnt, is_removed = 0; 1274 u16 dpm_idx; 1275 u32 search_idx, map_idx; 1276 u32 entry; 1277 struct dev_mapping_table *mt_entry; 1278 struct enc_mapping_table *et_entry; 1279 struct _map_phy_change *phy_change; 1280 u16 ioc_pg8_flags = le16toh(sc->ioc_pg8.Flags); 1281 Mpi2DriverMap0Entry_t *dpm_entry; 1282 uint64_t temp64_var; 1283 u8 map_shift = MPI2_DRVMAP0_MAPINFO_SLOT_SHIFT; 1284 u8 hdr_sz = sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER); 1285 u16 max_num_phy_ids = le16toh(sc->ioc_pg8.MaxNumPhysicalMappedIDs); 1286 1287 for (entry = 0; entry < topo_change->num_entries; entry++) { 1288 phy_change = &topo_change->phy_details[entry]; 1289 if (phy_change->is_processed) 1290 continue; 1291 if (phy_change->reason != MPI2_EVENT_SAS_TOPO_RC_TARG_ADDED || 1292 !phy_change->dev_handle) { 1293 phy_change->is_processed = 1; 1294 continue; 1295 } 1296 if ((ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) == 1297 MPI2_IOCPAGE8_FLAGS_ENCLOSURE_SLOT_MAPPING) { 1298 enc_idx = _mapping_get_enc_idx_from_handle 1299 (sc, topo_change->enc_handle); 1300 if (enc_idx == MPR_ENCTABLE_BAD_IDX) { 1301 phy_change->is_processed = 1; 1302 mpr_dprint(sc, MPR_ERROR, "%s: failed to add " 1303 "the device with handle 0x%04x because the " 1304 "enclosure is not in the mapping table\n", 1305 __func__, phy_change->dev_handle); 1306 continue; 1307 } 1308 et_entry = &sc->enclosure_table[enc_idx]; 1309 if (et_entry->start_index == MPR_MAPTABLE_BAD_IDX) { 1310 phy_change->is_processed = 1; 1311 if (!sc->mt_full_retry) { 1312 sc->mt_add_device_failed = 1; 1313 continue; 1314 } 1315 mpr_dprint(sc, MPR_INFO, "%s: failed to add " 1316 "the device with handle 0x%04x because " 1317 "there is no free space available in the " 1318 "mapping table\n", __func__, 1319 phy_change->dev_handle); 1320 continue; 1321 } 1322 map_idx = et_entry->start_index + phy_change->slot - 1323 et_entry->start_slot; 1324 mt_entry = &sc->mapping_table[map_idx]; 1325 mt_entry->physical_id = phy_change->physical_id; 1326 mt_entry->channel = 0; 1327 mt_entry->id = map_idx; 1328 mt_entry->dev_handle = phy_change->dev_handle; 1329 mt_entry->missing_count = 0; 1330 mt_entry->dpm_entry_num = et_entry->dpm_entry_num; 1331 mt_entry->device_info = phy_change->device_info | 1332 (MPR_DEV_RESERVED | MPR_MAP_IN_USE); 1333 if (sc->is_dpm_enable) { 1334 dpm_idx = et_entry->dpm_entry_num; 1335 if (dpm_idx == MPR_DPM_BAD_IDX) 1336 dpm_idx = _mapping_get_dpm_idx_from_id 1337 (sc, et_entry->enclosure_id, 1338 et_entry->phy_bits); 1339 if (dpm_idx == MPR_DPM_BAD_IDX) { 1340 dpm_idx = _mapping_get_free_dpm_idx(sc); 1341 if (dpm_idx != MPR_DPM_BAD_IDX) { 1342 dpm_entry = 1343 (Mpi2DriverMap0Entry_t *) 1344 ((u8 *) sc->dpm_pg0 + 1345 hdr_sz); 1346 dpm_entry += dpm_idx; 1347 dpm_entry-> 1348 PhysicalIdentifier.Low = 1349 (0xFFFFFFFF & 1350 et_entry->enclosure_id); 1351 dpm_entry-> 1352 PhysicalIdentifier.High = 1353 ( et_entry->enclosure_id 1354 >> 32); 1355 dpm_entry->DeviceIndex = 1356 (U16)et_entry->start_index; 1357 dpm_entry->MappingInformation = 1358 et_entry->num_slots; 1359 dpm_entry->MappingInformation 1360 <<= map_shift; 1361 dpm_entry->PhysicalBitsMapping 1362 = et_entry->phy_bits; 1363 et_entry->dpm_entry_num = 1364 dpm_idx; 1365 /* FIXME Do I need to set the dpm_idxin mt_entry too */ 1366 sc->dpm_entry_used[dpm_idx] = 1; 1367 sc->dpm_flush_entry[dpm_idx] = 1368 1; 1369 phy_change->is_processed = 1; 1370 } else { 1371 phy_change->is_processed = 1; 1372 mpr_dprint(sc, MPR_INFO, "%s: " 1373 "failed to add the device " 1374 "with handle 0x%04x to " 1375 "persistent table because " 1376 "there is no free space " 1377 "available\n", __func__, 1378 phy_change->dev_handle); 1379 } 1380 } else { 1381 et_entry->dpm_entry_num = dpm_idx; 1382 mt_entry->dpm_entry_num = dpm_idx; 1383 } 1384 } 1385 /* FIXME Why not mt_entry too? */ 1386 et_entry->init_complete = 1; 1387 } else if ((ioc_pg8_flags & 1388 MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) == 1389 MPI2_IOCPAGE8_FLAGS_DEVICE_PERSISTENCE_MAPPING) { 1390 map_idx = _mapping_get_mt_idx_from_id 1391 (sc, phy_change->physical_id); 1392 if (map_idx == MPR_MAPTABLE_BAD_IDX) { 1393 search_idx = sc->num_rsvd_entries; 1394 if (topo_change->exp_handle) 1395 search_idx += max_num_phy_ids; 1396 map_idx = _mapping_get_free_mt_idx(sc, 1397 search_idx); 1398 } 1399 if (map_idx == MPR_MAPTABLE_BAD_IDX) { 1400 map_idx = _mapping_get_high_missing_mt_idx(sc); 1401 if (map_idx != MPR_MAPTABLE_BAD_IDX) { 1402 mt_entry = &sc->mapping_table[map_idx]; 1403 if (mt_entry->dev_handle) { 1404 _mapping_add_to_removal_table 1405 (sc, mt_entry->dev_handle, 1406 0); 1407 is_removed = 1; 1408 } 1409 mt_entry->init_complete = 0; 1410 } 1411 } 1412 if (map_idx != MPR_MAPTABLE_BAD_IDX) { 1413 mt_entry = &sc->mapping_table[map_idx]; 1414 mt_entry->physical_id = phy_change->physical_id; 1415 mt_entry->channel = 0; 1416 mt_entry->id = map_idx; 1417 mt_entry->dev_handle = phy_change->dev_handle; 1418 mt_entry->missing_count = 0; 1419 mt_entry->device_info = phy_change->device_info 1420 | (MPR_DEV_RESERVED | MPR_MAP_IN_USE); 1421 } else { 1422 phy_change->is_processed = 1; 1423 if (!sc->mt_full_retry) { 1424 sc->mt_add_device_failed = 1; 1425 continue; 1426 } 1427 mpr_dprint(sc, MPR_INFO, "%s: failed to add " 1428 "the device with handle 0x%04x because " 1429 "there is no free space available in the " 1430 "mapping table\n", __func__, 1431 phy_change->dev_handle); 1432 continue; 1433 } 1434 if (sc->is_dpm_enable) { 1435 if (mt_entry->dpm_entry_num != 1436 MPR_DPM_BAD_IDX) { 1437 dpm_idx = mt_entry->dpm_entry_num; 1438 dpm_entry = (Mpi2DriverMap0Entry_t *) 1439 ((u8 *)sc->dpm_pg0 + hdr_sz); 1440 dpm_entry += dpm_idx; 1441 missing_cnt = dpm_entry-> 1442 MappingInformation & 1443 MPI2_DRVMAP0_MAPINFO_MISSING_MASK; 1444 temp64_var = dpm_entry-> 1445 PhysicalIdentifier.High; 1446 temp64_var = (temp64_var << 32) | 1447 dpm_entry->PhysicalIdentifier.Low; 1448 if ((mt_entry->physical_id == 1449 temp64_var) && !missing_cnt) 1450 mt_entry->init_complete = 1; 1451 } else { 1452 dpm_idx = _mapping_get_free_dpm_idx(sc); 1453 mt_entry->init_complete = 0; 1454 } 1455 if (dpm_idx != MPR_DPM_BAD_IDX && 1456 !mt_entry->init_complete) { 1457 mt_entry->init_complete = 1; 1458 mt_entry->dpm_entry_num = dpm_idx; 1459 dpm_entry = (Mpi2DriverMap0Entry_t *) 1460 ((u8 *)sc->dpm_pg0 + hdr_sz); 1461 dpm_entry += dpm_idx; 1462 dpm_entry->PhysicalIdentifier.Low = 1463 (0xFFFFFFFF & 1464 mt_entry->physical_id); 1465 dpm_entry->PhysicalIdentifier.High = 1466 (mt_entry->physical_id >> 32); 1467 dpm_entry->DeviceIndex = (U16) map_idx; 1468 dpm_entry->MappingInformation = 0; 1469 dpm_entry->PhysicalBitsMapping = 0; 1470 sc->dpm_entry_used[dpm_idx] = 1; 1471 sc->dpm_flush_entry[dpm_idx] = 1; 1472 phy_change->is_processed = 1; 1473 } else if (dpm_idx == MPR_DPM_BAD_IDX) { 1474 phy_change->is_processed = 1; 1475 mpr_dprint(sc, MPR_INFO, "%s: failed " 1476 "to add the device with handle " 1477 "0x%04x to persistent table " 1478 "because there is no free space " 1479 "available\n", __func__, 1480 phy_change->dev_handle); 1481 } 1482 } 1483 mt_entry->init_complete = 1; 1484 } 1485 1486 phy_change->is_processed = 1; 1487 } 1488 if (is_removed) 1489 _mapping_clear_removed_entries(sc); 1490 } 1491 1492 /** 1493 * _mapping_add_new_pcie_device -Add the new PCIe device into mapping table 1494 * @sc: per adapter object 1495 * @topo_change: Topology change event entry 1496 * 1497 * Search through the PCIe topology change event list and update map table, 1498 * enclosure table and DPM pages for the newly added devices. 1499 * 1500 * Returns nothing 1501 */ 1502 static void 1503 _mapping_add_new_pcie_device(struct mpr_softc *sc, 1504 struct _map_pcie_topology_change *topo_change) 1505 { 1506 u8 enc_idx, missing_cnt, is_removed = 0; 1507 u16 dpm_idx; 1508 u32 search_idx, map_idx; 1509 u32 entry; 1510 struct dev_mapping_table *mt_entry; 1511 struct enc_mapping_table *et_entry; 1512 struct _map_port_change *port_change; 1513 u16 ioc_pg8_flags = le16toh(sc->ioc_pg8.Flags); 1514 Mpi2DriverMap0Entry_t *dpm_entry; 1515 uint64_t temp64_var; 1516 u8 map_shift = MPI2_DRVMAP0_MAPINFO_SLOT_SHIFT; 1517 u8 hdr_sz = sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER); 1518 u16 max_num_phy_ids = le16toh(sc->ioc_pg8.MaxNumPhysicalMappedIDs); 1519 1520 for (entry = 0; entry < topo_change->num_entries; entry++) { 1521 port_change = &topo_change->port_details[entry]; 1522 if (port_change->is_processed) 1523 continue; 1524 if (port_change->reason != MPI26_EVENT_PCIE_TOPO_PS_DEV_ADDED || 1525 !port_change->dev_handle) { 1526 port_change->is_processed = 1; 1527 continue; 1528 } 1529 if ((ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) == 1530 MPI2_IOCPAGE8_FLAGS_ENCLOSURE_SLOT_MAPPING) { 1531 enc_idx = _mapping_get_enc_idx_from_handle 1532 (sc, topo_change->enc_handle); 1533 if (enc_idx == MPR_ENCTABLE_BAD_IDX) { 1534 port_change->is_processed = 1; 1535 mpr_dprint(sc, MPR_ERROR, "%s: failed to add " 1536 "the device with handle 0x%04x because the " 1537 "enclosure is not in the mapping table\n", 1538 __func__, port_change->dev_handle); 1539 continue; 1540 } 1541 et_entry = &sc->enclosure_table[enc_idx]; 1542 if (et_entry->start_index == MPR_MAPTABLE_BAD_IDX) { 1543 port_change->is_processed = 1; 1544 if (!sc->mt_full_retry) { 1545 sc->mt_add_device_failed = 1; 1546 continue; 1547 } 1548 mpr_dprint(sc, MPR_INFO, "%s: failed to add " 1549 "the device with handle 0x%04x because " 1550 "there is no free space available in the " 1551 "mapping table\n", __func__, 1552 port_change->dev_handle); 1553 continue; 1554 } 1555 map_idx = et_entry->start_index + port_change->slot - 1556 et_entry->start_slot; 1557 mt_entry = &sc->mapping_table[map_idx]; 1558 mt_entry->physical_id = port_change->physical_id; 1559 mt_entry->channel = 0; 1560 mt_entry->id = map_idx; 1561 mt_entry->dev_handle = port_change->dev_handle; 1562 mt_entry->missing_count = 0; 1563 mt_entry->dpm_entry_num = et_entry->dpm_entry_num; 1564 mt_entry->device_info = port_change->device_info | 1565 (MPR_DEV_RESERVED | MPR_MAP_IN_USE); 1566 if (sc->is_dpm_enable) { 1567 dpm_idx = et_entry->dpm_entry_num; 1568 if (dpm_idx == MPR_DPM_BAD_IDX) 1569 dpm_idx = _mapping_get_dpm_idx_from_id 1570 (sc, et_entry->enclosure_id, 1571 et_entry->phy_bits); 1572 if (dpm_idx == MPR_DPM_BAD_IDX) { 1573 dpm_idx = _mapping_get_free_dpm_idx(sc); 1574 if (dpm_idx != MPR_DPM_BAD_IDX) { 1575 dpm_entry = 1576 (Mpi2DriverMap0Entry_t *) 1577 ((u8 *) sc->dpm_pg0 + 1578 hdr_sz); 1579 dpm_entry += dpm_idx; 1580 dpm_entry-> 1581 PhysicalIdentifier.Low = 1582 (0xFFFFFFFF & 1583 et_entry->enclosure_id); 1584 dpm_entry-> 1585 PhysicalIdentifier.High = 1586 ( et_entry->enclosure_id 1587 >> 32); 1588 dpm_entry->DeviceIndex = 1589 (U16)et_entry->start_index; 1590 dpm_entry->MappingInformation = 1591 et_entry->num_slots; 1592 dpm_entry->MappingInformation 1593 <<= map_shift; 1594 dpm_entry->PhysicalBitsMapping 1595 = et_entry->phy_bits; 1596 et_entry->dpm_entry_num = 1597 dpm_idx; 1598 /* FIXME Do I need to set the dpm_idxin mt_entry too */ 1599 sc->dpm_entry_used[dpm_idx] = 1; 1600 sc->dpm_flush_entry[dpm_idx] = 1601 1; 1602 port_change->is_processed = 1; 1603 } else { 1604 port_change->is_processed = 1; 1605 mpr_dprint(sc, MPR_INFO, "%s: " 1606 "failed to add the device " 1607 "with handle 0x%04x to " 1608 "persistent table because " 1609 "there is no free space " 1610 "available\n", __func__, 1611 port_change->dev_handle); 1612 } 1613 } else { 1614 et_entry->dpm_entry_num = dpm_idx; 1615 mt_entry->dpm_entry_num = dpm_idx; 1616 } 1617 } 1618 /* FIXME Why not mt_entry too? */ 1619 et_entry->init_complete = 1; 1620 } else if ((ioc_pg8_flags & 1621 MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) == 1622 MPI2_IOCPAGE8_FLAGS_DEVICE_PERSISTENCE_MAPPING) { 1623 map_idx = _mapping_get_mt_idx_from_id 1624 (sc, port_change->physical_id); 1625 if (map_idx == MPR_MAPTABLE_BAD_IDX) { 1626 search_idx = sc->num_rsvd_entries; 1627 if (topo_change->switch_dev_handle) 1628 search_idx += max_num_phy_ids; 1629 map_idx = _mapping_get_free_mt_idx(sc, 1630 search_idx); 1631 } 1632 if (map_idx == MPR_MAPTABLE_BAD_IDX) { 1633 map_idx = _mapping_get_high_missing_mt_idx(sc); 1634 if (map_idx != MPR_MAPTABLE_BAD_IDX) { 1635 mt_entry = &sc->mapping_table[map_idx]; 1636 if (mt_entry->dev_handle) { 1637 _mapping_add_to_removal_table 1638 (sc, mt_entry->dev_handle, 1639 0); 1640 is_removed = 1; 1641 } 1642 mt_entry->init_complete = 0; 1643 } 1644 } 1645 if (map_idx != MPR_MAPTABLE_BAD_IDX) { 1646 mt_entry = &sc->mapping_table[map_idx]; 1647 mt_entry->physical_id = 1648 port_change->physical_id; 1649 mt_entry->channel = 0; 1650 mt_entry->id = map_idx; 1651 mt_entry->dev_handle = port_change->dev_handle; 1652 mt_entry->missing_count = 0; 1653 mt_entry->device_info = 1654 port_change->device_info | 1655 (MPR_DEV_RESERVED | MPR_MAP_IN_USE); 1656 } else { 1657 port_change->is_processed = 1; 1658 if (!sc->mt_full_retry) { 1659 sc->mt_add_device_failed = 1; 1660 continue; 1661 } 1662 mpr_dprint(sc, MPR_INFO, "%s: failed to add " 1663 "the device with handle 0x%04x because " 1664 "there is no free space available in the " 1665 "mapping table\n", __func__, 1666 port_change->dev_handle); 1667 continue; 1668 } 1669 if (sc->is_dpm_enable) { 1670 if (mt_entry->dpm_entry_num != 1671 MPR_DPM_BAD_IDX) { 1672 dpm_idx = mt_entry->dpm_entry_num; 1673 dpm_entry = (Mpi2DriverMap0Entry_t *) 1674 ((u8 *)sc->dpm_pg0 + hdr_sz); 1675 dpm_entry += dpm_idx; 1676 missing_cnt = dpm_entry-> 1677 MappingInformation & 1678 MPI2_DRVMAP0_MAPINFO_MISSING_MASK; 1679 temp64_var = dpm_entry-> 1680 PhysicalIdentifier.High; 1681 temp64_var = (temp64_var << 32) | 1682 dpm_entry->PhysicalIdentifier.Low; 1683 if ((mt_entry->physical_id == 1684 temp64_var) && !missing_cnt) 1685 mt_entry->init_complete = 1; 1686 } else { 1687 dpm_idx = _mapping_get_free_dpm_idx(sc); 1688 mt_entry->init_complete = 0; 1689 } 1690 if (dpm_idx != MPR_DPM_BAD_IDX && 1691 !mt_entry->init_complete) { 1692 mt_entry->init_complete = 1; 1693 mt_entry->dpm_entry_num = dpm_idx; 1694 dpm_entry = (Mpi2DriverMap0Entry_t *) 1695 ((u8 *)sc->dpm_pg0 + hdr_sz); 1696 dpm_entry += dpm_idx; 1697 dpm_entry->PhysicalIdentifier.Low = 1698 (0xFFFFFFFF & 1699 mt_entry->physical_id); 1700 dpm_entry->PhysicalIdentifier.High = 1701 (mt_entry->physical_id >> 32); 1702 dpm_entry->DeviceIndex = (U16) map_idx; 1703 dpm_entry->MappingInformation = 0; 1704 dpm_entry->PhysicalBitsMapping = 0; 1705 sc->dpm_entry_used[dpm_idx] = 1; 1706 sc->dpm_flush_entry[dpm_idx] = 1; 1707 port_change->is_processed = 1; 1708 } else if (dpm_idx == MPR_DPM_BAD_IDX) { 1709 port_change->is_processed = 1; 1710 mpr_dprint(sc, MPR_INFO, "%s: failed " 1711 "to add the device with handle " 1712 "0x%04x to persistent table " 1713 "because there is no free space " 1714 "available\n", __func__, 1715 port_change->dev_handle); 1716 } 1717 } 1718 mt_entry->init_complete = 1; 1719 } 1720 1721 port_change->is_processed = 1; 1722 } 1723 if (is_removed) 1724 _mapping_clear_removed_entries(sc); 1725 } 1726 1727 /** 1728 * _mapping_flush_dpm_pages -Flush the DPM pages to NVRAM 1729 * @sc: per adapter object 1730 * 1731 * Returns nothing 1732 */ 1733 static void 1734 _mapping_flush_dpm_pages(struct mpr_softc *sc) 1735 { 1736 Mpi2DriverMap0Entry_t *dpm_entry; 1737 Mpi2ConfigReply_t mpi_reply; 1738 Mpi2DriverMappingPage0_t config_page; 1739 u16 entry_num; 1740 1741 for (entry_num = 0; entry_num < sc->max_dpm_entries; entry_num++) { 1742 if (!sc->dpm_flush_entry[entry_num]) 1743 continue; 1744 memset(&config_page, 0, sizeof(Mpi2DriverMappingPage0_t)); 1745 memcpy(&config_page.Header, (u8 *)sc->dpm_pg0, 1746 sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER)); 1747 dpm_entry = (Mpi2DriverMap0Entry_t *) ((u8 *)sc->dpm_pg0 + 1748 sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER)); 1749 dpm_entry += entry_num; 1750 dpm_entry->MappingInformation = htole16(dpm_entry-> 1751 MappingInformation); 1752 dpm_entry->DeviceIndex = htole16(dpm_entry->DeviceIndex); 1753 dpm_entry->PhysicalBitsMapping = htole32(dpm_entry-> 1754 PhysicalBitsMapping); 1755 memcpy(&config_page.Entry, (u8 *)dpm_entry, 1756 sizeof(Mpi2DriverMap0Entry_t)); 1757 /* TODO-How to handle failed writes? */ 1758 if (mpr_config_set_dpm_pg0(sc, &mpi_reply, &config_page, 1759 entry_num)) { 1760 printf("%s: write of dpm entry %d for device failed\n", 1761 __func__, entry_num); 1762 } else 1763 sc->dpm_flush_entry[entry_num] = 0; 1764 dpm_entry->MappingInformation = le16toh(dpm_entry-> 1765 MappingInformation); 1766 dpm_entry->DeviceIndex = le16toh(dpm_entry->DeviceIndex); 1767 dpm_entry->PhysicalBitsMapping = le32toh(dpm_entry-> 1768 PhysicalBitsMapping); 1769 } 1770 } 1771 1772 /** 1773 * _mapping_allocate_memory- allocates the memory required for mapping tables 1774 * @sc: per adapter object 1775 * 1776 * Allocates the memory for all the tables required for host mapping 1777 * 1778 * Return 0 on success or non-zero on failure. 1779 */ 1780 int 1781 mpr_mapping_allocate_memory(struct mpr_softc *sc) 1782 { 1783 uint32_t dpm_pg0_sz; 1784 1785 sc->mapping_table = malloc((sizeof(struct dev_mapping_table) * 1786 sc->max_devices), M_MPR, M_ZERO|M_NOWAIT); 1787 if (!sc->mapping_table) 1788 goto free_resources; 1789 1790 sc->removal_table = malloc((sizeof(struct map_removal_table) * 1791 sc->max_devices), M_MPR, M_ZERO|M_NOWAIT); 1792 if (!sc->removal_table) 1793 goto free_resources; 1794 1795 sc->enclosure_table = malloc((sizeof(struct enc_mapping_table) * 1796 sc->max_enclosures), M_MPR, M_ZERO|M_NOWAIT); 1797 if (!sc->enclosure_table) 1798 goto free_resources; 1799 1800 sc->dpm_entry_used = malloc((sizeof(u8) * sc->max_dpm_entries), 1801 M_MPR, M_ZERO|M_NOWAIT); 1802 if (!sc->dpm_entry_used) 1803 goto free_resources; 1804 1805 sc->dpm_flush_entry = malloc((sizeof(u8) * sc->max_dpm_entries), 1806 M_MPR, M_ZERO|M_NOWAIT); 1807 if (!sc->dpm_flush_entry) 1808 goto free_resources; 1809 1810 dpm_pg0_sz = sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER) + 1811 (sc->max_dpm_entries * sizeof(MPI2_CONFIG_PAGE_DRIVER_MAP0_ENTRY)); 1812 1813 sc->dpm_pg0 = malloc(dpm_pg0_sz, M_MPR, M_ZERO|M_NOWAIT); 1814 if (!sc->dpm_pg0) { 1815 printf("%s: memory alloc failed for dpm page; disabling dpm\n", 1816 __func__); 1817 sc->is_dpm_enable = 0; 1818 } 1819 1820 return 0; 1821 1822 free_resources: 1823 free(sc->mapping_table, M_MPR); 1824 free(sc->removal_table, M_MPR); 1825 free(sc->enclosure_table, M_MPR); 1826 free(sc->dpm_entry_used, M_MPR); 1827 free(sc->dpm_flush_entry, M_MPR); 1828 free(sc->dpm_pg0, M_MPR); 1829 printf("%s: device initialization failed due to failure in mapping " 1830 "table memory allocation\n", __func__); 1831 return -1; 1832 } 1833 1834 /** 1835 * mpr_mapping_free_memory- frees the memory allocated for mapping tables 1836 * @sc: per adapter object 1837 * 1838 * Returns nothing. 1839 */ 1840 void 1841 mpr_mapping_free_memory(struct mpr_softc *sc) 1842 { 1843 free(sc->mapping_table, M_MPR); 1844 free(sc->removal_table, M_MPR); 1845 free(sc->enclosure_table, M_MPR); 1846 free(sc->dpm_entry_used, M_MPR); 1847 free(sc->dpm_flush_entry, M_MPR); 1848 free(sc->dpm_pg0, M_MPR); 1849 } 1850 1851 1852 static void 1853 _mapping_process_dpm_pg0(struct mpr_softc *sc) 1854 { 1855 u8 missing_cnt, enc_idx; 1856 u16 slot_id, entry_num, num_slots; 1857 u32 map_idx, dev_idx, start_idx, end_idx; 1858 struct dev_mapping_table *mt_entry; 1859 Mpi2DriverMap0Entry_t *dpm_entry; 1860 u16 ioc_pg8_flags = le16toh(sc->ioc_pg8.Flags); 1861 u16 max_num_phy_ids = le16toh(sc->ioc_pg8.MaxNumPhysicalMappedIDs); 1862 struct enc_mapping_table *et_entry; 1863 u64 physical_id; 1864 u32 phy_bits = 0; 1865 1866 if (sc->ir_firmware) 1867 _mapping_get_ir_maprange(sc, &start_idx, &end_idx); 1868 1869 dpm_entry = (Mpi2DriverMap0Entry_t *) ((uint8_t *) sc->dpm_pg0 + 1870 sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER)); 1871 for (entry_num = 0; entry_num < sc->max_dpm_entries; entry_num++, 1872 dpm_entry++) { 1873 physical_id = dpm_entry->PhysicalIdentifier.High; 1874 physical_id = (physical_id << 32) | 1875 dpm_entry->PhysicalIdentifier.Low; 1876 if (!physical_id) { 1877 sc->dpm_entry_used[entry_num] = 0; 1878 continue; 1879 } 1880 sc->dpm_entry_used[entry_num] = 1; 1881 dpm_entry->MappingInformation = le16toh(dpm_entry-> 1882 MappingInformation); 1883 missing_cnt = dpm_entry->MappingInformation & 1884 MPI2_DRVMAP0_MAPINFO_MISSING_MASK; 1885 dev_idx = le16toh(dpm_entry->DeviceIndex); 1886 phy_bits = le32toh(dpm_entry->PhysicalBitsMapping); 1887 if (sc->ir_firmware && (dev_idx >= start_idx) && 1888 (dev_idx <= end_idx)) { 1889 mt_entry = &sc->mapping_table[dev_idx]; 1890 mt_entry->physical_id = dpm_entry->PhysicalIdentifier.High; 1891 mt_entry->physical_id = (mt_entry->physical_id << 32) | 1892 dpm_entry->PhysicalIdentifier.Low; 1893 mt_entry->channel = MPR_RAID_CHANNEL; 1894 mt_entry->id = dev_idx; 1895 mt_entry->missing_count = missing_cnt; 1896 mt_entry->dpm_entry_num = entry_num; 1897 mt_entry->device_info = MPR_DEV_RESERVED; 1898 continue; 1899 } 1900 if ((ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) == 1901 MPI2_IOCPAGE8_FLAGS_ENCLOSURE_SLOT_MAPPING) { 1902 if (dev_idx < (sc->num_rsvd_entries + 1903 max_num_phy_ids)) { 1904 slot_id = 0; 1905 if (ioc_pg8_flags & 1906 MPI2_IOCPAGE8_FLAGS_DA_START_SLOT_1) 1907 slot_id = 1; 1908 num_slots = max_num_phy_ids; 1909 } else { 1910 slot_id = 0; 1911 num_slots = dpm_entry->MappingInformation & 1912 MPI2_DRVMAP0_MAPINFO_SLOT_MASK; 1913 num_slots >>= MPI2_DRVMAP0_MAPINFO_SLOT_SHIFT; 1914 } 1915 enc_idx = sc->num_enc_table_entries; 1916 if (enc_idx >= sc->max_enclosures) { 1917 printf("%s: enclosure entries exceed max " 1918 "enclosures of %d\n", __func__, 1919 sc->max_enclosures); 1920 break; 1921 } 1922 sc->num_enc_table_entries++; 1923 et_entry = &sc->enclosure_table[enc_idx]; 1924 physical_id = dpm_entry->PhysicalIdentifier.High; 1925 et_entry->enclosure_id = (physical_id << 32) | 1926 dpm_entry->PhysicalIdentifier.Low; 1927 et_entry->start_index = dev_idx; 1928 et_entry->dpm_entry_num = entry_num; 1929 et_entry->num_slots = num_slots; 1930 et_entry->start_slot = slot_id; 1931 et_entry->missing_count = missing_cnt; 1932 et_entry->phy_bits = phy_bits; 1933 1934 mt_entry = &sc->mapping_table[dev_idx]; 1935 for (map_idx = dev_idx; map_idx < (dev_idx + num_slots); 1936 map_idx++, mt_entry++) { 1937 if (mt_entry->dpm_entry_num != 1938 MPR_DPM_BAD_IDX) { 1939 printf("%s: conflict in mapping table " 1940 "for enclosure %d\n", __func__, 1941 enc_idx); 1942 break; 1943 } 1944 physical_id = dpm_entry->PhysicalIdentifier.High; 1945 mt_entry->physical_id = (physical_id << 32) | 1946 dpm_entry->PhysicalIdentifier.Low; 1947 mt_entry->phy_bits = phy_bits; 1948 mt_entry->channel = 0; 1949 mt_entry->id = dev_idx; 1950 mt_entry->dpm_entry_num = entry_num; 1951 mt_entry->missing_count = missing_cnt; 1952 mt_entry->device_info = MPR_DEV_RESERVED; 1953 } 1954 } else if ((ioc_pg8_flags & 1955 MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) == 1956 MPI2_IOCPAGE8_FLAGS_DEVICE_PERSISTENCE_MAPPING) { 1957 map_idx = dev_idx; 1958 mt_entry = &sc->mapping_table[map_idx]; 1959 if (mt_entry->dpm_entry_num != MPR_DPM_BAD_IDX) { 1960 printf("%s: conflict in mapping table for " 1961 "device %d\n", __func__, map_idx); 1962 break; 1963 } 1964 physical_id = dpm_entry->PhysicalIdentifier.High; 1965 mt_entry->physical_id = (physical_id << 32) | 1966 dpm_entry->PhysicalIdentifier.Low; 1967 mt_entry->phy_bits = phy_bits; 1968 mt_entry->channel = 0; 1969 mt_entry->id = dev_idx; 1970 mt_entry->missing_count = missing_cnt; 1971 mt_entry->dpm_entry_num = entry_num; 1972 mt_entry->device_info = MPR_DEV_RESERVED; 1973 } 1974 } /*close the loop for DPM table */ 1975 } 1976 1977 /* 1978 * mpr_mapping_check_devices - start of the day check for device availabilty 1979 * @sc: per adapter object 1980 * @sleep_flag: Flag indicating whether this function can sleep or not 1981 * 1982 * Returns nothing. 1983 */ 1984 void 1985 mpr_mapping_check_devices(struct mpr_softc *sc, int sleep_flag) 1986 { 1987 u32 i; 1988 /* u32 cntdn, i; 1989 u32 timeout = 60;*/ 1990 struct dev_mapping_table *mt_entry; 1991 u16 ioc_pg8_flags = le16toh(sc->ioc_pg8.Flags); 1992 struct enc_mapping_table *et_entry; 1993 u32 start_idx, end_idx; 1994 1995 /* We need to ucomment this when this function is called 1996 * from the port enable complete */ 1997 #if 0 1998 sc->track_mapping_events = 0; 1999 cntdn = (sleep_flag == CAN_SLEEP) ? 1000*timeout : 2000*timeout; 2000 do { 2001 if (!sc->pending_map_events) 2002 break; 2003 if (sleep_flag == CAN_SLEEP) 2004 pause("mpr_pause", (hz/1000));/* 1msec sleep */ 2005 else 2006 DELAY(500); /* 500 useconds delay */ 2007 } while (--cntdn); 2008 2009 2010 if (!cntdn) 2011 printf("%s: there are %d" 2012 " pending events after %d seconds of delay\n", 2013 __func__, sc->pending_map_events, timeout); 2014 #endif 2015 sc->pending_map_events = 0; 2016 2017 if ((ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) == 2018 MPI2_IOCPAGE8_FLAGS_ENCLOSURE_SLOT_MAPPING) { 2019 et_entry = sc->enclosure_table; 2020 for (i = 0; i < sc->num_enc_table_entries; i++, et_entry++) { 2021 if (!et_entry->init_complete) { 2022 if (et_entry->missing_count < 2023 MPR_MAX_MISSING_COUNT) { 2024 et_entry->missing_count++; 2025 if (et_entry->dpm_entry_num != 2026 MPR_DPM_BAD_IDX) 2027 _mapping_commit_enc_entry(sc, 2028 et_entry); 2029 } 2030 et_entry->init_complete = 1; 2031 } 2032 } 2033 if (!sc->ir_firmware) 2034 return; 2035 _mapping_get_ir_maprange(sc, &start_idx, &end_idx); 2036 mt_entry = &sc->mapping_table[start_idx]; 2037 for (i = start_idx; i < (end_idx + 1); i++, mt_entry++) { 2038 if (mt_entry->device_info & MPR_DEV_RESERVED 2039 && !mt_entry->physical_id) 2040 mt_entry->init_complete = 1; 2041 else if (mt_entry->device_info & MPR_DEV_RESERVED) { 2042 if (!mt_entry->init_complete) { 2043 if (mt_entry->missing_count < 2044 MPR_MAX_MISSING_COUNT) { 2045 mt_entry->missing_count++; 2046 if (mt_entry->dpm_entry_num != 2047 MPR_DPM_BAD_IDX) 2048 _mapping_commit_map_entry(sc, 2049 mt_entry); 2050 } 2051 mt_entry->init_complete = 1; 2052 } 2053 } 2054 } 2055 } else if ((ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) == 2056 MPI2_IOCPAGE8_FLAGS_DEVICE_PERSISTENCE_MAPPING) { 2057 mt_entry = sc->mapping_table; 2058 for (i = 0; i < sc->max_devices; i++, mt_entry++) { 2059 if (mt_entry->device_info & MPR_DEV_RESERVED 2060 && !mt_entry->physical_id) 2061 mt_entry->init_complete = 1; 2062 else if (mt_entry->device_info & MPR_DEV_RESERVED) { 2063 if (!mt_entry->init_complete) { 2064 if (mt_entry->missing_count < 2065 MPR_MAX_MISSING_COUNT) { 2066 mt_entry->missing_count++; 2067 if (mt_entry->dpm_entry_num != 2068 MPR_DPM_BAD_IDX) 2069 _mapping_commit_map_entry(sc, 2070 mt_entry); 2071 } 2072 mt_entry->init_complete = 1; 2073 } 2074 } 2075 } 2076 } 2077 } 2078 2079 2080 /** 2081 * mpr_mapping_is_reinit_required - check whether event replay required 2082 * @sc: per adapter object 2083 * 2084 * Checks the per ioc flags and decide whether reinit of events required 2085 * 2086 * Returns 1 for reinit of ioc 0 for not. 2087 */ 2088 int mpr_mapping_is_reinit_required(struct mpr_softc *sc) 2089 { 2090 if (!sc->mt_full_retry && sc->mt_add_device_failed) { 2091 sc->mt_full_retry = 1; 2092 sc->mt_add_device_failed = 0; 2093 _mapping_flush_dpm_pages(sc); 2094 return 1; 2095 } 2096 sc->mt_full_retry = 1; 2097 return 0; 2098 } 2099 2100 /** 2101 * mpr_mapping_initialize - initialize mapping tables 2102 * @sc: per adapter object 2103 * 2104 * Read controller persitant mapping tables into internal data area. 2105 * 2106 * Return 0 for success or non-zero for failure. 2107 */ 2108 int 2109 mpr_mapping_initialize(struct mpr_softc *sc) 2110 { 2111 uint16_t volume_mapping_flags, dpm_pg0_sz; 2112 uint32_t i; 2113 Mpi2ConfigReply_t mpi_reply; 2114 int error; 2115 uint8_t retry_count; 2116 uint16_t ioc_pg8_flags = le16toh(sc->ioc_pg8.Flags); 2117 2118 /* The additional 1 accounts for the virtual enclosure 2119 * created for the controller 2120 */ 2121 sc->max_enclosures = sc->facts->MaxEnclosures + 1; 2122 sc->max_expanders = sc->facts->MaxSasExpanders; 2123 sc->max_volumes = sc->facts->MaxVolumes; 2124 sc->max_devices = sc->facts->MaxTargets + sc->max_volumes; 2125 sc->pending_map_events = 0; 2126 sc->num_enc_table_entries = 0; 2127 sc->num_rsvd_entries = 0; 2128 sc->num_channels = 1; 2129 sc->max_dpm_entries = sc->ioc_pg8.MaxPersistentEntries; 2130 sc->is_dpm_enable = (sc->max_dpm_entries) ? 1 : 0; 2131 sc->track_mapping_events = 0; 2132 2133 if (ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_DISABLE_PERSISTENT_MAPPING) 2134 sc->is_dpm_enable = 0; 2135 2136 if (ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_RESERVED_TARGETID_0) 2137 sc->num_rsvd_entries = 1; 2138 2139 volume_mapping_flags = sc->ioc_pg8.IRVolumeMappingFlags & 2140 MPI2_IOCPAGE8_IRFLAGS_MASK_VOLUME_MAPPING_MODE; 2141 if (sc->ir_firmware && (volume_mapping_flags == 2142 MPI2_IOCPAGE8_IRFLAGS_LOW_VOLUME_MAPPING)) 2143 sc->num_rsvd_entries += sc->max_volumes; 2144 2145 error = mpr_mapping_allocate_memory(sc); 2146 if (error) 2147 return (error); 2148 2149 for (i = 0; i < sc->max_devices; i++) 2150 _mapping_clear_map_entry(sc->mapping_table + i); 2151 2152 for (i = 0; i < sc->max_enclosures; i++) 2153 _mapping_clear_enc_entry(sc->enclosure_table + i); 2154 2155 for (i = 0; i < sc->max_devices; i++) { 2156 sc->removal_table[i].dev_handle = 0; 2157 sc->removal_table[i].dpm_entry_num = MPR_DPM_BAD_IDX; 2158 } 2159 2160 memset(sc->dpm_entry_used, 0, sc->max_dpm_entries); 2161 memset(sc->dpm_flush_entry, 0, sc->max_dpm_entries); 2162 2163 if (sc->is_dpm_enable) { 2164 dpm_pg0_sz = sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER) + 2165 (sc->max_dpm_entries * 2166 sizeof(MPI2_CONFIG_PAGE_DRIVER_MAP0_ENTRY)); 2167 retry_count = 0; 2168 2169 retry_read_dpm: 2170 if (mpr_config_get_dpm_pg0(sc, &mpi_reply, sc->dpm_pg0, 2171 dpm_pg0_sz)) { 2172 printf("%s: dpm page read failed; disabling dpm\n", 2173 __func__); 2174 if (retry_count < 3) { 2175 retry_count++; 2176 goto retry_read_dpm; 2177 } 2178 sc->is_dpm_enable = 0; 2179 } 2180 } 2181 2182 if (sc->is_dpm_enable) 2183 _mapping_process_dpm_pg0(sc); 2184 2185 sc->track_mapping_events = 1; 2186 return 0; 2187 } 2188 2189 /** 2190 * mpr_mapping_exit - clear mapping table and associated memory 2191 * @sc: per adapter object 2192 * 2193 * Returns nothing. 2194 */ 2195 void 2196 mpr_mapping_exit(struct mpr_softc *sc) 2197 { 2198 _mapping_flush_dpm_pages(sc); 2199 mpr_mapping_free_memory(sc); 2200 } 2201 2202 /** 2203 * mpr_mapping_get_sas_id - assign a target id for sas device 2204 * @sc: per adapter object 2205 * @sas_address: sas address of the device 2206 * @handle: device handle 2207 * 2208 * Returns valid ID on success or BAD_ID. 2209 */ 2210 unsigned int 2211 mpr_mapping_get_sas_id(struct mpr_softc *sc, uint64_t sas_address, u16 handle) 2212 { 2213 u32 map_idx; 2214 struct dev_mapping_table *mt_entry; 2215 2216 for (map_idx = 0; map_idx < sc->max_devices; map_idx++) { 2217 mt_entry = &sc->mapping_table[map_idx]; 2218 if (mt_entry->dev_handle == handle && mt_entry->physical_id == 2219 sas_address) 2220 return mt_entry->id; 2221 } 2222 2223 return MPR_MAP_BAD_ID; 2224 } 2225 2226 /** 2227 * mpr_mapping_get_sas_id_from_handle - find a target id in mapping table using 2228 * only the dev handle. This is just a wrapper function for the local function 2229 * _mapping_get_mt_idx_from_handle. 2230 * @sc: per adapter object 2231 * @handle: device handle 2232 * 2233 * Returns valid ID on success or BAD_ID. 2234 */ 2235 unsigned int 2236 mpr_mapping_get_sas_id_from_handle(struct mpr_softc *sc, u16 handle) 2237 { 2238 return (_mapping_get_mt_idx_from_handle(sc, handle)); 2239 } 2240 2241 /** 2242 * mpr_mapping_get_raid_id - assign a target id for raid device 2243 * @sc: per adapter object 2244 * @wwid: world wide identifier for raid volume 2245 * @handle: device handle 2246 * 2247 * Returns valid ID on success or BAD_ID. 2248 */ 2249 unsigned int 2250 mpr_mapping_get_raid_id(struct mpr_softc *sc, u64 wwid, u16 handle) 2251 { 2252 u32 map_idx; 2253 struct dev_mapping_table *mt_entry; 2254 2255 for (map_idx = 0; map_idx < sc->max_devices; map_idx++) { 2256 mt_entry = &sc->mapping_table[map_idx]; 2257 if (mt_entry->dev_handle == handle && mt_entry->physical_id == 2258 wwid) 2259 return mt_entry->id; 2260 } 2261 2262 return MPR_MAP_BAD_ID; 2263 } 2264 2265 /** 2266 * mpr_mapping_get_raid_id_from_handle - find raid device in mapping table 2267 * using only the volume dev handle. This is just a wrapper function for the 2268 * local function _mapping_get_ir_mt_idx_from_handle. 2269 * @sc: per adapter object 2270 * @volHandle: volume device handle 2271 * 2272 * Returns valid ID on success or BAD_ID. 2273 */ 2274 unsigned int 2275 mpr_mapping_get_raid_id_from_handle(struct mpr_softc *sc, u16 volHandle) 2276 { 2277 return (_mapping_get_ir_mt_idx_from_handle(sc, volHandle)); 2278 } 2279 2280 /** 2281 * mpr_mapping_enclosure_dev_status_change_event - handle enclosure events 2282 * @sc: per adapter object 2283 * @event_data: event data payload 2284 * 2285 * Return nothing. 2286 */ 2287 void 2288 mpr_mapping_enclosure_dev_status_change_event(struct mpr_softc *sc, 2289 Mpi2EventDataSasEnclDevStatusChange_t *event_data) 2290 { 2291 u8 enc_idx, missing_count; 2292 struct enc_mapping_table *et_entry; 2293 Mpi2DriverMap0Entry_t *dpm_entry; 2294 u16 ioc_pg8_flags = le16toh(sc->ioc_pg8.Flags); 2295 u8 map_shift = MPI2_DRVMAP0_MAPINFO_SLOT_SHIFT; 2296 u8 update_phy_bits = 0; 2297 u32 saved_phy_bits; 2298 uint64_t temp64_var; 2299 2300 if ((ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) != 2301 MPI2_IOCPAGE8_FLAGS_ENCLOSURE_SLOT_MAPPING) 2302 goto out; 2303 2304 dpm_entry = (Mpi2DriverMap0Entry_t *)((u8 *)sc->dpm_pg0 + 2305 sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER)); 2306 2307 if (event_data->ReasonCode == MPI2_EVENT_SAS_ENCL_RC_ADDED) { 2308 if (!event_data->NumSlots) { 2309 printf("%s: enclosure with handle = 0x%x reported 0 " 2310 "slots\n", __func__, 2311 le16toh(event_data->EnclosureHandle)); 2312 goto out; 2313 } 2314 temp64_var = event_data->EnclosureLogicalID.High; 2315 temp64_var = (temp64_var << 32) | 2316 event_data->EnclosureLogicalID.Low; 2317 enc_idx = _mapping_get_enc_idx_from_id(sc, temp64_var, 2318 event_data->PhyBits); 2319 if (enc_idx != MPR_ENCTABLE_BAD_IDX) { 2320 et_entry = &sc->enclosure_table[enc_idx]; 2321 if (et_entry->init_complete && 2322 !et_entry->missing_count) { 2323 printf("%s: enclosure %d is already present " 2324 "with handle = 0x%x\n",__func__, enc_idx, 2325 et_entry->enc_handle); 2326 goto out; 2327 } 2328 et_entry->enc_handle = le16toh(event_data-> 2329 EnclosureHandle); 2330 et_entry->start_slot = le16toh(event_data->StartSlot); 2331 saved_phy_bits = et_entry->phy_bits; 2332 et_entry->phy_bits |= le32toh(event_data->PhyBits); 2333 if (saved_phy_bits != et_entry->phy_bits) 2334 update_phy_bits = 1; 2335 if (et_entry->missing_count || update_phy_bits) { 2336 et_entry->missing_count = 0; 2337 if (sc->is_dpm_enable && 2338 et_entry->dpm_entry_num != 2339 MPR_DPM_BAD_IDX) { 2340 dpm_entry += et_entry->dpm_entry_num; 2341 missing_count = 2342 (u8)(dpm_entry->MappingInformation & 2343 MPI2_DRVMAP0_MAPINFO_MISSING_MASK); 2344 if (!et_entry->init_complete && ( 2345 missing_count || update_phy_bits)) { 2346 dpm_entry->MappingInformation 2347 = et_entry->num_slots; 2348 dpm_entry->MappingInformation 2349 <<= map_shift; 2350 dpm_entry->PhysicalBitsMapping 2351 = et_entry->phy_bits; 2352 sc->dpm_flush_entry[et_entry-> 2353 dpm_entry_num] = 1; 2354 } 2355 } 2356 } 2357 } else { 2358 enc_idx = sc->num_enc_table_entries; 2359 if (enc_idx >= sc->max_enclosures) { 2360 printf("%s: enclosure can not be added; " 2361 "mapping table is full\n", __func__); 2362 goto out; 2363 } 2364 sc->num_enc_table_entries++; 2365 et_entry = &sc->enclosure_table[enc_idx]; 2366 et_entry->enc_handle = le16toh(event_data-> 2367 EnclosureHandle); 2368 et_entry->enclosure_id = event_data-> 2369 EnclosureLogicalID.High; 2370 et_entry->enclosure_id = ( et_entry->enclosure_id << 2371 32) | event_data->EnclosureLogicalID.Low; 2372 et_entry->start_index = MPR_MAPTABLE_BAD_IDX; 2373 et_entry->dpm_entry_num = MPR_DPM_BAD_IDX; 2374 et_entry->num_slots = le16toh(event_data->NumSlots); 2375 et_entry->start_slot = le16toh(event_data->StartSlot); 2376 et_entry->phy_bits = le32toh(event_data->PhyBits); 2377 } 2378 et_entry->init_complete = 1; 2379 } else if (event_data->ReasonCode == 2380 MPI2_EVENT_SAS_ENCL_RC_NOT_RESPONDING) { 2381 enc_idx = _mapping_get_enc_idx_from_handle(sc, 2382 le16toh(event_data->EnclosureHandle)); 2383 if (enc_idx == MPR_ENCTABLE_BAD_IDX) { 2384 printf("%s: cannot unmap enclosure %d because it has " 2385 "already been deleted", __func__, enc_idx); 2386 goto out; 2387 } 2388 et_entry = &sc->enclosure_table[enc_idx]; 2389 if (!et_entry->init_complete) { 2390 if (et_entry->missing_count < MPR_MAX_MISSING_COUNT) 2391 et_entry->missing_count++; 2392 else 2393 et_entry->init_complete = 1; 2394 } 2395 if (!et_entry->missing_count) 2396 et_entry->missing_count++; 2397 if (sc->is_dpm_enable && !et_entry->init_complete && 2398 et_entry->dpm_entry_num != MPR_DPM_BAD_IDX) { 2399 dpm_entry += et_entry->dpm_entry_num; 2400 dpm_entry->MappingInformation = et_entry->num_slots; 2401 dpm_entry->MappingInformation <<= map_shift; 2402 dpm_entry->MappingInformation |= 2403 et_entry->missing_count; 2404 sc->dpm_flush_entry[et_entry->dpm_entry_num] = 1; 2405 } 2406 et_entry->init_complete = 1; 2407 } 2408 2409 out: 2410 _mapping_flush_dpm_pages(sc); 2411 if (sc->pending_map_events) 2412 sc->pending_map_events--; 2413 } 2414 2415 /** 2416 * mpr_mapping_topology_change_event - handle topology change events 2417 * @sc: per adapter object 2418 * @event_data: event data payload 2419 * 2420 * Returns nothing. 2421 */ 2422 void 2423 mpr_mapping_topology_change_event(struct mpr_softc *sc, 2424 Mpi2EventDataSasTopologyChangeList_t *event_data) 2425 { 2426 struct _map_topology_change topo_change; 2427 struct _map_phy_change *phy_change; 2428 Mpi2EventSasTopoPhyEntry_t *event_phy_change; 2429 u8 i, num_entries; 2430 2431 topo_change.enc_handle = le16toh(event_data->EnclosureHandle); 2432 topo_change.exp_handle = le16toh(event_data->ExpanderDevHandle); 2433 num_entries = event_data->NumEntries; 2434 topo_change.num_entries = num_entries; 2435 topo_change.start_phy_num = event_data->StartPhyNum; 2436 topo_change.num_phys = event_data->NumPhys; 2437 topo_change.exp_status = event_data->ExpStatus; 2438 event_phy_change = event_data->PHY; 2439 topo_change.phy_details = NULL; 2440 2441 if (!num_entries) 2442 goto out; 2443 phy_change = malloc(sizeof(struct _map_phy_change) * num_entries, 2444 M_MPR, M_NOWAIT|M_ZERO); 2445 topo_change.phy_details = phy_change; 2446 if (!phy_change) 2447 goto out; 2448 for (i = 0; i < num_entries; i++, event_phy_change++, phy_change++) { 2449 phy_change->dev_handle = le16toh(event_phy_change-> 2450 AttachedDevHandle); 2451 phy_change->reason = event_phy_change->PhyStatus & 2452 MPI2_EVENT_SAS_TOPO_RC_MASK; 2453 } 2454 _mapping_update_missing_count(sc, &topo_change); 2455 _mapping_get_dev_info(sc, &topo_change); 2456 _mapping_clear_removed_entries(sc); 2457 _mapping_add_new_device(sc, &topo_change); 2458 2459 out: 2460 free(topo_change.phy_details, M_MPR); 2461 _mapping_flush_dpm_pages(sc); 2462 if (sc->pending_map_events) 2463 sc->pending_map_events--; 2464 } 2465 2466 /** 2467 * mpr_mapping_pcie_topology_change_event - handle PCIe topology change events 2468 * @sc: per adapter object 2469 * @event_data: event data payload 2470 * 2471 * Returns nothing. 2472 */ 2473 void 2474 mpr_mapping_pcie_topology_change_event(struct mpr_softc *sc, 2475 Mpi26EventDataPCIeTopologyChangeList_t *event_data) 2476 { 2477 struct _map_pcie_topology_change topo_change; 2478 struct _map_port_change *port_change; 2479 Mpi26EventPCIeTopoPortEntry_t *event_port_change; 2480 u8 i, num_entries; 2481 2482 topo_change.switch_dev_handle = le16toh(event_data->SwitchDevHandle); 2483 topo_change.enc_handle = le16toh(event_data->EnclosureHandle); 2484 num_entries = event_data->NumEntries; 2485 topo_change.num_entries = num_entries; 2486 topo_change.start_port_num = event_data->StartPortNum; 2487 topo_change.num_ports = event_data->NumPorts; 2488 topo_change.switch_status = event_data->SwitchStatus; 2489 event_port_change = event_data->PortEntry; 2490 topo_change.port_details = NULL; 2491 2492 if (!num_entries) 2493 goto out; 2494 port_change = malloc(sizeof(struct _map_port_change) * num_entries, 2495 M_MPR, M_NOWAIT|M_ZERO); 2496 topo_change.port_details = port_change; 2497 if (!port_change) 2498 goto out; 2499 for (i = 0; i < num_entries; i++, event_port_change++, port_change++) { 2500 port_change->dev_handle = le16toh(event_port_change-> 2501 AttachedDevHandle); 2502 port_change->reason = event_port_change->PortStatus; 2503 } 2504 _mapping_update_pcie_missing_count(sc, &topo_change); 2505 _mapping_get_pcie_dev_info(sc, &topo_change); 2506 _mapping_clear_removed_entries(sc); 2507 _mapping_add_new_pcie_device(sc, &topo_change); 2508 2509 out: 2510 free(topo_change.port_details, M_MPR); 2511 _mapping_flush_dpm_pages(sc); 2512 if (sc->pending_map_events) 2513 sc->pending_map_events--; 2514 } 2515 2516 /** 2517 * _mapping_check_update_ir_mt_idx - Check and update IR map table index 2518 * @sc: per adapter object 2519 * @event_data: event data payload 2520 * @evt_idx: current event index 2521 * @map_idx: current index and the place holder for new map table index 2522 * @wwid_table: world wide name for volumes in the element table 2523 * 2524 * pass through IR events and find whether any events matches and if so 2525 * tries to find new index if not returns failure 2526 * 2527 * Returns 0 on success and 1 on failure 2528 */ 2529 static int 2530 _mapping_check_update_ir_mt_idx(struct mpr_softc *sc, 2531 Mpi2EventDataIrConfigChangeList_t *event_data, int evt_idx, u32 *map_idx, 2532 u64 *wwid_table) 2533 { 2534 struct dev_mapping_table *mt_entry; 2535 u32 st_idx, end_idx, mt_idx = *map_idx; 2536 u8 match = 0; 2537 Mpi2EventIrConfigElement_t *element; 2538 u16 element_flags; 2539 int i; 2540 2541 mt_entry = &sc->mapping_table[mt_idx]; 2542 _mapping_get_ir_maprange(sc, &st_idx, &end_idx); 2543 search_again: 2544 match = 0; 2545 for (i = evt_idx + 1; i < event_data->NumElements; i++) { 2546 element = (Mpi2EventIrConfigElement_t *) 2547 &event_data->ConfigElement[i]; 2548 element_flags = le16toh(element->ElementFlags); 2549 if ((element_flags & 2550 MPI2_EVENT_IR_CHANGE_EFLAGS_ELEMENT_TYPE_MASK) != 2551 MPI2_EVENT_IR_CHANGE_EFLAGS_VOLUME_ELEMENT) 2552 continue; 2553 if (element->ReasonCode == MPI2_EVENT_IR_CHANGE_RC_ADDED || 2554 element->ReasonCode == 2555 MPI2_EVENT_IR_CHANGE_RC_VOLUME_CREATED) { 2556 if (mt_entry->physical_id == wwid_table[i]) { 2557 match = 1; 2558 break; 2559 } 2560 } 2561 } 2562 2563 if (match) { 2564 do { 2565 mt_idx++; 2566 if (mt_idx > end_idx) 2567 return 1; 2568 mt_entry = &sc->mapping_table[mt_idx]; 2569 } while (mt_entry->device_info & MPR_MAP_IN_USE); 2570 goto search_again; 2571 } 2572 *map_idx = mt_idx; 2573 return 0; 2574 } 2575 2576 /** 2577 * mpr_mapping_ir_config_change_event - handle IR config change list events 2578 * @sc: per adapter object 2579 * @event_data: event data payload 2580 * 2581 * Returns nothing. 2582 */ 2583 void 2584 mpr_mapping_ir_config_change_event(struct mpr_softc *sc, 2585 Mpi2EventDataIrConfigChangeList_t *event_data) 2586 { 2587 Mpi2EventIrConfigElement_t *element; 2588 int i; 2589 u64 *wwid_table; 2590 u32 map_idx, flags; 2591 struct dev_mapping_table *mt_entry; 2592 u16 element_flags; 2593 u8 log_full_error = 0; 2594 2595 wwid_table = malloc(sizeof(u64) * event_data->NumElements, M_MPR, 2596 M_NOWAIT | M_ZERO); 2597 if (!wwid_table) 2598 goto out; 2599 element = (Mpi2EventIrConfigElement_t *)&event_data->ConfigElement[0]; 2600 flags = le32toh(event_data->Flags); 2601 for (i = 0; i < event_data->NumElements; i++, element++) { 2602 element_flags = le16toh(element->ElementFlags); 2603 if ((element->ReasonCode != MPI2_EVENT_IR_CHANGE_RC_ADDED) && 2604 (element->ReasonCode != MPI2_EVENT_IR_CHANGE_RC_REMOVED) && 2605 (element->ReasonCode != MPI2_EVENT_IR_CHANGE_RC_NO_CHANGE) 2606 && (element->ReasonCode != 2607 MPI2_EVENT_IR_CHANGE_RC_VOLUME_CREATED)) 2608 continue; 2609 if ((element_flags & 2610 MPI2_EVENT_IR_CHANGE_EFLAGS_ELEMENT_TYPE_MASK) == 2611 MPI2_EVENT_IR_CHANGE_EFLAGS_VOLUME_ELEMENT) { 2612 mpr_config_get_volume_wwid(sc, 2613 le16toh(element->VolDevHandle), &wwid_table[i]); 2614 map_idx = _mapping_get_ir_mt_idx_from_wwid(sc, 2615 wwid_table[i]); 2616 if (map_idx != MPR_MAPTABLE_BAD_IDX) { 2617 mt_entry = &sc->mapping_table[map_idx]; 2618 mt_entry->device_info |= MPR_MAP_IN_USE; 2619 } 2620 } 2621 } 2622 if (flags == MPI2_EVENT_IR_CHANGE_FLAGS_FOREIGN_CONFIG) 2623 goto out; 2624 else { 2625 element = (Mpi2EventIrConfigElement_t *)&event_data-> 2626 ConfigElement[0]; 2627 for (i = 0; i < event_data->NumElements; i++, element++) { 2628 if (element->ReasonCode == 2629 MPI2_EVENT_IR_CHANGE_RC_ADDED || 2630 element->ReasonCode == 2631 MPI2_EVENT_IR_CHANGE_RC_VOLUME_CREATED) { 2632 map_idx = _mapping_get_ir_mt_idx_from_wwid 2633 (sc, wwid_table[i]); 2634 if (map_idx != MPR_MAPTABLE_BAD_IDX) { 2635 mt_entry = &sc->mapping_table[map_idx]; 2636 mt_entry->channel = MPR_RAID_CHANNEL; 2637 mt_entry->id = map_idx; 2638 mt_entry->dev_handle = le16toh 2639 (element->VolDevHandle); 2640 mt_entry->device_info = 2641 MPR_DEV_RESERVED | MPR_MAP_IN_USE; 2642 _mapping_update_ir_missing_cnt(sc, 2643 map_idx, element, wwid_table[i]); 2644 continue; 2645 } 2646 map_idx = _mapping_get_free_ir_mt_idx(sc); 2647 if (map_idx == MPR_MAPTABLE_BAD_IDX) 2648 log_full_error = 1; 2649 else if (i < (event_data->NumElements - 1)) { 2650 log_full_error = 2651 _mapping_check_update_ir_mt_idx 2652 (sc, event_data, i, &map_idx, 2653 wwid_table); 2654 } 2655 if (log_full_error) { 2656 printf("%s: no space to add the RAID " 2657 "volume with handle 0x%04x in " 2658 "mapping table\n", __func__, le16toh 2659 (element->VolDevHandle)); 2660 continue; 2661 } 2662 mt_entry = &sc->mapping_table[map_idx]; 2663 mt_entry->physical_id = wwid_table[i]; 2664 mt_entry->channel = MPR_RAID_CHANNEL; 2665 mt_entry->id = map_idx; 2666 mt_entry->dev_handle = le16toh(element-> 2667 VolDevHandle); 2668 mt_entry->device_info = MPR_DEV_RESERVED | 2669 MPR_MAP_IN_USE; 2670 mt_entry->init_complete = 0; 2671 _mapping_update_ir_missing_cnt(sc, map_idx, 2672 element, wwid_table[i]); 2673 } else if (element->ReasonCode == 2674 MPI2_EVENT_IR_CHANGE_RC_REMOVED) { 2675 map_idx = _mapping_get_ir_mt_idx_from_wwid(sc, 2676 wwid_table[i]); 2677 if (map_idx == MPR_MAPTABLE_BAD_IDX) { 2678 printf("%s: failed to remove a volume " 2679 "because it has already been " 2680 "removed\n", __func__); 2681 continue; 2682 } 2683 _mapping_update_ir_missing_cnt(sc, map_idx, 2684 element, wwid_table[i]); 2685 } else if (element->ReasonCode == 2686 MPI2_EVENT_IR_CHANGE_RC_VOLUME_DELETED) { 2687 map_idx = _mapping_get_mt_idx_from_handle(sc, 2688 le16toh(element->VolDevHandle)); 2689 if (map_idx == MPR_MAPTABLE_BAD_IDX) { 2690 printf("%s: failed to remove volume " 2691 "with handle 0x%04x because it has " 2692 "already been removed\n", __func__, 2693 le16toh(element->VolDevHandle)); 2694 continue; 2695 } 2696 mt_entry = &sc->mapping_table[map_idx]; 2697 _mapping_update_ir_missing_cnt(sc, map_idx, 2698 element, mt_entry->physical_id); 2699 } 2700 } 2701 } 2702 2703 out: 2704 _mapping_flush_dpm_pages(sc); 2705 free(wwid_table, M_MPR); 2706 if (sc->pending_map_events) 2707 sc->pending_map_events--; 2708 } 2709