arch/powerpc/platforms/pseries/pci.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  * Copyright (C) 2001 Dave Engebretsen, IBM Corporation
   4  * Copyright (C) 2003 Anton Blanchard <[email protected]>, IBM
   5  *
   6  * pSeries specific routines for PCI.
   7  */
   8
   9 #include <linux/init.h>
  10 #include <linux/ioport.h>
  11 #include <linux/kernel.h>
  12 #include <linux/pci.h>
  13 #include <linux/string.h>
  14
  15 #include <asm/eeh.h>
  16 #include <asm/pci-bridge.h>
  17 #include <asm/ppc-pci.h>
  18 #include <asm/pci.h>
  19 #include "pseries.h"
  20
  21 #ifdef CONFIG_PCI_IOV
  22 #define MAX_VFS_FOR_MAP_PE 256
  23 struct pe_map_bar_entry {
  24         __be64     bar;       /* Input:  Virtual Function BAR */
  25         __be16     rid;       /* Input:  Virtual Function Router ID */
  26         __be16     pe_num;    /* Output: Virtual Function PE Number */
  27         __be32     reserved;  /* Reserved Space */
  28 };
  29
  30 static int pseries_send_map_pe(struct pci_dev *pdev, u16 num_vfs,
  31                                struct pe_map_bar_entry *vf_pe_array)
  32 {
  33         struct pci_dn *pdn;
  34         int rc;
  35         unsigned long buid, addr;
  36         int ibm_map_pes = rtas_function_token(RTAS_FN_IBM_OPEN_SRIOV_MAP_PE_NUMBER);
  37
  38         if (ibm_map_pes == RTAS_UNKNOWN_SERVICE)
  39                 return -EINVAL;
  40
  41         pdn = pci_get_pdn(pdev);
  42         addr = rtas_config_addr(pdn->busno, pdn->devfn, 0);
  43         buid = pdn->phb->buid;
  44         spin_lock(&rtas_data_buf_lock);
  45         memcpy(rtas_data_buf, vf_pe_array,
  46                RTAS_DATA_BUF_SIZE);
  47         rc = rtas_call(ibm_map_pes, 5, 1, NULL, addr,
  48                        BUID_HI(buid), BUID_LO(buid),
  49                        rtas_data_buf,
  50                        num_vfs * sizeof(struct pe_map_bar_entry));
  51         memcpy(vf_pe_array, rtas_data_buf, RTAS_DATA_BUF_SIZE);
  52         spin_unlock(&rtas_data_buf_lock);
  53
  54         if (rc)
  55                 dev_err(&pdev->dev,
  56                         "%s: Failed to associate pes PE#%lx, rc=%x\n",
  57                         __func__,  addr, rc);
  58
  59         return rc;
  60 }
  61
  62 static void pseries_set_pe_num(struct pci_dev *pdev, u16 vf_index, __be16 pe_num)
  63 {
  64         struct pci_dn *pdn;
  65
  66         pdn = pci_get_pdn(pdev);
  67         pdn->pe_num_map[vf_index] = be16_to_cpu(pe_num);
  68         dev_dbg(&pdev->dev, "VF %04x:%02x:%02x.%x associated with PE#%x\n",
  69                 pci_domain_nr(pdev->bus),
  70                 pdev->bus->number,
  71                 PCI_SLOT(pci_iov_virtfn_devfn(pdev, vf_index)),
  72                 PCI_FUNC(pci_iov_virtfn_devfn(pdev, vf_index)),
  73                 pdn->pe_num_map[vf_index]);
  74 }
  75
  76 static int pseries_associate_pes(struct pci_dev *pdev, u16 num_vfs)
  77 {
  78         struct pci_dn *pdn;
  79         int i, rc, vf_index;
  80         struct pe_map_bar_entry *vf_pe_array;
  81         struct resource *res;
  82         u64 size;
  83
  84         vf_pe_array = kzalloc(RTAS_DATA_BUF_SIZE, GFP_KERNEL);
  85         if (!vf_pe_array)
  86                 return -ENOMEM;
  87
  88         pdn = pci_get_pdn(pdev);
  89         /* create firmware structure to associate pes */
  90         for (vf_index = 0; vf_index < num_vfs; vf_index++) {
  91                 pdn->pe_num_map[vf_index] = IODA_INVALID_PE;
  92                 for (i = 0; i < PCI_SRIOV_NUM_BARS; i++) {
  93                         res = &pdev->resource[i + PCI_IOV_RESOURCES];
  94                         if (!res->parent)
  95                                 continue;
  96                         size = pcibios_iov_resource_alignment(pdev, i +
  97                                         PCI_IOV_RESOURCES);
  98                         vf_pe_array[vf_index].bar =
  99                                 cpu_to_be64(res->start + size * vf_index);
 100                         vf_pe_array[vf_index].rid =
 101                                 cpu_to_be16((pci_iov_virtfn_bus(pdev, vf_index)
 102                                             << 8) | pci_iov_virtfn_devfn(pdev,
 103                                             vf_index));
 104                         vf_pe_array[vf_index].pe_num =
 105                                 cpu_to_be16(IODA_INVALID_PE);
 106                 }
 107         }
 108
 109         rc = pseries_send_map_pe(pdev, num_vfs, vf_pe_array);
 110         /* Only zero is success */
 111         if (!rc)
 112                 for (vf_index = 0; vf_index < num_vfs; vf_index++)
 113                         pseries_set_pe_num(pdev, vf_index,
 114                                            vf_pe_array[vf_index].pe_num);
 115
 116         kfree(vf_pe_array);
 117         return rc;
 118 }
 119
 120 static int pseries_pci_sriov_enable(struct pci_dev *pdev, u16 num_vfs)
 121 {
 122         struct pci_dn         *pdn;
 123         int                    rc;
 124         const int *max_vfs;
 125         int max_config_vfs;
 126         struct device_node *dn = pci_device_to_OF_node(pdev);
 127
 128         max_vfs = of_get_property(dn, "ibm,number-of-configurable-vfs", NULL);
 129
 130         if (!max_vfs)
 131                 return -EINVAL;
 132
 133         /* First integer stores max config */
 134         max_config_vfs = of_read_number(&max_vfs[0], 1);
 135         if (max_config_vfs < num_vfs && num_vfs > MAX_VFS_FOR_MAP_PE) {
 136                 dev_err(&pdev->dev,
 137                         "Num VFs %x > %x Configurable VFs\n",
 138                         num_vfs, (num_vfs > MAX_VFS_FOR_MAP_PE) ?
 139                         MAX_VFS_FOR_MAP_PE : max_config_vfs);
 140                 return -EINVAL;
 141         }
 142
 143         pdn = pci_get_pdn(pdev);
 144         pdn->pe_num_map = kmalloc_array(num_vfs,
 145                                         sizeof(*pdn->pe_num_map),
 146                                         GFP_KERNEL);
 147         if (!pdn->pe_num_map)
 148                 return -ENOMEM;
 149
 150         rc = pseries_associate_pes(pdev, num_vfs);
 151
 152         /* Anything other than zero is failure */
 153         if (rc) {
 154                 dev_err(&pdev->dev, "Failure to enable sriov: %x\n", rc);
 155                 kfree(pdn->pe_num_map);
 156         } else {
 157                 pci_vf_drivers_autoprobe(pdev, false);
 158         }
 159
 160         return rc;
 161 }
 162
 163 static int pseries_pcibios_sriov_enable(struct pci_dev *pdev, u16 num_vfs)
 164 {
 165         /* Allocate PCI data */
 166         add_sriov_vf_pdns(pdev);
 167         return pseries_pci_sriov_enable(pdev, num_vfs);
 168 }
 169
 170 static int pseries_pcibios_sriov_disable(struct pci_dev *pdev)
 171 {
 172         struct pci_dn         *pdn;
 173
 174         pdn = pci_get_pdn(pdev);
 175         /* Releasing pe_num_map */
 176         kfree(pdn->pe_num_map);
 177         /* Release PCI data */
 178         remove_sriov_vf_pdns(pdev);
 179         pci_vf_drivers_autoprobe(pdev, true);
 180         return 0;
 181 }
 182 #endif
 183
 184 static void __init pSeries_request_regions(void)
 185 {
 186         if (!isa_io_base)
 187                 return;
 188
 189         request_region(0x20,0x20,"pic1");
 190         request_region(0xa0,0x20,"pic2");
 191         request_region(0x00,0x20,"dma1");
 192         request_region(0x40,0x20,"timer");
 193         request_region(0x80,0x10,"dma page reg");
 194         request_region(0xc0,0x20,"dma2");
 195 }
 196
 197 void __init pSeries_final_fixup(void)
 198 {
 199         pSeries_request_regions();
 200
 201         eeh_show_enabled();
 202
 203 #ifdef CONFIG_PCI_IOV
 204         ppc_md.pcibios_sriov_enable = pseries_pcibios_sriov_enable;
 205         ppc_md.pcibios_sriov_disable = pseries_pcibios_sriov_disable;
 206 #endif
 207 }
 208
 209 /*
 210  * Assume the winbond 82c105 is the IDE controller on a
 211  * p610/p615/p630. We should probably be more careful in case
 212  * someone tries to plug in a similar adapter.
 213  */
 214 static void fixup_winbond_82c105(struct pci_dev* dev)
 215 {
 216         struct resource *r;
 217         unsigned int reg;
 218
 219         if (!machine_is(pseries))
 220                 return;
 221
 222         printk("Using INTC for W82c105 IDE controller.\n");
 223         pci_read_config_dword(dev, 0x40, &reg);
 224         /* Enable LEGIRQ to use INTC instead of ISA interrupts */
 225         pci_write_config_dword(dev, 0x40, reg | (1<<11));
 226
 227         pci_dev_for_each_resource(dev, r) {
 228                 /* zap the 2nd function of the winbond chip */
 229                 if (dev->bus->number == 0 && dev->devfn == 0x81 &&
 230                     r->flags & IORESOURCE_IO)
 231                         r->flags &= ~IORESOURCE_IO;
 232                 if (r->start == 0 && r->end) {
 233                         r->flags = 0;
 234                         r->end = 0;
 235                 }
 236         }
 237 }
 238 DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_WINBOND, PCI_DEVICE_ID_WINBOND_82C105,
 239                          fixup_winbond_82c105);
 240
 241 static enum pci_bus_speed prop_to_pci_speed(u32 prop)
 242 {
 243         switch (prop) {
 244         case 0x01:
 245                 return PCIE_SPEED_2_5GT;
 246         case 0x02:
 247                 return PCIE_SPEED_5_0GT;
 248         case 0x04:
 249                 return PCIE_SPEED_8_0GT;
 250         case 0x08:
 251                 return PCIE_SPEED_16_0GT;
 252         case 0x10:
 253                 return PCIE_SPEED_32_0GT;
 254         default:
 255                 pr_debug("Unexpected PCI link speed property value\n");
 256                 return PCI_SPEED_UNKNOWN;
 257         }
 258 }
 259
 260 int pseries_root_bridge_prepare(struct pci_host_bridge *bridge)
 261 {
 262         struct device_node *dn, *pdn;
 263         struct pci_bus *bus;
 264         u32 pcie_link_speed_stats[2];
 265         int rc;
 266
 267         bus = bridge->bus;
 268
 269         /* Rely on the pcibios_free_controller_deferred() callback. */
 270         pci_set_host_bridge_release(bridge, pcibios_free_controller_deferred,
 271                                         (void *) pci_bus_to_host(bus));
 272
 273         dn = pcibios_get_phb_of_node(bus);
 274         if (!dn)
 275                 return 0;
 276
 277         for (pdn = dn; pdn != NULL; pdn = of_get_next_parent(pdn)) {
 278                 rc = of_property_read_u32_array(pdn,
 279                                 "ibm,pcie-link-speed-stats",
 280                                 &pcie_link_speed_stats[0], 2);
 281                 if (!rc)
 282                         break;
 283         }
 284
 285         of_node_put(pdn);
 286
 287         if (rc) {
 288                 pr_debug("no ibm,pcie-link-speed-stats property\n");
 289                 return 0;
 290         }
 291
 292         bus->max_bus_speed = prop_to_pci_speed(pcie_link_speed_stats[0]);
 293         bus->cur_bus_speed = prop_to_pci_speed(pcie_link_speed_stats[1]);
 294         return 0;
 295 }