This source file includes following definitions.
- fixed_bar_cap
- pci_device_update_fixed
- type1_access_ok
- pci_read
- pci_write
- intel_mid_pci_irq_enable
- intel_mid_pci_irq_disable
- intel_mid_pci_init
- pci_d3delay_fixup
- mid_power_off_one_device
- mid_power_off_devices
- pci_fixed_bar_fixup
   1 
   2 
   3 
   4 
   5 
   6 
   7 
   8 
   9 
  10 
  11 
  12 
  13 
  14 
  15 
  16 
  17 
  18 
  19 
  20 
  21 
  22 #include <linux/sched.h>
  23 #include <linux/pci.h>
  24 #include <linux/ioport.h>
  25 #include <linux/init.h>
  26 #include <linux/dmi.h>
  27 #include <linux/acpi.h>
  28 #include <linux/io.h>
  29 #include <linux/smp.h>
  30 
  31 #include <asm/segment.h>
  32 #include <asm/pci_x86.h>
  33 #include <asm/hw_irq.h>
  34 #include <asm/io_apic.h>
  35 #include <asm/intel-mid.h>
  36 
  37 #define PCIE_CAP_OFFSET 0x100
  38 
  39 
  40 #define PCI_DEVICE_ID_INTEL_MRFLD_MMC   0x1190
  41 #define PCI_DEVICE_ID_INTEL_MRFLD_HSU   0x1191
  42 
  43 
  44 #define PCIE_VNDR_CAP_ID_FIXED_BAR 0x00 
  45 #define PCI_FIXED_BAR_0_SIZE    0x04
  46 #define PCI_FIXED_BAR_1_SIZE    0x08
  47 #define PCI_FIXED_BAR_2_SIZE    0x0c
  48 #define PCI_FIXED_BAR_3_SIZE    0x10
  49 #define PCI_FIXED_BAR_4_SIZE    0x14
  50 #define PCI_FIXED_BAR_5_SIZE    0x1c
  51 
  52 static int pci_soc_mode;
  53 
  54 
  55 
  56 
  57 
  58 
  59 
  60 
  61 
  62 static int fixed_bar_cap(struct pci_bus *bus, unsigned int devfn)
  63 {
  64         int pos;
  65         u32 pcie_cap = 0, cap_data;
  66 
  67         pos = PCIE_CAP_OFFSET;
  68 
  69         if (!raw_pci_ext_ops)
  70                 return 0;
  71 
  72         while (pos) {
  73                 if (raw_pci_ext_ops->read(pci_domain_nr(bus), bus->number,
  74                                           devfn, pos, 4, &pcie_cap))
  75                         return 0;
  76 
  77                 if (PCI_EXT_CAP_ID(pcie_cap) == 0x0000 ||
  78                         PCI_EXT_CAP_ID(pcie_cap) == 0xffff)
  79                         break;
  80 
  81                 if (PCI_EXT_CAP_ID(pcie_cap) == PCI_EXT_CAP_ID_VNDR) {
  82                         raw_pci_ext_ops->read(pci_domain_nr(bus), bus->number,
  83                                               devfn, pos + 4, 4, &cap_data);
  84                         if ((cap_data & 0xffff) == PCIE_VNDR_CAP_ID_FIXED_BAR)
  85                                 return pos;
  86                 }
  87 
  88                 pos = PCI_EXT_CAP_NEXT(pcie_cap);
  89         }
  90 
  91         return 0;
  92 }
  93 
  94 static int pci_device_update_fixed(struct pci_bus *bus, unsigned int devfn,
  95                                    int reg, int len, u32 val, int offset)
  96 {
  97         u32 size;
  98         unsigned int domain, busnum;
  99         int bar = (reg - PCI_BASE_ADDRESS_0) >> 2;
 100 
 101         domain = pci_domain_nr(bus);
 102         busnum = bus->number;
 103 
 104         if (val == ~0 && len == 4) {
 105                 unsigned long decode;
 106 
 107                 raw_pci_ext_ops->read(domain, busnum, devfn,
 108                                offset + 8 + (bar * 4), 4, &size);
 109 
 110                 
 111                 if (size) {
 112                         decode = size - 1;
 113                         decode |= decode >> 1;
 114                         decode |= decode >> 2;
 115                         decode |= decode >> 4;
 116                         decode |= decode >> 8;
 117                         decode |= decode >> 16;
 118                         decode++;
 119                         decode = ~(decode - 1);
 120                 } else {
 121                         decode = 0;
 122                 }
 123 
 124                 
 125 
 126 
 127 
 128 
 129 
 130                 return raw_pci_ext_ops->write(domain, busnum, devfn, reg, 4,
 131                                        decode);
 132         }
 133 
 134         
 135         return raw_pci_ext_ops->write(domain, busnum, devfn, reg, len, val);
 136 }
 137 
 138 
 139 
 140 
 141 
 142 
 143 
 144 
 145 
 146 
 147 
 148 static bool type1_access_ok(unsigned int bus, unsigned int devfn, int reg)
 149 {
 150         
 151 
 152 
 153 
 154 
 155 
 156 
 157 
 158         if (reg >= 0x100 || reg == PCI_STATUS || reg == PCI_HEADER_TYPE)
 159                 return false;
 160         if (bus == 0 && (devfn == PCI_DEVFN(2, 0)
 161                                 || devfn == PCI_DEVFN(0, 0)
 162                                 || devfn == PCI_DEVFN(3, 0)))
 163                 return true;
 164         return false; 
 165 }
 166 
 167 static int pci_read(struct pci_bus *bus, unsigned int devfn, int where,
 168                     int size, u32 *value)
 169 {
 170         if (type1_access_ok(bus->number, devfn, where))
 171                 return pci_direct_conf1.read(pci_domain_nr(bus), bus->number,
 172                                         devfn, where, size, value);
 173         return raw_pci_ext_ops->read(pci_domain_nr(bus), bus->number,
 174                               devfn, where, size, value);
 175 }
 176 
 177 static int pci_write(struct pci_bus *bus, unsigned int devfn, int where,
 178                      int size, u32 value)
 179 {
 180         int offset;
 181 
 182         
 183 
 184 
 185 
 186         if (where == PCI_ROM_ADDRESS)
 187                 return 0;
 188 
 189         
 190 
 191 
 192 
 193 
 194 
 195         offset = fixed_bar_cap(bus, devfn);
 196         if (offset &&
 197             (where >= PCI_BASE_ADDRESS_0 && where <= PCI_BASE_ADDRESS_5)) {
 198                 return pci_device_update_fixed(bus, devfn, where, size, value,
 199                                                offset);
 200         }
 201 
 202         
 203 
 204 
 205 
 206 
 207         if (type1_access_ok(bus->number, devfn, where))
 208                 return pci_direct_conf1.write(pci_domain_nr(bus), bus->number,
 209                                               devfn, where, size, value);
 210         return raw_pci_ext_ops->write(pci_domain_nr(bus), bus->number, devfn,
 211                                where, size, value);
 212 }
 213 
 214 static int intel_mid_pci_irq_enable(struct pci_dev *dev)
 215 {
 216         struct irq_alloc_info info;
 217         int polarity;
 218         int ret;
 219         u8 gsi;
 220 
 221         if (dev->irq_managed && dev->irq > 0)
 222                 return 0;
 223 
 224         ret = pci_read_config_byte(dev, PCI_INTERRUPT_LINE, &gsi);
 225         if (ret < 0) {
 226                 dev_warn(&dev->dev, "Failed to read interrupt line: %d\n", ret);
 227                 return ret;
 228         }
 229 
 230         switch (intel_mid_identify_cpu()) {
 231         case INTEL_MID_CPU_CHIP_TANGIER:
 232                 polarity = IOAPIC_POL_HIGH;
 233 
 234                 
 235                 if (gsi == 0) {
 236                         
 237 
 238 
 239 
 240                         if (dev->device == PCI_DEVICE_ID_INTEL_MRFLD_HSU)
 241                                 return -EBUSY;
 242                         
 243 
 244 
 245 
 246 
 247 
 248 
 249                         if (dev->device != PCI_DEVICE_ID_INTEL_MRFLD_MMC)
 250                                 return 0;
 251                 }
 252                 break;
 253         default:
 254                 polarity = IOAPIC_POL_LOW;
 255                 break;
 256         }
 257 
 258         ioapic_set_alloc_attr(&info, dev_to_node(&dev->dev), 1, polarity);
 259 
 260         
 261 
 262 
 263 
 264         ret = mp_map_gsi_to_irq(gsi, IOAPIC_MAP_ALLOC, &info);
 265         if (ret < 0)
 266                 return ret;
 267 
 268         dev->irq = ret;
 269         dev->irq_managed = 1;
 270 
 271         return 0;
 272 }
 273 
 274 static void intel_mid_pci_irq_disable(struct pci_dev *dev)
 275 {
 276         if (!mp_should_keep_irq(&dev->dev) && dev->irq_managed &&
 277             dev->irq > 0) {
 278                 mp_unmap_irq(dev->irq);
 279                 dev->irq_managed = 0;
 280         }
 281 }
 282 
 283 static const struct pci_ops intel_mid_pci_ops __initconst = {
 284         .read = pci_read,
 285         .write = pci_write,
 286 };
 287 
 288 
 289 
 290 
 291 
 292 
 293 
 294 int __init intel_mid_pci_init(void)
 295 {
 296         pr_info("Intel MID platform detected, using MID PCI ops\n");
 297         pci_mmcfg_late_init();
 298         pcibios_enable_irq = intel_mid_pci_irq_enable;
 299         pcibios_disable_irq = intel_mid_pci_irq_disable;
 300         pci_root_ops = intel_mid_pci_ops;
 301         pci_soc_mode = 1;
 302         
 303         acpi_noirq_set();
 304         return 1;
 305 }
 306 
 307 
 308 
 309 
 310 
 311 static void pci_d3delay_fixup(struct pci_dev *dev)
 312 {
 313         
 314 
 315 
 316 
 317         if (!pci_soc_mode)
 318                 return;
 319         
 320 
 321 
 322 
 323         if (type1_access_ok(dev->bus->number, dev->devfn, PCI_DEVICE_ID))
 324                 return;
 325         dev->d3_delay = 0;
 326 }
 327 DECLARE_PCI_FIXUP_FINAL(PCI_VENDOR_ID_INTEL, PCI_ANY_ID, pci_d3delay_fixup);
 328 
 329 static void mid_power_off_one_device(struct pci_dev *dev)
 330 {
 331         u16 pmcsr;
 332 
 333         
 334 
 335 
 336 
 337         pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &pmcsr);
 338         dev->current_state = (pci_power_t __force)(pmcsr & PCI_PM_CTRL_STATE_MASK);
 339 
 340         pci_set_power_state(dev, PCI_D3hot);
 341 }
 342 
 343 static void mid_power_off_devices(struct pci_dev *dev)
 344 {
 345         int id;
 346 
 347         if (!pci_soc_mode)
 348                 return;
 349 
 350         id = intel_mid_pwr_get_lss_id(dev);
 351         if (id < 0)
 352                 return;
 353 
 354         
 355 
 356 
 357 
 358         mid_power_off_one_device(dev);
 359 }
 360 
 361 DECLARE_PCI_FIXUP_FINAL(PCI_VENDOR_ID_INTEL, PCI_ANY_ID, mid_power_off_devices);
 362 
 363 
 364 
 365 
 366 static void pci_fixed_bar_fixup(struct pci_dev *dev)
 367 {
 368         unsigned long offset;
 369         u32 size;
 370         int i;
 371 
 372         if (!pci_soc_mode)
 373                 return;
 374 
 375         
 376         if (dev->cfg_size < PCIE_CAP_OFFSET + 4)
 377                 return;
 378 
 379         
 380         offset = fixed_bar_cap(dev->bus, dev->devfn);
 381         if (!offset || PCI_DEVFN(2, 0) == dev->devfn ||
 382             PCI_DEVFN(2, 2) == dev->devfn)
 383                 return;
 384 
 385         for (i = 0; i < PCI_ROM_RESOURCE; i++) {
 386                 pci_read_config_dword(dev, offset + 8 + (i * 4), &size);
 387                 dev->resource[i].end = dev->resource[i].start + size - 1;
 388                 dev->resource[i].flags |= IORESOURCE_PCI_FIXED;
 389         }
 390 }
 391 DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_INTEL, PCI_ANY_ID, pci_fixed_bar_fixup);