1 /* 2 * Support PCI/PCIe on PowerNV platforms 3 * 4 * Copyright 2011 Benjamin Herrenschmidt, IBM Corp. 5 * 6 * This program is free software; you can redistribute it and/or 7 * modify it under the terms of the GNU General Public License 8 * as published by the Free Software Foundation; either version 9 * 2 of the License, or (at your option) any later version. 10 */ 11 12 #include <linux/kernel.h> 13 #include <linux/pci.h> 14 #include <linux/delay.h> 15 #include <linux/string.h> 16 #include <linux/init.h> 17 #include <linux/irq.h> 18 #include <linux/io.h> 19 #include <linux/msi.h> 20 #include <linux/iommu.h> 21 22 #include <asm/sections.h> 23 #include <asm/io.h> 24 #include <asm/prom.h> 25 #include <asm/pci-bridge.h> 26 #include <asm/machdep.h> 27 #include <asm/msi_bitmap.h> 28 #include <asm/ppc-pci.h> 29 #include <asm/opal.h> 30 #include <asm/iommu.h> 31 #include <asm/tce.h> 32 #include <asm/firmware.h> 33 #include <asm/eeh_event.h> 34 #include <asm/eeh.h> 35 36 #include "powernv.h" 37 #include "pci.h" 38 39 /* Delay in usec */ 40 #define PCI_RESET_DELAY_US 3000000 41 42 #define cfg_dbg(fmt...) do { } while(0) 43 //#define cfg_dbg(fmt...) printk(fmt) 44 45 #ifdef CONFIG_PCI_MSI 46 int pnv_setup_msi_irqs(struct pci_dev *pdev, int nvec, int type) 47 { 48 struct pci_controller *hose = pci_bus_to_host(pdev->bus); 49 struct pnv_phb *phb = hose->private_data; 50 struct msi_desc *entry; 51 struct msi_msg msg; 52 int hwirq; 53 unsigned int virq; 54 int rc; 55 56 if (WARN_ON(!phb) || !phb->msi_bmp.bitmap) 57 return -ENODEV; 58 59 if (pdev->no_64bit_msi && !phb->msi32_support) 60 return -ENODEV; 61 62 for_each_pci_msi_entry(entry, pdev) { 63 if (!entry->msi_attrib.is_64 && !phb->msi32_support) { 64 pr_warn("%s: Supports only 64-bit MSIs\n", 65 pci_name(pdev)); 66 return -ENXIO; 67 } 68 hwirq = msi_bitmap_alloc_hwirqs(&phb->msi_bmp, 1); 69 if (hwirq < 0) { 70 pr_warn("%s: Failed to find a free MSI\n", 71 pci_name(pdev)); 72 return -ENOSPC; 73 } 74 virq = irq_create_mapping(NULL, phb->msi_base + hwirq); 75 if (virq == NO_IRQ) { 76 pr_warn("%s: Failed to map MSI to linux irq\n", 77 pci_name(pdev)); 78 msi_bitmap_free_hwirqs(&phb->msi_bmp, hwirq, 1); 79 return -ENOMEM; 80 } 81 rc = phb->msi_setup(phb, pdev, phb->msi_base + hwirq, 82 virq, entry->msi_attrib.is_64, &msg); 83 if (rc) { 84 pr_warn("%s: Failed to setup MSI\n", pci_name(pdev)); 85 irq_dispose_mapping(virq); 86 msi_bitmap_free_hwirqs(&phb->msi_bmp, hwirq, 1); 87 return rc; 88 } 89 irq_set_msi_desc(virq, entry); 90 pci_write_msi_msg(virq, &msg); 91 } 92 return 0; 93 } 94 95 void pnv_teardown_msi_irqs(struct pci_dev *pdev) 96 { 97 struct pci_controller *hose = pci_bus_to_host(pdev->bus); 98 struct pnv_phb *phb = hose->private_data; 99 struct msi_desc *entry; 100 irq_hw_number_t hwirq; 101 102 if (WARN_ON(!phb)) 103 return; 104 105 for_each_pci_msi_entry(entry, pdev) { 106 if (entry->irq == NO_IRQ) 107 continue; 108 hwirq = virq_to_hw(entry->irq); 109 irq_set_msi_desc(entry->irq, NULL); 110 irq_dispose_mapping(entry->irq); 111 msi_bitmap_free_hwirqs(&phb->msi_bmp, hwirq - phb->msi_base, 1); 112 } 113 } 114 #endif /* CONFIG_PCI_MSI */ 115 116 static void pnv_pci_dump_p7ioc_diag_data(struct pci_controller *hose, 117 struct OpalIoPhbErrorCommon *common) 118 { 119 struct OpalIoP7IOCPhbErrorData *data; 120 int i; 121 122 data = (struct OpalIoP7IOCPhbErrorData *)common; 123 pr_info("P7IOC PHB#%d Diag-data (Version: %d)\n", 124 hose->global_number, be32_to_cpu(common->version)); 125 126 if (data->brdgCtl) 127 pr_info("brdgCtl: %08x\n", 128 be32_to_cpu(data->brdgCtl)); 129 if (data->portStatusReg || data->rootCmplxStatus || 130 data->busAgentStatus) 131 pr_info("UtlSts: %08x %08x %08x\n", 132 be32_to_cpu(data->portStatusReg), 133 be32_to_cpu(data->rootCmplxStatus), 134 be32_to_cpu(data->busAgentStatus)); 135 if (data->deviceStatus || data->slotStatus || 136 data->linkStatus || data->devCmdStatus || 137 data->devSecStatus) 138 pr_info("RootSts: %08x %08x %08x %08x %08x\n", 139 be32_to_cpu(data->deviceStatus), 140 be32_to_cpu(data->slotStatus), 141 be32_to_cpu(data->linkStatus), 142 be32_to_cpu(data->devCmdStatus), 143 be32_to_cpu(data->devSecStatus)); 144 if (data->rootErrorStatus || data->uncorrErrorStatus || 145 data->corrErrorStatus) 146 pr_info("RootErrSts: %08x %08x %08x\n", 147 be32_to_cpu(data->rootErrorStatus), 148 be32_to_cpu(data->uncorrErrorStatus), 149 be32_to_cpu(data->corrErrorStatus)); 150 if (data->tlpHdr1 || data->tlpHdr2 || 151 data->tlpHdr3 || data->tlpHdr4) 152 pr_info("RootErrLog: %08x %08x %08x %08x\n", 153 be32_to_cpu(data->tlpHdr1), 154 be32_to_cpu(data->tlpHdr2), 155 be32_to_cpu(data->tlpHdr3), 156 be32_to_cpu(data->tlpHdr4)); 157 if (data->sourceId || data->errorClass || 158 data->correlator) 159 pr_info("RootErrLog1: %08x %016llx %016llx\n", 160 be32_to_cpu(data->sourceId), 161 be64_to_cpu(data->errorClass), 162 be64_to_cpu(data->correlator)); 163 if (data->p7iocPlssr || data->p7iocCsr) 164 pr_info("PhbSts: %016llx %016llx\n", 165 be64_to_cpu(data->p7iocPlssr), 166 be64_to_cpu(data->p7iocCsr)); 167 if (data->lemFir) 168 pr_info("Lem: %016llx %016llx %016llx\n", 169 be64_to_cpu(data->lemFir), 170 be64_to_cpu(data->lemErrorMask), 171 be64_to_cpu(data->lemWOF)); 172 if (data->phbErrorStatus) 173 pr_info("PhbErr: %016llx %016llx %016llx %016llx\n", 174 be64_to_cpu(data->phbErrorStatus), 175 be64_to_cpu(data->phbFirstErrorStatus), 176 be64_to_cpu(data->phbErrorLog0), 177 be64_to_cpu(data->phbErrorLog1)); 178 if (data->mmioErrorStatus) 179 pr_info("OutErr: %016llx %016llx %016llx %016llx\n", 180 be64_to_cpu(data->mmioErrorStatus), 181 be64_to_cpu(data->mmioFirstErrorStatus), 182 be64_to_cpu(data->mmioErrorLog0), 183 be64_to_cpu(data->mmioErrorLog1)); 184 if (data->dma0ErrorStatus) 185 pr_info("InAErr: %016llx %016llx %016llx %016llx\n", 186 be64_to_cpu(data->dma0ErrorStatus), 187 be64_to_cpu(data->dma0FirstErrorStatus), 188 be64_to_cpu(data->dma0ErrorLog0), 189 be64_to_cpu(data->dma0ErrorLog1)); 190 if (data->dma1ErrorStatus) 191 pr_info("InBErr: %016llx %016llx %016llx %016llx\n", 192 be64_to_cpu(data->dma1ErrorStatus), 193 be64_to_cpu(data->dma1FirstErrorStatus), 194 be64_to_cpu(data->dma1ErrorLog0), 195 be64_to_cpu(data->dma1ErrorLog1)); 196 197 for (i = 0; i < OPAL_P7IOC_NUM_PEST_REGS; i++) { 198 if ((data->pestA[i] >> 63) == 0 && 199 (data->pestB[i] >> 63) == 0) 200 continue; 201 202 pr_info("PE[%3d] A/B: %016llx %016llx\n", 203 i, be64_to_cpu(data->pestA[i]), 204 be64_to_cpu(data->pestB[i])); 205 } 206 } 207 208 static void pnv_pci_dump_phb3_diag_data(struct pci_controller *hose, 209 struct OpalIoPhbErrorCommon *common) 210 { 211 struct OpalIoPhb3ErrorData *data; 212 int i; 213 214 data = (struct OpalIoPhb3ErrorData*)common; 215 pr_info("PHB3 PHB#%d Diag-data (Version: %d)\n", 216 hose->global_number, be32_to_cpu(common->version)); 217 if (data->brdgCtl) 218 pr_info("brdgCtl: %08x\n", 219 be32_to_cpu(data->brdgCtl)); 220 if (data->portStatusReg || data->rootCmplxStatus || 221 data->busAgentStatus) 222 pr_info("UtlSts: %08x %08x %08x\n", 223 be32_to_cpu(data->portStatusReg), 224 be32_to_cpu(data->rootCmplxStatus), 225 be32_to_cpu(data->busAgentStatus)); 226 if (data->deviceStatus || data->slotStatus || 227 data->linkStatus || data->devCmdStatus || 228 data->devSecStatus) 229 pr_info("RootSts: %08x %08x %08x %08x %08x\n", 230 be32_to_cpu(data->deviceStatus), 231 be32_to_cpu(data->slotStatus), 232 be32_to_cpu(data->linkStatus), 233 be32_to_cpu(data->devCmdStatus), 234 be32_to_cpu(data->devSecStatus)); 235 if (data->rootErrorStatus || data->uncorrErrorStatus || 236 data->corrErrorStatus) 237 pr_info("RootErrSts: %08x %08x %08x\n", 238 be32_to_cpu(data->rootErrorStatus), 239 be32_to_cpu(data->uncorrErrorStatus), 240 be32_to_cpu(data->corrErrorStatus)); 241 if (data->tlpHdr1 || data->tlpHdr2 || 242 data->tlpHdr3 || data->tlpHdr4) 243 pr_info("RootErrLog: %08x %08x %08x %08x\n", 244 be32_to_cpu(data->tlpHdr1), 245 be32_to_cpu(data->tlpHdr2), 246 be32_to_cpu(data->tlpHdr3), 247 be32_to_cpu(data->tlpHdr4)); 248 if (data->sourceId || data->errorClass || 249 data->correlator) 250 pr_info("RootErrLog1: %08x %016llx %016llx\n", 251 be32_to_cpu(data->sourceId), 252 be64_to_cpu(data->errorClass), 253 be64_to_cpu(data->correlator)); 254 if (data->nFir) 255 pr_info("nFir: %016llx %016llx %016llx\n", 256 be64_to_cpu(data->nFir), 257 be64_to_cpu(data->nFirMask), 258 be64_to_cpu(data->nFirWOF)); 259 if (data->phbPlssr || data->phbCsr) 260 pr_info("PhbSts: %016llx %016llx\n", 261 be64_to_cpu(data->phbPlssr), 262 be64_to_cpu(data->phbCsr)); 263 if (data->lemFir) 264 pr_info("Lem: %016llx %016llx %016llx\n", 265 be64_to_cpu(data->lemFir), 266 be64_to_cpu(data->lemErrorMask), 267 be64_to_cpu(data->lemWOF)); 268 if (data->phbErrorStatus) 269 pr_info("PhbErr: %016llx %016llx %016llx %016llx\n", 270 be64_to_cpu(data->phbErrorStatus), 271 be64_to_cpu(data->phbFirstErrorStatus), 272 be64_to_cpu(data->phbErrorLog0), 273 be64_to_cpu(data->phbErrorLog1)); 274 if (data->mmioErrorStatus) 275 pr_info("OutErr: %016llx %016llx %016llx %016llx\n", 276 be64_to_cpu(data->mmioErrorStatus), 277 be64_to_cpu(data->mmioFirstErrorStatus), 278 be64_to_cpu(data->mmioErrorLog0), 279 be64_to_cpu(data->mmioErrorLog1)); 280 if (data->dma0ErrorStatus) 281 pr_info("InAErr: %016llx %016llx %016llx %016llx\n", 282 be64_to_cpu(data->dma0ErrorStatus), 283 be64_to_cpu(data->dma0FirstErrorStatus), 284 be64_to_cpu(data->dma0ErrorLog0), 285 be64_to_cpu(data->dma0ErrorLog1)); 286 if (data->dma1ErrorStatus) 287 pr_info("InBErr: %016llx %016llx %016llx %016llx\n", 288 be64_to_cpu(data->dma1ErrorStatus), 289 be64_to_cpu(data->dma1FirstErrorStatus), 290 be64_to_cpu(data->dma1ErrorLog0), 291 be64_to_cpu(data->dma1ErrorLog1)); 292 293 for (i = 0; i < OPAL_PHB3_NUM_PEST_REGS; i++) { 294 if ((be64_to_cpu(data->pestA[i]) >> 63) == 0 && 295 (be64_to_cpu(data->pestB[i]) >> 63) == 0) 296 continue; 297 298 pr_info("PE[%3d] A/B: %016llx %016llx\n", 299 i, be64_to_cpu(data->pestA[i]), 300 be64_to_cpu(data->pestB[i])); 301 } 302 } 303 304 void pnv_pci_dump_phb_diag_data(struct pci_controller *hose, 305 unsigned char *log_buff) 306 { 307 struct OpalIoPhbErrorCommon *common; 308 309 if (!hose || !log_buff) 310 return; 311 312 common = (struct OpalIoPhbErrorCommon *)log_buff; 313 switch (be32_to_cpu(common->ioType)) { 314 case OPAL_PHB_ERROR_DATA_TYPE_P7IOC: 315 pnv_pci_dump_p7ioc_diag_data(hose, common); 316 break; 317 case OPAL_PHB_ERROR_DATA_TYPE_PHB3: 318 pnv_pci_dump_phb3_diag_data(hose, common); 319 break; 320 default: 321 pr_warn("%s: Unrecognized ioType %d\n", 322 __func__, be32_to_cpu(common->ioType)); 323 } 324 } 325 326 static void pnv_pci_handle_eeh_config(struct pnv_phb *phb, u32 pe_no) 327 { 328 unsigned long flags, rc; 329 int has_diag, ret = 0; 330 331 spin_lock_irqsave(&phb->lock, flags); 332 333 /* Fetch PHB diag-data */ 334 rc = opal_pci_get_phb_diag_data2(phb->opal_id, phb->diag.blob, 335 PNV_PCI_DIAG_BUF_SIZE); 336 has_diag = (rc == OPAL_SUCCESS); 337 338 /* If PHB supports compound PE, to handle it */ 339 if (phb->unfreeze_pe) { 340 ret = phb->unfreeze_pe(phb, 341 pe_no, 342 OPAL_EEH_ACTION_CLEAR_FREEZE_ALL); 343 } else { 344 rc = opal_pci_eeh_freeze_clear(phb->opal_id, 345 pe_no, 346 OPAL_EEH_ACTION_CLEAR_FREEZE_ALL); 347 if (rc) { 348 pr_warn("%s: Failure %ld clearing frozen " 349 "PHB#%x-PE#%x\n", 350 __func__, rc, phb->hose->global_number, 351 pe_no); 352 ret = -EIO; 353 } 354 } 355 356 /* 357 * For now, let's only display the diag buffer when we fail to clear 358 * the EEH status. We'll do more sensible things later when we have 359 * proper EEH support. We need to make sure we don't pollute ourselves 360 * with the normal errors generated when probing empty slots 361 */ 362 if (has_diag && ret) 363 pnv_pci_dump_phb_diag_data(phb->hose, phb->diag.blob); 364 365 spin_unlock_irqrestore(&phb->lock, flags); 366 } 367 368 static void pnv_pci_config_check_eeh(struct pci_dn *pdn) 369 { 370 struct pnv_phb *phb = pdn->phb->private_data; 371 u8 fstate; 372 __be16 pcierr; 373 int pe_no; 374 s64 rc; 375 376 /* 377 * Get the PE#. During the PCI probe stage, we might not 378 * setup that yet. So all ER errors should be mapped to 379 * reserved PE. 380 */ 381 pe_no = pdn->pe_number; 382 if (pe_no == IODA_INVALID_PE) { 383 if (phb->type == PNV_PHB_P5IOC2) 384 pe_no = 0; 385 else 386 pe_no = phb->ioda.reserved_pe; 387 } 388 389 /* 390 * Fetch frozen state. If the PHB support compound PE, 391 * we need handle that case. 392 */ 393 if (phb->get_pe_state) { 394 fstate = phb->get_pe_state(phb, pe_no); 395 } else { 396 rc = opal_pci_eeh_freeze_status(phb->opal_id, 397 pe_no, 398 &fstate, 399 &pcierr, 400 NULL); 401 if (rc) { 402 pr_warn("%s: Failure %lld getting PHB#%x-PE#%x state\n", 403 __func__, rc, phb->hose->global_number, pe_no); 404 return; 405 } 406 } 407 408 cfg_dbg(" -> EEH check, bdfn=%04x PE#%d fstate=%x\n", 409 (pdn->busno << 8) | (pdn->devfn), pe_no, fstate); 410 411 /* Clear the frozen state if applicable */ 412 if (fstate == OPAL_EEH_STOPPED_MMIO_FREEZE || 413 fstate == OPAL_EEH_STOPPED_DMA_FREEZE || 414 fstate == OPAL_EEH_STOPPED_MMIO_DMA_FREEZE) { 415 /* 416 * If PHB supports compound PE, freeze it for 417 * consistency. 418 */ 419 if (phb->freeze_pe) 420 phb->freeze_pe(phb, pe_no); 421 422 pnv_pci_handle_eeh_config(phb, pe_no); 423 } 424 } 425 426 int pnv_pci_cfg_read(struct pci_dn *pdn, 427 int where, int size, u32 *val) 428 { 429 struct pnv_phb *phb = pdn->phb->private_data; 430 u32 bdfn = (pdn->busno << 8) | pdn->devfn; 431 s64 rc; 432 433 switch (size) { 434 case 1: { 435 u8 v8; 436 rc = opal_pci_config_read_byte(phb->opal_id, bdfn, where, &v8); 437 *val = (rc == OPAL_SUCCESS) ? v8 : 0xff; 438 break; 439 } 440 case 2: { 441 __be16 v16; 442 rc = opal_pci_config_read_half_word(phb->opal_id, bdfn, where, 443 &v16); 444 *val = (rc == OPAL_SUCCESS) ? be16_to_cpu(v16) : 0xffff; 445 break; 446 } 447 case 4: { 448 __be32 v32; 449 rc = opal_pci_config_read_word(phb->opal_id, bdfn, where, &v32); 450 *val = (rc == OPAL_SUCCESS) ? be32_to_cpu(v32) : 0xffffffff; 451 break; 452 } 453 default: 454 return PCIBIOS_FUNC_NOT_SUPPORTED; 455 } 456 457 cfg_dbg("%s: bus: %x devfn: %x +%x/%x -> %08x\n", 458 __func__, pdn->busno, pdn->devfn, where, size, *val); 459 return PCIBIOS_SUCCESSFUL; 460 } 461 462 int pnv_pci_cfg_write(struct pci_dn *pdn, 463 int where, int size, u32 val) 464 { 465 struct pnv_phb *phb = pdn->phb->private_data; 466 u32 bdfn = (pdn->busno << 8) | pdn->devfn; 467 468 cfg_dbg("%s: bus: %x devfn: %x +%x/%x -> %08x\n", 469 pdn->busno, pdn->devfn, where, size, val); 470 switch (size) { 471 case 1: 472 opal_pci_config_write_byte(phb->opal_id, bdfn, where, val); 473 break; 474 case 2: 475 opal_pci_config_write_half_word(phb->opal_id, bdfn, where, val); 476 break; 477 case 4: 478 opal_pci_config_write_word(phb->opal_id, bdfn, where, val); 479 break; 480 default: 481 return PCIBIOS_FUNC_NOT_SUPPORTED; 482 } 483 484 return PCIBIOS_SUCCESSFUL; 485 } 486 487 #if CONFIG_EEH 488 static bool pnv_pci_cfg_check(struct pci_dn *pdn) 489 { 490 struct eeh_dev *edev = NULL; 491 struct pnv_phb *phb = pdn->phb->private_data; 492 493 /* EEH not enabled ? */ 494 if (!(phb->flags & PNV_PHB_FLAG_EEH)) 495 return true; 496 497 /* PE reset or device removed ? */ 498 edev = pdn->edev; 499 if (edev) { 500 if (edev->pe && 501 (edev->pe->state & EEH_PE_CFG_BLOCKED)) 502 return false; 503 504 if (edev->mode & EEH_DEV_REMOVED) 505 return false; 506 } 507 508 return true; 509 } 510 #else 511 static inline pnv_pci_cfg_check(struct pci_dn *pdn) 512 { 513 return true; 514 } 515 #endif /* CONFIG_EEH */ 516 517 static int pnv_pci_read_config(struct pci_bus *bus, 518 unsigned int devfn, 519 int where, int size, u32 *val) 520 { 521 struct pci_dn *pdn; 522 struct pnv_phb *phb; 523 int ret; 524 525 *val = 0xFFFFFFFF; 526 pdn = pci_get_pdn_by_devfn(bus, devfn); 527 if (!pdn) 528 return PCIBIOS_DEVICE_NOT_FOUND; 529 530 if (!pnv_pci_cfg_check(pdn)) 531 return PCIBIOS_DEVICE_NOT_FOUND; 532 533 ret = pnv_pci_cfg_read(pdn, where, size, val); 534 phb = pdn->phb->private_data; 535 if (phb->flags & PNV_PHB_FLAG_EEH && pdn->edev) { 536 if (*val == EEH_IO_ERROR_VALUE(size) && 537 eeh_dev_check_failure(pdn->edev)) 538 return PCIBIOS_DEVICE_NOT_FOUND; 539 } else { 540 pnv_pci_config_check_eeh(pdn); 541 } 542 543 return ret; 544 } 545 546 static int pnv_pci_write_config(struct pci_bus *bus, 547 unsigned int devfn, 548 int where, int size, u32 val) 549 { 550 struct pci_dn *pdn; 551 struct pnv_phb *phb; 552 int ret; 553 554 pdn = pci_get_pdn_by_devfn(bus, devfn); 555 if (!pdn) 556 return PCIBIOS_DEVICE_NOT_FOUND; 557 558 if (!pnv_pci_cfg_check(pdn)) 559 return PCIBIOS_DEVICE_NOT_FOUND; 560 561 ret = pnv_pci_cfg_write(pdn, where, size, val); 562 phb = pdn->phb->private_data; 563 if (!(phb->flags & PNV_PHB_FLAG_EEH)) 564 pnv_pci_config_check_eeh(pdn); 565 566 return ret; 567 } 568 569 struct pci_ops pnv_pci_ops = { 570 .read = pnv_pci_read_config, 571 .write = pnv_pci_write_config, 572 }; 573 574 static __be64 *pnv_tce(struct iommu_table *tbl, long idx) 575 { 576 __be64 *tmp = ((__be64 *)tbl->it_base); 577 int level = tbl->it_indirect_levels; 578 const long shift = ilog2(tbl->it_level_size); 579 unsigned long mask = (tbl->it_level_size - 1) << (level * shift); 580 581 while (level) { 582 int n = (idx & mask) >> (level * shift); 583 unsigned long tce = be64_to_cpu(tmp[n]); 584 585 tmp = __va(tce & ~(TCE_PCI_READ | TCE_PCI_WRITE)); 586 idx &= ~mask; 587 mask >>= shift; 588 --level; 589 } 590 591 return tmp + idx; 592 } 593 594 int pnv_tce_build(struct iommu_table *tbl, long index, long npages, 595 unsigned long uaddr, enum dma_data_direction direction, 596 struct dma_attrs *attrs) 597 { 598 u64 proto_tce = iommu_direction_to_tce_perm(direction); 599 u64 rpn = __pa(uaddr) >> tbl->it_page_shift; 600 long i; 601 602 if (proto_tce & TCE_PCI_WRITE) 603 proto_tce |= TCE_PCI_READ; 604 605 for (i = 0; i < npages; i++) { 606 unsigned long newtce = proto_tce | 607 ((rpn + i) << tbl->it_page_shift); 608 unsigned long idx = index - tbl->it_offset + i; 609 610 *(pnv_tce(tbl, idx)) = cpu_to_be64(newtce); 611 } 612 613 return 0; 614 } 615 616 #ifdef CONFIG_IOMMU_API 617 int pnv_tce_xchg(struct iommu_table *tbl, long index, 618 unsigned long *hpa, enum dma_data_direction *direction) 619 { 620 u64 proto_tce = iommu_direction_to_tce_perm(*direction); 621 unsigned long newtce = *hpa | proto_tce, oldtce; 622 unsigned long idx = index - tbl->it_offset; 623 624 BUG_ON(*hpa & ~IOMMU_PAGE_MASK(tbl)); 625 626 if (newtce & TCE_PCI_WRITE) 627 newtce |= TCE_PCI_READ; 628 629 oldtce = xchg(pnv_tce(tbl, idx), cpu_to_be64(newtce)); 630 *hpa = be64_to_cpu(oldtce) & ~(TCE_PCI_READ | TCE_PCI_WRITE); 631 *direction = iommu_tce_direction(oldtce); 632 633 return 0; 634 } 635 #endif 636 637 void pnv_tce_free(struct iommu_table *tbl, long index, long npages) 638 { 639 long i; 640 641 for (i = 0; i < npages; i++) { 642 unsigned long idx = index - tbl->it_offset + i; 643 644 *(pnv_tce(tbl, idx)) = cpu_to_be64(0); 645 } 646 } 647 648 unsigned long pnv_tce_get(struct iommu_table *tbl, long index) 649 { 650 return *(pnv_tce(tbl, index - tbl->it_offset)); 651 } 652 653 struct iommu_table *pnv_pci_table_alloc(int nid) 654 { 655 struct iommu_table *tbl; 656 657 tbl = kzalloc_node(sizeof(struct iommu_table), GFP_KERNEL, nid); 658 INIT_LIST_HEAD_RCU(&tbl->it_group_list); 659 660 return tbl; 661 } 662 663 long pnv_pci_link_table_and_group(int node, int num, 664 struct iommu_table *tbl, 665 struct iommu_table_group *table_group) 666 { 667 struct iommu_table_group_link *tgl = NULL; 668 669 if (WARN_ON(!tbl || !table_group)) 670 return -EINVAL; 671 672 tgl = kzalloc_node(sizeof(struct iommu_table_group_link), GFP_KERNEL, 673 node); 674 if (!tgl) 675 return -ENOMEM; 676 677 tgl->table_group = table_group; 678 list_add_rcu(&tgl->next, &tbl->it_group_list); 679 680 table_group->tables[num] = tbl; 681 682 return 0; 683 } 684 685 static void pnv_iommu_table_group_link_free(struct rcu_head *head) 686 { 687 struct iommu_table_group_link *tgl = container_of(head, 688 struct iommu_table_group_link, rcu); 689 690 kfree(tgl); 691 } 692 693 void pnv_pci_unlink_table_and_group(struct iommu_table *tbl, 694 struct iommu_table_group *table_group) 695 { 696 long i; 697 bool found; 698 struct iommu_table_group_link *tgl; 699 700 if (!tbl || !table_group) 701 return; 702 703 /* Remove link to a group from table's list of attached groups */ 704 found = false; 705 list_for_each_entry_rcu(tgl, &tbl->it_group_list, next) { 706 if (tgl->table_group == table_group) { 707 list_del_rcu(&tgl->next); 708 call_rcu(&tgl->rcu, pnv_iommu_table_group_link_free); 709 found = true; 710 break; 711 } 712 } 713 if (WARN_ON(!found)) 714 return; 715 716 /* Clean a pointer to iommu_table in iommu_table_group::tables[] */ 717 found = false; 718 for (i = 0; i < IOMMU_TABLE_GROUP_MAX_TABLES; ++i) { 719 if (table_group->tables[i] == tbl) { 720 table_group->tables[i] = NULL; 721 found = true; 722 break; 723 } 724 } 725 WARN_ON(!found); 726 } 727 728 void pnv_pci_setup_iommu_table(struct iommu_table *tbl, 729 void *tce_mem, u64 tce_size, 730 u64 dma_offset, unsigned page_shift) 731 { 732 tbl->it_blocksize = 16; 733 tbl->it_base = (unsigned long)tce_mem; 734 tbl->it_page_shift = page_shift; 735 tbl->it_offset = dma_offset >> tbl->it_page_shift; 736 tbl->it_index = 0; 737 tbl->it_size = tce_size >> 3; 738 tbl->it_busno = 0; 739 tbl->it_type = TCE_PCI; 740 } 741 742 void pnv_pci_dma_dev_setup(struct pci_dev *pdev) 743 { 744 struct pci_controller *hose = pci_bus_to_host(pdev->bus); 745 struct pnv_phb *phb = hose->private_data; 746 #ifdef CONFIG_PCI_IOV 747 struct pnv_ioda_pe *pe; 748 struct pci_dn *pdn; 749 750 /* Fix the VF pdn PE number */ 751 if (pdev->is_virtfn) { 752 pdn = pci_get_pdn(pdev); 753 WARN_ON(pdn->pe_number != IODA_INVALID_PE); 754 list_for_each_entry(pe, &phb->ioda.pe_list, list) { 755 if (pe->rid == ((pdev->bus->number << 8) | 756 (pdev->devfn & 0xff))) { 757 pdn->pe_number = pe->pe_number; 758 pe->pdev = pdev; 759 break; 760 } 761 } 762 } 763 #endif /* CONFIG_PCI_IOV */ 764 765 if (phb && phb->dma_dev_setup) 766 phb->dma_dev_setup(phb, pdev); 767 } 768 769 void pnv_pci_dma_bus_setup(struct pci_bus *bus) 770 { 771 struct pci_controller *hose = bus->sysdata; 772 struct pnv_phb *phb = hose->private_data; 773 struct pnv_ioda_pe *pe; 774 775 list_for_each_entry(pe, &phb->ioda.pe_list, list) { 776 if (!(pe->flags & (PNV_IODA_PE_BUS | PNV_IODA_PE_BUS_ALL))) 777 continue; 778 779 if (!pe->pbus) 780 continue; 781 782 if (bus->number == ((pe->rid >> 8) & 0xFF)) { 783 pe->pbus = bus; 784 break; 785 } 786 } 787 } 788 789 void pnv_pci_shutdown(void) 790 { 791 struct pci_controller *hose; 792 793 list_for_each_entry(hose, &hose_list, list_node) 794 if (hose->controller_ops.shutdown) 795 hose->controller_ops.shutdown(hose); 796 } 797 798 /* Fixup wrong class code in p7ioc and p8 root complex */ 799 static void pnv_p7ioc_rc_quirk(struct pci_dev *dev) 800 { 801 dev->class = PCI_CLASS_BRIDGE_PCI << 8; 802 } 803 DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_IBM, 0x3b9, pnv_p7ioc_rc_quirk); 804 805 void __init pnv_pci_init(void) 806 { 807 struct device_node *np; 808 bool found_ioda = false; 809 810 pci_add_flags(PCI_CAN_SKIP_ISA_ALIGN); 811 812 /* If we don't have OPAL, eg. in sim, just skip PCI probe */ 813 if (!firmware_has_feature(FW_FEATURE_OPAL)) 814 return; 815 816 /* Look for IODA IO-Hubs. We don't support mixing IODA 817 * and p5ioc2 due to the need to change some global 818 * probing flags 819 */ 820 for_each_compatible_node(np, NULL, "ibm,ioda-hub") { 821 pnv_pci_init_ioda_hub(np); 822 found_ioda = true; 823 } 824 825 /* Look for p5ioc2 IO-Hubs */ 826 if (!found_ioda) 827 for_each_compatible_node(np, NULL, "ibm,p5ioc2") 828 pnv_pci_init_p5ioc2_hub(np); 829 830 /* Look for ioda2 built-in PHB3's */ 831 for_each_compatible_node(np, NULL, "ibm,ioda2-phb") 832 pnv_pci_init_ioda2_phb(np); 833 834 /* Look for NPU PHBs */ 835 for_each_compatible_node(np, NULL, "ibm,ioda2-npu-phb") 836 pnv_pci_init_npu_phb(np); 837 838 /* Setup the linkage between OF nodes and PHBs */ 839 pci_devs_phb_init(); 840 841 /* Configure IOMMU DMA hooks */ 842 set_pci_dma_ops(&dma_iommu_ops); 843 } 844 845 machine_subsys_initcall_sync(powernv, tce_iommu_bus_notifier_init); 846