arch/i386/pci/direct.c

   1 /*
   2  * direct.c - Low-level direct PCI config space access
   3  */
   4
   5 #include <linux/pci.h>
   6 #include <linux/init.h>
   7 #include "pci.h"
   8
   9 /*
  10  * Functions for accessing PCI configuration space with type 1 accesses
  11  */
  12
  13 #define PCI_CONF1_ADDRESS(bus, devfn, reg) \
  14         (0x80000000 | (bus << 16) | (devfn << 8) | (reg & ~3))
  15
  16 static int pci_conf1_read(unsigned int seg, unsigned int bus,
  17                           unsigned int devfn, int reg, int len, u32 *value)
  18 {
  19         unsigned long flags;
  20
  21         if (!value || (bus > 255) || (devfn > 255) || (reg > 255))
  22                 return -EINVAL;
  23
  24         spin_lock_irqsave(&pci_config_lock, flags);
  25
  26         outl(PCI_CONF1_ADDRESS(bus, devfn, reg), 0xCF8);
  27
  28         switch (len) {
  29         case 1:
  30                 *value = inb(0xCFC + (reg & 3));
  31                 break;
  32         case 2:
  33                 *value = inw(0xCFC + (reg & 2));
  34                 break;
  35         case 4:
  36                 *value = inl(0xCFC);
  37                 break;
  38         }
  39
  40         spin_unlock_irqrestore(&pci_config_lock, flags);
  41
  42         return 0;
  43 }
  44
  45 static int pci_conf1_write(unsigned int seg, unsigned int bus,
  46                            unsigned int devfn, int reg, int len, u32 value)
  47 {
  48         unsigned long flags;
  49
  50         if ((bus > 255) || (devfn > 255) || (reg > 255))
  51                 return -EINVAL;
  52
  53         spin_lock_irqsave(&pci_config_lock, flags);
  54
  55         outl(PCI_CONF1_ADDRESS(bus, devfn, reg), 0xCF8);
  56
  57         switch (len) {
  58         case 1:
  59                 outb((u8)value, 0xCFC + (reg & 3));
  60                 break;
  61         case 2:
  62                 outw((u16)value, 0xCFC + (reg & 2));
  63                 break;
  64         case 4:
  65                 outl((u32)value, 0xCFC);
  66                 break;
  67         }
  68
  69         spin_unlock_irqrestore(&pci_config_lock, flags);
  70
  71         return 0;
  72 }
  73
  74 #undef PCI_CONF1_ADDRESS
  75
  76 struct pci_raw_ops pci_direct_conf1 = {
  77         .read =         pci_conf1_read,
  78         .write =        pci_conf1_write,
  79 };
  80
  81
  82 /*
  83  * Functions for accessing PCI configuration space with type 2 accesses
  84  */
  85
  86 #define PCI_CONF2_ADDRESS(dev, reg)     (u16)(0xC000 | (dev << 8) | reg)
  87
  88 static int pci_conf2_read(unsigned int seg, unsigned int bus,
  89                           unsigned int devfn, int reg, int len, u32 *value)
  90 {
  91         unsigned long flags;
  92         int dev, fn;
  93
  94         if (!value || (bus > 255) || (devfn > 255) || (reg > 255))
  95                 return -EINVAL;
  96
  97         dev = PCI_SLOT(devfn);
  98         fn = PCI_FUNC(devfn);
  99
 100         if (dev & 0x10)
 101                 return PCIBIOS_DEVICE_NOT_FOUND;
 102
 103         spin_lock_irqsave(&pci_config_lock, flags);
 104
 105         outb((u8)(0xF0 | (fn << 1)), 0xCF8);
 106         outb((u8)bus, 0xCFA);
 107
 108         switch (len) {
 109         case 1:
 110                 *value = inb(PCI_CONF2_ADDRESS(dev, reg));
 111                 break;
 112         case 2:
 113                 *value = inw(PCI_CONF2_ADDRESS(dev, reg));
 114                 break;
 115         case 4:
 116                 *value = inl(PCI_CONF2_ADDRESS(dev, reg));
 117                 break;
 118         }
 119
 120         outb(0, 0xCF8);
 121
 122         spin_unlock_irqrestore(&pci_config_lock, flags);
 123
 124         return 0;
 125 }
 126
 127 static int pci_conf2_write(unsigned int seg, unsigned int bus,
 128                            unsigned int devfn, int reg, int len, u32 value)
 129 {
 130         unsigned long flags;
 131         int dev, fn;
 132
 133         if ((bus > 255) || (devfn > 255) || (reg > 255))
 134                 return -EINVAL;
 135
 136         dev = PCI_SLOT(devfn);
 137         fn = PCI_FUNC(devfn);
 138
 139         if (dev & 0x10)
 140                 return PCIBIOS_DEVICE_NOT_FOUND;
 141
 142         spin_lock_irqsave(&pci_config_lock, flags);
 143
 144         outb((u8)(0xF0 | (fn << 1)), 0xCF8);
 145         outb((u8)bus, 0xCFA);
 146
 147         switch (len) {
 148         case 1:
 149                 outb((u8)value, PCI_CONF2_ADDRESS(dev, reg));
 150                 break;
 151         case 2:
 152                 outw((u16)value, PCI_CONF2_ADDRESS(dev, reg));
 153                 break;
 154         case 4:
 155                 outl((u32)value, PCI_CONF2_ADDRESS(dev, reg));
 156                 break;
 157         }
 158
 159         outb(0, 0xCF8);
 160
 161         spin_unlock_irqrestore(&pci_config_lock, flags);
 162
 163         return 0;
 164 }
 165
 166 #undef PCI_CONF2_ADDRESS
 167
 168 static struct pci_raw_ops pci_direct_conf2 = {
 169         .read =         pci_conf2_read,
 170         .write =        pci_conf2_write,
 171 };
 172
 173
 174 /*
 175  * Before we decide to use direct hardware access mechanisms, we try to do some
 176  * trivial checks to ensure it at least _seems_ to be working -- we just test
 177  * whether bus 00 contains a host bridge (this is similar to checking
 178  * techniques used in XFree86, but ours should be more reliable since we
 179  * attempt to make use of direct access hints provided by the PCI BIOS).
 180  *
 181  * This should be close to trivial, but it isn't, because there are buggy
 182  * chipsets (yes, you guessed it, by Intel and Compaq) that have no class ID.
 183  */
 184 static int __init pci_sanity_check(struct pci_raw_ops *o)
 185 {
 186         u32 x = 0;
 187         int devfn;
 188
 189         if (pci_probe & PCI_NO_CHECKS)
 190                 return 1;
 191
 192         for (devfn = 0; devfn < 0x100; devfn++) {
 193                 if (o->read(0, 0, devfn, PCI_CLASS_DEVICE, 2, &x))
 194                         continue;
 195                 if (x == PCI_CLASS_BRIDGE_HOST || x == PCI_CLASS_DISPLAY_VGA)
 196                         return 1;
 197
 198                 if (o->read(0, 0, devfn, PCI_VENDOR_ID, 2, &x))
 199                         continue;
 200                 if (x == PCI_VENDOR_ID_INTEL || x == PCI_VENDOR_ID_COMPAQ)
 201                         return 1;
 202         }
 203
 204         DBG("PCI: Sanity check failed\n");
 205         return 0;
 206 }
 207
 208 static int __init pci_check_type1(void)
 209 {
 210         unsigned long flags;
 211         unsigned int tmp;
 212         int works = 0;
 213
 214         local_irq_save(flags);
 215
 216         outb(0x01, 0xCFB);
 217         tmp = inl(0xCF8);
 218         outl(0x80000000, 0xCF8);
 219         if (inl(0xCF8) == 0x80000000 && pci_sanity_check(&pci_direct_conf1)) {
 220                 works = 1;
 221         }
 222         outl(tmp, 0xCF8);
 223         local_irq_restore(flags);
 224
 225         return works;
 226 }
 227
 228 static int __init pci_check_type2(void)
 229 {
 230         unsigned long flags;
 231         int works = 0;
 232
 233         local_irq_save(flags);
 234
 235         outb(0x00, 0xCFB);
 236         outb(0x00, 0xCF8);
 237         outb(0x00, 0xCFA);
 238         if (inb(0xCF8) == 0x00 && inb(0xCFA) == 0x00 &&
 239             pci_sanity_check(&pci_direct_conf2)) {
 240                 works = 1;
 241         }
 242
 243         local_irq_restore(flags);
 244
 245         return works;
 246 }
 247
 248 static int __init pci_direct_init(void)
 249 {
 250         struct resource *region, *region2;
 251
 252         if ((pci_probe & PCI_PROBE_CONF1) == 0)
 253                 goto type2;
 254         region = request_region(0xCF8, 8, "PCI conf1");
 255         if (!region)
 256                 goto type2;
 257
 258         if (pci_check_type1()) {
 259                 printk(KERN_INFO "PCI: Using configuration type 1\n");
 260                 raw_pci_ops = &pci_direct_conf1;
 261                 return 0;
 262         }
 263         release_resource(region);
 264
 265  type2:
 266         if ((pci_probe & PCI_PROBE_CONF2) == 0)
 267                 goto out;
 268         region = request_region(0xCF8, 4, "PCI conf2");
 269         if (!region)
 270                 goto out;
 271         region2 = request_region(0xC000, 0x1000, "PCI conf2");
 272         if (!region2)
 273                 goto fail2;
 274
 275         if (pci_check_type2()) {
 276                 printk(KERN_INFO "PCI: Using configuration type 2\n");
 277                 raw_pci_ops = &pci_direct_conf2;
 278                 return 0;
 279         }
 280
 281         release_resource(region2);
 282  fail2:
 283         release_resource(region);
 284
 285  out:
 286         return 0;
 287 }
 288
 289 arch_initcall(pci_direct_init);