drivers/pci/controller/dwc/pcie-designware-host.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * Synopsys DesignWare PCIe host controller driver
   4  *
   5  * Copyright (C) 2013 Samsung Electronics Co., Ltd.
   6  *              https://www.samsung.com
   7  *
   8  * Author: Jingoo Han <jg1.han@samsung.com>
   9  */
  10
  11 #include <linux/irqchip/chained_irq.h>
  12 #include <linux/irqdomain.h>
  13 #include <linux/msi.h>
  14 #include <linux/of_address.h>
  15 #include <linux/of_pci.h>
  16 #include <linux/pci_regs.h>
  17 #include <linux/platform_device.h>
  18
  19 #include "../../pci.h"
  20 #include "pcie-designware.h"
  21
  22 static struct pci_ops dw_pcie_ops;
  23 static struct pci_ops dw_child_pcie_ops;
  24
  25 static void dw_msi_ack_irq(struct irq_data *d)
  26 {
  27         irq_chip_ack_parent(d);
  28 }
  29
  30 static void dw_msi_mask_irq(struct irq_data *d)
  31 {
  32         pci_msi_mask_irq(d);
  33         irq_chip_mask_parent(d);
  34 }
  35
  36 static void dw_msi_unmask_irq(struct irq_data *d)
  37 {
  38         pci_msi_unmask_irq(d);
  39         irq_chip_unmask_parent(d);
  40 }
  41
  42 static struct irq_chip dw_pcie_msi_irq_chip = {
  43         .name = "PCI-MSI",
  44         .irq_ack = dw_msi_ack_irq,
  45         .irq_mask = dw_msi_mask_irq,
  46         .irq_unmask = dw_msi_unmask_irq,
  47 };
  48
  49 static struct msi_domain_info dw_pcie_msi_domain_info = {
  50         .flags  = (MSI_FLAG_USE_DEF_DOM_OPS | MSI_FLAG_USE_DEF_CHIP_OPS |
  51                    MSI_FLAG_PCI_MSIX | MSI_FLAG_MULTI_PCI_MSI),
  52         .chip   = &dw_pcie_msi_irq_chip,
  53 };
  54
  55 /* MSI int handler */
  56 irqreturn_t dw_handle_msi_irq(struct pcie_port *pp)
  57 {
  58         int i, pos, irq;
  59         unsigned long val;
  60         u32 status, num_ctrls;
  61         irqreturn_t ret = IRQ_NONE;
  62         struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
  63
  64         num_ctrls = pp->num_vectors / MAX_MSI_IRQS_PER_CTRL;
  65
  66         for (i = 0; i < num_ctrls; i++) {
  67                 status = dw_pcie_readl_dbi(pci, PCIE_MSI_INTR0_STATUS +
  68                                            (i * MSI_REG_CTRL_BLOCK_SIZE));
  69                 if (!status)
  70                         continue;
  71
  72                 ret = IRQ_HANDLED;
  73                 val = status;
  74                 pos = 0;
  75                 while ((pos = find_next_bit(&val, MAX_MSI_IRQS_PER_CTRL,
  76                                             pos)) != MAX_MSI_IRQS_PER_CTRL) {
  77                         irq = irq_find_mapping(pp->irq_domain,
  78                                                (i * MAX_MSI_IRQS_PER_CTRL) +
  79                                                pos);
  80                         generic_handle_irq(irq);
  81                         pos++;
  82                 }
  83         }
  84
  85         return ret;
  86 }
  87
  88 /* Chained MSI interrupt service routine */
  89 static void dw_chained_msi_isr(struct irq_desc *desc)
  90 {
  91         struct irq_chip *chip = irq_desc_get_chip(desc);
  92         struct pcie_port *pp;
  93
  94         chained_irq_enter(chip, desc);
  95
  96         pp = irq_desc_get_handler_data(desc);
  97         dw_handle_msi_irq(pp);
  98
  99         chained_irq_exit(chip, desc);
 100 }
 101
 102 static void dw_pci_setup_msi_msg(struct irq_data *d, struct msi_msg *msg)
 103 {
 104         struct pcie_port *pp = irq_data_get_irq_chip_data(d);
 105         struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 106         u64 msi_target;
 107
 108         msi_target = (u64)pp->msi_data;
 109
 110         msg->address_lo = lower_32_bits(msi_target);
 111         msg->address_hi = upper_32_bits(msi_target);
 112
 113         msg->data = d->hwirq;
 114
 115         dev_dbg(pci->dev, "msi#%d address_hi %#x address_lo %#x\n",
 116                 (int)d->hwirq, msg->address_hi, msg->address_lo);
 117 }
 118
 119 static int dw_pci_msi_set_affinity(struct irq_data *d,
 120                                    const struct cpumask *mask, bool force)
 121 {
 122         return -EINVAL;
 123 }
 124
 125 static void dw_pci_bottom_mask(struct irq_data *d)
 126 {
 127         struct pcie_port *pp = irq_data_get_irq_chip_data(d);
 128         struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 129         unsigned int res, bit, ctrl;
 130         unsigned long flags;
 131
 132         raw_spin_lock_irqsave(&pp->lock, flags);
 133
 134         ctrl = d->hwirq / MAX_MSI_IRQS_PER_CTRL;
 135         res = ctrl * MSI_REG_CTRL_BLOCK_SIZE;
 136         bit = d->hwirq % MAX_MSI_IRQS_PER_CTRL;
 137
 138         pp->irq_mask[ctrl] |= BIT(bit);
 139         dw_pcie_writel_dbi(pci, PCIE_MSI_INTR0_MASK + res, pp->irq_mask[ctrl]);
 140
 141         raw_spin_unlock_irqrestore(&pp->lock, flags);
 142 }
 143
 144 static void dw_pci_bottom_unmask(struct irq_data *d)
 145 {
 146         struct pcie_port *pp = irq_data_get_irq_chip_data(d);
 147         struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 148         unsigned int res, bit, ctrl;
 149         unsigned long flags;
 150
 151         raw_spin_lock_irqsave(&pp->lock, flags);
 152
 153         ctrl = d->hwirq / MAX_MSI_IRQS_PER_CTRL;
 154         res = ctrl * MSI_REG_CTRL_BLOCK_SIZE;
 155         bit = d->hwirq % MAX_MSI_IRQS_PER_CTRL;
 156
 157         pp->irq_mask[ctrl] &= ~BIT(bit);
 158         dw_pcie_writel_dbi(pci, PCIE_MSI_INTR0_MASK + res, pp->irq_mask[ctrl]);
 159
 160         raw_spin_unlock_irqrestore(&pp->lock, flags);
 161 }
 162
 163 static void dw_pci_bottom_ack(struct irq_data *d)
 164 {
 165         struct pcie_port *pp  = irq_data_get_irq_chip_data(d);
 166         struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 167         unsigned int res, bit, ctrl;
 168
 169         ctrl = d->hwirq / MAX_MSI_IRQS_PER_CTRL;
 170         res = ctrl * MSI_REG_CTRL_BLOCK_SIZE;
 171         bit = d->hwirq % MAX_MSI_IRQS_PER_CTRL;
 172
 173         dw_pcie_writel_dbi(pci, PCIE_MSI_INTR0_STATUS + res, BIT(bit));
 174 }
 175
 176 static struct irq_chip dw_pci_msi_bottom_irq_chip = {
 177         .name = "DWPCI-MSI",
 178         .irq_ack = dw_pci_bottom_ack,
 179         .irq_compose_msi_msg = dw_pci_setup_msi_msg,
 180         .irq_set_affinity = dw_pci_msi_set_affinity,
 181         .irq_mask = dw_pci_bottom_mask,
 182         .irq_unmask = dw_pci_bottom_unmask,
 183 };
 184
 185 static int dw_pcie_irq_domain_alloc(struct irq_domain *domain,
 186                                     unsigned int virq, unsigned int nr_irqs,
 187                                     void *args)
 188 {
 189         struct pcie_port *pp = domain->host_data;
 190         unsigned long flags;
 191         u32 i;
 192         int bit;
 193
 194         raw_spin_lock_irqsave(&pp->lock, flags);
 195
 196         bit = bitmap_find_free_region(pp->msi_irq_in_use, pp->num_vectors,
 197                                       order_base_2(nr_irqs));
 198
 199         raw_spin_unlock_irqrestore(&pp->lock, flags);
 200
 201         if (bit < 0)
 202                 return -ENOSPC;
 203
 204         for (i = 0; i < nr_irqs; i++)
 205                 irq_domain_set_info(domain, virq + i, bit + i,
 206                                     pp->msi_irq_chip,
 207                                     pp, handle_edge_irq,
 208                                     NULL, NULL);
 209
 210         return 0;
 211 }
 212
 213 static void dw_pcie_irq_domain_free(struct irq_domain *domain,
 214                                     unsigned int virq, unsigned int nr_irqs)
 215 {
 216         struct irq_data *d = irq_domain_get_irq_data(domain, virq);
 217         struct pcie_port *pp = domain->host_data;
 218         unsigned long flags;
 219
 220         raw_spin_lock_irqsave(&pp->lock, flags);
 221
 222         bitmap_release_region(pp->msi_irq_in_use, d->hwirq,
 223                               order_base_2(nr_irqs));
 224
 225         raw_spin_unlock_irqrestore(&pp->lock, flags);
 226 }
 227
 228 static const struct irq_domain_ops dw_pcie_msi_domain_ops = {
 229         .alloc  = dw_pcie_irq_domain_alloc,
 230         .free   = dw_pcie_irq_domain_free,
 231 };
 232
 233 int dw_pcie_allocate_domains(struct pcie_port *pp)
 234 {
 235         struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 236         struct fwnode_handle *fwnode = of_node_to_fwnode(pci->dev->of_node);
 237
 238         pp->irq_domain = irq_domain_create_linear(fwnode, pp->num_vectors,
 239                                                &dw_pcie_msi_domain_ops, pp);
 240         if (!pp->irq_domain) {
 241                 dev_err(pci->dev, "Failed to create IRQ domain\n");
 242                 return -ENOMEM;
 243         }
 244
 245         irq_domain_update_bus_token(pp->irq_domain, DOMAIN_BUS_NEXUS);
 246
 247         pp->msi_domain = pci_msi_create_irq_domain(fwnode,
 248                                                    &dw_pcie_msi_domain_info,
 249                                                    pp->irq_domain);
 250         if (!pp->msi_domain) {
 251                 dev_err(pci->dev, "Failed to create MSI domain\n");
 252                 irq_domain_remove(pp->irq_domain);
 253                 return -ENOMEM;
 254         }
 255
 256         return 0;
 257 }
 258
 259 void dw_pcie_free_msi(struct pcie_port *pp)
 260 {
 261         if (pp->msi_irq) {
 262                 irq_set_chained_handler(pp->msi_irq, NULL);
 263                 irq_set_handler_data(pp->msi_irq, NULL);
 264         }
 265
 266         irq_domain_remove(pp->msi_domain);
 267         irq_domain_remove(pp->irq_domain);
 268
 269         if (pp->msi_data) {
 270                 struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 271                 struct device *dev = pci->dev;
 272
 273                 dma_unmap_single_attrs(dev, pp->msi_data, sizeof(pp->msi_msg),
 274                                        DMA_FROM_DEVICE, DMA_ATTR_SKIP_CPU_SYNC);
 275         }
 276 }
 277
 278 void dw_pcie_msi_init(struct pcie_port *pp)
 279 {
 280         struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 281         u64 msi_target = (u64)pp->msi_data;
 282
 283         if (!IS_ENABLED(CONFIG_PCI_MSI))
 284                 return;
 285
 286         /* Program the msi_data */
 287         dw_pcie_writel_dbi(pci, PCIE_MSI_ADDR_LO, lower_32_bits(msi_target));
 288         dw_pcie_writel_dbi(pci, PCIE_MSI_ADDR_HI, upper_32_bits(msi_target));
 289 }
 290 EXPORT_SYMBOL_GPL(dw_pcie_msi_init);
 291
 292 int dw_pcie_host_init(struct pcie_port *pp)
 293 {
 294         struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 295         struct device *dev = pci->dev;
 296         struct device_node *np = dev->of_node;
 297         struct platform_device *pdev = to_platform_device(dev);
 298         struct resource_entry *win;
 299         struct pci_host_bridge *bridge;
 300         struct resource *cfg_res;
 301         int ret;
 302
 303         raw_spin_lock_init(&pci->pp.lock);
 304
 305         cfg_res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "config");
 306         if (cfg_res) {
 307                 pp->cfg0_size = resource_size(cfg_res);
 308                 pp->cfg0_base = cfg_res->start;
 309         } else if (!pp->va_cfg0_base) {
 310                 dev_err(dev, "Missing *config* reg space\n");
 311         }
 312
 313         if (!pci->dbi_base) {
 314                 struct resource *dbi_res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "dbi");
 315                 pci->dbi_base = devm_pci_remap_cfg_resource(dev, dbi_res);
 316                 if (IS_ERR(pci->dbi_base))
 317                         return PTR_ERR(pci->dbi_base);
 318         }
 319
 320         bridge = devm_pci_alloc_host_bridge(dev, 0);
 321         if (!bridge)
 322                 return -ENOMEM;
 323
 324         pp->bridge = bridge;
 325
 326         /* Get the I/O and memory ranges from DT */
 327         resource_list_for_each_entry(win, &bridge->windows) {
 328                 switch (resource_type(win->res)) {
 329                 case IORESOURCE_IO:
 330                         pp->io_size = resource_size(win->res);
 331                         pp->io_bus_addr = win->res->start - win->offset;
 332                         pp->io_base = pci_pio_to_address(win->res->start);
 333                         break;
 334                 case 0:
 335                         dev_err(dev, "Missing *config* reg space\n");
 336                         pp->cfg0_size = resource_size(win->res);
 337                         pp->cfg0_base = win->res->start;
 338                         if (!pci->dbi_base) {
 339                                 pci->dbi_base = devm_pci_remap_cfgspace(dev,
 340                                                                 pp->cfg0_base,
 341                                                                 pp->cfg0_size);
 342                                 if (!pci->dbi_base) {
 343                                         dev_err(dev, "Error with ioremap\n");
 344                                         return -ENOMEM;
 345                                 }
 346                         }
 347                         break;
 348                 }
 349         }
 350
 351         if (!pp->va_cfg0_base) {
 352                 pp->va_cfg0_base = devm_pci_remap_cfgspace(dev,
 353                                         pp->cfg0_base, pp->cfg0_size);
 354                 if (!pp->va_cfg0_base) {
 355                         dev_err(dev, "Error with ioremap in function\n");
 356                         return -ENOMEM;
 357                 }
 358         }
 359
 360         ret = of_property_read_u32(np, "num-viewport", &pci->num_viewport);
 361         if (ret)
 362                 pci->num_viewport = 2;
 363
 364         if (pci->link_gen < 1)
 365                 pci->link_gen = of_pci_get_max_link_speed(np);
 366
 367         if (pci_msi_enabled()) {
 368                 if (!pp->num_vectors) {
 369                         pp->num_vectors = MSI_DEF_NUM_VECTORS;
 370                 } else if (pp->num_vectors > MAX_MSI_IRQS) {
 371                         dev_err(dev, "Invalid number of vectors\n");
 372                         return -EINVAL;
 373                 }
 374
 375                 if (!pp->ops->msi_host_init) {
 376                         pp->msi_irq_chip = &dw_pci_msi_bottom_irq_chip;
 377
 378                         ret = dw_pcie_allocate_domains(pp);
 379                         if (ret)
 380                                 return ret;
 381
 382                         if (pp->msi_irq)
 383                                 irq_set_chained_handler_and_data(pp->msi_irq,
 384                                                             dw_chained_msi_isr,
 385                                                             pp);
 386
 387                         pp->msi_data = dma_map_single_attrs(pci->dev, &pp->msi_msg,
 388                                                       sizeof(pp->msi_msg),
 389                                                       DMA_FROM_DEVICE,
 390                                                       DMA_ATTR_SKIP_CPU_SYNC);
 391                         if (dma_mapping_error(pci->dev, pp->msi_data)) {
 392                                 dev_err(pci->dev, "Failed to map MSI data\n");
 393                                 pp->msi_data = 0;
 394                                 goto err_free_msi;
 395                         }
 396                 } else {
 397                         ret = pp->ops->msi_host_init(pp);
 398                         if (ret < 0)
 399                                 return ret;
 400                 }
 401         }
 402
 403         /* Set default bus ops */
 404         bridge->ops = &dw_pcie_ops;
 405         bridge->child_ops = &dw_child_pcie_ops;
 406
 407         if (pp->ops->host_init) {
 408                 ret = pp->ops->host_init(pp);
 409                 if (ret)
 410                         goto err_free_msi;
 411         }
 412
 413         bridge->sysdata = pp;
 414
 415         ret = pci_host_probe(bridge);
 416         if (!ret)
 417                 return 0;
 418
 419 err_free_msi:
 420         if (pci_msi_enabled() && !pp->ops->msi_host_init)
 421                 dw_pcie_free_msi(pp);
 422         return ret;
 423 }
 424 EXPORT_SYMBOL_GPL(dw_pcie_host_init);
 425
 426 void dw_pcie_host_deinit(struct pcie_port *pp)
 427 {
 428         pci_stop_root_bus(pp->bridge->bus);
 429         pci_remove_root_bus(pp->bridge->bus);
 430         if (pci_msi_enabled() && !pp->ops->msi_host_init)
 431                 dw_pcie_free_msi(pp);
 432 }
 433 EXPORT_SYMBOL_GPL(dw_pcie_host_deinit);
 434
 435 static void __iomem *dw_pcie_other_conf_map_bus(struct pci_bus *bus,
 436                                                 unsigned int devfn, int where)
 437 {
 438         int type;
 439         u32 busdev;
 440         struct pcie_port *pp = bus->sysdata;
 441         struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 442
 443         /*
 444          * Checking whether the link is up here is a last line of defense
 445          * against platforms that forward errors on the system bus as
 446          * SError upon PCI configuration transactions issued when the link
 447          * is down. This check is racy by definition and does not stop
 448          * the system from triggering an SError if the link goes down
 449          * after this check is performed.
 450          */
 451         if (!dw_pcie_link_up(pci))
 452                 return NULL;
 453
 454         busdev = PCIE_ATU_BUS(bus->number) | PCIE_ATU_DEV(PCI_SLOT(devfn)) |
 455                  PCIE_ATU_FUNC(PCI_FUNC(devfn));
 456
 457         if (pci_is_root_bus(bus->parent))
 458                 type = PCIE_ATU_TYPE_CFG0;
 459         else
 460                 type = PCIE_ATU_TYPE_CFG1;
 461
 462
 463         dw_pcie_prog_outbound_atu(pci, 0, type, pp->cfg0_base, busdev, pp->cfg0_size);
 464
 465         return pp->va_cfg0_base + where;
 466 }
 467
 468 static int dw_pcie_rd_other_conf(struct pci_bus *bus, unsigned int devfn,
 469                                  int where, int size, u32 *val)
 470 {
 471         int ret;
 472         struct pcie_port *pp = bus->sysdata;
 473         struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 474
 475         ret = pci_generic_config_read(bus, devfn, where, size, val);
 476
 477         if (!ret && pci->io_cfg_atu_shared)
 478                 dw_pcie_prog_outbound_atu(pci, 0, PCIE_ATU_TYPE_IO, pp->io_base,
 479                                           pp->io_bus_addr, pp->io_size);
 480
 481         return ret;
 482 }
 483
 484 static int dw_pcie_wr_other_conf(struct pci_bus *bus, unsigned int devfn,
 485                                  int where, int size, u32 val)
 486 {
 487         int ret;
 488         struct pcie_port *pp = bus->sysdata;
 489         struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 490
 491         ret = pci_generic_config_write(bus, devfn, where, size, val);
 492
 493         if (!ret && pci->io_cfg_atu_shared)
 494                 dw_pcie_prog_outbound_atu(pci, 0, PCIE_ATU_TYPE_IO, pp->io_base,
 495                                           pp->io_bus_addr, pp->io_size);
 496
 497         return ret;
 498 }
 499
 500 static struct pci_ops dw_child_pcie_ops = {
 501         .map_bus = dw_pcie_other_conf_map_bus,
 502         .read = dw_pcie_rd_other_conf,
 503         .write = dw_pcie_wr_other_conf,
 504 };
 505
 506 void __iomem *dw_pcie_own_conf_map_bus(struct pci_bus *bus, unsigned int devfn, int where)
 507 {
 508         struct pcie_port *pp = bus->sysdata;
 509         struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 510
 511         if (PCI_SLOT(devfn) > 0)
 512                 return NULL;
 513
 514         return pci->dbi_base + where;
 515 }
 516 EXPORT_SYMBOL_GPL(dw_pcie_own_conf_map_bus);
 517
 518 static struct pci_ops dw_pcie_ops = {
 519         .map_bus = dw_pcie_own_conf_map_bus,
 520         .read = pci_generic_config_read,
 521         .write = pci_generic_config_write,
 522 };
 523
 524 void dw_pcie_setup_rc(struct pcie_port *pp)
 525 {
 526         int i;
 527         u32 val, ctrl, num_ctrls;
 528         struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 529
 530         /*
 531          * Enable DBI read-only registers for writing/updating configuration.
 532          * Write permission gets disabled towards the end of this function.
 533          */
 534         dw_pcie_dbi_ro_wr_en(pci);
 535
 536         dw_pcie_setup(pci);
 537
 538         if (pci_msi_enabled() && !pp->ops->msi_host_init) {
 539                 num_ctrls = pp->num_vectors / MAX_MSI_IRQS_PER_CTRL;
 540
 541                 /* Initialize IRQ Status array */
 542                 for (ctrl = 0; ctrl < num_ctrls; ctrl++) {
 543                         pp->irq_mask[ctrl] = ~0;
 544                         dw_pcie_writel_dbi(pci, PCIE_MSI_INTR0_MASK +
 545                                             (ctrl * MSI_REG_CTRL_BLOCK_SIZE),
 546                                             pp->irq_mask[ctrl]);
 547                         dw_pcie_writel_dbi(pci, PCIE_MSI_INTR0_ENABLE +
 548                                             (ctrl * MSI_REG_CTRL_BLOCK_SIZE),
 549                                             ~0);
 550                 }
 551         }
 552
 553         /* Setup RC BARs */
 554         dw_pcie_writel_dbi(pci, PCI_BASE_ADDRESS_0, 0x00000004);
 555         dw_pcie_writel_dbi(pci, PCI_BASE_ADDRESS_1, 0x00000000);
 556
 557         /* Setup interrupt pins */
 558         val = dw_pcie_readl_dbi(pci, PCI_INTERRUPT_LINE);
 559         val &= 0xffff00ff;
 560         val |= 0x00000100;
 561         dw_pcie_writel_dbi(pci, PCI_INTERRUPT_LINE, val);
 562
 563         /* Setup bus numbers */
 564         val = dw_pcie_readl_dbi(pci, PCI_PRIMARY_BUS);
 565         val &= 0xff000000;
 566         val |= 0x00ff0100;
 567         dw_pcie_writel_dbi(pci, PCI_PRIMARY_BUS, val);
 568
 569         /* Setup command register */
 570         val = dw_pcie_readl_dbi(pci, PCI_COMMAND);
 571         val &= 0xffff0000;
 572         val |= PCI_COMMAND_IO | PCI_COMMAND_MEMORY |
 573                 PCI_COMMAND_MASTER | PCI_COMMAND_SERR;
 574         dw_pcie_writel_dbi(pci, PCI_COMMAND, val);
 575
 576         /* Ensure all outbound windows are disabled so there are multiple matches */
 577         for (i = 0; i < pci->num_viewport; i++)
 578                 dw_pcie_disable_atu(pci, i, DW_PCIE_REGION_OUTBOUND);
 579
 580         /*
 581          * If the platform provides its own child bus config accesses, it means
 582          * the platform uses its own address translation component rather than
 583          * ATU, so we should not program the ATU here.
 584          */
 585         if (pp->bridge->child_ops == &dw_child_pcie_ops) {
 586                 int atu_idx = 0;
 587                 struct resource_entry *entry;
 588
 589                 /* Get last memory resource entry */
 590                 resource_list_for_each_entry(entry, &pp->bridge->windows) {
 591                         if (resource_type(entry->res) != IORESOURCE_MEM)
 592                                 continue;
 593
 594                         if (pci->num_viewport <= ++atu_idx)
 595                                 break;
 596
 597                         dw_pcie_prog_outbound_atu(pci, atu_idx,
 598                                                   PCIE_ATU_TYPE_MEM, entry->res->start,
 599                                                   entry->res->start - entry->offset,
 600                                                   resource_size(entry->res));
 601                 }
 602
 603                 if (pp->io_size) {
 604                         if (pci->num_viewport > ++atu_idx)
 605                                 dw_pcie_prog_outbound_atu(pci, atu_idx,
 606                                                           PCIE_ATU_TYPE_IO, pp->io_base,
 607                                                           pp->io_bus_addr, pp->io_size);
 608                         else
 609                                 pci->io_cfg_atu_shared = true;
 610                 }
 611
 612                 if (pci->num_viewport <= atu_idx)
 613                         dev_warn(pci->dev, "Resources exceed number of ATU entries (%d)",
 614                                  pci->num_viewport);
 615         }
 616
 617         dw_pcie_writel_dbi(pci, PCI_BASE_ADDRESS_0, 0);
 618
 619         /* Program correct class for RC */
 620         dw_pcie_writew_dbi(pci, PCI_CLASS_DEVICE, PCI_CLASS_BRIDGE_PCI);
 621
 622         val = dw_pcie_readl_dbi(pci, PCIE_LINK_WIDTH_SPEED_CONTROL);
 623         val |= PORT_LOGIC_SPEED_CHANGE;
 624         dw_pcie_writel_dbi(pci, PCIE_LINK_WIDTH_SPEED_CONTROL, val);
 625
 626         dw_pcie_dbi_ro_wr_dis(pci);
 627 }
 628 EXPORT_SYMBOL_GPL(dw_pcie_setup_rc);