LCOV - code coverage report
Current view: top level - arch/x86/pci - direct.c (source / functions) Hit Total Coverage
Test: combined.info Lines: 56 137 40.9 %
Date: 2022-04-01 13:59:58 Functions: 5 8 62.5 %
Branches: 19 72 26.4 %

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

Generated by: LCOV version 1.14